Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 12ef193d authored by Troy Kisky's avatar Troy Kisky Committed by Mark Brown
Browse files

ASoC: Allow setting codec register with debugfs filesystem



i.e. echo 6 59 >/sys/kernel/debug/soc-audio.0/codec_reg
will set register 0x06 to a value of 0x59.
Also, pop_time debugfs interface setup is moved so that it
is setup in the same function as codec_reg

Signed-off-by: default avatarTroy Kisky <troy.kisky@boundarydevices.com>
Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
parent 15ad9a53
Loading
Loading
Loading
Loading
+4 −0
Original line number Diff line number Diff line
@@ -425,6 +425,7 @@ struct snd_soc_codec {
	short reg_cache_step;

	/* dapm */
	u32 pop_time;
	struct list_head dapm_widgets;
	struct list_head dapm_paths;
	enum snd_soc_bias_level bias_level;
@@ -516,6 +517,9 @@ struct snd_soc_device {
	struct delayed_work delayed_work;
	struct work_struct deferred_resume_work;
	void *codec_data;
#ifdef CONFIG_DEBUG_FS
	struct dentry	*debugfs_root;
#endif
};

/* runtime channel data */
+113 −3
Original line number Diff line number Diff line
@@ -26,6 +26,7 @@
#include <linux/delay.h>
#include <linux/pm.h>
#include <linux/bitops.h>
#include <linux/debugfs.h>
#include <linux/platform_device.h>
#include <sound/core.h>
#include <sound/pcm.h>
@@ -961,10 +962,8 @@ static int soc_new_pcm(struct snd_soc_device *socdev,
}

/* codec register dump */
static ssize_t codec_reg_show(struct device *dev,
	struct device_attribute *attr, char *buf)
static ssize_t soc_codec_reg_show(struct snd_soc_device *devdata, char *buf)
{
	struct snd_soc_device *devdata = dev_get_drvdata(dev);
	struct snd_soc_codec *codec = devdata->codec;
	int i, step = 1, count = 0;

@@ -1001,8 +1000,117 @@ static ssize_t codec_reg_show(struct device *dev,

	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, 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_device *devdata = file->private_data;
	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
	if (!buf)
		return -ENOMEM;
	ret = soc_codec_reg_show(devdata, 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_device *devdata = file->private_data;
	struct snd_soc_codec *codec = devdata->codec;

	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_debugfs(struct snd_soc_device *socdev)
{
	struct dentry *root, *file;
	struct snd_soc_codec *codec = socdev->codec;
	root = debugfs_create_dir(dev_name(socdev->dev), NULL);
	if (IS_ERR(root) || !root)
		goto exit1;

	file = debugfs_create_file("codec_reg", 0644,
			root, socdev, &codec_reg_fops);
	if (!file)
		goto exit2;

	file = debugfs_create_u32("dapm_pop_time", 0744,
			root, &codec->pop_time);
	if (!file)
		goto exit2;
	socdev->debugfs_root = root;
	return;
exit2:
	debugfs_remove_recursive(root);
exit1:
	dev_err(socdev->dev, "debugfs is not available\n");
}

static void soc_cleanup_debugfs(struct snd_soc_device *socdev)
{
	debugfs_remove_recursive(socdev->debugfs_root);
	socdev->debugfs_root = NULL;
}

#else

static inline void soc_init_debugfs(struct snd_soc_device *socdev)
{
}

static inline void soc_cleanup_debugfs(struct snd_soc_device *socdev)
{
}
#endif

/**
 * snd_soc_new_ac97_codec - initailise AC97 device
 * @codec: audio codec
@@ -1216,6 +1324,7 @@ int snd_soc_register_card(struct snd_soc_device *socdev)
	if (err < 0)
		printk(KERN_WARNING "asoc: failed to add codec sysfs files\n");

	soc_init_debugfs(socdev);
	mutex_unlock(&codec->mutex);

out:
@@ -1239,6 +1348,7 @@ void snd_soc_free_pcms(struct snd_soc_device *socdev)
#endif

	mutex_lock(&codec->mutex);
	soc_cleanup_debugfs(socdev);
#ifdef CONFIG_SND_SOC_AC97_BUS
	for (i = 0; i < codec->num_dai; i++) {
		codec_dai = &codec->dai[i];
+8 −25
Original line number Diff line number Diff line
@@ -37,7 +37,6 @@
#include <linux/bitops.h>
#include <linux/platform_device.h>
#include <linux/jiffies.h>
#include <linux/debugfs.h>
#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
@@ -67,17 +66,13 @@ static int dapm_status = 1;
module_param(dapm_status, int, 0);
MODULE_PARM_DESC(dapm_status, "enable DPM sysfs entries");

static struct dentry *asoc_debugfs;

static u32 pop_time;

static void pop_wait(void)
static void pop_wait(u32 pop_time)
{
	if (pop_time)
		schedule_timeout_uninterruptible(msecs_to_jiffies(pop_time));
}

static void pop_dbg(const char *fmt, ...)
static void pop_dbg(u32 pop_time, const char *fmt, ...)
{
	va_list args;

@@ -85,7 +80,7 @@ static void pop_dbg(const char *fmt, ...)

	if (pop_time) {
		vprintk(fmt, args);
		pop_wait();
		pop_wait(pop_time);
	}

	va_end(args);
@@ -230,10 +225,11 @@ static int dapm_update_bits(struct snd_soc_dapm_widget *widget)

	change = old != new;
	if (change) {
		pop_dbg("pop test %s : %s in %d ms\n", widget->name,
			widget->power ? "on" : "off", pop_time);
		pop_dbg(codec->pop_time, "pop test %s : %s in %d ms\n",
			widget->name, widget->power ? "on" : "off",
			codec->pop_time);
		snd_soc_write(codec, widget->reg, new);
		pop_wait();
		pop_wait(codec->pop_time);
	}
	pr_debug("reg %x old %x new %x change %d\n", widget->reg,
		 old, new, change);
@@ -821,23 +817,13 @@ static DEVICE_ATTR(dapm_widget, 0444, dapm_widget_show, NULL);

int snd_soc_dapm_sys_add(struct device *dev)
{
	int ret = 0;

	if (!dapm_status)
		return 0;

	ret = device_create_file(dev, &dev_attr_dapm_widget);
	if (ret != 0)
		return ret;

	asoc_debugfs = debugfs_create_dir("asoc", NULL);
	if (!IS_ERR(asoc_debugfs) && asoc_debugfs)
		debugfs_create_u32("dapm_pop_time", 0744, asoc_debugfs,
				   &pop_time);
	else
		asoc_debugfs = NULL;

	return 0;
	return device_create_file(dev, &dev_attr_dapm_widget);
}

static void snd_soc_dapm_sys_remove(struct device *dev)
@@ -845,9 +831,6 @@ static void snd_soc_dapm_sys_remove(struct device *dev)
	if (dapm_status) {
		device_remove_file(dev, &dev_attr_dapm_widget);
	}

	if (asoc_debugfs)
		debugfs_remove_recursive(asoc_debugfs);
}

/* free all dapm widgets and resources */