ASoC: Move sysfs and debugfs functions to head of soc-core.c
A fairly hefty change in diff terms but no actual code changes, will be used by the next commit. Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
This commit is contained in:
Mark Brown
@@ -80,6 +80,173 @@ static int run_delayed_work(struct delayed_work *dwork)
|
|||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* codec register dump */
|
||||||
|
static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf)
|
||||||
|
{
|
||||||
|
int i, step = 1, count = 0;
|
||||||
|
|
||||||
|
if (!codec->reg_cache_size)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
if (codec->reg_cache_step)
|
||||||
|
step = codec->reg_cache_step;
|
||||||
|
|
||||||
|
count += sprintf(buf, "%s registers\n", codec->name);
|
||||||
|
for (i = 0; i < codec->reg_cache_size; i += step) {
|
||||||
|
if (codec->readable_register && !codec->readable_register(i))
|
||||||
|
continue;
|
||||||
|
|
||||||
|
count += sprintf(buf + count, "%2x: ", i);
|
||||||
|
if (count >= PAGE_SIZE - 1)
|
||||||
|
break;
|
||||||
|
|
||||||
|
if (codec->display_register)
|
||||||
|
count += codec->display_register(codec, buf + count,
|
||||||
|
PAGE_SIZE - count, i);
|
||||||
|
else
|
||||||
|
count += snprintf(buf + count, PAGE_SIZE - count,
|
||||||
|
"%4x", codec->read(codec, i));
|
||||||
|
|
||||||
|
if (count >= PAGE_SIZE - 1)
|
||||||
|
break;
|
||||||
|
|
||||||
|
count += snprintf(buf + count, PAGE_SIZE - count, "\n");
|
||||||
|
if (count >= PAGE_SIZE - 1)
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Truncate count; min() would cause a warning */
|
||||||
|
if (count >= PAGE_SIZE)
|
||||||
|
count = PAGE_SIZE - 1;
|
||||||
|
|
||||||
|
return count;
|
||||||
|
}
|
||||||
|
static ssize_t codec_reg_show(struct device *dev,
|
||||||
|
struct device_attribute *attr, char *buf)
|
||||||
|
{
|
||||||
|
struct snd_soc_device *devdata = dev_get_drvdata(dev);
|
||||||
|
return soc_codec_reg_show(devdata->card->codec, buf);
|
||||||
|
}
|
||||||
|
|
||||||
|
static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
|
||||||
|
|
||||||
|
#ifdef CONFIG_DEBUG_FS
|
||||||
|
static int codec_reg_open_file(struct inode *inode, struct file *file)
|
||||||
|
{
|
||||||
|
file->private_data = inode->i_private;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
|
||||||
|
size_t count, loff_t *ppos)
|
||||||
|
{
|
||||||
|
ssize_t ret;
|
||||||
|
struct snd_soc_codec *codec = file->private_data;
|
||||||
|
char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
|
||||||
|
if (!buf)
|
||||||
|
return -ENOMEM;
|
||||||
|
ret = soc_codec_reg_show(codec, buf);
|
||||||
|
if (ret >= 0)
|
||||||
|
ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
|
||||||
|
kfree(buf);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static ssize_t codec_reg_write_file(struct file *file,
|
||||||
|
const char __user *user_buf, size_t count, loff_t *ppos)
|
||||||
|
{
|
||||||
|
char buf[32];
|
||||||
|
int buf_size;
|
||||||
|
char *start = buf;
|
||||||
|
unsigned long reg, value;
|
||||||
|
int step = 1;
|
||||||
|
struct snd_soc_codec *codec = file->private_data;
|
||||||
|
|
||||||
|
buf_size = min(count, (sizeof(buf)-1));
|
||||||
|
if (copy_from_user(buf, user_buf, buf_size))
|
||||||
|
return -EFAULT;
|
||||||
|
buf[buf_size] = 0;
|
||||||
|
|
||||||
|
if (codec->reg_cache_step)
|
||||||
|
step = codec->reg_cache_step;
|
||||||
|
|
||||||
|
while (*start == ' ')
|
||||||
|
start++;
|
||||||
|
reg = simple_strtoul(start, &start, 16);
|
||||||
|
if ((reg >= codec->reg_cache_size) || (reg % step))
|
||||||
|
return -EINVAL;
|
||||||
|
while (*start == ' ')
|
||||||
|
start++;
|
||||||
|
if (strict_strtoul(start, 16, &value))
|
||||||
|
return -EINVAL;
|
||||||
|
codec->write(codec, reg, value);
|
||||||
|
return buf_size;
|
||||||
|
}
|
||||||
|
|
||||||
|
static const struct file_operations codec_reg_fops = {
|
||||||
|
.open = codec_reg_open_file,
|
||||||
|
.read = codec_reg_read_file,
|
||||||
|
.write = codec_reg_write_file,
|
||||||
|
};
|
||||||
|
|
||||||
|
static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
|
||||||
|
{
|
||||||
|
char codec_root[128];
|
||||||
|
|
||||||
|
if (codec->dev)
|
||||||
|
snprintf(codec_root, sizeof(codec_root),
|
||||||
|
"%s.%s", codec->name, dev_name(codec->dev));
|
||||||
|
else
|
||||||
|
snprintf(codec_root, sizeof(codec_root),
|
||||||
|
"%s", codec->name);
|
||||||
|
|
||||||
|
codec->debugfs_codec_root = debugfs_create_dir(codec_root,
|
||||||
|
debugfs_root);
|
||||||
|
if (!codec->debugfs_codec_root) {
|
||||||
|
printk(KERN_WARNING
|
||||||
|
"ASoC: Failed to create codec debugfs directory\n");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
|
||||||
|
codec->debugfs_codec_root,
|
||||||
|
codec, &codec_reg_fops);
|
||||||
|
if (!codec->debugfs_reg)
|
||||||
|
printk(KERN_WARNING
|
||||||
|
"ASoC: Failed to create codec register debugfs file\n");
|
||||||
|
|
||||||
|
codec->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0744,
|
||||||
|
codec->debugfs_codec_root,
|
||||||
|
&codec->pop_time);
|
||||||
|
if (!codec->debugfs_pop_time)
|
||||||
|
printk(KERN_WARNING
|
||||||
|
"Failed to create pop time debugfs file\n");
|
||||||
|
|
||||||
|
codec->debugfs_dapm = debugfs_create_dir("dapm",
|
||||||
|
codec->debugfs_codec_root);
|
||||||
|
if (!codec->debugfs_dapm)
|
||||||
|
printk(KERN_WARNING
|
||||||
|
"Failed to create DAPM debugfs directory\n");
|
||||||
|
|
||||||
|
snd_soc_dapm_debugfs_init(codec);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
|
||||||
|
{
|
||||||
|
debugfs_remove_recursive(codec->debugfs_codec_root);
|
||||||
|
}
|
||||||
|
|
||||||
|
#else
|
||||||
|
|
||||||
|
static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
|
||||||
|
{
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
|
||||||
|
{
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
#ifdef CONFIG_SND_SOC_AC97_BUS
|
#ifdef CONFIG_SND_SOC_AC97_BUS
|
||||||
/* unregister ac97 codec */
|
/* unregister ac97 codec */
|
||||||
static int soc_ac97_dev_unregister(struct snd_soc_codec *codec)
|
static int soc_ac97_dev_unregister(struct snd_soc_codec *codec)
|
||||||
@@ -1111,173 +1278,6 @@ int snd_soc_codec_volatile_register(struct snd_soc_codec *codec, int reg)
|
|||||||
}
|
}
|
||||||
EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register);
|
EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register);
|
||||||
|
|
||||||
/* codec register dump */
|
|
||||||
static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf)
|
|
||||||
{
|
|
||||||
int i, step = 1, count = 0;
|
|
||||||
|
|
||||||
if (!codec->reg_cache_size)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
if (codec->reg_cache_step)
|
|
||||||
step = codec->reg_cache_step;
|
|
||||||
|
|
||||||
count += sprintf(buf, "%s registers\n", codec->name);
|
|
||||||
for (i = 0; i < codec->reg_cache_size; i += step) {
|
|
||||||
if (codec->readable_register && !codec->readable_register(i))
|
|
||||||
continue;
|
|
||||||
|
|
||||||
count += sprintf(buf + count, "%2x: ", i);
|
|
||||||
if (count >= PAGE_SIZE - 1)
|
|
||||||
break;
|
|
||||||
|
|
||||||
if (codec->display_register)
|
|
||||||
count += codec->display_register(codec, buf + count,
|
|
||||||
PAGE_SIZE - count, i);
|
|
||||||
else
|
|
||||||
count += snprintf(buf + count, PAGE_SIZE - count,
|
|
||||||
"%4x", codec->read(codec, i));
|
|
||||||
|
|
||||||
if (count >= PAGE_SIZE - 1)
|
|
||||||
break;
|
|
||||||
|
|
||||||
count += snprintf(buf + count, PAGE_SIZE - count, "\n");
|
|
||||||
if (count >= PAGE_SIZE - 1)
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Truncate count; min() would cause a warning */
|
|
||||||
if (count >= PAGE_SIZE)
|
|
||||||
count = PAGE_SIZE - 1;
|
|
||||||
|
|
||||||
return count;
|
|
||||||
}
|
|
||||||
static ssize_t codec_reg_show(struct device *dev,
|
|
||||||
struct device_attribute *attr, char *buf)
|
|
||||||
{
|
|
||||||
struct snd_soc_device *devdata = dev_get_drvdata(dev);
|
|
||||||
return soc_codec_reg_show(devdata->card->codec, buf);
|
|
||||||
}
|
|
||||||
|
|
||||||
static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
|
|
||||||
|
|
||||||
#ifdef CONFIG_DEBUG_FS
|
|
||||||
static int codec_reg_open_file(struct inode *inode, struct file *file)
|
|
||||||
{
|
|
||||||
file->private_data = inode->i_private;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
|
|
||||||
size_t count, loff_t *ppos)
|
|
||||||
{
|
|
||||||
ssize_t ret;
|
|
||||||
struct snd_soc_codec *codec = file->private_data;
|
|
||||||
char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
|
|
||||||
if (!buf)
|
|
||||||
return -ENOMEM;
|
|
||||||
ret = soc_codec_reg_show(codec, buf);
|
|
||||||
if (ret >= 0)
|
|
||||||
ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
|
|
||||||
kfree(buf);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
static ssize_t codec_reg_write_file(struct file *file,
|
|
||||||
const char __user *user_buf, size_t count, loff_t *ppos)
|
|
||||||
{
|
|
||||||
char buf[32];
|
|
||||||
int buf_size;
|
|
||||||
char *start = buf;
|
|
||||||
unsigned long reg, value;
|
|
||||||
int step = 1;
|
|
||||||
struct snd_soc_codec *codec = file->private_data;
|
|
||||||
|
|
||||||
buf_size = min(count, (sizeof(buf)-1));
|
|
||||||
if (copy_from_user(buf, user_buf, buf_size))
|
|
||||||
return -EFAULT;
|
|
||||||
buf[buf_size] = 0;
|
|
||||||
|
|
||||||
if (codec->reg_cache_step)
|
|
||||||
step = codec->reg_cache_step;
|
|
||||||
|
|
||||||
while (*start == ' ')
|
|
||||||
start++;
|
|
||||||
reg = simple_strtoul(start, &start, 16);
|
|
||||||
if ((reg >= codec->reg_cache_size) || (reg % step))
|
|
||||||
return -EINVAL;
|
|
||||||
while (*start == ' ')
|
|
||||||
start++;
|
|
||||||
if (strict_strtoul(start, 16, &value))
|
|
||||||
return -EINVAL;
|
|
||||||
codec->write(codec, reg, value);
|
|
||||||
return buf_size;
|
|
||||||
}
|
|
||||||
|
|
||||||
static const struct file_operations codec_reg_fops = {
|
|
||||||
.open = codec_reg_open_file,
|
|
||||||
.read = codec_reg_read_file,
|
|
||||||
.write = codec_reg_write_file,
|
|
||||||
};
|
|
||||||
|
|
||||||
static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
|
|
||||||
{
|
|
||||||
char codec_root[128];
|
|
||||||
|
|
||||||
if (codec->dev)
|
|
||||||
snprintf(codec_root, sizeof(codec_root),
|
|
||||||
"%s.%s", codec->name, dev_name(codec->dev));
|
|
||||||
else
|
|
||||||
snprintf(codec_root, sizeof(codec_root),
|
|
||||||
"%s", codec->name);
|
|
||||||
|
|
||||||
codec->debugfs_codec_root = debugfs_create_dir(codec_root,
|
|
||||||
debugfs_root);
|
|
||||||
if (!codec->debugfs_codec_root) {
|
|
||||||
printk(KERN_WARNING
|
|
||||||
"ASoC: Failed to create codec debugfs directory\n");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
|
|
||||||
codec->debugfs_codec_root,
|
|
||||||
codec, &codec_reg_fops);
|
|
||||||
if (!codec->debugfs_reg)
|
|
||||||
printk(KERN_WARNING
|
|
||||||
"ASoC: Failed to create codec register debugfs file\n");
|
|
||||||
|
|
||||||
codec->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0744,
|
|
||||||
codec->debugfs_codec_root,
|
|
||||||
&codec->pop_time);
|
|
||||||
if (!codec->debugfs_pop_time)
|
|
||||||
printk(KERN_WARNING
|
|
||||||
"Failed to create pop time debugfs file\n");
|
|
||||||
|
|
||||||
codec->debugfs_dapm = debugfs_create_dir("dapm",
|
|
||||||
codec->debugfs_codec_root);
|
|
||||||
if (!codec->debugfs_dapm)
|
|
||||||
printk(KERN_WARNING
|
|
||||||
"Failed to create DAPM debugfs directory\n");
|
|
||||||
|
|
||||||
snd_soc_dapm_debugfs_init(codec);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
|
|
||||||
{
|
|
||||||
debugfs_remove_recursive(codec->debugfs_codec_root);
|
|
||||||
}
|
|
||||||
|
|
||||||
#else
|
|
||||||
|
|
||||||
static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
|
|
||||||
{
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* snd_soc_new_ac97_codec - initailise AC97 device
|
* snd_soc_new_ac97_codec - initailise AC97 device
|
||||||
* @codec: audio codec
|
* @codec: audio codec
|
||||||
|
|||||||
Reference in New Issue
Block a user