xref: /openbmc/linux/sound/soc/soc-core.c (revision 44c69bb13905c3b2281a920c0b44059e88819993)
1db2a4165SFrank Mandarino /*
2db2a4165SFrank Mandarino  * soc-core.c  --  ALSA SoC Audio Layer
3db2a4165SFrank Mandarino  *
4db2a4165SFrank Mandarino  * Copyright 2005 Wolfson Microelectronics PLC.
50664d888SLiam Girdwood  * Copyright 2005 Openedhand Ltd.
6f0fba2adSLiam Girdwood  * Copyright (C) 2010 Slimlogic Ltd.
7f0fba2adSLiam Girdwood  * Copyright (C) 2010 Texas Instruments Inc.
80664d888SLiam Girdwood  *
9d331124dSLiam Girdwood  * Author: Liam Girdwood <lrg@slimlogic.co.uk>
100664d888SLiam Girdwood  *         with code, comments and ideas from :-
110664d888SLiam Girdwood  *         Richard Purdie <richard@openedhand.com>
12db2a4165SFrank Mandarino  *
13db2a4165SFrank Mandarino  *  This program is free software; you can redistribute  it and/or modify it
14db2a4165SFrank Mandarino  *  under  the terms of  the GNU General  Public License as published by the
15db2a4165SFrank Mandarino  *  Free Software Foundation;  either version 2 of the  License, or (at your
16db2a4165SFrank Mandarino  *  option) any later version.
17db2a4165SFrank Mandarino  *
18db2a4165SFrank Mandarino  *  TODO:
19db2a4165SFrank Mandarino  *   o Add hw rules to enforce rates, etc.
20db2a4165SFrank Mandarino  *   o More testing with other codecs/machines.
21db2a4165SFrank Mandarino  *   o Add more codecs and platforms to ensure good API coverage.
22db2a4165SFrank Mandarino  *   o Support TDM on PCM and I2S
23db2a4165SFrank Mandarino  */
24db2a4165SFrank Mandarino 
25db2a4165SFrank Mandarino #include <linux/module.h>
26db2a4165SFrank Mandarino #include <linux/moduleparam.h>
27db2a4165SFrank Mandarino #include <linux/init.h>
28db2a4165SFrank Mandarino #include <linux/delay.h>
29db2a4165SFrank Mandarino #include <linux/pm.h>
30db2a4165SFrank Mandarino #include <linux/bitops.h>
3112ef193dSTroy Kisky #include <linux/debugfs.h>
32db2a4165SFrank Mandarino #include <linux/platform_device.h>
33741a509fSMarkus Pargmann #include <linux/pinctrl/consumer.h>
34f0e8ed85SMark Brown #include <linux/ctype.h>
355a0e3ad6STejun Heo #include <linux/slab.h>
36bec4fa05SStephen Warren #include <linux/of.h>
37741a509fSMarkus Pargmann #include <linux/gpio.h>
38741a509fSMarkus Pargmann #include <linux/of_gpio.h>
39474828a4SMarek Vasut #include <sound/ac97_codec.h>
40db2a4165SFrank Mandarino #include <sound/core.h>
413028eb8cSMark Brown #include <sound/jack.h>
42db2a4165SFrank Mandarino #include <sound/pcm.h>
43db2a4165SFrank Mandarino #include <sound/pcm_params.h>
44db2a4165SFrank Mandarino #include <sound/soc.h>
4501d7584cSLiam Girdwood #include <sound/soc-dpcm.h>
46db2a4165SFrank Mandarino #include <sound/initval.h>
47db2a4165SFrank Mandarino 
48a8b1d34fSMark Brown #define CREATE_TRACE_POINTS
49a8b1d34fSMark Brown #include <trace/events/asoc.h>
50a8b1d34fSMark Brown 
51f0fba2adSLiam Girdwood #define NAME_SIZE	32
52f0fba2adSLiam Girdwood 
53384c89e2SMark Brown #ifdef CONFIG_DEBUG_FS
548a9dab1aSMark Brown struct dentry *snd_soc_debugfs_root;
558a9dab1aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_debugfs_root);
56384c89e2SMark Brown #endif
57384c89e2SMark Brown 
58c5af3a2eSMark Brown static DEFINE_MUTEX(client_mutex);
5912a48a8cSMark Brown static LIST_HEAD(platform_list);
600d0cf00aSMark Brown static LIST_HEAD(codec_list);
61030e79f6SKuninori Morimoto static LIST_HEAD(component_list);
62c5af3a2eSMark Brown 
63db2a4165SFrank Mandarino /*
64db2a4165SFrank Mandarino  * This is a timeout to do a DAPM powerdown after a stream is closed().
65db2a4165SFrank Mandarino  * It can be used to eliminate pops between different playback streams, e.g.
66db2a4165SFrank Mandarino  * between two audio tracks.
67db2a4165SFrank Mandarino  */
68db2a4165SFrank Mandarino static int pmdown_time = 5000;
69db2a4165SFrank Mandarino module_param(pmdown_time, int, 0);
70db2a4165SFrank Mandarino MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
71db2a4165SFrank Mandarino 
72741a509fSMarkus Pargmann struct snd_ac97_reset_cfg {
73741a509fSMarkus Pargmann 	struct pinctrl *pctl;
74741a509fSMarkus Pargmann 	struct pinctrl_state *pstate_reset;
75741a509fSMarkus Pargmann 	struct pinctrl_state *pstate_warm_reset;
76741a509fSMarkus Pargmann 	struct pinctrl_state *pstate_run;
77741a509fSMarkus Pargmann 	int gpio_sdata;
78741a509fSMarkus Pargmann 	int gpio_sync;
79741a509fSMarkus Pargmann 	int gpio_reset;
80741a509fSMarkus Pargmann };
81741a509fSMarkus Pargmann 
822bc9a81eSDimitris Papastamos /* returns the minimum number of bytes needed to represent
832bc9a81eSDimitris Papastamos  * a particular given value */
842bc9a81eSDimitris Papastamos static int min_bytes_needed(unsigned long val)
852bc9a81eSDimitris Papastamos {
862bc9a81eSDimitris Papastamos 	int c = 0;
872bc9a81eSDimitris Papastamos 	int i;
882bc9a81eSDimitris Papastamos 
892bc9a81eSDimitris Papastamos 	for (i = (sizeof val * 8) - 1; i >= 0; --i, ++c)
902bc9a81eSDimitris Papastamos 		if (val & (1UL << i))
912bc9a81eSDimitris Papastamos 			break;
922bc9a81eSDimitris Papastamos 	c = (sizeof val * 8) - c;
932bc9a81eSDimitris Papastamos 	if (!c || (c % 8))
942bc9a81eSDimitris Papastamos 		c = (c + 8) / 8;
952bc9a81eSDimitris Papastamos 	else
962bc9a81eSDimitris Papastamos 		c /= 8;
972bc9a81eSDimitris Papastamos 	return c;
982bc9a81eSDimitris Papastamos }
992bc9a81eSDimitris Papastamos 
10013fd179fSDimitris Papastamos /* fill buf which is 'len' bytes with a formatted
10113fd179fSDimitris Papastamos  * string of the form 'reg: value\n' */
10213fd179fSDimitris Papastamos static int format_register_str(struct snd_soc_codec *codec,
10313fd179fSDimitris Papastamos 			       unsigned int reg, char *buf, size_t len)
1042624d5faSMark Brown {
10500b317a4SStephen Warren 	int wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
10600b317a4SStephen Warren 	int regsize = codec->driver->reg_word_size * 2;
10713fd179fSDimitris Papastamos 	int ret;
10813fd179fSDimitris Papastamos 	char tmpbuf[len + 1];
10913fd179fSDimitris Papastamos 	char regbuf[regsize + 1];
11013fd179fSDimitris Papastamos 
11113fd179fSDimitris Papastamos 	/* since tmpbuf is allocated on the stack, warn the callers if they
11213fd179fSDimitris Papastamos 	 * try to abuse this function */
11313fd179fSDimitris Papastamos 	WARN_ON(len > 63);
11413fd179fSDimitris Papastamos 
11513fd179fSDimitris Papastamos 	/* +2 for ': ' and + 1 for '\n' */
11613fd179fSDimitris Papastamos 	if (wordsize + regsize + 2 + 1 != len)
11713fd179fSDimitris Papastamos 		return -EINVAL;
11813fd179fSDimitris Papastamos 
11913fd179fSDimitris Papastamos 	ret = snd_soc_read(codec, reg);
12013fd179fSDimitris Papastamos 	if (ret < 0) {
12113fd179fSDimitris Papastamos 		memset(regbuf, 'X', regsize);
12213fd179fSDimitris Papastamos 		regbuf[regsize] = '\0';
12313fd179fSDimitris Papastamos 	} else {
12413fd179fSDimitris Papastamos 		snprintf(regbuf, regsize + 1, "%.*x", regsize, ret);
12513fd179fSDimitris Papastamos 	}
12613fd179fSDimitris Papastamos 
12713fd179fSDimitris Papastamos 	/* prepare the buffer */
12813fd179fSDimitris Papastamos 	snprintf(tmpbuf, len + 1, "%.*x: %s\n", wordsize, reg, regbuf);
12913fd179fSDimitris Papastamos 	/* copy it back to the caller without the '\0' */
13013fd179fSDimitris Papastamos 	memcpy(buf, tmpbuf, len);
13113fd179fSDimitris Papastamos 
13213fd179fSDimitris Papastamos 	return 0;
13313fd179fSDimitris Papastamos }
13413fd179fSDimitris Papastamos 
13513fd179fSDimitris Papastamos /* codec register dump */
13613fd179fSDimitris Papastamos static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf,
13713fd179fSDimitris Papastamos 				  size_t count, loff_t pos)
13813fd179fSDimitris Papastamos {
13913fd179fSDimitris Papastamos 	int i, step = 1;
1402bc9a81eSDimitris Papastamos 	int wordsize, regsize;
14113fd179fSDimitris Papastamos 	int len;
14213fd179fSDimitris Papastamos 	size_t total = 0;
14313fd179fSDimitris Papastamos 	loff_t p = 0;
1442bc9a81eSDimitris Papastamos 
14500b317a4SStephen Warren 	wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
14600b317a4SStephen Warren 	regsize = codec->driver->reg_word_size * 2;
1472624d5faSMark Brown 
14813fd179fSDimitris Papastamos 	len = wordsize + regsize + 2 + 1;
14913fd179fSDimitris Papastamos 
150f0fba2adSLiam Girdwood 	if (!codec->driver->reg_cache_size)
1512624d5faSMark Brown 		return 0;
1522624d5faSMark Brown 
153f0fba2adSLiam Girdwood 	if (codec->driver->reg_cache_step)
154f0fba2adSLiam Girdwood 		step = codec->driver->reg_cache_step;
1552624d5faSMark Brown 
156f0fba2adSLiam Girdwood 	for (i = 0; i < codec->driver->reg_cache_size; i += step) {
15713fd179fSDimitris Papastamos 		/* only support larger than PAGE_SIZE bytes debugfs
15813fd179fSDimitris Papastamos 		 * entries for the default case */
15913fd179fSDimitris Papastamos 		if (p >= pos) {
16013fd179fSDimitris Papastamos 			if (total + len >= count - 1)
1612624d5faSMark Brown 				break;
16213fd179fSDimitris Papastamos 			format_register_str(codec, i, buf + total, len);
16313fd179fSDimitris Papastamos 			total += len;
16413fd179fSDimitris Papastamos 		}
16513fd179fSDimitris Papastamos 		p += len;
16613fd179fSDimitris Papastamos 	}
1672624d5faSMark Brown 
16813fd179fSDimitris Papastamos 	total = min(total, count - 1);
1692624d5faSMark Brown 
17013fd179fSDimitris Papastamos 	return total;
1712624d5faSMark Brown }
17213fd179fSDimitris Papastamos 
1732624d5faSMark Brown static ssize_t codec_reg_show(struct device *dev,
1742624d5faSMark Brown 	struct device_attribute *attr, char *buf)
1752624d5faSMark Brown {
17636ae1a96SMark Brown 	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
177f0fba2adSLiam Girdwood 
17813fd179fSDimitris Papastamos 	return soc_codec_reg_show(rtd->codec, buf, PAGE_SIZE, 0);
1792624d5faSMark Brown }
1802624d5faSMark Brown 
1812624d5faSMark Brown static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
1822624d5faSMark Brown 
183dbe21408SMark Brown static ssize_t pmdown_time_show(struct device *dev,
184dbe21408SMark Brown 				struct device_attribute *attr, char *buf)
185dbe21408SMark Brown {
18636ae1a96SMark Brown 	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
187dbe21408SMark Brown 
188f0fba2adSLiam Girdwood 	return sprintf(buf, "%ld\n", rtd->pmdown_time);
189dbe21408SMark Brown }
190dbe21408SMark Brown 
191dbe21408SMark Brown static ssize_t pmdown_time_set(struct device *dev,
192dbe21408SMark Brown 			       struct device_attribute *attr,
193dbe21408SMark Brown 			       const char *buf, size_t count)
194dbe21408SMark Brown {
19536ae1a96SMark Brown 	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
196c593b520SMark Brown 	int ret;
197dbe21408SMark Brown 
198b785a492SJingoo Han 	ret = kstrtol(buf, 10, &rtd->pmdown_time);
199c593b520SMark Brown 	if (ret)
200c593b520SMark Brown 		return ret;
201dbe21408SMark Brown 
202dbe21408SMark Brown 	return count;
203dbe21408SMark Brown }
204dbe21408SMark Brown 
205dbe21408SMark Brown static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set);
206dbe21408SMark Brown 
2072624d5faSMark Brown #ifdef CONFIG_DEBUG_FS
2082624d5faSMark Brown static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
2092624d5faSMark Brown 				   size_t count, loff_t *ppos)
2102624d5faSMark Brown {
2112624d5faSMark Brown 	ssize_t ret;
2122624d5faSMark Brown 	struct snd_soc_codec *codec = file->private_data;
21313fd179fSDimitris Papastamos 	char *buf;
21413fd179fSDimitris Papastamos 
21513fd179fSDimitris Papastamos 	if (*ppos < 0 || !count)
21613fd179fSDimitris Papastamos 		return -EINVAL;
21713fd179fSDimitris Papastamos 
21813fd179fSDimitris Papastamos 	buf = kmalloc(count, GFP_KERNEL);
2192624d5faSMark Brown 	if (!buf)
2202624d5faSMark Brown 		return -ENOMEM;
22113fd179fSDimitris Papastamos 
22213fd179fSDimitris Papastamos 	ret = soc_codec_reg_show(codec, buf, count, *ppos);
22313fd179fSDimitris Papastamos 	if (ret >= 0) {
22413fd179fSDimitris Papastamos 		if (copy_to_user(user_buf, buf, ret)) {
22513fd179fSDimitris Papastamos 			kfree(buf);
22613fd179fSDimitris Papastamos 			return -EFAULT;
22713fd179fSDimitris Papastamos 		}
22813fd179fSDimitris Papastamos 		*ppos += ret;
22913fd179fSDimitris Papastamos 	}
23013fd179fSDimitris Papastamos 
2312624d5faSMark Brown 	kfree(buf);
2322624d5faSMark Brown 	return ret;
2332624d5faSMark Brown }
2342624d5faSMark Brown 
2352624d5faSMark Brown static ssize_t codec_reg_write_file(struct file *file,
2362624d5faSMark Brown 		const char __user *user_buf, size_t count, loff_t *ppos)
2372624d5faSMark Brown {
2382624d5faSMark Brown 	char buf[32];
23934e268d8SStephen Boyd 	size_t buf_size;
2402624d5faSMark Brown 	char *start = buf;
2412624d5faSMark Brown 	unsigned long reg, value;
2422624d5faSMark Brown 	struct snd_soc_codec *codec = file->private_data;
243b785a492SJingoo Han 	int ret;
2442624d5faSMark Brown 
2452624d5faSMark Brown 	buf_size = min(count, (sizeof(buf)-1));
2462624d5faSMark Brown 	if (copy_from_user(buf, user_buf, buf_size))
2472624d5faSMark Brown 		return -EFAULT;
2482624d5faSMark Brown 	buf[buf_size] = 0;
2492624d5faSMark Brown 
2502624d5faSMark Brown 	while (*start == ' ')
2512624d5faSMark Brown 		start++;
2522624d5faSMark Brown 	reg = simple_strtoul(start, &start, 16);
2532624d5faSMark Brown 	while (*start == ' ')
2542624d5faSMark Brown 		start++;
255b785a492SJingoo Han 	ret = kstrtoul(start, 16, &value);
256b785a492SJingoo Han 	if (ret)
257b785a492SJingoo Han 		return ret;
2580d51a9cbSMark Brown 
2590d51a9cbSMark Brown 	/* Userspace has been fiddling around behind the kernel's back */
260373d4d09SRusty Russell 	add_taint(TAINT_USER, LOCKDEP_NOW_UNRELIABLE);
2610d51a9cbSMark Brown 
262e4f078d8SDimitris Papastamos 	snd_soc_write(codec, reg, value);
2632624d5faSMark Brown 	return buf_size;
2642624d5faSMark Brown }
2652624d5faSMark Brown 
2662624d5faSMark Brown static const struct file_operations codec_reg_fops = {
267234e3405SStephen Boyd 	.open = simple_open,
2682624d5faSMark Brown 	.read = codec_reg_read_file,
2692624d5faSMark Brown 	.write = codec_reg_write_file,
2706038f373SArnd Bergmann 	.llseek = default_llseek,
2712624d5faSMark Brown };
2722624d5faSMark Brown 
273e73f3de5SRussell King static struct dentry *soc_debugfs_create_dir(struct dentry *parent,
274e73f3de5SRussell King 	const char *fmt, ...)
275e73f3de5SRussell King {
276e73f3de5SRussell King 	struct dentry *de;
277e73f3de5SRussell King 	va_list ap;
278e73f3de5SRussell King 	char *s;
279e73f3de5SRussell King 
280e73f3de5SRussell King 	va_start(ap, fmt);
281e73f3de5SRussell King 	s = kvasprintf(GFP_KERNEL, fmt, ap);
282e73f3de5SRussell King 	va_end(ap);
283e73f3de5SRussell King 
284e73f3de5SRussell King 	if (!s)
285e73f3de5SRussell King 		return NULL;
286e73f3de5SRussell King 
287e73f3de5SRussell King 	de = debugfs_create_dir(s, parent);
288e73f3de5SRussell King 	kfree(s);
289e73f3de5SRussell King 
290e73f3de5SRussell King 	return de;
291e73f3de5SRussell King }
292e73f3de5SRussell King 
2932624d5faSMark Brown static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
2942624d5faSMark Brown {
295d6ce4cf3SJarkko Nikula 	struct dentry *debugfs_card_root = codec->card->debugfs_card_root;
296d6ce4cf3SJarkko Nikula 
297e73f3de5SRussell King 	codec->debugfs_codec_root = soc_debugfs_create_dir(debugfs_card_root,
298211bcc6cSMark Brown 						"codec:%s",
299211bcc6cSMark Brown 						codec->component.name);
3002624d5faSMark Brown 	if (!codec->debugfs_codec_root) {
30110e8aa9aSMichał Mirosław 		dev_warn(codec->dev,
30210e8aa9aSMichał Mirosław 			"ASoC: Failed to create codec debugfs directory\n");
3032624d5faSMark Brown 		return;
3042624d5faSMark Brown 	}
3052624d5faSMark Brown 
306aaee8ef1SMark Brown 	debugfs_create_bool("cache_sync", 0444, codec->debugfs_codec_root,
307aaee8ef1SMark Brown 			    &codec->cache_sync);
308aaee8ef1SMark Brown 	debugfs_create_bool("cache_only", 0444, codec->debugfs_codec_root,
309aaee8ef1SMark Brown 			    &codec->cache_only);
310aaee8ef1SMark Brown 
3112624d5faSMark Brown 	codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
3122624d5faSMark Brown 						 codec->debugfs_codec_root,
3132624d5faSMark Brown 						 codec, &codec_reg_fops);
3142624d5faSMark Brown 	if (!codec->debugfs_reg)
31510e8aa9aSMichał Mirosław 		dev_warn(codec->dev,
31610e8aa9aSMichał Mirosław 			"ASoC: Failed to create codec register debugfs file\n");
3172624d5faSMark Brown 
3188eecaf62SLars-Peter Clausen 	snd_soc_dapm_debugfs_init(&codec->dapm, codec->debugfs_codec_root);
3192624d5faSMark Brown }
3202624d5faSMark Brown 
3212624d5faSMark Brown static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
3222624d5faSMark Brown {
3232624d5faSMark Brown 	debugfs_remove_recursive(codec->debugfs_codec_root);
3242624d5faSMark Brown }
3252624d5faSMark Brown 
326731f1ab2SSebastien Guiriec static void soc_init_platform_debugfs(struct snd_soc_platform *platform)
327731f1ab2SSebastien Guiriec {
328731f1ab2SSebastien Guiriec 	struct dentry *debugfs_card_root = platform->card->debugfs_card_root;
329731f1ab2SSebastien Guiriec 
330e73f3de5SRussell King 	platform->debugfs_platform_root = soc_debugfs_create_dir(debugfs_card_root,
331211bcc6cSMark Brown 						"platform:%s",
332211bcc6cSMark Brown 						platform->component.name);
333731f1ab2SSebastien Guiriec 	if (!platform->debugfs_platform_root) {
334731f1ab2SSebastien Guiriec 		dev_warn(platform->dev,
335f110bfc7SLiam Girdwood 			"ASoC: Failed to create platform debugfs directory\n");
336731f1ab2SSebastien Guiriec 		return;
337731f1ab2SSebastien Guiriec 	}
338731f1ab2SSebastien Guiriec 
339bc9af9faSLars-Peter Clausen 	snd_soc_dapm_debugfs_init(&platform->component.dapm,
340731f1ab2SSebastien Guiriec 		platform->debugfs_platform_root);
341731f1ab2SSebastien Guiriec }
342731f1ab2SSebastien Guiriec 
343731f1ab2SSebastien Guiriec static void soc_cleanup_platform_debugfs(struct snd_soc_platform *platform)
344731f1ab2SSebastien Guiriec {
345731f1ab2SSebastien Guiriec 	debugfs_remove_recursive(platform->debugfs_platform_root);
346731f1ab2SSebastien Guiriec }
347731f1ab2SSebastien Guiriec 
348c3c5a19aSMark Brown static ssize_t codec_list_read_file(struct file *file, char __user *user_buf,
349c3c5a19aSMark Brown 				    size_t count, loff_t *ppos)
350c3c5a19aSMark Brown {
351c3c5a19aSMark Brown 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
3522b194f9dSMark Brown 	ssize_t len, ret = 0;
353c3c5a19aSMark Brown 	struct snd_soc_codec *codec;
354c3c5a19aSMark Brown 
355c3c5a19aSMark Brown 	if (!buf)
356c3c5a19aSMark Brown 		return -ENOMEM;
357c3c5a19aSMark Brown 
3582b194f9dSMark Brown 	list_for_each_entry(codec, &codec_list, list) {
3592b194f9dSMark Brown 		len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
360f4333203SLars-Peter Clausen 			       codec->component.name);
3612b194f9dSMark Brown 		if (len >= 0)
3622b194f9dSMark Brown 			ret += len;
3632b194f9dSMark Brown 		if (ret > PAGE_SIZE) {
3642b194f9dSMark Brown 			ret = PAGE_SIZE;
3652b194f9dSMark Brown 			break;
3662b194f9dSMark Brown 		}
3672b194f9dSMark Brown 	}
368c3c5a19aSMark Brown 
369c3c5a19aSMark Brown 	if (ret >= 0)
370c3c5a19aSMark Brown 		ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
371c3c5a19aSMark Brown 
372c3c5a19aSMark Brown 	kfree(buf);
373c3c5a19aSMark Brown 
374c3c5a19aSMark Brown 	return ret;
375c3c5a19aSMark Brown }
376c3c5a19aSMark Brown 
377c3c5a19aSMark Brown static const struct file_operations codec_list_fops = {
378c3c5a19aSMark Brown 	.read = codec_list_read_file,
379c3c5a19aSMark Brown 	.llseek = default_llseek,/* read accesses f_pos */
380c3c5a19aSMark Brown };
381c3c5a19aSMark Brown 
382f3208780SMark Brown static ssize_t dai_list_read_file(struct file *file, char __user *user_buf,
383f3208780SMark Brown 				  size_t count, loff_t *ppos)
384f3208780SMark Brown {
385f3208780SMark Brown 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
3862b194f9dSMark Brown 	ssize_t len, ret = 0;
3871438c2f6SLars-Peter Clausen 	struct snd_soc_component *component;
388f3208780SMark Brown 	struct snd_soc_dai *dai;
389f3208780SMark Brown 
390f3208780SMark Brown 	if (!buf)
391f3208780SMark Brown 		return -ENOMEM;
392f3208780SMark Brown 
3931438c2f6SLars-Peter Clausen 	list_for_each_entry(component, &component_list, list) {
3941438c2f6SLars-Peter Clausen 		list_for_each_entry(dai, &component->dai_list, list) {
3951438c2f6SLars-Peter Clausen 			len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
3961438c2f6SLars-Peter Clausen 				dai->name);
3972b194f9dSMark Brown 			if (len >= 0)
3982b194f9dSMark Brown 				ret += len;
3992b194f9dSMark Brown 			if (ret > PAGE_SIZE) {
4002b194f9dSMark Brown 				ret = PAGE_SIZE;
4012b194f9dSMark Brown 				break;
4022b194f9dSMark Brown 			}
4032b194f9dSMark Brown 		}
4041438c2f6SLars-Peter Clausen 	}
405f3208780SMark Brown 
406f3208780SMark Brown 	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
407f3208780SMark Brown 
408f3208780SMark Brown 	kfree(buf);
409f3208780SMark Brown 
410f3208780SMark Brown 	return ret;
411f3208780SMark Brown }
412f3208780SMark Brown 
413f3208780SMark Brown static const struct file_operations dai_list_fops = {
414f3208780SMark Brown 	.read = dai_list_read_file,
415f3208780SMark Brown 	.llseek = default_llseek,/* read accesses f_pos */
416f3208780SMark Brown };
417f3208780SMark Brown 
41819c7ac27SMark Brown static ssize_t platform_list_read_file(struct file *file,
41919c7ac27SMark Brown 				       char __user *user_buf,
42019c7ac27SMark Brown 				       size_t count, loff_t *ppos)
42119c7ac27SMark Brown {
42219c7ac27SMark Brown 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
4232b194f9dSMark Brown 	ssize_t len, ret = 0;
42419c7ac27SMark Brown 	struct snd_soc_platform *platform;
42519c7ac27SMark Brown 
42619c7ac27SMark Brown 	if (!buf)
42719c7ac27SMark Brown 		return -ENOMEM;
42819c7ac27SMark Brown 
4292b194f9dSMark Brown 	list_for_each_entry(platform, &platform_list, list) {
4302b194f9dSMark Brown 		len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
431f4333203SLars-Peter Clausen 			       platform->component.name);
4322b194f9dSMark Brown 		if (len >= 0)
4332b194f9dSMark Brown 			ret += len;
4342b194f9dSMark Brown 		if (ret > PAGE_SIZE) {
4352b194f9dSMark Brown 			ret = PAGE_SIZE;
4362b194f9dSMark Brown 			break;
4372b194f9dSMark Brown 		}
4382b194f9dSMark Brown 	}
43919c7ac27SMark Brown 
44019c7ac27SMark Brown 	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
44119c7ac27SMark Brown 
44219c7ac27SMark Brown 	kfree(buf);
44319c7ac27SMark Brown 
44419c7ac27SMark Brown 	return ret;
44519c7ac27SMark Brown }
44619c7ac27SMark Brown 
44719c7ac27SMark Brown static const struct file_operations platform_list_fops = {
44819c7ac27SMark Brown 	.read = platform_list_read_file,
44919c7ac27SMark Brown 	.llseek = default_llseek,/* read accesses f_pos */
45019c7ac27SMark Brown };
45119c7ac27SMark Brown 
452a6052154SJarkko Nikula static void soc_init_card_debugfs(struct snd_soc_card *card)
453a6052154SJarkko Nikula {
454a6052154SJarkko Nikula 	card->debugfs_card_root = debugfs_create_dir(card->name,
4558a9dab1aSMark Brown 						     snd_soc_debugfs_root);
4563a45b867SJarkko Nikula 	if (!card->debugfs_card_root) {
457a6052154SJarkko Nikula 		dev_warn(card->dev,
4587c08be84SLothar Waßmann 			 "ASoC: Failed to create card debugfs directory\n");
4593a45b867SJarkko Nikula 		return;
4603a45b867SJarkko Nikula 	}
4613a45b867SJarkko Nikula 
4623a45b867SJarkko Nikula 	card->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0644,
4633a45b867SJarkko Nikula 						    card->debugfs_card_root,
4643a45b867SJarkko Nikula 						    &card->pop_time);
4653a45b867SJarkko Nikula 	if (!card->debugfs_pop_time)
4663a45b867SJarkko Nikula 		dev_warn(card->dev,
467f110bfc7SLiam Girdwood 		       "ASoC: Failed to create pop time debugfs file\n");
468a6052154SJarkko Nikula }
469a6052154SJarkko Nikula 
470a6052154SJarkko Nikula static void soc_cleanup_card_debugfs(struct snd_soc_card *card)
471a6052154SJarkko Nikula {
472a6052154SJarkko Nikula 	debugfs_remove_recursive(card->debugfs_card_root);
473a6052154SJarkko Nikula }
474a6052154SJarkko Nikula 
4752624d5faSMark Brown #else
4762624d5faSMark Brown 
4772624d5faSMark Brown static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
4782624d5faSMark Brown {
4792624d5faSMark Brown }
4802624d5faSMark Brown 
4812624d5faSMark Brown static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
4822624d5faSMark Brown {
4832624d5faSMark Brown }
484b95fccbcSAxel Lin 
485731f1ab2SSebastien Guiriec static inline void soc_init_platform_debugfs(struct snd_soc_platform *platform)
486731f1ab2SSebastien Guiriec {
487731f1ab2SSebastien Guiriec }
488731f1ab2SSebastien Guiriec 
489731f1ab2SSebastien Guiriec static inline void soc_cleanup_platform_debugfs(struct snd_soc_platform *platform)
490731f1ab2SSebastien Guiriec {
491731f1ab2SSebastien Guiriec }
492731f1ab2SSebastien Guiriec 
493b95fccbcSAxel Lin static inline void soc_init_card_debugfs(struct snd_soc_card *card)
494b95fccbcSAxel Lin {
495b95fccbcSAxel Lin }
496b95fccbcSAxel Lin 
497b95fccbcSAxel Lin static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card)
498b95fccbcSAxel Lin {
499b95fccbcSAxel Lin }
5002624d5faSMark Brown #endif
5012624d5faSMark Brown 
50247c88fffSLiam Girdwood struct snd_pcm_substream *snd_soc_get_dai_substream(struct snd_soc_card *card,
50347c88fffSLiam Girdwood 		const char *dai_link, int stream)
50447c88fffSLiam Girdwood {
50547c88fffSLiam Girdwood 	int i;
50647c88fffSLiam Girdwood 
50747c88fffSLiam Girdwood 	for (i = 0; i < card->num_links; i++) {
50847c88fffSLiam Girdwood 		if (card->rtd[i].dai_link->no_pcm &&
50947c88fffSLiam Girdwood 			!strcmp(card->rtd[i].dai_link->name, dai_link))
51047c88fffSLiam Girdwood 			return card->rtd[i].pcm->streams[stream].substream;
51147c88fffSLiam Girdwood 	}
512f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: failed to find dai link %s\n", dai_link);
51347c88fffSLiam Girdwood 	return NULL;
51447c88fffSLiam Girdwood }
51547c88fffSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_get_dai_substream);
51647c88fffSLiam Girdwood 
51747c88fffSLiam Girdwood struct snd_soc_pcm_runtime *snd_soc_get_pcm_runtime(struct snd_soc_card *card,
51847c88fffSLiam Girdwood 		const char *dai_link)
51947c88fffSLiam Girdwood {
52047c88fffSLiam Girdwood 	int i;
52147c88fffSLiam Girdwood 
52247c88fffSLiam Girdwood 	for (i = 0; i < card->num_links; i++) {
52347c88fffSLiam Girdwood 		if (!strcmp(card->rtd[i].dai_link->name, dai_link))
52447c88fffSLiam Girdwood 			return &card->rtd[i];
52547c88fffSLiam Girdwood 	}
526f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: failed to find rtd %s\n", dai_link);
52747c88fffSLiam Girdwood 	return NULL;
52847c88fffSLiam Girdwood }
52947c88fffSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_get_pcm_runtime);
53047c88fffSLiam Girdwood 
531db2a4165SFrank Mandarino #ifdef CONFIG_SND_SOC_AC97_BUS
532db2a4165SFrank Mandarino /* unregister ac97 codec */
533db2a4165SFrank Mandarino static int soc_ac97_dev_unregister(struct snd_soc_codec *codec)
534db2a4165SFrank Mandarino {
535db2a4165SFrank Mandarino 	if (codec->ac97->dev.bus)
536db2a4165SFrank Mandarino 		device_unregister(&codec->ac97->dev);
537db2a4165SFrank Mandarino 	return 0;
538db2a4165SFrank Mandarino }
539db2a4165SFrank Mandarino 
540db2a4165SFrank Mandarino /* stop no dev release warning */
541db2a4165SFrank Mandarino static void soc_ac97_device_release(struct device *dev){}
542db2a4165SFrank Mandarino 
543db2a4165SFrank Mandarino /* register ac97 codec to bus */
544db2a4165SFrank Mandarino static int soc_ac97_dev_register(struct snd_soc_codec *codec)
545db2a4165SFrank Mandarino {
546db2a4165SFrank Mandarino 	int err;
547db2a4165SFrank Mandarino 
548db2a4165SFrank Mandarino 	codec->ac97->dev.bus = &ac97_bus_type;
5494ac5c61fSMark Brown 	codec->ac97->dev.parent = codec->card->dev;
550db2a4165SFrank Mandarino 	codec->ac97->dev.release = soc_ac97_device_release;
551db2a4165SFrank Mandarino 
552bb072bf0SKay Sievers 	dev_set_name(&codec->ac97->dev, "%d-%d:%s",
553f4333203SLars-Peter Clausen 		     codec->card->snd_card->number, 0, codec->component.name);
554db2a4165SFrank Mandarino 	err = device_register(&codec->ac97->dev);
555db2a4165SFrank Mandarino 	if (err < 0) {
556f110bfc7SLiam Girdwood 		dev_err(codec->dev, "ASoC: Can't register ac97 bus\n");
557db2a4165SFrank Mandarino 		codec->ac97->dev.bus = NULL;
558db2a4165SFrank Mandarino 		return err;
559db2a4165SFrank Mandarino 	}
560db2a4165SFrank Mandarino 	return 0;
561db2a4165SFrank Mandarino }
562db2a4165SFrank Mandarino #endif
563db2a4165SFrank Mandarino 
5649d58a077SRichard Fitzgerald static void codec2codec_close_delayed_work(struct work_struct *work)
5659d58a077SRichard Fitzgerald {
5669d58a077SRichard Fitzgerald 	/* Currently nothing to do for c2c links
5679d58a077SRichard Fitzgerald 	 * Since c2c links are internal nodes in the DAPM graph and
5689d58a077SRichard Fitzgerald 	 * don't interface with the outside world or application layer
5699d58a077SRichard Fitzgerald 	 * we don't have to do any special handling on close.
5709d58a077SRichard Fitzgerald 	 */
5719d58a077SRichard Fitzgerald }
5729d58a077SRichard Fitzgerald 
5736f8ab4acSMark Brown #ifdef CONFIG_PM_SLEEP
574db2a4165SFrank Mandarino /* powers down audio subsystem for suspend */
5756f8ab4acSMark Brown int snd_soc_suspend(struct device *dev)
576db2a4165SFrank Mandarino {
5776f8ab4acSMark Brown 	struct snd_soc_card *card = dev_get_drvdata(dev);
5782eea392dSJarkko Nikula 	struct snd_soc_codec *codec;
579db2a4165SFrank Mandarino 	int i;
580db2a4165SFrank Mandarino 
581e3509ff0SDaniel Mack 	/* If the initialization of this soc device failed, there is no codec
582e3509ff0SDaniel Mack 	 * associated with it. Just bail out in this case.
583e3509ff0SDaniel Mack 	 */
584f0fba2adSLiam Girdwood 	if (list_empty(&card->codec_dev_list))
585e3509ff0SDaniel Mack 		return 0;
586e3509ff0SDaniel Mack 
5876ed25978SAndy Green 	/* Due to the resume being scheduled into a workqueue we could
5886ed25978SAndy Green 	* suspend before that's finished - wait for it to complete.
5896ed25978SAndy Green 	 */
590f0fba2adSLiam Girdwood 	snd_power_lock(card->snd_card);
591f0fba2adSLiam Girdwood 	snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0);
592f0fba2adSLiam Girdwood 	snd_power_unlock(card->snd_card);
5936ed25978SAndy Green 
5946ed25978SAndy Green 	/* we're going to block userspace touching us until resume completes */
595f0fba2adSLiam Girdwood 	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
5966ed25978SAndy Green 
597a00f90f9SMark Brown 	/* mute any active DACs */
598f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
599f0fba2adSLiam Girdwood 		struct snd_soc_dai *dai = card->rtd[i].codec_dai;
600f0fba2adSLiam Girdwood 		struct snd_soc_dai_driver *drv = dai->driver;
6013efab7dcSMark Brown 
602f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
6033efab7dcSMark Brown 			continue;
6043efab7dcSMark Brown 
605f0fba2adSLiam Girdwood 		if (drv->ops->digital_mute && dai->playback_active)
606f0fba2adSLiam Girdwood 			drv->ops->digital_mute(dai, 1);
607db2a4165SFrank Mandarino 	}
608db2a4165SFrank Mandarino 
6094ccab3e7SLiam Girdwood 	/* suspend all pcms */
610f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
611f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
6123efab7dcSMark Brown 			continue;
6133efab7dcSMark Brown 
614f0fba2adSLiam Girdwood 		snd_pcm_suspend_all(card->rtd[i].pcm);
6153efab7dcSMark Brown 	}
6164ccab3e7SLiam Girdwood 
61787506549SMark Brown 	if (card->suspend_pre)
61870b2ac12SMark Brown 		card->suspend_pre(card);
619db2a4165SFrank Mandarino 
620f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
621f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
622f0fba2adSLiam Girdwood 		struct snd_soc_platform *platform = card->rtd[i].platform;
6233efab7dcSMark Brown 
624f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
6253efab7dcSMark Brown 			continue;
6263efab7dcSMark Brown 
627f0fba2adSLiam Girdwood 		if (cpu_dai->driver->suspend && !cpu_dai->driver->ac97_control)
628f0fba2adSLiam Girdwood 			cpu_dai->driver->suspend(cpu_dai);
629f0fba2adSLiam Girdwood 		if (platform->driver->suspend && !platform->suspended) {
630f0fba2adSLiam Girdwood 			platform->driver->suspend(cpu_dai);
631f0fba2adSLiam Girdwood 			platform->suspended = 1;
632f0fba2adSLiam Girdwood 		}
633db2a4165SFrank Mandarino 	}
634db2a4165SFrank Mandarino 
635db2a4165SFrank Mandarino 	/* close any waiting streams and save state */
636f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
63743829731STejun Heo 		flush_delayed_work(&card->rtd[i].delayed_work);
638ce6120ccSLiam Girdwood 		card->rtd[i].codec->dapm.suspend_bias_level = card->rtd[i].codec->dapm.bias_level;
639f0fba2adSLiam Girdwood 	}
640db2a4165SFrank Mandarino 
641f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
6423efab7dcSMark Brown 
643f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
6443efab7dcSMark Brown 			continue;
6453efab7dcSMark Brown 
6467bd3a6f3SMark Brown 		snd_soc_dapm_stream_event(&card->rtd[i],
6477bd3a6f3SMark Brown 					  SNDRV_PCM_STREAM_PLAYBACK,
648db2a4165SFrank Mandarino 					  SND_SOC_DAPM_STREAM_SUSPEND);
649f0fba2adSLiam Girdwood 
6507bd3a6f3SMark Brown 		snd_soc_dapm_stream_event(&card->rtd[i],
6517bd3a6f3SMark Brown 					  SNDRV_PCM_STREAM_CAPTURE,
652db2a4165SFrank Mandarino 					  SND_SOC_DAPM_STREAM_SUSPEND);
653db2a4165SFrank Mandarino 	}
654db2a4165SFrank Mandarino 
655e2d32ff6SMark Brown 	/* Recheck all analogue paths too */
656e2d32ff6SMark Brown 	dapm_mark_io_dirty(&card->dapm);
657e2d32ff6SMark Brown 	snd_soc_dapm_sync(&card->dapm);
658e2d32ff6SMark Brown 
659f0fba2adSLiam Girdwood 	/* suspend all CODECs */
6602eea392dSJarkko Nikula 	list_for_each_entry(codec, &card->codec_dev_list, card_list) {
6611547aba9SMark Brown 		/* If there are paths active then the CODEC will be held with
6621547aba9SMark Brown 		 * bias _ON and should not be suspended. */
663f0fba2adSLiam Girdwood 		if (!codec->suspended && codec->driver->suspend) {
664ce6120ccSLiam Girdwood 			switch (codec->dapm.bias_level) {
6651547aba9SMark Brown 			case SND_SOC_BIAS_STANDBY:
666125a25daSMark Brown 				/*
667125a25daSMark Brown 				 * If the CODEC is capable of idle
668125a25daSMark Brown 				 * bias off then being in STANDBY
669125a25daSMark Brown 				 * means it's doing something,
670125a25daSMark Brown 				 * otherwise fall through.
671125a25daSMark Brown 				 */
672125a25daSMark Brown 				if (codec->dapm.idle_bias_off) {
673125a25daSMark Brown 					dev_dbg(codec->dev,
67410e8aa9aSMichał Mirosław 						"ASoC: idle_bias_off CODEC on over suspend\n");
675125a25daSMark Brown 					break;
676125a25daSMark Brown 				}
6771547aba9SMark Brown 			case SND_SOC_BIAS_OFF:
67884b315eeSLars-Peter Clausen 				codec->driver->suspend(codec);
679f0fba2adSLiam Girdwood 				codec->suspended = 1;
6807be4ba24SMark Brown 				codec->cache_sync = 1;
681e2c330b9SLars-Peter Clausen 				if (codec->component.regmap)
682e2c330b9SLars-Peter Clausen 					regcache_mark_dirty(codec->component.regmap);
683988e8cc4SNicolin Chen 				/* deactivate pins to sleep state */
684988e8cc4SNicolin Chen 				pinctrl_pm_select_sleep_state(codec->dev);
6851547aba9SMark Brown 				break;
6861547aba9SMark Brown 			default:
68710e8aa9aSMichał Mirosław 				dev_dbg(codec->dev,
68810e8aa9aSMichał Mirosław 					"ASoC: CODEC is on over suspend\n");
6891547aba9SMark Brown 				break;
6901547aba9SMark Brown 			}
6911547aba9SMark Brown 		}
692f0fba2adSLiam Girdwood 	}
693db2a4165SFrank Mandarino 
694f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
695f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
6963efab7dcSMark Brown 
697f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
6983efab7dcSMark Brown 			continue;
6993efab7dcSMark Brown 
700f0fba2adSLiam Girdwood 		if (cpu_dai->driver->suspend && cpu_dai->driver->ac97_control)
701f0fba2adSLiam Girdwood 			cpu_dai->driver->suspend(cpu_dai);
702988e8cc4SNicolin Chen 
703988e8cc4SNicolin Chen 		/* deactivate pins to sleep state */
704988e8cc4SNicolin Chen 		pinctrl_pm_select_sleep_state(cpu_dai->dev);
705db2a4165SFrank Mandarino 	}
706db2a4165SFrank Mandarino 
70787506549SMark Brown 	if (card->suspend_post)
70870b2ac12SMark Brown 		card->suspend_post(card);
709db2a4165SFrank Mandarino 
710db2a4165SFrank Mandarino 	return 0;
711db2a4165SFrank Mandarino }
7126f8ab4acSMark Brown EXPORT_SYMBOL_GPL(snd_soc_suspend);
713db2a4165SFrank Mandarino 
7146ed25978SAndy Green /* deferred resume work, so resume can complete before we finished
7156ed25978SAndy Green  * setting our codec back up, which can be very slow on I2C
7166ed25978SAndy Green  */
7176ed25978SAndy Green static void soc_resume_deferred(struct work_struct *work)
718db2a4165SFrank Mandarino {
719f0fba2adSLiam Girdwood 	struct snd_soc_card *card =
720f0fba2adSLiam Girdwood 			container_of(work, struct snd_soc_card, deferred_resume_work);
7212eea392dSJarkko Nikula 	struct snd_soc_codec *codec;
722db2a4165SFrank Mandarino 	int i;
723db2a4165SFrank Mandarino 
7246ed25978SAndy Green 	/* our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
7256ed25978SAndy Green 	 * so userspace apps are blocked from touching us
7266ed25978SAndy Green 	 */
7276ed25978SAndy Green 
728f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: starting resume work\n");
7296ed25978SAndy Green 
7309949788bSMark Brown 	/* Bring us up into D2 so that DAPM starts enabling things */
731f0fba2adSLiam Girdwood 	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
7329949788bSMark Brown 
73387506549SMark Brown 	if (card->resume_pre)
73470b2ac12SMark Brown 		card->resume_pre(card);
735db2a4165SFrank Mandarino 
736f0fba2adSLiam Girdwood 	/* resume AC97 DAIs */
737f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
738f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
7393efab7dcSMark Brown 
740f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
7413efab7dcSMark Brown 			continue;
7423efab7dcSMark Brown 
743f0fba2adSLiam Girdwood 		if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control)
744f0fba2adSLiam Girdwood 			cpu_dai->driver->resume(cpu_dai);
745db2a4165SFrank Mandarino 	}
746db2a4165SFrank Mandarino 
7472eea392dSJarkko Nikula 	list_for_each_entry(codec, &card->codec_dev_list, card_list) {
7481547aba9SMark Brown 		/* If the CODEC was idle over suspend then it will have been
7491547aba9SMark Brown 		 * left with bias OFF or STANDBY and suspended so we must now
7501547aba9SMark Brown 		 * resume.  Otherwise the suspend was suppressed.
7511547aba9SMark Brown 		 */
752f0fba2adSLiam Girdwood 		if (codec->driver->resume && codec->suspended) {
753ce6120ccSLiam Girdwood 			switch (codec->dapm.bias_level) {
7541547aba9SMark Brown 			case SND_SOC_BIAS_STANDBY:
7551547aba9SMark Brown 			case SND_SOC_BIAS_OFF:
756f0fba2adSLiam Girdwood 				codec->driver->resume(codec);
757f0fba2adSLiam Girdwood 				codec->suspended = 0;
7581547aba9SMark Brown 				break;
7591547aba9SMark Brown 			default:
76010e8aa9aSMichał Mirosław 				dev_dbg(codec->dev,
76110e8aa9aSMichał Mirosław 					"ASoC: CODEC was on over suspend\n");
7621547aba9SMark Brown 				break;
7631547aba9SMark Brown 			}
7641547aba9SMark Brown 		}
765f0fba2adSLiam Girdwood 	}
766db2a4165SFrank Mandarino 
767f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
7683efab7dcSMark Brown 
769f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
7703efab7dcSMark Brown 			continue;
7713efab7dcSMark Brown 
7727bd3a6f3SMark Brown 		snd_soc_dapm_stream_event(&card->rtd[i],
773d9b0951bSLiam Girdwood 					  SNDRV_PCM_STREAM_PLAYBACK,
774db2a4165SFrank Mandarino 					  SND_SOC_DAPM_STREAM_RESUME);
775f0fba2adSLiam Girdwood 
7767bd3a6f3SMark Brown 		snd_soc_dapm_stream_event(&card->rtd[i],
777d9b0951bSLiam Girdwood 					  SNDRV_PCM_STREAM_CAPTURE,
778db2a4165SFrank Mandarino 					  SND_SOC_DAPM_STREAM_RESUME);
779db2a4165SFrank Mandarino 	}
780db2a4165SFrank Mandarino 
7813ff3f64bSMark Brown 	/* unmute any active DACs */
782f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
783f0fba2adSLiam Girdwood 		struct snd_soc_dai *dai = card->rtd[i].codec_dai;
784f0fba2adSLiam Girdwood 		struct snd_soc_dai_driver *drv = dai->driver;
7853efab7dcSMark Brown 
786f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
7873efab7dcSMark Brown 			continue;
7883efab7dcSMark Brown 
789f0fba2adSLiam Girdwood 		if (drv->ops->digital_mute && dai->playback_active)
790f0fba2adSLiam Girdwood 			drv->ops->digital_mute(dai, 0);
791db2a4165SFrank Mandarino 	}
792db2a4165SFrank Mandarino 
793f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
794f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
795f0fba2adSLiam Girdwood 		struct snd_soc_platform *platform = card->rtd[i].platform;
7963efab7dcSMark Brown 
797f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
7983efab7dcSMark Brown 			continue;
7993efab7dcSMark Brown 
800f0fba2adSLiam Girdwood 		if (cpu_dai->driver->resume && !cpu_dai->driver->ac97_control)
801f0fba2adSLiam Girdwood 			cpu_dai->driver->resume(cpu_dai);
802f0fba2adSLiam Girdwood 		if (platform->driver->resume && platform->suspended) {
803f0fba2adSLiam Girdwood 			platform->driver->resume(cpu_dai);
804f0fba2adSLiam Girdwood 			platform->suspended = 0;
805f0fba2adSLiam Girdwood 		}
806db2a4165SFrank Mandarino 	}
807db2a4165SFrank Mandarino 
80887506549SMark Brown 	if (card->resume_post)
80970b2ac12SMark Brown 		card->resume_post(card);
810db2a4165SFrank Mandarino 
811f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: resume work completed\n");
8126ed25978SAndy Green 
8136ed25978SAndy Green 	/* userspace can access us now we are back as we were before */
814f0fba2adSLiam Girdwood 	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
815e2d32ff6SMark Brown 
816e2d32ff6SMark Brown 	/* Recheck all analogue paths too */
817e2d32ff6SMark Brown 	dapm_mark_io_dirty(&card->dapm);
818e2d32ff6SMark Brown 	snd_soc_dapm_sync(&card->dapm);
8196ed25978SAndy Green }
8206ed25978SAndy Green 
8216ed25978SAndy Green /* powers up audio subsystem after a suspend */
8226f8ab4acSMark Brown int snd_soc_resume(struct device *dev)
8236ed25978SAndy Green {
8246f8ab4acSMark Brown 	struct snd_soc_card *card = dev_get_drvdata(dev);
82582e14e8bSStephen Warren 	int i, ac97_control = 0;
826b9dd94a8SPeter Ujfalusi 
8275ff1ddf2SEric Miao 	/* If the initialization of this soc device failed, there is no codec
8285ff1ddf2SEric Miao 	 * associated with it. Just bail out in this case.
8295ff1ddf2SEric Miao 	 */
8305ff1ddf2SEric Miao 	if (list_empty(&card->codec_dev_list))
8315ff1ddf2SEric Miao 		return 0;
8325ff1ddf2SEric Miao 
833988e8cc4SNicolin Chen 	/* activate pins from sleep state */
834988e8cc4SNicolin Chen 	for (i = 0; i < card->num_rtd; i++) {
835988e8cc4SNicolin Chen 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
836988e8cc4SNicolin Chen 		struct snd_soc_dai *codec_dai = card->rtd[i].codec_dai;
837988e8cc4SNicolin Chen 		if (cpu_dai->active)
838988e8cc4SNicolin Chen 			pinctrl_pm_select_default_state(cpu_dai->dev);
839988e8cc4SNicolin Chen 		if (codec_dai->active)
840988e8cc4SNicolin Chen 			pinctrl_pm_select_default_state(codec_dai->dev);
841988e8cc4SNicolin Chen 	}
842988e8cc4SNicolin Chen 
84364ab9baaSMark Brown 	/* AC97 devices might have other drivers hanging off them so
84464ab9baaSMark Brown 	 * need to resume immediately.  Other drivers don't have that
84564ab9baaSMark Brown 	 * problem and may take a substantial amount of time to resume
84664ab9baaSMark Brown 	 * due to I/O costs and anti-pop so handle them out of line.
84764ab9baaSMark Brown 	 */
848f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
849f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
85082e14e8bSStephen Warren 		ac97_control |= cpu_dai->driver->ac97_control;
85182e14e8bSStephen Warren 	}
85282e14e8bSStephen Warren 	if (ac97_control) {
853f110bfc7SLiam Girdwood 		dev_dbg(dev, "ASoC: Resuming AC97 immediately\n");
85464ab9baaSMark Brown 		soc_resume_deferred(&card->deferred_resume_work);
85564ab9baaSMark Brown 	} else {
856f110bfc7SLiam Girdwood 		dev_dbg(dev, "ASoC: Scheduling resume work\n");
8576308419aSMark Brown 		if (!schedule_work(&card->deferred_resume_work))
858f110bfc7SLiam Girdwood 			dev_err(dev, "ASoC: resume work item may be lost\n");
859f0fba2adSLiam Girdwood 	}
8606ed25978SAndy Green 
861db2a4165SFrank Mandarino 	return 0;
862db2a4165SFrank Mandarino }
8636f8ab4acSMark Brown EXPORT_SYMBOL_GPL(snd_soc_resume);
864db2a4165SFrank Mandarino #else
8656f8ab4acSMark Brown #define snd_soc_suspend NULL
8666f8ab4acSMark Brown #define snd_soc_resume NULL
867db2a4165SFrank Mandarino #endif
868db2a4165SFrank Mandarino 
86985e7652dSLars-Peter Clausen static const struct snd_soc_dai_ops null_dai_ops = {
87002a06d30SBarry Song };
87102a06d30SBarry Song 
87212023a9aSMisael Lopez Cruz static struct snd_soc_codec *soc_find_codec(const struct device_node *codec_of_node,
87312023a9aSMisael Lopez Cruz 					    const char *codec_name)
87412023a9aSMisael Lopez Cruz {
87512023a9aSMisael Lopez Cruz 	struct snd_soc_codec *codec;
87612023a9aSMisael Lopez Cruz 
87712023a9aSMisael Lopez Cruz 	list_for_each_entry(codec, &codec_list, list) {
87812023a9aSMisael Lopez Cruz 		if (codec_of_node) {
87912023a9aSMisael Lopez Cruz 			if (codec->dev->of_node != codec_of_node)
88012023a9aSMisael Lopez Cruz 				continue;
88112023a9aSMisael Lopez Cruz 		} else {
882f4333203SLars-Peter Clausen 			if (strcmp(codec->component.name, codec_name))
88312023a9aSMisael Lopez Cruz 				continue;
88412023a9aSMisael Lopez Cruz 		}
88512023a9aSMisael Lopez Cruz 
88612023a9aSMisael Lopez Cruz 		return codec;
88712023a9aSMisael Lopez Cruz 	}
88812023a9aSMisael Lopez Cruz 
88912023a9aSMisael Lopez Cruz 	return NULL;
89012023a9aSMisael Lopez Cruz }
89112023a9aSMisael Lopez Cruz 
89212023a9aSMisael Lopez Cruz static struct snd_soc_dai *soc_find_codec_dai(struct snd_soc_codec *codec,
89312023a9aSMisael Lopez Cruz 					      const char *codec_dai_name)
89412023a9aSMisael Lopez Cruz {
89512023a9aSMisael Lopez Cruz 	struct snd_soc_dai *codec_dai;
89612023a9aSMisael Lopez Cruz 
89712023a9aSMisael Lopez Cruz 	list_for_each_entry(codec_dai, &codec->component.dai_list, list) {
89812023a9aSMisael Lopez Cruz 		if (!strcmp(codec_dai->name, codec_dai_name)) {
89912023a9aSMisael Lopez Cruz 			return codec_dai;
90012023a9aSMisael Lopez Cruz 		}
90112023a9aSMisael Lopez Cruz 	}
90212023a9aSMisael Lopez Cruz 
90312023a9aSMisael Lopez Cruz 	return NULL;
90412023a9aSMisael Lopez Cruz }
90512023a9aSMisael Lopez Cruz 
906f0fba2adSLiam Girdwood static int soc_bind_dai_link(struct snd_soc_card *card, int num)
907db2a4165SFrank Mandarino {
908f0fba2adSLiam Girdwood 	struct snd_soc_dai_link *dai_link = &card->dai_link[num];
909f0fba2adSLiam Girdwood 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
9101438c2f6SLars-Peter Clausen 	struct snd_soc_component *component;
911435c5e25SMark Brown 	struct snd_soc_platform *platform;
91212023a9aSMisael Lopez Cruz 	struct snd_soc_dai *cpu_dai;
913848dd8beSMark Brown 	const char *platform_name;
914db2a4165SFrank Mandarino 
915f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: binding %s at idx %d\n", dai_link->name, num);
9166308419aSMark Brown 
917b19e6e7bSMark Brown 	/* Find CPU DAI from registered DAIs*/
9181438c2f6SLars-Peter Clausen 	list_for_each_entry(component, &component_list, list) {
919bc92657aSStephen Warren 		if (dai_link->cpu_of_node &&
9201438c2f6SLars-Peter Clausen 			component->dev->of_node != dai_link->cpu_of_node)
9215a504963SStephen Warren 			continue;
922bc92657aSStephen Warren 		if (dai_link->cpu_name &&
9231438c2f6SLars-Peter Clausen 			strcmp(dev_name(component->dev), dai_link->cpu_name))
9242610ab77SStephen Warren 			continue;
9251438c2f6SLars-Peter Clausen 		list_for_each_entry(cpu_dai, &component->dai_list, list) {
926bc92657aSStephen Warren 			if (dai_link->cpu_dai_name &&
927bc92657aSStephen Warren 				strcmp(cpu_dai->name, dai_link->cpu_dai_name))
928bc92657aSStephen Warren 				continue;
9292610ab77SStephen Warren 
930f0fba2adSLiam Girdwood 			rtd->cpu_dai = cpu_dai;
931f0fba2adSLiam Girdwood 		}
9321438c2f6SLars-Peter Clausen 	}
933b19e6e7bSMark Brown 
934b19e6e7bSMark Brown 	if (!rtd->cpu_dai) {
935f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: CPU DAI %s not registered\n",
936f0fba2adSLiam Girdwood 			dai_link->cpu_dai_name);
937b19e6e7bSMark Brown 		return -EPROBE_DEFER;
938c5af3a2eSMark Brown 	}
939c5af3a2eSMark Brown 
94012023a9aSMisael Lopez Cruz 	/* Find CODEC from registered list */
94112023a9aSMisael Lopez Cruz 	rtd->codec = soc_find_codec(dai_link->codec_of_node,
94212023a9aSMisael Lopez Cruz 				    dai_link->codec_name);
943b19e6e7bSMark Brown 	if (!rtd->codec) {
944f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: CODEC %s not registered\n",
945f0fba2adSLiam Girdwood 			dai_link->codec_name);
946b19e6e7bSMark Brown 		return -EPROBE_DEFER;
947b19e6e7bSMark Brown 	}
948848dd8beSMark Brown 
94912023a9aSMisael Lopez Cruz 	/* Find CODEC DAI from registered list */
95012023a9aSMisael Lopez Cruz 	rtd->codec_dai = soc_find_codec_dai(rtd->codec,
95112023a9aSMisael Lopez Cruz 					    dai_link->codec_dai_name);
95212023a9aSMisael Lopez Cruz 	if (!rtd->codec_dai) {
95312023a9aSMisael Lopez Cruz 		dev_err(card->dev, "ASoC: CODEC DAI %s not registered\n",
95412023a9aSMisael Lopez Cruz 			dai_link->codec_dai_name);
95512023a9aSMisael Lopez Cruz 		return -EPROBE_DEFER;
95612023a9aSMisael Lopez Cruz 	}
95712023a9aSMisael Lopez Cruz 
958848dd8beSMark Brown 	/* if there's no platform we match on the empty platform */
959848dd8beSMark Brown 	platform_name = dai_link->platform_name;
9605a504963SStephen Warren 	if (!platform_name && !dai_link->platform_of_node)
961848dd8beSMark Brown 		platform_name = "snd-soc-dummy";
962848dd8beSMark Brown 
963b19e6e7bSMark Brown 	/* find one from the set of registered platforms */
964f0fba2adSLiam Girdwood 	list_for_each_entry(platform, &platform_list, list) {
9655a504963SStephen Warren 		if (dai_link->platform_of_node) {
9665a504963SStephen Warren 			if (platform->dev->of_node !=
9675a504963SStephen Warren 			    dai_link->platform_of_node)
9685a504963SStephen Warren 				continue;
9695a504963SStephen Warren 		} else {
970f4333203SLars-Peter Clausen 			if (strcmp(platform->component.name, platform_name))
9712610ab77SStephen Warren 				continue;
9725a504963SStephen Warren 		}
9732610ab77SStephen Warren 
974f0fba2adSLiam Girdwood 		rtd->platform = platform;
975f0fba2adSLiam Girdwood 	}
976b19e6e7bSMark Brown 	if (!rtd->platform) {
977f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: platform %s not registered\n",
978f0fba2adSLiam Girdwood 			dai_link->platform_name);
979b19e6e7bSMark Brown 		return -EPROBE_DEFER;
980f0fba2adSLiam Girdwood 	}
981b19e6e7bSMark Brown 
982b19e6e7bSMark Brown 	card->num_rtd++;
983b19e6e7bSMark Brown 
984b19e6e7bSMark Brown 	return 0;
9856b05eda6SMark Brown }
9866b05eda6SMark Brown 
987d12cd198SStephen Warren static int soc_remove_platform(struct snd_soc_platform *platform)
988d12cd198SStephen Warren {
989d12cd198SStephen Warren 	int ret;
990d12cd198SStephen Warren 
991d12cd198SStephen Warren 	if (platform->driver->remove) {
992d12cd198SStephen Warren 		ret = platform->driver->remove(platform);
993d12cd198SStephen Warren 		if (ret < 0)
994f110bfc7SLiam Girdwood 			dev_err(platform->dev, "ASoC: failed to remove %d\n",
995f110bfc7SLiam Girdwood 				ret);
996d12cd198SStephen Warren 	}
997d12cd198SStephen Warren 
998d12cd198SStephen Warren 	/* Make sure all DAPM widgets are freed */
999bc9af9faSLars-Peter Clausen 	snd_soc_dapm_free(&platform->component.dapm);
1000d12cd198SStephen Warren 
1001d12cd198SStephen Warren 	soc_cleanup_platform_debugfs(platform);
1002d12cd198SStephen Warren 	platform->probed = 0;
1003d12cd198SStephen Warren 	list_del(&platform->card_list);
1004d12cd198SStephen Warren 	module_put(platform->dev->driver->owner);
1005d12cd198SStephen Warren 
1006d12cd198SStephen Warren 	return 0;
1007d12cd198SStephen Warren }
1008d12cd198SStephen Warren 
1009589c3563SJarkko Nikula static void soc_remove_codec(struct snd_soc_codec *codec)
1010589c3563SJarkko Nikula {
1011589c3563SJarkko Nikula 	int err;
1012589c3563SJarkko Nikula 
1013589c3563SJarkko Nikula 	if (codec->driver->remove) {
1014589c3563SJarkko Nikula 		err = codec->driver->remove(codec);
1015589c3563SJarkko Nikula 		if (err < 0)
1016f110bfc7SLiam Girdwood 			dev_err(codec->dev, "ASoC: failed to remove %d\n", err);
1017589c3563SJarkko Nikula 	}
1018589c3563SJarkko Nikula 
1019589c3563SJarkko Nikula 	/* Make sure all DAPM widgets are freed */
1020589c3563SJarkko Nikula 	snd_soc_dapm_free(&codec->dapm);
1021589c3563SJarkko Nikula 
1022589c3563SJarkko Nikula 	soc_cleanup_codec_debugfs(codec);
1023589c3563SJarkko Nikula 	codec->probed = 0;
1024589c3563SJarkko Nikula 	list_del(&codec->card_list);
1025589c3563SJarkko Nikula 	module_put(codec->dev->driver->owner);
1026589c3563SJarkko Nikula }
1027589c3563SJarkko Nikula 
1028b0aa88afSMisael Lopez Cruz static void soc_remove_codec_dai(struct snd_soc_dai *codec_dai, int order)
1029b0aa88afSMisael Lopez Cruz {
1030b0aa88afSMisael Lopez Cruz 	int err;
1031b0aa88afSMisael Lopez Cruz 
1032b0aa88afSMisael Lopez Cruz 	if (codec_dai && codec_dai->probed &&
1033b0aa88afSMisael Lopez Cruz 			codec_dai->driver->remove_order == order) {
1034b0aa88afSMisael Lopez Cruz 		if (codec_dai->driver->remove) {
1035b0aa88afSMisael Lopez Cruz 			err = codec_dai->driver->remove(codec_dai);
1036b0aa88afSMisael Lopez Cruz 			if (err < 0)
1037b0aa88afSMisael Lopez Cruz 				dev_err(codec_dai->dev,
1038b0aa88afSMisael Lopez Cruz 					"ASoC: failed to remove %s: %d\n",
1039b0aa88afSMisael Lopez Cruz 					codec_dai->name, err);
1040b0aa88afSMisael Lopez Cruz 		}
1041b0aa88afSMisael Lopez Cruz 		codec_dai->probed = 0;
1042b0aa88afSMisael Lopez Cruz 	}
1043b0aa88afSMisael Lopez Cruz }
1044b0aa88afSMisael Lopez Cruz 
104562ae68faSStephen Warren static void soc_remove_link_dais(struct snd_soc_card *card, int num, int order)
1046f0fba2adSLiam Girdwood {
1047f0fba2adSLiam Girdwood 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1048f0fba2adSLiam Girdwood 	struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
1049f0fba2adSLiam Girdwood 	int err;
1050f0fba2adSLiam Girdwood 
1051f0fba2adSLiam Girdwood 	/* unregister the rtd device */
1052f0fba2adSLiam Girdwood 	if (rtd->dev_registered) {
105336ae1a96SMark Brown 		device_remove_file(rtd->dev, &dev_attr_pmdown_time);
105436ae1a96SMark Brown 		device_remove_file(rtd->dev, &dev_attr_codec_reg);
105536ae1a96SMark Brown 		device_unregister(rtd->dev);
1056f0fba2adSLiam Girdwood 		rtd->dev_registered = 0;
105702a06d30SBarry Song 	}
105802a06d30SBarry Song 
1059f0fba2adSLiam Girdwood 	/* remove the CODEC DAI */
1060b0aa88afSMisael Lopez Cruz 	soc_remove_codec_dai(codec_dai, order);
1061f0fba2adSLiam Girdwood 
1062f0fba2adSLiam Girdwood 	/* remove the cpu_dai */
10630168bf0dSLiam Girdwood 	if (cpu_dai && cpu_dai->probed &&
10640168bf0dSLiam Girdwood 			cpu_dai->driver->remove_order == order) {
1065f0fba2adSLiam Girdwood 		if (cpu_dai->driver->remove) {
1066f0fba2adSLiam Girdwood 			err = cpu_dai->driver->remove(cpu_dai);
1067f0fba2adSLiam Girdwood 			if (err < 0)
1068f110bfc7SLiam Girdwood 				dev_err(cpu_dai->dev,
1069f110bfc7SLiam Girdwood 					"ASoC: failed to remove %s: %d\n",
10700837fc62SFabio Estevam 					cpu_dai->name, err);
1071f0fba2adSLiam Girdwood 		}
1072f0fba2adSLiam Girdwood 		cpu_dai->probed = 0;
10739420d97bSLars-Peter Clausen 		if (!cpu_dai->codec)
1074f0fba2adSLiam Girdwood 			module_put(cpu_dai->dev->driver->owner);
1075f0fba2adSLiam Girdwood 	}
1076f0fba2adSLiam Girdwood }
1077f0fba2adSLiam Girdwood 
107862ae68faSStephen Warren static void soc_remove_link_components(struct snd_soc_card *card, int num,
107962ae68faSStephen Warren 				       int order)
108062ae68faSStephen Warren {
108162ae68faSStephen Warren 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
108262ae68faSStephen Warren 	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
108362ae68faSStephen Warren 	struct snd_soc_dai *codec_dai = rtd->codec_dai;
108462ae68faSStephen Warren 	struct snd_soc_platform *platform = rtd->platform;
108562ae68faSStephen Warren 	struct snd_soc_codec *codec;
108662ae68faSStephen Warren 
108762ae68faSStephen Warren 	/* remove the platform */
108862ae68faSStephen Warren 	if (platform && platform->probed &&
108962ae68faSStephen Warren 	    platform->driver->remove_order == order) {
109062ae68faSStephen Warren 		soc_remove_platform(platform);
109162ae68faSStephen Warren 	}
109262ae68faSStephen Warren 
109362ae68faSStephen Warren 	/* remove the CODEC-side CODEC */
109462ae68faSStephen Warren 	if (codec_dai) {
109562ae68faSStephen Warren 		codec = codec_dai->codec;
109662ae68faSStephen Warren 		if (codec && codec->probed &&
109762ae68faSStephen Warren 		    codec->driver->remove_order == order)
109862ae68faSStephen Warren 			soc_remove_codec(codec);
109962ae68faSStephen Warren 	}
110062ae68faSStephen Warren 
110162ae68faSStephen Warren 	/* remove any CPU-side CODEC */
110262ae68faSStephen Warren 	if (cpu_dai) {
110362ae68faSStephen Warren 		codec = cpu_dai->codec;
110462ae68faSStephen Warren 		if (codec && codec->probed &&
110562ae68faSStephen Warren 		    codec->driver->remove_order == order)
110662ae68faSStephen Warren 			soc_remove_codec(codec);
110762ae68faSStephen Warren 	}
110862ae68faSStephen Warren }
110962ae68faSStephen Warren 
11100671fd8eSKuninori Morimoto static void soc_remove_dai_links(struct snd_soc_card *card)
11110671fd8eSKuninori Morimoto {
11120168bf0dSLiam Girdwood 	int dai, order;
11130671fd8eSKuninori Morimoto 
11140168bf0dSLiam Girdwood 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
11150168bf0dSLiam Girdwood 			order++) {
11160168bf0dSLiam Girdwood 		for (dai = 0; dai < card->num_rtd; dai++)
111762ae68faSStephen Warren 			soc_remove_link_dais(card, dai, order);
11180168bf0dSLiam Girdwood 	}
111962ae68faSStephen Warren 
112062ae68faSStephen Warren 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
112162ae68faSStephen Warren 			order++) {
112262ae68faSStephen Warren 		for (dai = 0; dai < card->num_rtd; dai++)
112362ae68faSStephen Warren 			soc_remove_link_components(card, dai, order);
112462ae68faSStephen Warren 	}
112562ae68faSStephen Warren 
11260671fd8eSKuninori Morimoto 	card->num_rtd = 0;
11270671fd8eSKuninori Morimoto }
11280671fd8eSKuninori Morimoto 
1129ead9b919SJarkko Nikula static void soc_set_name_prefix(struct snd_soc_card *card,
113094f99c87SLars-Peter Clausen 				struct snd_soc_component *component)
1131ead9b919SJarkko Nikula {
1132ead9b919SJarkko Nikula 	int i;
1133ead9b919SJarkko Nikula 
1134ff819b83SDimitris Papastamos 	if (card->codec_conf == NULL)
1135ead9b919SJarkko Nikula 		return;
1136ead9b919SJarkko Nikula 
1137ff819b83SDimitris Papastamos 	for (i = 0; i < card->num_configs; i++) {
1138ff819b83SDimitris Papastamos 		struct snd_soc_codec_conf *map = &card->codec_conf[i];
113994f99c87SLars-Peter Clausen 		if (map->of_node && component->dev->of_node != map->of_node)
11403ca041edSSebastian Reichel 			continue;
114194f99c87SLars-Peter Clausen 		if (map->dev_name && strcmp(component->name, map->dev_name))
11423ca041edSSebastian Reichel 			continue;
114394f99c87SLars-Peter Clausen 		component->name_prefix = map->name_prefix;
1144ead9b919SJarkko Nikula 		break;
1145ead9b919SJarkko Nikula 	}
1146ead9b919SJarkko Nikula }
1147ead9b919SJarkko Nikula 
1148589c3563SJarkko Nikula static int soc_probe_codec(struct snd_soc_card *card,
1149589c3563SJarkko Nikula 			   struct snd_soc_codec *codec)
1150589c3563SJarkko Nikula {
1151589c3563SJarkko Nikula 	int ret = 0;
115289b95ac0SMark Brown 	const struct snd_soc_codec_driver *driver = codec->driver;
1153888df395SMark Brown 	struct snd_soc_dai *dai;
1154589c3563SJarkko Nikula 
1155589c3563SJarkko Nikula 	codec->card = card;
1156589c3563SJarkko Nikula 	codec->dapm.card = card;
115794f99c87SLars-Peter Clausen 	soc_set_name_prefix(card, &codec->component);
1158589c3563SJarkko Nikula 
115970d29331SJarkko Nikula 	if (!try_module_get(codec->dev->driver->owner))
116070d29331SJarkko Nikula 		return -ENODEV;
116170d29331SJarkko Nikula 
1162d5d1e0beSLars-Peter Clausen 	soc_init_codec_debugfs(codec);
1163d5d1e0beSLars-Peter Clausen 
1164b318ad50SNariman Poushin 	if (driver->dapm_widgets) {
1165b318ad50SNariman Poushin 		ret = snd_soc_dapm_new_controls(&codec->dapm,
1166b318ad50SNariman Poushin 						driver->dapm_widgets,
116777530150SLars-Peter Clausen 					 	driver->num_dapm_widgets);
116877530150SLars-Peter Clausen 
1169b318ad50SNariman Poushin 		if (ret != 0) {
1170b318ad50SNariman Poushin 			dev_err(codec->dev,
1171b318ad50SNariman Poushin 				"Failed to create new controls %d\n", ret);
1172b318ad50SNariman Poushin 			goto err_probe;
1173b318ad50SNariman Poushin 		}
1174b318ad50SNariman Poushin 	}
1175b318ad50SNariman Poushin 
1176888df395SMark Brown 	/* Create DAPM widgets for each DAI stream */
1177261edc70SNariman Poushin 	list_for_each_entry(dai, &codec->component.dai_list, list) {
1178261edc70SNariman Poushin 		ret = snd_soc_dapm_new_dai_widgets(&codec->dapm, dai);
1179261edc70SNariman Poushin 
1180261edc70SNariman Poushin 		if (ret != 0) {
1181261edc70SNariman Poushin 			dev_err(codec->dev,
1182261edc70SNariman Poushin 				"Failed to create DAI widgets %d\n", ret);
1183261edc70SNariman Poushin 			goto err_probe;
1184261edc70SNariman Poushin 		}
1185261edc70SNariman Poushin 	}
1186888df395SMark Brown 
118733c5f969SMark Brown 	codec->dapm.idle_bias_off = driver->idle_bias_off;
118833c5f969SMark Brown 
118989b95ac0SMark Brown 	if (driver->probe) {
119089b95ac0SMark Brown 		ret = driver->probe(codec);
1191589c3563SJarkko Nikula 		if (ret < 0) {
1192589c3563SJarkko Nikula 			dev_err(codec->dev,
1193f110bfc7SLiam Girdwood 				"ASoC: failed to probe CODEC %d\n", ret);
119470d29331SJarkko Nikula 			goto err_probe;
1195589c3563SJarkko Nikula 		}
1196ff541f4bSChuansheng Liu 		WARN(codec->dapm.idle_bias_off &&
1197ff541f4bSChuansheng Liu 			codec->dapm.bias_level != SND_SOC_BIAS_OFF,
119810e8aa9aSMichał Mirosław 			"codec %s can not start from non-off bias with idle_bias_off==1\n",
1199f4333203SLars-Peter Clausen 			codec->component.name);
1200589c3563SJarkko Nikula 	}
1201589c3563SJarkko Nikula 
1202b7af1dafSMark Brown 	if (driver->controls)
1203022658beSLiam Girdwood 		snd_soc_add_codec_controls(codec, driver->controls,
1204b7af1dafSMark Brown 				     driver->num_controls);
120589b95ac0SMark Brown 	if (driver->dapm_routes)
120689b95ac0SMark Brown 		snd_soc_dapm_add_routes(&codec->dapm, driver->dapm_routes,
120789b95ac0SMark Brown 					driver->num_dapm_routes);
120889b95ac0SMark Brown 
1209589c3563SJarkko Nikula 	/* mark codec as probed and add to card codec list */
1210589c3563SJarkko Nikula 	codec->probed = 1;
1211589c3563SJarkko Nikula 	list_add(&codec->card_list, &card->codec_dev_list);
12127be31be8SJarkko Nikula 	list_add(&codec->dapm.list, &card->dapm_list);
1213589c3563SJarkko Nikula 
121470d29331SJarkko Nikula 	return 0;
121570d29331SJarkko Nikula 
121670d29331SJarkko Nikula err_probe:
1217d5d1e0beSLars-Peter Clausen 	soc_cleanup_codec_debugfs(codec);
121870d29331SJarkko Nikula 	module_put(codec->dev->driver->owner);
121970d29331SJarkko Nikula 
1220589c3563SJarkko Nikula 	return ret;
1221589c3563SJarkko Nikula }
1222589c3563SJarkko Nikula 
1223956245e9SLiam Girdwood static int soc_probe_platform(struct snd_soc_card *card,
1224956245e9SLiam Girdwood 			   struct snd_soc_platform *platform)
1225956245e9SLiam Girdwood {
1226956245e9SLiam Girdwood 	int ret = 0;
1227956245e9SLiam Girdwood 	const struct snd_soc_platform_driver *driver = platform->driver;
12281438c2f6SLars-Peter Clausen 	struct snd_soc_component *component;
1229be09ad90SLiam Girdwood 	struct snd_soc_dai *dai;
1230956245e9SLiam Girdwood 
1231956245e9SLiam Girdwood 	platform->card = card;
1232bc9af9faSLars-Peter Clausen 	platform->component.dapm.card = card;
1233956245e9SLiam Girdwood 
1234956245e9SLiam Girdwood 	if (!try_module_get(platform->dev->driver->owner))
1235956245e9SLiam Girdwood 		return -ENODEV;
1236956245e9SLiam Girdwood 
1237731f1ab2SSebastien Guiriec 	soc_init_platform_debugfs(platform);
1238731f1ab2SSebastien Guiriec 
1239cb2cf612SLiam Girdwood 	if (driver->dapm_widgets)
1240bc9af9faSLars-Peter Clausen 		snd_soc_dapm_new_controls(&platform->component.dapm,
1241cb2cf612SLiam Girdwood 			driver->dapm_widgets, driver->num_dapm_widgets);
1242cb2cf612SLiam Girdwood 
1243be09ad90SLiam Girdwood 	/* Create DAPM widgets for each DAI stream */
12441438c2f6SLars-Peter Clausen 	list_for_each_entry(component, &component_list, list) {
12451438c2f6SLars-Peter Clausen 		if (component->dev != platform->dev)
1246be09ad90SLiam Girdwood 			continue;
12471438c2f6SLars-Peter Clausen 		list_for_each_entry(dai, &component->dai_list, list)
1248bc9af9faSLars-Peter Clausen 			snd_soc_dapm_new_dai_widgets(&platform->component.dapm,
1249bc9af9faSLars-Peter Clausen 				dai);
1250be09ad90SLiam Girdwood 	}
1251be09ad90SLiam Girdwood 
1252bc9af9faSLars-Peter Clausen 	platform->component.dapm.idle_bias_off = 1;
12533fec6b6dSStephen Warren 
1254956245e9SLiam Girdwood 	if (driver->probe) {
1255956245e9SLiam Girdwood 		ret = driver->probe(platform);
1256956245e9SLiam Girdwood 		if (ret < 0) {
1257956245e9SLiam Girdwood 			dev_err(platform->dev,
1258f110bfc7SLiam Girdwood 				"ASoC: failed to probe platform %d\n", ret);
1259956245e9SLiam Girdwood 			goto err_probe;
1260956245e9SLiam Girdwood 		}
1261956245e9SLiam Girdwood 	}
1262956245e9SLiam Girdwood 
1263cb2cf612SLiam Girdwood 	if (driver->controls)
1264cb2cf612SLiam Girdwood 		snd_soc_add_platform_controls(platform, driver->controls,
1265cb2cf612SLiam Girdwood 				     driver->num_controls);
1266cb2cf612SLiam Girdwood 	if (driver->dapm_routes)
1267bc9af9faSLars-Peter Clausen 		snd_soc_dapm_add_routes(&platform->component.dapm,
1268bc9af9faSLars-Peter Clausen 			driver->dapm_routes, driver->num_dapm_routes);
1269cb2cf612SLiam Girdwood 
1270956245e9SLiam Girdwood 	/* mark platform as probed and add to card platform list */
1271956245e9SLiam Girdwood 	platform->probed = 1;
1272956245e9SLiam Girdwood 	list_add(&platform->card_list, &card->platform_dev_list);
1273bc9af9faSLars-Peter Clausen 	list_add(&platform->component.dapm.list, &card->dapm_list);
1274956245e9SLiam Girdwood 
1275956245e9SLiam Girdwood 	return 0;
1276956245e9SLiam Girdwood 
1277956245e9SLiam Girdwood err_probe:
127802db1103SLiam Girdwood 	soc_cleanup_platform_debugfs(platform);
1279956245e9SLiam Girdwood 	module_put(platform->dev->driver->owner);
1280956245e9SLiam Girdwood 
1281956245e9SLiam Girdwood 	return ret;
1282956245e9SLiam Girdwood }
1283956245e9SLiam Girdwood 
128436ae1a96SMark Brown static void rtd_release(struct device *dev)
128536ae1a96SMark Brown {
128636ae1a96SMark Brown 	kfree(dev);
128736ae1a96SMark Brown }
1288f0fba2adSLiam Girdwood 
1289*44c69bb1SLars-Peter Clausen static int soc_aux_dev_init(struct snd_soc_card *card, int num)
1290503ae5e0SMisael Lopez Cruz {
1291503ae5e0SMisael Lopez Cruz 	struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
1292503ae5e0SMisael Lopez Cruz 	struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
1293503ae5e0SMisael Lopez Cruz 	int ret;
1294503ae5e0SMisael Lopez Cruz 
1295503ae5e0SMisael Lopez Cruz 	rtd->card = card;
1296503ae5e0SMisael Lopez Cruz 
1297503ae5e0SMisael Lopez Cruz 	/* do machine specific initialization */
1298503ae5e0SMisael Lopez Cruz 	if (aux_dev->init) {
1299*44c69bb1SLars-Peter Clausen 		ret = aux_dev->init(&rtd->codec->dapm);
1300503ae5e0SMisael Lopez Cruz 		if (ret < 0)
1301503ae5e0SMisael Lopez Cruz 			return ret;
1302503ae5e0SMisael Lopez Cruz 	}
1303503ae5e0SMisael Lopez Cruz 
1304503ae5e0SMisael Lopez Cruz 	return 0;
1305503ae5e0SMisael Lopez Cruz }
1306503ae5e0SMisael Lopez Cruz 
1307b8257be5SLars-Peter Clausen static int soc_dai_link_init(struct snd_soc_card *card, int num)
1308503ae5e0SMisael Lopez Cruz {
1309503ae5e0SMisael Lopez Cruz 	struct snd_soc_dai_link *dai_link =  &card->dai_link[num];
1310503ae5e0SMisael Lopez Cruz 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1311503ae5e0SMisael Lopez Cruz 	int ret;
1312503ae5e0SMisael Lopez Cruz 
1313503ae5e0SMisael Lopez Cruz 	rtd->card = card;
1314503ae5e0SMisael Lopez Cruz 
1315503ae5e0SMisael Lopez Cruz 	/* do machine specific initialization */
1316503ae5e0SMisael Lopez Cruz 	if (dai_link->init) {
1317503ae5e0SMisael Lopez Cruz 		ret = dai_link->init(rtd);
1318503ae5e0SMisael Lopez Cruz 		if (ret < 0)
1319503ae5e0SMisael Lopez Cruz 			return ret;
1320503ae5e0SMisael Lopez Cruz 	}
1321503ae5e0SMisael Lopez Cruz 
1322503ae5e0SMisael Lopez Cruz 	return 0;
1323503ae5e0SMisael Lopez Cruz }
1324503ae5e0SMisael Lopez Cruz 
1325589c3563SJarkko Nikula static int soc_post_component_init(struct snd_soc_card *card,
1326589c3563SJarkko Nikula 				   int num, int dailess)
1327589c3563SJarkko Nikula {
1328589c3563SJarkko Nikula 	struct snd_soc_dai_link *dai_link = NULL;
1329589c3563SJarkko Nikula 	struct snd_soc_aux_dev *aux_dev = NULL;
1330589c3563SJarkko Nikula 	struct snd_soc_pcm_runtime *rtd;
13316479f15aSLars-Peter Clausen 	const char *name;
1332589c3563SJarkko Nikula 	int ret = 0;
1333589c3563SJarkko Nikula 
1334589c3563SJarkko Nikula 	if (!dailess) {
1335589c3563SJarkko Nikula 		dai_link = &card->dai_link[num];
1336589c3563SJarkko Nikula 		rtd = &card->rtd[num];
1337589c3563SJarkko Nikula 		name = dai_link->name;
1338b8257be5SLars-Peter Clausen 		ret = soc_dai_link_init(card, num);
1339589c3563SJarkko Nikula 	} else {
1340589c3563SJarkko Nikula 		aux_dev = &card->aux_dev[num];
1341589c3563SJarkko Nikula 		rtd = &card->rtd_aux[num];
1342589c3563SJarkko Nikula 		name = aux_dev->name;
1343*44c69bb1SLars-Peter Clausen 		ret = soc_aux_dev_init(card, num);
1344589c3563SJarkko Nikula 	}
1345589c3563SJarkko Nikula 
1346589c3563SJarkko Nikula 	if (ret < 0) {
1347f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: failed to init %s: %d\n", name, ret);
1348589c3563SJarkko Nikula 		return ret;
1349589c3563SJarkko Nikula 	}
1350589c3563SJarkko Nikula 
1351589c3563SJarkko Nikula 	/* register the rtd device */
135236ae1a96SMark Brown 	rtd->dev = kzalloc(sizeof(struct device), GFP_KERNEL);
135336ae1a96SMark Brown 	if (!rtd->dev)
135436ae1a96SMark Brown 		return -ENOMEM;
135536ae1a96SMark Brown 	device_initialize(rtd->dev);
135636ae1a96SMark Brown 	rtd->dev->parent = card->dev;
135736ae1a96SMark Brown 	rtd->dev->release = rtd_release;
135836ae1a96SMark Brown 	rtd->dev->init_name = name;
135936ae1a96SMark Brown 	dev_set_drvdata(rtd->dev, rtd);
1360b8c0dab9SLiam Girdwood 	mutex_init(&rtd->pcm_mutex);
136101d7584cSLiam Girdwood 	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].be_clients);
136201d7584cSLiam Girdwood 	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].be_clients);
136301d7584cSLiam Girdwood 	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].fe_clients);
136401d7584cSLiam Girdwood 	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].fe_clients);
136536ae1a96SMark Brown 	ret = device_add(rtd->dev);
1366589c3563SJarkko Nikula 	if (ret < 0) {
1367865df9cbSChuansheng Liu 		/* calling put_device() here to free the rtd->dev */
1368865df9cbSChuansheng Liu 		put_device(rtd->dev);
1369589c3563SJarkko Nikula 		dev_err(card->dev,
1370f110bfc7SLiam Girdwood 			"ASoC: failed to register runtime device: %d\n", ret);
1371589c3563SJarkko Nikula 		return ret;
1372589c3563SJarkko Nikula 	}
1373589c3563SJarkko Nikula 	rtd->dev_registered = 1;
1374589c3563SJarkko Nikula 
1375589c3563SJarkko Nikula 	/* add DAPM sysfs entries for this codec */
137636ae1a96SMark Brown 	ret = snd_soc_dapm_sys_add(rtd->dev);
1377589c3563SJarkko Nikula 	if (ret < 0)
1378*44c69bb1SLars-Peter Clausen 		dev_err(rtd->dev,
1379f110bfc7SLiam Girdwood 			"ASoC: failed to add codec dapm sysfs entries: %d\n", ret);
1380589c3563SJarkko Nikula 
1381589c3563SJarkko Nikula 	/* add codec sysfs entries */
138236ae1a96SMark Brown 	ret = device_create_file(rtd->dev, &dev_attr_codec_reg);
1383589c3563SJarkko Nikula 	if (ret < 0)
1384*44c69bb1SLars-Peter Clausen 		dev_err(rtd->dev,
1385f110bfc7SLiam Girdwood 			"ASoC: failed to add codec sysfs files: %d\n", ret);
1386589c3563SJarkko Nikula 
1387f86dcef8SLiam Girdwood #ifdef CONFIG_DEBUG_FS
1388f86dcef8SLiam Girdwood 	/* add DPCM sysfs entries */
1389cd0f8911SLiam Girdwood 	if (!dailess && !dai_link->dynamic)
1390f86dcef8SLiam Girdwood 		goto out;
1391f86dcef8SLiam Girdwood 
1392f86dcef8SLiam Girdwood 	ret = soc_dpcm_debugfs_add(rtd);
1393f86dcef8SLiam Girdwood 	if (ret < 0)
1394f110bfc7SLiam Girdwood 		dev_err(rtd->dev, "ASoC: failed to add dpcm sysfs entries: %d\n", ret);
1395f86dcef8SLiam Girdwood 
1396f86dcef8SLiam Girdwood out:
1397f86dcef8SLiam Girdwood #endif
1398589c3563SJarkko Nikula 	return 0;
1399589c3563SJarkko Nikula }
1400589c3563SJarkko Nikula 
140162ae68faSStephen Warren static int soc_probe_link_components(struct snd_soc_card *card, int num,
140262ae68faSStephen Warren 				     int order)
140362ae68faSStephen Warren {
140462ae68faSStephen Warren 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
140562ae68faSStephen Warren 	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
140662ae68faSStephen Warren 	struct snd_soc_dai *codec_dai = rtd->codec_dai;
140762ae68faSStephen Warren 	struct snd_soc_platform *platform = rtd->platform;
140862ae68faSStephen Warren 	int ret;
140962ae68faSStephen Warren 
141062ae68faSStephen Warren 	/* probe the CPU-side component, if it is a CODEC */
141162ae68faSStephen Warren 	if (cpu_dai->codec &&
141262ae68faSStephen Warren 	    !cpu_dai->codec->probed &&
141362ae68faSStephen Warren 	    cpu_dai->codec->driver->probe_order == order) {
141462ae68faSStephen Warren 		ret = soc_probe_codec(card, cpu_dai->codec);
141562ae68faSStephen Warren 		if (ret < 0)
141662ae68faSStephen Warren 			return ret;
141762ae68faSStephen Warren 	}
141862ae68faSStephen Warren 
141962ae68faSStephen Warren 	/* probe the CODEC-side component */
142062ae68faSStephen Warren 	if (!codec_dai->codec->probed &&
142162ae68faSStephen Warren 	    codec_dai->codec->driver->probe_order == order) {
142262ae68faSStephen Warren 		ret = soc_probe_codec(card, codec_dai->codec);
142362ae68faSStephen Warren 		if (ret < 0)
142462ae68faSStephen Warren 			return ret;
142562ae68faSStephen Warren 	}
142662ae68faSStephen Warren 
142762ae68faSStephen Warren 	/* probe the platform */
142862ae68faSStephen Warren 	if (!platform->probed &&
142962ae68faSStephen Warren 	    platform->driver->probe_order == order) {
143062ae68faSStephen Warren 		ret = soc_probe_platform(card, platform);
143162ae68faSStephen Warren 		if (ret < 0)
143262ae68faSStephen Warren 			return ret;
143362ae68faSStephen Warren 	}
143462ae68faSStephen Warren 
143562ae68faSStephen Warren 	return 0;
143662ae68faSStephen Warren }
143762ae68faSStephen Warren 
1438b0aa88afSMisael Lopez Cruz static int soc_probe_codec_dai(struct snd_soc_card *card,
1439b0aa88afSMisael Lopez Cruz 			       struct snd_soc_dai *codec_dai,
1440b0aa88afSMisael Lopez Cruz 			       int order)
1441b0aa88afSMisael Lopez Cruz {
1442b0aa88afSMisael Lopez Cruz 	int ret;
1443b0aa88afSMisael Lopez Cruz 
1444b0aa88afSMisael Lopez Cruz 	if (!codec_dai->probed && codec_dai->driver->probe_order == order) {
1445b0aa88afSMisael Lopez Cruz 		if (codec_dai->driver->probe) {
1446b0aa88afSMisael Lopez Cruz 			ret = codec_dai->driver->probe(codec_dai);
1447b0aa88afSMisael Lopez Cruz 			if (ret < 0) {
1448b0aa88afSMisael Lopez Cruz 				dev_err(codec_dai->dev,
1449b0aa88afSMisael Lopez Cruz 					"ASoC: failed to probe CODEC DAI %s: %d\n",
1450b0aa88afSMisael Lopez Cruz 					codec_dai->name, ret);
1451b0aa88afSMisael Lopez Cruz 				return ret;
1452b0aa88afSMisael Lopez Cruz 			}
1453b0aa88afSMisael Lopez Cruz 		}
1454b0aa88afSMisael Lopez Cruz 
1455b0aa88afSMisael Lopez Cruz 		/* mark codec_dai as probed and add to card dai list */
1456b0aa88afSMisael Lopez Cruz 		codec_dai->probed = 1;
1457b0aa88afSMisael Lopez Cruz 	}
1458b0aa88afSMisael Lopez Cruz 
1459b0aa88afSMisael Lopez Cruz 	return 0;
1460b0aa88afSMisael Lopez Cruz }
1461b0aa88afSMisael Lopez Cruz 
14622436a723SMisael Lopez Cruz static int soc_link_dai_widgets(struct snd_soc_card *card,
14632436a723SMisael Lopez Cruz 				struct snd_soc_dai_link *dai_link,
14642436a723SMisael Lopez Cruz 				struct snd_soc_dai *cpu_dai,
14652436a723SMisael Lopez Cruz 				struct snd_soc_dai *codec_dai)
14662436a723SMisael Lopez Cruz {
14672436a723SMisael Lopez Cruz 	struct snd_soc_dapm_widget *play_w, *capture_w;
14682436a723SMisael Lopez Cruz 	int ret;
14692436a723SMisael Lopez Cruz 
14702436a723SMisael Lopez Cruz 	/* link the DAI widgets */
14712436a723SMisael Lopez Cruz 	play_w = codec_dai->playback_widget;
14722436a723SMisael Lopez Cruz 	capture_w = cpu_dai->capture_widget;
14732436a723SMisael Lopez Cruz 	if (play_w && capture_w) {
14742436a723SMisael Lopez Cruz 		ret = snd_soc_dapm_new_pcm(card, dai_link->params,
14752436a723SMisael Lopez Cruz 					   capture_w, play_w);
14762436a723SMisael Lopez Cruz 		if (ret != 0) {
14772436a723SMisael Lopez Cruz 			dev_err(card->dev, "ASoC: Can't link %s to %s: %d\n",
14782436a723SMisael Lopez Cruz 				play_w->name, capture_w->name, ret);
14792436a723SMisael Lopez Cruz 			return ret;
14802436a723SMisael Lopez Cruz 		}
14812436a723SMisael Lopez Cruz 	}
14822436a723SMisael Lopez Cruz 
14832436a723SMisael Lopez Cruz 	play_w = cpu_dai->playback_widget;
14842436a723SMisael Lopez Cruz 	capture_w = codec_dai->capture_widget;
14852436a723SMisael Lopez Cruz 	if (play_w && capture_w) {
14862436a723SMisael Lopez Cruz 		ret = snd_soc_dapm_new_pcm(card, dai_link->params,
14872436a723SMisael Lopez Cruz 					   capture_w, play_w);
14882436a723SMisael Lopez Cruz 		if (ret != 0) {
14892436a723SMisael Lopez Cruz 			dev_err(card->dev, "ASoC: Can't link %s to %s: %d\n",
14902436a723SMisael Lopez Cruz 				play_w->name, capture_w->name, ret);
14912436a723SMisael Lopez Cruz 			return ret;
14922436a723SMisael Lopez Cruz 		}
14932436a723SMisael Lopez Cruz 	}
14942436a723SMisael Lopez Cruz 
14952436a723SMisael Lopez Cruz 	return 0;
14962436a723SMisael Lopez Cruz }
14972436a723SMisael Lopez Cruz 
149862ae68faSStephen Warren static int soc_probe_link_dais(struct snd_soc_card *card, int num, int order)
1499f0fba2adSLiam Girdwood {
1500f0fba2adSLiam Girdwood 	struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1501f0fba2adSLiam Girdwood 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1502f0fba2adSLiam Girdwood 	struct snd_soc_codec *codec = rtd->codec;
1503f0fba2adSLiam Girdwood 	struct snd_soc_platform *platform = rtd->platform;
1504c74184edSMark Brown 	struct snd_soc_dai *codec_dai = rtd->codec_dai;
1505c74184edSMark Brown 	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1506f0fba2adSLiam Girdwood 	int ret;
1507f0fba2adSLiam Girdwood 
1508f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: probe %s dai link %d late %d\n",
15090168bf0dSLiam Girdwood 			card->name, num, order);
1510f0fba2adSLiam Girdwood 
1511f0fba2adSLiam Girdwood 	/* config components */
1512f0fba2adSLiam Girdwood 	cpu_dai->platform = platform;
1513f0fba2adSLiam Girdwood 	codec_dai->card = card;
1514f0fba2adSLiam Girdwood 	cpu_dai->card = card;
1515f0fba2adSLiam Girdwood 
1516f0fba2adSLiam Girdwood 	/* set default power off timeout */
1517f0fba2adSLiam Girdwood 	rtd->pmdown_time = pmdown_time;
1518f0fba2adSLiam Girdwood 
1519f0fba2adSLiam Girdwood 	/* probe the cpu_dai */
15200168bf0dSLiam Girdwood 	if (!cpu_dai->probed &&
15210168bf0dSLiam Girdwood 			cpu_dai->driver->probe_order == order) {
1522a9db7dbeSStephen Warren 		if (!cpu_dai->codec) {
152361b61e3cSLiam Girdwood 			if (!try_module_get(cpu_dai->dev->driver->owner))
152461b61e3cSLiam Girdwood 				return -ENODEV;
1525a9db7dbeSStephen Warren 		}
1526be09ad90SLiam Girdwood 
1527f0fba2adSLiam Girdwood 		if (cpu_dai->driver->probe) {
1528f0fba2adSLiam Girdwood 			ret = cpu_dai->driver->probe(cpu_dai);
1529f0fba2adSLiam Girdwood 			if (ret < 0) {
1530f110bfc7SLiam Girdwood 				dev_err(cpu_dai->dev,
1531f110bfc7SLiam Girdwood 					"ASoC: failed to probe CPU DAI %s: %d\n",
15320837fc62SFabio Estevam 					cpu_dai->name, ret);
153361b61e3cSLiam Girdwood 				module_put(cpu_dai->dev->driver->owner);
1534f0fba2adSLiam Girdwood 				return ret;
1535f0fba2adSLiam Girdwood 			}
1536f0fba2adSLiam Girdwood 		}
1537f0fba2adSLiam Girdwood 		cpu_dai->probed = 1;
1538f0fba2adSLiam Girdwood 	}
1539f0fba2adSLiam Girdwood 
1540f0fba2adSLiam Girdwood 	/* probe the CODEC DAI */
1541b0aa88afSMisael Lopez Cruz 	ret = soc_probe_codec_dai(card, codec_dai, order);
1542b0aa88afSMisael Lopez Cruz 	if (ret)
1543f0fba2adSLiam Girdwood 		return ret;
1544f0fba2adSLiam Girdwood 
15450168bf0dSLiam Girdwood 	/* complete DAI probe during last probe */
15460168bf0dSLiam Girdwood 	if (order != SND_SOC_COMP_ORDER_LAST)
15470168bf0dSLiam Girdwood 		return 0;
15480168bf0dSLiam Girdwood 
1549*44c69bb1SLars-Peter Clausen 	ret = soc_post_component_init(card, num, 0);
1550589c3563SJarkko Nikula 	if (ret)
1551f0fba2adSLiam Girdwood 		return ret;
1552f0fba2adSLiam Girdwood 
155336ae1a96SMark Brown 	ret = device_create_file(rtd->dev, &dev_attr_pmdown_time);
1554f0fba2adSLiam Girdwood 	if (ret < 0)
1555f110bfc7SLiam Girdwood 		dev_warn(rtd->dev, "ASoC: failed to add pmdown_time sysfs: %d\n",
1556f110bfc7SLiam Girdwood 			ret);
1557f0fba2adSLiam Girdwood 
15581245b700SNamarta Kohli 	if (cpu_dai->driver->compress_dai) {
15591245b700SNamarta Kohli 		/*create compress_device"*/
15601245b700SNamarta Kohli 		ret = soc_new_compress(rtd, num);
15611245b700SNamarta Kohli 		if (ret < 0) {
1562f110bfc7SLiam Girdwood 			dev_err(card->dev, "ASoC: can't create compress %s\n",
15631245b700SNamarta Kohli 					 dai_link->stream_name);
15641245b700SNamarta Kohli 			return ret;
15651245b700SNamarta Kohli 		}
15661245b700SNamarta Kohli 	} else {
15671245b700SNamarta Kohli 
1568c74184edSMark Brown 		if (!dai_link->params) {
1569f0fba2adSLiam Girdwood 			/* create the pcm */
1570f0fba2adSLiam Girdwood 			ret = soc_new_pcm(rtd, num);
1571f0fba2adSLiam Girdwood 			if (ret < 0) {
1572f110bfc7SLiam Girdwood 				dev_err(card->dev, "ASoC: can't create pcm %s :%d\n",
15730837fc62SFabio Estevam 				       dai_link->stream_name, ret);
1574f0fba2adSLiam Girdwood 				return ret;
1575f0fba2adSLiam Girdwood 			}
1576c74184edSMark Brown 		} else {
15779d58a077SRichard Fitzgerald 			INIT_DELAYED_WORK(&rtd->delayed_work,
15789d58a077SRichard Fitzgerald 						codec2codec_close_delayed_work);
15799d58a077SRichard Fitzgerald 
1580c74184edSMark Brown 			/* link the DAI widgets */
15812436a723SMisael Lopez Cruz 			ret = soc_link_dai_widgets(card, dai_link,
15822436a723SMisael Lopez Cruz 					cpu_dai, codec_dai);
15832436a723SMisael Lopez Cruz 			if (ret)
1584c74184edSMark Brown 				return ret;
1585c74184edSMark Brown 		}
1586c74184edSMark Brown 	}
1587c74184edSMark Brown 
1588f0fba2adSLiam Girdwood 	/* add platform data for AC97 devices */
1589f0fba2adSLiam Girdwood 	if (rtd->codec_dai->driver->ac97_control)
1590f0fba2adSLiam Girdwood 		snd_ac97_dev_add_pdata(codec->ac97, rtd->cpu_dai->ac97_pdata);
1591f0fba2adSLiam Girdwood 
1592f0fba2adSLiam Girdwood 	return 0;
1593f0fba2adSLiam Girdwood }
1594f0fba2adSLiam Girdwood 
1595f0fba2adSLiam Girdwood #ifdef CONFIG_SND_SOC_AC97_BUS
159602c9c7b9SMisael Lopez Cruz static int soc_register_ac97_codec(struct snd_soc_codec *codec,
159702c9c7b9SMisael Lopez Cruz 				   struct snd_soc_dai *codec_dai)
1598f0fba2adSLiam Girdwood {
1599f0fba2adSLiam Girdwood 	int ret;
1600f0fba2adSLiam Girdwood 
1601f0fba2adSLiam Girdwood 	/* Only instantiate AC97 if not already done by the adaptor
1602f0fba2adSLiam Girdwood 	 * for the generic AC97 subsystem.
16036b05eda6SMark Brown 	 */
160402c9c7b9SMisael Lopez Cruz 	if (codec_dai->driver->ac97_control && !codec->ac97_registered) {
16050562f788SMika Westerberg 		/*
16060562f788SMika Westerberg 		 * It is possible that the AC97 device is already registered to
16070562f788SMika Westerberg 		 * the device subsystem. This happens when the device is created
16080562f788SMika Westerberg 		 * via snd_ac97_mixer(). Currently only SoC codec that does so
16090562f788SMika Westerberg 		 * is the generic AC97 glue but others migh emerge.
16100562f788SMika Westerberg 		 *
16110562f788SMika Westerberg 		 * In those cases we don't try to register the device again.
16120562f788SMika Westerberg 		 */
161302c9c7b9SMisael Lopez Cruz 		if (!codec->ac97_created)
16140562f788SMika Westerberg 			return 0;
1615f0fba2adSLiam Girdwood 
161602c9c7b9SMisael Lopez Cruz 		ret = soc_ac97_dev_register(codec);
1617f0fba2adSLiam Girdwood 		if (ret < 0) {
161802c9c7b9SMisael Lopez Cruz 			dev_err(codec->dev,
1619f110bfc7SLiam Girdwood 				"ASoC: AC97 device register failed: %d\n", ret);
1620f0fba2adSLiam Girdwood 			return ret;
1621435c5e25SMark Brown 		}
1622435c5e25SMark Brown 
162302c9c7b9SMisael Lopez Cruz 		codec->ac97_registered = 1;
1624f0fba2adSLiam Girdwood 	}
1625f0fba2adSLiam Girdwood 	return 0;
1626f0fba2adSLiam Girdwood }
1627435c5e25SMark Brown 
162802c9c7b9SMisael Lopez Cruz static int soc_register_ac97_dai_link(struct snd_soc_pcm_runtime *rtd)
162902c9c7b9SMisael Lopez Cruz {
163002c9c7b9SMisael Lopez Cruz 	return soc_register_ac97_codec(rtd->codec, rtd->codec_dai);
163102c9c7b9SMisael Lopez Cruz }
163202c9c7b9SMisael Lopez Cruz 
163302c9c7b9SMisael Lopez Cruz static void soc_unregister_ac97_codec(struct snd_soc_codec *codec)
1634f0fba2adSLiam Girdwood {
1635f0fba2adSLiam Girdwood 	if (codec->ac97_registered) {
1636f0fba2adSLiam Girdwood 		soc_ac97_dev_unregister(codec);
1637f0fba2adSLiam Girdwood 		codec->ac97_registered = 0;
1638f0fba2adSLiam Girdwood 	}
1639f0fba2adSLiam Girdwood }
164002c9c7b9SMisael Lopez Cruz 
164102c9c7b9SMisael Lopez Cruz static void soc_unregister_ac97_dai_link(struct snd_soc_pcm_runtime *rtd)
164202c9c7b9SMisael Lopez Cruz {
164302c9c7b9SMisael Lopez Cruz 	soc_unregister_ac97_codec(rtd->codec);
164402c9c7b9SMisael Lopez Cruz }
1645f0fba2adSLiam Girdwood #endif
1646435c5e25SMark Brown 
1647*44c69bb1SLars-Peter Clausen static int soc_bind_aux_dev(struct snd_soc_card *card, int num)
16483ca041edSSebastian Reichel {
1649*44c69bb1SLars-Peter Clausen 	struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
16503ca041edSSebastian Reichel 	struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
16513ca041edSSebastian Reichel 	const char *codecname = aux_dev->codec_name;
16523ca041edSSebastian Reichel 
1653*44c69bb1SLars-Peter Clausen 	rtd->codec = soc_find_codec(aux_dev->codec_of_node, codecname);
1654*44c69bb1SLars-Peter Clausen 	if (!rtd->codec) {
16553ca041edSSebastian Reichel 		if (aux_dev->codec_of_node)
16563ca041edSSebastian Reichel 			codecname = of_node_full_name(aux_dev->codec_of_node);
16573ca041edSSebastian Reichel 
16583ca041edSSebastian Reichel 		dev_err(card->dev, "ASoC: %s not registered\n", codecname);
1659b19e6e7bSMark Brown 		return -EPROBE_DEFER;
1660b19e6e7bSMark Brown 	}
1661b19e6e7bSMark Brown 
1662*44c69bb1SLars-Peter Clausen 	return 0;
16633ca041edSSebastian Reichel }
16642eea392dSJarkko Nikula 
1665*44c69bb1SLars-Peter Clausen static int soc_probe_aux_dev(struct snd_soc_card *card, int num)
1666*44c69bb1SLars-Peter Clausen {
1667*44c69bb1SLars-Peter Clausen 	struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
1668*44c69bb1SLars-Peter Clausen 	int ret;
1669*44c69bb1SLars-Peter Clausen 
1670*44c69bb1SLars-Peter Clausen 	if (rtd->codec->probed) {
1671*44c69bb1SLars-Peter Clausen 		dev_err(rtd->codec->dev, "ASoC: codec already probed\n");
16723ca041edSSebastian Reichel 		return -EBUSY;
16733ca041edSSebastian Reichel 	}
16743ca041edSSebastian Reichel 
1675*44c69bb1SLars-Peter Clausen 	ret = soc_probe_codec(card, rtd->codec);
16762eea392dSJarkko Nikula 	if (ret < 0)
1677589c3563SJarkko Nikula 		return ret;
16782eea392dSJarkko Nikula 
1679*44c69bb1SLars-Peter Clausen 	return soc_post_component_init(card, num, 1);
16802eea392dSJarkko Nikula }
16812eea392dSJarkko Nikula 
16822eea392dSJarkko Nikula static void soc_remove_aux_dev(struct snd_soc_card *card, int num)
16832eea392dSJarkko Nikula {
16842eea392dSJarkko Nikula 	struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
16852eea392dSJarkko Nikula 	struct snd_soc_codec *codec = rtd->codec;
16862eea392dSJarkko Nikula 
16872eea392dSJarkko Nikula 	/* unregister the rtd device */
16882eea392dSJarkko Nikula 	if (rtd->dev_registered) {
168936ae1a96SMark Brown 		device_remove_file(rtd->dev, &dev_attr_codec_reg);
1690d3bf1561SChuansheng Liu 		device_unregister(rtd->dev);
16912eea392dSJarkko Nikula 		rtd->dev_registered = 0;
16922eea392dSJarkko Nikula 	}
16932eea392dSJarkko Nikula 
1694589c3563SJarkko Nikula 	if (codec && codec->probed)
1695589c3563SJarkko Nikula 		soc_remove_codec(codec);
16962eea392dSJarkko Nikula }
16972eea392dSJarkko Nikula 
1698f90fb3f7SLars-Peter Clausen static int snd_soc_init_codec_cache(struct snd_soc_codec *codec)
1699fdf0f54dSDimitris Papastamos {
1700fdf0f54dSDimitris Papastamos 	int ret;
1701fdf0f54dSDimitris Papastamos 
1702fdf0f54dSDimitris Papastamos 	if (codec->cache_init)
1703fdf0f54dSDimitris Papastamos 		return 0;
1704fdf0f54dSDimitris Papastamos 
1705fdf0f54dSDimitris Papastamos 	ret = snd_soc_cache_init(codec);
1706fdf0f54dSDimitris Papastamos 	if (ret < 0) {
170710e8aa9aSMichał Mirosław 		dev_err(codec->dev,
170810e8aa9aSMichał Mirosław 			"ASoC: Failed to set cache compression type: %d\n",
170910e8aa9aSMichał Mirosław 			ret);
1710fdf0f54dSDimitris Papastamos 		return ret;
1711fdf0f54dSDimitris Papastamos 	}
1712fdf0f54dSDimitris Papastamos 	codec->cache_init = 1;
1713fdf0f54dSDimitris Papastamos 	return 0;
1714fdf0f54dSDimitris Papastamos }
1715fdf0f54dSDimitris Papastamos 
1716b19e6e7bSMark Brown static int snd_soc_instantiate_card(struct snd_soc_card *card)
1717f0fba2adSLiam Girdwood {
1718fdf0f54dSDimitris Papastamos 	struct snd_soc_codec *codec;
171975d9ac46SMark Brown 	struct snd_soc_dai_link *dai_link;
1720f04209a7SMark Brown 	int ret, i, order, dai_fmt;
172196dd3622SMark Brown 
172201b9d99aSLiam Girdwood 	mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_INIT);
1723f0fba2adSLiam Girdwood 
1724b19e6e7bSMark Brown 	/* bind DAIs */
1725b19e6e7bSMark Brown 	for (i = 0; i < card->num_links; i++) {
1726b19e6e7bSMark Brown 		ret = soc_bind_dai_link(card, i);
1727b19e6e7bSMark Brown 		if (ret != 0)
1728b19e6e7bSMark Brown 			goto base_error;
1729db2a4165SFrank Mandarino 	}
1730db2a4165SFrank Mandarino 
1731*44c69bb1SLars-Peter Clausen 	/* bind aux_devs too */
1732b19e6e7bSMark Brown 	for (i = 0; i < card->num_aux_devs; i++) {
1733*44c69bb1SLars-Peter Clausen 		ret = soc_bind_aux_dev(card, i);
1734b19e6e7bSMark Brown 		if (ret != 0)
1735b19e6e7bSMark Brown 			goto base_error;
1736db2a4165SFrank Mandarino 	}
1737db2a4165SFrank Mandarino 
1738fdf0f54dSDimitris Papastamos 	/* initialize the register cache for each available codec */
1739fdf0f54dSDimitris Papastamos 	list_for_each_entry(codec, &codec_list, list) {
1740fdf0f54dSDimitris Papastamos 		if (codec->cache_init)
1741fdf0f54dSDimitris Papastamos 			continue;
1742f90fb3f7SLars-Peter Clausen 		ret = snd_soc_init_codec_cache(codec);
1743b19e6e7bSMark Brown 		if (ret < 0)
1744b19e6e7bSMark Brown 			goto base_error;
1745fdf0f54dSDimitris Papastamos 	}
1746fdf0f54dSDimitris Papastamos 
1747f0fba2adSLiam Girdwood 	/* card bind complete so register a sound card */
1748102b5a8dSTakashi Iwai 	ret = snd_card_new(card->dev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
1749f0fba2adSLiam Girdwood 			card->owner, 0, &card->snd_card);
1750f0fba2adSLiam Girdwood 	if (ret < 0) {
175110e8aa9aSMichał Mirosław 		dev_err(card->dev,
175210e8aa9aSMichał Mirosław 			"ASoC: can't create sound card for card %s: %d\n",
175310e8aa9aSMichał Mirosław 			card->name, ret);
1754b19e6e7bSMark Brown 		goto base_error;
1755db2a4165SFrank Mandarino 	}
1756db2a4165SFrank Mandarino 
1757e37a4970SMark Brown 	card->dapm.bias_level = SND_SOC_BIAS_OFF;
1758e37a4970SMark Brown 	card->dapm.dev = card->dev;
1759e37a4970SMark Brown 	card->dapm.card = card;
1760e37a4970SMark Brown 	list_add(&card->dapm.list, &card->dapm_list);
1761e37a4970SMark Brown 
1762d5d1e0beSLars-Peter Clausen #ifdef CONFIG_DEBUG_FS
1763d5d1e0beSLars-Peter Clausen 	snd_soc_dapm_debugfs_init(&card->dapm, card->debugfs_card_root);
1764d5d1e0beSLars-Peter Clausen #endif
1765d5d1e0beSLars-Peter Clausen 
176688ee1c61SMark Brown #ifdef CONFIG_PM_SLEEP
17676ed25978SAndy Green 	/* deferred resume work */
17686308419aSMark Brown 	INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
17691301a964SRandy Dunlap #endif
17706ed25978SAndy Green 
17719a841ebbSMark Brown 	if (card->dapm_widgets)
17729a841ebbSMark Brown 		snd_soc_dapm_new_controls(&card->dapm, card->dapm_widgets,
17739a841ebbSMark Brown 					  card->num_dapm_widgets);
17749a841ebbSMark Brown 
1775f0fba2adSLiam Girdwood 	/* initialise the sound card only once */
1776f0fba2adSLiam Girdwood 	if (card->probe) {
1777e7361ec4SMark Brown 		ret = card->probe(card);
1778f0fba2adSLiam Girdwood 		if (ret < 0)
1779f0fba2adSLiam Girdwood 			goto card_probe_error;
1780f0fba2adSLiam Girdwood 	}
1781f0fba2adSLiam Girdwood 
178262ae68faSStephen Warren 	/* probe all components used by DAI links on this card */
17830168bf0dSLiam Girdwood 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
17840168bf0dSLiam Girdwood 			order++) {
1785fe3e78e0SMark Brown 		for (i = 0; i < card->num_links; i++) {
178662ae68faSStephen Warren 			ret = soc_probe_link_components(card, i, order);
178762ae68faSStephen Warren 			if (ret < 0) {
1788f110bfc7SLiam Girdwood 				dev_err(card->dev,
1789f110bfc7SLiam Girdwood 					"ASoC: failed to instantiate card %d\n",
1790f110bfc7SLiam Girdwood 					ret);
179162ae68faSStephen Warren 				goto probe_dai_err;
179262ae68faSStephen Warren 			}
179362ae68faSStephen Warren 		}
179462ae68faSStephen Warren 	}
179562ae68faSStephen Warren 
179662ae68faSStephen Warren 	/* probe all DAI links on this card */
179762ae68faSStephen Warren 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
179862ae68faSStephen Warren 			order++) {
179962ae68faSStephen Warren 		for (i = 0; i < card->num_links; i++) {
180062ae68faSStephen Warren 			ret = soc_probe_link_dais(card, i, order);
1801fe3e78e0SMark Brown 			if (ret < 0) {
1802f110bfc7SLiam Girdwood 				dev_err(card->dev,
1803f110bfc7SLiam Girdwood 					"ASoC: failed to instantiate card %d\n",
1804f110bfc7SLiam Girdwood 					ret);
1805f0fba2adSLiam Girdwood 				goto probe_dai_err;
1806fe3e78e0SMark Brown 			}
1807fe3e78e0SMark Brown 		}
18080168bf0dSLiam Girdwood 	}
1809fe3e78e0SMark Brown 
18102eea392dSJarkko Nikula 	for (i = 0; i < card->num_aux_devs; i++) {
18112eea392dSJarkko Nikula 		ret = soc_probe_aux_dev(card, i);
18122eea392dSJarkko Nikula 		if (ret < 0) {
1813f110bfc7SLiam Girdwood 			dev_err(card->dev,
1814f110bfc7SLiam Girdwood 				"ASoC: failed to add auxiliary devices %d\n",
1815f110bfc7SLiam Girdwood 				ret);
18162eea392dSJarkko Nikula 			goto probe_aux_dev_err;
18172eea392dSJarkko Nikula 		}
18182eea392dSJarkko Nikula 	}
18192eea392dSJarkko Nikula 
1820888df395SMark Brown 	snd_soc_dapm_link_dai_widgets(card);
1821b893ea5fSLiam Girdwood 	snd_soc_dapm_connect_dai_link_widgets(card);
1822888df395SMark Brown 
1823b7af1dafSMark Brown 	if (card->controls)
1824022658beSLiam Girdwood 		snd_soc_add_card_controls(card, card->controls, card->num_controls);
1825b7af1dafSMark Brown 
1826b8ad29deSMark Brown 	if (card->dapm_routes)
1827b8ad29deSMark Brown 		snd_soc_dapm_add_routes(&card->dapm, card->dapm_routes,
1828b8ad29deSMark Brown 					card->num_dapm_routes);
1829b8ad29deSMark Brown 
183075d9ac46SMark Brown 	for (i = 0; i < card->num_links; i++) {
183175d9ac46SMark Brown 		dai_link = &card->dai_link[i];
1832f04209a7SMark Brown 		dai_fmt = dai_link->dai_fmt;
183375d9ac46SMark Brown 
1834f04209a7SMark Brown 		if (dai_fmt) {
183575d9ac46SMark Brown 			ret = snd_soc_dai_set_fmt(card->rtd[i].codec_dai,
1836f04209a7SMark Brown 						  dai_fmt);
18375e4ba569SShawn Guo 			if (ret != 0 && ret != -ENOTSUPP)
183875d9ac46SMark Brown 				dev_warn(card->rtd[i].codec_dai->dev,
1839f110bfc7SLiam Girdwood 					 "ASoC: Failed to set DAI format: %d\n",
184075d9ac46SMark Brown 					 ret);
1841f04209a7SMark Brown 		}
1842f04209a7SMark Brown 
1843f04209a7SMark Brown 		/* If this is a regular CPU link there will be a platform */
1844fe33d4c5SStephen Warren 		if (dai_fmt &&
1845fe33d4c5SStephen Warren 		    (dai_link->platform_name || dai_link->platform_of_node)) {
1846f04209a7SMark Brown 			ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai,
1847f04209a7SMark Brown 						  dai_fmt);
1848f04209a7SMark Brown 			if (ret != 0 && ret != -ENOTSUPP)
1849f04209a7SMark Brown 				dev_warn(card->rtd[i].cpu_dai->dev,
1850f110bfc7SLiam Girdwood 					 "ASoC: Failed to set DAI format: %d\n",
1851f04209a7SMark Brown 					 ret);
1852f04209a7SMark Brown 		} else if (dai_fmt) {
1853f04209a7SMark Brown 			/* Flip the polarity for the "CPU" end */
1854f04209a7SMark Brown 			dai_fmt &= ~SND_SOC_DAIFMT_MASTER_MASK;
1855f04209a7SMark Brown 			switch (dai_link->dai_fmt &
1856f04209a7SMark Brown 				SND_SOC_DAIFMT_MASTER_MASK) {
1857f04209a7SMark Brown 			case SND_SOC_DAIFMT_CBM_CFM:
1858f04209a7SMark Brown 				dai_fmt |= SND_SOC_DAIFMT_CBS_CFS;
1859f04209a7SMark Brown 				break;
1860f04209a7SMark Brown 			case SND_SOC_DAIFMT_CBM_CFS:
1861f04209a7SMark Brown 				dai_fmt |= SND_SOC_DAIFMT_CBS_CFM;
1862f04209a7SMark Brown 				break;
1863f04209a7SMark Brown 			case SND_SOC_DAIFMT_CBS_CFM:
1864f04209a7SMark Brown 				dai_fmt |= SND_SOC_DAIFMT_CBM_CFS;
1865f04209a7SMark Brown 				break;
1866f04209a7SMark Brown 			case SND_SOC_DAIFMT_CBS_CFS:
1867f04209a7SMark Brown 				dai_fmt |= SND_SOC_DAIFMT_CBM_CFM;
1868f04209a7SMark Brown 				break;
1869f04209a7SMark Brown 			}
187075d9ac46SMark Brown 
187175d9ac46SMark Brown 			ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai,
1872f04209a7SMark Brown 						  dai_fmt);
18735e4ba569SShawn Guo 			if (ret != 0 && ret != -ENOTSUPP)
187475d9ac46SMark Brown 				dev_warn(card->rtd[i].cpu_dai->dev,
1875f110bfc7SLiam Girdwood 					 "ASoC: Failed to set DAI format: %d\n",
187675d9ac46SMark Brown 					 ret);
187775d9ac46SMark Brown 		}
187875d9ac46SMark Brown 	}
187975d9ac46SMark Brown 
1880f0fba2adSLiam Girdwood 	snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname),
1881fe3e78e0SMark Brown 		 "%s", card->name);
1882f0fba2adSLiam Girdwood 	snprintf(card->snd_card->longname, sizeof(card->snd_card->longname),
188322de71baSLiam Girdwood 		 "%s", card->long_name ? card->long_name : card->name);
1884f0e8ed85SMark Brown 	snprintf(card->snd_card->driver, sizeof(card->snd_card->driver),
1885f0e8ed85SMark Brown 		 "%s", card->driver_name ? card->driver_name : card->name);
1886f0e8ed85SMark Brown 	for (i = 0; i < ARRAY_SIZE(card->snd_card->driver); i++) {
1887f0e8ed85SMark Brown 		switch (card->snd_card->driver[i]) {
1888f0e8ed85SMark Brown 		case '_':
1889f0e8ed85SMark Brown 		case '-':
1890f0e8ed85SMark Brown 		case '\0':
1891f0e8ed85SMark Brown 			break;
1892f0e8ed85SMark Brown 		default:
1893f0e8ed85SMark Brown 			if (!isalnum(card->snd_card->driver[i]))
1894f0e8ed85SMark Brown 				card->snd_card->driver[i] = '_';
1895f0e8ed85SMark Brown 			break;
1896f0e8ed85SMark Brown 		}
1897f0e8ed85SMark Brown 	}
1898fe3e78e0SMark Brown 
189928e9ad92SMark Brown 	if (card->late_probe) {
190028e9ad92SMark Brown 		ret = card->late_probe(card);
190128e9ad92SMark Brown 		if (ret < 0) {
1902f110bfc7SLiam Girdwood 			dev_err(card->dev, "ASoC: %s late_probe() failed: %d\n",
190328e9ad92SMark Brown 				card->name, ret);
190428e9ad92SMark Brown 			goto probe_aux_dev_err;
190528e9ad92SMark Brown 		}
190628e9ad92SMark Brown 	}
190728e9ad92SMark Brown 
19081633281bSStephen Warren 	if (card->fully_routed)
19097df37884SLars-Peter Clausen 		snd_soc_dapm_auto_nc_pins(card);
19101633281bSStephen Warren 
1911824ef826SLars-Peter Clausen 	snd_soc_dapm_new_widgets(card);
19128c193b8dSLars-Peter Clausen 
1913f0fba2adSLiam Girdwood 	ret = snd_card_register(card->snd_card);
1914fe3e78e0SMark Brown 	if (ret < 0) {
1915f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: failed to register soundcard %d\n",
1916f110bfc7SLiam Girdwood 				ret);
19176b3ed785SAxel Lin 		goto probe_aux_dev_err;
1918fe3e78e0SMark Brown 	}
1919fe3e78e0SMark Brown 
1920fe3e78e0SMark Brown #ifdef CONFIG_SND_SOC_AC97_BUS
1921f0fba2adSLiam Girdwood 	/* register any AC97 codecs */
1922f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
1923f0fba2adSLiam Girdwood 		ret = soc_register_ac97_dai_link(&card->rtd[i]);
1924fe3e78e0SMark Brown 		if (ret < 0) {
192510e8aa9aSMichał Mirosław 			dev_err(card->dev,
192610e8aa9aSMichał Mirosław 				"ASoC: failed to register AC97: %d\n", ret);
19276b3ed785SAxel Lin 			while (--i >= 0)
192802c9c7b9SMisael Lopez Cruz 				soc_unregister_ac97_dai_link(&card->rtd[i]);
19296b3ed785SAxel Lin 			goto probe_aux_dev_err;
1930fe3e78e0SMark Brown 		}
1931fe3e78e0SMark Brown 	}
1932fe3e78e0SMark Brown #endif
1933fe3e78e0SMark Brown 
1934435c5e25SMark Brown 	card->instantiated = 1;
19354f4c0072SMark Brown 	snd_soc_dapm_sync(&card->dapm);
1936f0fba2adSLiam Girdwood 	mutex_unlock(&card->mutex);
1937b19e6e7bSMark Brown 
1938b19e6e7bSMark Brown 	return 0;
1939db2a4165SFrank Mandarino 
19402eea392dSJarkko Nikula probe_aux_dev_err:
19412eea392dSJarkko Nikula 	for (i = 0; i < card->num_aux_devs; i++)
19422eea392dSJarkko Nikula 		soc_remove_aux_dev(card, i);
19432eea392dSJarkko Nikula 
1944f0fba2adSLiam Girdwood probe_dai_err:
19450671fd8eSKuninori Morimoto 	soc_remove_dai_links(card);
1946fe3e78e0SMark Brown 
1947f0fba2adSLiam Girdwood card_probe_error:
194887506549SMark Brown 	if (card->remove)
1949e7361ec4SMark Brown 		card->remove(card);
1950f0fba2adSLiam Girdwood 
1951f0fba2adSLiam Girdwood 	snd_card_free(card->snd_card);
1952f0fba2adSLiam Girdwood 
1953b19e6e7bSMark Brown base_error:
1954f0fba2adSLiam Girdwood 	mutex_unlock(&card->mutex);
1955db2a4165SFrank Mandarino 
1956b19e6e7bSMark Brown 	return ret;
1957435c5e25SMark Brown }
1958435c5e25SMark Brown 
1959435c5e25SMark Brown /* probes a new socdev */
1960435c5e25SMark Brown static int soc_probe(struct platform_device *pdev)
1961435c5e25SMark Brown {
1962f0fba2adSLiam Girdwood 	struct snd_soc_card *card = platform_get_drvdata(pdev);
1963435c5e25SMark Brown 
196470a7ca34SVinod Koul 	/*
196570a7ca34SVinod Koul 	 * no card, so machine driver should be registering card
196670a7ca34SVinod Koul 	 * we should not be here in that case so ret error
196770a7ca34SVinod Koul 	 */
196870a7ca34SVinod Koul 	if (!card)
196970a7ca34SVinod Koul 		return -EINVAL;
197070a7ca34SVinod Koul 
1971fe4085e8SMark Brown 	dev_warn(&pdev->dev,
1972f110bfc7SLiam Girdwood 		 "ASoC: machine %s should use snd_soc_register_card()\n",
1973fe4085e8SMark Brown 		 card->name);
1974fe4085e8SMark Brown 
1975435c5e25SMark Brown 	/* Bodge while we unpick instantiation */
1976435c5e25SMark Brown 	card->dev = &pdev->dev;
1977f0fba2adSLiam Girdwood 
197828d528c8SMark Brown 	return snd_soc_register_card(card);
1979435c5e25SMark Brown }
1980435c5e25SMark Brown 
1981b0e26485SVinod Koul static int soc_cleanup_card_resources(struct snd_soc_card *card)
1982db2a4165SFrank Mandarino {
1983db2a4165SFrank Mandarino 	int i;
1984db2a4165SFrank Mandarino 
1985f0fba2adSLiam Girdwood 	/* make sure any delayed work runs */
1986f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
1987f0fba2adSLiam Girdwood 		struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
198843829731STejun Heo 		flush_delayed_work(&rtd->delayed_work);
1989db2a4165SFrank Mandarino 	}
1990db2a4165SFrank Mandarino 
19912eea392dSJarkko Nikula 	/* remove auxiliary devices */
19922eea392dSJarkko Nikula 	for (i = 0; i < card->num_aux_devs; i++)
19932eea392dSJarkko Nikula 		soc_remove_aux_dev(card, i);
19942eea392dSJarkko Nikula 
1995f0fba2adSLiam Girdwood 	/* remove and free each DAI */
19960671fd8eSKuninori Morimoto 	soc_remove_dai_links(card);
1997f0fba2adSLiam Girdwood 
1998a6052154SJarkko Nikula 	soc_cleanup_card_debugfs(card);
1999a6052154SJarkko Nikula 
2000f0fba2adSLiam Girdwood 	/* remove the card */
200187506549SMark Brown 	if (card->remove)
2002e7361ec4SMark Brown 		card->remove(card);
2003f0fba2adSLiam Girdwood 
20040aaae527SLars-Peter Clausen 	snd_soc_dapm_free(&card->dapm);
20050aaae527SLars-Peter Clausen 
2006f0fba2adSLiam Girdwood 	snd_card_free(card->snd_card);
2007b0e26485SVinod Koul 	return 0;
2008b0e26485SVinod Koul 
2009b2dfa62cSGuennadi Liakhovetski }
2010b0e26485SVinod Koul 
2011b0e26485SVinod Koul /* removes a socdev */
2012b0e26485SVinod Koul static int soc_remove(struct platform_device *pdev)
2013b0e26485SVinod Koul {
2014b0e26485SVinod Koul 	struct snd_soc_card *card = platform_get_drvdata(pdev);
2015b0e26485SVinod Koul 
2016c5af3a2eSMark Brown 	snd_soc_unregister_card(card);
2017db2a4165SFrank Mandarino 	return 0;
2018db2a4165SFrank Mandarino }
2019db2a4165SFrank Mandarino 
20206f8ab4acSMark Brown int snd_soc_poweroff(struct device *dev)
202151737470SMark Brown {
20226f8ab4acSMark Brown 	struct snd_soc_card *card = dev_get_drvdata(dev);
2023f0fba2adSLiam Girdwood 	int i;
202451737470SMark Brown 
202551737470SMark Brown 	if (!card->instantiated)
2026416356fcSMark Brown 		return 0;
202751737470SMark Brown 
202851737470SMark Brown 	/* Flush out pmdown_time work - we actually do want to run it
202951737470SMark Brown 	 * now, we're shutting down so no imminent restart. */
2030f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
2031f0fba2adSLiam Girdwood 		struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
203243829731STejun Heo 		flush_delayed_work(&rtd->delayed_work);
2033f0fba2adSLiam Girdwood 	}
203451737470SMark Brown 
2035f0fba2adSLiam Girdwood 	snd_soc_dapm_shutdown(card);
2036416356fcSMark Brown 
2037988e8cc4SNicolin Chen 	/* deactivate pins to sleep state */
2038988e8cc4SNicolin Chen 	for (i = 0; i < card->num_rtd; i++) {
2039988e8cc4SNicolin Chen 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
2040988e8cc4SNicolin Chen 		struct snd_soc_dai *codec_dai = card->rtd[i].codec_dai;
2041988e8cc4SNicolin Chen 		pinctrl_pm_select_sleep_state(codec_dai->dev);
2042988e8cc4SNicolin Chen 		pinctrl_pm_select_sleep_state(cpu_dai->dev);
2043988e8cc4SNicolin Chen 	}
2044988e8cc4SNicolin Chen 
2045416356fcSMark Brown 	return 0;
204651737470SMark Brown }
20476f8ab4acSMark Brown EXPORT_SYMBOL_GPL(snd_soc_poweroff);
204851737470SMark Brown 
20496f8ab4acSMark Brown const struct dev_pm_ops snd_soc_pm_ops = {
2050b1dd5897SViresh Kumar 	.suspend = snd_soc_suspend,
2051b1dd5897SViresh Kumar 	.resume = snd_soc_resume,
2052b1dd5897SViresh Kumar 	.freeze = snd_soc_suspend,
2053b1dd5897SViresh Kumar 	.thaw = snd_soc_resume,
20546f8ab4acSMark Brown 	.poweroff = snd_soc_poweroff,
2055b1dd5897SViresh Kumar 	.restore = snd_soc_resume,
2056416356fcSMark Brown };
2057deb2607eSStephen Warren EXPORT_SYMBOL_GPL(snd_soc_pm_ops);
2058416356fcSMark Brown 
2059db2a4165SFrank Mandarino /* ASoC platform driver */
2060db2a4165SFrank Mandarino static struct platform_driver soc_driver = {
2061db2a4165SFrank Mandarino 	.driver		= {
2062db2a4165SFrank Mandarino 		.name		= "soc-audio",
20638b45a209SKay Sievers 		.owner		= THIS_MODULE,
20646f8ab4acSMark Brown 		.pm		= &snd_soc_pm_ops,
2065db2a4165SFrank Mandarino 	},
2066db2a4165SFrank Mandarino 	.probe		= soc_probe,
2067db2a4165SFrank Mandarino 	.remove		= soc_remove,
2068db2a4165SFrank Mandarino };
2069db2a4165SFrank Mandarino 
2070096e49d5SMark Brown /**
2071db2a4165SFrank Mandarino  * snd_soc_new_ac97_codec - initailise AC97 device
2072db2a4165SFrank Mandarino  * @codec: audio codec
2073db2a4165SFrank Mandarino  * @ops: AC97 bus operations
2074db2a4165SFrank Mandarino  * @num: AC97 codec number
2075db2a4165SFrank Mandarino  *
2076db2a4165SFrank Mandarino  * Initialises AC97 codec resources for use by ad-hoc devices only.
2077db2a4165SFrank Mandarino  */
2078db2a4165SFrank Mandarino int snd_soc_new_ac97_codec(struct snd_soc_codec *codec,
2079db2a4165SFrank Mandarino 	struct snd_ac97_bus_ops *ops, int num)
2080db2a4165SFrank Mandarino {
2081db2a4165SFrank Mandarino 	mutex_lock(&codec->mutex);
2082db2a4165SFrank Mandarino 
2083db2a4165SFrank Mandarino 	codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL);
2084db2a4165SFrank Mandarino 	if (codec->ac97 == NULL) {
2085db2a4165SFrank Mandarino 		mutex_unlock(&codec->mutex);
2086db2a4165SFrank Mandarino 		return -ENOMEM;
2087db2a4165SFrank Mandarino 	}
2088db2a4165SFrank Mandarino 
2089db2a4165SFrank Mandarino 	codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL);
2090db2a4165SFrank Mandarino 	if (codec->ac97->bus == NULL) {
2091db2a4165SFrank Mandarino 		kfree(codec->ac97);
2092db2a4165SFrank Mandarino 		codec->ac97 = NULL;
2093db2a4165SFrank Mandarino 		mutex_unlock(&codec->mutex);
2094db2a4165SFrank Mandarino 		return -ENOMEM;
2095db2a4165SFrank Mandarino 	}
2096db2a4165SFrank Mandarino 
2097db2a4165SFrank Mandarino 	codec->ac97->bus->ops = ops;
2098db2a4165SFrank Mandarino 	codec->ac97->num = num;
20990562f788SMika Westerberg 
21000562f788SMika Westerberg 	/*
21010562f788SMika Westerberg 	 * Mark the AC97 device to be created by us. This way we ensure that the
21020562f788SMika Westerberg 	 * device will be registered with the device subsystem later on.
21030562f788SMika Westerberg 	 */
21040562f788SMika Westerberg 	codec->ac97_created = 1;
21050562f788SMika Westerberg 
2106db2a4165SFrank Mandarino 	mutex_unlock(&codec->mutex);
2107db2a4165SFrank Mandarino 	return 0;
2108db2a4165SFrank Mandarino }
2109db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec);
2110db2a4165SFrank Mandarino 
2111741a509fSMarkus Pargmann static struct snd_ac97_reset_cfg snd_ac97_rst_cfg;
2112741a509fSMarkus Pargmann 
2113741a509fSMarkus Pargmann static void snd_soc_ac97_warm_reset(struct snd_ac97 *ac97)
2114741a509fSMarkus Pargmann {
2115741a509fSMarkus Pargmann 	struct pinctrl *pctl = snd_ac97_rst_cfg.pctl;
2116741a509fSMarkus Pargmann 
2117741a509fSMarkus Pargmann 	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_warm_reset);
2118741a509fSMarkus Pargmann 
2119741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 1);
2120741a509fSMarkus Pargmann 
2121741a509fSMarkus Pargmann 	udelay(10);
2122741a509fSMarkus Pargmann 
2123741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 0);
2124741a509fSMarkus Pargmann 
2125741a509fSMarkus Pargmann 	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_run);
2126741a509fSMarkus Pargmann 	msleep(2);
2127741a509fSMarkus Pargmann }
2128741a509fSMarkus Pargmann 
2129741a509fSMarkus Pargmann static void snd_soc_ac97_reset(struct snd_ac97 *ac97)
2130741a509fSMarkus Pargmann {
2131741a509fSMarkus Pargmann 	struct pinctrl *pctl = snd_ac97_rst_cfg.pctl;
2132741a509fSMarkus Pargmann 
2133741a509fSMarkus Pargmann 	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_reset);
2134741a509fSMarkus Pargmann 
2135741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 0);
2136741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_sdata, 0);
2137741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_reset, 0);
2138741a509fSMarkus Pargmann 
2139741a509fSMarkus Pargmann 	udelay(10);
2140741a509fSMarkus Pargmann 
2141741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_reset, 1);
2142741a509fSMarkus Pargmann 
2143741a509fSMarkus Pargmann 	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_run);
2144741a509fSMarkus Pargmann 	msleep(2);
2145741a509fSMarkus Pargmann }
2146741a509fSMarkus Pargmann 
2147741a509fSMarkus Pargmann static int snd_soc_ac97_parse_pinctl(struct device *dev,
2148741a509fSMarkus Pargmann 		struct snd_ac97_reset_cfg *cfg)
2149741a509fSMarkus Pargmann {
2150741a509fSMarkus Pargmann 	struct pinctrl *p;
2151741a509fSMarkus Pargmann 	struct pinctrl_state *state;
2152741a509fSMarkus Pargmann 	int gpio;
2153741a509fSMarkus Pargmann 	int ret;
2154741a509fSMarkus Pargmann 
2155741a509fSMarkus Pargmann 	p = devm_pinctrl_get(dev);
2156741a509fSMarkus Pargmann 	if (IS_ERR(p)) {
2157741a509fSMarkus Pargmann 		dev_err(dev, "Failed to get pinctrl\n");
2158b7580cdeSChristoph Jaeger 		return PTR_ERR(p);
2159741a509fSMarkus Pargmann 	}
2160741a509fSMarkus Pargmann 	cfg->pctl = p;
2161741a509fSMarkus Pargmann 
2162741a509fSMarkus Pargmann 	state = pinctrl_lookup_state(p, "ac97-reset");
2163741a509fSMarkus Pargmann 	if (IS_ERR(state)) {
2164741a509fSMarkus Pargmann 		dev_err(dev, "Can't find pinctrl state ac97-reset\n");
2165b7580cdeSChristoph Jaeger 		return PTR_ERR(state);
2166741a509fSMarkus Pargmann 	}
2167741a509fSMarkus Pargmann 	cfg->pstate_reset = state;
2168741a509fSMarkus Pargmann 
2169741a509fSMarkus Pargmann 	state = pinctrl_lookup_state(p, "ac97-warm-reset");
2170741a509fSMarkus Pargmann 	if (IS_ERR(state)) {
2171741a509fSMarkus Pargmann 		dev_err(dev, "Can't find pinctrl state ac97-warm-reset\n");
2172b7580cdeSChristoph Jaeger 		return PTR_ERR(state);
2173741a509fSMarkus Pargmann 	}
2174741a509fSMarkus Pargmann 	cfg->pstate_warm_reset = state;
2175741a509fSMarkus Pargmann 
2176741a509fSMarkus Pargmann 	state = pinctrl_lookup_state(p, "ac97-running");
2177741a509fSMarkus Pargmann 	if (IS_ERR(state)) {
2178741a509fSMarkus Pargmann 		dev_err(dev, "Can't find pinctrl state ac97-running\n");
2179b7580cdeSChristoph Jaeger 		return PTR_ERR(state);
2180741a509fSMarkus Pargmann 	}
2181741a509fSMarkus Pargmann 	cfg->pstate_run = state;
2182741a509fSMarkus Pargmann 
2183741a509fSMarkus Pargmann 	gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 0);
2184741a509fSMarkus Pargmann 	if (gpio < 0) {
2185741a509fSMarkus Pargmann 		dev_err(dev, "Can't find ac97-sync gpio\n");
2186741a509fSMarkus Pargmann 		return gpio;
2187741a509fSMarkus Pargmann 	}
2188741a509fSMarkus Pargmann 	ret = devm_gpio_request(dev, gpio, "AC97 link sync");
2189741a509fSMarkus Pargmann 	if (ret) {
2190741a509fSMarkus Pargmann 		dev_err(dev, "Failed requesting ac97-sync gpio\n");
2191741a509fSMarkus Pargmann 		return ret;
2192741a509fSMarkus Pargmann 	}
2193741a509fSMarkus Pargmann 	cfg->gpio_sync = gpio;
2194741a509fSMarkus Pargmann 
2195741a509fSMarkus Pargmann 	gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 1);
2196741a509fSMarkus Pargmann 	if (gpio < 0) {
2197741a509fSMarkus Pargmann 		dev_err(dev, "Can't find ac97-sdata gpio %d\n", gpio);
2198741a509fSMarkus Pargmann 		return gpio;
2199741a509fSMarkus Pargmann 	}
2200741a509fSMarkus Pargmann 	ret = devm_gpio_request(dev, gpio, "AC97 link sdata");
2201741a509fSMarkus Pargmann 	if (ret) {
2202741a509fSMarkus Pargmann 		dev_err(dev, "Failed requesting ac97-sdata gpio\n");
2203741a509fSMarkus Pargmann 		return ret;
2204741a509fSMarkus Pargmann 	}
2205741a509fSMarkus Pargmann 	cfg->gpio_sdata = gpio;
2206741a509fSMarkus Pargmann 
2207741a509fSMarkus Pargmann 	gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 2);
2208741a509fSMarkus Pargmann 	if (gpio < 0) {
2209741a509fSMarkus Pargmann 		dev_err(dev, "Can't find ac97-reset gpio\n");
2210741a509fSMarkus Pargmann 		return gpio;
2211741a509fSMarkus Pargmann 	}
2212741a509fSMarkus Pargmann 	ret = devm_gpio_request(dev, gpio, "AC97 link reset");
2213741a509fSMarkus Pargmann 	if (ret) {
2214741a509fSMarkus Pargmann 		dev_err(dev, "Failed requesting ac97-reset gpio\n");
2215741a509fSMarkus Pargmann 		return ret;
2216741a509fSMarkus Pargmann 	}
2217741a509fSMarkus Pargmann 	cfg->gpio_reset = gpio;
2218741a509fSMarkus Pargmann 
2219741a509fSMarkus Pargmann 	return 0;
2220741a509fSMarkus Pargmann }
2221741a509fSMarkus Pargmann 
2222b047e1ccSMark Brown struct snd_ac97_bus_ops *soc_ac97_ops;
2223f74b5e25SKevin Hilman EXPORT_SYMBOL_GPL(soc_ac97_ops);
2224b047e1ccSMark Brown 
2225b047e1ccSMark Brown int snd_soc_set_ac97_ops(struct snd_ac97_bus_ops *ops)
2226b047e1ccSMark Brown {
2227b047e1ccSMark Brown 	if (ops == soc_ac97_ops)
2228b047e1ccSMark Brown 		return 0;
2229b047e1ccSMark Brown 
2230b047e1ccSMark Brown 	if (soc_ac97_ops && ops)
2231b047e1ccSMark Brown 		return -EBUSY;
2232b047e1ccSMark Brown 
2233b047e1ccSMark Brown 	soc_ac97_ops = ops;
2234b047e1ccSMark Brown 
2235b047e1ccSMark Brown 	return 0;
2236b047e1ccSMark Brown }
2237b047e1ccSMark Brown EXPORT_SYMBOL_GPL(snd_soc_set_ac97_ops);
2238b047e1ccSMark Brown 
2239db2a4165SFrank Mandarino /**
2240741a509fSMarkus Pargmann  * snd_soc_set_ac97_ops_of_reset - Set ac97 ops with generic ac97 reset functions
2241741a509fSMarkus Pargmann  *
2242741a509fSMarkus Pargmann  * This function sets the reset and warm_reset properties of ops and parses
2243741a509fSMarkus Pargmann  * the device node of pdev to get pinctrl states and gpio numbers to use.
2244741a509fSMarkus Pargmann  */
2245741a509fSMarkus Pargmann int snd_soc_set_ac97_ops_of_reset(struct snd_ac97_bus_ops *ops,
2246741a509fSMarkus Pargmann 		struct platform_device *pdev)
2247741a509fSMarkus Pargmann {
2248741a509fSMarkus Pargmann 	struct device *dev = &pdev->dev;
2249741a509fSMarkus Pargmann 	struct snd_ac97_reset_cfg cfg;
2250741a509fSMarkus Pargmann 	int ret;
2251741a509fSMarkus Pargmann 
2252741a509fSMarkus Pargmann 	ret = snd_soc_ac97_parse_pinctl(dev, &cfg);
2253741a509fSMarkus Pargmann 	if (ret)
2254741a509fSMarkus Pargmann 		return ret;
2255741a509fSMarkus Pargmann 
2256741a509fSMarkus Pargmann 	ret = snd_soc_set_ac97_ops(ops);
2257741a509fSMarkus Pargmann 	if (ret)
2258741a509fSMarkus Pargmann 		return ret;
2259741a509fSMarkus Pargmann 
2260741a509fSMarkus Pargmann 	ops->warm_reset = snd_soc_ac97_warm_reset;
2261741a509fSMarkus Pargmann 	ops->reset = snd_soc_ac97_reset;
2262741a509fSMarkus Pargmann 
2263741a509fSMarkus Pargmann 	snd_ac97_rst_cfg = cfg;
2264741a509fSMarkus Pargmann 	return 0;
2265741a509fSMarkus Pargmann }
2266741a509fSMarkus Pargmann EXPORT_SYMBOL_GPL(snd_soc_set_ac97_ops_of_reset);
2267741a509fSMarkus Pargmann 
2268741a509fSMarkus Pargmann /**
2269db2a4165SFrank Mandarino  * snd_soc_free_ac97_codec - free AC97 codec device
2270db2a4165SFrank Mandarino  * @codec: audio codec
2271db2a4165SFrank Mandarino  *
2272db2a4165SFrank Mandarino  * Frees AC97 codec device resources.
2273db2a4165SFrank Mandarino  */
2274db2a4165SFrank Mandarino void snd_soc_free_ac97_codec(struct snd_soc_codec *codec)
2275db2a4165SFrank Mandarino {
2276db2a4165SFrank Mandarino 	mutex_lock(&codec->mutex);
2277f0fba2adSLiam Girdwood #ifdef CONFIG_SND_SOC_AC97_BUS
227802c9c7b9SMisael Lopez Cruz 	soc_unregister_ac97_codec(codec);
2279f0fba2adSLiam Girdwood #endif
2280db2a4165SFrank Mandarino 	kfree(codec->ac97->bus);
2281db2a4165SFrank Mandarino 	kfree(codec->ac97);
2282db2a4165SFrank Mandarino 	codec->ac97 = NULL;
22830562f788SMika Westerberg 	codec->ac97_created = 0;
2284db2a4165SFrank Mandarino 	mutex_unlock(&codec->mutex);
2285db2a4165SFrank Mandarino }
2286db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec);
2287db2a4165SFrank Mandarino 
2288db2a4165SFrank Mandarino /**
2289db2a4165SFrank Mandarino  * snd_soc_cnew - create new control
2290db2a4165SFrank Mandarino  * @_template: control template
2291db2a4165SFrank Mandarino  * @data: control private data
2292ac11a2b3SMark Brown  * @long_name: control long name
2293efb7ac3fSMark Brown  * @prefix: control name prefix
2294db2a4165SFrank Mandarino  *
2295db2a4165SFrank Mandarino  * Create a new mixer control from a template control.
2296db2a4165SFrank Mandarino  *
2297db2a4165SFrank Mandarino  * Returns 0 for success, else error.
2298db2a4165SFrank Mandarino  */
2299db2a4165SFrank Mandarino struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
23003056557fSMark Brown 				  void *data, const char *long_name,
2301efb7ac3fSMark Brown 				  const char *prefix)
2302db2a4165SFrank Mandarino {
2303db2a4165SFrank Mandarino 	struct snd_kcontrol_new template;
2304efb7ac3fSMark Brown 	struct snd_kcontrol *kcontrol;
2305efb7ac3fSMark Brown 	char *name = NULL;
2306db2a4165SFrank Mandarino 
2307db2a4165SFrank Mandarino 	memcpy(&template, _template, sizeof(template));
2308db2a4165SFrank Mandarino 	template.index = 0;
2309db2a4165SFrank Mandarino 
2310efb7ac3fSMark Brown 	if (!long_name)
2311efb7ac3fSMark Brown 		long_name = template.name;
2312efb7ac3fSMark Brown 
2313efb7ac3fSMark Brown 	if (prefix) {
23142b581074SLars-Peter Clausen 		name = kasprintf(GFP_KERNEL, "%s %s", prefix, long_name);
2315efb7ac3fSMark Brown 		if (!name)
2316efb7ac3fSMark Brown 			return NULL;
2317efb7ac3fSMark Brown 
2318efb7ac3fSMark Brown 		template.name = name;
2319efb7ac3fSMark Brown 	} else {
2320efb7ac3fSMark Brown 		template.name = long_name;
2321efb7ac3fSMark Brown 	}
2322efb7ac3fSMark Brown 
2323efb7ac3fSMark Brown 	kcontrol = snd_ctl_new1(&template, data);
2324efb7ac3fSMark Brown 
2325efb7ac3fSMark Brown 	kfree(name);
2326efb7ac3fSMark Brown 
2327efb7ac3fSMark Brown 	return kcontrol;
2328db2a4165SFrank Mandarino }
2329db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_cnew);
2330db2a4165SFrank Mandarino 
2331022658beSLiam Girdwood static int snd_soc_add_controls(struct snd_card *card, struct device *dev,
2332022658beSLiam Girdwood 	const struct snd_kcontrol_new *controls, int num_controls,
2333022658beSLiam Girdwood 	const char *prefix, void *data)
2334022658beSLiam Girdwood {
2335022658beSLiam Girdwood 	int err, i;
2336022658beSLiam Girdwood 
2337022658beSLiam Girdwood 	for (i = 0; i < num_controls; i++) {
2338022658beSLiam Girdwood 		const struct snd_kcontrol_new *control = &controls[i];
2339022658beSLiam Girdwood 		err = snd_ctl_add(card, snd_soc_cnew(control, data,
2340022658beSLiam Girdwood 						     control->name, prefix));
2341022658beSLiam Girdwood 		if (err < 0) {
2342f110bfc7SLiam Girdwood 			dev_err(dev, "ASoC: Failed to add %s: %d\n",
2343f110bfc7SLiam Girdwood 				control->name, err);
2344022658beSLiam Girdwood 			return err;
2345022658beSLiam Girdwood 		}
2346022658beSLiam Girdwood 	}
2347022658beSLiam Girdwood 
2348022658beSLiam Girdwood 	return 0;
2349022658beSLiam Girdwood }
2350022658beSLiam Girdwood 
23514fefd698SDimitris Papastamos struct snd_kcontrol *snd_soc_card_get_kcontrol(struct snd_soc_card *soc_card,
23524fefd698SDimitris Papastamos 					       const char *name)
23534fefd698SDimitris Papastamos {
23544fefd698SDimitris Papastamos 	struct snd_card *card = soc_card->snd_card;
23554fefd698SDimitris Papastamos 	struct snd_kcontrol *kctl;
23564fefd698SDimitris Papastamos 
23574fefd698SDimitris Papastamos 	if (unlikely(!name))
23584fefd698SDimitris Papastamos 		return NULL;
23594fefd698SDimitris Papastamos 
23604fefd698SDimitris Papastamos 	list_for_each_entry(kctl, &card->controls, list)
23614fefd698SDimitris Papastamos 		if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name)))
23624fefd698SDimitris Papastamos 			return kctl;
23634fefd698SDimitris Papastamos 	return NULL;
23644fefd698SDimitris Papastamos }
23654fefd698SDimitris Papastamos EXPORT_SYMBOL_GPL(snd_soc_card_get_kcontrol);
23664fefd698SDimitris Papastamos 
2367db2a4165SFrank Mandarino /**
2368022658beSLiam Girdwood  * snd_soc_add_codec_controls - add an array of controls to a codec.
2369022658beSLiam Girdwood  * Convenience function to add a list of controls. Many codecs were
23703e8e1952SIan Molton  * duplicating this code.
23713e8e1952SIan Molton  *
23723e8e1952SIan Molton  * @codec: codec to add controls to
23733e8e1952SIan Molton  * @controls: array of controls to add
23743e8e1952SIan Molton  * @num_controls: number of elements in the array
23753e8e1952SIan Molton  *
23763e8e1952SIan Molton  * Return 0 for success, else error.
23773e8e1952SIan Molton  */
2378022658beSLiam Girdwood int snd_soc_add_codec_controls(struct snd_soc_codec *codec,
23793e8e1952SIan Molton 	const struct snd_kcontrol_new *controls, int num_controls)
23803e8e1952SIan Molton {
2381f0fba2adSLiam Girdwood 	struct snd_card *card = codec->card->snd_card;
23823e8e1952SIan Molton 
2383022658beSLiam Girdwood 	return snd_soc_add_controls(card, codec->dev, controls, num_controls,
238494f99c87SLars-Peter Clausen 			codec->component.name_prefix, &codec->component);
23853e8e1952SIan Molton }
2386022658beSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_add_codec_controls);
23873e8e1952SIan Molton 
23883e8e1952SIan Molton /**
2389a491a5c8SLiam Girdwood  * snd_soc_add_platform_controls - add an array of controls to a platform.
2390022658beSLiam Girdwood  * Convenience function to add a list of controls.
2391a491a5c8SLiam Girdwood  *
2392a491a5c8SLiam Girdwood  * @platform: platform to add controls to
2393a491a5c8SLiam Girdwood  * @controls: array of controls to add
2394a491a5c8SLiam Girdwood  * @num_controls: number of elements in the array
2395a491a5c8SLiam Girdwood  *
2396a491a5c8SLiam Girdwood  * Return 0 for success, else error.
2397a491a5c8SLiam Girdwood  */
2398a491a5c8SLiam Girdwood int snd_soc_add_platform_controls(struct snd_soc_platform *platform,
2399a491a5c8SLiam Girdwood 	const struct snd_kcontrol_new *controls, int num_controls)
2400a491a5c8SLiam Girdwood {
2401a491a5c8SLiam Girdwood 	struct snd_card *card = platform->card->snd_card;
2402a491a5c8SLiam Girdwood 
2403022658beSLiam Girdwood 	return snd_soc_add_controls(card, platform->dev, controls, num_controls,
2404907fe36aSLars-Peter Clausen 			NULL, &platform->component);
2405a491a5c8SLiam Girdwood }
2406a491a5c8SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_add_platform_controls);
2407a491a5c8SLiam Girdwood 
2408a491a5c8SLiam Girdwood /**
2409022658beSLiam Girdwood  * snd_soc_add_card_controls - add an array of controls to a SoC card.
2410022658beSLiam Girdwood  * Convenience function to add a list of controls.
2411022658beSLiam Girdwood  *
2412022658beSLiam Girdwood  * @soc_card: SoC card to add controls to
2413022658beSLiam Girdwood  * @controls: array of controls to add
2414022658beSLiam Girdwood  * @num_controls: number of elements in the array
2415022658beSLiam Girdwood  *
2416022658beSLiam Girdwood  * Return 0 for success, else error.
2417022658beSLiam Girdwood  */
2418022658beSLiam Girdwood int snd_soc_add_card_controls(struct snd_soc_card *soc_card,
2419022658beSLiam Girdwood 	const struct snd_kcontrol_new *controls, int num_controls)
2420022658beSLiam Girdwood {
2421022658beSLiam Girdwood 	struct snd_card *card = soc_card->snd_card;
2422022658beSLiam Girdwood 
2423022658beSLiam Girdwood 	return snd_soc_add_controls(card, soc_card->dev, controls, num_controls,
2424022658beSLiam Girdwood 			NULL, soc_card);
2425022658beSLiam Girdwood }
2426022658beSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_add_card_controls);
2427022658beSLiam Girdwood 
2428022658beSLiam Girdwood /**
2429022658beSLiam Girdwood  * snd_soc_add_dai_controls - add an array of controls to a DAI.
2430022658beSLiam Girdwood  * Convienience function to add a list of controls.
2431022658beSLiam Girdwood  *
2432022658beSLiam Girdwood  * @dai: DAI to add controls to
2433022658beSLiam Girdwood  * @controls: array of controls to add
2434022658beSLiam Girdwood  * @num_controls: number of elements in the array
2435022658beSLiam Girdwood  *
2436022658beSLiam Girdwood  * Return 0 for success, else error.
2437022658beSLiam Girdwood  */
2438022658beSLiam Girdwood int snd_soc_add_dai_controls(struct snd_soc_dai *dai,
2439022658beSLiam Girdwood 	const struct snd_kcontrol_new *controls, int num_controls)
2440022658beSLiam Girdwood {
2441022658beSLiam Girdwood 	struct snd_card *card = dai->card->snd_card;
2442022658beSLiam Girdwood 
2443022658beSLiam Girdwood 	return snd_soc_add_controls(card, dai->dev, controls, num_controls,
2444022658beSLiam Girdwood 			NULL, dai);
2445022658beSLiam Girdwood }
2446022658beSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_add_dai_controls);
2447022658beSLiam Girdwood 
2448022658beSLiam Girdwood /**
2449db2a4165SFrank Mandarino  * snd_soc_info_enum_double - enumerated double mixer info callback
2450db2a4165SFrank Mandarino  * @kcontrol: mixer control
2451db2a4165SFrank Mandarino  * @uinfo: control element information
2452db2a4165SFrank Mandarino  *
2453db2a4165SFrank Mandarino  * Callback to provide information about a double enumerated
2454db2a4165SFrank Mandarino  * mixer control.
2455db2a4165SFrank Mandarino  *
2456db2a4165SFrank Mandarino  * Returns 0 for success.
2457db2a4165SFrank Mandarino  */
2458db2a4165SFrank Mandarino int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol,
2459db2a4165SFrank Mandarino 	struct snd_ctl_elem_info *uinfo)
2460db2a4165SFrank Mandarino {
2461db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2462db2a4165SFrank Mandarino 
2463db2a4165SFrank Mandarino 	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2464db2a4165SFrank Mandarino 	uinfo->count = e->shift_l == e->shift_r ? 1 : 2;
24659a8d38dbSTakashi Iwai 	uinfo->value.enumerated.items = e->items;
2466db2a4165SFrank Mandarino 
24679a8d38dbSTakashi Iwai 	if (uinfo->value.enumerated.item >= e->items)
24689a8d38dbSTakashi Iwai 		uinfo->value.enumerated.item = e->items - 1;
2469a19685cbSTakashi Iwai 	strlcpy(uinfo->value.enumerated.name,
2470a19685cbSTakashi Iwai 		e->texts[uinfo->value.enumerated.item],
2471a19685cbSTakashi Iwai 		sizeof(uinfo->value.enumerated.name));
2472db2a4165SFrank Mandarino 	return 0;
2473db2a4165SFrank Mandarino }
2474db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
2475db2a4165SFrank Mandarino 
2476db2a4165SFrank Mandarino /**
2477db2a4165SFrank Mandarino  * snd_soc_get_enum_double - enumerated double mixer get callback
2478db2a4165SFrank Mandarino  * @kcontrol: mixer control
2479ac11a2b3SMark Brown  * @ucontrol: control element information
2480db2a4165SFrank Mandarino  *
2481db2a4165SFrank Mandarino  * Callback to get the value of a double enumerated mixer.
2482db2a4165SFrank Mandarino  *
2483db2a4165SFrank Mandarino  * Returns 0 for success.
2484db2a4165SFrank Mandarino  */
2485db2a4165SFrank Mandarino int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol,
2486db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
2487db2a4165SFrank Mandarino {
2488907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
2489db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
249029ae2fa5SLars-Peter Clausen 	unsigned int val, item;
249129ae2fa5SLars-Peter Clausen 	unsigned int reg_val;
2492907fe36aSLars-Peter Clausen 	int ret;
2493db2a4165SFrank Mandarino 
2494907fe36aSLars-Peter Clausen 	ret = snd_soc_component_read(component, e->reg, &reg_val);
2495907fe36aSLars-Peter Clausen 	if (ret)
2496907fe36aSLars-Peter Clausen 		return ret;
249729ae2fa5SLars-Peter Clausen 	val = (reg_val >> e->shift_l) & e->mask;
249829ae2fa5SLars-Peter Clausen 	item = snd_soc_enum_val_to_item(e, val);
249929ae2fa5SLars-Peter Clausen 	ucontrol->value.enumerated.item[0] = item;
250029ae2fa5SLars-Peter Clausen 	if (e->shift_l != e->shift_r) {
250129ae2fa5SLars-Peter Clausen 		val = (reg_val >> e->shift_l) & e->mask;
250229ae2fa5SLars-Peter Clausen 		item = snd_soc_enum_val_to_item(e, val);
250329ae2fa5SLars-Peter Clausen 		ucontrol->value.enumerated.item[1] = item;
250429ae2fa5SLars-Peter Clausen 	}
2505db2a4165SFrank Mandarino 
2506db2a4165SFrank Mandarino 	return 0;
2507db2a4165SFrank Mandarino }
2508db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
2509db2a4165SFrank Mandarino 
2510db2a4165SFrank Mandarino /**
2511db2a4165SFrank Mandarino  * snd_soc_put_enum_double - enumerated double mixer put callback
2512db2a4165SFrank Mandarino  * @kcontrol: mixer control
2513ac11a2b3SMark Brown  * @ucontrol: control element information
2514db2a4165SFrank Mandarino  *
2515db2a4165SFrank Mandarino  * Callback to set the value of a double enumerated mixer.
2516db2a4165SFrank Mandarino  *
2517db2a4165SFrank Mandarino  * Returns 0 for success.
2518db2a4165SFrank Mandarino  */
2519db2a4165SFrank Mandarino int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol,
2520db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
2521db2a4165SFrank Mandarino {
2522907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
2523db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
252429ae2fa5SLars-Peter Clausen 	unsigned int *item = ucontrol->value.enumerated.item;
252546f5822fSDaniel Ribeiro 	unsigned int val;
252686767b7dSLars-Peter Clausen 	unsigned int mask;
2527db2a4165SFrank Mandarino 
252829ae2fa5SLars-Peter Clausen 	if (item[0] >= e->items)
2529db2a4165SFrank Mandarino 		return -EINVAL;
253029ae2fa5SLars-Peter Clausen 	val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l;
253186767b7dSLars-Peter Clausen 	mask = e->mask << e->shift_l;
2532db2a4165SFrank Mandarino 	if (e->shift_l != e->shift_r) {
253329ae2fa5SLars-Peter Clausen 		if (item[1] >= e->items)
2534db2a4165SFrank Mandarino 			return -EINVAL;
253529ae2fa5SLars-Peter Clausen 		val |= snd_soc_enum_item_to_val(e, item[1]) << e->shift_r;
253686767b7dSLars-Peter Clausen 		mask |= e->mask << e->shift_r;
2537db2a4165SFrank Mandarino 	}
2538db2a4165SFrank Mandarino 
2539907fe36aSLars-Peter Clausen 	return snd_soc_component_update_bits(component, e->reg, mask, val);
2540db2a4165SFrank Mandarino }
2541db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
2542db2a4165SFrank Mandarino 
2543db2a4165SFrank Mandarino /**
2544f227b88fSMarkus Pargmann  * snd_soc_read_signed - Read a codec register and interprete as signed value
2545907fe36aSLars-Peter Clausen  * @component: component
2546f227b88fSMarkus Pargmann  * @reg: Register to read
2547f227b88fSMarkus Pargmann  * @mask: Mask to use after shifting the register value
2548f227b88fSMarkus Pargmann  * @shift: Right shift of register value
2549f227b88fSMarkus Pargmann  * @sign_bit: Bit that describes if a number is negative or not.
2550907fe36aSLars-Peter Clausen  * @signed_val: Pointer to where the read value should be stored
25512e72f8e3SPeter Ujfalusi  *
2552f227b88fSMarkus Pargmann  * This functions reads a codec register. The register value is shifted right
2553f227b88fSMarkus Pargmann  * by 'shift' bits and masked with the given 'mask'. Afterwards it translates
2554f227b88fSMarkus Pargmann  * the given registervalue into a signed integer if sign_bit is non-zero.
25552e72f8e3SPeter Ujfalusi  *
2556907fe36aSLars-Peter Clausen  * Returns 0 on sucess, otherwise an error value
25572e72f8e3SPeter Ujfalusi  */
2558907fe36aSLars-Peter Clausen static int snd_soc_read_signed(struct snd_soc_component *component,
2559907fe36aSLars-Peter Clausen 	unsigned int reg, unsigned int mask, unsigned int shift,
2560907fe36aSLars-Peter Clausen 	unsigned int sign_bit, int *signed_val)
25612e72f8e3SPeter Ujfalusi {
2562f227b88fSMarkus Pargmann 	int ret;
256346f5822fSDaniel Ribeiro 	unsigned int val;
25642e72f8e3SPeter Ujfalusi 
2565907fe36aSLars-Peter Clausen 	ret = snd_soc_component_read(component, reg, &val);
2566907fe36aSLars-Peter Clausen 	if (ret < 0)
2567907fe36aSLars-Peter Clausen 		return ret;
25682e72f8e3SPeter Ujfalusi 
2569907fe36aSLars-Peter Clausen 	val = (val >> shift) & mask;
2570907fe36aSLars-Peter Clausen 
2571907fe36aSLars-Peter Clausen 	if (!sign_bit) {
2572907fe36aSLars-Peter Clausen 		*signed_val = val;
2573907fe36aSLars-Peter Clausen 		return 0;
2574907fe36aSLars-Peter Clausen 	}
2575f227b88fSMarkus Pargmann 
2576f227b88fSMarkus Pargmann 	/* non-negative number */
2577907fe36aSLars-Peter Clausen 	if (!(val & BIT(sign_bit))) {
2578907fe36aSLars-Peter Clausen 		*signed_val = val;
2579907fe36aSLars-Peter Clausen 		return 0;
2580907fe36aSLars-Peter Clausen 	}
2581f227b88fSMarkus Pargmann 
2582f227b88fSMarkus Pargmann 	ret = val;
2583f227b88fSMarkus Pargmann 
2584f227b88fSMarkus Pargmann 	/*
2585f227b88fSMarkus Pargmann 	 * The register most probably does not contain a full-sized int.
2586f227b88fSMarkus Pargmann 	 * Instead we have an arbitrary number of bits in a signed
2587f227b88fSMarkus Pargmann 	 * representation which has to be translated into a full-sized int.
2588f227b88fSMarkus Pargmann 	 * This is done by filling up all bits above the sign-bit.
2589f227b88fSMarkus Pargmann 	 */
2590f227b88fSMarkus Pargmann 	ret |= ~((int)(BIT(sign_bit) - 1));
2591f227b88fSMarkus Pargmann 
2592907fe36aSLars-Peter Clausen 	*signed_val = ret;
2593907fe36aSLars-Peter Clausen 
2594907fe36aSLars-Peter Clausen 	return 0;
25952e72f8e3SPeter Ujfalusi }
25962e72f8e3SPeter Ujfalusi 
25972e72f8e3SPeter Ujfalusi /**
2598db2a4165SFrank Mandarino  * snd_soc_info_volsw - single mixer info callback
2599db2a4165SFrank Mandarino  * @kcontrol: mixer control
2600db2a4165SFrank Mandarino  * @uinfo: control element information
2601db2a4165SFrank Mandarino  *
2602e8f5a103SPeter Ujfalusi  * Callback to provide information about a single mixer control, or a double
2603e8f5a103SPeter Ujfalusi  * mixer control that spans 2 registers.
2604db2a4165SFrank Mandarino  *
2605db2a4165SFrank Mandarino  * Returns 0 for success.
2606db2a4165SFrank Mandarino  */
2607db2a4165SFrank Mandarino int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
2608db2a4165SFrank Mandarino 	struct snd_ctl_elem_info *uinfo)
2609db2a4165SFrank Mandarino {
26104eaa9819SJon Smirl 	struct soc_mixer_control *mc =
26114eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2612d11bb4a9SPeter Ujfalusi 	int platform_max;
2613db2a4165SFrank Mandarino 
2614d11bb4a9SPeter Ujfalusi 	if (!mc->platform_max)
2615d11bb4a9SPeter Ujfalusi 		mc->platform_max = mc->max;
2616d11bb4a9SPeter Ujfalusi 	platform_max = mc->platform_max;
2617d11bb4a9SPeter Ujfalusi 
2618d11bb4a9SPeter Ujfalusi 	if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
2619a7a4ac86SPhilipp Zabel 		uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2620a7a4ac86SPhilipp Zabel 	else
2621a7a4ac86SPhilipp Zabel 		uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2622a7a4ac86SPhilipp Zabel 
2623e8f5a103SPeter Ujfalusi 	uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
2624db2a4165SFrank Mandarino 	uinfo->value.integer.min = 0;
2625f227b88fSMarkus Pargmann 	uinfo->value.integer.max = platform_max - mc->min;
2626db2a4165SFrank Mandarino 	return 0;
2627db2a4165SFrank Mandarino }
2628db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
2629db2a4165SFrank Mandarino 
2630db2a4165SFrank Mandarino /**
2631db2a4165SFrank Mandarino  * snd_soc_get_volsw - single mixer get callback
2632db2a4165SFrank Mandarino  * @kcontrol: mixer control
2633ac11a2b3SMark Brown  * @ucontrol: control element information
2634db2a4165SFrank Mandarino  *
2635f7915d99SPeter Ujfalusi  * Callback to get the value of a single mixer control, or a double mixer
2636f7915d99SPeter Ujfalusi  * control that spans 2 registers.
2637db2a4165SFrank Mandarino  *
2638db2a4165SFrank Mandarino  * Returns 0 for success.
2639db2a4165SFrank Mandarino  */
2640db2a4165SFrank Mandarino int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
2641db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
2642db2a4165SFrank Mandarino {
2643907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
26444eaa9819SJon Smirl 	struct soc_mixer_control *mc =
26454eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2646815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
2647f7915d99SPeter Ujfalusi 	unsigned int reg2 = mc->rreg;
2648815ecf8dSJon Smirl 	unsigned int shift = mc->shift;
2649815ecf8dSJon Smirl 	unsigned int rshift = mc->rshift;
26504eaa9819SJon Smirl 	int max = mc->max;
2651f227b88fSMarkus Pargmann 	int min = mc->min;
2652f227b88fSMarkus Pargmann 	int sign_bit = mc->sign_bit;
2653815ecf8dSJon Smirl 	unsigned int mask = (1 << fls(max)) - 1;
2654815ecf8dSJon Smirl 	unsigned int invert = mc->invert;
2655907fe36aSLars-Peter Clausen 	int val;
2656907fe36aSLars-Peter Clausen 	int ret;
2657db2a4165SFrank Mandarino 
2658f227b88fSMarkus Pargmann 	if (sign_bit)
2659f227b88fSMarkus Pargmann 		mask = BIT(sign_bit + 1) - 1;
2660f227b88fSMarkus Pargmann 
2661907fe36aSLars-Peter Clausen 	ret = snd_soc_read_signed(component, reg, mask, shift, sign_bit, &val);
2662907fe36aSLars-Peter Clausen 	if (ret)
2663907fe36aSLars-Peter Clausen 		return ret;
2664907fe36aSLars-Peter Clausen 
2665907fe36aSLars-Peter Clausen 	ucontrol->value.integer.value[0] = val - min;
2666f7915d99SPeter Ujfalusi 	if (invert)
2667db2a4165SFrank Mandarino 		ucontrol->value.integer.value[0] =
2668a7a4ac86SPhilipp Zabel 			max - ucontrol->value.integer.value[0];
2669f7915d99SPeter Ujfalusi 
2670f7915d99SPeter Ujfalusi 	if (snd_soc_volsw_is_stereo(mc)) {
2671f7915d99SPeter Ujfalusi 		if (reg == reg2)
2672907fe36aSLars-Peter Clausen 			ret = snd_soc_read_signed(component, reg, mask, rshift,
2673907fe36aSLars-Peter Clausen 				sign_bit, &val);
2674f7915d99SPeter Ujfalusi 		else
2675907fe36aSLars-Peter Clausen 			ret = snd_soc_read_signed(component, reg2, mask, shift,
2676907fe36aSLars-Peter Clausen 				sign_bit, &val);
2677907fe36aSLars-Peter Clausen 		if (ret)
2678907fe36aSLars-Peter Clausen 			return ret;
2679907fe36aSLars-Peter Clausen 
2680907fe36aSLars-Peter Clausen 		ucontrol->value.integer.value[1] = val - min;
2681f7915d99SPeter Ujfalusi 		if (invert)
2682db2a4165SFrank Mandarino 			ucontrol->value.integer.value[1] =
2683a7a4ac86SPhilipp Zabel 				max - ucontrol->value.integer.value[1];
2684db2a4165SFrank Mandarino 	}
2685db2a4165SFrank Mandarino 
2686db2a4165SFrank Mandarino 	return 0;
2687db2a4165SFrank Mandarino }
2688db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
2689db2a4165SFrank Mandarino 
2690db2a4165SFrank Mandarino /**
2691db2a4165SFrank Mandarino  * snd_soc_put_volsw - single mixer put callback
2692db2a4165SFrank Mandarino  * @kcontrol: mixer control
2693ac11a2b3SMark Brown  * @ucontrol: control element information
2694db2a4165SFrank Mandarino  *
2695974815baSPeter Ujfalusi  * Callback to set the value of a single mixer control, or a double mixer
2696974815baSPeter Ujfalusi  * control that spans 2 registers.
2697db2a4165SFrank Mandarino  *
2698db2a4165SFrank Mandarino  * Returns 0 for success.
2699db2a4165SFrank Mandarino  */
2700db2a4165SFrank Mandarino int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
2701db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
2702db2a4165SFrank Mandarino {
2703907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
27044eaa9819SJon Smirl 	struct soc_mixer_control *mc =
27054eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2706815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
2707974815baSPeter Ujfalusi 	unsigned int reg2 = mc->rreg;
2708815ecf8dSJon Smirl 	unsigned int shift = mc->shift;
2709815ecf8dSJon Smirl 	unsigned int rshift = mc->rshift;
27104eaa9819SJon Smirl 	int max = mc->max;
2711f227b88fSMarkus Pargmann 	int min = mc->min;
2712f227b88fSMarkus Pargmann 	unsigned int sign_bit = mc->sign_bit;
2713815ecf8dSJon Smirl 	unsigned int mask = (1 << fls(max)) - 1;
2714815ecf8dSJon Smirl 	unsigned int invert = mc->invert;
2715974815baSPeter Ujfalusi 	int err;
2716939d9f16SNenghua Cao 	bool type_2r = false;
2717974815baSPeter Ujfalusi 	unsigned int val2 = 0;
2718974815baSPeter Ujfalusi 	unsigned int val, val_mask;
2719db2a4165SFrank Mandarino 
2720f227b88fSMarkus Pargmann 	if (sign_bit)
2721f227b88fSMarkus Pargmann 		mask = BIT(sign_bit + 1) - 1;
2722f227b88fSMarkus Pargmann 
2723f227b88fSMarkus Pargmann 	val = ((ucontrol->value.integer.value[0] + min) & mask);
2724db2a4165SFrank Mandarino 	if (invert)
2725a7a4ac86SPhilipp Zabel 		val = max - val;
2726db2a4165SFrank Mandarino 	val_mask = mask << shift;
2727db2a4165SFrank Mandarino 	val = val << shift;
2728974815baSPeter Ujfalusi 	if (snd_soc_volsw_is_stereo(mc)) {
2729f227b88fSMarkus Pargmann 		val2 = ((ucontrol->value.integer.value[1] + min) & mask);
2730db2a4165SFrank Mandarino 		if (invert)
2731a7a4ac86SPhilipp Zabel 			val2 = max - val2;
2732974815baSPeter Ujfalusi 		if (reg == reg2) {
2733db2a4165SFrank Mandarino 			val_mask |= mask << rshift;
2734db2a4165SFrank Mandarino 			val |= val2 << rshift;
2735974815baSPeter Ujfalusi 		} else {
2736db2a4165SFrank Mandarino 			val2 = val2 << shift;
2737939d9f16SNenghua Cao 			type_2r = true;
2738974815baSPeter Ujfalusi 		}
2739974815baSPeter Ujfalusi 	}
2740907fe36aSLars-Peter Clausen 	err = snd_soc_component_update_bits(component, reg, val_mask, val);
27413ff3f64bSMark Brown 	if (err < 0)
2742db2a4165SFrank Mandarino 		return err;
2743db2a4165SFrank Mandarino 
2744974815baSPeter Ujfalusi 	if (type_2r)
2745907fe36aSLars-Peter Clausen 		err = snd_soc_component_update_bits(component, reg2, val_mask,
2746907fe36aSLars-Peter Clausen 			val2);
2747974815baSPeter Ujfalusi 
2748db2a4165SFrank Mandarino 	return err;
2749db2a4165SFrank Mandarino }
2750974815baSPeter Ujfalusi EXPORT_SYMBOL_GPL(snd_soc_put_volsw);
2751db2a4165SFrank Mandarino 
2752e13ac2e9SMark Brown /**
27531d99f243SBrian Austin  * snd_soc_get_volsw_sx - single mixer get callback
27541d99f243SBrian Austin  * @kcontrol: mixer control
27551d99f243SBrian Austin  * @ucontrol: control element information
27561d99f243SBrian Austin  *
27571d99f243SBrian Austin  * Callback to get the value of a single mixer control, or a double mixer
27581d99f243SBrian Austin  * control that spans 2 registers.
27591d99f243SBrian Austin  *
27601d99f243SBrian Austin  * Returns 0 for success.
27611d99f243SBrian Austin  */
27621d99f243SBrian Austin int snd_soc_get_volsw_sx(struct snd_kcontrol *kcontrol,
27631d99f243SBrian Austin 		      struct snd_ctl_elem_value *ucontrol)
27641d99f243SBrian Austin {
2765907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
27661d99f243SBrian Austin 	struct soc_mixer_control *mc =
27671d99f243SBrian Austin 	    (struct soc_mixer_control *)kcontrol->private_value;
27681d99f243SBrian Austin 	unsigned int reg = mc->reg;
27691d99f243SBrian Austin 	unsigned int reg2 = mc->rreg;
27701d99f243SBrian Austin 	unsigned int shift = mc->shift;
27711d99f243SBrian Austin 	unsigned int rshift = mc->rshift;
27721d99f243SBrian Austin 	int max = mc->max;
27731d99f243SBrian Austin 	int min = mc->min;
27741d99f243SBrian Austin 	int mask = (1 << (fls(min + max) - 1)) - 1;
2775907fe36aSLars-Peter Clausen 	unsigned int val;
2776907fe36aSLars-Peter Clausen 	int ret;
27771d99f243SBrian Austin 
2778907fe36aSLars-Peter Clausen 	ret = snd_soc_component_read(component, reg, &val);
2779907fe36aSLars-Peter Clausen 	if (ret < 0)
2780907fe36aSLars-Peter Clausen 		return ret;
27811d99f243SBrian Austin 
2782907fe36aSLars-Peter Clausen 	ucontrol->value.integer.value[0] = ((val >> shift) - min) & mask;
2783907fe36aSLars-Peter Clausen 
2784907fe36aSLars-Peter Clausen 	if (snd_soc_volsw_is_stereo(mc)) {
2785907fe36aSLars-Peter Clausen 		ret = snd_soc_component_read(component, reg2, &val);
2786907fe36aSLars-Peter Clausen 		if (ret < 0)
2787907fe36aSLars-Peter Clausen 			return ret;
2788907fe36aSLars-Peter Clausen 
2789907fe36aSLars-Peter Clausen 		val = ((val >> rshift) - min) & mask;
2790907fe36aSLars-Peter Clausen 		ucontrol->value.integer.value[1] = val;
2791907fe36aSLars-Peter Clausen 	}
27921d99f243SBrian Austin 
27931d99f243SBrian Austin 	return 0;
27941d99f243SBrian Austin }
27951d99f243SBrian Austin EXPORT_SYMBOL_GPL(snd_soc_get_volsw_sx);
27961d99f243SBrian Austin 
27971d99f243SBrian Austin /**
27981d99f243SBrian Austin  * snd_soc_put_volsw_sx - double mixer set callback
27991d99f243SBrian Austin  * @kcontrol: mixer control
28001d99f243SBrian Austin  * @uinfo: control element information
28011d99f243SBrian Austin  *
28021d99f243SBrian Austin  * Callback to set the value of a double mixer control that spans 2 registers.
28031d99f243SBrian Austin  *
28041d99f243SBrian Austin  * Returns 0 for success.
28051d99f243SBrian Austin  */
28061d99f243SBrian Austin int snd_soc_put_volsw_sx(struct snd_kcontrol *kcontrol,
28071d99f243SBrian Austin 			 struct snd_ctl_elem_value *ucontrol)
28081d99f243SBrian Austin {
2809907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
28101d99f243SBrian Austin 	struct soc_mixer_control *mc =
28111d99f243SBrian Austin 	    (struct soc_mixer_control *)kcontrol->private_value;
28121d99f243SBrian Austin 
28131d99f243SBrian Austin 	unsigned int reg = mc->reg;
28141d99f243SBrian Austin 	unsigned int reg2 = mc->rreg;
28151d99f243SBrian Austin 	unsigned int shift = mc->shift;
28161d99f243SBrian Austin 	unsigned int rshift = mc->rshift;
28171d99f243SBrian Austin 	int max = mc->max;
28181d99f243SBrian Austin 	int min = mc->min;
28191d99f243SBrian Austin 	int mask = (1 << (fls(min + max) - 1)) - 1;
282027f1d759SBrian Austin 	int err = 0;
28211a39019eSBard Liao 	unsigned int val, val_mask, val2 = 0;
28221d99f243SBrian Austin 
28231d99f243SBrian Austin 	val_mask = mask << shift;
28241d99f243SBrian Austin 	val = (ucontrol->value.integer.value[0] + min) & mask;
28251d99f243SBrian Austin 	val = val << shift;
28261d99f243SBrian Austin 
2827907fe36aSLars-Peter Clausen 	err = snd_soc_component_update_bits(component, reg, val_mask, val);
2828d055852eSMukund Navada 	if (err < 0)
28291d99f243SBrian Austin 		return err;
28301d99f243SBrian Austin 
28311d99f243SBrian Austin 	if (snd_soc_volsw_is_stereo(mc)) {
28321d99f243SBrian Austin 		val_mask = mask << rshift;
28331d99f243SBrian Austin 		val2 = (ucontrol->value.integer.value[1] + min) & mask;
28341d99f243SBrian Austin 		val2 = val2 << rshift;
28351d99f243SBrian Austin 
2836907fe36aSLars-Peter Clausen 		err = snd_soc_component_update_bits(component, reg2, val_mask,
2837907fe36aSLars-Peter Clausen 			val2);
28381d99f243SBrian Austin 	}
2839907fe36aSLars-Peter Clausen 	return err;
28401d99f243SBrian Austin }
28411d99f243SBrian Austin EXPORT_SYMBOL_GPL(snd_soc_put_volsw_sx);
28421d99f243SBrian Austin 
28431d99f243SBrian Austin /**
2844e13ac2e9SMark Brown  * snd_soc_info_volsw_s8 - signed mixer info callback
2845e13ac2e9SMark Brown  * @kcontrol: mixer control
2846e13ac2e9SMark Brown  * @uinfo: control element information
2847e13ac2e9SMark Brown  *
2848e13ac2e9SMark Brown  * Callback to provide information about a signed mixer control.
2849e13ac2e9SMark Brown  *
2850e13ac2e9SMark Brown  * Returns 0 for success.
2851e13ac2e9SMark Brown  */
2852e13ac2e9SMark Brown int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol,
2853e13ac2e9SMark Brown 	struct snd_ctl_elem_info *uinfo)
2854e13ac2e9SMark Brown {
28554eaa9819SJon Smirl 	struct soc_mixer_control *mc =
28564eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2857d11bb4a9SPeter Ujfalusi 	int platform_max;
28584eaa9819SJon Smirl 	int min = mc->min;
2859e13ac2e9SMark Brown 
2860d11bb4a9SPeter Ujfalusi 	if (!mc->platform_max)
2861d11bb4a9SPeter Ujfalusi 		mc->platform_max = mc->max;
2862d11bb4a9SPeter Ujfalusi 	platform_max = mc->platform_max;
2863d11bb4a9SPeter Ujfalusi 
2864e13ac2e9SMark Brown 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2865e13ac2e9SMark Brown 	uinfo->count = 2;
2866e13ac2e9SMark Brown 	uinfo->value.integer.min = 0;
2867d11bb4a9SPeter Ujfalusi 	uinfo->value.integer.max = platform_max - min;
2868e13ac2e9SMark Brown 	return 0;
2869e13ac2e9SMark Brown }
2870e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8);
2871e13ac2e9SMark Brown 
2872e13ac2e9SMark Brown /**
2873e13ac2e9SMark Brown  * snd_soc_get_volsw_s8 - signed mixer get callback
2874e13ac2e9SMark Brown  * @kcontrol: mixer control
2875ac11a2b3SMark Brown  * @ucontrol: control element information
2876e13ac2e9SMark Brown  *
2877e13ac2e9SMark Brown  * Callback to get the value of a signed mixer control.
2878e13ac2e9SMark Brown  *
2879e13ac2e9SMark Brown  * Returns 0 for success.
2880e13ac2e9SMark Brown  */
2881e13ac2e9SMark Brown int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol,
2882e13ac2e9SMark Brown 	struct snd_ctl_elem_value *ucontrol)
2883e13ac2e9SMark Brown {
28844eaa9819SJon Smirl 	struct soc_mixer_control *mc =
28854eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2886907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
2887815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
2888907fe36aSLars-Peter Clausen 	unsigned int val;
28894eaa9819SJon Smirl 	int min = mc->min;
2890907fe36aSLars-Peter Clausen 	int ret;
2891907fe36aSLars-Peter Clausen 
2892907fe36aSLars-Peter Clausen 	ret = snd_soc_component_read(component, reg, &val);
2893907fe36aSLars-Peter Clausen 	if (ret)
2894907fe36aSLars-Peter Clausen 		return ret;
2895e13ac2e9SMark Brown 
2896e13ac2e9SMark Brown 	ucontrol->value.integer.value[0] =
2897e13ac2e9SMark Brown 		((signed char)(val & 0xff))-min;
2898e13ac2e9SMark Brown 	ucontrol->value.integer.value[1] =
2899e13ac2e9SMark Brown 		((signed char)((val >> 8) & 0xff))-min;
2900e13ac2e9SMark Brown 	return 0;
2901e13ac2e9SMark Brown }
2902e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8);
2903e13ac2e9SMark Brown 
2904e13ac2e9SMark Brown /**
2905e13ac2e9SMark Brown  * snd_soc_put_volsw_sgn - signed mixer put callback
2906e13ac2e9SMark Brown  * @kcontrol: mixer control
2907ac11a2b3SMark Brown  * @ucontrol: control element information
2908e13ac2e9SMark Brown  *
2909e13ac2e9SMark Brown  * Callback to set the value of a signed mixer control.
2910e13ac2e9SMark Brown  *
2911e13ac2e9SMark Brown  * Returns 0 for success.
2912e13ac2e9SMark Brown  */
2913e13ac2e9SMark Brown int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol,
2914e13ac2e9SMark Brown 	struct snd_ctl_elem_value *ucontrol)
2915e13ac2e9SMark Brown {
29164eaa9819SJon Smirl 	struct soc_mixer_control *mc =
29174eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2918907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
2919815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
29204eaa9819SJon Smirl 	int min = mc->min;
292146f5822fSDaniel Ribeiro 	unsigned int val;
2922e13ac2e9SMark Brown 
2923e13ac2e9SMark Brown 	val = (ucontrol->value.integer.value[0]+min) & 0xff;
2924e13ac2e9SMark Brown 	val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8;
2925e13ac2e9SMark Brown 
2926907fe36aSLars-Peter Clausen 	return snd_soc_component_update_bits(component, reg, 0xffff, val);
2927e13ac2e9SMark Brown }
2928e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8);
2929e13ac2e9SMark Brown 
29308c6529dbSLiam Girdwood /**
29316c9d8cf6SAdam Thomson  * snd_soc_info_volsw_range - single mixer info callback with range.
29326c9d8cf6SAdam Thomson  * @kcontrol: mixer control
29336c9d8cf6SAdam Thomson  * @uinfo: control element information
29346c9d8cf6SAdam Thomson  *
29356c9d8cf6SAdam Thomson  * Callback to provide information, within a range, about a single
29366c9d8cf6SAdam Thomson  * mixer control.
29376c9d8cf6SAdam Thomson  *
29386c9d8cf6SAdam Thomson  * returns 0 for success.
29396c9d8cf6SAdam Thomson  */
29406c9d8cf6SAdam Thomson int snd_soc_info_volsw_range(struct snd_kcontrol *kcontrol,
29416c9d8cf6SAdam Thomson 	struct snd_ctl_elem_info *uinfo)
29426c9d8cf6SAdam Thomson {
29436c9d8cf6SAdam Thomson 	struct soc_mixer_control *mc =
29446c9d8cf6SAdam Thomson 		(struct soc_mixer_control *)kcontrol->private_value;
29456c9d8cf6SAdam Thomson 	int platform_max;
29466c9d8cf6SAdam Thomson 	int min = mc->min;
29476c9d8cf6SAdam Thomson 
29486c9d8cf6SAdam Thomson 	if (!mc->platform_max)
29496c9d8cf6SAdam Thomson 		mc->platform_max = mc->max;
29506c9d8cf6SAdam Thomson 	platform_max = mc->platform_max;
29516c9d8cf6SAdam Thomson 
29526c9d8cf6SAdam Thomson 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
29539bde4f0bSMark Brown 	uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
29546c9d8cf6SAdam Thomson 	uinfo->value.integer.min = 0;
29556c9d8cf6SAdam Thomson 	uinfo->value.integer.max = platform_max - min;
29566c9d8cf6SAdam Thomson 
29576c9d8cf6SAdam Thomson 	return 0;
29586c9d8cf6SAdam Thomson }
29596c9d8cf6SAdam Thomson EXPORT_SYMBOL_GPL(snd_soc_info_volsw_range);
29606c9d8cf6SAdam Thomson 
29616c9d8cf6SAdam Thomson /**
29626c9d8cf6SAdam Thomson  * snd_soc_put_volsw_range - single mixer put value callback with range.
29636c9d8cf6SAdam Thomson  * @kcontrol: mixer control
29646c9d8cf6SAdam Thomson  * @ucontrol: control element information
29656c9d8cf6SAdam Thomson  *
29666c9d8cf6SAdam Thomson  * Callback to set the value, within a range, for a single mixer control.
29676c9d8cf6SAdam Thomson  *
29686c9d8cf6SAdam Thomson  * Returns 0 for success.
29696c9d8cf6SAdam Thomson  */
29706c9d8cf6SAdam Thomson int snd_soc_put_volsw_range(struct snd_kcontrol *kcontrol,
29716c9d8cf6SAdam Thomson 	struct snd_ctl_elem_value *ucontrol)
29726c9d8cf6SAdam Thomson {
29736c9d8cf6SAdam Thomson 	struct soc_mixer_control *mc =
29746c9d8cf6SAdam Thomson 		(struct soc_mixer_control *)kcontrol->private_value;
2975907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
29766c9d8cf6SAdam Thomson 	unsigned int reg = mc->reg;
29779bde4f0bSMark Brown 	unsigned int rreg = mc->rreg;
29786c9d8cf6SAdam Thomson 	unsigned int shift = mc->shift;
29796c9d8cf6SAdam Thomson 	int min = mc->min;
29806c9d8cf6SAdam Thomson 	int max = mc->max;
29816c9d8cf6SAdam Thomson 	unsigned int mask = (1 << fls(max)) - 1;
29826c9d8cf6SAdam Thomson 	unsigned int invert = mc->invert;
29836c9d8cf6SAdam Thomson 	unsigned int val, val_mask;
29849bde4f0bSMark Brown 	int ret;
29856c9d8cf6SAdam Thomson 
29866c9d8cf6SAdam Thomson 	val = ((ucontrol->value.integer.value[0] + min) & mask);
29876c9d8cf6SAdam Thomson 	if (invert)
29886c9d8cf6SAdam Thomson 		val = max - val;
29896c9d8cf6SAdam Thomson 	val_mask = mask << shift;
29906c9d8cf6SAdam Thomson 	val = val << shift;
29916c9d8cf6SAdam Thomson 
2992907fe36aSLars-Peter Clausen 	ret = snd_soc_component_update_bits(component, reg, val_mask, val);
29930eaa6ccaSJoonyoung Shim 	if (ret < 0)
29949bde4f0bSMark Brown 		return ret;
29959bde4f0bSMark Brown 
29969bde4f0bSMark Brown 	if (snd_soc_volsw_is_stereo(mc)) {
29979bde4f0bSMark Brown 		val = ((ucontrol->value.integer.value[1] + min) & mask);
29989bde4f0bSMark Brown 		if (invert)
29999bde4f0bSMark Brown 			val = max - val;
30009bde4f0bSMark Brown 		val_mask = mask << shift;
30019bde4f0bSMark Brown 		val = val << shift;
30029bde4f0bSMark Brown 
3003907fe36aSLars-Peter Clausen 		ret = snd_soc_component_update_bits(component, rreg, val_mask,
3004907fe36aSLars-Peter Clausen 			val);
30059bde4f0bSMark Brown 	}
30069bde4f0bSMark Brown 
30079bde4f0bSMark Brown 	return ret;
30086c9d8cf6SAdam Thomson }
30096c9d8cf6SAdam Thomson EXPORT_SYMBOL_GPL(snd_soc_put_volsw_range);
30106c9d8cf6SAdam Thomson 
30116c9d8cf6SAdam Thomson /**
30126c9d8cf6SAdam Thomson  * snd_soc_get_volsw_range - single mixer get callback with range
30136c9d8cf6SAdam Thomson  * @kcontrol: mixer control
30146c9d8cf6SAdam Thomson  * @ucontrol: control element information
30156c9d8cf6SAdam Thomson  *
30166c9d8cf6SAdam Thomson  * Callback to get the value, within a range, of a single mixer control.
30176c9d8cf6SAdam Thomson  *
30186c9d8cf6SAdam Thomson  * Returns 0 for success.
30196c9d8cf6SAdam Thomson  */
30206c9d8cf6SAdam Thomson int snd_soc_get_volsw_range(struct snd_kcontrol *kcontrol,
30216c9d8cf6SAdam Thomson 	struct snd_ctl_elem_value *ucontrol)
30226c9d8cf6SAdam Thomson {
3023907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
30246c9d8cf6SAdam Thomson 	struct soc_mixer_control *mc =
30256c9d8cf6SAdam Thomson 		(struct soc_mixer_control *)kcontrol->private_value;
30266c9d8cf6SAdam Thomson 	unsigned int reg = mc->reg;
30279bde4f0bSMark Brown 	unsigned int rreg = mc->rreg;
30286c9d8cf6SAdam Thomson 	unsigned int shift = mc->shift;
30296c9d8cf6SAdam Thomson 	int min = mc->min;
30306c9d8cf6SAdam Thomson 	int max = mc->max;
30316c9d8cf6SAdam Thomson 	unsigned int mask = (1 << fls(max)) - 1;
30326c9d8cf6SAdam Thomson 	unsigned int invert = mc->invert;
3033907fe36aSLars-Peter Clausen 	unsigned int val;
3034907fe36aSLars-Peter Clausen 	int ret;
30356c9d8cf6SAdam Thomson 
3036907fe36aSLars-Peter Clausen 	ret = snd_soc_component_read(component, reg, &val);
3037907fe36aSLars-Peter Clausen 	if (ret)
3038907fe36aSLars-Peter Clausen 		return ret;
3039907fe36aSLars-Peter Clausen 
3040907fe36aSLars-Peter Clausen 	ucontrol->value.integer.value[0] = (val >> shift) & mask;
30416c9d8cf6SAdam Thomson 	if (invert)
30426c9d8cf6SAdam Thomson 		ucontrol->value.integer.value[0] =
30436c9d8cf6SAdam Thomson 			max - ucontrol->value.integer.value[0];
30446c9d8cf6SAdam Thomson 	ucontrol->value.integer.value[0] =
30456c9d8cf6SAdam Thomson 		ucontrol->value.integer.value[0] - min;
30466c9d8cf6SAdam Thomson 
30479bde4f0bSMark Brown 	if (snd_soc_volsw_is_stereo(mc)) {
3048907fe36aSLars-Peter Clausen 		ret = snd_soc_component_read(component, rreg, &val);
3049907fe36aSLars-Peter Clausen 		if (ret)
3050907fe36aSLars-Peter Clausen 			return ret;
3051907fe36aSLars-Peter Clausen 
3052907fe36aSLars-Peter Clausen 		ucontrol->value.integer.value[1] = (val >> shift) & mask;
30539bde4f0bSMark Brown 		if (invert)
30549bde4f0bSMark Brown 			ucontrol->value.integer.value[1] =
30559bde4f0bSMark Brown 				max - ucontrol->value.integer.value[1];
30569bde4f0bSMark Brown 		ucontrol->value.integer.value[1] =
30579bde4f0bSMark Brown 			ucontrol->value.integer.value[1] - min;
30589bde4f0bSMark Brown 	}
30599bde4f0bSMark Brown 
30606c9d8cf6SAdam Thomson 	return 0;
30616c9d8cf6SAdam Thomson }
30626c9d8cf6SAdam Thomson EXPORT_SYMBOL_GPL(snd_soc_get_volsw_range);
30636c9d8cf6SAdam Thomson 
30646c9d8cf6SAdam Thomson /**
3065637d3847SPeter Ujfalusi  * snd_soc_limit_volume - Set new limit to an existing volume control.
3066637d3847SPeter Ujfalusi  *
3067637d3847SPeter Ujfalusi  * @codec: where to look for the control
3068637d3847SPeter Ujfalusi  * @name: Name of the control
3069637d3847SPeter Ujfalusi  * @max: new maximum limit
3070637d3847SPeter Ujfalusi  *
3071637d3847SPeter Ujfalusi  * Return 0 for success, else error.
3072637d3847SPeter Ujfalusi  */
3073637d3847SPeter Ujfalusi int snd_soc_limit_volume(struct snd_soc_codec *codec,
3074637d3847SPeter Ujfalusi 	const char *name, int max)
3075637d3847SPeter Ujfalusi {
3076f0fba2adSLiam Girdwood 	struct snd_card *card = codec->card->snd_card;
3077637d3847SPeter Ujfalusi 	struct snd_kcontrol *kctl;
3078637d3847SPeter Ujfalusi 	struct soc_mixer_control *mc;
3079637d3847SPeter Ujfalusi 	int found = 0;
3080637d3847SPeter Ujfalusi 	int ret = -EINVAL;
3081637d3847SPeter Ujfalusi 
3082637d3847SPeter Ujfalusi 	/* Sanity check for name and max */
3083637d3847SPeter Ujfalusi 	if (unlikely(!name || max <= 0))
3084637d3847SPeter Ujfalusi 		return -EINVAL;
3085637d3847SPeter Ujfalusi 
3086637d3847SPeter Ujfalusi 	list_for_each_entry(kctl, &card->controls, list) {
3087637d3847SPeter Ujfalusi 		if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) {
3088637d3847SPeter Ujfalusi 			found = 1;
3089637d3847SPeter Ujfalusi 			break;
3090637d3847SPeter Ujfalusi 		}
3091637d3847SPeter Ujfalusi 	}
3092637d3847SPeter Ujfalusi 	if (found) {
3093637d3847SPeter Ujfalusi 		mc = (struct soc_mixer_control *)kctl->private_value;
3094637d3847SPeter Ujfalusi 		if (max <= mc->max) {
3095d11bb4a9SPeter Ujfalusi 			mc->platform_max = max;
3096637d3847SPeter Ujfalusi 			ret = 0;
3097637d3847SPeter Ujfalusi 		}
3098637d3847SPeter Ujfalusi 	}
3099637d3847SPeter Ujfalusi 	return ret;
3100637d3847SPeter Ujfalusi }
3101637d3847SPeter Ujfalusi EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
3102637d3847SPeter Ujfalusi 
310371d08516SMark Brown int snd_soc_bytes_info(struct snd_kcontrol *kcontrol,
310471d08516SMark Brown 		       struct snd_ctl_elem_info *uinfo)
310571d08516SMark Brown {
3106907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
310771d08516SMark Brown 	struct soc_bytes *params = (void *)kcontrol->private_value;
310871d08516SMark Brown 
310971d08516SMark Brown 	uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
3110907fe36aSLars-Peter Clausen 	uinfo->count = params->num_regs * component->val_bytes;
311171d08516SMark Brown 
311271d08516SMark Brown 	return 0;
311371d08516SMark Brown }
311471d08516SMark Brown EXPORT_SYMBOL_GPL(snd_soc_bytes_info);
311571d08516SMark Brown 
311671d08516SMark Brown int snd_soc_bytes_get(struct snd_kcontrol *kcontrol,
311771d08516SMark Brown 		      struct snd_ctl_elem_value *ucontrol)
311871d08516SMark Brown {
3119907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
312071d08516SMark Brown 	struct soc_bytes *params = (void *)kcontrol->private_value;
312171d08516SMark Brown 	int ret;
312271d08516SMark Brown 
3123907fe36aSLars-Peter Clausen 	if (component->regmap)
3124907fe36aSLars-Peter Clausen 		ret = regmap_raw_read(component->regmap, params->base,
312571d08516SMark Brown 				      ucontrol->value.bytes.data,
3126907fe36aSLars-Peter Clausen 				      params->num_regs * component->val_bytes);
312771d08516SMark Brown 	else
312871d08516SMark Brown 		ret = -EINVAL;
312971d08516SMark Brown 
3130f831b055SMark Brown 	/* Hide any masked bytes to ensure consistent data reporting */
3131f831b055SMark Brown 	if (ret == 0 && params->mask) {
3132907fe36aSLars-Peter Clausen 		switch (component->val_bytes) {
3133f831b055SMark Brown 		case 1:
3134f831b055SMark Brown 			ucontrol->value.bytes.data[0] &= ~params->mask;
3135f831b055SMark Brown 			break;
3136f831b055SMark Brown 		case 2:
3137f831b055SMark Brown 			((u16 *)(&ucontrol->value.bytes.data))[0]
31388f1ec93aSCharles Keepax 				&= cpu_to_be16(~params->mask);
3139f831b055SMark Brown 			break;
3140f831b055SMark Brown 		case 4:
3141f831b055SMark Brown 			((u32 *)(&ucontrol->value.bytes.data))[0]
31428f1ec93aSCharles Keepax 				&= cpu_to_be32(~params->mask);
3143f831b055SMark Brown 			break;
3144f831b055SMark Brown 		default:
3145f831b055SMark Brown 			return -EINVAL;
3146f831b055SMark Brown 		}
3147f831b055SMark Brown 	}
3148f831b055SMark Brown 
314971d08516SMark Brown 	return ret;
315071d08516SMark Brown }
315171d08516SMark Brown EXPORT_SYMBOL_GPL(snd_soc_bytes_get);
315271d08516SMark Brown 
315371d08516SMark Brown int snd_soc_bytes_put(struct snd_kcontrol *kcontrol,
315471d08516SMark Brown 		      struct snd_ctl_elem_value *ucontrol)
315571d08516SMark Brown {
3156907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
315771d08516SMark Brown 	struct soc_bytes *params = (void *)kcontrol->private_value;
3158f831b055SMark Brown 	int ret, len;
3159a1a564edSNenghua Cao 	unsigned int val, mask;
3160f831b055SMark Brown 	void *data;
316171d08516SMark Brown 
3162907fe36aSLars-Peter Clausen 	if (!component->regmap)
3163f831b055SMark Brown 		return -EINVAL;
3164f831b055SMark Brown 
3165907fe36aSLars-Peter Clausen 	len = params->num_regs * component->val_bytes;
3166f831b055SMark Brown 
3167b5a8fe43SMark Brown 	data = kmemdup(ucontrol->value.bytes.data, len, GFP_KERNEL | GFP_DMA);
3168b5a8fe43SMark Brown 	if (!data)
3169b5a8fe43SMark Brown 		return -ENOMEM;
3170b5a8fe43SMark Brown 
3171f831b055SMark Brown 	/*
3172f831b055SMark Brown 	 * If we've got a mask then we need to preserve the register
3173f831b055SMark Brown 	 * bits.  We shouldn't modify the incoming data so take a
3174f831b055SMark Brown 	 * copy.
3175f831b055SMark Brown 	 */
3176f831b055SMark Brown 	if (params->mask) {
3177907fe36aSLars-Peter Clausen 		ret = regmap_read(component->regmap, params->base, &val);
3178f831b055SMark Brown 		if (ret != 0)
3179e8b18addSWei Yongjun 			goto out;
3180f831b055SMark Brown 
3181f831b055SMark Brown 		val &= params->mask;
3182f831b055SMark Brown 
3183907fe36aSLars-Peter Clausen 		switch (component->val_bytes) {
3184f831b055SMark Brown 		case 1:
3185f831b055SMark Brown 			((u8 *)data)[0] &= ~params->mask;
3186f831b055SMark Brown 			((u8 *)data)[0] |= val;
3187f831b055SMark Brown 			break;
3188f831b055SMark Brown 		case 2:
3189a1a564edSNenghua Cao 			mask = ~params->mask;
3190907fe36aSLars-Peter Clausen 			ret = regmap_parse_val(component->regmap,
3191a1a564edSNenghua Cao 							&mask, &mask);
3192a1a564edSNenghua Cao 			if (ret != 0)
3193a1a564edSNenghua Cao 				goto out;
3194a1a564edSNenghua Cao 
3195a1a564edSNenghua Cao 			((u16 *)data)[0] &= mask;
3196a1a564edSNenghua Cao 
3197907fe36aSLars-Peter Clausen 			ret = regmap_parse_val(component->regmap,
3198a1a564edSNenghua Cao 							&val, &val);
3199a1a564edSNenghua Cao 			if (ret != 0)
3200a1a564edSNenghua Cao 				goto out;
3201a1a564edSNenghua Cao 
3202a1a564edSNenghua Cao 			((u16 *)data)[0] |= val;
3203f831b055SMark Brown 			break;
3204f831b055SMark Brown 		case 4:
3205a1a564edSNenghua Cao 			mask = ~params->mask;
3206907fe36aSLars-Peter Clausen 			ret = regmap_parse_val(component->regmap,
3207a1a564edSNenghua Cao 							&mask, &mask);
3208a1a564edSNenghua Cao 			if (ret != 0)
3209a1a564edSNenghua Cao 				goto out;
3210a1a564edSNenghua Cao 
3211a1a564edSNenghua Cao 			((u32 *)data)[0] &= mask;
3212a1a564edSNenghua Cao 
3213907fe36aSLars-Peter Clausen 			ret = regmap_parse_val(component->regmap,
3214a1a564edSNenghua Cao 							&val, &val);
3215a1a564edSNenghua Cao 			if (ret != 0)
3216a1a564edSNenghua Cao 				goto out;
3217a1a564edSNenghua Cao 
3218a1a564edSNenghua Cao 			((u32 *)data)[0] |= val;
3219f831b055SMark Brown 			break;
3220f831b055SMark Brown 		default:
3221e8b18addSWei Yongjun 			ret = -EINVAL;
3222e8b18addSWei Yongjun 			goto out;
3223f831b055SMark Brown 		}
3224f831b055SMark Brown 	}
3225f831b055SMark Brown 
3226907fe36aSLars-Peter Clausen 	ret = regmap_raw_write(component->regmap, params->base,
3227f831b055SMark Brown 			       data, len);
3228f831b055SMark Brown 
3229e8b18addSWei Yongjun out:
3230f831b055SMark Brown 	kfree(data);
323171d08516SMark Brown 
323271d08516SMark Brown 	return ret;
323371d08516SMark Brown }
323471d08516SMark Brown EXPORT_SYMBOL_GPL(snd_soc_bytes_put);
323571d08516SMark Brown 
3236d9881208SVinod Koul int snd_soc_bytes_info_ext(struct snd_kcontrol *kcontrol,
3237d9881208SVinod Koul 			struct snd_ctl_elem_info *ucontrol)
3238d9881208SVinod Koul {
3239d9881208SVinod Koul 	struct soc_bytes_ext *params = (void *)kcontrol->private_value;
3240d9881208SVinod Koul 
3241d9881208SVinod Koul 	ucontrol->type = SNDRV_CTL_ELEM_TYPE_BYTES;
3242d9881208SVinod Koul 	ucontrol->count = params->max;
3243d9881208SVinod Koul 
3244d9881208SVinod Koul 	return 0;
3245d9881208SVinod Koul }
3246d9881208SVinod Koul EXPORT_SYMBOL_GPL(snd_soc_bytes_info_ext);
3247d9881208SVinod Koul 
3248b6f4bb38Sapatard@mandriva.com /**
32494183eed2SKristoffer KARLSSON  * snd_soc_info_xr_sx - signed multi register info callback
32504183eed2SKristoffer KARLSSON  * @kcontrol: mreg control
32514183eed2SKristoffer KARLSSON  * @uinfo: control element information
32524183eed2SKristoffer KARLSSON  *
32534183eed2SKristoffer KARLSSON  * Callback to provide information of a control that can
32544183eed2SKristoffer KARLSSON  * span multiple codec registers which together
32554183eed2SKristoffer KARLSSON  * forms a single signed value in a MSB/LSB manner.
32564183eed2SKristoffer KARLSSON  *
32574183eed2SKristoffer KARLSSON  * Returns 0 for success.
32584183eed2SKristoffer KARLSSON  */
32594183eed2SKristoffer KARLSSON int snd_soc_info_xr_sx(struct snd_kcontrol *kcontrol,
32604183eed2SKristoffer KARLSSON 	struct snd_ctl_elem_info *uinfo)
32614183eed2SKristoffer KARLSSON {
32624183eed2SKristoffer KARLSSON 	struct soc_mreg_control *mc =
32634183eed2SKristoffer KARLSSON 		(struct soc_mreg_control *)kcontrol->private_value;
32644183eed2SKristoffer KARLSSON 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
32654183eed2SKristoffer KARLSSON 	uinfo->count = 1;
32664183eed2SKristoffer KARLSSON 	uinfo->value.integer.min = mc->min;
32674183eed2SKristoffer KARLSSON 	uinfo->value.integer.max = mc->max;
32684183eed2SKristoffer KARLSSON 
32694183eed2SKristoffer KARLSSON 	return 0;
32704183eed2SKristoffer KARLSSON }
32714183eed2SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_info_xr_sx);
32724183eed2SKristoffer KARLSSON 
32734183eed2SKristoffer KARLSSON /**
32744183eed2SKristoffer KARLSSON  * snd_soc_get_xr_sx - signed multi register get callback
32754183eed2SKristoffer KARLSSON  * @kcontrol: mreg control
32764183eed2SKristoffer KARLSSON  * @ucontrol: control element information
32774183eed2SKristoffer KARLSSON  *
32784183eed2SKristoffer KARLSSON  * Callback to get the value of a control that can span
32794183eed2SKristoffer KARLSSON  * multiple codec registers which together forms a single
32804183eed2SKristoffer KARLSSON  * signed value in a MSB/LSB manner. The control supports
32814183eed2SKristoffer KARLSSON  * specifying total no of bits used to allow for bitfields
32824183eed2SKristoffer KARLSSON  * across the multiple codec registers.
32834183eed2SKristoffer KARLSSON  *
32844183eed2SKristoffer KARLSSON  * Returns 0 for success.
32854183eed2SKristoffer KARLSSON  */
32864183eed2SKristoffer KARLSSON int snd_soc_get_xr_sx(struct snd_kcontrol *kcontrol,
32874183eed2SKristoffer KARLSSON 	struct snd_ctl_elem_value *ucontrol)
32884183eed2SKristoffer KARLSSON {
3289907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
32904183eed2SKristoffer KARLSSON 	struct soc_mreg_control *mc =
32914183eed2SKristoffer KARLSSON 		(struct soc_mreg_control *)kcontrol->private_value;
32924183eed2SKristoffer KARLSSON 	unsigned int regbase = mc->regbase;
32934183eed2SKristoffer KARLSSON 	unsigned int regcount = mc->regcount;
3294907fe36aSLars-Peter Clausen 	unsigned int regwshift = component->val_bytes * BITS_PER_BYTE;
32954183eed2SKristoffer KARLSSON 	unsigned int regwmask = (1<<regwshift)-1;
32964183eed2SKristoffer KARLSSON 	unsigned int invert = mc->invert;
32974183eed2SKristoffer KARLSSON 	unsigned long mask = (1UL<<mc->nbits)-1;
32984183eed2SKristoffer KARLSSON 	long min = mc->min;
32994183eed2SKristoffer KARLSSON 	long max = mc->max;
33004183eed2SKristoffer KARLSSON 	long val = 0;
3301907fe36aSLars-Peter Clausen 	unsigned int regval;
33024183eed2SKristoffer KARLSSON 	unsigned int i;
3303907fe36aSLars-Peter Clausen 	int ret;
33044183eed2SKristoffer KARLSSON 
33054183eed2SKristoffer KARLSSON 	for (i = 0; i < regcount; i++) {
3306907fe36aSLars-Peter Clausen 		ret = snd_soc_component_read(component, regbase+i, &regval);
3307907fe36aSLars-Peter Clausen 		if (ret)
3308907fe36aSLars-Peter Clausen 			return ret;
3309907fe36aSLars-Peter Clausen 		val |= (regval & regwmask) << (regwshift*(regcount-i-1));
33104183eed2SKristoffer KARLSSON 	}
33114183eed2SKristoffer KARLSSON 	val &= mask;
33124183eed2SKristoffer KARLSSON 	if (min < 0 && val > max)
33134183eed2SKristoffer KARLSSON 		val |= ~mask;
33144183eed2SKristoffer KARLSSON 	if (invert)
33154183eed2SKristoffer KARLSSON 		val = max - val;
33164183eed2SKristoffer KARLSSON 	ucontrol->value.integer.value[0] = val;
33174183eed2SKristoffer KARLSSON 
33184183eed2SKristoffer KARLSSON 	return 0;
33194183eed2SKristoffer KARLSSON }
33204183eed2SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_get_xr_sx);
33214183eed2SKristoffer KARLSSON 
33224183eed2SKristoffer KARLSSON /**
33234183eed2SKristoffer KARLSSON  * snd_soc_put_xr_sx - signed multi register get callback
33244183eed2SKristoffer KARLSSON  * @kcontrol: mreg control
33254183eed2SKristoffer KARLSSON  * @ucontrol: control element information
33264183eed2SKristoffer KARLSSON  *
33274183eed2SKristoffer KARLSSON  * Callback to set the value of a control that can span
33284183eed2SKristoffer KARLSSON  * multiple codec registers which together forms a single
33294183eed2SKristoffer KARLSSON  * signed value in a MSB/LSB manner. The control supports
33304183eed2SKristoffer KARLSSON  * specifying total no of bits used to allow for bitfields
33314183eed2SKristoffer KARLSSON  * across the multiple codec registers.
33324183eed2SKristoffer KARLSSON  *
33334183eed2SKristoffer KARLSSON  * Returns 0 for success.
33344183eed2SKristoffer KARLSSON  */
33354183eed2SKristoffer KARLSSON int snd_soc_put_xr_sx(struct snd_kcontrol *kcontrol,
33364183eed2SKristoffer KARLSSON 	struct snd_ctl_elem_value *ucontrol)
33374183eed2SKristoffer KARLSSON {
3338907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
33394183eed2SKristoffer KARLSSON 	struct soc_mreg_control *mc =
33404183eed2SKristoffer KARLSSON 		(struct soc_mreg_control *)kcontrol->private_value;
33414183eed2SKristoffer KARLSSON 	unsigned int regbase = mc->regbase;
33424183eed2SKristoffer KARLSSON 	unsigned int regcount = mc->regcount;
3343907fe36aSLars-Peter Clausen 	unsigned int regwshift = component->val_bytes * BITS_PER_BYTE;
33444183eed2SKristoffer KARLSSON 	unsigned int regwmask = (1<<regwshift)-1;
33454183eed2SKristoffer KARLSSON 	unsigned int invert = mc->invert;
33464183eed2SKristoffer KARLSSON 	unsigned long mask = (1UL<<mc->nbits)-1;
33474183eed2SKristoffer KARLSSON 	long max = mc->max;
33484183eed2SKristoffer KARLSSON 	long val = ucontrol->value.integer.value[0];
33494183eed2SKristoffer KARLSSON 	unsigned int i, regval, regmask;
33504183eed2SKristoffer KARLSSON 	int err;
33514183eed2SKristoffer KARLSSON 
33524183eed2SKristoffer KARLSSON 	if (invert)
33534183eed2SKristoffer KARLSSON 		val = max - val;
33544183eed2SKristoffer KARLSSON 	val &= mask;
33554183eed2SKristoffer KARLSSON 	for (i = 0; i < regcount; i++) {
33564183eed2SKristoffer KARLSSON 		regval = (val >> (regwshift*(regcount-i-1))) & regwmask;
33574183eed2SKristoffer KARLSSON 		regmask = (mask >> (regwshift*(regcount-i-1))) & regwmask;
3358907fe36aSLars-Peter Clausen 		err = snd_soc_component_update_bits(component, regbase+i,
33594183eed2SKristoffer KARLSSON 				regmask, regval);
33604183eed2SKristoffer KARLSSON 		if (err < 0)
33614183eed2SKristoffer KARLSSON 			return err;
33624183eed2SKristoffer KARLSSON 	}
33634183eed2SKristoffer KARLSSON 
33644183eed2SKristoffer KARLSSON 	return 0;
33654183eed2SKristoffer KARLSSON }
33664183eed2SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_put_xr_sx);
33674183eed2SKristoffer KARLSSON 
33684183eed2SKristoffer KARLSSON /**
3369dd7b10b3SKristoffer KARLSSON  * snd_soc_get_strobe - strobe get callback
3370dd7b10b3SKristoffer KARLSSON  * @kcontrol: mixer control
3371dd7b10b3SKristoffer KARLSSON  * @ucontrol: control element information
3372dd7b10b3SKristoffer KARLSSON  *
3373dd7b10b3SKristoffer KARLSSON  * Callback get the value of a strobe mixer control.
3374dd7b10b3SKristoffer KARLSSON  *
3375dd7b10b3SKristoffer KARLSSON  * Returns 0 for success.
3376dd7b10b3SKristoffer KARLSSON  */
3377dd7b10b3SKristoffer KARLSSON int snd_soc_get_strobe(struct snd_kcontrol *kcontrol,
3378dd7b10b3SKristoffer KARLSSON 	struct snd_ctl_elem_value *ucontrol)
3379dd7b10b3SKristoffer KARLSSON {
3380907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
3381dd7b10b3SKristoffer KARLSSON 	struct soc_mixer_control *mc =
3382dd7b10b3SKristoffer KARLSSON 		(struct soc_mixer_control *)kcontrol->private_value;
3383dd7b10b3SKristoffer KARLSSON 	unsigned int reg = mc->reg;
3384dd7b10b3SKristoffer KARLSSON 	unsigned int shift = mc->shift;
3385dd7b10b3SKristoffer KARLSSON 	unsigned int mask = 1 << shift;
3386dd7b10b3SKristoffer KARLSSON 	unsigned int invert = mc->invert != 0;
3387907fe36aSLars-Peter Clausen 	unsigned int val;
3388907fe36aSLars-Peter Clausen 	int ret;
3389907fe36aSLars-Peter Clausen 
3390907fe36aSLars-Peter Clausen 	ret = snd_soc_component_read(component, reg, &val);
3391907fe36aSLars-Peter Clausen 	if (ret)
3392907fe36aSLars-Peter Clausen 		return ret;
3393907fe36aSLars-Peter Clausen 
3394907fe36aSLars-Peter Clausen 	val &= mask;
3395dd7b10b3SKristoffer KARLSSON 
3396dd7b10b3SKristoffer KARLSSON 	if (shift != 0 && val != 0)
3397dd7b10b3SKristoffer KARLSSON 		val = val >> shift;
3398dd7b10b3SKristoffer KARLSSON 	ucontrol->value.enumerated.item[0] = val ^ invert;
3399dd7b10b3SKristoffer KARLSSON 
3400dd7b10b3SKristoffer KARLSSON 	return 0;
3401dd7b10b3SKristoffer KARLSSON }
3402dd7b10b3SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_get_strobe);
3403dd7b10b3SKristoffer KARLSSON 
3404dd7b10b3SKristoffer KARLSSON /**
3405dd7b10b3SKristoffer KARLSSON  * snd_soc_put_strobe - strobe put callback
3406dd7b10b3SKristoffer KARLSSON  * @kcontrol: mixer control
3407dd7b10b3SKristoffer KARLSSON  * @ucontrol: control element information
3408dd7b10b3SKristoffer KARLSSON  *
3409dd7b10b3SKristoffer KARLSSON  * Callback strobe a register bit to high then low (or the inverse)
3410dd7b10b3SKristoffer KARLSSON  * in one pass of a single mixer enum control.
3411dd7b10b3SKristoffer KARLSSON  *
3412dd7b10b3SKristoffer KARLSSON  * Returns 1 for success.
3413dd7b10b3SKristoffer KARLSSON  */
3414dd7b10b3SKristoffer KARLSSON int snd_soc_put_strobe(struct snd_kcontrol *kcontrol,
3415dd7b10b3SKristoffer KARLSSON 	struct snd_ctl_elem_value *ucontrol)
3416dd7b10b3SKristoffer KARLSSON {
3417907fe36aSLars-Peter Clausen 	struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
3418dd7b10b3SKristoffer KARLSSON 	struct soc_mixer_control *mc =
3419dd7b10b3SKristoffer KARLSSON 		(struct soc_mixer_control *)kcontrol->private_value;
3420dd7b10b3SKristoffer KARLSSON 	unsigned int reg = mc->reg;
3421dd7b10b3SKristoffer KARLSSON 	unsigned int shift = mc->shift;
3422dd7b10b3SKristoffer KARLSSON 	unsigned int mask = 1 << shift;
3423dd7b10b3SKristoffer KARLSSON 	unsigned int invert = mc->invert != 0;
3424dd7b10b3SKristoffer KARLSSON 	unsigned int strobe = ucontrol->value.enumerated.item[0] != 0;
3425dd7b10b3SKristoffer KARLSSON 	unsigned int val1 = (strobe ^ invert) ? mask : 0;
3426dd7b10b3SKristoffer KARLSSON 	unsigned int val2 = (strobe ^ invert) ? 0 : mask;
3427dd7b10b3SKristoffer KARLSSON 	int err;
3428dd7b10b3SKristoffer KARLSSON 
3429907fe36aSLars-Peter Clausen 	err = snd_soc_component_update_bits(component, reg, mask, val1);
3430dd7b10b3SKristoffer KARLSSON 	if (err < 0)
3431dd7b10b3SKristoffer KARLSSON 		return err;
3432dd7b10b3SKristoffer KARLSSON 
3433907fe36aSLars-Peter Clausen 	return snd_soc_component_update_bits(component, reg, mask, val2);
3434dd7b10b3SKristoffer KARLSSON }
3435dd7b10b3SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_put_strobe);
3436dd7b10b3SKristoffer KARLSSON 
3437dd7b10b3SKristoffer KARLSSON /**
34388c6529dbSLiam Girdwood  * snd_soc_dai_set_sysclk - configure DAI system or master clock.
34398c6529dbSLiam Girdwood  * @dai: DAI
34408c6529dbSLiam Girdwood  * @clk_id: DAI specific clock ID
34418c6529dbSLiam Girdwood  * @freq: new clock frequency in Hz
34428c6529dbSLiam Girdwood  * @dir: new clock direction - input/output.
34438c6529dbSLiam Girdwood  *
34448c6529dbSLiam Girdwood  * Configures the DAI master (MCLK) or system (SYSCLK) clocking.
34458c6529dbSLiam Girdwood  */
34468c6529dbSLiam Girdwood int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
34478c6529dbSLiam Girdwood 	unsigned int freq, int dir)
34488c6529dbSLiam Girdwood {
3449f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_sysclk)
3450f0fba2adSLiam Girdwood 		return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir);
3451ec4ee52aSMark Brown 	else if (dai->codec && dai->codec->driver->set_sysclk)
3452da1c6ea6SMark Brown 		return dai->codec->driver->set_sysclk(dai->codec, clk_id, 0,
3453ec4ee52aSMark Brown 						      freq, dir);
34548c6529dbSLiam Girdwood 	else
34551104a9c8SMark Brown 		return -ENOTSUPP;
34568c6529dbSLiam Girdwood }
34578c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
34588c6529dbSLiam Girdwood 
34598c6529dbSLiam Girdwood /**
3460ec4ee52aSMark Brown  * snd_soc_codec_set_sysclk - configure CODEC system or master clock.
3461ec4ee52aSMark Brown  * @codec: CODEC
3462ec4ee52aSMark Brown  * @clk_id: DAI specific clock ID
3463da1c6ea6SMark Brown  * @source: Source for the clock
3464ec4ee52aSMark Brown  * @freq: new clock frequency in Hz
3465ec4ee52aSMark Brown  * @dir: new clock direction - input/output.
3466ec4ee52aSMark Brown  *
3467ec4ee52aSMark Brown  * Configures the CODEC master (MCLK) or system (SYSCLK) clocking.
3468ec4ee52aSMark Brown  */
3469ec4ee52aSMark Brown int snd_soc_codec_set_sysclk(struct snd_soc_codec *codec, int clk_id,
3470da1c6ea6SMark Brown 			     int source, unsigned int freq, int dir)
3471ec4ee52aSMark Brown {
3472ec4ee52aSMark Brown 	if (codec->driver->set_sysclk)
3473da1c6ea6SMark Brown 		return codec->driver->set_sysclk(codec, clk_id, source,
3474da1c6ea6SMark Brown 						 freq, dir);
3475ec4ee52aSMark Brown 	else
34761104a9c8SMark Brown 		return -ENOTSUPP;
3477ec4ee52aSMark Brown }
3478ec4ee52aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_codec_set_sysclk);
3479ec4ee52aSMark Brown 
3480ec4ee52aSMark Brown /**
34818c6529dbSLiam Girdwood  * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
34828c6529dbSLiam Girdwood  * @dai: DAI
3483ac11a2b3SMark Brown  * @div_id: DAI specific clock divider ID
34848c6529dbSLiam Girdwood  * @div: new clock divisor.
34858c6529dbSLiam Girdwood  *
34868c6529dbSLiam Girdwood  * Configures the clock dividers. This is used to derive the best DAI bit and
34878c6529dbSLiam Girdwood  * frame clocks from the system or master clock. It's best to set the DAI bit
34888c6529dbSLiam Girdwood  * and frame clocks as low as possible to save system power.
34898c6529dbSLiam Girdwood  */
34908c6529dbSLiam Girdwood int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
34918c6529dbSLiam Girdwood 	int div_id, int div)
34928c6529dbSLiam Girdwood {
3493f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_clkdiv)
3494f0fba2adSLiam Girdwood 		return dai->driver->ops->set_clkdiv(dai, div_id, div);
34958c6529dbSLiam Girdwood 	else
34968c6529dbSLiam Girdwood 		return -EINVAL;
34978c6529dbSLiam Girdwood }
34988c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv);
34998c6529dbSLiam Girdwood 
35008c6529dbSLiam Girdwood /**
35018c6529dbSLiam Girdwood  * snd_soc_dai_set_pll - configure DAI PLL.
35028c6529dbSLiam Girdwood  * @dai: DAI
35038c6529dbSLiam Girdwood  * @pll_id: DAI specific PLL ID
350485488037SMark Brown  * @source: DAI specific source for the PLL
35058c6529dbSLiam Girdwood  * @freq_in: PLL input clock frequency in Hz
35068c6529dbSLiam Girdwood  * @freq_out: requested PLL output clock frequency in Hz
35078c6529dbSLiam Girdwood  *
35088c6529dbSLiam Girdwood  * Configures and enables PLL to generate output clock based on input clock.
35098c6529dbSLiam Girdwood  */
351085488037SMark Brown int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
351185488037SMark Brown 	unsigned int freq_in, unsigned int freq_out)
35128c6529dbSLiam Girdwood {
3513f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_pll)
3514f0fba2adSLiam Girdwood 		return dai->driver->ops->set_pll(dai, pll_id, source,
351585488037SMark Brown 					 freq_in, freq_out);
3516ec4ee52aSMark Brown 	else if (dai->codec && dai->codec->driver->set_pll)
3517ec4ee52aSMark Brown 		return dai->codec->driver->set_pll(dai->codec, pll_id, source,
3518ec4ee52aSMark Brown 						   freq_in, freq_out);
35198c6529dbSLiam Girdwood 	else
35208c6529dbSLiam Girdwood 		return -EINVAL;
35218c6529dbSLiam Girdwood }
35228c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
35238c6529dbSLiam Girdwood 
3524ec4ee52aSMark Brown /*
3525ec4ee52aSMark Brown  * snd_soc_codec_set_pll - configure codec PLL.
3526ec4ee52aSMark Brown  * @codec: CODEC
3527ec4ee52aSMark Brown  * @pll_id: DAI specific PLL ID
3528ec4ee52aSMark Brown  * @source: DAI specific source for the PLL
3529ec4ee52aSMark Brown  * @freq_in: PLL input clock frequency in Hz
3530ec4ee52aSMark Brown  * @freq_out: requested PLL output clock frequency in Hz
3531ec4ee52aSMark Brown  *
3532ec4ee52aSMark Brown  * Configures and enables PLL to generate output clock based on input clock.
3533ec4ee52aSMark Brown  */
3534ec4ee52aSMark Brown int snd_soc_codec_set_pll(struct snd_soc_codec *codec, int pll_id, int source,
3535ec4ee52aSMark Brown 			  unsigned int freq_in, unsigned int freq_out)
3536ec4ee52aSMark Brown {
3537ec4ee52aSMark Brown 	if (codec->driver->set_pll)
3538ec4ee52aSMark Brown 		return codec->driver->set_pll(codec, pll_id, source,
3539ec4ee52aSMark Brown 					      freq_in, freq_out);
3540ec4ee52aSMark Brown 	else
3541ec4ee52aSMark Brown 		return -EINVAL;
3542ec4ee52aSMark Brown }
3543ec4ee52aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_codec_set_pll);
3544ec4ee52aSMark Brown 
35458c6529dbSLiam Girdwood /**
3546e54cf76bSLiam Girdwood  * snd_soc_dai_set_bclk_ratio - configure BCLK to sample rate ratio.
3547e54cf76bSLiam Girdwood  * @dai: DAI
3548e54cf76bSLiam Girdwood  * @ratio Ratio of BCLK to Sample rate.
3549e54cf76bSLiam Girdwood  *
3550e54cf76bSLiam Girdwood  * Configures the DAI for a preset BCLK to sample rate ratio.
3551e54cf76bSLiam Girdwood  */
3552e54cf76bSLiam Girdwood int snd_soc_dai_set_bclk_ratio(struct snd_soc_dai *dai, unsigned int ratio)
3553e54cf76bSLiam Girdwood {
3554e54cf76bSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_bclk_ratio)
3555e54cf76bSLiam Girdwood 		return dai->driver->ops->set_bclk_ratio(dai, ratio);
3556e54cf76bSLiam Girdwood 	else
3557e54cf76bSLiam Girdwood 		return -EINVAL;
3558e54cf76bSLiam Girdwood }
3559e54cf76bSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_bclk_ratio);
3560e54cf76bSLiam Girdwood 
3561e54cf76bSLiam Girdwood /**
35628c6529dbSLiam Girdwood  * snd_soc_dai_set_fmt - configure DAI hardware audio format.
35638c6529dbSLiam Girdwood  * @dai: DAI
35648c6529dbSLiam Girdwood  * @fmt: SND_SOC_DAIFMT_ format value.
35658c6529dbSLiam Girdwood  *
35668c6529dbSLiam Girdwood  * Configures the DAI hardware format and clocking.
35678c6529dbSLiam Girdwood  */
35688c6529dbSLiam Girdwood int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
35698c6529dbSLiam Girdwood {
35705e4ba569SShawn Guo 	if (dai->driver == NULL)
35718c6529dbSLiam Girdwood 		return -EINVAL;
35725e4ba569SShawn Guo 	if (dai->driver->ops->set_fmt == NULL)
35735e4ba569SShawn Guo 		return -ENOTSUPP;
35745e4ba569SShawn Guo 	return dai->driver->ops->set_fmt(dai, fmt);
35758c6529dbSLiam Girdwood }
35768c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
35778c6529dbSLiam Girdwood 
35788c6529dbSLiam Girdwood /**
3579e5c21514SXiubo Li  * snd_soc_xlate_tdm_slot - generate tx/rx slot mask.
358089c67857SXiubo Li  * @slots: Number of slots in use.
358189c67857SXiubo Li  * @tx_mask: bitmask representing active TX slots.
358289c67857SXiubo Li  * @rx_mask: bitmask representing active RX slots.
358389c67857SXiubo Li  *
358489c67857SXiubo Li  * Generates the TDM tx and rx slot default masks for DAI.
358589c67857SXiubo Li  */
3586e5c21514SXiubo Li static int snd_soc_xlate_tdm_slot_mask(unsigned int slots,
358789c67857SXiubo Li 					  unsigned int *tx_mask,
358889c67857SXiubo Li 					  unsigned int *rx_mask)
358989c67857SXiubo Li {
359089c67857SXiubo Li 	if (*tx_mask || *rx_mask)
359189c67857SXiubo Li 		return 0;
359289c67857SXiubo Li 
359389c67857SXiubo Li 	if (!slots)
359489c67857SXiubo Li 		return -EINVAL;
359589c67857SXiubo Li 
359689c67857SXiubo Li 	*tx_mask = (1 << slots) - 1;
359789c67857SXiubo Li 	*rx_mask = (1 << slots) - 1;
359889c67857SXiubo Li 
359989c67857SXiubo Li 	return 0;
360089c67857SXiubo Li }
360189c67857SXiubo Li 
360289c67857SXiubo Li /**
36038c6529dbSLiam Girdwood  * snd_soc_dai_set_tdm_slot - configure DAI TDM.
36048c6529dbSLiam Girdwood  * @dai: DAI
3605a5479e38SDaniel Ribeiro  * @tx_mask: bitmask representing active TX slots.
3606a5479e38SDaniel Ribeiro  * @rx_mask: bitmask representing active RX slots.
36078c6529dbSLiam Girdwood  * @slots: Number of slots in use.
3608a5479e38SDaniel Ribeiro  * @slot_width: Width in bits for each slot.
36098c6529dbSLiam Girdwood  *
36108c6529dbSLiam Girdwood  * Configures a DAI for TDM operation. Both mask and slots are codec and DAI
36118c6529dbSLiam Girdwood  * specific.
36128c6529dbSLiam Girdwood  */
36138c6529dbSLiam Girdwood int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
3614a5479e38SDaniel Ribeiro 	unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
36158c6529dbSLiam Girdwood {
3616e5c21514SXiubo Li 	if (dai->driver && dai->driver->ops->xlate_tdm_slot_mask)
3617e5c21514SXiubo Li 		dai->driver->ops->xlate_tdm_slot_mask(slots,
361889c67857SXiubo Li 						&tx_mask, &rx_mask);
361989c67857SXiubo Li 	else
3620e5c21514SXiubo Li 		snd_soc_xlate_tdm_slot_mask(slots, &tx_mask, &rx_mask);
362189c67857SXiubo Li 
3622f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_tdm_slot)
3623f0fba2adSLiam Girdwood 		return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask,
3624a5479e38SDaniel Ribeiro 				slots, slot_width);
36258c6529dbSLiam Girdwood 	else
3626b2cbb6e1SXiubo Li 		return -ENOTSUPP;
36278c6529dbSLiam Girdwood }
36288c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
36298c6529dbSLiam Girdwood 
36308c6529dbSLiam Girdwood /**
3631472df3cbSBarry Song  * snd_soc_dai_set_channel_map - configure DAI audio channel map
3632472df3cbSBarry Song  * @dai: DAI
3633472df3cbSBarry Song  * @tx_num: how many TX channels
3634472df3cbSBarry Song  * @tx_slot: pointer to an array which imply the TX slot number channel
3635472df3cbSBarry Song  *           0~num-1 uses
3636472df3cbSBarry Song  * @rx_num: how many RX channels
3637472df3cbSBarry Song  * @rx_slot: pointer to an array which imply the RX slot number channel
3638472df3cbSBarry Song  *           0~num-1 uses
3639472df3cbSBarry Song  *
3640472df3cbSBarry Song  * configure the relationship between channel number and TDM slot number.
3641472df3cbSBarry Song  */
3642472df3cbSBarry Song int snd_soc_dai_set_channel_map(struct snd_soc_dai *dai,
3643472df3cbSBarry Song 	unsigned int tx_num, unsigned int *tx_slot,
3644472df3cbSBarry Song 	unsigned int rx_num, unsigned int *rx_slot)
3645472df3cbSBarry Song {
3646f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_channel_map)
3647f0fba2adSLiam Girdwood 		return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot,
3648472df3cbSBarry Song 			rx_num, rx_slot);
3649472df3cbSBarry Song 	else
3650472df3cbSBarry Song 		return -EINVAL;
3651472df3cbSBarry Song }
3652472df3cbSBarry Song EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map);
3653472df3cbSBarry Song 
3654472df3cbSBarry Song /**
36558c6529dbSLiam Girdwood  * snd_soc_dai_set_tristate - configure DAI system or master clock.
36568c6529dbSLiam Girdwood  * @dai: DAI
36578c6529dbSLiam Girdwood  * @tristate: tristate enable
36588c6529dbSLiam Girdwood  *
36598c6529dbSLiam Girdwood  * Tristates the DAI so that others can use it.
36608c6529dbSLiam Girdwood  */
36618c6529dbSLiam Girdwood int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
36628c6529dbSLiam Girdwood {
3663f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_tristate)
3664f0fba2adSLiam Girdwood 		return dai->driver->ops->set_tristate(dai, tristate);
36658c6529dbSLiam Girdwood 	else
36668c6529dbSLiam Girdwood 		return -EINVAL;
36678c6529dbSLiam Girdwood }
36688c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate);
36698c6529dbSLiam Girdwood 
36708c6529dbSLiam Girdwood /**
36718c6529dbSLiam Girdwood  * snd_soc_dai_digital_mute - configure DAI system or master clock.
36728c6529dbSLiam Girdwood  * @dai: DAI
36738c6529dbSLiam Girdwood  * @mute: mute enable
3674da18396fSMark Brown  * @direction: stream to mute
36758c6529dbSLiam Girdwood  *
36768c6529dbSLiam Girdwood  * Mutes the DAI DAC.
36778c6529dbSLiam Girdwood  */
3678da18396fSMark Brown int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute,
3679da18396fSMark Brown 			     int direction)
36808c6529dbSLiam Girdwood {
3681da18396fSMark Brown 	if (!dai->driver)
3682da18396fSMark Brown 		return -ENOTSUPP;
3683da18396fSMark Brown 
3684da18396fSMark Brown 	if (dai->driver->ops->mute_stream)
3685da18396fSMark Brown 		return dai->driver->ops->mute_stream(dai, mute, direction);
3686da18396fSMark Brown 	else if (direction == SNDRV_PCM_STREAM_PLAYBACK &&
3687da18396fSMark Brown 		 dai->driver->ops->digital_mute)
3688f0fba2adSLiam Girdwood 		return dai->driver->ops->digital_mute(dai, mute);
36898c6529dbSLiam Girdwood 	else
369004570c62SMark Brown 		return -ENOTSUPP;
36918c6529dbSLiam Girdwood }
36928c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
36938c6529dbSLiam Girdwood 
3694c5af3a2eSMark Brown /**
3695c5af3a2eSMark Brown  * snd_soc_register_card - Register a card with the ASoC core
3696c5af3a2eSMark Brown  *
3697ac11a2b3SMark Brown  * @card: Card to register
3698c5af3a2eSMark Brown  *
3699c5af3a2eSMark Brown  */
370070a7ca34SVinod Koul int snd_soc_register_card(struct snd_soc_card *card)
3701c5af3a2eSMark Brown {
3702b19e6e7bSMark Brown 	int i, ret;
3703f0fba2adSLiam Girdwood 
3704c5af3a2eSMark Brown 	if (!card->name || !card->dev)
3705c5af3a2eSMark Brown 		return -EINVAL;
3706c5af3a2eSMark Brown 
37075a504963SStephen Warren 	for (i = 0; i < card->num_links; i++) {
37085a504963SStephen Warren 		struct snd_soc_dai_link *link = &card->dai_link[i];
37095a504963SStephen Warren 
37105a504963SStephen Warren 		/*
37115a504963SStephen Warren 		 * Codec must be specified by 1 of name or OF node,
37125a504963SStephen Warren 		 * not both or neither.
37135a504963SStephen Warren 		 */
37145a504963SStephen Warren 		if (!!link->codec_name == !!link->codec_of_node) {
371510e8aa9aSMichał Mirosław 			dev_err(card->dev,
371610e8aa9aSMichał Mirosław 				"ASoC: Neither/both codec name/of_node are set for %s\n",
371710e8aa9aSMichał Mirosław 				link->name);
37185a504963SStephen Warren 			return -EINVAL;
37195a504963SStephen Warren 		}
3720bc92657aSStephen Warren 		/* Codec DAI name must be specified */
3721bc92657aSStephen Warren 		if (!link->codec_dai_name) {
372210e8aa9aSMichał Mirosław 			dev_err(card->dev,
372310e8aa9aSMichał Mirosław 				"ASoC: codec_dai_name not set for %s\n",
372410e8aa9aSMichał Mirosław 				link->name);
3725bc92657aSStephen Warren 			return -EINVAL;
3726bc92657aSStephen Warren 		}
37275a504963SStephen Warren 
37285a504963SStephen Warren 		/*
37295a504963SStephen Warren 		 * Platform may be specified by either name or OF node, but
37305a504963SStephen Warren 		 * can be left unspecified, and a dummy platform will be used.
37315a504963SStephen Warren 		 */
37325a504963SStephen Warren 		if (link->platform_name && link->platform_of_node) {
373310e8aa9aSMichał Mirosław 			dev_err(card->dev,
373410e8aa9aSMichał Mirosław 				"ASoC: Both platform name/of_node are set for %s\n",
373510e8aa9aSMichał Mirosław 				link->name);
37365a504963SStephen Warren 			return -EINVAL;
37375a504963SStephen Warren 		}
37385a504963SStephen Warren 
37395a504963SStephen Warren 		/*
3740bc92657aSStephen Warren 		 * CPU device may be specified by either name or OF node, but
3741bc92657aSStephen Warren 		 * can be left unspecified, and will be matched based on DAI
3742bc92657aSStephen Warren 		 * name alone..
37435a504963SStephen Warren 		 */
3744bc92657aSStephen Warren 		if (link->cpu_name && link->cpu_of_node) {
374510e8aa9aSMichał Mirosław 			dev_err(card->dev,
374610e8aa9aSMichał Mirosław 				"ASoC: Neither/both cpu name/of_node are set for %s\n",
374710e8aa9aSMichał Mirosław 				link->name);
3748bc92657aSStephen Warren 			return -EINVAL;
3749bc92657aSStephen Warren 		}
3750bc92657aSStephen Warren 		/*
3751bc92657aSStephen Warren 		 * At least one of CPU DAI name or CPU device name/node must be
3752bc92657aSStephen Warren 		 * specified
3753bc92657aSStephen Warren 		 */
3754bc92657aSStephen Warren 		if (!link->cpu_dai_name &&
3755bc92657aSStephen Warren 		    !(link->cpu_name || link->cpu_of_node)) {
375610e8aa9aSMichał Mirosław 			dev_err(card->dev,
375710e8aa9aSMichał Mirosław 				"ASoC: Neither cpu_dai_name nor cpu_name/of_node are set for %s\n",
375810e8aa9aSMichał Mirosław 				link->name);
37595a504963SStephen Warren 			return -EINVAL;
37605a504963SStephen Warren 		}
37615a504963SStephen Warren 	}
37625a504963SStephen Warren 
3763ed77cc12SMark Brown 	dev_set_drvdata(card->dev, card);
3764ed77cc12SMark Brown 
3765111c6419SStephen Warren 	snd_soc_initialize_card_lists(card);
3766111c6419SStephen Warren 
3767150dd2f8SVinod Koul 	soc_init_card_debugfs(card);
3768150dd2f8SVinod Koul 
3769181a6892SMark Brown 	card->rtd = devm_kzalloc(card->dev,
3770181a6892SMark Brown 				 sizeof(struct snd_soc_pcm_runtime) *
37712eea392dSJarkko Nikula 				 (card->num_links + card->num_aux_devs),
3772f0fba2adSLiam Girdwood 				 GFP_KERNEL);
3773f0fba2adSLiam Girdwood 	if (card->rtd == NULL)
3774f0fba2adSLiam Girdwood 		return -ENOMEM;
3775a7dbb603SLiam Girdwood 	card->num_rtd = 0;
37762eea392dSJarkko Nikula 	card->rtd_aux = &card->rtd[card->num_links];
3777f0fba2adSLiam Girdwood 
3778f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_links; i++)
3779f0fba2adSLiam Girdwood 		card->rtd[i].dai_link = &card->dai_link[i];
3780f0fba2adSLiam Girdwood 
3781db432b41SMark Brown 	INIT_LIST_HEAD(&card->dapm_dirty);
3782c5af3a2eSMark Brown 	card->instantiated = 0;
3783f0fba2adSLiam Girdwood 	mutex_init(&card->mutex);
3784a73fb2dfSLiam Girdwood 	mutex_init(&card->dapm_mutex);
3785c5af3a2eSMark Brown 
3786b19e6e7bSMark Brown 	ret = snd_soc_instantiate_card(card);
3787b19e6e7bSMark Brown 	if (ret != 0)
3788b19e6e7bSMark Brown 		soc_cleanup_card_debugfs(card);
3789c5af3a2eSMark Brown 
3790988e8cc4SNicolin Chen 	/* deactivate pins to sleep state */
3791988e8cc4SNicolin Chen 	for (i = 0; i < card->num_rtd; i++) {
3792988e8cc4SNicolin Chen 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
3793988e8cc4SNicolin Chen 		struct snd_soc_dai *codec_dai = card->rtd[i].codec_dai;
3794988e8cc4SNicolin Chen 		if (!codec_dai->active)
3795988e8cc4SNicolin Chen 			pinctrl_pm_select_sleep_state(codec_dai->dev);
3796988e8cc4SNicolin Chen 		if (!cpu_dai->active)
3797988e8cc4SNicolin Chen 			pinctrl_pm_select_sleep_state(cpu_dai->dev);
3798988e8cc4SNicolin Chen 	}
3799988e8cc4SNicolin Chen 
3800b19e6e7bSMark Brown 	return ret;
3801c5af3a2eSMark Brown }
380270a7ca34SVinod Koul EXPORT_SYMBOL_GPL(snd_soc_register_card);
3803c5af3a2eSMark Brown 
3804c5af3a2eSMark Brown /**
3805c5af3a2eSMark Brown  * snd_soc_unregister_card - Unregister a card with the ASoC core
3806c5af3a2eSMark Brown  *
3807ac11a2b3SMark Brown  * @card: Card to unregister
3808c5af3a2eSMark Brown  *
3809c5af3a2eSMark Brown  */
381070a7ca34SVinod Koul int snd_soc_unregister_card(struct snd_soc_card *card)
3811c5af3a2eSMark Brown {
3812b0e26485SVinod Koul 	if (card->instantiated)
3813b0e26485SVinod Koul 		soc_cleanup_card_resources(card);
3814f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: Unregistered card '%s'\n", card->name);
3815c5af3a2eSMark Brown 
3816c5af3a2eSMark Brown 	return 0;
3817c5af3a2eSMark Brown }
381870a7ca34SVinod Koul EXPORT_SYMBOL_GPL(snd_soc_unregister_card);
3819c5af3a2eSMark Brown 
3820f0fba2adSLiam Girdwood /*
3821f0fba2adSLiam Girdwood  * Simplify DAI link configuration by removing ".-1" from device names
3822f0fba2adSLiam Girdwood  * and sanitizing names.
3823f0fba2adSLiam Girdwood  */
38240b9a214aSDimitris Papastamos static char *fmt_single_name(struct device *dev, int *id)
3825f0fba2adSLiam Girdwood {
3826f0fba2adSLiam Girdwood 	char *found, name[NAME_SIZE];
3827f0fba2adSLiam Girdwood 	int id1, id2;
3828f0fba2adSLiam Girdwood 
3829f0fba2adSLiam Girdwood 	if (dev_name(dev) == NULL)
3830f0fba2adSLiam Girdwood 		return NULL;
3831f0fba2adSLiam Girdwood 
383258818a77SDimitris Papastamos 	strlcpy(name, dev_name(dev), NAME_SIZE);
3833f0fba2adSLiam Girdwood 
3834f0fba2adSLiam Girdwood 	/* are we a "%s.%d" name (platform and SPI components) */
3835f0fba2adSLiam Girdwood 	found = strstr(name, dev->driver->name);
3836f0fba2adSLiam Girdwood 	if (found) {
3837f0fba2adSLiam Girdwood 		/* get ID */
3838f0fba2adSLiam Girdwood 		if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) {
3839f0fba2adSLiam Girdwood 
3840f0fba2adSLiam Girdwood 			/* discard ID from name if ID == -1 */
3841f0fba2adSLiam Girdwood 			if (*id == -1)
3842f0fba2adSLiam Girdwood 				found[strlen(dev->driver->name)] = '\0';
3843f0fba2adSLiam Girdwood 		}
3844f0fba2adSLiam Girdwood 
3845f0fba2adSLiam Girdwood 	} else {
3846f0fba2adSLiam Girdwood 		/* I2C component devices are named "bus-addr"  */
3847f0fba2adSLiam Girdwood 		if (sscanf(name, "%x-%x", &id1, &id2) == 2) {
3848f0fba2adSLiam Girdwood 			char tmp[NAME_SIZE];
3849f0fba2adSLiam Girdwood 
3850f0fba2adSLiam Girdwood 			/* create unique ID number from I2C addr and bus */
385105899446SJarkko Nikula 			*id = ((id1 & 0xffff) << 16) + id2;
3852f0fba2adSLiam Girdwood 
3853f0fba2adSLiam Girdwood 			/* sanitize component name for DAI link creation */
3854f0fba2adSLiam Girdwood 			snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name);
385558818a77SDimitris Papastamos 			strlcpy(name, tmp, NAME_SIZE);
3856f0fba2adSLiam Girdwood 		} else
3857f0fba2adSLiam Girdwood 			*id = 0;
3858f0fba2adSLiam Girdwood 	}
3859f0fba2adSLiam Girdwood 
3860f0fba2adSLiam Girdwood 	return kstrdup(name, GFP_KERNEL);
3861f0fba2adSLiam Girdwood }
3862f0fba2adSLiam Girdwood 
3863f0fba2adSLiam Girdwood /*
3864f0fba2adSLiam Girdwood  * Simplify DAI link naming for single devices with multiple DAIs by removing
3865f0fba2adSLiam Girdwood  * any ".-1" and using the DAI name (instead of device name).
3866f0fba2adSLiam Girdwood  */
3867f0fba2adSLiam Girdwood static inline char *fmt_multiple_name(struct device *dev,
3868f0fba2adSLiam Girdwood 		struct snd_soc_dai_driver *dai_drv)
3869f0fba2adSLiam Girdwood {
3870f0fba2adSLiam Girdwood 	if (dai_drv->name == NULL) {
387110e8aa9aSMichał Mirosław 		dev_err(dev,
387210e8aa9aSMichał Mirosław 			"ASoC: error - multiple DAI %s registered with no name\n",
387310e8aa9aSMichał Mirosław 			dev_name(dev));
3874f0fba2adSLiam Girdwood 		return NULL;
3875f0fba2adSLiam Girdwood 	}
3876f0fba2adSLiam Girdwood 
3877f0fba2adSLiam Girdwood 	return kstrdup(dai_drv->name, GFP_KERNEL);
3878f0fba2adSLiam Girdwood }
3879f0fba2adSLiam Girdwood 
38809115171aSMark Brown /**
388132c9ba54SLars-Peter Clausen  * snd_soc_unregister_dai - Unregister DAIs from the ASoC core
38829115171aSMark Brown  *
388332c9ba54SLars-Peter Clausen  * @component: The component for which the DAIs should be unregistered
38849115171aSMark Brown  */
388532c9ba54SLars-Peter Clausen static void snd_soc_unregister_dais(struct snd_soc_component *component)
38869115171aSMark Brown {
38875c1d5f09SLars-Peter Clausen 	struct snd_soc_dai *dai, *_dai;
38889115171aSMark Brown 
38895c1d5f09SLars-Peter Clausen 	list_for_each_entry_safe(dai, _dai, &component->dai_list, list) {
389032c9ba54SLars-Peter Clausen 		dev_dbg(component->dev, "ASoC: Unregistered DAI '%s'\n",
389132c9ba54SLars-Peter Clausen 			dai->name);
38929115171aSMark Brown 		list_del(&dai->list);
3893f0fba2adSLiam Girdwood 		kfree(dai->name);
3894f0fba2adSLiam Girdwood 		kfree(dai);
38959115171aSMark Brown 	}
389632c9ba54SLars-Peter Clausen }
38979115171aSMark Brown 
38989115171aSMark Brown /**
389932c9ba54SLars-Peter Clausen  * snd_soc_register_dais - Register a DAI with the ASoC core
39009115171aSMark Brown  *
39016106d129SLars-Peter Clausen  * @component: The component the DAIs are registered for
39026106d129SLars-Peter Clausen  * @dai_drv: DAI driver to use for the DAIs
3903ac11a2b3SMark Brown  * @count: Number of DAIs
390432c9ba54SLars-Peter Clausen  * @legacy_dai_naming: Use the legacy naming scheme and let the DAI inherit the
390532c9ba54SLars-Peter Clausen  *                     parent's name.
39069115171aSMark Brown  */
390732c9ba54SLars-Peter Clausen static int snd_soc_register_dais(struct snd_soc_component *component,
3908bb13109dSLars-Peter Clausen 	struct snd_soc_dai_driver *dai_drv, size_t count,
3909bb13109dSLars-Peter Clausen 	bool legacy_dai_naming)
39109115171aSMark Brown {
39116106d129SLars-Peter Clausen 	struct device *dev = component->dev;
3912f0fba2adSLiam Girdwood 	struct snd_soc_dai *dai;
391332c9ba54SLars-Peter Clausen 	unsigned int i;
391432c9ba54SLars-Peter Clausen 	int ret;
3915f0fba2adSLiam Girdwood 
3916f110bfc7SLiam Girdwood 	dev_dbg(dev, "ASoC: dai register %s #%Zu\n", dev_name(dev), count);
39179115171aSMark Brown 
3918bb13109dSLars-Peter Clausen 	component->dai_drv = dai_drv;
3919bb13109dSLars-Peter Clausen 	component->num_dai = count;
3920bb13109dSLars-Peter Clausen 
39219115171aSMark Brown 	for (i = 0; i < count; i++) {
3922f0fba2adSLiam Girdwood 
3923f0fba2adSLiam Girdwood 		dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
3924c46e0079SAxel Lin 		if (dai == NULL) {
3925c46e0079SAxel Lin 			ret = -ENOMEM;
3926c46e0079SAxel Lin 			goto err;
3927c46e0079SAxel Lin 		}
3928f0fba2adSLiam Girdwood 
392932c9ba54SLars-Peter Clausen 		/*
393032c9ba54SLars-Peter Clausen 		 * Back in the old days when we still had component-less DAIs,
393132c9ba54SLars-Peter Clausen 		 * instead of having a static name, component-less DAIs would
393232c9ba54SLars-Peter Clausen 		 * inherit the name of the parent device so it is possible to
393332c9ba54SLars-Peter Clausen 		 * register multiple instances of the DAI. We still need to keep
393432c9ba54SLars-Peter Clausen 		 * the same naming style even though those DAIs are not
393532c9ba54SLars-Peter Clausen 		 * component-less anymore.
393632c9ba54SLars-Peter Clausen 		 */
393732c9ba54SLars-Peter Clausen 		if (count == 1 && legacy_dai_naming) {
3938db2a4165SFrank Mandarino 			dai->name = fmt_single_name(dev, &dai->id);
393932c9ba54SLars-Peter Clausen 		} else {
3940f0fba2adSLiam Girdwood 			dai->name = fmt_multiple_name(dev, &dai_drv[i]);
394132c9ba54SLars-Peter Clausen 			if (dai_drv[i].id)
394232c9ba54SLars-Peter Clausen 				dai->id = dai_drv[i].id;
394332c9ba54SLars-Peter Clausen 			else
394432c9ba54SLars-Peter Clausen 				dai->id = i;
394532c9ba54SLars-Peter Clausen 		}
3946f0fba2adSLiam Girdwood 		if (dai->name == NULL) {
3947f0fba2adSLiam Girdwood 			kfree(dai);
394832c9ba54SLars-Peter Clausen 			ret = -ENOMEM;
39499115171aSMark Brown 			goto err;
39509115171aSMark Brown 		}
39519115171aSMark Brown 
39526106d129SLars-Peter Clausen 		dai->component = component;
3953f0fba2adSLiam Girdwood 		dai->dev = dev;
3954f0fba2adSLiam Girdwood 		dai->driver = &dai_drv[i];
3955f0fba2adSLiam Girdwood 		if (!dai->driver->ops)
3956f0fba2adSLiam Girdwood 			dai->driver->ops = &null_dai_ops;
3957f0fba2adSLiam Girdwood 
39581438c2f6SLars-Peter Clausen 		list_add(&dai->list, &component->dai_list);
3959054880feSMark Brown 
39609115171aSMark Brown 		dev_dbg(dev, "ASoC: Registered DAI '%s'\n", dai->name);
3961f0fba2adSLiam Girdwood 	}
3962f0fba2adSLiam Girdwood 
39639115171aSMark Brown 	return 0;
39649115171aSMark Brown 
39659115171aSMark Brown err:
396632c9ba54SLars-Peter Clausen 	snd_soc_unregister_dais(component);
39679115171aSMark Brown 
39689115171aSMark Brown 	return ret;
39699115171aSMark Brown }
39709115171aSMark Brown 
397114e8bdebSLars-Peter Clausen static void snd_soc_component_seq_notifier(struct snd_soc_dapm_context *dapm,
397214e8bdebSLars-Peter Clausen 	enum snd_soc_dapm_type type, int subseq)
397314e8bdebSLars-Peter Clausen {
397414e8bdebSLars-Peter Clausen 	struct snd_soc_component *component = dapm->component;
397514e8bdebSLars-Peter Clausen 
397614e8bdebSLars-Peter Clausen 	component->driver->seq_notifier(component, type, subseq);
397714e8bdebSLars-Peter Clausen }
397814e8bdebSLars-Peter Clausen 
397914e8bdebSLars-Peter Clausen static int snd_soc_component_stream_event(struct snd_soc_dapm_context *dapm,
398014e8bdebSLars-Peter Clausen 	int event)
398114e8bdebSLars-Peter Clausen {
398214e8bdebSLars-Peter Clausen 	struct snd_soc_component *component = dapm->component;
398314e8bdebSLars-Peter Clausen 
398414e8bdebSLars-Peter Clausen 	return component->driver->stream_event(component, event);
398514e8bdebSLars-Peter Clausen }
398614e8bdebSLars-Peter Clausen 
3987bb13109dSLars-Peter Clausen static int snd_soc_component_initialize(struct snd_soc_component *component,
3988bb13109dSLars-Peter Clausen 	const struct snd_soc_component_driver *driver, struct device *dev)
3989d191bd8dSKuninori Morimoto {
3990ce0fc93aSLars-Peter Clausen 	struct snd_soc_dapm_context *dapm;
3991ce0fc93aSLars-Peter Clausen 
3992bb13109dSLars-Peter Clausen 	component->name = fmt_single_name(dev, &component->id);
3993bb13109dSLars-Peter Clausen 	if (!component->name) {
3994bb13109dSLars-Peter Clausen 		dev_err(dev, "ASoC: Failed to allocate name\n");
3995d191bd8dSKuninori Morimoto 		return -ENOMEM;
3996d191bd8dSKuninori Morimoto 	}
3997d191bd8dSKuninori Morimoto 
3998bb13109dSLars-Peter Clausen 	component->dev = dev;
3999bb13109dSLars-Peter Clausen 	component->driver = driver;
4000e2c330b9SLars-Peter Clausen 
4001ce0fc93aSLars-Peter Clausen 	if (!component->dapm_ptr)
4002ce0fc93aSLars-Peter Clausen 		component->dapm_ptr = &component->dapm;
4003ce0fc93aSLars-Peter Clausen 
4004ce0fc93aSLars-Peter Clausen 	dapm = component->dapm_ptr;
4005ce0fc93aSLars-Peter Clausen 	dapm->dev = dev;
4006ce0fc93aSLars-Peter Clausen 	dapm->component = component;
4007ce0fc93aSLars-Peter Clausen 	dapm->bias_level = SND_SOC_BIAS_OFF;
400814e8bdebSLars-Peter Clausen 	if (driver->seq_notifier)
400914e8bdebSLars-Peter Clausen 		dapm->seq_notifier = snd_soc_component_seq_notifier;
401014e8bdebSLars-Peter Clausen 	if (driver->stream_event)
401114e8bdebSLars-Peter Clausen 		dapm->stream_event = snd_soc_component_stream_event;
4012ce0fc93aSLars-Peter Clausen 
4013bb13109dSLars-Peter Clausen 	INIT_LIST_HEAD(&component->dai_list);
4014bb13109dSLars-Peter Clausen 	mutex_init(&component->io_mutex);
4015bb13109dSLars-Peter Clausen 
4016bb13109dSLars-Peter Clausen 	return 0;
4017d191bd8dSKuninori Morimoto }
4018d191bd8dSKuninori Morimoto 
4019bb13109dSLars-Peter Clausen static void snd_soc_component_add_unlocked(struct snd_soc_component *component)
4020bb13109dSLars-Peter Clausen {
4021bb13109dSLars-Peter Clausen 	list_add(&component->list, &component_list);
4022d191bd8dSKuninori Morimoto }
4023d191bd8dSKuninori Morimoto 
4024bb13109dSLars-Peter Clausen static void snd_soc_component_add(struct snd_soc_component *component)
4025bb13109dSLars-Peter Clausen {
4026d191bd8dSKuninori Morimoto 	mutex_lock(&client_mutex);
4027bb13109dSLars-Peter Clausen 	snd_soc_component_add_unlocked(component);
4028d191bd8dSKuninori Morimoto 	mutex_unlock(&client_mutex);
4029bb13109dSLars-Peter Clausen }
4030d191bd8dSKuninori Morimoto 
4031bb13109dSLars-Peter Clausen static void snd_soc_component_cleanup(struct snd_soc_component *component)
4032bb13109dSLars-Peter Clausen {
4033bb13109dSLars-Peter Clausen 	snd_soc_unregister_dais(component);
4034bb13109dSLars-Peter Clausen 	kfree(component->name);
4035bb13109dSLars-Peter Clausen }
4036d191bd8dSKuninori Morimoto 
4037bb13109dSLars-Peter Clausen static void snd_soc_component_del_unlocked(struct snd_soc_component *component)
4038bb13109dSLars-Peter Clausen {
4039bb13109dSLars-Peter Clausen 	list_del(&component->list);
4040bb13109dSLars-Peter Clausen }
4041d191bd8dSKuninori Morimoto 
4042bb13109dSLars-Peter Clausen static void snd_soc_component_del(struct snd_soc_component *component)
4043bb13109dSLars-Peter Clausen {
4044bb13109dSLars-Peter Clausen 	mutex_lock(&client_mutex);
4045bb13109dSLars-Peter Clausen 	snd_soc_component_del_unlocked(component);
4046bb13109dSLars-Peter Clausen 	mutex_unlock(&client_mutex);
4047d191bd8dSKuninori Morimoto }
4048d191bd8dSKuninori Morimoto 
4049d191bd8dSKuninori Morimoto int snd_soc_register_component(struct device *dev,
4050d191bd8dSKuninori Morimoto 			       const struct snd_soc_component_driver *cmpnt_drv,
4051d191bd8dSKuninori Morimoto 			       struct snd_soc_dai_driver *dai_drv,
4052d191bd8dSKuninori Morimoto 			       int num_dai)
4053d191bd8dSKuninori Morimoto {
4054d191bd8dSKuninori Morimoto 	struct snd_soc_component *cmpnt;
4055bb13109dSLars-Peter Clausen 	int ret;
4056d191bd8dSKuninori Morimoto 
4057bb13109dSLars-Peter Clausen 	cmpnt = kzalloc(sizeof(*cmpnt), GFP_KERNEL);
4058d191bd8dSKuninori Morimoto 	if (!cmpnt) {
4059d191bd8dSKuninori Morimoto 		dev_err(dev, "ASoC: Failed to allocate memory\n");
4060d191bd8dSKuninori Morimoto 		return -ENOMEM;
4061d191bd8dSKuninori Morimoto 	}
4062d191bd8dSKuninori Morimoto 
4063bb13109dSLars-Peter Clausen 	ret = snd_soc_component_initialize(cmpnt, cmpnt_drv, dev);
4064bb13109dSLars-Peter Clausen 	if (ret)
4065bb13109dSLars-Peter Clausen 		goto err_free;
4066bb13109dSLars-Peter Clausen 
40673d59400fSLars-Peter Clausen 	cmpnt->ignore_pmdown_time = true;
406898e639fbSLars-Peter Clausen 	cmpnt->registered_as_component = true;
40693d59400fSLars-Peter Clausen 
4070bb13109dSLars-Peter Clausen 	ret = snd_soc_register_dais(cmpnt, dai_drv, num_dai, true);
4071bb13109dSLars-Peter Clausen 	if (ret < 0) {
4072bb13109dSLars-Peter Clausen 		dev_err(dev, "ASoC: Failed to regster DAIs: %d\n", ret);
4073bb13109dSLars-Peter Clausen 		goto err_cleanup;
4074bb13109dSLars-Peter Clausen 	}
4075bb13109dSLars-Peter Clausen 
4076bb13109dSLars-Peter Clausen 	snd_soc_component_add(cmpnt);
4077bb13109dSLars-Peter Clausen 
4078bb13109dSLars-Peter Clausen 	return 0;
4079bb13109dSLars-Peter Clausen 
4080bb13109dSLars-Peter Clausen err_cleanup:
4081bb13109dSLars-Peter Clausen 	snd_soc_component_cleanup(cmpnt);
4082bb13109dSLars-Peter Clausen err_free:
4083bb13109dSLars-Peter Clausen 	kfree(cmpnt);
4084bb13109dSLars-Peter Clausen 	return ret;
4085d191bd8dSKuninori Morimoto }
4086d191bd8dSKuninori Morimoto EXPORT_SYMBOL_GPL(snd_soc_register_component);
4087d191bd8dSKuninori Morimoto 
4088d191bd8dSKuninori Morimoto /**
4089d191bd8dSKuninori Morimoto  * snd_soc_unregister_component - Unregister a component from the ASoC core
4090d191bd8dSKuninori Morimoto  *
4091d191bd8dSKuninori Morimoto  */
4092d191bd8dSKuninori Morimoto void snd_soc_unregister_component(struct device *dev)
4093d191bd8dSKuninori Morimoto {
4094d191bd8dSKuninori Morimoto 	struct snd_soc_component *cmpnt;
4095d191bd8dSKuninori Morimoto 
4096d191bd8dSKuninori Morimoto 	list_for_each_entry(cmpnt, &component_list, list) {
409798e639fbSLars-Peter Clausen 		if (dev == cmpnt->dev && cmpnt->registered_as_component)
4098d191bd8dSKuninori Morimoto 			goto found;
4099d191bd8dSKuninori Morimoto 	}
4100d191bd8dSKuninori Morimoto 	return;
4101d191bd8dSKuninori Morimoto 
4102d191bd8dSKuninori Morimoto found:
4103bb13109dSLars-Peter Clausen 	snd_soc_component_del(cmpnt);
4104bb13109dSLars-Peter Clausen 	snd_soc_component_cleanup(cmpnt);
4105bb13109dSLars-Peter Clausen 	kfree(cmpnt);
4106d191bd8dSKuninori Morimoto }
4107d191bd8dSKuninori Morimoto EXPORT_SYMBOL_GPL(snd_soc_unregister_component);
4108d191bd8dSKuninori Morimoto 
4109e2c330b9SLars-Peter Clausen static int snd_soc_platform_drv_write(struct snd_soc_component *component,
4110e2c330b9SLars-Peter Clausen 	unsigned int reg, unsigned int val)
4111e2c330b9SLars-Peter Clausen {
4112e2c330b9SLars-Peter Clausen 	struct snd_soc_platform *platform = snd_soc_component_to_platform(component);
4113e2c330b9SLars-Peter Clausen 
4114e2c330b9SLars-Peter Clausen 	return platform->driver->write(platform, reg, val);
4115e2c330b9SLars-Peter Clausen }
4116e2c330b9SLars-Peter Clausen 
4117e2c330b9SLars-Peter Clausen static int snd_soc_platform_drv_read(struct snd_soc_component *component,
4118e2c330b9SLars-Peter Clausen 	unsigned int reg, unsigned int *val)
4119e2c330b9SLars-Peter Clausen {
4120e2c330b9SLars-Peter Clausen 	struct snd_soc_platform *platform = snd_soc_component_to_platform(component);
4121e2c330b9SLars-Peter Clausen 
4122e2c330b9SLars-Peter Clausen 	*val = platform->driver->read(platform, reg);
4123e2c330b9SLars-Peter Clausen 
4124e2c330b9SLars-Peter Clausen 	return 0;
4125e2c330b9SLars-Peter Clausen }
4126e2c330b9SLars-Peter Clausen 
4127d191bd8dSKuninori Morimoto /**
412871a45cdaSLars-Peter Clausen  * snd_soc_add_platform - Add a platform to the ASoC core
412971a45cdaSLars-Peter Clausen  * @dev: The parent device for the platform
413071a45cdaSLars-Peter Clausen  * @platform: The platform to add
413171a45cdaSLars-Peter Clausen  * @platform_driver: The driver for the platform
413212a48a8cSMark Brown  */
413371a45cdaSLars-Peter Clausen int snd_soc_add_platform(struct device *dev, struct snd_soc_platform *platform,
4134d79e57dbSLars-Peter Clausen 		const struct snd_soc_platform_driver *platform_drv)
413512a48a8cSMark Brown {
4136b37f1d12SLars-Peter Clausen 	int ret;
4137b37f1d12SLars-Peter Clausen 
4138bb13109dSLars-Peter Clausen 	ret = snd_soc_component_initialize(&platform->component,
4139bb13109dSLars-Peter Clausen 			&platform_drv->component_driver, dev);
4140bb13109dSLars-Peter Clausen 	if (ret)
4141bb13109dSLars-Peter Clausen 		return ret;
4142bb13109dSLars-Peter Clausen 
4143f0fba2adSLiam Girdwood 	platform->dev = dev;
4144f0fba2adSLiam Girdwood 	platform->driver = platform_drv;
4145e2c330b9SLars-Peter Clausen 	if (platform_drv->write)
4146e2c330b9SLars-Peter Clausen 		platform->component.write = snd_soc_platform_drv_write;
4147e2c330b9SLars-Peter Clausen 	if (platform_drv->read)
4148e2c330b9SLars-Peter Clausen 		platform->component.read = snd_soc_platform_drv_read;
414912a48a8cSMark Brown 
415012a48a8cSMark Brown 	mutex_lock(&client_mutex);
4151bb13109dSLars-Peter Clausen 	snd_soc_component_add_unlocked(&platform->component);
415212a48a8cSMark Brown 	list_add(&platform->list, &platform_list);
415312a48a8cSMark Brown 	mutex_unlock(&client_mutex);
415412a48a8cSMark Brown 
4155f4333203SLars-Peter Clausen 	dev_dbg(dev, "ASoC: Registered platform '%s'\n",
4156f4333203SLars-Peter Clausen 		platform->component.name);
415712a48a8cSMark Brown 
415812a48a8cSMark Brown 	return 0;
415912a48a8cSMark Brown }
416071a45cdaSLars-Peter Clausen EXPORT_SYMBOL_GPL(snd_soc_add_platform);
416171a45cdaSLars-Peter Clausen 
416271a45cdaSLars-Peter Clausen /**
416371a45cdaSLars-Peter Clausen  * snd_soc_register_platform - Register a platform with the ASoC core
416471a45cdaSLars-Peter Clausen  *
416571a45cdaSLars-Peter Clausen  * @platform: platform to register
416671a45cdaSLars-Peter Clausen  */
416771a45cdaSLars-Peter Clausen int snd_soc_register_platform(struct device *dev,
416871a45cdaSLars-Peter Clausen 		const struct snd_soc_platform_driver *platform_drv)
416971a45cdaSLars-Peter Clausen {
417071a45cdaSLars-Peter Clausen 	struct snd_soc_platform *platform;
417171a45cdaSLars-Peter Clausen 	int ret;
417271a45cdaSLars-Peter Clausen 
417371a45cdaSLars-Peter Clausen 	dev_dbg(dev, "ASoC: platform register %s\n", dev_name(dev));
417471a45cdaSLars-Peter Clausen 
417571a45cdaSLars-Peter Clausen 	platform = kzalloc(sizeof(struct snd_soc_platform), GFP_KERNEL);
417671a45cdaSLars-Peter Clausen 	if (platform == NULL)
417771a45cdaSLars-Peter Clausen 		return -ENOMEM;
417871a45cdaSLars-Peter Clausen 
417971a45cdaSLars-Peter Clausen 	ret = snd_soc_add_platform(dev, platform, platform_drv);
418071a45cdaSLars-Peter Clausen 	if (ret)
418171a45cdaSLars-Peter Clausen 		kfree(platform);
418271a45cdaSLars-Peter Clausen 
418371a45cdaSLars-Peter Clausen 	return ret;
418471a45cdaSLars-Peter Clausen }
418512a48a8cSMark Brown EXPORT_SYMBOL_GPL(snd_soc_register_platform);
418612a48a8cSMark Brown 
418712a48a8cSMark Brown /**
418871a45cdaSLars-Peter Clausen  * snd_soc_remove_platform - Remove a platform from the ASoC core
418971a45cdaSLars-Peter Clausen  * @platform: the platform to remove
419071a45cdaSLars-Peter Clausen  */
419171a45cdaSLars-Peter Clausen void snd_soc_remove_platform(struct snd_soc_platform *platform)
419271a45cdaSLars-Peter Clausen {
4193b37f1d12SLars-Peter Clausen 
419471a45cdaSLars-Peter Clausen 	mutex_lock(&client_mutex);
419571a45cdaSLars-Peter Clausen 	list_del(&platform->list);
4196bb13109dSLars-Peter Clausen 	snd_soc_component_del_unlocked(&platform->component);
419771a45cdaSLars-Peter Clausen 	mutex_unlock(&client_mutex);
419871a45cdaSLars-Peter Clausen 
4199bb13109dSLars-Peter Clausen 	snd_soc_component_cleanup(&platform->component);
4200bb13109dSLars-Peter Clausen 
420171a45cdaSLars-Peter Clausen 	dev_dbg(platform->dev, "ASoC: Unregistered platform '%s'\n",
4202f4333203SLars-Peter Clausen 		platform->component.name);
420371a45cdaSLars-Peter Clausen }
420471a45cdaSLars-Peter Clausen EXPORT_SYMBOL_GPL(snd_soc_remove_platform);
420571a45cdaSLars-Peter Clausen 
420671a45cdaSLars-Peter Clausen struct snd_soc_platform *snd_soc_lookup_platform(struct device *dev)
420771a45cdaSLars-Peter Clausen {
420871a45cdaSLars-Peter Clausen 	struct snd_soc_platform *platform;
420971a45cdaSLars-Peter Clausen 
421071a45cdaSLars-Peter Clausen 	list_for_each_entry(platform, &platform_list, list) {
421171a45cdaSLars-Peter Clausen 		if (dev == platform->dev)
421271a45cdaSLars-Peter Clausen 			return platform;
421371a45cdaSLars-Peter Clausen 	}
421471a45cdaSLars-Peter Clausen 
421571a45cdaSLars-Peter Clausen 	return NULL;
421671a45cdaSLars-Peter Clausen }
421771a45cdaSLars-Peter Clausen EXPORT_SYMBOL_GPL(snd_soc_lookup_platform);
421871a45cdaSLars-Peter Clausen 
421971a45cdaSLars-Peter Clausen /**
422012a48a8cSMark Brown  * snd_soc_unregister_platform - Unregister a platform from the ASoC core
422112a48a8cSMark Brown  *
4222ac11a2b3SMark Brown  * @platform: platform to unregister
422312a48a8cSMark Brown  */
4224f0fba2adSLiam Girdwood void snd_soc_unregister_platform(struct device *dev)
422512a48a8cSMark Brown {
4226f0fba2adSLiam Girdwood 	struct snd_soc_platform *platform;
4227f0fba2adSLiam Girdwood 
422871a45cdaSLars-Peter Clausen 	platform = snd_soc_lookup_platform(dev);
422971a45cdaSLars-Peter Clausen 	if (!platform)
4230f0fba2adSLiam Girdwood 		return;
4231f0fba2adSLiam Girdwood 
423271a45cdaSLars-Peter Clausen 	snd_soc_remove_platform(platform);
4233f0fba2adSLiam Girdwood 	kfree(platform);
423412a48a8cSMark Brown }
423512a48a8cSMark Brown EXPORT_SYMBOL_GPL(snd_soc_unregister_platform);
423612a48a8cSMark Brown 
4237151ab22cSMark Brown static u64 codec_format_map[] = {
4238151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE,
4239151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE,
4240151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_BE,
4241151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U24_LE | SNDRV_PCM_FMTBIT_U24_BE,
4242151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE,
4243151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE,
4244151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
4245151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
4246151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S20_3BE,
4247151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U20_3LE | SNDRV_PCM_FMTBIT_U20_3BE,
4248151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S18_3BE,
4249151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U18_3LE | SNDRV_PCM_FMTBIT_U18_3BE,
4250151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_FLOAT_LE | SNDRV_PCM_FMTBIT_FLOAT_BE,
4251151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_FLOAT64_LE | SNDRV_PCM_FMTBIT_FLOAT64_BE,
4252151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE
4253151ab22cSMark Brown 	| SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE,
4254151ab22cSMark Brown };
4255151ab22cSMark Brown 
4256151ab22cSMark Brown /* Fix up the DAI formats for endianness: codecs don't actually see
4257151ab22cSMark Brown  * the endianness of the data but we're using the CPU format
4258151ab22cSMark Brown  * definitions which do need to include endianness so we ensure that
4259151ab22cSMark Brown  * codec DAIs always have both big and little endian variants set.
4260151ab22cSMark Brown  */
4261151ab22cSMark Brown static void fixup_codec_formats(struct snd_soc_pcm_stream *stream)
4262151ab22cSMark Brown {
4263151ab22cSMark Brown 	int i;
4264151ab22cSMark Brown 
4265151ab22cSMark Brown 	for (i = 0; i < ARRAY_SIZE(codec_format_map); i++)
4266151ab22cSMark Brown 		if (stream->formats & codec_format_map[i])
4267151ab22cSMark Brown 			stream->formats |= codec_format_map[i];
4268151ab22cSMark Brown }
4269151ab22cSMark Brown 
4270e2c330b9SLars-Peter Clausen static int snd_soc_codec_drv_write(struct snd_soc_component *component,
4271e2c330b9SLars-Peter Clausen 	unsigned int reg, unsigned int val)
4272e2c330b9SLars-Peter Clausen {
4273e2c330b9SLars-Peter Clausen 	struct snd_soc_codec *codec = snd_soc_component_to_codec(component);
4274e2c330b9SLars-Peter Clausen 
4275e2c330b9SLars-Peter Clausen 	return codec->driver->write(codec, reg, val);
4276e2c330b9SLars-Peter Clausen }
4277e2c330b9SLars-Peter Clausen 
4278e2c330b9SLars-Peter Clausen static int snd_soc_codec_drv_read(struct snd_soc_component *component,
4279e2c330b9SLars-Peter Clausen 	unsigned int reg, unsigned int *val)
4280e2c330b9SLars-Peter Clausen {
4281e2c330b9SLars-Peter Clausen 	struct snd_soc_codec *codec = snd_soc_component_to_codec(component);
4282e2c330b9SLars-Peter Clausen 
4283e2c330b9SLars-Peter Clausen 	*val = codec->driver->read(codec, reg);
4284e2c330b9SLars-Peter Clausen 
4285e2c330b9SLars-Peter Clausen 	return 0;
4286e2c330b9SLars-Peter Clausen }
4287e2c330b9SLars-Peter Clausen 
428868f831c2SLars-Peter Clausen static int snd_soc_codec_set_bias_level(struct snd_soc_dapm_context *dapm,
428968f831c2SLars-Peter Clausen 	enum snd_soc_bias_level level)
429068f831c2SLars-Peter Clausen {
429168f831c2SLars-Peter Clausen 	struct snd_soc_codec *codec = snd_soc_dapm_to_codec(dapm);
429268f831c2SLars-Peter Clausen 
429368f831c2SLars-Peter Clausen 	return codec->driver->set_bias_level(codec, level);
429468f831c2SLars-Peter Clausen }
429568f831c2SLars-Peter Clausen 
42960d0cf00aSMark Brown /**
42970d0cf00aSMark Brown  * snd_soc_register_codec - Register a codec with the ASoC core
42980d0cf00aSMark Brown  *
4299ac11a2b3SMark Brown  * @codec: codec to register
43000d0cf00aSMark Brown  */
4301f0fba2adSLiam Girdwood int snd_soc_register_codec(struct device *dev,
4302001ae4c0SMark Brown 			   const struct snd_soc_codec_driver *codec_drv,
4303001ae4c0SMark Brown 			   struct snd_soc_dai_driver *dai_drv,
4304001ae4c0SMark Brown 			   int num_dai)
43050d0cf00aSMark Brown {
4306f0fba2adSLiam Girdwood 	struct snd_soc_codec *codec;
4307bb13109dSLars-Peter Clausen 	struct snd_soc_dai *dai;
4308a39f75f7SXiubo Li 	struct regmap *regmap;
4309f0fba2adSLiam Girdwood 	int ret, i;
4310151ab22cSMark Brown 
4311f0fba2adSLiam Girdwood 	dev_dbg(dev, "codec register %s\n", dev_name(dev));
43120d0cf00aSMark Brown 
4313f0fba2adSLiam Girdwood 	codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
4314f0fba2adSLiam Girdwood 	if (codec == NULL)
4315f0fba2adSLiam Girdwood 		return -ENOMEM;
43160d0cf00aSMark Brown 
4317ce0fc93aSLars-Peter Clausen 	codec->component.dapm_ptr = &codec->dapm;
4318ce0fc93aSLars-Peter Clausen 
4319bb13109dSLars-Peter Clausen 	ret = snd_soc_component_initialize(&codec->component,
4320bb13109dSLars-Peter Clausen 			&codec_drv->component_driver, dev);
4321bb13109dSLars-Peter Clausen 	if (ret)
4322bb13109dSLars-Peter Clausen 		goto err_free;
4323bb13109dSLars-Peter Clausen 
4324e2c330b9SLars-Peter Clausen 	if (codec_drv->write)
4325e2c330b9SLars-Peter Clausen 		codec->component.write = snd_soc_codec_drv_write;
4326e2c330b9SLars-Peter Clausen 	if (codec_drv->read)
4327e2c330b9SLars-Peter Clausen 		codec->component.read = snd_soc_codec_drv_read;
43283d59400fSLars-Peter Clausen 	codec->component.ignore_pmdown_time = codec_drv->ignore_pmdown_time;
4329ce6120ccSLiam Girdwood 	codec->dapm.codec = codec;
433014e8bdebSLars-Peter Clausen 	if (codec_drv->seq_notifier)
4331474b62d6SMark Brown 		codec->dapm.seq_notifier = codec_drv->seq_notifier;
433268f831c2SLars-Peter Clausen 	if (codec_drv->set_bias_level)
433368f831c2SLars-Peter Clausen 		codec->dapm.set_bias_level = snd_soc_codec_set_bias_level;
4334f0fba2adSLiam Girdwood 	codec->dev = dev;
4335f0fba2adSLiam Girdwood 	codec->driver = codec_drv;
4336e2c330b9SLars-Peter Clausen 	codec->component.val_bytes = codec_drv->reg_word_size;
4337f0fba2adSLiam Girdwood 	mutex_init(&codec->mutex);
4338f0fba2adSLiam Girdwood 
4339e2c330b9SLars-Peter Clausen 	if (!codec->component.write) {
4340a39f75f7SXiubo Li 		if (codec_drv->get_regmap)
4341a39f75f7SXiubo Li 			regmap = codec_drv->get_regmap(dev);
4342a39f75f7SXiubo Li 		else
4343a39f75f7SXiubo Li 			regmap = dev_get_regmap(dev, NULL);
4344a39f75f7SXiubo Li 
4345a39f75f7SXiubo Li 		if (regmap) {
4346e2c330b9SLars-Peter Clausen 			ret = snd_soc_component_init_io(&codec->component,
4347e2c330b9SLars-Peter Clausen 				regmap);
4348e2c330b9SLars-Peter Clausen 			if (ret) {
4349a39f75f7SXiubo Li 				dev_err(codec->dev,
4350a39f75f7SXiubo Li 						"Failed to set cache I/O:%d\n",
4351a39f75f7SXiubo Li 						ret);
4352bb13109dSLars-Peter Clausen 				goto err_cleanup;
4353a39f75f7SXiubo Li 			}
4354a39f75f7SXiubo Li 		}
4355a39f75f7SXiubo Li 	}
4356a39f75f7SXiubo Li 
4357f0fba2adSLiam Girdwood 	for (i = 0; i < num_dai; i++) {
4358f0fba2adSLiam Girdwood 		fixup_codec_formats(&dai_drv[i].playback);
4359f0fba2adSLiam Girdwood 		fixup_codec_formats(&dai_drv[i].capture);
4360f0fba2adSLiam Girdwood 	}
4361f0fba2adSLiam Girdwood 
4362bb13109dSLars-Peter Clausen 	ret = snd_soc_register_dais(&codec->component, dai_drv, num_dai, false);
4363bb13109dSLars-Peter Clausen 	if (ret < 0) {
4364bb13109dSLars-Peter Clausen 		dev_err(dev, "ASoC: Failed to regster DAIs: %d\n", ret);
4365bb13109dSLars-Peter Clausen 		goto err_cleanup;
4366bb13109dSLars-Peter Clausen 	}
4367bb13109dSLars-Peter Clausen 
4368bb13109dSLars-Peter Clausen 	list_for_each_entry(dai, &codec->component.dai_list, list)
4369bb13109dSLars-Peter Clausen 		dai->codec = codec;
4370bb13109dSLars-Peter Clausen 
4371054880feSMark Brown 	mutex_lock(&client_mutex);
4372bb13109dSLars-Peter Clausen 	snd_soc_component_add_unlocked(&codec->component);
4373054880feSMark Brown 	list_add(&codec->list, &codec_list);
4374054880feSMark Brown 	mutex_unlock(&client_mutex);
4375054880feSMark Brown 
4376f4333203SLars-Peter Clausen 	dev_dbg(codec->dev, "ASoC: Registered codec '%s'\n",
4377f4333203SLars-Peter Clausen 		codec->component.name);
43780d0cf00aSMark Brown 	return 0;
4379f0fba2adSLiam Girdwood 
4380bb13109dSLars-Peter Clausen err_cleanup:
4381bb13109dSLars-Peter Clausen 	snd_soc_component_cleanup(&codec->component);
4382bb13109dSLars-Peter Clausen err_free:
4383f0fba2adSLiam Girdwood 	kfree(codec);
4384f0fba2adSLiam Girdwood 	return ret;
43850d0cf00aSMark Brown }
43860d0cf00aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_register_codec);
43870d0cf00aSMark Brown 
43880d0cf00aSMark Brown /**
43890d0cf00aSMark Brown  * snd_soc_unregister_codec - Unregister a codec from the ASoC core
43900d0cf00aSMark Brown  *
4391ac11a2b3SMark Brown  * @codec: codec to unregister
43920d0cf00aSMark Brown  */
4393f0fba2adSLiam Girdwood void snd_soc_unregister_codec(struct device *dev)
43940d0cf00aSMark Brown {
4395f0fba2adSLiam Girdwood 	struct snd_soc_codec *codec;
4396f0fba2adSLiam Girdwood 
4397f0fba2adSLiam Girdwood 	list_for_each_entry(codec, &codec_list, list) {
4398f0fba2adSLiam Girdwood 		if (dev == codec->dev)
4399f0fba2adSLiam Girdwood 			goto found;
4400f0fba2adSLiam Girdwood 	}
4401f0fba2adSLiam Girdwood 	return;
4402f0fba2adSLiam Girdwood 
4403f0fba2adSLiam Girdwood found:
4404f0fba2adSLiam Girdwood 
44050d0cf00aSMark Brown 	mutex_lock(&client_mutex);
44060d0cf00aSMark Brown 	list_del(&codec->list);
4407bb13109dSLars-Peter Clausen 	snd_soc_component_del_unlocked(&codec->component);
44080d0cf00aSMark Brown 	mutex_unlock(&client_mutex);
44090d0cf00aSMark Brown 
4410f4333203SLars-Peter Clausen 	dev_dbg(codec->dev, "ASoC: Unregistered codec '%s'\n",
4411f4333203SLars-Peter Clausen 			codec->component.name);
4412f0fba2adSLiam Girdwood 
4413bb13109dSLars-Peter Clausen 	snd_soc_component_cleanup(&codec->component);
44147a30a3dbSDimitris Papastamos 	snd_soc_cache_exit(codec);
4415f0fba2adSLiam Girdwood 	kfree(codec);
44160d0cf00aSMark Brown }
44170d0cf00aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_unregister_codec);
44180d0cf00aSMark Brown 
4419bec4fa05SStephen Warren /* Retrieve a card's name from device tree */
4420bec4fa05SStephen Warren int snd_soc_of_parse_card_name(struct snd_soc_card *card,
4421bec4fa05SStephen Warren 			       const char *propname)
4422bec4fa05SStephen Warren {
4423bec4fa05SStephen Warren 	struct device_node *np = card->dev->of_node;
4424bec4fa05SStephen Warren 	int ret;
4425bec4fa05SStephen Warren 
4426bec4fa05SStephen Warren 	ret = of_property_read_string_index(np, propname, 0, &card->name);
4427bec4fa05SStephen Warren 	/*
4428bec4fa05SStephen Warren 	 * EINVAL means the property does not exist. This is fine providing
4429bec4fa05SStephen Warren 	 * card->name was previously set, which is checked later in
4430bec4fa05SStephen Warren 	 * snd_soc_register_card.
4431bec4fa05SStephen Warren 	 */
4432bec4fa05SStephen Warren 	if (ret < 0 && ret != -EINVAL) {
4433bec4fa05SStephen Warren 		dev_err(card->dev,
4434f110bfc7SLiam Girdwood 			"ASoC: Property '%s' could not be read: %d\n",
4435bec4fa05SStephen Warren 			propname, ret);
4436bec4fa05SStephen Warren 		return ret;
4437bec4fa05SStephen Warren 	}
4438bec4fa05SStephen Warren 
4439bec4fa05SStephen Warren 	return 0;
4440bec4fa05SStephen Warren }
4441bec4fa05SStephen Warren EXPORT_SYMBOL_GPL(snd_soc_of_parse_card_name);
4442bec4fa05SStephen Warren 
44439a6d4860SXiubo Li static const struct snd_soc_dapm_widget simple_widgets[] = {
44449a6d4860SXiubo Li 	SND_SOC_DAPM_MIC("Microphone", NULL),
44459a6d4860SXiubo Li 	SND_SOC_DAPM_LINE("Line", NULL),
44469a6d4860SXiubo Li 	SND_SOC_DAPM_HP("Headphone", NULL),
44479a6d4860SXiubo Li 	SND_SOC_DAPM_SPK("Speaker", NULL),
44489a6d4860SXiubo Li };
44499a6d4860SXiubo Li 
44509a6d4860SXiubo Li int snd_soc_of_parse_audio_simple_widgets(struct snd_soc_card *card,
44519a6d4860SXiubo Li 					  const char *propname)
44529a6d4860SXiubo Li {
44539a6d4860SXiubo Li 	struct device_node *np = card->dev->of_node;
44549a6d4860SXiubo Li 	struct snd_soc_dapm_widget *widgets;
44559a6d4860SXiubo Li 	const char *template, *wname;
44569a6d4860SXiubo Li 	int i, j, num_widgets, ret;
44579a6d4860SXiubo Li 
44589a6d4860SXiubo Li 	num_widgets = of_property_count_strings(np, propname);
44599a6d4860SXiubo Li 	if (num_widgets < 0) {
44609a6d4860SXiubo Li 		dev_err(card->dev,
44619a6d4860SXiubo Li 			"ASoC: Property '%s' does not exist\n",	propname);
44629a6d4860SXiubo Li 		return -EINVAL;
44639a6d4860SXiubo Li 	}
44649a6d4860SXiubo Li 	if (num_widgets & 1) {
44659a6d4860SXiubo Li 		dev_err(card->dev,
44669a6d4860SXiubo Li 			"ASoC: Property '%s' length is not even\n", propname);
44679a6d4860SXiubo Li 		return -EINVAL;
44689a6d4860SXiubo Li 	}
44699a6d4860SXiubo Li 
44709a6d4860SXiubo Li 	num_widgets /= 2;
44719a6d4860SXiubo Li 	if (!num_widgets) {
44729a6d4860SXiubo Li 		dev_err(card->dev, "ASoC: Property '%s's length is zero\n",
44739a6d4860SXiubo Li 			propname);
44749a6d4860SXiubo Li 		return -EINVAL;
44759a6d4860SXiubo Li 	}
44769a6d4860SXiubo Li 
44779a6d4860SXiubo Li 	widgets = devm_kcalloc(card->dev, num_widgets, sizeof(*widgets),
44789a6d4860SXiubo Li 			       GFP_KERNEL);
44799a6d4860SXiubo Li 	if (!widgets) {
44809a6d4860SXiubo Li 		dev_err(card->dev,
44819a6d4860SXiubo Li 			"ASoC: Could not allocate memory for widgets\n");
44829a6d4860SXiubo Li 		return -ENOMEM;
44839a6d4860SXiubo Li 	}
44849a6d4860SXiubo Li 
44859a6d4860SXiubo Li 	for (i = 0; i < num_widgets; i++) {
44869a6d4860SXiubo Li 		ret = of_property_read_string_index(np, propname,
44879a6d4860SXiubo Li 			2 * i, &template);
44889a6d4860SXiubo Li 		if (ret) {
44899a6d4860SXiubo Li 			dev_err(card->dev,
44909a6d4860SXiubo Li 				"ASoC: Property '%s' index %d read error:%d\n",
44919a6d4860SXiubo Li 				propname, 2 * i, ret);
44929a6d4860SXiubo Li 			return -EINVAL;
44939a6d4860SXiubo Li 		}
44949a6d4860SXiubo Li 
44959a6d4860SXiubo Li 		for (j = 0; j < ARRAY_SIZE(simple_widgets); j++) {
44969a6d4860SXiubo Li 			if (!strncmp(template, simple_widgets[j].name,
44979a6d4860SXiubo Li 				     strlen(simple_widgets[j].name))) {
44989a6d4860SXiubo Li 				widgets[i] = simple_widgets[j];
44999a6d4860SXiubo Li 				break;
45009a6d4860SXiubo Li 			}
45019a6d4860SXiubo Li 		}
45029a6d4860SXiubo Li 
45039a6d4860SXiubo Li 		if (j >= ARRAY_SIZE(simple_widgets)) {
45049a6d4860SXiubo Li 			dev_err(card->dev,
45059a6d4860SXiubo Li 				"ASoC: DAPM widget '%s' is not supported\n",
45069a6d4860SXiubo Li 				template);
45079a6d4860SXiubo Li 			return -EINVAL;
45089a6d4860SXiubo Li 		}
45099a6d4860SXiubo Li 
45109a6d4860SXiubo Li 		ret = of_property_read_string_index(np, propname,
45119a6d4860SXiubo Li 						    (2 * i) + 1,
45129a6d4860SXiubo Li 						    &wname);
45139a6d4860SXiubo Li 		if (ret) {
45149a6d4860SXiubo Li 			dev_err(card->dev,
45159a6d4860SXiubo Li 				"ASoC: Property '%s' index %d read error:%d\n",
45169a6d4860SXiubo Li 				propname, (2 * i) + 1, ret);
45179a6d4860SXiubo Li 			return -EINVAL;
45189a6d4860SXiubo Li 		}
45199a6d4860SXiubo Li 
45209a6d4860SXiubo Li 		widgets[i].name = wname;
45219a6d4860SXiubo Li 	}
45229a6d4860SXiubo Li 
45239a6d4860SXiubo Li 	card->dapm_widgets = widgets;
45249a6d4860SXiubo Li 	card->num_dapm_widgets = num_widgets;
45259a6d4860SXiubo Li 
45269a6d4860SXiubo Li 	return 0;
45279a6d4860SXiubo Li }
45289a6d4860SXiubo Li EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_simple_widgets);
45299a6d4860SXiubo Li 
453089c67857SXiubo Li int snd_soc_of_parse_tdm_slot(struct device_node *np,
453189c67857SXiubo Li 			      unsigned int *slots,
453289c67857SXiubo Li 			      unsigned int *slot_width)
453389c67857SXiubo Li {
453489c67857SXiubo Li 	u32 val;
453589c67857SXiubo Li 	int ret;
453689c67857SXiubo Li 
453789c67857SXiubo Li 	if (of_property_read_bool(np, "dai-tdm-slot-num")) {
453889c67857SXiubo Li 		ret = of_property_read_u32(np, "dai-tdm-slot-num", &val);
453989c67857SXiubo Li 		if (ret)
454089c67857SXiubo Li 			return ret;
454189c67857SXiubo Li 
454289c67857SXiubo Li 		if (slots)
454389c67857SXiubo Li 			*slots = val;
454489c67857SXiubo Li 	}
454589c67857SXiubo Li 
454689c67857SXiubo Li 	if (of_property_read_bool(np, "dai-tdm-slot-width")) {
454789c67857SXiubo Li 		ret = of_property_read_u32(np, "dai-tdm-slot-width", &val);
454889c67857SXiubo Li 		if (ret)
454989c67857SXiubo Li 			return ret;
455089c67857SXiubo Li 
455189c67857SXiubo Li 		if (slot_width)
455289c67857SXiubo Li 			*slot_width = val;
455389c67857SXiubo Li 	}
455489c67857SXiubo Li 
455589c67857SXiubo Li 	return 0;
455689c67857SXiubo Li }
455789c67857SXiubo Li EXPORT_SYMBOL_GPL(snd_soc_of_parse_tdm_slot);
455889c67857SXiubo Li 
4559a4a54dd5SStephen Warren int snd_soc_of_parse_audio_routing(struct snd_soc_card *card,
4560a4a54dd5SStephen Warren 				   const char *propname)
4561a4a54dd5SStephen Warren {
4562a4a54dd5SStephen Warren 	struct device_node *np = card->dev->of_node;
4563a4a54dd5SStephen Warren 	int num_routes;
4564a4a54dd5SStephen Warren 	struct snd_soc_dapm_route *routes;
4565a4a54dd5SStephen Warren 	int i, ret;
4566a4a54dd5SStephen Warren 
4567a4a54dd5SStephen Warren 	num_routes = of_property_count_strings(np, propname);
4568c34ce320SRichard Zhao 	if (num_routes < 0 || num_routes & 1) {
456910e8aa9aSMichał Mirosław 		dev_err(card->dev,
457010e8aa9aSMichał Mirosław 			"ASoC: Property '%s' does not exist or its length is not even\n",
457110e8aa9aSMichał Mirosław 			propname);
4572a4a54dd5SStephen Warren 		return -EINVAL;
4573a4a54dd5SStephen Warren 	}
4574a4a54dd5SStephen Warren 	num_routes /= 2;
4575a4a54dd5SStephen Warren 	if (!num_routes) {
4576f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: Property '%s's length is zero\n",
4577a4a54dd5SStephen Warren 			propname);
4578a4a54dd5SStephen Warren 		return -EINVAL;
4579a4a54dd5SStephen Warren 	}
4580a4a54dd5SStephen Warren 
4581a4a54dd5SStephen Warren 	routes = devm_kzalloc(card->dev, num_routes * sizeof(*routes),
4582a4a54dd5SStephen Warren 			      GFP_KERNEL);
4583a4a54dd5SStephen Warren 	if (!routes) {
4584a4a54dd5SStephen Warren 		dev_err(card->dev,
4585f110bfc7SLiam Girdwood 			"ASoC: Could not allocate DAPM route table\n");
4586a4a54dd5SStephen Warren 		return -EINVAL;
4587a4a54dd5SStephen Warren 	}
4588a4a54dd5SStephen Warren 
4589a4a54dd5SStephen Warren 	for (i = 0; i < num_routes; i++) {
4590a4a54dd5SStephen Warren 		ret = of_property_read_string_index(np, propname,
4591a4a54dd5SStephen Warren 			2 * i, &routes[i].sink);
4592a4a54dd5SStephen Warren 		if (ret) {
4593c871bd0bSMark Brown 			dev_err(card->dev,
4594c871bd0bSMark Brown 				"ASoC: Property '%s' index %d could not be read: %d\n",
4595c871bd0bSMark Brown 				propname, 2 * i, ret);
4596a4a54dd5SStephen Warren 			return -EINVAL;
4597a4a54dd5SStephen Warren 		}
4598a4a54dd5SStephen Warren 		ret = of_property_read_string_index(np, propname,
4599a4a54dd5SStephen Warren 			(2 * i) + 1, &routes[i].source);
4600a4a54dd5SStephen Warren 		if (ret) {
4601a4a54dd5SStephen Warren 			dev_err(card->dev,
4602c871bd0bSMark Brown 				"ASoC: Property '%s' index %d could not be read: %d\n",
4603c871bd0bSMark Brown 				propname, (2 * i) + 1, ret);
4604a4a54dd5SStephen Warren 			return -EINVAL;
4605a4a54dd5SStephen Warren 		}
4606a4a54dd5SStephen Warren 	}
4607a4a54dd5SStephen Warren 
4608a4a54dd5SStephen Warren 	card->num_dapm_routes = num_routes;
4609a4a54dd5SStephen Warren 	card->dapm_routes = routes;
4610a4a54dd5SStephen Warren 
4611a4a54dd5SStephen Warren 	return 0;
4612a4a54dd5SStephen Warren }
4613a4a54dd5SStephen Warren EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_routing);
4614a4a54dd5SStephen Warren 
4615a7930ed4SKuninori Morimoto unsigned int snd_soc_of_parse_daifmt(struct device_node *np,
4616389cb834SJyri Sarha 				     const char *prefix,
4617389cb834SJyri Sarha 				     struct device_node **bitclkmaster,
4618389cb834SJyri Sarha 				     struct device_node **framemaster)
4619a7930ed4SKuninori Morimoto {
4620a7930ed4SKuninori Morimoto 	int ret, i;
4621a7930ed4SKuninori Morimoto 	char prop[128];
4622a7930ed4SKuninori Morimoto 	unsigned int format = 0;
4623a7930ed4SKuninori Morimoto 	int bit, frame;
4624a7930ed4SKuninori Morimoto 	const char *str;
4625a7930ed4SKuninori Morimoto 	struct {
4626a7930ed4SKuninori Morimoto 		char *name;
4627a7930ed4SKuninori Morimoto 		unsigned int val;
4628a7930ed4SKuninori Morimoto 	} of_fmt_table[] = {
4629a7930ed4SKuninori Morimoto 		{ "i2s",	SND_SOC_DAIFMT_I2S },
4630a7930ed4SKuninori Morimoto 		{ "right_j",	SND_SOC_DAIFMT_RIGHT_J },
4631a7930ed4SKuninori Morimoto 		{ "left_j",	SND_SOC_DAIFMT_LEFT_J },
4632a7930ed4SKuninori Morimoto 		{ "dsp_a",	SND_SOC_DAIFMT_DSP_A },
4633a7930ed4SKuninori Morimoto 		{ "dsp_b",	SND_SOC_DAIFMT_DSP_B },
4634a7930ed4SKuninori Morimoto 		{ "ac97",	SND_SOC_DAIFMT_AC97 },
4635a7930ed4SKuninori Morimoto 		{ "pdm",	SND_SOC_DAIFMT_PDM},
4636a7930ed4SKuninori Morimoto 		{ "msb",	SND_SOC_DAIFMT_MSB },
4637a7930ed4SKuninori Morimoto 		{ "lsb",	SND_SOC_DAIFMT_LSB },
4638a7930ed4SKuninori Morimoto 	};
4639a7930ed4SKuninori Morimoto 
4640a7930ed4SKuninori Morimoto 	if (!prefix)
4641a7930ed4SKuninori Morimoto 		prefix = "";
4642a7930ed4SKuninori Morimoto 
4643a7930ed4SKuninori Morimoto 	/*
4644a7930ed4SKuninori Morimoto 	 * check "[prefix]format = xxx"
4645a7930ed4SKuninori Morimoto 	 * SND_SOC_DAIFMT_FORMAT_MASK area
4646a7930ed4SKuninori Morimoto 	 */
4647a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sformat", prefix);
4648a7930ed4SKuninori Morimoto 	ret = of_property_read_string(np, prop, &str);
4649a7930ed4SKuninori Morimoto 	if (ret == 0) {
4650a7930ed4SKuninori Morimoto 		for (i = 0; i < ARRAY_SIZE(of_fmt_table); i++) {
4651a7930ed4SKuninori Morimoto 			if (strcmp(str, of_fmt_table[i].name) == 0) {
4652a7930ed4SKuninori Morimoto 				format |= of_fmt_table[i].val;
4653a7930ed4SKuninori Morimoto 				break;
4654a7930ed4SKuninori Morimoto 			}
4655a7930ed4SKuninori Morimoto 		}
4656a7930ed4SKuninori Morimoto 	}
4657a7930ed4SKuninori Morimoto 
4658a7930ed4SKuninori Morimoto 	/*
46598c2d6a9fSKuninori Morimoto 	 * check "[prefix]continuous-clock"
4660a7930ed4SKuninori Morimoto 	 * SND_SOC_DAIFMT_CLOCK_MASK area
4661a7930ed4SKuninori Morimoto 	 */
46628c2d6a9fSKuninori Morimoto 	snprintf(prop, sizeof(prop), "%scontinuous-clock", prefix);
46638c2d6a9fSKuninori Morimoto 	if (of_get_property(np, prop, NULL))
46648c2d6a9fSKuninori Morimoto 		format |= SND_SOC_DAIFMT_CONT;
46658c2d6a9fSKuninori Morimoto 	else
46668c2d6a9fSKuninori Morimoto 		format |= SND_SOC_DAIFMT_GATED;
4667a7930ed4SKuninori Morimoto 
4668a7930ed4SKuninori Morimoto 	/*
4669a7930ed4SKuninori Morimoto 	 * check "[prefix]bitclock-inversion"
4670a7930ed4SKuninori Morimoto 	 * check "[prefix]frame-inversion"
4671a7930ed4SKuninori Morimoto 	 * SND_SOC_DAIFMT_INV_MASK area
4672a7930ed4SKuninori Morimoto 	 */
4673a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sbitclock-inversion", prefix);
4674a7930ed4SKuninori Morimoto 	bit = !!of_get_property(np, prop, NULL);
4675a7930ed4SKuninori Morimoto 
4676a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sframe-inversion", prefix);
4677a7930ed4SKuninori Morimoto 	frame = !!of_get_property(np, prop, NULL);
4678a7930ed4SKuninori Morimoto 
4679a7930ed4SKuninori Morimoto 	switch ((bit << 4) + frame) {
4680a7930ed4SKuninori Morimoto 	case 0x11:
4681a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_IB_IF;
4682a7930ed4SKuninori Morimoto 		break;
4683a7930ed4SKuninori Morimoto 	case 0x10:
4684a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_IB_NF;
4685a7930ed4SKuninori Morimoto 		break;
4686a7930ed4SKuninori Morimoto 	case 0x01:
4687a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_NB_IF;
4688a7930ed4SKuninori Morimoto 		break;
4689a7930ed4SKuninori Morimoto 	default:
4690a7930ed4SKuninori Morimoto 		/* SND_SOC_DAIFMT_NB_NF is default */
4691a7930ed4SKuninori Morimoto 		break;
4692a7930ed4SKuninori Morimoto 	}
4693a7930ed4SKuninori Morimoto 
4694a7930ed4SKuninori Morimoto 	/*
4695a7930ed4SKuninori Morimoto 	 * check "[prefix]bitclock-master"
4696a7930ed4SKuninori Morimoto 	 * check "[prefix]frame-master"
4697a7930ed4SKuninori Morimoto 	 * SND_SOC_DAIFMT_MASTER_MASK area
4698a7930ed4SKuninori Morimoto 	 */
4699a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sbitclock-master", prefix);
4700a7930ed4SKuninori Morimoto 	bit = !!of_get_property(np, prop, NULL);
4701389cb834SJyri Sarha 	if (bit && bitclkmaster)
4702389cb834SJyri Sarha 		*bitclkmaster = of_parse_phandle(np, prop, 0);
4703a7930ed4SKuninori Morimoto 
4704a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sframe-master", prefix);
4705a7930ed4SKuninori Morimoto 	frame = !!of_get_property(np, prop, NULL);
4706389cb834SJyri Sarha 	if (frame && framemaster)
4707389cb834SJyri Sarha 		*framemaster = of_parse_phandle(np, prop, 0);
4708a7930ed4SKuninori Morimoto 
4709a7930ed4SKuninori Morimoto 	switch ((bit << 4) + frame) {
4710a7930ed4SKuninori Morimoto 	case 0x11:
4711a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_CBM_CFM;
4712a7930ed4SKuninori Morimoto 		break;
4713a7930ed4SKuninori Morimoto 	case 0x10:
4714a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_CBM_CFS;
4715a7930ed4SKuninori Morimoto 		break;
4716a7930ed4SKuninori Morimoto 	case 0x01:
4717a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_CBS_CFM;
4718a7930ed4SKuninori Morimoto 		break;
4719a7930ed4SKuninori Morimoto 	default:
4720a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_CBS_CFS;
4721a7930ed4SKuninori Morimoto 		break;
4722a7930ed4SKuninori Morimoto 	}
4723a7930ed4SKuninori Morimoto 
4724a7930ed4SKuninori Morimoto 	return format;
4725a7930ed4SKuninori Morimoto }
4726a7930ed4SKuninori Morimoto EXPORT_SYMBOL_GPL(snd_soc_of_parse_daifmt);
4727a7930ed4SKuninori Morimoto 
4728cb470087SKuninori Morimoto int snd_soc_of_get_dai_name(struct device_node *of_node,
4729cb470087SKuninori Morimoto 			    const char **dai_name)
4730cb470087SKuninori Morimoto {
4731cb470087SKuninori Morimoto 	struct snd_soc_component *pos;
4732cb470087SKuninori Morimoto 	struct of_phandle_args args;
4733cb470087SKuninori Morimoto 	int ret;
4734cb470087SKuninori Morimoto 
4735cb470087SKuninori Morimoto 	ret = of_parse_phandle_with_args(of_node, "sound-dai",
4736cb470087SKuninori Morimoto 					 "#sound-dai-cells", 0, &args);
4737cb470087SKuninori Morimoto 	if (ret)
4738cb470087SKuninori Morimoto 		return ret;
4739cb470087SKuninori Morimoto 
4740cb470087SKuninori Morimoto 	ret = -EPROBE_DEFER;
4741cb470087SKuninori Morimoto 
4742cb470087SKuninori Morimoto 	mutex_lock(&client_mutex);
4743cb470087SKuninori Morimoto 	list_for_each_entry(pos, &component_list, list) {
4744cb470087SKuninori Morimoto 		if (pos->dev->of_node != args.np)
4745cb470087SKuninori Morimoto 			continue;
4746cb470087SKuninori Morimoto 
47476833c452SKuninori Morimoto 		if (pos->driver->of_xlate_dai_name) {
47486833c452SKuninori Morimoto 			ret = pos->driver->of_xlate_dai_name(pos, &args, dai_name);
47496833c452SKuninori Morimoto 		} else {
47506833c452SKuninori Morimoto 			int id = -1;
47516833c452SKuninori Morimoto 
47526833c452SKuninori Morimoto 			switch (args.args_count) {
47536833c452SKuninori Morimoto 			case 0:
47546833c452SKuninori Morimoto 				id = 0; /* same as dai_drv[0] */
47556833c452SKuninori Morimoto 				break;
47566833c452SKuninori Morimoto 			case 1:
47576833c452SKuninori Morimoto 				id = args.args[0];
47586833c452SKuninori Morimoto 				break;
47596833c452SKuninori Morimoto 			default:
47606833c452SKuninori Morimoto 				/* not supported */
4761cb470087SKuninori Morimoto 				break;
4762cb470087SKuninori Morimoto 			}
4763cb470087SKuninori Morimoto 
47646833c452SKuninori Morimoto 			if (id < 0 || id >= pos->num_dai) {
47656833c452SKuninori Morimoto 				ret = -EINVAL;
47663dcba280SNicolin Chen 				continue;
47676833c452SKuninori Morimoto 			}
4768e41975edSXiubo Li 
4769e41975edSXiubo Li 			ret = 0;
4770e41975edSXiubo Li 
4771e41975edSXiubo Li 			*dai_name = pos->dai_drv[id].name;
4772e41975edSXiubo Li 			if (!*dai_name)
4773e41975edSXiubo Li 				*dai_name = pos->name;
47746833c452SKuninori Morimoto 		}
47756833c452SKuninori Morimoto 
4776cb470087SKuninori Morimoto 		break;
4777cb470087SKuninori Morimoto 	}
4778cb470087SKuninori Morimoto 	mutex_unlock(&client_mutex);
4779cb470087SKuninori Morimoto 
4780cb470087SKuninori Morimoto 	of_node_put(args.np);
4781cb470087SKuninori Morimoto 
4782cb470087SKuninori Morimoto 	return ret;
4783cb470087SKuninori Morimoto }
4784cb470087SKuninori Morimoto EXPORT_SYMBOL_GPL(snd_soc_of_get_dai_name);
4785cb470087SKuninori Morimoto 
4786c9b3a40fSTakashi Iwai static int __init snd_soc_init(void)
4787db2a4165SFrank Mandarino {
4788db2a4165SFrank Mandarino #ifdef CONFIG_DEBUG_FS
47898a9dab1aSMark Brown 	snd_soc_debugfs_root = debugfs_create_dir("asoc", NULL);
47908a9dab1aSMark Brown 	if (IS_ERR(snd_soc_debugfs_root) || !snd_soc_debugfs_root) {
47910837fc62SFabio Estevam 		pr_warn("ASoC: Failed to create debugfs directory\n");
47928a9dab1aSMark Brown 		snd_soc_debugfs_root = NULL;
4793db2a4165SFrank Mandarino 	}
4794c3c5a19aSMark Brown 
47958a9dab1aSMark Brown 	if (!debugfs_create_file("codecs", 0444, snd_soc_debugfs_root, NULL,
4796c3c5a19aSMark Brown 				 &codec_list_fops))
4797c3c5a19aSMark Brown 		pr_warn("ASoC: Failed to create CODEC list debugfs file\n");
4798c3c5a19aSMark Brown 
47998a9dab1aSMark Brown 	if (!debugfs_create_file("dais", 0444, snd_soc_debugfs_root, NULL,
4800f3208780SMark Brown 				 &dai_list_fops))
4801f3208780SMark Brown 		pr_warn("ASoC: Failed to create DAI list debugfs file\n");
480219c7ac27SMark Brown 
48038a9dab1aSMark Brown 	if (!debugfs_create_file("platforms", 0444, snd_soc_debugfs_root, NULL,
480419c7ac27SMark Brown 				 &platform_list_fops))
480519c7ac27SMark Brown 		pr_warn("ASoC: Failed to create platform list debugfs file\n");
4806db2a4165SFrank Mandarino #endif
4807db2a4165SFrank Mandarino 
4808fb257897SMark Brown 	snd_soc_util_init();
4809fb257897SMark Brown 
4810db2a4165SFrank Mandarino 	return platform_driver_register(&soc_driver);
4811db2a4165SFrank Mandarino }
48124abe8e16SMark Brown module_init(snd_soc_init);
4813db2a4165SFrank Mandarino 
4814db2a4165SFrank Mandarino static void __exit snd_soc_exit(void)
4815db2a4165SFrank Mandarino {
4816fb257897SMark Brown 	snd_soc_util_exit();
4817fb257897SMark Brown 
4818db2a4165SFrank Mandarino #ifdef CONFIG_DEBUG_FS
48198a9dab1aSMark Brown 	debugfs_remove_recursive(snd_soc_debugfs_root);
4820db2a4165SFrank Mandarino #endif
4821db2a4165SFrank Mandarino 	platform_driver_unregister(&soc_driver);
4822db2a4165SFrank Mandarino }
4823db2a4165SFrank Mandarino module_exit(snd_soc_exit);
4824db2a4165SFrank Mandarino 
4825db2a4165SFrank Mandarino /* Module information */
4826db2a4165SFrank Mandarino MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
4827db2a4165SFrank Mandarino MODULE_DESCRIPTION("ALSA SoC Core");
4828db2a4165SFrank Mandarino MODULE_LICENSE("GPL");
4829db2a4165SFrank Mandarino MODULE_ALIAS("platform:soc-audio");
4830