xref: /openbmc/linux/sound/soc/soc-core.c (revision a32c17b87c17f5e2e68edcf4d163ee42f9490652)
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);
599115171aSMark Brown static LIST_HEAD(dai_list);
6012a48a8cSMark Brown static LIST_HEAD(platform_list);
610d0cf00aSMark Brown static LIST_HEAD(codec_list);
62030e79f6SKuninori Morimoto static LIST_HEAD(component_list);
63c5af3a2eSMark Brown 
64db2a4165SFrank Mandarino /*
65db2a4165SFrank Mandarino  * This is a timeout to do a DAPM powerdown after a stream is closed().
66db2a4165SFrank Mandarino  * It can be used to eliminate pops between different playback streams, e.g.
67db2a4165SFrank Mandarino  * between two audio tracks.
68db2a4165SFrank Mandarino  */
69db2a4165SFrank Mandarino static int pmdown_time = 5000;
70db2a4165SFrank Mandarino module_param(pmdown_time, int, 0);
71db2a4165SFrank Mandarino MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
72db2a4165SFrank Mandarino 
73741a509fSMarkus Pargmann struct snd_ac97_reset_cfg {
74741a509fSMarkus Pargmann 	struct pinctrl *pctl;
75741a509fSMarkus Pargmann 	struct pinctrl_state *pstate_reset;
76741a509fSMarkus Pargmann 	struct pinctrl_state *pstate_warm_reset;
77741a509fSMarkus Pargmann 	struct pinctrl_state *pstate_run;
78741a509fSMarkus Pargmann 	int gpio_sdata;
79741a509fSMarkus Pargmann 	int gpio_sync;
80741a509fSMarkus Pargmann 	int gpio_reset;
81741a509fSMarkus Pargmann };
82741a509fSMarkus Pargmann 
832bc9a81eSDimitris Papastamos /* returns the minimum number of bytes needed to represent
842bc9a81eSDimitris Papastamos  * a particular given value */
852bc9a81eSDimitris Papastamos static int min_bytes_needed(unsigned long val)
862bc9a81eSDimitris Papastamos {
872bc9a81eSDimitris Papastamos 	int c = 0;
882bc9a81eSDimitris Papastamos 	int i;
892bc9a81eSDimitris Papastamos 
902bc9a81eSDimitris Papastamos 	for (i = (sizeof val * 8) - 1; i >= 0; --i, ++c)
912bc9a81eSDimitris Papastamos 		if (val & (1UL << i))
922bc9a81eSDimitris Papastamos 			break;
932bc9a81eSDimitris Papastamos 	c = (sizeof val * 8) - c;
942bc9a81eSDimitris Papastamos 	if (!c || (c % 8))
952bc9a81eSDimitris Papastamos 		c = (c + 8) / 8;
962bc9a81eSDimitris Papastamos 	else
972bc9a81eSDimitris Papastamos 		c /= 8;
982bc9a81eSDimitris Papastamos 	return c;
992bc9a81eSDimitris Papastamos }
1002bc9a81eSDimitris Papastamos 
10113fd179fSDimitris Papastamos /* fill buf which is 'len' bytes with a formatted
10213fd179fSDimitris Papastamos  * string of the form 'reg: value\n' */
10313fd179fSDimitris Papastamos static int format_register_str(struct snd_soc_codec *codec,
10413fd179fSDimitris Papastamos 			       unsigned int reg, char *buf, size_t len)
1052624d5faSMark Brown {
10600b317a4SStephen Warren 	int wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
10700b317a4SStephen Warren 	int regsize = codec->driver->reg_word_size * 2;
10813fd179fSDimitris Papastamos 	int ret;
10913fd179fSDimitris Papastamos 	char tmpbuf[len + 1];
11013fd179fSDimitris Papastamos 	char regbuf[regsize + 1];
11113fd179fSDimitris Papastamos 
11213fd179fSDimitris Papastamos 	/* since tmpbuf is allocated on the stack, warn the callers if they
11313fd179fSDimitris Papastamos 	 * try to abuse this function */
11413fd179fSDimitris Papastamos 	WARN_ON(len > 63);
11513fd179fSDimitris Papastamos 
11613fd179fSDimitris Papastamos 	/* +2 for ': ' and + 1 for '\n' */
11713fd179fSDimitris Papastamos 	if (wordsize + regsize + 2 + 1 != len)
11813fd179fSDimitris Papastamos 		return -EINVAL;
11913fd179fSDimitris Papastamos 
12013fd179fSDimitris Papastamos 	ret = snd_soc_read(codec, reg);
12113fd179fSDimitris Papastamos 	if (ret < 0) {
12213fd179fSDimitris Papastamos 		memset(regbuf, 'X', regsize);
12313fd179fSDimitris Papastamos 		regbuf[regsize] = '\0';
12413fd179fSDimitris Papastamos 	} else {
12513fd179fSDimitris Papastamos 		snprintf(regbuf, regsize + 1, "%.*x", regsize, ret);
12613fd179fSDimitris Papastamos 	}
12713fd179fSDimitris Papastamos 
12813fd179fSDimitris Papastamos 	/* prepare the buffer */
12913fd179fSDimitris Papastamos 	snprintf(tmpbuf, len + 1, "%.*x: %s\n", wordsize, reg, regbuf);
13013fd179fSDimitris Papastamos 	/* copy it back to the caller without the '\0' */
13113fd179fSDimitris Papastamos 	memcpy(buf, tmpbuf, len);
13213fd179fSDimitris Papastamos 
13313fd179fSDimitris Papastamos 	return 0;
13413fd179fSDimitris Papastamos }
13513fd179fSDimitris Papastamos 
13613fd179fSDimitris Papastamos /* codec register dump */
13713fd179fSDimitris Papastamos static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf,
13813fd179fSDimitris Papastamos 				  size_t count, loff_t pos)
13913fd179fSDimitris Papastamos {
14013fd179fSDimitris Papastamos 	int i, step = 1;
1412bc9a81eSDimitris Papastamos 	int wordsize, regsize;
14213fd179fSDimitris Papastamos 	int len;
14313fd179fSDimitris Papastamos 	size_t total = 0;
14413fd179fSDimitris Papastamos 	loff_t p = 0;
1452bc9a81eSDimitris Papastamos 
14600b317a4SStephen Warren 	wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
14700b317a4SStephen Warren 	regsize = codec->driver->reg_word_size * 2;
1482624d5faSMark Brown 
14913fd179fSDimitris Papastamos 	len = wordsize + regsize + 2 + 1;
15013fd179fSDimitris Papastamos 
151f0fba2adSLiam Girdwood 	if (!codec->driver->reg_cache_size)
1522624d5faSMark Brown 		return 0;
1532624d5faSMark Brown 
154f0fba2adSLiam Girdwood 	if (codec->driver->reg_cache_step)
155f0fba2adSLiam Girdwood 		step = codec->driver->reg_cache_step;
1562624d5faSMark Brown 
157f0fba2adSLiam Girdwood 	for (i = 0; i < codec->driver->reg_cache_size; i += step) {
158b92d150bSLars-Peter Clausen 		if (!snd_soc_codec_readable_register(codec, i))
1592624d5faSMark Brown 			continue;
160f0fba2adSLiam Girdwood 		if (codec->driver->display_register) {
161f0fba2adSLiam Girdwood 			count += codec->driver->display_register(codec, buf + count,
1622624d5faSMark Brown 							 PAGE_SIZE - count, i);
1635164d74dSMark Brown 		} else {
16413fd179fSDimitris Papastamos 			/* only support larger than PAGE_SIZE bytes debugfs
16513fd179fSDimitris Papastamos 			 * entries for the default case */
16613fd179fSDimitris Papastamos 			if (p >= pos) {
16713fd179fSDimitris Papastamos 				if (total + len >= count - 1)
1682624d5faSMark Brown 					break;
16913fd179fSDimitris Papastamos 				format_register_str(codec, i, buf + total, len);
17013fd179fSDimitris Papastamos 				total += len;
17113fd179fSDimitris Papastamos 			}
17213fd179fSDimitris Papastamos 			p += len;
17313fd179fSDimitris Papastamos 		}
1742624d5faSMark Brown 	}
1752624d5faSMark Brown 
17613fd179fSDimitris Papastamos 	total = min(total, count - 1);
1772624d5faSMark Brown 
17813fd179fSDimitris Papastamos 	return total;
1792624d5faSMark Brown }
18013fd179fSDimitris Papastamos 
1812624d5faSMark Brown static ssize_t codec_reg_show(struct device *dev,
1822624d5faSMark Brown 	struct device_attribute *attr, char *buf)
1832624d5faSMark Brown {
18436ae1a96SMark Brown 	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
185f0fba2adSLiam Girdwood 
18613fd179fSDimitris Papastamos 	return soc_codec_reg_show(rtd->codec, buf, PAGE_SIZE, 0);
1872624d5faSMark Brown }
1882624d5faSMark Brown 
1892624d5faSMark Brown static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
1902624d5faSMark Brown 
191dbe21408SMark Brown static ssize_t pmdown_time_show(struct device *dev,
192dbe21408SMark Brown 				struct device_attribute *attr, char *buf)
193dbe21408SMark Brown {
19436ae1a96SMark Brown 	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
195dbe21408SMark Brown 
196f0fba2adSLiam Girdwood 	return sprintf(buf, "%ld\n", rtd->pmdown_time);
197dbe21408SMark Brown }
198dbe21408SMark Brown 
199dbe21408SMark Brown static ssize_t pmdown_time_set(struct device *dev,
200dbe21408SMark Brown 			       struct device_attribute *attr,
201dbe21408SMark Brown 			       const char *buf, size_t count)
202dbe21408SMark Brown {
20336ae1a96SMark Brown 	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
204c593b520SMark Brown 	int ret;
205dbe21408SMark Brown 
206b785a492SJingoo Han 	ret = kstrtol(buf, 10, &rtd->pmdown_time);
207c593b520SMark Brown 	if (ret)
208c593b520SMark Brown 		return ret;
209dbe21408SMark Brown 
210dbe21408SMark Brown 	return count;
211dbe21408SMark Brown }
212dbe21408SMark Brown 
213dbe21408SMark Brown static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set);
214dbe21408SMark Brown 
2152624d5faSMark Brown #ifdef CONFIG_DEBUG_FS
2162624d5faSMark Brown static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
2172624d5faSMark Brown 				   size_t count, loff_t *ppos)
2182624d5faSMark Brown {
2192624d5faSMark Brown 	ssize_t ret;
2202624d5faSMark Brown 	struct snd_soc_codec *codec = file->private_data;
22113fd179fSDimitris Papastamos 	char *buf;
22213fd179fSDimitris Papastamos 
22313fd179fSDimitris Papastamos 	if (*ppos < 0 || !count)
22413fd179fSDimitris Papastamos 		return -EINVAL;
22513fd179fSDimitris Papastamos 
22613fd179fSDimitris Papastamos 	buf = kmalloc(count, GFP_KERNEL);
2272624d5faSMark Brown 	if (!buf)
2282624d5faSMark Brown 		return -ENOMEM;
22913fd179fSDimitris Papastamos 
23013fd179fSDimitris Papastamos 	ret = soc_codec_reg_show(codec, buf, count, *ppos);
23113fd179fSDimitris Papastamos 	if (ret >= 0) {
23213fd179fSDimitris Papastamos 		if (copy_to_user(user_buf, buf, ret)) {
23313fd179fSDimitris Papastamos 			kfree(buf);
23413fd179fSDimitris Papastamos 			return -EFAULT;
23513fd179fSDimitris Papastamos 		}
23613fd179fSDimitris Papastamos 		*ppos += ret;
23713fd179fSDimitris Papastamos 	}
23813fd179fSDimitris Papastamos 
2392624d5faSMark Brown 	kfree(buf);
2402624d5faSMark Brown 	return ret;
2412624d5faSMark Brown }
2422624d5faSMark Brown 
2432624d5faSMark Brown static ssize_t codec_reg_write_file(struct file *file,
2442624d5faSMark Brown 		const char __user *user_buf, size_t count, loff_t *ppos)
2452624d5faSMark Brown {
2462624d5faSMark Brown 	char buf[32];
24734e268d8SStephen Boyd 	size_t buf_size;
2482624d5faSMark Brown 	char *start = buf;
2492624d5faSMark Brown 	unsigned long reg, value;
2502624d5faSMark Brown 	struct snd_soc_codec *codec = file->private_data;
251b785a492SJingoo Han 	int ret;
2522624d5faSMark Brown 
2532624d5faSMark Brown 	buf_size = min(count, (sizeof(buf)-1));
2542624d5faSMark Brown 	if (copy_from_user(buf, user_buf, buf_size))
2552624d5faSMark Brown 		return -EFAULT;
2562624d5faSMark Brown 	buf[buf_size] = 0;
2572624d5faSMark Brown 
2582624d5faSMark Brown 	while (*start == ' ')
2592624d5faSMark Brown 		start++;
2602624d5faSMark Brown 	reg = simple_strtoul(start, &start, 16);
2612624d5faSMark Brown 	while (*start == ' ')
2622624d5faSMark Brown 		start++;
263b785a492SJingoo Han 	ret = kstrtoul(start, 16, &value);
264b785a492SJingoo Han 	if (ret)
265b785a492SJingoo Han 		return ret;
2660d51a9cbSMark Brown 
2670d51a9cbSMark Brown 	/* Userspace has been fiddling around behind the kernel's back */
268373d4d09SRusty Russell 	add_taint(TAINT_USER, LOCKDEP_NOW_UNRELIABLE);
2690d51a9cbSMark Brown 
270e4f078d8SDimitris Papastamos 	snd_soc_write(codec, reg, value);
2712624d5faSMark Brown 	return buf_size;
2722624d5faSMark Brown }
2732624d5faSMark Brown 
2742624d5faSMark Brown static const struct file_operations codec_reg_fops = {
275234e3405SStephen Boyd 	.open = simple_open,
2762624d5faSMark Brown 	.read = codec_reg_read_file,
2772624d5faSMark Brown 	.write = codec_reg_write_file,
2786038f373SArnd Bergmann 	.llseek = default_llseek,
2792624d5faSMark Brown };
2802624d5faSMark Brown 
2812624d5faSMark Brown static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
2822624d5faSMark Brown {
283d6ce4cf3SJarkko Nikula 	struct dentry *debugfs_card_root = codec->card->debugfs_card_root;
284d6ce4cf3SJarkko Nikula 
2856ba6c9c3SMark Brown 	codec->debugfs_codec_root = debugfs_create_dir(codec->name,
286d6ce4cf3SJarkko Nikula 						       debugfs_card_root);
2872624d5faSMark Brown 	if (!codec->debugfs_codec_root) {
28810e8aa9aSMichał Mirosław 		dev_warn(codec->dev,
28910e8aa9aSMichał Mirosław 			"ASoC: Failed to create codec debugfs directory\n");
2902624d5faSMark Brown 		return;
2912624d5faSMark Brown 	}
2922624d5faSMark Brown 
293aaee8ef1SMark Brown 	debugfs_create_bool("cache_sync", 0444, codec->debugfs_codec_root,
294aaee8ef1SMark Brown 			    &codec->cache_sync);
295aaee8ef1SMark Brown 	debugfs_create_bool("cache_only", 0444, codec->debugfs_codec_root,
296aaee8ef1SMark Brown 			    &codec->cache_only);
297aaee8ef1SMark Brown 
2982624d5faSMark Brown 	codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
2992624d5faSMark Brown 						 codec->debugfs_codec_root,
3002624d5faSMark Brown 						 codec, &codec_reg_fops);
3012624d5faSMark Brown 	if (!codec->debugfs_reg)
30210e8aa9aSMichał Mirosław 		dev_warn(codec->dev,
30310e8aa9aSMichał Mirosław 			"ASoC: Failed to create codec register debugfs file\n");
3042624d5faSMark Brown 
3058eecaf62SLars-Peter Clausen 	snd_soc_dapm_debugfs_init(&codec->dapm, codec->debugfs_codec_root);
3062624d5faSMark Brown }
3072624d5faSMark Brown 
3082624d5faSMark Brown static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
3092624d5faSMark Brown {
3102624d5faSMark Brown 	debugfs_remove_recursive(codec->debugfs_codec_root);
3112624d5faSMark Brown }
3122624d5faSMark Brown 
313731f1ab2SSebastien Guiriec static void soc_init_platform_debugfs(struct snd_soc_platform *platform)
314731f1ab2SSebastien Guiriec {
315731f1ab2SSebastien Guiriec 	struct dentry *debugfs_card_root = platform->card->debugfs_card_root;
316731f1ab2SSebastien Guiriec 
317731f1ab2SSebastien Guiriec 	platform->debugfs_platform_root = debugfs_create_dir(platform->name,
318731f1ab2SSebastien Guiriec 						       debugfs_card_root);
319731f1ab2SSebastien Guiriec 	if (!platform->debugfs_platform_root) {
320731f1ab2SSebastien Guiriec 		dev_warn(platform->dev,
321f110bfc7SLiam Girdwood 			"ASoC: Failed to create platform debugfs directory\n");
322731f1ab2SSebastien Guiriec 		return;
323731f1ab2SSebastien Guiriec 	}
324731f1ab2SSebastien Guiriec 
325731f1ab2SSebastien Guiriec 	snd_soc_dapm_debugfs_init(&platform->dapm,
326731f1ab2SSebastien Guiriec 		platform->debugfs_platform_root);
327731f1ab2SSebastien Guiriec }
328731f1ab2SSebastien Guiriec 
329731f1ab2SSebastien Guiriec static void soc_cleanup_platform_debugfs(struct snd_soc_platform *platform)
330731f1ab2SSebastien Guiriec {
331731f1ab2SSebastien Guiriec 	debugfs_remove_recursive(platform->debugfs_platform_root);
332731f1ab2SSebastien Guiriec }
333731f1ab2SSebastien Guiriec 
334c3c5a19aSMark Brown static ssize_t codec_list_read_file(struct file *file, char __user *user_buf,
335c3c5a19aSMark Brown 				    size_t count, loff_t *ppos)
336c3c5a19aSMark Brown {
337c3c5a19aSMark Brown 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
3382b194f9dSMark Brown 	ssize_t len, ret = 0;
339c3c5a19aSMark Brown 	struct snd_soc_codec *codec;
340c3c5a19aSMark Brown 
341c3c5a19aSMark Brown 	if (!buf)
342c3c5a19aSMark Brown 		return -ENOMEM;
343c3c5a19aSMark Brown 
3442b194f9dSMark Brown 	list_for_each_entry(codec, &codec_list, list) {
3452b194f9dSMark Brown 		len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
346c3c5a19aSMark Brown 			       codec->name);
3472b194f9dSMark Brown 		if (len >= 0)
3482b194f9dSMark Brown 			ret += len;
3492b194f9dSMark Brown 		if (ret > PAGE_SIZE) {
3502b194f9dSMark Brown 			ret = PAGE_SIZE;
3512b194f9dSMark Brown 			break;
3522b194f9dSMark Brown 		}
3532b194f9dSMark Brown 	}
354c3c5a19aSMark Brown 
355c3c5a19aSMark Brown 	if (ret >= 0)
356c3c5a19aSMark Brown 		ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
357c3c5a19aSMark Brown 
358c3c5a19aSMark Brown 	kfree(buf);
359c3c5a19aSMark Brown 
360c3c5a19aSMark Brown 	return ret;
361c3c5a19aSMark Brown }
362c3c5a19aSMark Brown 
363c3c5a19aSMark Brown static const struct file_operations codec_list_fops = {
364c3c5a19aSMark Brown 	.read = codec_list_read_file,
365c3c5a19aSMark Brown 	.llseek = default_llseek,/* read accesses f_pos */
366c3c5a19aSMark Brown };
367c3c5a19aSMark Brown 
368f3208780SMark Brown static ssize_t dai_list_read_file(struct file *file, char __user *user_buf,
369f3208780SMark Brown 				  size_t count, loff_t *ppos)
370f3208780SMark Brown {
371f3208780SMark Brown 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
3722b194f9dSMark Brown 	ssize_t len, ret = 0;
373f3208780SMark Brown 	struct snd_soc_dai *dai;
374f3208780SMark Brown 
375f3208780SMark Brown 	if (!buf)
376f3208780SMark Brown 		return -ENOMEM;
377f3208780SMark Brown 
3782b194f9dSMark Brown 	list_for_each_entry(dai, &dai_list, list) {
3792b194f9dSMark Brown 		len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n", dai->name);
3802b194f9dSMark Brown 		if (len >= 0)
3812b194f9dSMark Brown 			ret += len;
3822b194f9dSMark Brown 		if (ret > PAGE_SIZE) {
3832b194f9dSMark Brown 			ret = PAGE_SIZE;
3842b194f9dSMark Brown 			break;
3852b194f9dSMark Brown 		}
3862b194f9dSMark Brown 	}
387f3208780SMark Brown 
388f3208780SMark Brown 	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
389f3208780SMark Brown 
390f3208780SMark Brown 	kfree(buf);
391f3208780SMark Brown 
392f3208780SMark Brown 	return ret;
393f3208780SMark Brown }
394f3208780SMark Brown 
395f3208780SMark Brown static const struct file_operations dai_list_fops = {
396f3208780SMark Brown 	.read = dai_list_read_file,
397f3208780SMark Brown 	.llseek = default_llseek,/* read accesses f_pos */
398f3208780SMark Brown };
399f3208780SMark Brown 
40019c7ac27SMark Brown static ssize_t platform_list_read_file(struct file *file,
40119c7ac27SMark Brown 				       char __user *user_buf,
40219c7ac27SMark Brown 				       size_t count, loff_t *ppos)
40319c7ac27SMark Brown {
40419c7ac27SMark Brown 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
4052b194f9dSMark Brown 	ssize_t len, ret = 0;
40619c7ac27SMark Brown 	struct snd_soc_platform *platform;
40719c7ac27SMark Brown 
40819c7ac27SMark Brown 	if (!buf)
40919c7ac27SMark Brown 		return -ENOMEM;
41019c7ac27SMark Brown 
4112b194f9dSMark Brown 	list_for_each_entry(platform, &platform_list, list) {
4122b194f9dSMark Brown 		len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
41319c7ac27SMark Brown 			       platform->name);
4142b194f9dSMark Brown 		if (len >= 0)
4152b194f9dSMark Brown 			ret += len;
4162b194f9dSMark Brown 		if (ret > PAGE_SIZE) {
4172b194f9dSMark Brown 			ret = PAGE_SIZE;
4182b194f9dSMark Brown 			break;
4192b194f9dSMark Brown 		}
4202b194f9dSMark Brown 	}
42119c7ac27SMark Brown 
42219c7ac27SMark Brown 	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
42319c7ac27SMark Brown 
42419c7ac27SMark Brown 	kfree(buf);
42519c7ac27SMark Brown 
42619c7ac27SMark Brown 	return ret;
42719c7ac27SMark Brown }
42819c7ac27SMark Brown 
42919c7ac27SMark Brown static const struct file_operations platform_list_fops = {
43019c7ac27SMark Brown 	.read = platform_list_read_file,
43119c7ac27SMark Brown 	.llseek = default_llseek,/* read accesses f_pos */
43219c7ac27SMark Brown };
43319c7ac27SMark Brown 
434a6052154SJarkko Nikula static void soc_init_card_debugfs(struct snd_soc_card *card)
435a6052154SJarkko Nikula {
436a6052154SJarkko Nikula 	card->debugfs_card_root = debugfs_create_dir(card->name,
4378a9dab1aSMark Brown 						     snd_soc_debugfs_root);
4383a45b867SJarkko Nikula 	if (!card->debugfs_card_root) {
439a6052154SJarkko Nikula 		dev_warn(card->dev,
4407c08be84SLothar Waßmann 			 "ASoC: Failed to create card debugfs directory\n");
4413a45b867SJarkko Nikula 		return;
4423a45b867SJarkko Nikula 	}
4433a45b867SJarkko Nikula 
4443a45b867SJarkko Nikula 	card->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0644,
4453a45b867SJarkko Nikula 						    card->debugfs_card_root,
4463a45b867SJarkko Nikula 						    &card->pop_time);
4473a45b867SJarkko Nikula 	if (!card->debugfs_pop_time)
4483a45b867SJarkko Nikula 		dev_warn(card->dev,
449f110bfc7SLiam Girdwood 		       "ASoC: Failed to create pop time debugfs file\n");
450a6052154SJarkko Nikula }
451a6052154SJarkko Nikula 
452a6052154SJarkko Nikula static void soc_cleanup_card_debugfs(struct snd_soc_card *card)
453a6052154SJarkko Nikula {
454a6052154SJarkko Nikula 	debugfs_remove_recursive(card->debugfs_card_root);
455a6052154SJarkko Nikula }
456a6052154SJarkko Nikula 
4572624d5faSMark Brown #else
4582624d5faSMark Brown 
4592624d5faSMark Brown static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
4602624d5faSMark Brown {
4612624d5faSMark Brown }
4622624d5faSMark Brown 
4632624d5faSMark Brown static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
4642624d5faSMark Brown {
4652624d5faSMark Brown }
466b95fccbcSAxel Lin 
467731f1ab2SSebastien Guiriec static inline void soc_init_platform_debugfs(struct snd_soc_platform *platform)
468731f1ab2SSebastien Guiriec {
469731f1ab2SSebastien Guiriec }
470731f1ab2SSebastien Guiriec 
471731f1ab2SSebastien Guiriec static inline void soc_cleanup_platform_debugfs(struct snd_soc_platform *platform)
472731f1ab2SSebastien Guiriec {
473731f1ab2SSebastien Guiriec }
474731f1ab2SSebastien Guiriec 
475b95fccbcSAxel Lin static inline void soc_init_card_debugfs(struct snd_soc_card *card)
476b95fccbcSAxel Lin {
477b95fccbcSAxel Lin }
478b95fccbcSAxel Lin 
479b95fccbcSAxel Lin static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card)
480b95fccbcSAxel Lin {
481b95fccbcSAxel Lin }
4822624d5faSMark Brown #endif
4832624d5faSMark Brown 
48447c88fffSLiam Girdwood struct snd_pcm_substream *snd_soc_get_dai_substream(struct snd_soc_card *card,
48547c88fffSLiam Girdwood 		const char *dai_link, int stream)
48647c88fffSLiam Girdwood {
48747c88fffSLiam Girdwood 	int i;
48847c88fffSLiam Girdwood 
48947c88fffSLiam Girdwood 	for (i = 0; i < card->num_links; i++) {
49047c88fffSLiam Girdwood 		if (card->rtd[i].dai_link->no_pcm &&
49147c88fffSLiam Girdwood 			!strcmp(card->rtd[i].dai_link->name, dai_link))
49247c88fffSLiam Girdwood 			return card->rtd[i].pcm->streams[stream].substream;
49347c88fffSLiam Girdwood 	}
494f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: failed to find dai link %s\n", dai_link);
49547c88fffSLiam Girdwood 	return NULL;
49647c88fffSLiam Girdwood }
49747c88fffSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_get_dai_substream);
49847c88fffSLiam Girdwood 
49947c88fffSLiam Girdwood struct snd_soc_pcm_runtime *snd_soc_get_pcm_runtime(struct snd_soc_card *card,
50047c88fffSLiam Girdwood 		const char *dai_link)
50147c88fffSLiam Girdwood {
50247c88fffSLiam Girdwood 	int i;
50347c88fffSLiam Girdwood 
50447c88fffSLiam Girdwood 	for (i = 0; i < card->num_links; i++) {
50547c88fffSLiam Girdwood 		if (!strcmp(card->rtd[i].dai_link->name, dai_link))
50647c88fffSLiam Girdwood 			return &card->rtd[i];
50747c88fffSLiam Girdwood 	}
508f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: failed to find rtd %s\n", dai_link);
50947c88fffSLiam Girdwood 	return NULL;
51047c88fffSLiam Girdwood }
51147c88fffSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_get_pcm_runtime);
51247c88fffSLiam Girdwood 
513db2a4165SFrank Mandarino #ifdef CONFIG_SND_SOC_AC97_BUS
514db2a4165SFrank Mandarino /* unregister ac97 codec */
515db2a4165SFrank Mandarino static int soc_ac97_dev_unregister(struct snd_soc_codec *codec)
516db2a4165SFrank Mandarino {
517db2a4165SFrank Mandarino 	if (codec->ac97->dev.bus)
518db2a4165SFrank Mandarino 		device_unregister(&codec->ac97->dev);
519db2a4165SFrank Mandarino 	return 0;
520db2a4165SFrank Mandarino }
521db2a4165SFrank Mandarino 
522db2a4165SFrank Mandarino /* stop no dev release warning */
523db2a4165SFrank Mandarino static void soc_ac97_device_release(struct device *dev){}
524db2a4165SFrank Mandarino 
525db2a4165SFrank Mandarino /* register ac97 codec to bus */
526db2a4165SFrank Mandarino static int soc_ac97_dev_register(struct snd_soc_codec *codec)
527db2a4165SFrank Mandarino {
528db2a4165SFrank Mandarino 	int err;
529db2a4165SFrank Mandarino 
530db2a4165SFrank Mandarino 	codec->ac97->dev.bus = &ac97_bus_type;
5314ac5c61fSMark Brown 	codec->ac97->dev.parent = codec->card->dev;
532db2a4165SFrank Mandarino 	codec->ac97->dev.release = soc_ac97_device_release;
533db2a4165SFrank Mandarino 
534bb072bf0SKay Sievers 	dev_set_name(&codec->ac97->dev, "%d-%d:%s",
535f0fba2adSLiam Girdwood 		     codec->card->snd_card->number, 0, codec->name);
536db2a4165SFrank Mandarino 	err = device_register(&codec->ac97->dev);
537db2a4165SFrank Mandarino 	if (err < 0) {
538f110bfc7SLiam Girdwood 		dev_err(codec->dev, "ASoC: Can't register ac97 bus\n");
539db2a4165SFrank Mandarino 		codec->ac97->dev.bus = NULL;
540db2a4165SFrank Mandarino 		return err;
541db2a4165SFrank Mandarino 	}
542db2a4165SFrank Mandarino 	return 0;
543db2a4165SFrank Mandarino }
544db2a4165SFrank Mandarino #endif
545db2a4165SFrank Mandarino 
5469d58a077SRichard Fitzgerald static void codec2codec_close_delayed_work(struct work_struct *work)
5479d58a077SRichard Fitzgerald {
5489d58a077SRichard Fitzgerald 	/* Currently nothing to do for c2c links
5499d58a077SRichard Fitzgerald 	 * Since c2c links are internal nodes in the DAPM graph and
5509d58a077SRichard Fitzgerald 	 * don't interface with the outside world or application layer
5519d58a077SRichard Fitzgerald 	 * we don't have to do any special handling on close.
5529d58a077SRichard Fitzgerald 	 */
5539d58a077SRichard Fitzgerald }
5549d58a077SRichard Fitzgerald 
5556f8ab4acSMark Brown #ifdef CONFIG_PM_SLEEP
556db2a4165SFrank Mandarino /* powers down audio subsystem for suspend */
5576f8ab4acSMark Brown int snd_soc_suspend(struct device *dev)
558db2a4165SFrank Mandarino {
5596f8ab4acSMark Brown 	struct snd_soc_card *card = dev_get_drvdata(dev);
5602eea392dSJarkko Nikula 	struct snd_soc_codec *codec;
561db2a4165SFrank Mandarino 	int i;
562db2a4165SFrank Mandarino 
563e3509ff0SDaniel Mack 	/* If the initialization of this soc device failed, there is no codec
564e3509ff0SDaniel Mack 	 * associated with it. Just bail out in this case.
565e3509ff0SDaniel Mack 	 */
566f0fba2adSLiam Girdwood 	if (list_empty(&card->codec_dev_list))
567e3509ff0SDaniel Mack 		return 0;
568e3509ff0SDaniel Mack 
5696ed25978SAndy Green 	/* Due to the resume being scheduled into a workqueue we could
5706ed25978SAndy Green 	* suspend before that's finished - wait for it to complete.
5716ed25978SAndy Green 	 */
572f0fba2adSLiam Girdwood 	snd_power_lock(card->snd_card);
573f0fba2adSLiam Girdwood 	snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0);
574f0fba2adSLiam Girdwood 	snd_power_unlock(card->snd_card);
5756ed25978SAndy Green 
5766ed25978SAndy Green 	/* we're going to block userspace touching us until resume completes */
577f0fba2adSLiam Girdwood 	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
5786ed25978SAndy Green 
579a00f90f9SMark Brown 	/* mute any active DACs */
580f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
581f0fba2adSLiam Girdwood 		struct snd_soc_dai *dai = card->rtd[i].codec_dai;
582f0fba2adSLiam Girdwood 		struct snd_soc_dai_driver *drv = dai->driver;
5833efab7dcSMark Brown 
584f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
5853efab7dcSMark Brown 			continue;
5863efab7dcSMark Brown 
587f0fba2adSLiam Girdwood 		if (drv->ops->digital_mute && dai->playback_active)
588f0fba2adSLiam Girdwood 			drv->ops->digital_mute(dai, 1);
589db2a4165SFrank Mandarino 	}
590db2a4165SFrank Mandarino 
5914ccab3e7SLiam Girdwood 	/* suspend all pcms */
592f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
593f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
5943efab7dcSMark Brown 			continue;
5953efab7dcSMark Brown 
596f0fba2adSLiam Girdwood 		snd_pcm_suspend_all(card->rtd[i].pcm);
5973efab7dcSMark Brown 	}
5984ccab3e7SLiam Girdwood 
59987506549SMark Brown 	if (card->suspend_pre)
60070b2ac12SMark Brown 		card->suspend_pre(card);
601db2a4165SFrank Mandarino 
602f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
603f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
604f0fba2adSLiam Girdwood 		struct snd_soc_platform *platform = card->rtd[i].platform;
6053efab7dcSMark Brown 
606f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
6073efab7dcSMark Brown 			continue;
6083efab7dcSMark Brown 
609f0fba2adSLiam Girdwood 		if (cpu_dai->driver->suspend && !cpu_dai->driver->ac97_control)
610f0fba2adSLiam Girdwood 			cpu_dai->driver->suspend(cpu_dai);
611f0fba2adSLiam Girdwood 		if (platform->driver->suspend && !platform->suspended) {
612f0fba2adSLiam Girdwood 			platform->driver->suspend(cpu_dai);
613f0fba2adSLiam Girdwood 			platform->suspended = 1;
614f0fba2adSLiam Girdwood 		}
615db2a4165SFrank Mandarino 	}
616db2a4165SFrank Mandarino 
617db2a4165SFrank Mandarino 	/* close any waiting streams and save state */
618f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
61943829731STejun Heo 		flush_delayed_work(&card->rtd[i].delayed_work);
620ce6120ccSLiam Girdwood 		card->rtd[i].codec->dapm.suspend_bias_level = card->rtd[i].codec->dapm.bias_level;
621f0fba2adSLiam Girdwood 	}
622db2a4165SFrank Mandarino 
623f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
6243efab7dcSMark Brown 
625f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
6263efab7dcSMark Brown 			continue;
6273efab7dcSMark Brown 
6287bd3a6f3SMark Brown 		snd_soc_dapm_stream_event(&card->rtd[i],
6297bd3a6f3SMark Brown 					  SNDRV_PCM_STREAM_PLAYBACK,
630db2a4165SFrank Mandarino 					  SND_SOC_DAPM_STREAM_SUSPEND);
631f0fba2adSLiam Girdwood 
6327bd3a6f3SMark Brown 		snd_soc_dapm_stream_event(&card->rtd[i],
6337bd3a6f3SMark Brown 					  SNDRV_PCM_STREAM_CAPTURE,
634db2a4165SFrank Mandarino 					  SND_SOC_DAPM_STREAM_SUSPEND);
635db2a4165SFrank Mandarino 	}
636db2a4165SFrank Mandarino 
637e2d32ff6SMark Brown 	/* Recheck all analogue paths too */
638e2d32ff6SMark Brown 	dapm_mark_io_dirty(&card->dapm);
639e2d32ff6SMark Brown 	snd_soc_dapm_sync(&card->dapm);
640e2d32ff6SMark Brown 
641f0fba2adSLiam Girdwood 	/* suspend all CODECs */
6422eea392dSJarkko Nikula 	list_for_each_entry(codec, &card->codec_dev_list, card_list) {
6431547aba9SMark Brown 		/* If there are paths active then the CODEC will be held with
6441547aba9SMark Brown 		 * bias _ON and should not be suspended. */
645f0fba2adSLiam Girdwood 		if (!codec->suspended && codec->driver->suspend) {
646ce6120ccSLiam Girdwood 			switch (codec->dapm.bias_level) {
6471547aba9SMark Brown 			case SND_SOC_BIAS_STANDBY:
648125a25daSMark Brown 				/*
649125a25daSMark Brown 				 * If the CODEC is capable of idle
650125a25daSMark Brown 				 * bias off then being in STANDBY
651125a25daSMark Brown 				 * means it's doing something,
652125a25daSMark Brown 				 * otherwise fall through.
653125a25daSMark Brown 				 */
654125a25daSMark Brown 				if (codec->dapm.idle_bias_off) {
655125a25daSMark Brown 					dev_dbg(codec->dev,
65610e8aa9aSMichał Mirosław 						"ASoC: idle_bias_off CODEC on over suspend\n");
657125a25daSMark Brown 					break;
658125a25daSMark Brown 				}
6591547aba9SMark Brown 			case SND_SOC_BIAS_OFF:
66084b315eeSLars-Peter Clausen 				codec->driver->suspend(codec);
661f0fba2adSLiam Girdwood 				codec->suspended = 1;
6627be4ba24SMark Brown 				codec->cache_sync = 1;
663da8b8e0fSMark Brown 				if (codec->using_regmap)
664da8b8e0fSMark Brown 					regcache_mark_dirty(codec->control_data);
665988e8cc4SNicolin Chen 				/* deactivate pins to sleep state */
666988e8cc4SNicolin Chen 				pinctrl_pm_select_sleep_state(codec->dev);
6671547aba9SMark Brown 				break;
6681547aba9SMark Brown 			default:
66910e8aa9aSMichał Mirosław 				dev_dbg(codec->dev,
67010e8aa9aSMichał Mirosław 					"ASoC: CODEC is on over suspend\n");
6711547aba9SMark Brown 				break;
6721547aba9SMark Brown 			}
6731547aba9SMark Brown 		}
674f0fba2adSLiam Girdwood 	}
675db2a4165SFrank Mandarino 
676f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
677f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
6783efab7dcSMark Brown 
679f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
6803efab7dcSMark Brown 			continue;
6813efab7dcSMark Brown 
682f0fba2adSLiam Girdwood 		if (cpu_dai->driver->suspend && cpu_dai->driver->ac97_control)
683f0fba2adSLiam Girdwood 			cpu_dai->driver->suspend(cpu_dai);
684988e8cc4SNicolin Chen 
685988e8cc4SNicolin Chen 		/* deactivate pins to sleep state */
686988e8cc4SNicolin Chen 		pinctrl_pm_select_sleep_state(cpu_dai->dev);
687db2a4165SFrank Mandarino 	}
688db2a4165SFrank Mandarino 
68987506549SMark Brown 	if (card->suspend_post)
69070b2ac12SMark Brown 		card->suspend_post(card);
691db2a4165SFrank Mandarino 
692db2a4165SFrank Mandarino 	return 0;
693db2a4165SFrank Mandarino }
6946f8ab4acSMark Brown EXPORT_SYMBOL_GPL(snd_soc_suspend);
695db2a4165SFrank Mandarino 
6966ed25978SAndy Green /* deferred resume work, so resume can complete before we finished
6976ed25978SAndy Green  * setting our codec back up, which can be very slow on I2C
6986ed25978SAndy Green  */
6996ed25978SAndy Green static void soc_resume_deferred(struct work_struct *work)
700db2a4165SFrank Mandarino {
701f0fba2adSLiam Girdwood 	struct snd_soc_card *card =
702f0fba2adSLiam Girdwood 			container_of(work, struct snd_soc_card, deferred_resume_work);
7032eea392dSJarkko Nikula 	struct snd_soc_codec *codec;
704db2a4165SFrank Mandarino 	int i;
705db2a4165SFrank Mandarino 
7066ed25978SAndy Green 	/* our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
7076ed25978SAndy Green 	 * so userspace apps are blocked from touching us
7086ed25978SAndy Green 	 */
7096ed25978SAndy Green 
710f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: starting resume work\n");
7116ed25978SAndy Green 
7129949788bSMark Brown 	/* Bring us up into D2 so that DAPM starts enabling things */
713f0fba2adSLiam Girdwood 	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
7149949788bSMark Brown 
71587506549SMark Brown 	if (card->resume_pre)
71670b2ac12SMark Brown 		card->resume_pre(card);
717db2a4165SFrank Mandarino 
718f0fba2adSLiam Girdwood 	/* resume AC97 DAIs */
719f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
720f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
7213efab7dcSMark Brown 
722f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
7233efab7dcSMark Brown 			continue;
7243efab7dcSMark Brown 
725f0fba2adSLiam Girdwood 		if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control)
726f0fba2adSLiam Girdwood 			cpu_dai->driver->resume(cpu_dai);
727db2a4165SFrank Mandarino 	}
728db2a4165SFrank Mandarino 
7292eea392dSJarkko Nikula 	list_for_each_entry(codec, &card->codec_dev_list, card_list) {
7301547aba9SMark Brown 		/* If the CODEC was idle over suspend then it will have been
7311547aba9SMark Brown 		 * left with bias OFF or STANDBY and suspended so we must now
7321547aba9SMark Brown 		 * resume.  Otherwise the suspend was suppressed.
7331547aba9SMark Brown 		 */
734f0fba2adSLiam Girdwood 		if (codec->driver->resume && codec->suspended) {
735ce6120ccSLiam Girdwood 			switch (codec->dapm.bias_level) {
7361547aba9SMark Brown 			case SND_SOC_BIAS_STANDBY:
7371547aba9SMark Brown 			case SND_SOC_BIAS_OFF:
738f0fba2adSLiam Girdwood 				codec->driver->resume(codec);
739f0fba2adSLiam Girdwood 				codec->suspended = 0;
7401547aba9SMark Brown 				break;
7411547aba9SMark Brown 			default:
74210e8aa9aSMichał Mirosław 				dev_dbg(codec->dev,
74310e8aa9aSMichał Mirosław 					"ASoC: CODEC was on over suspend\n");
7441547aba9SMark Brown 				break;
7451547aba9SMark Brown 			}
7461547aba9SMark Brown 		}
747f0fba2adSLiam Girdwood 	}
748db2a4165SFrank Mandarino 
749f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
7503efab7dcSMark Brown 
751f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
7523efab7dcSMark Brown 			continue;
7533efab7dcSMark Brown 
7547bd3a6f3SMark Brown 		snd_soc_dapm_stream_event(&card->rtd[i],
755d9b0951bSLiam Girdwood 					  SNDRV_PCM_STREAM_PLAYBACK,
756db2a4165SFrank Mandarino 					  SND_SOC_DAPM_STREAM_RESUME);
757f0fba2adSLiam Girdwood 
7587bd3a6f3SMark Brown 		snd_soc_dapm_stream_event(&card->rtd[i],
759d9b0951bSLiam Girdwood 					  SNDRV_PCM_STREAM_CAPTURE,
760db2a4165SFrank Mandarino 					  SND_SOC_DAPM_STREAM_RESUME);
761db2a4165SFrank Mandarino 	}
762db2a4165SFrank Mandarino 
7633ff3f64bSMark Brown 	/* unmute any active DACs */
764f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
765f0fba2adSLiam Girdwood 		struct snd_soc_dai *dai = card->rtd[i].codec_dai;
766f0fba2adSLiam Girdwood 		struct snd_soc_dai_driver *drv = dai->driver;
7673efab7dcSMark Brown 
768f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
7693efab7dcSMark Brown 			continue;
7703efab7dcSMark Brown 
771f0fba2adSLiam Girdwood 		if (drv->ops->digital_mute && dai->playback_active)
772f0fba2adSLiam Girdwood 			drv->ops->digital_mute(dai, 0);
773db2a4165SFrank Mandarino 	}
774db2a4165SFrank Mandarino 
775f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
776f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
777f0fba2adSLiam Girdwood 		struct snd_soc_platform *platform = card->rtd[i].platform;
7783efab7dcSMark Brown 
779f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
7803efab7dcSMark Brown 			continue;
7813efab7dcSMark Brown 
782f0fba2adSLiam Girdwood 		if (cpu_dai->driver->resume && !cpu_dai->driver->ac97_control)
783f0fba2adSLiam Girdwood 			cpu_dai->driver->resume(cpu_dai);
784f0fba2adSLiam Girdwood 		if (platform->driver->resume && platform->suspended) {
785f0fba2adSLiam Girdwood 			platform->driver->resume(cpu_dai);
786f0fba2adSLiam Girdwood 			platform->suspended = 0;
787f0fba2adSLiam Girdwood 		}
788db2a4165SFrank Mandarino 	}
789db2a4165SFrank Mandarino 
79087506549SMark Brown 	if (card->resume_post)
79170b2ac12SMark Brown 		card->resume_post(card);
792db2a4165SFrank Mandarino 
793f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: resume work completed\n");
7946ed25978SAndy Green 
7956ed25978SAndy Green 	/* userspace can access us now we are back as we were before */
796f0fba2adSLiam Girdwood 	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
797e2d32ff6SMark Brown 
798e2d32ff6SMark Brown 	/* Recheck all analogue paths too */
799e2d32ff6SMark Brown 	dapm_mark_io_dirty(&card->dapm);
800e2d32ff6SMark Brown 	snd_soc_dapm_sync(&card->dapm);
8016ed25978SAndy Green }
8026ed25978SAndy Green 
8036ed25978SAndy Green /* powers up audio subsystem after a suspend */
8046f8ab4acSMark Brown int snd_soc_resume(struct device *dev)
8056ed25978SAndy Green {
8066f8ab4acSMark Brown 	struct snd_soc_card *card = dev_get_drvdata(dev);
80782e14e8bSStephen Warren 	int i, ac97_control = 0;
808b9dd94a8SPeter Ujfalusi 
8095ff1ddf2SEric Miao 	/* If the initialization of this soc device failed, there is no codec
8105ff1ddf2SEric Miao 	 * associated with it. Just bail out in this case.
8115ff1ddf2SEric Miao 	 */
8125ff1ddf2SEric Miao 	if (list_empty(&card->codec_dev_list))
8135ff1ddf2SEric Miao 		return 0;
8145ff1ddf2SEric Miao 
815988e8cc4SNicolin Chen 	/* activate pins from sleep state */
816988e8cc4SNicolin Chen 	for (i = 0; i < card->num_rtd; i++) {
817988e8cc4SNicolin Chen 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
818988e8cc4SNicolin Chen 		struct snd_soc_dai *codec_dai = card->rtd[i].codec_dai;
819988e8cc4SNicolin Chen 		if (cpu_dai->active)
820988e8cc4SNicolin Chen 			pinctrl_pm_select_default_state(cpu_dai->dev);
821988e8cc4SNicolin Chen 		if (codec_dai->active)
822988e8cc4SNicolin Chen 			pinctrl_pm_select_default_state(codec_dai->dev);
823988e8cc4SNicolin Chen 	}
824988e8cc4SNicolin Chen 
82564ab9baaSMark Brown 	/* AC97 devices might have other drivers hanging off them so
82664ab9baaSMark Brown 	 * need to resume immediately.  Other drivers don't have that
82764ab9baaSMark Brown 	 * problem and may take a substantial amount of time to resume
82864ab9baaSMark Brown 	 * due to I/O costs and anti-pop so handle them out of line.
82964ab9baaSMark Brown 	 */
830f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
831f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
83282e14e8bSStephen Warren 		ac97_control |= cpu_dai->driver->ac97_control;
83382e14e8bSStephen Warren 	}
83482e14e8bSStephen Warren 	if (ac97_control) {
835f110bfc7SLiam Girdwood 		dev_dbg(dev, "ASoC: Resuming AC97 immediately\n");
83664ab9baaSMark Brown 		soc_resume_deferred(&card->deferred_resume_work);
83764ab9baaSMark Brown 	} else {
838f110bfc7SLiam Girdwood 		dev_dbg(dev, "ASoC: Scheduling resume work\n");
8396308419aSMark Brown 		if (!schedule_work(&card->deferred_resume_work))
840f110bfc7SLiam Girdwood 			dev_err(dev, "ASoC: resume work item may be lost\n");
841f0fba2adSLiam Girdwood 	}
8426ed25978SAndy Green 
843db2a4165SFrank Mandarino 	return 0;
844db2a4165SFrank Mandarino }
8456f8ab4acSMark Brown EXPORT_SYMBOL_GPL(snd_soc_resume);
846db2a4165SFrank Mandarino #else
8476f8ab4acSMark Brown #define snd_soc_suspend NULL
8486f8ab4acSMark Brown #define snd_soc_resume NULL
849db2a4165SFrank Mandarino #endif
850db2a4165SFrank Mandarino 
85185e7652dSLars-Peter Clausen static const struct snd_soc_dai_ops null_dai_ops = {
85202a06d30SBarry Song };
85302a06d30SBarry Song 
854f0fba2adSLiam Girdwood static int soc_bind_dai_link(struct snd_soc_card *card, int num)
855db2a4165SFrank Mandarino {
856f0fba2adSLiam Girdwood 	struct snd_soc_dai_link *dai_link = &card->dai_link[num];
857f0fba2adSLiam Girdwood 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
858fe3e78e0SMark Brown 	struct snd_soc_codec *codec;
859435c5e25SMark Brown 	struct snd_soc_platform *platform;
860f0fba2adSLiam Girdwood 	struct snd_soc_dai *codec_dai, *cpu_dai;
861848dd8beSMark Brown 	const char *platform_name;
862db2a4165SFrank Mandarino 
863f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: binding %s at idx %d\n", dai_link->name, num);
8646308419aSMark Brown 
865b19e6e7bSMark Brown 	/* Find CPU DAI from registered DAIs*/
866f0fba2adSLiam Girdwood 	list_for_each_entry(cpu_dai, &dai_list, list) {
867bc92657aSStephen Warren 		if (dai_link->cpu_of_node &&
868bc92657aSStephen Warren 		    (cpu_dai->dev->of_node != dai_link->cpu_of_node))
8695a504963SStephen Warren 			continue;
870bc92657aSStephen Warren 		if (dai_link->cpu_name &&
871bc92657aSStephen Warren 		    strcmp(dev_name(cpu_dai->dev), dai_link->cpu_name))
8722610ab77SStephen Warren 			continue;
873bc92657aSStephen Warren 		if (dai_link->cpu_dai_name &&
874bc92657aSStephen Warren 		    strcmp(cpu_dai->name, dai_link->cpu_dai_name))
875bc92657aSStephen Warren 			continue;
8762610ab77SStephen Warren 
877f0fba2adSLiam Girdwood 		rtd->cpu_dai = cpu_dai;
878f0fba2adSLiam Girdwood 	}
879b19e6e7bSMark Brown 
880b19e6e7bSMark Brown 	if (!rtd->cpu_dai) {
881f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: CPU DAI %s not registered\n",
882f0fba2adSLiam Girdwood 			dai_link->cpu_dai_name);
883b19e6e7bSMark Brown 		return -EPROBE_DEFER;
884c5af3a2eSMark Brown 	}
885c5af3a2eSMark Brown 
886b19e6e7bSMark Brown 	/* Find CODEC from registered CODECs */
887f0fba2adSLiam Girdwood 	list_for_each_entry(codec, &codec_list, list) {
8885a504963SStephen Warren 		if (dai_link->codec_of_node) {
8895a504963SStephen Warren 			if (codec->dev->of_node != dai_link->codec_of_node)
8905a504963SStephen Warren 				continue;
8915a504963SStephen Warren 		} else {
8922610ab77SStephen Warren 			if (strcmp(codec->name, dai_link->codec_name))
8932610ab77SStephen Warren 				continue;
8945a504963SStephen Warren 		}
8952610ab77SStephen Warren 
896f0fba2adSLiam Girdwood 		rtd->codec = codec;
897f0fba2adSLiam Girdwood 
8982610ab77SStephen Warren 		/*
8992610ab77SStephen Warren 		 * CODEC found, so find CODEC DAI from registered DAIs from
9002610ab77SStephen Warren 		 * this CODEC
9012610ab77SStephen Warren 		 */
902f0fba2adSLiam Girdwood 		list_for_each_entry(codec_dai, &dai_list, list) {
903f0fba2adSLiam Girdwood 			if (codec->dev == codec_dai->dev &&
9042610ab77SStephen Warren 				!strcmp(codec_dai->name,
9052610ab77SStephen Warren 					dai_link->codec_dai_name)) {
9062610ab77SStephen Warren 
907f0fba2adSLiam Girdwood 				rtd->codec_dai = codec_dai;
908435c5e25SMark Brown 			}
909f0fba2adSLiam Girdwood 		}
910b19e6e7bSMark Brown 
911b19e6e7bSMark Brown 		if (!rtd->codec_dai) {
912f110bfc7SLiam Girdwood 			dev_err(card->dev, "ASoC: CODEC DAI %s not registered\n",
913f0fba2adSLiam Girdwood 				dai_link->codec_dai_name);
914b19e6e7bSMark Brown 			return -EPROBE_DEFER;
915f0fba2adSLiam Girdwood 		}
916b19e6e7bSMark Brown 	}
917b19e6e7bSMark Brown 
918b19e6e7bSMark Brown 	if (!rtd->codec) {
919f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: CODEC %s not registered\n",
920f0fba2adSLiam Girdwood 			dai_link->codec_name);
921b19e6e7bSMark Brown 		return -EPROBE_DEFER;
922b19e6e7bSMark Brown 	}
923848dd8beSMark Brown 
924848dd8beSMark Brown 	/* if there's no platform we match on the empty platform */
925848dd8beSMark Brown 	platform_name = dai_link->platform_name;
9265a504963SStephen Warren 	if (!platform_name && !dai_link->platform_of_node)
927848dd8beSMark Brown 		platform_name = "snd-soc-dummy";
928848dd8beSMark Brown 
929b19e6e7bSMark Brown 	/* find one from the set of registered platforms */
930f0fba2adSLiam Girdwood 	list_for_each_entry(platform, &platform_list, list) {
9315a504963SStephen Warren 		if (dai_link->platform_of_node) {
9325a504963SStephen Warren 			if (platform->dev->of_node !=
9335a504963SStephen Warren 			    dai_link->platform_of_node)
9345a504963SStephen Warren 				continue;
9355a504963SStephen Warren 		} else {
9362610ab77SStephen Warren 			if (strcmp(platform->name, platform_name))
9372610ab77SStephen Warren 				continue;
9385a504963SStephen Warren 		}
9392610ab77SStephen Warren 
940f0fba2adSLiam Girdwood 		rtd->platform = platform;
941f0fba2adSLiam Girdwood 	}
942b19e6e7bSMark Brown 	if (!rtd->platform) {
943f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: platform %s not registered\n",
944f0fba2adSLiam Girdwood 			dai_link->platform_name);
945b19e6e7bSMark Brown 		return -EPROBE_DEFER;
946f0fba2adSLiam Girdwood 	}
947b19e6e7bSMark Brown 
948b19e6e7bSMark Brown 	card->num_rtd++;
949b19e6e7bSMark Brown 
950b19e6e7bSMark Brown 	return 0;
9516b05eda6SMark Brown }
9526b05eda6SMark Brown 
953d12cd198SStephen Warren static int soc_remove_platform(struct snd_soc_platform *platform)
954d12cd198SStephen Warren {
955d12cd198SStephen Warren 	int ret;
956d12cd198SStephen Warren 
957d12cd198SStephen Warren 	if (platform->driver->remove) {
958d12cd198SStephen Warren 		ret = platform->driver->remove(platform);
959d12cd198SStephen Warren 		if (ret < 0)
960f110bfc7SLiam Girdwood 			dev_err(platform->dev, "ASoC: failed to remove %d\n",
961f110bfc7SLiam Girdwood 				ret);
962d12cd198SStephen Warren 	}
963d12cd198SStephen Warren 
964d12cd198SStephen Warren 	/* Make sure all DAPM widgets are freed */
965d12cd198SStephen Warren 	snd_soc_dapm_free(&platform->dapm);
966d12cd198SStephen Warren 
967d12cd198SStephen Warren 	soc_cleanup_platform_debugfs(platform);
968d12cd198SStephen Warren 	platform->probed = 0;
969d12cd198SStephen Warren 	list_del(&platform->card_list);
970d12cd198SStephen Warren 	module_put(platform->dev->driver->owner);
971d12cd198SStephen Warren 
972d12cd198SStephen Warren 	return 0;
973d12cd198SStephen Warren }
974d12cd198SStephen Warren 
975589c3563SJarkko Nikula static void soc_remove_codec(struct snd_soc_codec *codec)
976589c3563SJarkko Nikula {
977589c3563SJarkko Nikula 	int err;
978589c3563SJarkko Nikula 
979589c3563SJarkko Nikula 	if (codec->driver->remove) {
980589c3563SJarkko Nikula 		err = codec->driver->remove(codec);
981589c3563SJarkko Nikula 		if (err < 0)
982f110bfc7SLiam Girdwood 			dev_err(codec->dev, "ASoC: failed to remove %d\n", err);
983589c3563SJarkko Nikula 	}
984589c3563SJarkko Nikula 
985589c3563SJarkko Nikula 	/* Make sure all DAPM widgets are freed */
986589c3563SJarkko Nikula 	snd_soc_dapm_free(&codec->dapm);
987589c3563SJarkko Nikula 
988589c3563SJarkko Nikula 	soc_cleanup_codec_debugfs(codec);
989589c3563SJarkko Nikula 	codec->probed = 0;
990589c3563SJarkko Nikula 	list_del(&codec->card_list);
991589c3563SJarkko Nikula 	module_put(codec->dev->driver->owner);
992589c3563SJarkko Nikula }
993589c3563SJarkko Nikula 
99462ae68faSStephen Warren static void soc_remove_link_dais(struct snd_soc_card *card, int num, int order)
995f0fba2adSLiam Girdwood {
996f0fba2adSLiam Girdwood 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
997f0fba2adSLiam Girdwood 	struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
998f0fba2adSLiam Girdwood 	int err;
999f0fba2adSLiam Girdwood 
1000f0fba2adSLiam Girdwood 	/* unregister the rtd device */
1001f0fba2adSLiam Girdwood 	if (rtd->dev_registered) {
100236ae1a96SMark Brown 		device_remove_file(rtd->dev, &dev_attr_pmdown_time);
100336ae1a96SMark Brown 		device_remove_file(rtd->dev, &dev_attr_codec_reg);
100436ae1a96SMark Brown 		device_unregister(rtd->dev);
1005f0fba2adSLiam Girdwood 		rtd->dev_registered = 0;
100602a06d30SBarry Song 	}
100702a06d30SBarry Song 
1008f0fba2adSLiam Girdwood 	/* remove the CODEC DAI */
10090168bf0dSLiam Girdwood 	if (codec_dai && codec_dai->probed &&
10100168bf0dSLiam Girdwood 			codec_dai->driver->remove_order == order) {
1011f0fba2adSLiam Girdwood 		if (codec_dai->driver->remove) {
1012f0fba2adSLiam Girdwood 			err = codec_dai->driver->remove(codec_dai);
1013f0fba2adSLiam Girdwood 			if (err < 0)
1014f110bfc7SLiam Girdwood 				dev_err(codec_dai->dev,
1015f110bfc7SLiam Girdwood 					"ASoC: failed to remove %s: %d\n",
10160837fc62SFabio Estevam 					codec_dai->name, err);
1017f0fba2adSLiam Girdwood 		}
1018f0fba2adSLiam Girdwood 		codec_dai->probed = 0;
1019f0fba2adSLiam Girdwood 		list_del(&codec_dai->card_list);
1020f0fba2adSLiam Girdwood 	}
1021f0fba2adSLiam Girdwood 
1022f0fba2adSLiam Girdwood 	/* remove the cpu_dai */
10230168bf0dSLiam Girdwood 	if (cpu_dai && cpu_dai->probed &&
10240168bf0dSLiam Girdwood 			cpu_dai->driver->remove_order == order) {
1025f0fba2adSLiam Girdwood 		if (cpu_dai->driver->remove) {
1026f0fba2adSLiam Girdwood 			err = cpu_dai->driver->remove(cpu_dai);
1027f0fba2adSLiam Girdwood 			if (err < 0)
1028f110bfc7SLiam Girdwood 				dev_err(cpu_dai->dev,
1029f110bfc7SLiam Girdwood 					"ASoC: failed to remove %s: %d\n",
10300837fc62SFabio Estevam 					cpu_dai->name, err);
1031f0fba2adSLiam Girdwood 		}
1032f0fba2adSLiam Girdwood 		cpu_dai->probed = 0;
1033f0fba2adSLiam Girdwood 		list_del(&cpu_dai->card_list);
1034a9db7dbeSStephen Warren 
103518d75644SStephen Warren 		if (!cpu_dai->codec) {
103618d75644SStephen Warren 			snd_soc_dapm_free(&cpu_dai->dapm);
1037f0fba2adSLiam Girdwood 			module_put(cpu_dai->dev->driver->owner);
1038f0fba2adSLiam Girdwood 		}
1039f0fba2adSLiam Girdwood 	}
104018d75644SStephen Warren }
1041f0fba2adSLiam Girdwood 
104262ae68faSStephen Warren static void soc_remove_link_components(struct snd_soc_card *card, int num,
104362ae68faSStephen Warren 				       int order)
104462ae68faSStephen Warren {
104562ae68faSStephen Warren 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
104662ae68faSStephen Warren 	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
104762ae68faSStephen Warren 	struct snd_soc_dai *codec_dai = rtd->codec_dai;
104862ae68faSStephen Warren 	struct snd_soc_platform *platform = rtd->platform;
104962ae68faSStephen Warren 	struct snd_soc_codec *codec;
105062ae68faSStephen Warren 
105162ae68faSStephen Warren 	/* remove the platform */
105262ae68faSStephen Warren 	if (platform && platform->probed &&
105362ae68faSStephen Warren 	    platform->driver->remove_order == order) {
105462ae68faSStephen Warren 		soc_remove_platform(platform);
105562ae68faSStephen Warren 	}
105662ae68faSStephen Warren 
105762ae68faSStephen Warren 	/* remove the CODEC-side CODEC */
105862ae68faSStephen Warren 	if (codec_dai) {
105962ae68faSStephen Warren 		codec = codec_dai->codec;
106062ae68faSStephen Warren 		if (codec && codec->probed &&
106162ae68faSStephen Warren 		    codec->driver->remove_order == order)
106262ae68faSStephen Warren 			soc_remove_codec(codec);
106362ae68faSStephen Warren 	}
106462ae68faSStephen Warren 
106562ae68faSStephen Warren 	/* remove any CPU-side CODEC */
106662ae68faSStephen Warren 	if (cpu_dai) {
106762ae68faSStephen Warren 		codec = cpu_dai->codec;
106862ae68faSStephen Warren 		if (codec && codec->probed &&
106962ae68faSStephen Warren 		    codec->driver->remove_order == order)
107062ae68faSStephen Warren 			soc_remove_codec(codec);
107162ae68faSStephen Warren 	}
107262ae68faSStephen Warren }
107362ae68faSStephen Warren 
10740671fd8eSKuninori Morimoto static void soc_remove_dai_links(struct snd_soc_card *card)
10750671fd8eSKuninori Morimoto {
10760168bf0dSLiam Girdwood 	int dai, order;
10770671fd8eSKuninori Morimoto 
10780168bf0dSLiam Girdwood 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
10790168bf0dSLiam Girdwood 			order++) {
10800168bf0dSLiam Girdwood 		for (dai = 0; dai < card->num_rtd; dai++)
108162ae68faSStephen Warren 			soc_remove_link_dais(card, dai, order);
10820168bf0dSLiam Girdwood 	}
108362ae68faSStephen Warren 
108462ae68faSStephen Warren 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
108562ae68faSStephen Warren 			order++) {
108662ae68faSStephen Warren 		for (dai = 0; dai < card->num_rtd; dai++)
108762ae68faSStephen Warren 			soc_remove_link_components(card, dai, order);
108862ae68faSStephen Warren 	}
108962ae68faSStephen Warren 
10900671fd8eSKuninori Morimoto 	card->num_rtd = 0;
10910671fd8eSKuninori Morimoto }
10920671fd8eSKuninori Morimoto 
1093ead9b919SJarkko Nikula static void soc_set_name_prefix(struct snd_soc_card *card,
1094ead9b919SJarkko Nikula 				struct snd_soc_codec *codec)
1095ead9b919SJarkko Nikula {
1096ead9b919SJarkko Nikula 	int i;
1097ead9b919SJarkko Nikula 
1098ff819b83SDimitris Papastamos 	if (card->codec_conf == NULL)
1099ead9b919SJarkko Nikula 		return;
1100ead9b919SJarkko Nikula 
1101ff819b83SDimitris Papastamos 	for (i = 0; i < card->num_configs; i++) {
1102ff819b83SDimitris Papastamos 		struct snd_soc_codec_conf *map = &card->codec_conf[i];
1103ead9b919SJarkko Nikula 		if (map->dev_name && !strcmp(codec->name, map->dev_name)) {
1104ead9b919SJarkko Nikula 			codec->name_prefix = map->name_prefix;
1105ead9b919SJarkko Nikula 			break;
1106ead9b919SJarkko Nikula 		}
1107ead9b919SJarkko Nikula 	}
1108ead9b919SJarkko Nikula }
1109ead9b919SJarkko Nikula 
1110589c3563SJarkko Nikula static int soc_probe_codec(struct snd_soc_card *card,
1111589c3563SJarkko Nikula 			   struct snd_soc_codec *codec)
1112589c3563SJarkko Nikula {
1113589c3563SJarkko Nikula 	int ret = 0;
111489b95ac0SMark Brown 	const struct snd_soc_codec_driver *driver = codec->driver;
1115888df395SMark Brown 	struct snd_soc_dai *dai;
1116589c3563SJarkko Nikula 
1117589c3563SJarkko Nikula 	codec->card = card;
1118589c3563SJarkko Nikula 	codec->dapm.card = card;
1119589c3563SJarkko Nikula 	soc_set_name_prefix(card, codec);
1120589c3563SJarkko Nikula 
112170d29331SJarkko Nikula 	if (!try_module_get(codec->dev->driver->owner))
112270d29331SJarkko Nikula 		return -ENODEV;
112370d29331SJarkko Nikula 
1124d5d1e0beSLars-Peter Clausen 	soc_init_codec_debugfs(codec);
1125d5d1e0beSLars-Peter Clausen 
112677530150SLars-Peter Clausen 	if (driver->dapm_widgets)
112777530150SLars-Peter Clausen 		snd_soc_dapm_new_controls(&codec->dapm, driver->dapm_widgets,
112877530150SLars-Peter Clausen 					  driver->num_dapm_widgets);
112977530150SLars-Peter Clausen 
1130888df395SMark Brown 	/* Create DAPM widgets for each DAI stream */
1131888df395SMark Brown 	list_for_each_entry(dai, &dai_list, list) {
1132888df395SMark Brown 		if (dai->dev != codec->dev)
1133888df395SMark Brown 			continue;
1134888df395SMark Brown 
1135888df395SMark Brown 		snd_soc_dapm_new_dai_widgets(&codec->dapm, dai);
1136888df395SMark Brown 	}
1137888df395SMark Brown 
113833c5f969SMark Brown 	codec->dapm.idle_bias_off = driver->idle_bias_off;
113933c5f969SMark Brown 
1140*a32c17b8SXiubo Li 	if (!codec->write && dev_get_regmap(codec->dev, NULL)) {
1141fe2265e4SXiubo Li 		/* Set the default I/O up try regmap */
1142*a32c17b8SXiubo Li 		ret = snd_soc_codec_set_cache_io(codec, NULL);
1143*a32c17b8SXiubo Li 		if (ret < 0) {
1144*a32c17b8SXiubo Li 			dev_err(codec->dev,
1145*a32c17b8SXiubo Li 				"Failed to set cache I/O: %d\n", ret);
1146*a32c17b8SXiubo Li 			goto err_probe;
1147*a32c17b8SXiubo Li 		}
1148*a32c17b8SXiubo Li 	}
1149fe2265e4SXiubo Li 
115089b95ac0SMark Brown 	if (driver->probe) {
115189b95ac0SMark Brown 		ret = driver->probe(codec);
1152589c3563SJarkko Nikula 		if (ret < 0) {
1153589c3563SJarkko Nikula 			dev_err(codec->dev,
1154f110bfc7SLiam Girdwood 				"ASoC: failed to probe CODEC %d\n", ret);
115570d29331SJarkko Nikula 			goto err_probe;
1156589c3563SJarkko Nikula 		}
1157ff541f4bSChuansheng Liu 		WARN(codec->dapm.idle_bias_off &&
1158ff541f4bSChuansheng Liu 			codec->dapm.bias_level != SND_SOC_BIAS_OFF,
115910e8aa9aSMichał Mirosław 			"codec %s can not start from non-off bias with idle_bias_off==1\n",
116010e8aa9aSMichał Mirosław 			codec->name);
1161589c3563SJarkko Nikula 	}
1162589c3563SJarkko Nikula 
1163b7af1dafSMark Brown 	if (driver->controls)
1164022658beSLiam Girdwood 		snd_soc_add_codec_controls(codec, driver->controls,
1165b7af1dafSMark Brown 				     driver->num_controls);
116689b95ac0SMark Brown 	if (driver->dapm_routes)
116789b95ac0SMark Brown 		snd_soc_dapm_add_routes(&codec->dapm, driver->dapm_routes,
116889b95ac0SMark Brown 					driver->num_dapm_routes);
116989b95ac0SMark Brown 
1170589c3563SJarkko Nikula 	/* mark codec as probed and add to card codec list */
1171589c3563SJarkko Nikula 	codec->probed = 1;
1172589c3563SJarkko Nikula 	list_add(&codec->card_list, &card->codec_dev_list);
11737be31be8SJarkko Nikula 	list_add(&codec->dapm.list, &card->dapm_list);
1174589c3563SJarkko Nikula 
117570d29331SJarkko Nikula 	return 0;
117670d29331SJarkko Nikula 
117770d29331SJarkko Nikula err_probe:
1178d5d1e0beSLars-Peter Clausen 	soc_cleanup_codec_debugfs(codec);
117970d29331SJarkko Nikula 	module_put(codec->dev->driver->owner);
118070d29331SJarkko Nikula 
1181589c3563SJarkko Nikula 	return ret;
1182589c3563SJarkko Nikula }
1183589c3563SJarkko Nikula 
1184956245e9SLiam Girdwood static int soc_probe_platform(struct snd_soc_card *card,
1185956245e9SLiam Girdwood 			   struct snd_soc_platform *platform)
1186956245e9SLiam Girdwood {
1187956245e9SLiam Girdwood 	int ret = 0;
1188956245e9SLiam Girdwood 	const struct snd_soc_platform_driver *driver = platform->driver;
1189be09ad90SLiam Girdwood 	struct snd_soc_dai *dai;
1190956245e9SLiam Girdwood 
1191956245e9SLiam Girdwood 	platform->card = card;
1192b7950641SLiam Girdwood 	platform->dapm.card = card;
1193956245e9SLiam Girdwood 
1194956245e9SLiam Girdwood 	if (!try_module_get(platform->dev->driver->owner))
1195956245e9SLiam Girdwood 		return -ENODEV;
1196956245e9SLiam Girdwood 
1197731f1ab2SSebastien Guiriec 	soc_init_platform_debugfs(platform);
1198731f1ab2SSebastien Guiriec 
1199cb2cf612SLiam Girdwood 	if (driver->dapm_widgets)
1200cb2cf612SLiam Girdwood 		snd_soc_dapm_new_controls(&platform->dapm,
1201cb2cf612SLiam Girdwood 			driver->dapm_widgets, driver->num_dapm_widgets);
1202cb2cf612SLiam Girdwood 
1203be09ad90SLiam Girdwood 	/* Create DAPM widgets for each DAI stream */
1204be09ad90SLiam Girdwood 	list_for_each_entry(dai, &dai_list, list) {
1205be09ad90SLiam Girdwood 		if (dai->dev != platform->dev)
1206be09ad90SLiam Girdwood 			continue;
1207be09ad90SLiam Girdwood 
1208be09ad90SLiam Girdwood 		snd_soc_dapm_new_dai_widgets(&platform->dapm, dai);
1209be09ad90SLiam Girdwood 	}
1210be09ad90SLiam Girdwood 
12113fec6b6dSStephen Warren 	platform->dapm.idle_bias_off = 1;
12123fec6b6dSStephen Warren 
1213956245e9SLiam Girdwood 	if (driver->probe) {
1214956245e9SLiam Girdwood 		ret = driver->probe(platform);
1215956245e9SLiam Girdwood 		if (ret < 0) {
1216956245e9SLiam Girdwood 			dev_err(platform->dev,
1217f110bfc7SLiam Girdwood 				"ASoC: failed to probe platform %d\n", ret);
1218956245e9SLiam Girdwood 			goto err_probe;
1219956245e9SLiam Girdwood 		}
1220956245e9SLiam Girdwood 	}
1221956245e9SLiam Girdwood 
1222cb2cf612SLiam Girdwood 	if (driver->controls)
1223cb2cf612SLiam Girdwood 		snd_soc_add_platform_controls(platform, driver->controls,
1224cb2cf612SLiam Girdwood 				     driver->num_controls);
1225cb2cf612SLiam Girdwood 	if (driver->dapm_routes)
1226cb2cf612SLiam Girdwood 		snd_soc_dapm_add_routes(&platform->dapm, driver->dapm_routes,
1227cb2cf612SLiam Girdwood 					driver->num_dapm_routes);
1228cb2cf612SLiam Girdwood 
1229956245e9SLiam Girdwood 	/* mark platform as probed and add to card platform list */
1230956245e9SLiam Girdwood 	platform->probed = 1;
1231956245e9SLiam Girdwood 	list_add(&platform->card_list, &card->platform_dev_list);
1232b7950641SLiam Girdwood 	list_add(&platform->dapm.list, &card->dapm_list);
1233956245e9SLiam Girdwood 
1234956245e9SLiam Girdwood 	return 0;
1235956245e9SLiam Girdwood 
1236956245e9SLiam Girdwood err_probe:
123702db1103SLiam Girdwood 	soc_cleanup_platform_debugfs(platform);
1238956245e9SLiam Girdwood 	module_put(platform->dev->driver->owner);
1239956245e9SLiam Girdwood 
1240956245e9SLiam Girdwood 	return ret;
1241956245e9SLiam Girdwood }
1242956245e9SLiam Girdwood 
124336ae1a96SMark Brown static void rtd_release(struct device *dev)
124436ae1a96SMark Brown {
124536ae1a96SMark Brown 	kfree(dev);
124636ae1a96SMark Brown }
1247f0fba2adSLiam Girdwood 
1248589c3563SJarkko Nikula static int soc_post_component_init(struct snd_soc_card *card,
1249589c3563SJarkko Nikula 				   struct snd_soc_codec *codec,
1250589c3563SJarkko Nikula 				   int num, int dailess)
1251589c3563SJarkko Nikula {
1252589c3563SJarkko Nikula 	struct snd_soc_dai_link *dai_link = NULL;
1253589c3563SJarkko Nikula 	struct snd_soc_aux_dev *aux_dev = NULL;
1254589c3563SJarkko Nikula 	struct snd_soc_pcm_runtime *rtd;
1255589c3563SJarkko Nikula 	const char *temp, *name;
1256589c3563SJarkko Nikula 	int ret = 0;
1257589c3563SJarkko Nikula 
1258589c3563SJarkko Nikula 	if (!dailess) {
1259589c3563SJarkko Nikula 		dai_link = &card->dai_link[num];
1260589c3563SJarkko Nikula 		rtd = &card->rtd[num];
1261589c3563SJarkko Nikula 		name = dai_link->name;
1262589c3563SJarkko Nikula 	} else {
1263589c3563SJarkko Nikula 		aux_dev = &card->aux_dev[num];
1264589c3563SJarkko Nikula 		rtd = &card->rtd_aux[num];
1265589c3563SJarkko Nikula 		name = aux_dev->name;
1266589c3563SJarkko Nikula 	}
12670962bb21SJanusz Krzysztofik 	rtd->card = card;
1268589c3563SJarkko Nikula 
1269589c3563SJarkko Nikula 	/* machine controls, routes and widgets are not prefixed */
1270589c3563SJarkko Nikula 	temp = codec->name_prefix;
1271589c3563SJarkko Nikula 	codec->name_prefix = NULL;
1272589c3563SJarkko Nikula 
1273589c3563SJarkko Nikula 	/* do machine specific initialization */
1274589c3563SJarkko Nikula 	if (!dailess && dai_link->init)
1275589c3563SJarkko Nikula 		ret = dai_link->init(rtd);
1276589c3563SJarkko Nikula 	else if (dailess && aux_dev->init)
1277589c3563SJarkko Nikula 		ret = aux_dev->init(&codec->dapm);
1278589c3563SJarkko Nikula 	if (ret < 0) {
1279f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: failed to init %s: %d\n", name, ret);
1280589c3563SJarkko Nikula 		return ret;
1281589c3563SJarkko Nikula 	}
1282589c3563SJarkko Nikula 	codec->name_prefix = temp;
1283589c3563SJarkko Nikula 
1284589c3563SJarkko Nikula 	/* register the rtd device */
1285589c3563SJarkko Nikula 	rtd->codec = codec;
128636ae1a96SMark Brown 
128736ae1a96SMark Brown 	rtd->dev = kzalloc(sizeof(struct device), GFP_KERNEL);
128836ae1a96SMark Brown 	if (!rtd->dev)
128936ae1a96SMark Brown 		return -ENOMEM;
129036ae1a96SMark Brown 	device_initialize(rtd->dev);
129136ae1a96SMark Brown 	rtd->dev->parent = card->dev;
129236ae1a96SMark Brown 	rtd->dev->release = rtd_release;
129336ae1a96SMark Brown 	rtd->dev->init_name = name;
129436ae1a96SMark Brown 	dev_set_drvdata(rtd->dev, rtd);
1295b8c0dab9SLiam Girdwood 	mutex_init(&rtd->pcm_mutex);
129601d7584cSLiam Girdwood 	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].be_clients);
129701d7584cSLiam Girdwood 	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].be_clients);
129801d7584cSLiam Girdwood 	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].fe_clients);
129901d7584cSLiam Girdwood 	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].fe_clients);
130036ae1a96SMark Brown 	ret = device_add(rtd->dev);
1301589c3563SJarkko Nikula 	if (ret < 0) {
1302865df9cbSChuansheng Liu 		/* calling put_device() here to free the rtd->dev */
1303865df9cbSChuansheng Liu 		put_device(rtd->dev);
1304589c3563SJarkko Nikula 		dev_err(card->dev,
1305f110bfc7SLiam Girdwood 			"ASoC: failed to register runtime device: %d\n", ret);
1306589c3563SJarkko Nikula 		return ret;
1307589c3563SJarkko Nikula 	}
1308589c3563SJarkko Nikula 	rtd->dev_registered = 1;
1309589c3563SJarkko Nikula 
1310589c3563SJarkko Nikula 	/* add DAPM sysfs entries for this codec */
131136ae1a96SMark Brown 	ret = snd_soc_dapm_sys_add(rtd->dev);
1312589c3563SJarkko Nikula 	if (ret < 0)
1313589c3563SJarkko Nikula 		dev_err(codec->dev,
1314f110bfc7SLiam Girdwood 			"ASoC: failed to add codec dapm sysfs entries: %d\n", ret);
1315589c3563SJarkko Nikula 
1316589c3563SJarkko Nikula 	/* add codec sysfs entries */
131736ae1a96SMark Brown 	ret = device_create_file(rtd->dev, &dev_attr_codec_reg);
1318589c3563SJarkko Nikula 	if (ret < 0)
1319589c3563SJarkko Nikula 		dev_err(codec->dev,
1320f110bfc7SLiam Girdwood 			"ASoC: failed to add codec sysfs files: %d\n", ret);
1321589c3563SJarkko Nikula 
1322f86dcef8SLiam Girdwood #ifdef CONFIG_DEBUG_FS
1323f86dcef8SLiam Girdwood 	/* add DPCM sysfs entries */
1324cd0f8911SLiam Girdwood 	if (!dailess && !dai_link->dynamic)
1325f86dcef8SLiam Girdwood 		goto out;
1326f86dcef8SLiam Girdwood 
1327f86dcef8SLiam Girdwood 	ret = soc_dpcm_debugfs_add(rtd);
1328f86dcef8SLiam Girdwood 	if (ret < 0)
1329f110bfc7SLiam Girdwood 		dev_err(rtd->dev, "ASoC: failed to add dpcm sysfs entries: %d\n", ret);
1330f86dcef8SLiam Girdwood 
1331f86dcef8SLiam Girdwood out:
1332f86dcef8SLiam Girdwood #endif
1333589c3563SJarkko Nikula 	return 0;
1334589c3563SJarkko Nikula }
1335589c3563SJarkko Nikula 
133662ae68faSStephen Warren static int soc_probe_link_components(struct snd_soc_card *card, int num,
133762ae68faSStephen Warren 				     int order)
133862ae68faSStephen Warren {
133962ae68faSStephen Warren 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
134062ae68faSStephen Warren 	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
134162ae68faSStephen Warren 	struct snd_soc_dai *codec_dai = rtd->codec_dai;
134262ae68faSStephen Warren 	struct snd_soc_platform *platform = rtd->platform;
134362ae68faSStephen Warren 	int ret;
134462ae68faSStephen Warren 
134562ae68faSStephen Warren 	/* probe the CPU-side component, if it is a CODEC */
134662ae68faSStephen Warren 	if (cpu_dai->codec &&
134762ae68faSStephen Warren 	    !cpu_dai->codec->probed &&
134862ae68faSStephen Warren 	    cpu_dai->codec->driver->probe_order == order) {
134962ae68faSStephen Warren 		ret = soc_probe_codec(card, cpu_dai->codec);
135062ae68faSStephen Warren 		if (ret < 0)
135162ae68faSStephen Warren 			return ret;
135262ae68faSStephen Warren 	}
135362ae68faSStephen Warren 
135462ae68faSStephen Warren 	/* probe the CODEC-side component */
135562ae68faSStephen Warren 	if (!codec_dai->codec->probed &&
135662ae68faSStephen Warren 	    codec_dai->codec->driver->probe_order == order) {
135762ae68faSStephen Warren 		ret = soc_probe_codec(card, codec_dai->codec);
135862ae68faSStephen Warren 		if (ret < 0)
135962ae68faSStephen Warren 			return ret;
136062ae68faSStephen Warren 	}
136162ae68faSStephen Warren 
136262ae68faSStephen Warren 	/* probe the platform */
136362ae68faSStephen Warren 	if (!platform->probed &&
136462ae68faSStephen Warren 	    platform->driver->probe_order == order) {
136562ae68faSStephen Warren 		ret = soc_probe_platform(card, platform);
136662ae68faSStephen Warren 		if (ret < 0)
136762ae68faSStephen Warren 			return ret;
136862ae68faSStephen Warren 	}
136962ae68faSStephen Warren 
137062ae68faSStephen Warren 	return 0;
137162ae68faSStephen Warren }
137262ae68faSStephen Warren 
137362ae68faSStephen Warren static int soc_probe_link_dais(struct snd_soc_card *card, int num, int order)
1374f0fba2adSLiam Girdwood {
1375f0fba2adSLiam Girdwood 	struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1376f0fba2adSLiam Girdwood 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1377f0fba2adSLiam Girdwood 	struct snd_soc_codec *codec = rtd->codec;
1378f0fba2adSLiam Girdwood 	struct snd_soc_platform *platform = rtd->platform;
1379c74184edSMark Brown 	struct snd_soc_dai *codec_dai = rtd->codec_dai;
1380c74184edSMark Brown 	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1381c74184edSMark Brown 	struct snd_soc_dapm_widget *play_w, *capture_w;
1382f0fba2adSLiam Girdwood 	int ret;
1383f0fba2adSLiam Girdwood 
1384f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: probe %s dai link %d late %d\n",
13850168bf0dSLiam Girdwood 			card->name, num, order);
1386f0fba2adSLiam Girdwood 
1387f0fba2adSLiam Girdwood 	/* config components */
1388f0fba2adSLiam Girdwood 	cpu_dai->platform = platform;
1389f0fba2adSLiam Girdwood 	codec_dai->card = card;
1390f0fba2adSLiam Girdwood 	cpu_dai->card = card;
1391f0fba2adSLiam Girdwood 
1392f0fba2adSLiam Girdwood 	/* set default power off timeout */
1393f0fba2adSLiam Girdwood 	rtd->pmdown_time = pmdown_time;
1394f0fba2adSLiam Girdwood 
1395f0fba2adSLiam Girdwood 	/* probe the cpu_dai */
13960168bf0dSLiam Girdwood 	if (!cpu_dai->probed &&
13970168bf0dSLiam Girdwood 			cpu_dai->driver->probe_order == order) {
1398a9db7dbeSStephen Warren 		if (!cpu_dai->codec) {
1399be09ad90SLiam Girdwood 			cpu_dai->dapm.card = card;
140061b61e3cSLiam Girdwood 			if (!try_module_get(cpu_dai->dev->driver->owner))
140161b61e3cSLiam Girdwood 				return -ENODEV;
140261b61e3cSLiam Girdwood 
140318d75644SStephen Warren 			list_add(&cpu_dai->dapm.list, &card->dapm_list);
1404a9db7dbeSStephen Warren 		}
1405be09ad90SLiam Girdwood 
1406f0fba2adSLiam Girdwood 		if (cpu_dai->driver->probe) {
1407f0fba2adSLiam Girdwood 			ret = cpu_dai->driver->probe(cpu_dai);
1408f0fba2adSLiam Girdwood 			if (ret < 0) {
1409f110bfc7SLiam Girdwood 				dev_err(cpu_dai->dev,
1410f110bfc7SLiam Girdwood 					"ASoC: failed to probe CPU DAI %s: %d\n",
14110837fc62SFabio Estevam 					cpu_dai->name, ret);
141261b61e3cSLiam Girdwood 				module_put(cpu_dai->dev->driver->owner);
1413f0fba2adSLiam Girdwood 				return ret;
1414f0fba2adSLiam Girdwood 			}
1415f0fba2adSLiam Girdwood 		}
1416f0fba2adSLiam Girdwood 		cpu_dai->probed = 1;
14171c8371d6SWolfram Sang 		/* mark cpu_dai as probed and add to card dai list */
1418f0fba2adSLiam Girdwood 		list_add(&cpu_dai->card_list, &card->dai_dev_list);
1419f0fba2adSLiam Girdwood 	}
1420f0fba2adSLiam Girdwood 
1421f0fba2adSLiam Girdwood 	/* probe the CODEC DAI */
14220168bf0dSLiam Girdwood 	if (!codec_dai->probed && codec_dai->driver->probe_order == order) {
1423f0fba2adSLiam Girdwood 		if (codec_dai->driver->probe) {
1424f0fba2adSLiam Girdwood 			ret = codec_dai->driver->probe(codec_dai);
1425f0fba2adSLiam Girdwood 			if (ret < 0) {
1426f110bfc7SLiam Girdwood 				dev_err(codec_dai->dev,
1427f110bfc7SLiam Girdwood 					"ASoC: failed to probe CODEC DAI %s: %d\n",
14280837fc62SFabio Estevam 					codec_dai->name, ret);
1429f0fba2adSLiam Girdwood 				return ret;
1430f0fba2adSLiam Girdwood 			}
1431f0fba2adSLiam Girdwood 		}
1432f0fba2adSLiam Girdwood 
14331c8371d6SWolfram Sang 		/* mark codec_dai as probed and add to card dai list */
1434f0fba2adSLiam Girdwood 		codec_dai->probed = 1;
1435f0fba2adSLiam Girdwood 		list_add(&codec_dai->card_list, &card->dai_dev_list);
1436f0fba2adSLiam Girdwood 	}
1437f0fba2adSLiam Girdwood 
14380168bf0dSLiam Girdwood 	/* complete DAI probe during last probe */
14390168bf0dSLiam Girdwood 	if (order != SND_SOC_COMP_ORDER_LAST)
14400168bf0dSLiam Girdwood 		return 0;
14410168bf0dSLiam Girdwood 
1442589c3563SJarkko Nikula 	ret = soc_post_component_init(card, codec, num, 0);
1443589c3563SJarkko Nikula 	if (ret)
1444f0fba2adSLiam Girdwood 		return ret;
1445f0fba2adSLiam Girdwood 
144636ae1a96SMark Brown 	ret = device_create_file(rtd->dev, &dev_attr_pmdown_time);
1447f0fba2adSLiam Girdwood 	if (ret < 0)
1448f110bfc7SLiam Girdwood 		dev_warn(rtd->dev, "ASoC: failed to add pmdown_time sysfs: %d\n",
1449f110bfc7SLiam Girdwood 			ret);
1450f0fba2adSLiam Girdwood 
14511245b700SNamarta Kohli 	if (cpu_dai->driver->compress_dai) {
14521245b700SNamarta Kohli 		/*create compress_device"*/
14531245b700SNamarta Kohli 		ret = soc_new_compress(rtd, num);
14541245b700SNamarta Kohli 		if (ret < 0) {
1455f110bfc7SLiam Girdwood 			dev_err(card->dev, "ASoC: can't create compress %s\n",
14561245b700SNamarta Kohli 					 dai_link->stream_name);
14571245b700SNamarta Kohli 			return ret;
14581245b700SNamarta Kohli 		}
14591245b700SNamarta Kohli 	} else {
14601245b700SNamarta Kohli 
1461c74184edSMark Brown 		if (!dai_link->params) {
1462f0fba2adSLiam Girdwood 			/* create the pcm */
1463f0fba2adSLiam Girdwood 			ret = soc_new_pcm(rtd, num);
1464f0fba2adSLiam Girdwood 			if (ret < 0) {
1465f110bfc7SLiam Girdwood 				dev_err(card->dev, "ASoC: can't create pcm %s :%d\n",
14660837fc62SFabio Estevam 				       dai_link->stream_name, ret);
1467f0fba2adSLiam Girdwood 				return ret;
1468f0fba2adSLiam Girdwood 			}
1469c74184edSMark Brown 		} else {
14709d58a077SRichard Fitzgerald 			INIT_DELAYED_WORK(&rtd->delayed_work,
14719d58a077SRichard Fitzgerald 						codec2codec_close_delayed_work);
14729d58a077SRichard Fitzgerald 
1473c74184edSMark Brown 			/* link the DAI widgets */
1474c74184edSMark Brown 			play_w = codec_dai->playback_widget;
1475c74184edSMark Brown 			capture_w = cpu_dai->capture_widget;
1476c74184edSMark Brown 			if (play_w && capture_w) {
1477c74184edSMark Brown 				ret = snd_soc_dapm_new_pcm(card, dai_link->params,
1478c74184edSMark Brown 						   capture_w, play_w);
1479c74184edSMark Brown 				if (ret != 0) {
1480f110bfc7SLiam Girdwood 					dev_err(card->dev, "ASoC: Can't link %s to %s: %d\n",
1481c74184edSMark Brown 						play_w->name, capture_w->name, ret);
1482c74184edSMark Brown 					return ret;
1483c74184edSMark Brown 				}
1484c74184edSMark Brown 			}
1485c74184edSMark Brown 
1486c74184edSMark Brown 			play_w = cpu_dai->playback_widget;
1487c74184edSMark Brown 			capture_w = codec_dai->capture_widget;
1488c74184edSMark Brown 			if (play_w && capture_w) {
1489c74184edSMark Brown 				ret = snd_soc_dapm_new_pcm(card, dai_link->params,
1490c74184edSMark Brown 						   capture_w, play_w);
1491c74184edSMark Brown 				if (ret != 0) {
1492f110bfc7SLiam Girdwood 					dev_err(card->dev, "ASoC: Can't link %s to %s: %d\n",
1493c74184edSMark Brown 						play_w->name, capture_w->name, ret);
1494c74184edSMark Brown 					return ret;
1495c74184edSMark Brown 				}
1496c74184edSMark Brown 			}
1497c74184edSMark Brown 		}
14981245b700SNamarta Kohli 	}
1499f0fba2adSLiam Girdwood 
1500f0fba2adSLiam Girdwood 	/* add platform data for AC97 devices */
1501f0fba2adSLiam Girdwood 	if (rtd->codec_dai->driver->ac97_control)
1502f0fba2adSLiam Girdwood 		snd_ac97_dev_add_pdata(codec->ac97, rtd->cpu_dai->ac97_pdata);
1503f0fba2adSLiam Girdwood 
1504f0fba2adSLiam Girdwood 	return 0;
1505f0fba2adSLiam Girdwood }
1506f0fba2adSLiam Girdwood 
1507f0fba2adSLiam Girdwood #ifdef CONFIG_SND_SOC_AC97_BUS
1508f0fba2adSLiam Girdwood static int soc_register_ac97_dai_link(struct snd_soc_pcm_runtime *rtd)
1509f0fba2adSLiam Girdwood {
1510f0fba2adSLiam Girdwood 	int ret;
1511f0fba2adSLiam Girdwood 
1512f0fba2adSLiam Girdwood 	/* Only instantiate AC97 if not already done by the adaptor
1513f0fba2adSLiam Girdwood 	 * for the generic AC97 subsystem.
15146b05eda6SMark Brown 	 */
1515f0fba2adSLiam Girdwood 	if (rtd->codec_dai->driver->ac97_control && !rtd->codec->ac97_registered) {
15160562f788SMika Westerberg 		/*
15170562f788SMika Westerberg 		 * It is possible that the AC97 device is already registered to
15180562f788SMika Westerberg 		 * the device subsystem. This happens when the device is created
15190562f788SMika Westerberg 		 * via snd_ac97_mixer(). Currently only SoC codec that does so
15200562f788SMika Westerberg 		 * is the generic AC97 glue but others migh emerge.
15210562f788SMika Westerberg 		 *
15220562f788SMika Westerberg 		 * In those cases we don't try to register the device again.
15230562f788SMika Westerberg 		 */
15240562f788SMika Westerberg 		if (!rtd->codec->ac97_created)
15250562f788SMika Westerberg 			return 0;
1526f0fba2adSLiam Girdwood 
1527f0fba2adSLiam Girdwood 		ret = soc_ac97_dev_register(rtd->codec);
1528f0fba2adSLiam Girdwood 		if (ret < 0) {
1529f110bfc7SLiam Girdwood 			dev_err(rtd->codec->dev,
1530f110bfc7SLiam Girdwood 				"ASoC: AC97 device register failed: %d\n", ret);
1531f0fba2adSLiam Girdwood 			return ret;
1532435c5e25SMark Brown 		}
1533435c5e25SMark Brown 
1534f0fba2adSLiam Girdwood 		rtd->codec->ac97_registered = 1;
1535f0fba2adSLiam Girdwood 	}
1536f0fba2adSLiam Girdwood 	return 0;
1537f0fba2adSLiam Girdwood }
1538435c5e25SMark Brown 
1539f0fba2adSLiam Girdwood static void soc_unregister_ac97_dai_link(struct snd_soc_codec *codec)
1540f0fba2adSLiam Girdwood {
1541f0fba2adSLiam Girdwood 	if (codec->ac97_registered) {
1542f0fba2adSLiam Girdwood 		soc_ac97_dev_unregister(codec);
1543f0fba2adSLiam Girdwood 		codec->ac97_registered = 0;
1544f0fba2adSLiam Girdwood 	}
1545f0fba2adSLiam Girdwood }
1546f0fba2adSLiam Girdwood #endif
1547435c5e25SMark Brown 
1548b19e6e7bSMark Brown static int soc_check_aux_dev(struct snd_soc_card *card, int num)
1549b19e6e7bSMark Brown {
1550b19e6e7bSMark Brown 	struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
1551b19e6e7bSMark Brown 	struct snd_soc_codec *codec;
1552b19e6e7bSMark Brown 
1553b19e6e7bSMark Brown 	/* find CODEC from registered CODECs*/
1554b19e6e7bSMark Brown 	list_for_each_entry(codec, &codec_list, list) {
1555b19e6e7bSMark Brown 		if (!strcmp(codec->name, aux_dev->codec_name))
1556b19e6e7bSMark Brown 			return 0;
1557b19e6e7bSMark Brown 	}
1558b19e6e7bSMark Brown 
1559f110bfc7SLiam Girdwood 	dev_err(card->dev, "ASoC: %s not registered\n", aux_dev->codec_name);
1560fb099cb7SMark Brown 
1561b19e6e7bSMark Brown 	return -EPROBE_DEFER;
1562b19e6e7bSMark Brown }
1563b19e6e7bSMark Brown 
15642eea392dSJarkko Nikula static int soc_probe_aux_dev(struct snd_soc_card *card, int num)
15652eea392dSJarkko Nikula {
15662eea392dSJarkko Nikula 	struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
15672eea392dSJarkko Nikula 	struct snd_soc_codec *codec;
1568676ad98aSJarkko Nikula 	int ret = -ENODEV;
15692eea392dSJarkko Nikula 
15702eea392dSJarkko Nikula 	/* find CODEC from registered CODECs*/
15712eea392dSJarkko Nikula 	list_for_each_entry(codec, &codec_list, list) {
15722eea392dSJarkko Nikula 		if (!strcmp(codec->name, aux_dev->codec_name)) {
15732eea392dSJarkko Nikula 			if (codec->probed) {
15742eea392dSJarkko Nikula 				dev_err(codec->dev,
1575f110bfc7SLiam Girdwood 					"ASoC: codec already probed");
15762eea392dSJarkko Nikula 				ret = -EBUSY;
15772eea392dSJarkko Nikula 				goto out;
15782eea392dSJarkko Nikula 			}
1579676ad98aSJarkko Nikula 			goto found;
15802eea392dSJarkko Nikula 		}
15812eea392dSJarkko Nikula 	}
1582676ad98aSJarkko Nikula 	/* codec not found */
1583f110bfc7SLiam Girdwood 	dev_err(card->dev, "ASoC: codec %s not found", aux_dev->codec_name);
1584b19e6e7bSMark Brown 	return -EPROBE_DEFER;
15852eea392dSJarkko Nikula 
1586676ad98aSJarkko Nikula found:
1587589c3563SJarkko Nikula 	ret = soc_probe_codec(card, codec);
15882eea392dSJarkko Nikula 	if (ret < 0)
1589589c3563SJarkko Nikula 		return ret;
15902eea392dSJarkko Nikula 
1591589c3563SJarkko Nikula 	ret = soc_post_component_init(card, codec, num, 1);
15922eea392dSJarkko Nikula 
15932eea392dSJarkko Nikula out:
15942eea392dSJarkko Nikula 	return ret;
15952eea392dSJarkko Nikula }
15962eea392dSJarkko Nikula 
15972eea392dSJarkko Nikula static void soc_remove_aux_dev(struct snd_soc_card *card, int num)
15982eea392dSJarkko Nikula {
15992eea392dSJarkko Nikula 	struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
16002eea392dSJarkko Nikula 	struct snd_soc_codec *codec = rtd->codec;
16012eea392dSJarkko Nikula 
16022eea392dSJarkko Nikula 	/* unregister the rtd device */
16032eea392dSJarkko Nikula 	if (rtd->dev_registered) {
160436ae1a96SMark Brown 		device_remove_file(rtd->dev, &dev_attr_codec_reg);
1605d3bf1561SChuansheng Liu 		device_unregister(rtd->dev);
16062eea392dSJarkko Nikula 		rtd->dev_registered = 0;
16072eea392dSJarkko Nikula 	}
16082eea392dSJarkko Nikula 
1609589c3563SJarkko Nikula 	if (codec && codec->probed)
1610589c3563SJarkko Nikula 		soc_remove_codec(codec);
16112eea392dSJarkko Nikula }
16122eea392dSJarkko Nikula 
1613f90fb3f7SLars-Peter Clausen static int snd_soc_init_codec_cache(struct snd_soc_codec *codec)
1614fdf0f54dSDimitris Papastamos {
1615fdf0f54dSDimitris Papastamos 	int ret;
1616fdf0f54dSDimitris Papastamos 
1617fdf0f54dSDimitris Papastamos 	if (codec->cache_init)
1618fdf0f54dSDimitris Papastamos 		return 0;
1619fdf0f54dSDimitris Papastamos 
1620fdf0f54dSDimitris Papastamos 	ret = snd_soc_cache_init(codec);
1621fdf0f54dSDimitris Papastamos 	if (ret < 0) {
162210e8aa9aSMichał Mirosław 		dev_err(codec->dev,
162310e8aa9aSMichał Mirosław 			"ASoC: Failed to set cache compression type: %d\n",
162410e8aa9aSMichał Mirosław 			ret);
1625fdf0f54dSDimitris Papastamos 		return ret;
1626fdf0f54dSDimitris Papastamos 	}
1627fdf0f54dSDimitris Papastamos 	codec->cache_init = 1;
1628fdf0f54dSDimitris Papastamos 	return 0;
1629fdf0f54dSDimitris Papastamos }
1630fdf0f54dSDimitris Papastamos 
1631b19e6e7bSMark Brown static int snd_soc_instantiate_card(struct snd_soc_card *card)
1632f0fba2adSLiam Girdwood {
1633fdf0f54dSDimitris Papastamos 	struct snd_soc_codec *codec;
163475d9ac46SMark Brown 	struct snd_soc_dai_link *dai_link;
1635f04209a7SMark Brown 	int ret, i, order, dai_fmt;
163696dd3622SMark Brown 
163701b9d99aSLiam Girdwood 	mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_INIT);
1638f0fba2adSLiam Girdwood 
1639b19e6e7bSMark Brown 	/* bind DAIs */
1640b19e6e7bSMark Brown 	for (i = 0; i < card->num_links; i++) {
1641b19e6e7bSMark Brown 		ret = soc_bind_dai_link(card, i);
1642b19e6e7bSMark Brown 		if (ret != 0)
1643b19e6e7bSMark Brown 			goto base_error;
1644db2a4165SFrank Mandarino 	}
1645db2a4165SFrank Mandarino 
1646b19e6e7bSMark Brown 	/* check aux_devs too */
1647b19e6e7bSMark Brown 	for (i = 0; i < card->num_aux_devs; i++) {
1648b19e6e7bSMark Brown 		ret = soc_check_aux_dev(card, i);
1649b19e6e7bSMark Brown 		if (ret != 0)
1650b19e6e7bSMark Brown 			goto base_error;
1651db2a4165SFrank Mandarino 	}
1652db2a4165SFrank Mandarino 
1653fdf0f54dSDimitris Papastamos 	/* initialize the register cache for each available codec */
1654fdf0f54dSDimitris Papastamos 	list_for_each_entry(codec, &codec_list, list) {
1655fdf0f54dSDimitris Papastamos 		if (codec->cache_init)
1656fdf0f54dSDimitris Papastamos 			continue;
1657f90fb3f7SLars-Peter Clausen 		ret = snd_soc_init_codec_cache(codec);
1658b19e6e7bSMark Brown 		if (ret < 0)
1659b19e6e7bSMark Brown 			goto base_error;
1660fdf0f54dSDimitris Papastamos 	}
1661fdf0f54dSDimitris Papastamos 
1662f0fba2adSLiam Girdwood 	/* card bind complete so register a sound card */
1663f0fba2adSLiam Girdwood 	ret = snd_card_create(SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
1664f0fba2adSLiam Girdwood 			card->owner, 0, &card->snd_card);
1665f0fba2adSLiam Girdwood 	if (ret < 0) {
166610e8aa9aSMichał Mirosław 		dev_err(card->dev,
166710e8aa9aSMichał Mirosław 			"ASoC: can't create sound card for card %s: %d\n",
166810e8aa9aSMichał Mirosław 			card->name, ret);
1669b19e6e7bSMark Brown 		goto base_error;
1670db2a4165SFrank Mandarino 	}
1671f0fba2adSLiam Girdwood 	card->snd_card->dev = card->dev;
1672db2a4165SFrank Mandarino 
1673e37a4970SMark Brown 	card->dapm.bias_level = SND_SOC_BIAS_OFF;
1674e37a4970SMark Brown 	card->dapm.dev = card->dev;
1675e37a4970SMark Brown 	card->dapm.card = card;
1676e37a4970SMark Brown 	list_add(&card->dapm.list, &card->dapm_list);
1677e37a4970SMark Brown 
1678d5d1e0beSLars-Peter Clausen #ifdef CONFIG_DEBUG_FS
1679d5d1e0beSLars-Peter Clausen 	snd_soc_dapm_debugfs_init(&card->dapm, card->debugfs_card_root);
1680d5d1e0beSLars-Peter Clausen #endif
1681d5d1e0beSLars-Peter Clausen 
168288ee1c61SMark Brown #ifdef CONFIG_PM_SLEEP
16836ed25978SAndy Green 	/* deferred resume work */
16846308419aSMark Brown 	INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
16851301a964SRandy Dunlap #endif
16866ed25978SAndy Green 
16879a841ebbSMark Brown 	if (card->dapm_widgets)
16889a841ebbSMark Brown 		snd_soc_dapm_new_controls(&card->dapm, card->dapm_widgets,
16899a841ebbSMark Brown 					  card->num_dapm_widgets);
16909a841ebbSMark Brown 
1691f0fba2adSLiam Girdwood 	/* initialise the sound card only once */
1692f0fba2adSLiam Girdwood 	if (card->probe) {
1693e7361ec4SMark Brown 		ret = card->probe(card);
1694f0fba2adSLiam Girdwood 		if (ret < 0)
1695f0fba2adSLiam Girdwood 			goto card_probe_error;
1696f0fba2adSLiam Girdwood 	}
1697f0fba2adSLiam Girdwood 
169862ae68faSStephen Warren 	/* probe all components used by DAI links on this card */
16990168bf0dSLiam Girdwood 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
17000168bf0dSLiam Girdwood 			order++) {
1701fe3e78e0SMark Brown 		for (i = 0; i < card->num_links; i++) {
170262ae68faSStephen Warren 			ret = soc_probe_link_components(card, i, order);
170362ae68faSStephen Warren 			if (ret < 0) {
1704f110bfc7SLiam Girdwood 				dev_err(card->dev,
1705f110bfc7SLiam Girdwood 					"ASoC: failed to instantiate card %d\n",
1706f110bfc7SLiam Girdwood 					ret);
170762ae68faSStephen Warren 				goto probe_dai_err;
170862ae68faSStephen Warren 			}
170962ae68faSStephen Warren 		}
171062ae68faSStephen Warren 	}
171162ae68faSStephen Warren 
171262ae68faSStephen Warren 	/* probe all DAI links on this card */
171362ae68faSStephen Warren 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
171462ae68faSStephen Warren 			order++) {
171562ae68faSStephen Warren 		for (i = 0; i < card->num_links; i++) {
171662ae68faSStephen Warren 			ret = soc_probe_link_dais(card, i, order);
1717fe3e78e0SMark Brown 			if (ret < 0) {
1718f110bfc7SLiam Girdwood 				dev_err(card->dev,
1719f110bfc7SLiam Girdwood 					"ASoC: failed to instantiate card %d\n",
1720f110bfc7SLiam Girdwood 					ret);
1721f0fba2adSLiam Girdwood 				goto probe_dai_err;
1722fe3e78e0SMark Brown 			}
1723fe3e78e0SMark Brown 		}
17240168bf0dSLiam Girdwood 	}
1725fe3e78e0SMark Brown 
17262eea392dSJarkko Nikula 	for (i = 0; i < card->num_aux_devs; i++) {
17272eea392dSJarkko Nikula 		ret = soc_probe_aux_dev(card, i);
17282eea392dSJarkko Nikula 		if (ret < 0) {
1729f110bfc7SLiam Girdwood 			dev_err(card->dev,
1730f110bfc7SLiam Girdwood 				"ASoC: failed to add auxiliary devices %d\n",
1731f110bfc7SLiam Girdwood 				ret);
17322eea392dSJarkko Nikula 			goto probe_aux_dev_err;
17332eea392dSJarkko Nikula 		}
17342eea392dSJarkko Nikula 	}
17352eea392dSJarkko Nikula 
1736888df395SMark Brown 	snd_soc_dapm_link_dai_widgets(card);
1737b893ea5fSLiam Girdwood 	snd_soc_dapm_connect_dai_link_widgets(card);
1738888df395SMark Brown 
1739b7af1dafSMark Brown 	if (card->controls)
1740022658beSLiam Girdwood 		snd_soc_add_card_controls(card, card->controls, card->num_controls);
1741b7af1dafSMark Brown 
1742b8ad29deSMark Brown 	if (card->dapm_routes)
1743b8ad29deSMark Brown 		snd_soc_dapm_add_routes(&card->dapm, card->dapm_routes,
1744b8ad29deSMark Brown 					card->num_dapm_routes);
1745b8ad29deSMark Brown 
174675d9ac46SMark Brown 	for (i = 0; i < card->num_links; i++) {
174775d9ac46SMark Brown 		dai_link = &card->dai_link[i];
1748f04209a7SMark Brown 		dai_fmt = dai_link->dai_fmt;
174975d9ac46SMark Brown 
1750f04209a7SMark Brown 		if (dai_fmt) {
175175d9ac46SMark Brown 			ret = snd_soc_dai_set_fmt(card->rtd[i].codec_dai,
1752f04209a7SMark Brown 						  dai_fmt);
17535e4ba569SShawn Guo 			if (ret != 0 && ret != -ENOTSUPP)
175475d9ac46SMark Brown 				dev_warn(card->rtd[i].codec_dai->dev,
1755f110bfc7SLiam Girdwood 					 "ASoC: Failed to set DAI format: %d\n",
175675d9ac46SMark Brown 					 ret);
1757f04209a7SMark Brown 		}
1758f04209a7SMark Brown 
1759f04209a7SMark Brown 		/* If this is a regular CPU link there will be a platform */
1760fe33d4c5SStephen Warren 		if (dai_fmt &&
1761fe33d4c5SStephen Warren 		    (dai_link->platform_name || dai_link->platform_of_node)) {
1762f04209a7SMark Brown 			ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai,
1763f04209a7SMark Brown 						  dai_fmt);
1764f04209a7SMark Brown 			if (ret != 0 && ret != -ENOTSUPP)
1765f04209a7SMark Brown 				dev_warn(card->rtd[i].cpu_dai->dev,
1766f110bfc7SLiam Girdwood 					 "ASoC: Failed to set DAI format: %d\n",
1767f04209a7SMark Brown 					 ret);
1768f04209a7SMark Brown 		} else if (dai_fmt) {
1769f04209a7SMark Brown 			/* Flip the polarity for the "CPU" end */
1770f04209a7SMark Brown 			dai_fmt &= ~SND_SOC_DAIFMT_MASTER_MASK;
1771f04209a7SMark Brown 			switch (dai_link->dai_fmt &
1772f04209a7SMark Brown 				SND_SOC_DAIFMT_MASTER_MASK) {
1773f04209a7SMark Brown 			case SND_SOC_DAIFMT_CBM_CFM:
1774f04209a7SMark Brown 				dai_fmt |= SND_SOC_DAIFMT_CBS_CFS;
1775f04209a7SMark Brown 				break;
1776f04209a7SMark Brown 			case SND_SOC_DAIFMT_CBM_CFS:
1777f04209a7SMark Brown 				dai_fmt |= SND_SOC_DAIFMT_CBS_CFM;
1778f04209a7SMark Brown 				break;
1779f04209a7SMark Brown 			case SND_SOC_DAIFMT_CBS_CFM:
1780f04209a7SMark Brown 				dai_fmt |= SND_SOC_DAIFMT_CBM_CFS;
1781f04209a7SMark Brown 				break;
1782f04209a7SMark Brown 			case SND_SOC_DAIFMT_CBS_CFS:
1783f04209a7SMark Brown 				dai_fmt |= SND_SOC_DAIFMT_CBM_CFM;
1784f04209a7SMark Brown 				break;
1785f04209a7SMark Brown 			}
178675d9ac46SMark Brown 
178775d9ac46SMark Brown 			ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai,
1788f04209a7SMark Brown 						  dai_fmt);
17895e4ba569SShawn Guo 			if (ret != 0 && ret != -ENOTSUPP)
179075d9ac46SMark Brown 				dev_warn(card->rtd[i].cpu_dai->dev,
1791f110bfc7SLiam Girdwood 					 "ASoC: Failed to set DAI format: %d\n",
179275d9ac46SMark Brown 					 ret);
179375d9ac46SMark Brown 		}
179475d9ac46SMark Brown 	}
179575d9ac46SMark Brown 
1796f0fba2adSLiam Girdwood 	snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname),
1797fe3e78e0SMark Brown 		 "%s", card->name);
1798f0fba2adSLiam Girdwood 	snprintf(card->snd_card->longname, sizeof(card->snd_card->longname),
179922de71baSLiam Girdwood 		 "%s", card->long_name ? card->long_name : card->name);
1800f0e8ed85SMark Brown 	snprintf(card->snd_card->driver, sizeof(card->snd_card->driver),
1801f0e8ed85SMark Brown 		 "%s", card->driver_name ? card->driver_name : card->name);
1802f0e8ed85SMark Brown 	for (i = 0; i < ARRAY_SIZE(card->snd_card->driver); i++) {
1803f0e8ed85SMark Brown 		switch (card->snd_card->driver[i]) {
1804f0e8ed85SMark Brown 		case '_':
1805f0e8ed85SMark Brown 		case '-':
1806f0e8ed85SMark Brown 		case '\0':
1807f0e8ed85SMark Brown 			break;
1808f0e8ed85SMark Brown 		default:
1809f0e8ed85SMark Brown 			if (!isalnum(card->snd_card->driver[i]))
1810f0e8ed85SMark Brown 				card->snd_card->driver[i] = '_';
1811f0e8ed85SMark Brown 			break;
1812f0e8ed85SMark Brown 		}
1813f0e8ed85SMark Brown 	}
1814fe3e78e0SMark Brown 
181528e9ad92SMark Brown 	if (card->late_probe) {
181628e9ad92SMark Brown 		ret = card->late_probe(card);
181728e9ad92SMark Brown 		if (ret < 0) {
1818f110bfc7SLiam Girdwood 			dev_err(card->dev, "ASoC: %s late_probe() failed: %d\n",
181928e9ad92SMark Brown 				card->name, ret);
182028e9ad92SMark Brown 			goto probe_aux_dev_err;
182128e9ad92SMark Brown 		}
182228e9ad92SMark Brown 	}
182328e9ad92SMark Brown 
18241633281bSStephen Warren 	if (card->fully_routed)
1825b05d8dc1SMark Brown 		list_for_each_entry(codec, &card->codec_dev_list, card_list)
18261633281bSStephen Warren 			snd_soc_dapm_auto_nc_codec_pins(codec);
18271633281bSStephen Warren 
1828824ef826SLars-Peter Clausen 	snd_soc_dapm_new_widgets(card);
18298c193b8dSLars-Peter Clausen 
1830f0fba2adSLiam Girdwood 	ret = snd_card_register(card->snd_card);
1831fe3e78e0SMark Brown 	if (ret < 0) {
1832f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: failed to register soundcard %d\n",
1833f110bfc7SLiam Girdwood 				ret);
18346b3ed785SAxel Lin 		goto probe_aux_dev_err;
1835fe3e78e0SMark Brown 	}
1836fe3e78e0SMark Brown 
1837fe3e78e0SMark Brown #ifdef CONFIG_SND_SOC_AC97_BUS
1838f0fba2adSLiam Girdwood 	/* register any AC97 codecs */
1839f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
1840f0fba2adSLiam Girdwood 		ret = soc_register_ac97_dai_link(&card->rtd[i]);
1841fe3e78e0SMark Brown 		if (ret < 0) {
184210e8aa9aSMichał Mirosław 			dev_err(card->dev,
184310e8aa9aSMichał Mirosław 				"ASoC: failed to register AC97: %d\n", ret);
18446b3ed785SAxel Lin 			while (--i >= 0)
18457d8316dfSMark Brown 				soc_unregister_ac97_dai_link(card->rtd[i].codec);
18466b3ed785SAxel Lin 			goto probe_aux_dev_err;
1847fe3e78e0SMark Brown 		}
1848fe3e78e0SMark Brown 	}
1849fe3e78e0SMark Brown #endif
1850fe3e78e0SMark Brown 
1851435c5e25SMark Brown 	card->instantiated = 1;
18524f4c0072SMark Brown 	snd_soc_dapm_sync(&card->dapm);
1853f0fba2adSLiam Girdwood 	mutex_unlock(&card->mutex);
1854b19e6e7bSMark Brown 
1855b19e6e7bSMark Brown 	return 0;
1856db2a4165SFrank Mandarino 
18572eea392dSJarkko Nikula probe_aux_dev_err:
18582eea392dSJarkko Nikula 	for (i = 0; i < card->num_aux_devs; i++)
18592eea392dSJarkko Nikula 		soc_remove_aux_dev(card, i);
18602eea392dSJarkko Nikula 
1861f0fba2adSLiam Girdwood probe_dai_err:
18620671fd8eSKuninori Morimoto 	soc_remove_dai_links(card);
1863fe3e78e0SMark Brown 
1864f0fba2adSLiam Girdwood card_probe_error:
186587506549SMark Brown 	if (card->remove)
1866e7361ec4SMark Brown 		card->remove(card);
1867f0fba2adSLiam Girdwood 
1868f0fba2adSLiam Girdwood 	snd_card_free(card->snd_card);
1869f0fba2adSLiam Girdwood 
1870b19e6e7bSMark Brown base_error:
1871f0fba2adSLiam Girdwood 	mutex_unlock(&card->mutex);
1872db2a4165SFrank Mandarino 
1873b19e6e7bSMark Brown 	return ret;
1874435c5e25SMark Brown }
1875435c5e25SMark Brown 
1876435c5e25SMark Brown /* probes a new socdev */
1877435c5e25SMark Brown static int soc_probe(struct platform_device *pdev)
1878435c5e25SMark Brown {
1879f0fba2adSLiam Girdwood 	struct snd_soc_card *card = platform_get_drvdata(pdev);
1880435c5e25SMark Brown 
188170a7ca34SVinod Koul 	/*
188270a7ca34SVinod Koul 	 * no card, so machine driver should be registering card
188370a7ca34SVinod Koul 	 * we should not be here in that case so ret error
188470a7ca34SVinod Koul 	 */
188570a7ca34SVinod Koul 	if (!card)
188670a7ca34SVinod Koul 		return -EINVAL;
188770a7ca34SVinod Koul 
1888fe4085e8SMark Brown 	dev_warn(&pdev->dev,
1889f110bfc7SLiam Girdwood 		 "ASoC: machine %s should use snd_soc_register_card()\n",
1890fe4085e8SMark Brown 		 card->name);
1891fe4085e8SMark Brown 
1892435c5e25SMark Brown 	/* Bodge while we unpick instantiation */
1893435c5e25SMark Brown 	card->dev = &pdev->dev;
1894f0fba2adSLiam Girdwood 
189528d528c8SMark Brown 	return snd_soc_register_card(card);
1896435c5e25SMark Brown }
1897435c5e25SMark Brown 
1898b0e26485SVinod Koul static int soc_cleanup_card_resources(struct snd_soc_card *card)
1899db2a4165SFrank Mandarino {
1900db2a4165SFrank Mandarino 	int i;
1901db2a4165SFrank Mandarino 
1902f0fba2adSLiam Girdwood 	/* make sure any delayed work runs */
1903f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
1904f0fba2adSLiam Girdwood 		struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
190543829731STejun Heo 		flush_delayed_work(&rtd->delayed_work);
1906db2a4165SFrank Mandarino 	}
1907db2a4165SFrank Mandarino 
19082eea392dSJarkko Nikula 	/* remove auxiliary devices */
19092eea392dSJarkko Nikula 	for (i = 0; i < card->num_aux_devs; i++)
19102eea392dSJarkko Nikula 		soc_remove_aux_dev(card, i);
19112eea392dSJarkko Nikula 
1912f0fba2adSLiam Girdwood 	/* remove and free each DAI */
19130671fd8eSKuninori Morimoto 	soc_remove_dai_links(card);
1914f0fba2adSLiam Girdwood 
1915a6052154SJarkko Nikula 	soc_cleanup_card_debugfs(card);
1916a6052154SJarkko Nikula 
1917f0fba2adSLiam Girdwood 	/* remove the card */
191887506549SMark Brown 	if (card->remove)
1919e7361ec4SMark Brown 		card->remove(card);
1920f0fba2adSLiam Girdwood 
19210aaae527SLars-Peter Clausen 	snd_soc_dapm_free(&card->dapm);
19220aaae527SLars-Peter Clausen 
1923f0fba2adSLiam Girdwood 	snd_card_free(card->snd_card);
1924b0e26485SVinod Koul 	return 0;
1925b0e26485SVinod Koul 
1926b2dfa62cSGuennadi Liakhovetski }
1927b0e26485SVinod Koul 
1928b0e26485SVinod Koul /* removes a socdev */
1929b0e26485SVinod Koul static int soc_remove(struct platform_device *pdev)
1930b0e26485SVinod Koul {
1931b0e26485SVinod Koul 	struct snd_soc_card *card = platform_get_drvdata(pdev);
1932b0e26485SVinod Koul 
1933c5af3a2eSMark Brown 	snd_soc_unregister_card(card);
1934db2a4165SFrank Mandarino 	return 0;
1935db2a4165SFrank Mandarino }
1936db2a4165SFrank Mandarino 
19376f8ab4acSMark Brown int snd_soc_poweroff(struct device *dev)
193851737470SMark Brown {
19396f8ab4acSMark Brown 	struct snd_soc_card *card = dev_get_drvdata(dev);
1940f0fba2adSLiam Girdwood 	int i;
194151737470SMark Brown 
194251737470SMark Brown 	if (!card->instantiated)
1943416356fcSMark Brown 		return 0;
194451737470SMark Brown 
194551737470SMark Brown 	/* Flush out pmdown_time work - we actually do want to run it
194651737470SMark Brown 	 * now, we're shutting down so no imminent restart. */
1947f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
1948f0fba2adSLiam Girdwood 		struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
194943829731STejun Heo 		flush_delayed_work(&rtd->delayed_work);
1950f0fba2adSLiam Girdwood 	}
195151737470SMark Brown 
1952f0fba2adSLiam Girdwood 	snd_soc_dapm_shutdown(card);
1953416356fcSMark Brown 
1954988e8cc4SNicolin Chen 	/* deactivate pins to sleep state */
1955988e8cc4SNicolin Chen 	for (i = 0; i < card->num_rtd; i++) {
1956988e8cc4SNicolin Chen 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1957988e8cc4SNicolin Chen 		struct snd_soc_dai *codec_dai = card->rtd[i].codec_dai;
1958988e8cc4SNicolin Chen 		pinctrl_pm_select_sleep_state(codec_dai->dev);
1959988e8cc4SNicolin Chen 		pinctrl_pm_select_sleep_state(cpu_dai->dev);
1960988e8cc4SNicolin Chen 	}
1961988e8cc4SNicolin Chen 
1962416356fcSMark Brown 	return 0;
196351737470SMark Brown }
19646f8ab4acSMark Brown EXPORT_SYMBOL_GPL(snd_soc_poweroff);
196551737470SMark Brown 
19666f8ab4acSMark Brown const struct dev_pm_ops snd_soc_pm_ops = {
1967b1dd5897SViresh Kumar 	.suspend = snd_soc_suspend,
1968b1dd5897SViresh Kumar 	.resume = snd_soc_resume,
1969b1dd5897SViresh Kumar 	.freeze = snd_soc_suspend,
1970b1dd5897SViresh Kumar 	.thaw = snd_soc_resume,
19716f8ab4acSMark Brown 	.poweroff = snd_soc_poweroff,
1972b1dd5897SViresh Kumar 	.restore = snd_soc_resume,
1973416356fcSMark Brown };
1974deb2607eSStephen Warren EXPORT_SYMBOL_GPL(snd_soc_pm_ops);
1975416356fcSMark Brown 
1976db2a4165SFrank Mandarino /* ASoC platform driver */
1977db2a4165SFrank Mandarino static struct platform_driver soc_driver = {
1978db2a4165SFrank Mandarino 	.driver		= {
1979db2a4165SFrank Mandarino 		.name		= "soc-audio",
19808b45a209SKay Sievers 		.owner		= THIS_MODULE,
19816f8ab4acSMark Brown 		.pm		= &snd_soc_pm_ops,
1982db2a4165SFrank Mandarino 	},
1983db2a4165SFrank Mandarino 	.probe		= soc_probe,
1984db2a4165SFrank Mandarino 	.remove		= soc_remove,
1985db2a4165SFrank Mandarino };
1986db2a4165SFrank Mandarino 
1987096e49d5SMark Brown /**
1988096e49d5SMark Brown  * snd_soc_codec_volatile_register: Report if a register is volatile.
1989096e49d5SMark Brown  *
1990096e49d5SMark Brown  * @codec: CODEC to query.
1991096e49d5SMark Brown  * @reg: Register to query.
1992096e49d5SMark Brown  *
1993096e49d5SMark Brown  * Boolean function indiciating if a CODEC register is volatile.
1994096e49d5SMark Brown  */
1995181e055eSMark Brown int snd_soc_codec_volatile_register(struct snd_soc_codec *codec,
1996181e055eSMark Brown 				    unsigned int reg)
1997096e49d5SMark Brown {
19981500b7b5SDimitris Papastamos 	if (codec->volatile_register)
19991500b7b5SDimitris Papastamos 		return codec->volatile_register(codec, reg);
2000096e49d5SMark Brown 	else
2001096e49d5SMark Brown 		return 0;
2002096e49d5SMark Brown }
2003096e49d5SMark Brown EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register);
2004096e49d5SMark Brown 
2005db2a4165SFrank Mandarino /**
2006239c9706SDimitris Papastamos  * snd_soc_codec_readable_register: Report if a register is readable.
2007239c9706SDimitris Papastamos  *
2008239c9706SDimitris Papastamos  * @codec: CODEC to query.
2009239c9706SDimitris Papastamos  * @reg: Register to query.
2010239c9706SDimitris Papastamos  *
2011239c9706SDimitris Papastamos  * Boolean function indicating if a CODEC register is readable.
2012239c9706SDimitris Papastamos  */
2013239c9706SDimitris Papastamos int snd_soc_codec_readable_register(struct snd_soc_codec *codec,
2014239c9706SDimitris Papastamos 				    unsigned int reg)
2015239c9706SDimitris Papastamos {
2016239c9706SDimitris Papastamos 	if (codec->readable_register)
2017239c9706SDimitris Papastamos 		return codec->readable_register(codec, reg);
2018239c9706SDimitris Papastamos 	else
201963fa0a28SLars-Peter Clausen 		return 1;
2020239c9706SDimitris Papastamos }
2021239c9706SDimitris Papastamos EXPORT_SYMBOL_GPL(snd_soc_codec_readable_register);
2022239c9706SDimitris Papastamos 
2023239c9706SDimitris Papastamos /**
2024239c9706SDimitris Papastamos  * snd_soc_codec_writable_register: Report if a register is writable.
2025239c9706SDimitris Papastamos  *
2026239c9706SDimitris Papastamos  * @codec: CODEC to query.
2027239c9706SDimitris Papastamos  * @reg: Register to query.
2028239c9706SDimitris Papastamos  *
2029239c9706SDimitris Papastamos  * Boolean function indicating if a CODEC register is writable.
2030239c9706SDimitris Papastamos  */
2031239c9706SDimitris Papastamos int snd_soc_codec_writable_register(struct snd_soc_codec *codec,
2032239c9706SDimitris Papastamos 				    unsigned int reg)
2033239c9706SDimitris Papastamos {
2034239c9706SDimitris Papastamos 	if (codec->writable_register)
2035239c9706SDimitris Papastamos 		return codec->writable_register(codec, reg);
2036239c9706SDimitris Papastamos 	else
203763fa0a28SLars-Peter Clausen 		return 1;
2038239c9706SDimitris Papastamos }
2039239c9706SDimitris Papastamos EXPORT_SYMBOL_GPL(snd_soc_codec_writable_register);
2040239c9706SDimitris Papastamos 
2041f1442bc1SLiam Girdwood int snd_soc_platform_read(struct snd_soc_platform *platform,
2042f1442bc1SLiam Girdwood 					unsigned int reg)
2043f1442bc1SLiam Girdwood {
2044f1442bc1SLiam Girdwood 	unsigned int ret;
2045f1442bc1SLiam Girdwood 
2046f1442bc1SLiam Girdwood 	if (!platform->driver->read) {
2047f110bfc7SLiam Girdwood 		dev_err(platform->dev, "ASoC: platform has no read back\n");
2048f1442bc1SLiam Girdwood 		return -1;
2049f1442bc1SLiam Girdwood 	}
2050f1442bc1SLiam Girdwood 
2051f1442bc1SLiam Girdwood 	ret = platform->driver->read(platform, reg);
2052f1442bc1SLiam Girdwood 	dev_dbg(platform->dev, "read %x => %x\n", reg, ret);
2053a82ce2aeSLiam Girdwood 	trace_snd_soc_preg_read(platform, reg, ret);
2054f1442bc1SLiam Girdwood 
2055f1442bc1SLiam Girdwood 	return ret;
2056f1442bc1SLiam Girdwood }
2057f1442bc1SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_platform_read);
2058f1442bc1SLiam Girdwood 
2059f1442bc1SLiam Girdwood int snd_soc_platform_write(struct snd_soc_platform *platform,
2060f1442bc1SLiam Girdwood 					 unsigned int reg, unsigned int val)
2061f1442bc1SLiam Girdwood {
2062f1442bc1SLiam Girdwood 	if (!platform->driver->write) {
2063f110bfc7SLiam Girdwood 		dev_err(platform->dev, "ASoC: platform has no write back\n");
2064f1442bc1SLiam Girdwood 		return -1;
2065f1442bc1SLiam Girdwood 	}
2066f1442bc1SLiam Girdwood 
2067f1442bc1SLiam Girdwood 	dev_dbg(platform->dev, "write %x = %x\n", reg, val);
2068a82ce2aeSLiam Girdwood 	trace_snd_soc_preg_write(platform, reg, val);
2069f1442bc1SLiam Girdwood 	return platform->driver->write(platform, reg, val);
2070f1442bc1SLiam Girdwood }
2071f1442bc1SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_platform_write);
2072f1442bc1SLiam Girdwood 
2073239c9706SDimitris Papastamos /**
2074db2a4165SFrank Mandarino  * snd_soc_new_ac97_codec - initailise AC97 device
2075db2a4165SFrank Mandarino  * @codec: audio codec
2076db2a4165SFrank Mandarino  * @ops: AC97 bus operations
2077db2a4165SFrank Mandarino  * @num: AC97 codec number
2078db2a4165SFrank Mandarino  *
2079db2a4165SFrank Mandarino  * Initialises AC97 codec resources for use by ad-hoc devices only.
2080db2a4165SFrank Mandarino  */
2081db2a4165SFrank Mandarino int snd_soc_new_ac97_codec(struct snd_soc_codec *codec,
2082db2a4165SFrank Mandarino 	struct snd_ac97_bus_ops *ops, int num)
2083db2a4165SFrank Mandarino {
2084db2a4165SFrank Mandarino 	mutex_lock(&codec->mutex);
2085db2a4165SFrank Mandarino 
2086db2a4165SFrank Mandarino 	codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL);
2087db2a4165SFrank Mandarino 	if (codec->ac97 == NULL) {
2088db2a4165SFrank Mandarino 		mutex_unlock(&codec->mutex);
2089db2a4165SFrank Mandarino 		return -ENOMEM;
2090db2a4165SFrank Mandarino 	}
2091db2a4165SFrank Mandarino 
2092db2a4165SFrank Mandarino 	codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL);
2093db2a4165SFrank Mandarino 	if (codec->ac97->bus == NULL) {
2094db2a4165SFrank Mandarino 		kfree(codec->ac97);
2095db2a4165SFrank Mandarino 		codec->ac97 = NULL;
2096db2a4165SFrank Mandarino 		mutex_unlock(&codec->mutex);
2097db2a4165SFrank Mandarino 		return -ENOMEM;
2098db2a4165SFrank Mandarino 	}
2099db2a4165SFrank Mandarino 
2100db2a4165SFrank Mandarino 	codec->ac97->bus->ops = ops;
2101db2a4165SFrank Mandarino 	codec->ac97->num = num;
21020562f788SMika Westerberg 
21030562f788SMika Westerberg 	/*
21040562f788SMika Westerberg 	 * Mark the AC97 device to be created by us. This way we ensure that the
21050562f788SMika Westerberg 	 * device will be registered with the device subsystem later on.
21060562f788SMika Westerberg 	 */
21070562f788SMika Westerberg 	codec->ac97_created = 1;
21080562f788SMika Westerberg 
2109db2a4165SFrank Mandarino 	mutex_unlock(&codec->mutex);
2110db2a4165SFrank Mandarino 	return 0;
2111db2a4165SFrank Mandarino }
2112db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec);
2113db2a4165SFrank Mandarino 
2114741a509fSMarkus Pargmann static struct snd_ac97_reset_cfg snd_ac97_rst_cfg;
2115741a509fSMarkus Pargmann 
2116741a509fSMarkus Pargmann static void snd_soc_ac97_warm_reset(struct snd_ac97 *ac97)
2117741a509fSMarkus Pargmann {
2118741a509fSMarkus Pargmann 	struct pinctrl *pctl = snd_ac97_rst_cfg.pctl;
2119741a509fSMarkus Pargmann 
2120741a509fSMarkus Pargmann 	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_warm_reset);
2121741a509fSMarkus Pargmann 
2122741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 1);
2123741a509fSMarkus Pargmann 
2124741a509fSMarkus Pargmann 	udelay(10);
2125741a509fSMarkus Pargmann 
2126741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 0);
2127741a509fSMarkus Pargmann 
2128741a509fSMarkus Pargmann 	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_run);
2129741a509fSMarkus Pargmann 	msleep(2);
2130741a509fSMarkus Pargmann }
2131741a509fSMarkus Pargmann 
2132741a509fSMarkus Pargmann static void snd_soc_ac97_reset(struct snd_ac97 *ac97)
2133741a509fSMarkus Pargmann {
2134741a509fSMarkus Pargmann 	struct pinctrl *pctl = snd_ac97_rst_cfg.pctl;
2135741a509fSMarkus Pargmann 
2136741a509fSMarkus Pargmann 	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_reset);
2137741a509fSMarkus Pargmann 
2138741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 0);
2139741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_sdata, 0);
2140741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_reset, 0);
2141741a509fSMarkus Pargmann 
2142741a509fSMarkus Pargmann 	udelay(10);
2143741a509fSMarkus Pargmann 
2144741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_reset, 1);
2145741a509fSMarkus Pargmann 
2146741a509fSMarkus Pargmann 	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_run);
2147741a509fSMarkus Pargmann 	msleep(2);
2148741a509fSMarkus Pargmann }
2149741a509fSMarkus Pargmann 
2150741a509fSMarkus Pargmann static int snd_soc_ac97_parse_pinctl(struct device *dev,
2151741a509fSMarkus Pargmann 		struct snd_ac97_reset_cfg *cfg)
2152741a509fSMarkus Pargmann {
2153741a509fSMarkus Pargmann 	struct pinctrl *p;
2154741a509fSMarkus Pargmann 	struct pinctrl_state *state;
2155741a509fSMarkus Pargmann 	int gpio;
2156741a509fSMarkus Pargmann 	int ret;
2157741a509fSMarkus Pargmann 
2158741a509fSMarkus Pargmann 	p = devm_pinctrl_get(dev);
2159741a509fSMarkus Pargmann 	if (IS_ERR(p)) {
2160741a509fSMarkus Pargmann 		dev_err(dev, "Failed to get pinctrl\n");
2161741a509fSMarkus Pargmann 		return PTR_RET(p);
2162741a509fSMarkus Pargmann 	}
2163741a509fSMarkus Pargmann 	cfg->pctl = p;
2164741a509fSMarkus Pargmann 
2165741a509fSMarkus Pargmann 	state = pinctrl_lookup_state(p, "ac97-reset");
2166741a509fSMarkus Pargmann 	if (IS_ERR(state)) {
2167741a509fSMarkus Pargmann 		dev_err(dev, "Can't find pinctrl state ac97-reset\n");
2168741a509fSMarkus Pargmann 		return PTR_RET(state);
2169741a509fSMarkus Pargmann 	}
2170741a509fSMarkus Pargmann 	cfg->pstate_reset = state;
2171741a509fSMarkus Pargmann 
2172741a509fSMarkus Pargmann 	state = pinctrl_lookup_state(p, "ac97-warm-reset");
2173741a509fSMarkus Pargmann 	if (IS_ERR(state)) {
2174741a509fSMarkus Pargmann 		dev_err(dev, "Can't find pinctrl state ac97-warm-reset\n");
2175741a509fSMarkus Pargmann 		return PTR_RET(state);
2176741a509fSMarkus Pargmann 	}
2177741a509fSMarkus Pargmann 	cfg->pstate_warm_reset = state;
2178741a509fSMarkus Pargmann 
2179741a509fSMarkus Pargmann 	state = pinctrl_lookup_state(p, "ac97-running");
2180741a509fSMarkus Pargmann 	if (IS_ERR(state)) {
2181741a509fSMarkus Pargmann 		dev_err(dev, "Can't find pinctrl state ac97-running\n");
2182741a509fSMarkus Pargmann 		return PTR_RET(state);
2183741a509fSMarkus Pargmann 	}
2184741a509fSMarkus Pargmann 	cfg->pstate_run = state;
2185741a509fSMarkus Pargmann 
2186741a509fSMarkus Pargmann 	gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 0);
2187741a509fSMarkus Pargmann 	if (gpio < 0) {
2188741a509fSMarkus Pargmann 		dev_err(dev, "Can't find ac97-sync gpio\n");
2189741a509fSMarkus Pargmann 		return gpio;
2190741a509fSMarkus Pargmann 	}
2191741a509fSMarkus Pargmann 	ret = devm_gpio_request(dev, gpio, "AC97 link sync");
2192741a509fSMarkus Pargmann 	if (ret) {
2193741a509fSMarkus Pargmann 		dev_err(dev, "Failed requesting ac97-sync gpio\n");
2194741a509fSMarkus Pargmann 		return ret;
2195741a509fSMarkus Pargmann 	}
2196741a509fSMarkus Pargmann 	cfg->gpio_sync = gpio;
2197741a509fSMarkus Pargmann 
2198741a509fSMarkus Pargmann 	gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 1);
2199741a509fSMarkus Pargmann 	if (gpio < 0) {
2200741a509fSMarkus Pargmann 		dev_err(dev, "Can't find ac97-sdata gpio %d\n", gpio);
2201741a509fSMarkus Pargmann 		return gpio;
2202741a509fSMarkus Pargmann 	}
2203741a509fSMarkus Pargmann 	ret = devm_gpio_request(dev, gpio, "AC97 link sdata");
2204741a509fSMarkus Pargmann 	if (ret) {
2205741a509fSMarkus Pargmann 		dev_err(dev, "Failed requesting ac97-sdata gpio\n");
2206741a509fSMarkus Pargmann 		return ret;
2207741a509fSMarkus Pargmann 	}
2208741a509fSMarkus Pargmann 	cfg->gpio_sdata = gpio;
2209741a509fSMarkus Pargmann 
2210741a509fSMarkus Pargmann 	gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 2);
2211741a509fSMarkus Pargmann 	if (gpio < 0) {
2212741a509fSMarkus Pargmann 		dev_err(dev, "Can't find ac97-reset gpio\n");
2213741a509fSMarkus Pargmann 		return gpio;
2214741a509fSMarkus Pargmann 	}
2215741a509fSMarkus Pargmann 	ret = devm_gpio_request(dev, gpio, "AC97 link reset");
2216741a509fSMarkus Pargmann 	if (ret) {
2217741a509fSMarkus Pargmann 		dev_err(dev, "Failed requesting ac97-reset gpio\n");
2218741a509fSMarkus Pargmann 		return ret;
2219741a509fSMarkus Pargmann 	}
2220741a509fSMarkus Pargmann 	cfg->gpio_reset = gpio;
2221741a509fSMarkus Pargmann 
2222741a509fSMarkus Pargmann 	return 0;
2223741a509fSMarkus Pargmann }
2224741a509fSMarkus Pargmann 
2225b047e1ccSMark Brown struct snd_ac97_bus_ops *soc_ac97_ops;
2226f74b5e25SKevin Hilman EXPORT_SYMBOL_GPL(soc_ac97_ops);
2227b047e1ccSMark Brown 
2228b047e1ccSMark Brown int snd_soc_set_ac97_ops(struct snd_ac97_bus_ops *ops)
2229b047e1ccSMark Brown {
2230b047e1ccSMark Brown 	if (ops == soc_ac97_ops)
2231b047e1ccSMark Brown 		return 0;
2232b047e1ccSMark Brown 
2233b047e1ccSMark Brown 	if (soc_ac97_ops && ops)
2234b047e1ccSMark Brown 		return -EBUSY;
2235b047e1ccSMark Brown 
2236b047e1ccSMark Brown 	soc_ac97_ops = ops;
2237b047e1ccSMark Brown 
2238b047e1ccSMark Brown 	return 0;
2239b047e1ccSMark Brown }
2240b047e1ccSMark Brown EXPORT_SYMBOL_GPL(snd_soc_set_ac97_ops);
2241b047e1ccSMark Brown 
2242db2a4165SFrank Mandarino /**
2243741a509fSMarkus Pargmann  * snd_soc_set_ac97_ops_of_reset - Set ac97 ops with generic ac97 reset functions
2244741a509fSMarkus Pargmann  *
2245741a509fSMarkus Pargmann  * This function sets the reset and warm_reset properties of ops and parses
2246741a509fSMarkus Pargmann  * the device node of pdev to get pinctrl states and gpio numbers to use.
2247741a509fSMarkus Pargmann  */
2248741a509fSMarkus Pargmann int snd_soc_set_ac97_ops_of_reset(struct snd_ac97_bus_ops *ops,
2249741a509fSMarkus Pargmann 		struct platform_device *pdev)
2250741a509fSMarkus Pargmann {
2251741a509fSMarkus Pargmann 	struct device *dev = &pdev->dev;
2252741a509fSMarkus Pargmann 	struct snd_ac97_reset_cfg cfg;
2253741a509fSMarkus Pargmann 	int ret;
2254741a509fSMarkus Pargmann 
2255741a509fSMarkus Pargmann 	ret = snd_soc_ac97_parse_pinctl(dev, &cfg);
2256741a509fSMarkus Pargmann 	if (ret)
2257741a509fSMarkus Pargmann 		return ret;
2258741a509fSMarkus Pargmann 
2259741a509fSMarkus Pargmann 	ret = snd_soc_set_ac97_ops(ops);
2260741a509fSMarkus Pargmann 	if (ret)
2261741a509fSMarkus Pargmann 		return ret;
2262741a509fSMarkus Pargmann 
2263741a509fSMarkus Pargmann 	ops->warm_reset = snd_soc_ac97_warm_reset;
2264741a509fSMarkus Pargmann 	ops->reset = snd_soc_ac97_reset;
2265741a509fSMarkus Pargmann 
2266741a509fSMarkus Pargmann 	snd_ac97_rst_cfg = cfg;
2267741a509fSMarkus Pargmann 	return 0;
2268741a509fSMarkus Pargmann }
2269741a509fSMarkus Pargmann EXPORT_SYMBOL_GPL(snd_soc_set_ac97_ops_of_reset);
2270741a509fSMarkus Pargmann 
2271741a509fSMarkus Pargmann /**
2272db2a4165SFrank Mandarino  * snd_soc_free_ac97_codec - free AC97 codec device
2273db2a4165SFrank Mandarino  * @codec: audio codec
2274db2a4165SFrank Mandarino  *
2275db2a4165SFrank Mandarino  * Frees AC97 codec device resources.
2276db2a4165SFrank Mandarino  */
2277db2a4165SFrank Mandarino void snd_soc_free_ac97_codec(struct snd_soc_codec *codec)
2278db2a4165SFrank Mandarino {
2279db2a4165SFrank Mandarino 	mutex_lock(&codec->mutex);
2280f0fba2adSLiam Girdwood #ifdef CONFIG_SND_SOC_AC97_BUS
2281f0fba2adSLiam Girdwood 	soc_unregister_ac97_dai_link(codec);
2282f0fba2adSLiam Girdwood #endif
2283db2a4165SFrank Mandarino 	kfree(codec->ac97->bus);
2284db2a4165SFrank Mandarino 	kfree(codec->ac97);
2285db2a4165SFrank Mandarino 	codec->ac97 = NULL;
22860562f788SMika Westerberg 	codec->ac97_created = 0;
2287db2a4165SFrank Mandarino 	mutex_unlock(&codec->mutex);
2288db2a4165SFrank Mandarino }
2289db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec);
2290db2a4165SFrank Mandarino 
2291c3753707SMark Brown unsigned int snd_soc_read(struct snd_soc_codec *codec, unsigned int reg)
2292c3753707SMark Brown {
2293c3753707SMark Brown 	unsigned int ret;
2294c3753707SMark Brown 
2295c3acec26SMark Brown 	ret = codec->read(codec, reg);
2296c3753707SMark Brown 	dev_dbg(codec->dev, "read %x => %x\n", reg, ret);
2297a8b1d34fSMark Brown 	trace_snd_soc_reg_read(codec, reg, ret);
2298c3753707SMark Brown 
2299c3753707SMark Brown 	return ret;
2300c3753707SMark Brown }
2301c3753707SMark Brown EXPORT_SYMBOL_GPL(snd_soc_read);
2302c3753707SMark Brown 
2303c3753707SMark Brown unsigned int snd_soc_write(struct snd_soc_codec *codec,
2304c3753707SMark Brown 			   unsigned int reg, unsigned int val)
2305c3753707SMark Brown {
2306c3753707SMark Brown 	dev_dbg(codec->dev, "write %x = %x\n", reg, val);
2307a8b1d34fSMark Brown 	trace_snd_soc_reg_write(codec, reg, val);
2308c3acec26SMark Brown 	return codec->write(codec, reg, val);
2309c3753707SMark Brown }
2310c3753707SMark Brown EXPORT_SYMBOL_GPL(snd_soc_write);
2311c3753707SMark Brown 
2312db2a4165SFrank Mandarino /**
2313db2a4165SFrank Mandarino  * snd_soc_update_bits - update codec register bits
2314db2a4165SFrank Mandarino  * @codec: audio codec
2315db2a4165SFrank Mandarino  * @reg: codec register
2316db2a4165SFrank Mandarino  * @mask: register mask
2317db2a4165SFrank Mandarino  * @value: new value
2318db2a4165SFrank Mandarino  *
2319db2a4165SFrank Mandarino  * Writes new register value.
2320db2a4165SFrank Mandarino  *
2321180c329dSTimur Tabi  * Returns 1 for change, 0 for no change, or negative error code.
2322db2a4165SFrank Mandarino  */
2323db2a4165SFrank Mandarino int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg,
232446f5822fSDaniel Ribeiro 				unsigned int mask, unsigned int value)
2325db2a4165SFrank Mandarino {
23268a713da8SMark Brown 	bool change;
232746f5822fSDaniel Ribeiro 	unsigned int old, new;
2328180c329dSTimur Tabi 	int ret;
2329db2a4165SFrank Mandarino 
23308a713da8SMark Brown 	if (codec->using_regmap) {
23318a713da8SMark Brown 		ret = regmap_update_bits_check(codec->control_data, reg,
23328a713da8SMark Brown 					       mask, value, &change);
23338a713da8SMark Brown 	} else {
2334180c329dSTimur Tabi 		ret = snd_soc_read(codec, reg);
2335180c329dSTimur Tabi 		if (ret < 0)
2336180c329dSTimur Tabi 			return ret;
2337180c329dSTimur Tabi 
2338180c329dSTimur Tabi 		old = ret;
233978bf3c9aSMark Brown 		new = (old & ~mask) | (value & mask);
2340db2a4165SFrank Mandarino 		change = old != new;
23418a713da8SMark Brown 		if (change)
2342180c329dSTimur Tabi 			ret = snd_soc_write(codec, reg, new);
23438a713da8SMark Brown 	}
23448a713da8SMark Brown 
2345180c329dSTimur Tabi 	if (ret < 0)
2346180c329dSTimur Tabi 		return ret;
2347db2a4165SFrank Mandarino 
2348db2a4165SFrank Mandarino 	return change;
2349db2a4165SFrank Mandarino }
2350db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_update_bits);
2351db2a4165SFrank Mandarino 
2352db2a4165SFrank Mandarino /**
23536c508c62SEero Nurkkala  * snd_soc_update_bits_locked - update codec register bits
23546c508c62SEero Nurkkala  * @codec: audio codec
23556c508c62SEero Nurkkala  * @reg: codec register
23566c508c62SEero Nurkkala  * @mask: register mask
23576c508c62SEero Nurkkala  * @value: new value
23586c508c62SEero Nurkkala  *
23596c508c62SEero Nurkkala  * Writes new register value, and takes the codec mutex.
23606c508c62SEero Nurkkala  *
23616c508c62SEero Nurkkala  * Returns 1 for change else 0.
23626c508c62SEero Nurkkala  */
2363dd1b3d53SMark Brown int snd_soc_update_bits_locked(struct snd_soc_codec *codec,
23646c508c62SEero Nurkkala 			       unsigned short reg, unsigned int mask,
23656c508c62SEero Nurkkala 			       unsigned int value)
23666c508c62SEero Nurkkala {
23676c508c62SEero Nurkkala 	int change;
23686c508c62SEero Nurkkala 
23696c508c62SEero Nurkkala 	mutex_lock(&codec->mutex);
23706c508c62SEero Nurkkala 	change = snd_soc_update_bits(codec, reg, mask, value);
23716c508c62SEero Nurkkala 	mutex_unlock(&codec->mutex);
23726c508c62SEero Nurkkala 
23736c508c62SEero Nurkkala 	return change;
23746c508c62SEero Nurkkala }
2375dd1b3d53SMark Brown EXPORT_SYMBOL_GPL(snd_soc_update_bits_locked);
23766c508c62SEero Nurkkala 
23776c508c62SEero Nurkkala /**
2378db2a4165SFrank Mandarino  * snd_soc_test_bits - test register for change
2379db2a4165SFrank Mandarino  * @codec: audio codec
2380db2a4165SFrank Mandarino  * @reg: codec register
2381db2a4165SFrank Mandarino  * @mask: register mask
2382db2a4165SFrank Mandarino  * @value: new value
2383db2a4165SFrank Mandarino  *
2384db2a4165SFrank Mandarino  * Tests a register with a new value and checks if the new value is
2385db2a4165SFrank Mandarino  * different from the old value.
2386db2a4165SFrank Mandarino  *
2387db2a4165SFrank Mandarino  * Returns 1 for change else 0.
2388db2a4165SFrank Mandarino  */
2389db2a4165SFrank Mandarino int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg,
239046f5822fSDaniel Ribeiro 				unsigned int mask, unsigned int value)
2391db2a4165SFrank Mandarino {
2392db2a4165SFrank Mandarino 	int change;
239346f5822fSDaniel Ribeiro 	unsigned int old, new;
2394db2a4165SFrank Mandarino 
2395db2a4165SFrank Mandarino 	old = snd_soc_read(codec, reg);
2396db2a4165SFrank Mandarino 	new = (old & ~mask) | value;
2397db2a4165SFrank Mandarino 	change = old != new;
2398db2a4165SFrank Mandarino 
2399db2a4165SFrank Mandarino 	return change;
2400db2a4165SFrank Mandarino }
2401db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_test_bits);
2402db2a4165SFrank Mandarino 
2403db2a4165SFrank Mandarino /**
2404db2a4165SFrank Mandarino  * snd_soc_cnew - create new control
2405db2a4165SFrank Mandarino  * @_template: control template
2406db2a4165SFrank Mandarino  * @data: control private data
2407ac11a2b3SMark Brown  * @long_name: control long name
2408efb7ac3fSMark Brown  * @prefix: control name prefix
2409db2a4165SFrank Mandarino  *
2410db2a4165SFrank Mandarino  * Create a new mixer control from a template control.
2411db2a4165SFrank Mandarino  *
2412db2a4165SFrank Mandarino  * Returns 0 for success, else error.
2413db2a4165SFrank Mandarino  */
2414db2a4165SFrank Mandarino struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
24153056557fSMark Brown 				  void *data, const char *long_name,
2416efb7ac3fSMark Brown 				  const char *prefix)
2417db2a4165SFrank Mandarino {
2418db2a4165SFrank Mandarino 	struct snd_kcontrol_new template;
2419efb7ac3fSMark Brown 	struct snd_kcontrol *kcontrol;
2420efb7ac3fSMark Brown 	char *name = NULL;
2421db2a4165SFrank Mandarino 
2422db2a4165SFrank Mandarino 	memcpy(&template, _template, sizeof(template));
2423db2a4165SFrank Mandarino 	template.index = 0;
2424db2a4165SFrank Mandarino 
2425efb7ac3fSMark Brown 	if (!long_name)
2426efb7ac3fSMark Brown 		long_name = template.name;
2427efb7ac3fSMark Brown 
2428efb7ac3fSMark Brown 	if (prefix) {
24292b581074SLars-Peter Clausen 		name = kasprintf(GFP_KERNEL, "%s %s", prefix, long_name);
2430efb7ac3fSMark Brown 		if (!name)
2431efb7ac3fSMark Brown 			return NULL;
2432efb7ac3fSMark Brown 
2433efb7ac3fSMark Brown 		template.name = name;
2434efb7ac3fSMark Brown 	} else {
2435efb7ac3fSMark Brown 		template.name = long_name;
2436efb7ac3fSMark Brown 	}
2437efb7ac3fSMark Brown 
2438efb7ac3fSMark Brown 	kcontrol = snd_ctl_new1(&template, data);
2439efb7ac3fSMark Brown 
2440efb7ac3fSMark Brown 	kfree(name);
2441efb7ac3fSMark Brown 
2442efb7ac3fSMark Brown 	return kcontrol;
2443db2a4165SFrank Mandarino }
2444db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_cnew);
2445db2a4165SFrank Mandarino 
2446022658beSLiam Girdwood static int snd_soc_add_controls(struct snd_card *card, struct device *dev,
2447022658beSLiam Girdwood 	const struct snd_kcontrol_new *controls, int num_controls,
2448022658beSLiam Girdwood 	const char *prefix, void *data)
2449022658beSLiam Girdwood {
2450022658beSLiam Girdwood 	int err, i;
2451022658beSLiam Girdwood 
2452022658beSLiam Girdwood 	for (i = 0; i < num_controls; i++) {
2453022658beSLiam Girdwood 		const struct snd_kcontrol_new *control = &controls[i];
2454022658beSLiam Girdwood 		err = snd_ctl_add(card, snd_soc_cnew(control, data,
2455022658beSLiam Girdwood 						     control->name, prefix));
2456022658beSLiam Girdwood 		if (err < 0) {
2457f110bfc7SLiam Girdwood 			dev_err(dev, "ASoC: Failed to add %s: %d\n",
2458f110bfc7SLiam Girdwood 				control->name, err);
2459022658beSLiam Girdwood 			return err;
2460022658beSLiam Girdwood 		}
2461022658beSLiam Girdwood 	}
2462022658beSLiam Girdwood 
2463022658beSLiam Girdwood 	return 0;
2464022658beSLiam Girdwood }
2465022658beSLiam Girdwood 
24664fefd698SDimitris Papastamos struct snd_kcontrol *snd_soc_card_get_kcontrol(struct snd_soc_card *soc_card,
24674fefd698SDimitris Papastamos 					       const char *name)
24684fefd698SDimitris Papastamos {
24694fefd698SDimitris Papastamos 	struct snd_card *card = soc_card->snd_card;
24704fefd698SDimitris Papastamos 	struct snd_kcontrol *kctl;
24714fefd698SDimitris Papastamos 
24724fefd698SDimitris Papastamos 	if (unlikely(!name))
24734fefd698SDimitris Papastamos 		return NULL;
24744fefd698SDimitris Papastamos 
24754fefd698SDimitris Papastamos 	list_for_each_entry(kctl, &card->controls, list)
24764fefd698SDimitris Papastamos 		if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name)))
24774fefd698SDimitris Papastamos 			return kctl;
24784fefd698SDimitris Papastamos 	return NULL;
24794fefd698SDimitris Papastamos }
24804fefd698SDimitris Papastamos EXPORT_SYMBOL_GPL(snd_soc_card_get_kcontrol);
24814fefd698SDimitris Papastamos 
2482db2a4165SFrank Mandarino /**
2483022658beSLiam Girdwood  * snd_soc_add_codec_controls - add an array of controls to a codec.
2484022658beSLiam Girdwood  * Convenience function to add a list of controls. Many codecs were
24853e8e1952SIan Molton  * duplicating this code.
24863e8e1952SIan Molton  *
24873e8e1952SIan Molton  * @codec: codec to add controls to
24883e8e1952SIan Molton  * @controls: array of controls to add
24893e8e1952SIan Molton  * @num_controls: number of elements in the array
24903e8e1952SIan Molton  *
24913e8e1952SIan Molton  * Return 0 for success, else error.
24923e8e1952SIan Molton  */
2493022658beSLiam Girdwood int snd_soc_add_codec_controls(struct snd_soc_codec *codec,
24943e8e1952SIan Molton 	const struct snd_kcontrol_new *controls, int num_controls)
24953e8e1952SIan Molton {
2496f0fba2adSLiam Girdwood 	struct snd_card *card = codec->card->snd_card;
24973e8e1952SIan Molton 
2498022658beSLiam Girdwood 	return snd_soc_add_controls(card, codec->dev, controls, num_controls,
2499022658beSLiam Girdwood 			codec->name_prefix, codec);
25003e8e1952SIan Molton }
2501022658beSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_add_codec_controls);
25023e8e1952SIan Molton 
25033e8e1952SIan Molton /**
2504a491a5c8SLiam Girdwood  * snd_soc_add_platform_controls - add an array of controls to a platform.
2505022658beSLiam Girdwood  * Convenience function to add a list of controls.
2506a491a5c8SLiam Girdwood  *
2507a491a5c8SLiam Girdwood  * @platform: platform to add controls to
2508a491a5c8SLiam Girdwood  * @controls: array of controls to add
2509a491a5c8SLiam Girdwood  * @num_controls: number of elements in the array
2510a491a5c8SLiam Girdwood  *
2511a491a5c8SLiam Girdwood  * Return 0 for success, else error.
2512a491a5c8SLiam Girdwood  */
2513a491a5c8SLiam Girdwood int snd_soc_add_platform_controls(struct snd_soc_platform *platform,
2514a491a5c8SLiam Girdwood 	const struct snd_kcontrol_new *controls, int num_controls)
2515a491a5c8SLiam Girdwood {
2516a491a5c8SLiam Girdwood 	struct snd_card *card = platform->card->snd_card;
2517a491a5c8SLiam Girdwood 
2518022658beSLiam Girdwood 	return snd_soc_add_controls(card, platform->dev, controls, num_controls,
2519022658beSLiam Girdwood 			NULL, platform);
2520a491a5c8SLiam Girdwood }
2521a491a5c8SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_add_platform_controls);
2522a491a5c8SLiam Girdwood 
2523a491a5c8SLiam Girdwood /**
2524022658beSLiam Girdwood  * snd_soc_add_card_controls - add an array of controls to a SoC card.
2525022658beSLiam Girdwood  * Convenience function to add a list of controls.
2526022658beSLiam Girdwood  *
2527022658beSLiam Girdwood  * @soc_card: SoC card to add controls to
2528022658beSLiam Girdwood  * @controls: array of controls to add
2529022658beSLiam Girdwood  * @num_controls: number of elements in the array
2530022658beSLiam Girdwood  *
2531022658beSLiam Girdwood  * Return 0 for success, else error.
2532022658beSLiam Girdwood  */
2533022658beSLiam Girdwood int snd_soc_add_card_controls(struct snd_soc_card *soc_card,
2534022658beSLiam Girdwood 	const struct snd_kcontrol_new *controls, int num_controls)
2535022658beSLiam Girdwood {
2536022658beSLiam Girdwood 	struct snd_card *card = soc_card->snd_card;
2537022658beSLiam Girdwood 
2538022658beSLiam Girdwood 	return snd_soc_add_controls(card, soc_card->dev, controls, num_controls,
2539022658beSLiam Girdwood 			NULL, soc_card);
2540022658beSLiam Girdwood }
2541022658beSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_add_card_controls);
2542022658beSLiam Girdwood 
2543022658beSLiam Girdwood /**
2544022658beSLiam Girdwood  * snd_soc_add_dai_controls - add an array of controls to a DAI.
2545022658beSLiam Girdwood  * Convienience function to add a list of controls.
2546022658beSLiam Girdwood  *
2547022658beSLiam Girdwood  * @dai: DAI to add controls to
2548022658beSLiam Girdwood  * @controls: array of controls to add
2549022658beSLiam Girdwood  * @num_controls: number of elements in the array
2550022658beSLiam Girdwood  *
2551022658beSLiam Girdwood  * Return 0 for success, else error.
2552022658beSLiam Girdwood  */
2553022658beSLiam Girdwood int snd_soc_add_dai_controls(struct snd_soc_dai *dai,
2554022658beSLiam Girdwood 	const struct snd_kcontrol_new *controls, int num_controls)
2555022658beSLiam Girdwood {
2556022658beSLiam Girdwood 	struct snd_card *card = dai->card->snd_card;
2557022658beSLiam Girdwood 
2558022658beSLiam Girdwood 	return snd_soc_add_controls(card, dai->dev, controls, num_controls,
2559022658beSLiam Girdwood 			NULL, dai);
2560022658beSLiam Girdwood }
2561022658beSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_add_dai_controls);
2562022658beSLiam Girdwood 
2563022658beSLiam Girdwood /**
2564db2a4165SFrank Mandarino  * snd_soc_info_enum_double - enumerated double mixer info callback
2565db2a4165SFrank Mandarino  * @kcontrol: mixer control
2566db2a4165SFrank Mandarino  * @uinfo: control element information
2567db2a4165SFrank Mandarino  *
2568db2a4165SFrank Mandarino  * Callback to provide information about a double enumerated
2569db2a4165SFrank Mandarino  * mixer control.
2570db2a4165SFrank Mandarino  *
2571db2a4165SFrank Mandarino  * Returns 0 for success.
2572db2a4165SFrank Mandarino  */
2573db2a4165SFrank Mandarino int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol,
2574db2a4165SFrank Mandarino 	struct snd_ctl_elem_info *uinfo)
2575db2a4165SFrank Mandarino {
2576db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2577db2a4165SFrank Mandarino 
2578db2a4165SFrank Mandarino 	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2579db2a4165SFrank Mandarino 	uinfo->count = e->shift_l == e->shift_r ? 1 : 2;
2580f8ba0b7bSJon Smirl 	uinfo->value.enumerated.items = e->max;
2581db2a4165SFrank Mandarino 
2582f8ba0b7bSJon Smirl 	if (uinfo->value.enumerated.item > e->max - 1)
2583f8ba0b7bSJon Smirl 		uinfo->value.enumerated.item = e->max - 1;
2584a19685cbSTakashi Iwai 	strlcpy(uinfo->value.enumerated.name,
2585a19685cbSTakashi Iwai 		e->texts[uinfo->value.enumerated.item],
2586a19685cbSTakashi Iwai 		sizeof(uinfo->value.enumerated.name));
2587db2a4165SFrank Mandarino 	return 0;
2588db2a4165SFrank Mandarino }
2589db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
2590db2a4165SFrank Mandarino 
2591db2a4165SFrank Mandarino /**
2592db2a4165SFrank Mandarino  * snd_soc_get_enum_double - enumerated double mixer get callback
2593db2a4165SFrank Mandarino  * @kcontrol: mixer control
2594ac11a2b3SMark Brown  * @ucontrol: control element information
2595db2a4165SFrank Mandarino  *
2596db2a4165SFrank Mandarino  * Callback to get the value of a double enumerated mixer.
2597db2a4165SFrank Mandarino  *
2598db2a4165SFrank Mandarino  * Returns 0 for success.
2599db2a4165SFrank Mandarino  */
2600db2a4165SFrank Mandarino int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol,
2601db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
2602db2a4165SFrank Mandarino {
2603db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2604db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
260586767b7dSLars-Peter Clausen 	unsigned int val;
2606db2a4165SFrank Mandarino 
2607db2a4165SFrank Mandarino 	val = snd_soc_read(codec, e->reg);
26083ff3f64bSMark Brown 	ucontrol->value.enumerated.item[0]
260986767b7dSLars-Peter Clausen 		= (val >> e->shift_l) & e->mask;
2610db2a4165SFrank Mandarino 	if (e->shift_l != e->shift_r)
2611db2a4165SFrank Mandarino 		ucontrol->value.enumerated.item[1] =
261286767b7dSLars-Peter Clausen 			(val >> e->shift_r) & e->mask;
2613db2a4165SFrank Mandarino 
2614db2a4165SFrank Mandarino 	return 0;
2615db2a4165SFrank Mandarino }
2616db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
2617db2a4165SFrank Mandarino 
2618db2a4165SFrank Mandarino /**
2619db2a4165SFrank Mandarino  * snd_soc_put_enum_double - enumerated double mixer put callback
2620db2a4165SFrank Mandarino  * @kcontrol: mixer control
2621ac11a2b3SMark Brown  * @ucontrol: control element information
2622db2a4165SFrank Mandarino  *
2623db2a4165SFrank Mandarino  * Callback to set the value of a double enumerated mixer.
2624db2a4165SFrank Mandarino  *
2625db2a4165SFrank Mandarino  * Returns 0 for success.
2626db2a4165SFrank Mandarino  */
2627db2a4165SFrank Mandarino int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol,
2628db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
2629db2a4165SFrank Mandarino {
2630db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2631db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
263246f5822fSDaniel Ribeiro 	unsigned int val;
263386767b7dSLars-Peter Clausen 	unsigned int mask;
2634db2a4165SFrank Mandarino 
2635f8ba0b7bSJon Smirl 	if (ucontrol->value.enumerated.item[0] > e->max - 1)
2636db2a4165SFrank Mandarino 		return -EINVAL;
2637db2a4165SFrank Mandarino 	val = ucontrol->value.enumerated.item[0] << e->shift_l;
263886767b7dSLars-Peter Clausen 	mask = e->mask << e->shift_l;
2639db2a4165SFrank Mandarino 	if (e->shift_l != e->shift_r) {
2640f8ba0b7bSJon Smirl 		if (ucontrol->value.enumerated.item[1] > e->max - 1)
2641db2a4165SFrank Mandarino 			return -EINVAL;
2642db2a4165SFrank Mandarino 		val |= ucontrol->value.enumerated.item[1] << e->shift_r;
264386767b7dSLars-Peter Clausen 		mask |= e->mask << e->shift_r;
2644db2a4165SFrank Mandarino 	}
2645db2a4165SFrank Mandarino 
26466c508c62SEero Nurkkala 	return snd_soc_update_bits_locked(codec, e->reg, mask, val);
2647db2a4165SFrank Mandarino }
2648db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
2649db2a4165SFrank Mandarino 
2650db2a4165SFrank Mandarino /**
26512e72f8e3SPeter Ujfalusi  * snd_soc_get_value_enum_double - semi enumerated double mixer get callback
26522e72f8e3SPeter Ujfalusi  * @kcontrol: mixer control
26532e72f8e3SPeter Ujfalusi  * @ucontrol: control element information
26542e72f8e3SPeter Ujfalusi  *
26552e72f8e3SPeter Ujfalusi  * Callback to get the value of a double semi enumerated mixer.
26562e72f8e3SPeter Ujfalusi  *
26572e72f8e3SPeter Ujfalusi  * Semi enumerated mixer: the enumerated items are referred as values. Can be
26582e72f8e3SPeter Ujfalusi  * used for handling bitfield coded enumeration for example.
26592e72f8e3SPeter Ujfalusi  *
26602e72f8e3SPeter Ujfalusi  * Returns 0 for success.
26612e72f8e3SPeter Ujfalusi  */
26622e72f8e3SPeter Ujfalusi int snd_soc_get_value_enum_double(struct snd_kcontrol *kcontrol,
26632e72f8e3SPeter Ujfalusi 	struct snd_ctl_elem_value *ucontrol)
26642e72f8e3SPeter Ujfalusi {
26652e72f8e3SPeter Ujfalusi 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
266674155556SPeter Ujfalusi 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
266746f5822fSDaniel Ribeiro 	unsigned int reg_val, val, mux;
26682e72f8e3SPeter Ujfalusi 
26692e72f8e3SPeter Ujfalusi 	reg_val = snd_soc_read(codec, e->reg);
26702e72f8e3SPeter Ujfalusi 	val = (reg_val >> e->shift_l) & e->mask;
26712e72f8e3SPeter Ujfalusi 	for (mux = 0; mux < e->max; mux++) {
26722e72f8e3SPeter Ujfalusi 		if (val == e->values[mux])
26732e72f8e3SPeter Ujfalusi 			break;
26742e72f8e3SPeter Ujfalusi 	}
26752e72f8e3SPeter Ujfalusi 	ucontrol->value.enumerated.item[0] = mux;
26762e72f8e3SPeter Ujfalusi 	if (e->shift_l != e->shift_r) {
26772e72f8e3SPeter Ujfalusi 		val = (reg_val >> e->shift_r) & e->mask;
26782e72f8e3SPeter Ujfalusi 		for (mux = 0; mux < e->max; mux++) {
26792e72f8e3SPeter Ujfalusi 			if (val == e->values[mux])
26802e72f8e3SPeter Ujfalusi 				break;
26812e72f8e3SPeter Ujfalusi 		}
26822e72f8e3SPeter Ujfalusi 		ucontrol->value.enumerated.item[1] = mux;
26832e72f8e3SPeter Ujfalusi 	}
26842e72f8e3SPeter Ujfalusi 
26852e72f8e3SPeter Ujfalusi 	return 0;
26862e72f8e3SPeter Ujfalusi }
26872e72f8e3SPeter Ujfalusi EXPORT_SYMBOL_GPL(snd_soc_get_value_enum_double);
26882e72f8e3SPeter Ujfalusi 
26892e72f8e3SPeter Ujfalusi /**
26902e72f8e3SPeter Ujfalusi  * snd_soc_put_value_enum_double - semi enumerated double mixer put callback
26912e72f8e3SPeter Ujfalusi  * @kcontrol: mixer control
26922e72f8e3SPeter Ujfalusi  * @ucontrol: control element information
26932e72f8e3SPeter Ujfalusi  *
26942e72f8e3SPeter Ujfalusi  * Callback to set the value of a double semi enumerated mixer.
26952e72f8e3SPeter Ujfalusi  *
26962e72f8e3SPeter Ujfalusi  * Semi enumerated mixer: the enumerated items are referred as values. Can be
26972e72f8e3SPeter Ujfalusi  * used for handling bitfield coded enumeration for example.
26982e72f8e3SPeter Ujfalusi  *
26992e72f8e3SPeter Ujfalusi  * Returns 0 for success.
27002e72f8e3SPeter Ujfalusi  */
27012e72f8e3SPeter Ujfalusi int snd_soc_put_value_enum_double(struct snd_kcontrol *kcontrol,
27022e72f8e3SPeter Ujfalusi 	struct snd_ctl_elem_value *ucontrol)
27032e72f8e3SPeter Ujfalusi {
27042e72f8e3SPeter Ujfalusi 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
270574155556SPeter Ujfalusi 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
270646f5822fSDaniel Ribeiro 	unsigned int val;
270746f5822fSDaniel Ribeiro 	unsigned int mask;
27082e72f8e3SPeter Ujfalusi 
27092e72f8e3SPeter Ujfalusi 	if (ucontrol->value.enumerated.item[0] > e->max - 1)
27102e72f8e3SPeter Ujfalusi 		return -EINVAL;
27112e72f8e3SPeter Ujfalusi 	val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
27122e72f8e3SPeter Ujfalusi 	mask = e->mask << e->shift_l;
27132e72f8e3SPeter Ujfalusi 	if (e->shift_l != e->shift_r) {
27142e72f8e3SPeter Ujfalusi 		if (ucontrol->value.enumerated.item[1] > e->max - 1)
27152e72f8e3SPeter Ujfalusi 			return -EINVAL;
27162e72f8e3SPeter Ujfalusi 		val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
27172e72f8e3SPeter Ujfalusi 		mask |= e->mask << e->shift_r;
27182e72f8e3SPeter Ujfalusi 	}
27192e72f8e3SPeter Ujfalusi 
27206c508c62SEero Nurkkala 	return snd_soc_update_bits_locked(codec, e->reg, mask, val);
27212e72f8e3SPeter Ujfalusi }
27222e72f8e3SPeter Ujfalusi EXPORT_SYMBOL_GPL(snd_soc_put_value_enum_double);
27232e72f8e3SPeter Ujfalusi 
27242e72f8e3SPeter Ujfalusi /**
2725f227b88fSMarkus Pargmann  * snd_soc_read_signed - Read a codec register and interprete as signed value
2726f227b88fSMarkus Pargmann  * @codec: codec
2727f227b88fSMarkus Pargmann  * @reg: Register to read
2728f227b88fSMarkus Pargmann  * @mask: Mask to use after shifting the register value
2729f227b88fSMarkus Pargmann  * @shift: Right shift of register value
2730f227b88fSMarkus Pargmann  * @sign_bit: Bit that describes if a number is negative or not.
2731f227b88fSMarkus Pargmann  *
2732f227b88fSMarkus Pargmann  * This functions reads a codec register. The register value is shifted right
2733f227b88fSMarkus Pargmann  * by 'shift' bits and masked with the given 'mask'. Afterwards it translates
2734f227b88fSMarkus Pargmann  * the given registervalue into a signed integer if sign_bit is non-zero.
2735f227b88fSMarkus Pargmann  *
2736f227b88fSMarkus Pargmann  * Returns the register value as signed int.
2737f227b88fSMarkus Pargmann  */
2738f227b88fSMarkus Pargmann static int snd_soc_read_signed(struct snd_soc_codec *codec, unsigned int reg,
2739f227b88fSMarkus Pargmann 		unsigned int mask, unsigned int shift, unsigned int sign_bit)
2740f227b88fSMarkus Pargmann {
2741f227b88fSMarkus Pargmann 	int ret;
2742f227b88fSMarkus Pargmann 	unsigned int val;
2743f227b88fSMarkus Pargmann 
2744f227b88fSMarkus Pargmann 	val = (snd_soc_read(codec, reg) >> shift) & mask;
2745f227b88fSMarkus Pargmann 
2746f227b88fSMarkus Pargmann 	if (!sign_bit)
2747f227b88fSMarkus Pargmann 		return val;
2748f227b88fSMarkus Pargmann 
2749f227b88fSMarkus Pargmann 	/* non-negative number */
2750f227b88fSMarkus Pargmann 	if (!(val & BIT(sign_bit)))
2751f227b88fSMarkus Pargmann 		return val;
2752f227b88fSMarkus Pargmann 
2753f227b88fSMarkus Pargmann 	ret = val;
2754f227b88fSMarkus Pargmann 
2755f227b88fSMarkus Pargmann 	/*
2756f227b88fSMarkus Pargmann 	 * The register most probably does not contain a full-sized int.
2757f227b88fSMarkus Pargmann 	 * Instead we have an arbitrary number of bits in a signed
2758f227b88fSMarkus Pargmann 	 * representation which has to be translated into a full-sized int.
2759f227b88fSMarkus Pargmann 	 * This is done by filling up all bits above the sign-bit.
2760f227b88fSMarkus Pargmann 	 */
2761f227b88fSMarkus Pargmann 	ret |= ~((int)(BIT(sign_bit) - 1));
2762f227b88fSMarkus Pargmann 
2763f227b88fSMarkus Pargmann 	return ret;
2764f227b88fSMarkus Pargmann }
2765f227b88fSMarkus Pargmann 
2766f227b88fSMarkus Pargmann /**
2767db2a4165SFrank Mandarino  * snd_soc_info_volsw - single mixer info callback
2768db2a4165SFrank Mandarino  * @kcontrol: mixer control
2769db2a4165SFrank Mandarino  * @uinfo: control element information
2770db2a4165SFrank Mandarino  *
2771e8f5a103SPeter Ujfalusi  * Callback to provide information about a single mixer control, or a double
2772e8f5a103SPeter Ujfalusi  * mixer control that spans 2 registers.
2773db2a4165SFrank Mandarino  *
2774db2a4165SFrank Mandarino  * Returns 0 for success.
2775db2a4165SFrank Mandarino  */
2776db2a4165SFrank Mandarino int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
2777db2a4165SFrank Mandarino 	struct snd_ctl_elem_info *uinfo)
2778db2a4165SFrank Mandarino {
27794eaa9819SJon Smirl 	struct soc_mixer_control *mc =
27804eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2781d11bb4a9SPeter Ujfalusi 	int platform_max;
2782db2a4165SFrank Mandarino 
2783d11bb4a9SPeter Ujfalusi 	if (!mc->platform_max)
2784d11bb4a9SPeter Ujfalusi 		mc->platform_max = mc->max;
2785d11bb4a9SPeter Ujfalusi 	platform_max = mc->platform_max;
2786d11bb4a9SPeter Ujfalusi 
2787d11bb4a9SPeter Ujfalusi 	if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
2788a7a4ac86SPhilipp Zabel 		uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2789a7a4ac86SPhilipp Zabel 	else
2790a7a4ac86SPhilipp Zabel 		uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2791a7a4ac86SPhilipp Zabel 
2792e8f5a103SPeter Ujfalusi 	uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
2793db2a4165SFrank Mandarino 	uinfo->value.integer.min = 0;
2794f227b88fSMarkus Pargmann 	uinfo->value.integer.max = platform_max - mc->min;
2795db2a4165SFrank Mandarino 	return 0;
2796db2a4165SFrank Mandarino }
2797db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
2798db2a4165SFrank Mandarino 
2799db2a4165SFrank Mandarino /**
2800db2a4165SFrank Mandarino  * snd_soc_get_volsw - single mixer get callback
2801db2a4165SFrank Mandarino  * @kcontrol: mixer control
2802ac11a2b3SMark Brown  * @ucontrol: control element information
2803db2a4165SFrank Mandarino  *
2804f7915d99SPeter Ujfalusi  * Callback to get the value of a single mixer control, or a double mixer
2805f7915d99SPeter Ujfalusi  * control that spans 2 registers.
2806db2a4165SFrank Mandarino  *
2807db2a4165SFrank Mandarino  * Returns 0 for success.
2808db2a4165SFrank Mandarino  */
2809db2a4165SFrank Mandarino int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
2810db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
2811db2a4165SFrank Mandarino {
28124eaa9819SJon Smirl 	struct soc_mixer_control *mc =
28134eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2814db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2815815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
2816f7915d99SPeter Ujfalusi 	unsigned int reg2 = mc->rreg;
2817815ecf8dSJon Smirl 	unsigned int shift = mc->shift;
2818815ecf8dSJon Smirl 	unsigned int rshift = mc->rshift;
28194eaa9819SJon Smirl 	int max = mc->max;
2820f227b88fSMarkus Pargmann 	int min = mc->min;
2821f227b88fSMarkus Pargmann 	int sign_bit = mc->sign_bit;
2822815ecf8dSJon Smirl 	unsigned int mask = (1 << fls(max)) - 1;
2823815ecf8dSJon Smirl 	unsigned int invert = mc->invert;
2824db2a4165SFrank Mandarino 
2825f227b88fSMarkus Pargmann 	if (sign_bit)
2826f227b88fSMarkus Pargmann 		mask = BIT(sign_bit + 1) - 1;
2827f227b88fSMarkus Pargmann 
2828f227b88fSMarkus Pargmann 	ucontrol->value.integer.value[0] = snd_soc_read_signed(codec, reg, mask,
2829f227b88fSMarkus Pargmann 			shift, sign_bit) - min;
2830f7915d99SPeter Ujfalusi 	if (invert)
2831db2a4165SFrank Mandarino 		ucontrol->value.integer.value[0] =
2832a7a4ac86SPhilipp Zabel 			max - ucontrol->value.integer.value[0];
2833f7915d99SPeter Ujfalusi 
2834f7915d99SPeter Ujfalusi 	if (snd_soc_volsw_is_stereo(mc)) {
2835f7915d99SPeter Ujfalusi 		if (reg == reg2)
2836f7915d99SPeter Ujfalusi 			ucontrol->value.integer.value[1] =
2837f227b88fSMarkus Pargmann 				snd_soc_read_signed(codec, reg, mask, rshift,
2838f227b88fSMarkus Pargmann 						sign_bit) - min;
2839f7915d99SPeter Ujfalusi 		else
2840f7915d99SPeter Ujfalusi 			ucontrol->value.integer.value[1] =
2841f227b88fSMarkus Pargmann 				snd_soc_read_signed(codec, reg2, mask, shift,
2842f227b88fSMarkus Pargmann 						sign_bit) - min;
2843f7915d99SPeter Ujfalusi 		if (invert)
2844db2a4165SFrank Mandarino 			ucontrol->value.integer.value[1] =
2845a7a4ac86SPhilipp Zabel 				max - ucontrol->value.integer.value[1];
2846db2a4165SFrank Mandarino 	}
2847db2a4165SFrank Mandarino 
2848db2a4165SFrank Mandarino 	return 0;
2849db2a4165SFrank Mandarino }
2850db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
2851db2a4165SFrank Mandarino 
2852db2a4165SFrank Mandarino /**
2853db2a4165SFrank Mandarino  * snd_soc_put_volsw - single mixer put callback
2854db2a4165SFrank Mandarino  * @kcontrol: mixer control
2855ac11a2b3SMark Brown  * @ucontrol: control element information
2856db2a4165SFrank Mandarino  *
2857974815baSPeter Ujfalusi  * Callback to set the value of a single mixer control, or a double mixer
2858974815baSPeter Ujfalusi  * control that spans 2 registers.
2859db2a4165SFrank Mandarino  *
2860db2a4165SFrank Mandarino  * Returns 0 for success.
2861db2a4165SFrank Mandarino  */
2862db2a4165SFrank Mandarino int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
2863db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
2864db2a4165SFrank Mandarino {
28654eaa9819SJon Smirl 	struct soc_mixer_control *mc =
28664eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2867db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2868815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
2869974815baSPeter Ujfalusi 	unsigned int reg2 = mc->rreg;
2870815ecf8dSJon Smirl 	unsigned int shift = mc->shift;
2871815ecf8dSJon Smirl 	unsigned int rshift = mc->rshift;
28724eaa9819SJon Smirl 	int max = mc->max;
2873f227b88fSMarkus Pargmann 	int min = mc->min;
2874f227b88fSMarkus Pargmann 	unsigned int sign_bit = mc->sign_bit;
2875815ecf8dSJon Smirl 	unsigned int mask = (1 << fls(max)) - 1;
2876815ecf8dSJon Smirl 	unsigned int invert = mc->invert;
2877974815baSPeter Ujfalusi 	int err;
2878974815baSPeter Ujfalusi 	bool type_2r = 0;
2879974815baSPeter Ujfalusi 	unsigned int val2 = 0;
2880974815baSPeter Ujfalusi 	unsigned int val, val_mask;
2881db2a4165SFrank Mandarino 
2882f227b88fSMarkus Pargmann 	if (sign_bit)
2883f227b88fSMarkus Pargmann 		mask = BIT(sign_bit + 1) - 1;
2884f227b88fSMarkus Pargmann 
2885f227b88fSMarkus Pargmann 	val = ((ucontrol->value.integer.value[0] + min) & mask);
2886db2a4165SFrank Mandarino 	if (invert)
2887a7a4ac86SPhilipp Zabel 		val = max - val;
2888db2a4165SFrank Mandarino 	val_mask = mask << shift;
2889db2a4165SFrank Mandarino 	val = val << shift;
2890974815baSPeter Ujfalusi 	if (snd_soc_volsw_is_stereo(mc)) {
2891f227b88fSMarkus Pargmann 		val2 = ((ucontrol->value.integer.value[1] + min) & mask);
2892db2a4165SFrank Mandarino 		if (invert)
2893a7a4ac86SPhilipp Zabel 			val2 = max - val2;
2894974815baSPeter Ujfalusi 		if (reg == reg2) {
2895db2a4165SFrank Mandarino 			val_mask |= mask << rshift;
2896db2a4165SFrank Mandarino 			val |= val2 << rshift;
2897974815baSPeter Ujfalusi 		} else {
2898db2a4165SFrank Mandarino 			val2 = val2 << shift;
2899974815baSPeter Ujfalusi 			type_2r = 1;
2900974815baSPeter Ujfalusi 		}
2901974815baSPeter Ujfalusi 	}
29026c508c62SEero Nurkkala 	err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
29033ff3f64bSMark Brown 	if (err < 0)
2904db2a4165SFrank Mandarino 		return err;
2905db2a4165SFrank Mandarino 
2906974815baSPeter Ujfalusi 	if (type_2r)
29076c508c62SEero Nurkkala 		err = snd_soc_update_bits_locked(codec, reg2, val_mask, val2);
2908974815baSPeter Ujfalusi 
2909db2a4165SFrank Mandarino 	return err;
2910db2a4165SFrank Mandarino }
2911974815baSPeter Ujfalusi EXPORT_SYMBOL_GPL(snd_soc_put_volsw);
2912db2a4165SFrank Mandarino 
2913e13ac2e9SMark Brown /**
29141d99f243SBrian Austin  * snd_soc_get_volsw_sx - single mixer get callback
29151d99f243SBrian Austin  * @kcontrol: mixer control
29161d99f243SBrian Austin  * @ucontrol: control element information
29171d99f243SBrian Austin  *
29181d99f243SBrian Austin  * Callback to get the value of a single mixer control, or a double mixer
29191d99f243SBrian Austin  * control that spans 2 registers.
29201d99f243SBrian Austin  *
29211d99f243SBrian Austin  * Returns 0 for success.
29221d99f243SBrian Austin  */
29231d99f243SBrian Austin int snd_soc_get_volsw_sx(struct snd_kcontrol *kcontrol,
29241d99f243SBrian Austin 		      struct snd_ctl_elem_value *ucontrol)
29251d99f243SBrian Austin {
29261d99f243SBrian Austin 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
29271d99f243SBrian Austin 	struct soc_mixer_control *mc =
29281d99f243SBrian Austin 	    (struct soc_mixer_control *)kcontrol->private_value;
29291d99f243SBrian Austin 
29301d99f243SBrian Austin 	unsigned int reg = mc->reg;
29311d99f243SBrian Austin 	unsigned int reg2 = mc->rreg;
29321d99f243SBrian Austin 	unsigned int shift = mc->shift;
29331d99f243SBrian Austin 	unsigned int rshift = mc->rshift;
29341d99f243SBrian Austin 	int max = mc->max;
29351d99f243SBrian Austin 	int min = mc->min;
29361d99f243SBrian Austin 	int mask = (1 << (fls(min + max) - 1)) - 1;
29371d99f243SBrian Austin 
29381d99f243SBrian Austin 	ucontrol->value.integer.value[0] =
29391d99f243SBrian Austin 	    ((snd_soc_read(codec, reg) >> shift) - min) & mask;
29401d99f243SBrian Austin 
29411d99f243SBrian Austin 	if (snd_soc_volsw_is_stereo(mc))
29421d99f243SBrian Austin 		ucontrol->value.integer.value[1] =
29431d99f243SBrian Austin 			((snd_soc_read(codec, reg2) >> rshift) - min) & mask;
29441d99f243SBrian Austin 
29451d99f243SBrian Austin 	return 0;
29461d99f243SBrian Austin }
29471d99f243SBrian Austin EXPORT_SYMBOL_GPL(snd_soc_get_volsw_sx);
29481d99f243SBrian Austin 
29491d99f243SBrian Austin /**
29501d99f243SBrian Austin  * snd_soc_put_volsw_sx - double mixer set callback
29511d99f243SBrian Austin  * @kcontrol: mixer control
29521d99f243SBrian Austin  * @uinfo: control element information
29531d99f243SBrian Austin  *
29541d99f243SBrian Austin  * Callback to set the value of a double mixer control that spans 2 registers.
29551d99f243SBrian Austin  *
29561d99f243SBrian Austin  * Returns 0 for success.
29571d99f243SBrian Austin  */
29581d99f243SBrian Austin int snd_soc_put_volsw_sx(struct snd_kcontrol *kcontrol,
29591d99f243SBrian Austin 			 struct snd_ctl_elem_value *ucontrol)
29601d99f243SBrian Austin {
29611d99f243SBrian Austin 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
29621d99f243SBrian Austin 	struct soc_mixer_control *mc =
29631d99f243SBrian Austin 	    (struct soc_mixer_control *)kcontrol->private_value;
29641d99f243SBrian Austin 
29651d99f243SBrian Austin 	unsigned int reg = mc->reg;
29661d99f243SBrian Austin 	unsigned int reg2 = mc->rreg;
29671d99f243SBrian Austin 	unsigned int shift = mc->shift;
29681d99f243SBrian Austin 	unsigned int rshift = mc->rshift;
29691d99f243SBrian Austin 	int max = mc->max;
29701d99f243SBrian Austin 	int min = mc->min;
29711d99f243SBrian Austin 	int mask = (1 << (fls(min + max) - 1)) - 1;
297227f1d759SBrian Austin 	int err = 0;
29731d99f243SBrian Austin 	unsigned short val, val_mask, val2 = 0;
29741d99f243SBrian Austin 
29751d99f243SBrian Austin 	val_mask = mask << shift;
29761d99f243SBrian Austin 	val = (ucontrol->value.integer.value[0] + min) & mask;
29771d99f243SBrian Austin 	val = val << shift;
29781d99f243SBrian Austin 
2979d055852eSMukund Navada 	err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
2980d055852eSMukund Navada 	if (err < 0)
29811d99f243SBrian Austin 		return err;
29821d99f243SBrian Austin 
29831d99f243SBrian Austin 	if (snd_soc_volsw_is_stereo(mc)) {
29841d99f243SBrian Austin 		val_mask = mask << rshift;
29851d99f243SBrian Austin 		val2 = (ucontrol->value.integer.value[1] + min) & mask;
29861d99f243SBrian Austin 		val2 = val2 << rshift;
29871d99f243SBrian Austin 
29881d99f243SBrian Austin 		if (snd_soc_update_bits_locked(codec, reg2, val_mask, val2))
29891d99f243SBrian Austin 			return err;
29901d99f243SBrian Austin 	}
29911d99f243SBrian Austin 	return 0;
29921d99f243SBrian Austin }
29931d99f243SBrian Austin EXPORT_SYMBOL_GPL(snd_soc_put_volsw_sx);
29941d99f243SBrian Austin 
29951d99f243SBrian Austin /**
2996e13ac2e9SMark Brown  * snd_soc_info_volsw_s8 - signed mixer info callback
2997e13ac2e9SMark Brown  * @kcontrol: mixer control
2998e13ac2e9SMark Brown  * @uinfo: control element information
2999e13ac2e9SMark Brown  *
3000e13ac2e9SMark Brown  * Callback to provide information about a signed mixer control.
3001e13ac2e9SMark Brown  *
3002e13ac2e9SMark Brown  * Returns 0 for success.
3003e13ac2e9SMark Brown  */
3004e13ac2e9SMark Brown int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol,
3005e13ac2e9SMark Brown 	struct snd_ctl_elem_info *uinfo)
3006e13ac2e9SMark Brown {
30074eaa9819SJon Smirl 	struct soc_mixer_control *mc =
30084eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
3009d11bb4a9SPeter Ujfalusi 	int platform_max;
30104eaa9819SJon Smirl 	int min = mc->min;
3011e13ac2e9SMark Brown 
3012d11bb4a9SPeter Ujfalusi 	if (!mc->platform_max)
3013d11bb4a9SPeter Ujfalusi 		mc->platform_max = mc->max;
3014d11bb4a9SPeter Ujfalusi 	platform_max = mc->platform_max;
3015d11bb4a9SPeter Ujfalusi 
3016e13ac2e9SMark Brown 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
3017e13ac2e9SMark Brown 	uinfo->count = 2;
3018e13ac2e9SMark Brown 	uinfo->value.integer.min = 0;
3019d11bb4a9SPeter Ujfalusi 	uinfo->value.integer.max = platform_max - min;
3020e13ac2e9SMark Brown 	return 0;
3021e13ac2e9SMark Brown }
3022e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8);
3023e13ac2e9SMark Brown 
3024e13ac2e9SMark Brown /**
3025e13ac2e9SMark Brown  * snd_soc_get_volsw_s8 - signed mixer get callback
3026e13ac2e9SMark Brown  * @kcontrol: mixer control
3027ac11a2b3SMark Brown  * @ucontrol: control element information
3028e13ac2e9SMark Brown  *
3029e13ac2e9SMark Brown  * Callback to get the value of a signed mixer control.
3030e13ac2e9SMark Brown  *
3031e13ac2e9SMark Brown  * Returns 0 for success.
3032e13ac2e9SMark Brown  */
3033e13ac2e9SMark Brown int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol,
3034e13ac2e9SMark Brown 	struct snd_ctl_elem_value *ucontrol)
3035e13ac2e9SMark Brown {
30364eaa9819SJon Smirl 	struct soc_mixer_control *mc =
30374eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
3038e13ac2e9SMark Brown 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3039815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
30404eaa9819SJon Smirl 	int min = mc->min;
3041e13ac2e9SMark Brown 	int val = snd_soc_read(codec, reg);
3042e13ac2e9SMark Brown 
3043e13ac2e9SMark Brown 	ucontrol->value.integer.value[0] =
3044e13ac2e9SMark Brown 		((signed char)(val & 0xff))-min;
3045e13ac2e9SMark Brown 	ucontrol->value.integer.value[1] =
3046e13ac2e9SMark Brown 		((signed char)((val >> 8) & 0xff))-min;
3047e13ac2e9SMark Brown 	return 0;
3048e13ac2e9SMark Brown }
3049e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8);
3050e13ac2e9SMark Brown 
3051e13ac2e9SMark Brown /**
3052e13ac2e9SMark Brown  * snd_soc_put_volsw_sgn - signed mixer put callback
3053e13ac2e9SMark Brown  * @kcontrol: mixer control
3054ac11a2b3SMark Brown  * @ucontrol: control element information
3055e13ac2e9SMark Brown  *
3056e13ac2e9SMark Brown  * Callback to set the value of a signed mixer control.
3057e13ac2e9SMark Brown  *
3058e13ac2e9SMark Brown  * Returns 0 for success.
3059e13ac2e9SMark Brown  */
3060e13ac2e9SMark Brown int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol,
3061e13ac2e9SMark Brown 	struct snd_ctl_elem_value *ucontrol)
3062e13ac2e9SMark Brown {
30634eaa9819SJon Smirl 	struct soc_mixer_control *mc =
30644eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
3065e13ac2e9SMark Brown 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3066815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
30674eaa9819SJon Smirl 	int min = mc->min;
306846f5822fSDaniel Ribeiro 	unsigned int val;
3069e13ac2e9SMark Brown 
3070e13ac2e9SMark Brown 	val = (ucontrol->value.integer.value[0]+min) & 0xff;
3071e13ac2e9SMark Brown 	val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8;
3072e13ac2e9SMark Brown 
30736c508c62SEero Nurkkala 	return snd_soc_update_bits_locked(codec, reg, 0xffff, val);
3074e13ac2e9SMark Brown }
3075e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8);
3076e13ac2e9SMark Brown 
30778c6529dbSLiam Girdwood /**
30786c9d8cf6SAdam Thomson  * snd_soc_info_volsw_range - single mixer info callback with range.
30796c9d8cf6SAdam Thomson  * @kcontrol: mixer control
30806c9d8cf6SAdam Thomson  * @uinfo: control element information
30816c9d8cf6SAdam Thomson  *
30826c9d8cf6SAdam Thomson  * Callback to provide information, within a range, about a single
30836c9d8cf6SAdam Thomson  * mixer control.
30846c9d8cf6SAdam Thomson  *
30856c9d8cf6SAdam Thomson  * returns 0 for success.
30866c9d8cf6SAdam Thomson  */
30876c9d8cf6SAdam Thomson int snd_soc_info_volsw_range(struct snd_kcontrol *kcontrol,
30886c9d8cf6SAdam Thomson 	struct snd_ctl_elem_info *uinfo)
30896c9d8cf6SAdam Thomson {
30906c9d8cf6SAdam Thomson 	struct soc_mixer_control *mc =
30916c9d8cf6SAdam Thomson 		(struct soc_mixer_control *)kcontrol->private_value;
30926c9d8cf6SAdam Thomson 	int platform_max;
30936c9d8cf6SAdam Thomson 	int min = mc->min;
30946c9d8cf6SAdam Thomson 
30956c9d8cf6SAdam Thomson 	if (!mc->platform_max)
30966c9d8cf6SAdam Thomson 		mc->platform_max = mc->max;
30976c9d8cf6SAdam Thomson 	platform_max = mc->platform_max;
30986c9d8cf6SAdam Thomson 
30996c9d8cf6SAdam Thomson 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
31009bde4f0bSMark Brown 	uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
31016c9d8cf6SAdam Thomson 	uinfo->value.integer.min = 0;
31026c9d8cf6SAdam Thomson 	uinfo->value.integer.max = platform_max - min;
31036c9d8cf6SAdam Thomson 
31046c9d8cf6SAdam Thomson 	return 0;
31056c9d8cf6SAdam Thomson }
31066c9d8cf6SAdam Thomson EXPORT_SYMBOL_GPL(snd_soc_info_volsw_range);
31076c9d8cf6SAdam Thomson 
31086c9d8cf6SAdam Thomson /**
31096c9d8cf6SAdam Thomson  * snd_soc_put_volsw_range - single mixer put value callback with range.
31106c9d8cf6SAdam Thomson  * @kcontrol: mixer control
31116c9d8cf6SAdam Thomson  * @ucontrol: control element information
31126c9d8cf6SAdam Thomson  *
31136c9d8cf6SAdam Thomson  * Callback to set the value, within a range, for a single mixer control.
31146c9d8cf6SAdam Thomson  *
31156c9d8cf6SAdam Thomson  * Returns 0 for success.
31166c9d8cf6SAdam Thomson  */
31176c9d8cf6SAdam Thomson int snd_soc_put_volsw_range(struct snd_kcontrol *kcontrol,
31186c9d8cf6SAdam Thomson 	struct snd_ctl_elem_value *ucontrol)
31196c9d8cf6SAdam Thomson {
31206c9d8cf6SAdam Thomson 	struct soc_mixer_control *mc =
31216c9d8cf6SAdam Thomson 		(struct soc_mixer_control *)kcontrol->private_value;
31226c9d8cf6SAdam Thomson 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
31236c9d8cf6SAdam Thomson 	unsigned int reg = mc->reg;
31249bde4f0bSMark Brown 	unsigned int rreg = mc->rreg;
31256c9d8cf6SAdam Thomson 	unsigned int shift = mc->shift;
31266c9d8cf6SAdam Thomson 	int min = mc->min;
31276c9d8cf6SAdam Thomson 	int max = mc->max;
31286c9d8cf6SAdam Thomson 	unsigned int mask = (1 << fls(max)) - 1;
31296c9d8cf6SAdam Thomson 	unsigned int invert = mc->invert;
31306c9d8cf6SAdam Thomson 	unsigned int val, val_mask;
31319bde4f0bSMark Brown 	int ret;
31326c9d8cf6SAdam Thomson 
31336c9d8cf6SAdam Thomson 	val = ((ucontrol->value.integer.value[0] + min) & mask);
31346c9d8cf6SAdam Thomson 	if (invert)
31356c9d8cf6SAdam Thomson 		val = max - val;
31366c9d8cf6SAdam Thomson 	val_mask = mask << shift;
31376c9d8cf6SAdam Thomson 	val = val << shift;
31386c9d8cf6SAdam Thomson 
31399bde4f0bSMark Brown 	ret = snd_soc_update_bits_locked(codec, reg, val_mask, val);
31400eaa6ccaSJoonyoung Shim 	if (ret < 0)
31419bde4f0bSMark Brown 		return ret;
31429bde4f0bSMark Brown 
31439bde4f0bSMark Brown 	if (snd_soc_volsw_is_stereo(mc)) {
31449bde4f0bSMark Brown 		val = ((ucontrol->value.integer.value[1] + min) & mask);
31459bde4f0bSMark Brown 		if (invert)
31469bde4f0bSMark Brown 			val = max - val;
31479bde4f0bSMark Brown 		val_mask = mask << shift;
31489bde4f0bSMark Brown 		val = val << shift;
31499bde4f0bSMark Brown 
31509bde4f0bSMark Brown 		ret = snd_soc_update_bits_locked(codec, rreg, val_mask, val);
31519bde4f0bSMark Brown 	}
31529bde4f0bSMark Brown 
31539bde4f0bSMark Brown 	return ret;
31546c9d8cf6SAdam Thomson }
31556c9d8cf6SAdam Thomson EXPORT_SYMBOL_GPL(snd_soc_put_volsw_range);
31566c9d8cf6SAdam Thomson 
31576c9d8cf6SAdam Thomson /**
31586c9d8cf6SAdam Thomson  * snd_soc_get_volsw_range - single mixer get callback with range
31596c9d8cf6SAdam Thomson  * @kcontrol: mixer control
31606c9d8cf6SAdam Thomson  * @ucontrol: control element information
31616c9d8cf6SAdam Thomson  *
31626c9d8cf6SAdam Thomson  * Callback to get the value, within a range, of a single mixer control.
31636c9d8cf6SAdam Thomson  *
31646c9d8cf6SAdam Thomson  * Returns 0 for success.
31656c9d8cf6SAdam Thomson  */
31666c9d8cf6SAdam Thomson int snd_soc_get_volsw_range(struct snd_kcontrol *kcontrol,
31676c9d8cf6SAdam Thomson 	struct snd_ctl_elem_value *ucontrol)
31686c9d8cf6SAdam Thomson {
31696c9d8cf6SAdam Thomson 	struct soc_mixer_control *mc =
31706c9d8cf6SAdam Thomson 		(struct soc_mixer_control *)kcontrol->private_value;
31716c9d8cf6SAdam Thomson 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
31726c9d8cf6SAdam Thomson 	unsigned int reg = mc->reg;
31739bde4f0bSMark Brown 	unsigned int rreg = mc->rreg;
31746c9d8cf6SAdam Thomson 	unsigned int shift = mc->shift;
31756c9d8cf6SAdam Thomson 	int min = mc->min;
31766c9d8cf6SAdam Thomson 	int max = mc->max;
31776c9d8cf6SAdam Thomson 	unsigned int mask = (1 << fls(max)) - 1;
31786c9d8cf6SAdam Thomson 	unsigned int invert = mc->invert;
31796c9d8cf6SAdam Thomson 
31806c9d8cf6SAdam Thomson 	ucontrol->value.integer.value[0] =
31816c9d8cf6SAdam Thomson 		(snd_soc_read(codec, reg) >> shift) & mask;
31826c9d8cf6SAdam Thomson 	if (invert)
31836c9d8cf6SAdam Thomson 		ucontrol->value.integer.value[0] =
31846c9d8cf6SAdam Thomson 			max - ucontrol->value.integer.value[0];
31856c9d8cf6SAdam Thomson 	ucontrol->value.integer.value[0] =
31866c9d8cf6SAdam Thomson 		ucontrol->value.integer.value[0] - min;
31876c9d8cf6SAdam Thomson 
31889bde4f0bSMark Brown 	if (snd_soc_volsw_is_stereo(mc)) {
31899bde4f0bSMark Brown 		ucontrol->value.integer.value[1] =
31909bde4f0bSMark Brown 			(snd_soc_read(codec, rreg) >> shift) & mask;
31919bde4f0bSMark Brown 		if (invert)
31929bde4f0bSMark Brown 			ucontrol->value.integer.value[1] =
31939bde4f0bSMark Brown 				max - ucontrol->value.integer.value[1];
31949bde4f0bSMark Brown 		ucontrol->value.integer.value[1] =
31959bde4f0bSMark Brown 			ucontrol->value.integer.value[1] - min;
31969bde4f0bSMark Brown 	}
31979bde4f0bSMark Brown 
31986c9d8cf6SAdam Thomson 	return 0;
31996c9d8cf6SAdam Thomson }
32006c9d8cf6SAdam Thomson EXPORT_SYMBOL_GPL(snd_soc_get_volsw_range);
32016c9d8cf6SAdam Thomson 
32026c9d8cf6SAdam Thomson /**
3203637d3847SPeter Ujfalusi  * snd_soc_limit_volume - Set new limit to an existing volume control.
3204637d3847SPeter Ujfalusi  *
3205637d3847SPeter Ujfalusi  * @codec: where to look for the control
3206637d3847SPeter Ujfalusi  * @name: Name of the control
3207637d3847SPeter Ujfalusi  * @max: new maximum limit
3208637d3847SPeter Ujfalusi  *
3209637d3847SPeter Ujfalusi  * Return 0 for success, else error.
3210637d3847SPeter Ujfalusi  */
3211637d3847SPeter Ujfalusi int snd_soc_limit_volume(struct snd_soc_codec *codec,
3212637d3847SPeter Ujfalusi 	const char *name, int max)
3213637d3847SPeter Ujfalusi {
3214f0fba2adSLiam Girdwood 	struct snd_card *card = codec->card->snd_card;
3215637d3847SPeter Ujfalusi 	struct snd_kcontrol *kctl;
3216637d3847SPeter Ujfalusi 	struct soc_mixer_control *mc;
3217637d3847SPeter Ujfalusi 	int found = 0;
3218637d3847SPeter Ujfalusi 	int ret = -EINVAL;
3219637d3847SPeter Ujfalusi 
3220637d3847SPeter Ujfalusi 	/* Sanity check for name and max */
3221637d3847SPeter Ujfalusi 	if (unlikely(!name || max <= 0))
3222637d3847SPeter Ujfalusi 		return -EINVAL;
3223637d3847SPeter Ujfalusi 
3224637d3847SPeter Ujfalusi 	list_for_each_entry(kctl, &card->controls, list) {
3225637d3847SPeter Ujfalusi 		if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) {
3226637d3847SPeter Ujfalusi 			found = 1;
3227637d3847SPeter Ujfalusi 			break;
3228637d3847SPeter Ujfalusi 		}
3229637d3847SPeter Ujfalusi 	}
3230637d3847SPeter Ujfalusi 	if (found) {
3231637d3847SPeter Ujfalusi 		mc = (struct soc_mixer_control *)kctl->private_value;
3232637d3847SPeter Ujfalusi 		if (max <= mc->max) {
3233d11bb4a9SPeter Ujfalusi 			mc->platform_max = max;
3234637d3847SPeter Ujfalusi 			ret = 0;
3235637d3847SPeter Ujfalusi 		}
3236637d3847SPeter Ujfalusi 	}
3237637d3847SPeter Ujfalusi 	return ret;
3238637d3847SPeter Ujfalusi }
3239637d3847SPeter Ujfalusi EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
3240637d3847SPeter Ujfalusi 
324171d08516SMark Brown int snd_soc_bytes_info(struct snd_kcontrol *kcontrol,
324271d08516SMark Brown 		       struct snd_ctl_elem_info *uinfo)
324371d08516SMark Brown {
324471d08516SMark Brown 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
324571d08516SMark Brown 	struct soc_bytes *params = (void *)kcontrol->private_value;
324671d08516SMark Brown 
324771d08516SMark Brown 	uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
324871d08516SMark Brown 	uinfo->count = params->num_regs * codec->val_bytes;
324971d08516SMark Brown 
325071d08516SMark Brown 	return 0;
325171d08516SMark Brown }
325271d08516SMark Brown EXPORT_SYMBOL_GPL(snd_soc_bytes_info);
325371d08516SMark Brown 
325471d08516SMark Brown int snd_soc_bytes_get(struct snd_kcontrol *kcontrol,
325571d08516SMark Brown 		      struct snd_ctl_elem_value *ucontrol)
325671d08516SMark Brown {
325771d08516SMark Brown 	struct soc_bytes *params = (void *)kcontrol->private_value;
325871d08516SMark Brown 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
325971d08516SMark Brown 	int ret;
326071d08516SMark Brown 
326171d08516SMark Brown 	if (codec->using_regmap)
326271d08516SMark Brown 		ret = regmap_raw_read(codec->control_data, params->base,
326371d08516SMark Brown 				      ucontrol->value.bytes.data,
326471d08516SMark Brown 				      params->num_regs * codec->val_bytes);
326571d08516SMark Brown 	else
326671d08516SMark Brown 		ret = -EINVAL;
326771d08516SMark Brown 
3268f831b055SMark Brown 	/* Hide any masked bytes to ensure consistent data reporting */
3269f831b055SMark Brown 	if (ret == 0 && params->mask) {
3270f831b055SMark Brown 		switch (codec->val_bytes) {
3271f831b055SMark Brown 		case 1:
3272f831b055SMark Brown 			ucontrol->value.bytes.data[0] &= ~params->mask;
3273f831b055SMark Brown 			break;
3274f831b055SMark Brown 		case 2:
3275f831b055SMark Brown 			((u16 *)(&ucontrol->value.bytes.data))[0]
32768f1ec93aSCharles Keepax 				&= cpu_to_be16(~params->mask);
3277f831b055SMark Brown 			break;
3278f831b055SMark Brown 		case 4:
3279f831b055SMark Brown 			((u32 *)(&ucontrol->value.bytes.data))[0]
32808f1ec93aSCharles Keepax 				&= cpu_to_be32(~params->mask);
3281f831b055SMark Brown 			break;
3282f831b055SMark Brown 		default:
3283f831b055SMark Brown 			return -EINVAL;
3284f831b055SMark Brown 		}
3285f831b055SMark Brown 	}
3286f831b055SMark Brown 
328771d08516SMark Brown 	return ret;
328871d08516SMark Brown }
328971d08516SMark Brown EXPORT_SYMBOL_GPL(snd_soc_bytes_get);
329071d08516SMark Brown 
329171d08516SMark Brown int snd_soc_bytes_put(struct snd_kcontrol *kcontrol,
329271d08516SMark Brown 		      struct snd_ctl_elem_value *ucontrol)
329371d08516SMark Brown {
329471d08516SMark Brown 	struct soc_bytes *params = (void *)kcontrol->private_value;
329571d08516SMark Brown 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3296f831b055SMark Brown 	int ret, len;
3297f831b055SMark Brown 	unsigned int val;
3298f831b055SMark Brown 	void *data;
329971d08516SMark Brown 
3300f831b055SMark Brown 	if (!codec->using_regmap)
3301f831b055SMark Brown 		return -EINVAL;
3302f831b055SMark Brown 
3303f831b055SMark Brown 	len = params->num_regs * codec->val_bytes;
3304f831b055SMark Brown 
3305b5a8fe43SMark Brown 	data = kmemdup(ucontrol->value.bytes.data, len, GFP_KERNEL | GFP_DMA);
3306b5a8fe43SMark Brown 	if (!data)
3307b5a8fe43SMark Brown 		return -ENOMEM;
3308b5a8fe43SMark Brown 
3309f831b055SMark Brown 	/*
3310f831b055SMark Brown 	 * If we've got a mask then we need to preserve the register
3311f831b055SMark Brown 	 * bits.  We shouldn't modify the incoming data so take a
3312f831b055SMark Brown 	 * copy.
3313f831b055SMark Brown 	 */
3314f831b055SMark Brown 	if (params->mask) {
3315f831b055SMark Brown 		ret = regmap_read(codec->control_data, params->base, &val);
3316f831b055SMark Brown 		if (ret != 0)
3317e8b18addSWei Yongjun 			goto out;
3318f831b055SMark Brown 
3319f831b055SMark Brown 		val &= params->mask;
3320f831b055SMark Brown 
3321f831b055SMark Brown 		switch (codec->val_bytes) {
3322f831b055SMark Brown 		case 1:
3323f831b055SMark Brown 			((u8 *)data)[0] &= ~params->mask;
3324f831b055SMark Brown 			((u8 *)data)[0] |= val;
3325f831b055SMark Brown 			break;
3326f831b055SMark Brown 		case 2:
3327f831b055SMark Brown 			((u16 *)data)[0] &= cpu_to_be16(~params->mask);
3328f831b055SMark Brown 			((u16 *)data)[0] |= cpu_to_be16(val);
3329f831b055SMark Brown 			break;
3330f831b055SMark Brown 		case 4:
3331f831b055SMark Brown 			((u32 *)data)[0] &= cpu_to_be32(~params->mask);
3332f831b055SMark Brown 			((u32 *)data)[0] |= cpu_to_be32(val);
3333f831b055SMark Brown 			break;
3334f831b055SMark Brown 		default:
3335e8b18addSWei Yongjun 			ret = -EINVAL;
3336e8b18addSWei Yongjun 			goto out;
3337f831b055SMark Brown 		}
3338f831b055SMark Brown 	}
3339f831b055SMark Brown 
334071d08516SMark Brown 	ret = regmap_raw_write(codec->control_data, params->base,
3341f831b055SMark Brown 			       data, len);
3342f831b055SMark Brown 
3343e8b18addSWei Yongjun out:
3344f831b055SMark Brown 	kfree(data);
334571d08516SMark Brown 
334671d08516SMark Brown 	return ret;
334771d08516SMark Brown }
334871d08516SMark Brown EXPORT_SYMBOL_GPL(snd_soc_bytes_put);
334971d08516SMark Brown 
3350b6f4bb38Sapatard@mandriva.com /**
33514183eed2SKristoffer KARLSSON  * snd_soc_info_xr_sx - signed multi register info callback
33524183eed2SKristoffer KARLSSON  * @kcontrol: mreg control
33534183eed2SKristoffer KARLSSON  * @uinfo: control element information
33544183eed2SKristoffer KARLSSON  *
33554183eed2SKristoffer KARLSSON  * Callback to provide information of a control that can
33564183eed2SKristoffer KARLSSON  * span multiple codec registers which together
33574183eed2SKristoffer KARLSSON  * forms a single signed value in a MSB/LSB manner.
33584183eed2SKristoffer KARLSSON  *
33594183eed2SKristoffer KARLSSON  * Returns 0 for success.
33604183eed2SKristoffer KARLSSON  */
33614183eed2SKristoffer KARLSSON int snd_soc_info_xr_sx(struct snd_kcontrol *kcontrol,
33624183eed2SKristoffer KARLSSON 	struct snd_ctl_elem_info *uinfo)
33634183eed2SKristoffer KARLSSON {
33644183eed2SKristoffer KARLSSON 	struct soc_mreg_control *mc =
33654183eed2SKristoffer KARLSSON 		(struct soc_mreg_control *)kcontrol->private_value;
33664183eed2SKristoffer KARLSSON 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
33674183eed2SKristoffer KARLSSON 	uinfo->count = 1;
33684183eed2SKristoffer KARLSSON 	uinfo->value.integer.min = mc->min;
33694183eed2SKristoffer KARLSSON 	uinfo->value.integer.max = mc->max;
33704183eed2SKristoffer KARLSSON 
33714183eed2SKristoffer KARLSSON 	return 0;
33724183eed2SKristoffer KARLSSON }
33734183eed2SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_info_xr_sx);
33744183eed2SKristoffer KARLSSON 
33754183eed2SKristoffer KARLSSON /**
33764183eed2SKristoffer KARLSSON  * snd_soc_get_xr_sx - signed multi register get callback
33774183eed2SKristoffer KARLSSON  * @kcontrol: mreg control
33784183eed2SKristoffer KARLSSON  * @ucontrol: control element information
33794183eed2SKristoffer KARLSSON  *
33804183eed2SKristoffer KARLSSON  * Callback to get the value of a control that can span
33814183eed2SKristoffer KARLSSON  * multiple codec registers which together forms a single
33824183eed2SKristoffer KARLSSON  * signed value in a MSB/LSB manner. The control supports
33834183eed2SKristoffer KARLSSON  * specifying total no of bits used to allow for bitfields
33844183eed2SKristoffer KARLSSON  * across the multiple codec registers.
33854183eed2SKristoffer KARLSSON  *
33864183eed2SKristoffer KARLSSON  * Returns 0 for success.
33874183eed2SKristoffer KARLSSON  */
33884183eed2SKristoffer KARLSSON int snd_soc_get_xr_sx(struct snd_kcontrol *kcontrol,
33894183eed2SKristoffer KARLSSON 	struct snd_ctl_elem_value *ucontrol)
33904183eed2SKristoffer KARLSSON {
33914183eed2SKristoffer KARLSSON 	struct soc_mreg_control *mc =
33924183eed2SKristoffer KARLSSON 		(struct soc_mreg_control *)kcontrol->private_value;
33934183eed2SKristoffer KARLSSON 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
33944183eed2SKristoffer KARLSSON 	unsigned int regbase = mc->regbase;
33954183eed2SKristoffer KARLSSON 	unsigned int regcount = mc->regcount;
33964183eed2SKristoffer KARLSSON 	unsigned int regwshift = codec->driver->reg_word_size * BITS_PER_BYTE;
33974183eed2SKristoffer KARLSSON 	unsigned int regwmask = (1<<regwshift)-1;
33984183eed2SKristoffer KARLSSON 	unsigned int invert = mc->invert;
33994183eed2SKristoffer KARLSSON 	unsigned long mask = (1UL<<mc->nbits)-1;
34004183eed2SKristoffer KARLSSON 	long min = mc->min;
34014183eed2SKristoffer KARLSSON 	long max = mc->max;
34024183eed2SKristoffer KARLSSON 	long val = 0;
34034183eed2SKristoffer KARLSSON 	unsigned long regval;
34044183eed2SKristoffer KARLSSON 	unsigned int i;
34054183eed2SKristoffer KARLSSON 
34064183eed2SKristoffer KARLSSON 	for (i = 0; i < regcount; i++) {
34074183eed2SKristoffer KARLSSON 		regval = snd_soc_read(codec, regbase+i) & regwmask;
34084183eed2SKristoffer KARLSSON 		val |= regval << (regwshift*(regcount-i-1));
34094183eed2SKristoffer KARLSSON 	}
34104183eed2SKristoffer KARLSSON 	val &= mask;
34114183eed2SKristoffer KARLSSON 	if (min < 0 && val > max)
34124183eed2SKristoffer KARLSSON 		val |= ~mask;
34134183eed2SKristoffer KARLSSON 	if (invert)
34144183eed2SKristoffer KARLSSON 		val = max - val;
34154183eed2SKristoffer KARLSSON 	ucontrol->value.integer.value[0] = val;
34164183eed2SKristoffer KARLSSON 
34174183eed2SKristoffer KARLSSON 	return 0;
34184183eed2SKristoffer KARLSSON }
34194183eed2SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_get_xr_sx);
34204183eed2SKristoffer KARLSSON 
34214183eed2SKristoffer KARLSSON /**
34224183eed2SKristoffer KARLSSON  * snd_soc_put_xr_sx - signed multi register get callback
34234183eed2SKristoffer KARLSSON  * @kcontrol: mreg control
34244183eed2SKristoffer KARLSSON  * @ucontrol: control element information
34254183eed2SKristoffer KARLSSON  *
34264183eed2SKristoffer KARLSSON  * Callback to set the value of a control that can span
34274183eed2SKristoffer KARLSSON  * multiple codec registers which together forms a single
34284183eed2SKristoffer KARLSSON  * signed value in a MSB/LSB manner. The control supports
34294183eed2SKristoffer KARLSSON  * specifying total no of bits used to allow for bitfields
34304183eed2SKristoffer KARLSSON  * across the multiple codec registers.
34314183eed2SKristoffer KARLSSON  *
34324183eed2SKristoffer KARLSSON  * Returns 0 for success.
34334183eed2SKristoffer KARLSSON  */
34344183eed2SKristoffer KARLSSON int snd_soc_put_xr_sx(struct snd_kcontrol *kcontrol,
34354183eed2SKristoffer KARLSSON 	struct snd_ctl_elem_value *ucontrol)
34364183eed2SKristoffer KARLSSON {
34374183eed2SKristoffer KARLSSON 	struct soc_mreg_control *mc =
34384183eed2SKristoffer KARLSSON 		(struct soc_mreg_control *)kcontrol->private_value;
34394183eed2SKristoffer KARLSSON 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
34404183eed2SKristoffer KARLSSON 	unsigned int regbase = mc->regbase;
34414183eed2SKristoffer KARLSSON 	unsigned int regcount = mc->regcount;
34424183eed2SKristoffer KARLSSON 	unsigned int regwshift = codec->driver->reg_word_size * BITS_PER_BYTE;
34434183eed2SKristoffer KARLSSON 	unsigned int regwmask = (1<<regwshift)-1;
34444183eed2SKristoffer KARLSSON 	unsigned int invert = mc->invert;
34454183eed2SKristoffer KARLSSON 	unsigned long mask = (1UL<<mc->nbits)-1;
34464183eed2SKristoffer KARLSSON 	long max = mc->max;
34474183eed2SKristoffer KARLSSON 	long val = ucontrol->value.integer.value[0];
34484183eed2SKristoffer KARLSSON 	unsigned int i, regval, regmask;
34494183eed2SKristoffer KARLSSON 	int err;
34504183eed2SKristoffer KARLSSON 
34514183eed2SKristoffer KARLSSON 	if (invert)
34524183eed2SKristoffer KARLSSON 		val = max - val;
34534183eed2SKristoffer KARLSSON 	val &= mask;
34544183eed2SKristoffer KARLSSON 	for (i = 0; i < regcount; i++) {
34554183eed2SKristoffer KARLSSON 		regval = (val >> (regwshift*(regcount-i-1))) & regwmask;
34564183eed2SKristoffer KARLSSON 		regmask = (mask >> (regwshift*(regcount-i-1))) & regwmask;
34574183eed2SKristoffer KARLSSON 		err = snd_soc_update_bits_locked(codec, regbase+i,
34584183eed2SKristoffer KARLSSON 				regmask, regval);
34594183eed2SKristoffer KARLSSON 		if (err < 0)
34604183eed2SKristoffer KARLSSON 			return err;
34614183eed2SKristoffer KARLSSON 	}
34624183eed2SKristoffer KARLSSON 
34634183eed2SKristoffer KARLSSON 	return 0;
34644183eed2SKristoffer KARLSSON }
34654183eed2SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_put_xr_sx);
34664183eed2SKristoffer KARLSSON 
34674183eed2SKristoffer KARLSSON /**
3468dd7b10b3SKristoffer KARLSSON  * snd_soc_get_strobe - strobe get callback
3469dd7b10b3SKristoffer KARLSSON  * @kcontrol: mixer control
3470dd7b10b3SKristoffer KARLSSON  * @ucontrol: control element information
3471dd7b10b3SKristoffer KARLSSON  *
3472dd7b10b3SKristoffer KARLSSON  * Callback get the value of a strobe mixer control.
3473dd7b10b3SKristoffer KARLSSON  *
3474dd7b10b3SKristoffer KARLSSON  * Returns 0 for success.
3475dd7b10b3SKristoffer KARLSSON  */
3476dd7b10b3SKristoffer KARLSSON int snd_soc_get_strobe(struct snd_kcontrol *kcontrol,
3477dd7b10b3SKristoffer KARLSSON 	struct snd_ctl_elem_value *ucontrol)
3478dd7b10b3SKristoffer KARLSSON {
3479dd7b10b3SKristoffer KARLSSON 	struct soc_mixer_control *mc =
3480dd7b10b3SKristoffer KARLSSON 		(struct soc_mixer_control *)kcontrol->private_value;
3481dd7b10b3SKristoffer KARLSSON 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3482dd7b10b3SKristoffer KARLSSON 	unsigned int reg = mc->reg;
3483dd7b10b3SKristoffer KARLSSON 	unsigned int shift = mc->shift;
3484dd7b10b3SKristoffer KARLSSON 	unsigned int mask = 1 << shift;
3485dd7b10b3SKristoffer KARLSSON 	unsigned int invert = mc->invert != 0;
3486dd7b10b3SKristoffer KARLSSON 	unsigned int val = snd_soc_read(codec, reg) & mask;
3487dd7b10b3SKristoffer KARLSSON 
3488dd7b10b3SKristoffer KARLSSON 	if (shift != 0 && val != 0)
3489dd7b10b3SKristoffer KARLSSON 		val = val >> shift;
3490dd7b10b3SKristoffer KARLSSON 	ucontrol->value.enumerated.item[0] = val ^ invert;
3491dd7b10b3SKristoffer KARLSSON 
3492dd7b10b3SKristoffer KARLSSON 	return 0;
3493dd7b10b3SKristoffer KARLSSON }
3494dd7b10b3SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_get_strobe);
3495dd7b10b3SKristoffer KARLSSON 
3496dd7b10b3SKristoffer KARLSSON /**
3497dd7b10b3SKristoffer KARLSSON  * snd_soc_put_strobe - strobe put callback
3498dd7b10b3SKristoffer KARLSSON  * @kcontrol: mixer control
3499dd7b10b3SKristoffer KARLSSON  * @ucontrol: control element information
3500dd7b10b3SKristoffer KARLSSON  *
3501dd7b10b3SKristoffer KARLSSON  * Callback strobe a register bit to high then low (or the inverse)
3502dd7b10b3SKristoffer KARLSSON  * in one pass of a single mixer enum control.
3503dd7b10b3SKristoffer KARLSSON  *
3504dd7b10b3SKristoffer KARLSSON  * Returns 1 for success.
3505dd7b10b3SKristoffer KARLSSON  */
3506dd7b10b3SKristoffer KARLSSON int snd_soc_put_strobe(struct snd_kcontrol *kcontrol,
3507dd7b10b3SKristoffer KARLSSON 	struct snd_ctl_elem_value *ucontrol)
3508dd7b10b3SKristoffer KARLSSON {
3509dd7b10b3SKristoffer KARLSSON 	struct soc_mixer_control *mc =
3510dd7b10b3SKristoffer KARLSSON 		(struct soc_mixer_control *)kcontrol->private_value;
3511dd7b10b3SKristoffer KARLSSON 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3512dd7b10b3SKristoffer KARLSSON 	unsigned int reg = mc->reg;
3513dd7b10b3SKristoffer KARLSSON 	unsigned int shift = mc->shift;
3514dd7b10b3SKristoffer KARLSSON 	unsigned int mask = 1 << shift;
3515dd7b10b3SKristoffer KARLSSON 	unsigned int invert = mc->invert != 0;
3516dd7b10b3SKristoffer KARLSSON 	unsigned int strobe = ucontrol->value.enumerated.item[0] != 0;
3517dd7b10b3SKristoffer KARLSSON 	unsigned int val1 = (strobe ^ invert) ? mask : 0;
3518dd7b10b3SKristoffer KARLSSON 	unsigned int val2 = (strobe ^ invert) ? 0 : mask;
3519dd7b10b3SKristoffer KARLSSON 	int err;
3520dd7b10b3SKristoffer KARLSSON 
3521dd7b10b3SKristoffer KARLSSON 	err = snd_soc_update_bits_locked(codec, reg, mask, val1);
3522dd7b10b3SKristoffer KARLSSON 	if (err < 0)
3523dd7b10b3SKristoffer KARLSSON 		return err;
3524dd7b10b3SKristoffer KARLSSON 
3525dd7b10b3SKristoffer KARLSSON 	err = snd_soc_update_bits_locked(codec, reg, mask, val2);
3526dd7b10b3SKristoffer KARLSSON 	return err;
3527dd7b10b3SKristoffer KARLSSON }
3528dd7b10b3SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_put_strobe);
3529dd7b10b3SKristoffer KARLSSON 
3530dd7b10b3SKristoffer KARLSSON /**
35318c6529dbSLiam Girdwood  * snd_soc_dai_set_sysclk - configure DAI system or master clock.
35328c6529dbSLiam Girdwood  * @dai: DAI
35338c6529dbSLiam Girdwood  * @clk_id: DAI specific clock ID
35348c6529dbSLiam Girdwood  * @freq: new clock frequency in Hz
35358c6529dbSLiam Girdwood  * @dir: new clock direction - input/output.
35368c6529dbSLiam Girdwood  *
35378c6529dbSLiam Girdwood  * Configures the DAI master (MCLK) or system (SYSCLK) clocking.
35388c6529dbSLiam Girdwood  */
35398c6529dbSLiam Girdwood int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
35408c6529dbSLiam Girdwood 	unsigned int freq, int dir)
35418c6529dbSLiam Girdwood {
3542f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_sysclk)
3543f0fba2adSLiam Girdwood 		return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir);
3544ec4ee52aSMark Brown 	else if (dai->codec && dai->codec->driver->set_sysclk)
3545da1c6ea6SMark Brown 		return dai->codec->driver->set_sysclk(dai->codec, clk_id, 0,
3546ec4ee52aSMark Brown 						      freq, dir);
35478c6529dbSLiam Girdwood 	else
35481104a9c8SMark Brown 		return -ENOTSUPP;
35498c6529dbSLiam Girdwood }
35508c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
35518c6529dbSLiam Girdwood 
35528c6529dbSLiam Girdwood /**
3553ec4ee52aSMark Brown  * snd_soc_codec_set_sysclk - configure CODEC system or master clock.
3554ec4ee52aSMark Brown  * @codec: CODEC
3555ec4ee52aSMark Brown  * @clk_id: DAI specific clock ID
3556da1c6ea6SMark Brown  * @source: Source for the clock
3557ec4ee52aSMark Brown  * @freq: new clock frequency in Hz
3558ec4ee52aSMark Brown  * @dir: new clock direction - input/output.
3559ec4ee52aSMark Brown  *
3560ec4ee52aSMark Brown  * Configures the CODEC master (MCLK) or system (SYSCLK) clocking.
3561ec4ee52aSMark Brown  */
3562ec4ee52aSMark Brown int snd_soc_codec_set_sysclk(struct snd_soc_codec *codec, int clk_id,
3563da1c6ea6SMark Brown 			     int source, unsigned int freq, int dir)
3564ec4ee52aSMark Brown {
3565ec4ee52aSMark Brown 	if (codec->driver->set_sysclk)
3566da1c6ea6SMark Brown 		return codec->driver->set_sysclk(codec, clk_id, source,
3567da1c6ea6SMark Brown 						 freq, dir);
3568ec4ee52aSMark Brown 	else
35691104a9c8SMark Brown 		return -ENOTSUPP;
3570ec4ee52aSMark Brown }
3571ec4ee52aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_codec_set_sysclk);
3572ec4ee52aSMark Brown 
3573ec4ee52aSMark Brown /**
35748c6529dbSLiam Girdwood  * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
35758c6529dbSLiam Girdwood  * @dai: DAI
3576ac11a2b3SMark Brown  * @div_id: DAI specific clock divider ID
35778c6529dbSLiam Girdwood  * @div: new clock divisor.
35788c6529dbSLiam Girdwood  *
35798c6529dbSLiam Girdwood  * Configures the clock dividers. This is used to derive the best DAI bit and
35808c6529dbSLiam Girdwood  * frame clocks from the system or master clock. It's best to set the DAI bit
35818c6529dbSLiam Girdwood  * and frame clocks as low as possible to save system power.
35828c6529dbSLiam Girdwood  */
35838c6529dbSLiam Girdwood int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
35848c6529dbSLiam Girdwood 	int div_id, int div)
35858c6529dbSLiam Girdwood {
3586f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_clkdiv)
3587f0fba2adSLiam Girdwood 		return dai->driver->ops->set_clkdiv(dai, div_id, div);
35888c6529dbSLiam Girdwood 	else
35898c6529dbSLiam Girdwood 		return -EINVAL;
35908c6529dbSLiam Girdwood }
35918c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv);
35928c6529dbSLiam Girdwood 
35938c6529dbSLiam Girdwood /**
35948c6529dbSLiam Girdwood  * snd_soc_dai_set_pll - configure DAI PLL.
35958c6529dbSLiam Girdwood  * @dai: DAI
35968c6529dbSLiam Girdwood  * @pll_id: DAI specific PLL ID
359785488037SMark Brown  * @source: DAI specific source for the PLL
35988c6529dbSLiam Girdwood  * @freq_in: PLL input clock frequency in Hz
35998c6529dbSLiam Girdwood  * @freq_out: requested PLL output clock frequency in Hz
36008c6529dbSLiam Girdwood  *
36018c6529dbSLiam Girdwood  * Configures and enables PLL to generate output clock based on input clock.
36028c6529dbSLiam Girdwood  */
360385488037SMark Brown int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
360485488037SMark Brown 	unsigned int freq_in, unsigned int freq_out)
36058c6529dbSLiam Girdwood {
3606f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_pll)
3607f0fba2adSLiam Girdwood 		return dai->driver->ops->set_pll(dai, pll_id, source,
360885488037SMark Brown 					 freq_in, freq_out);
3609ec4ee52aSMark Brown 	else if (dai->codec && dai->codec->driver->set_pll)
3610ec4ee52aSMark Brown 		return dai->codec->driver->set_pll(dai->codec, pll_id, source,
3611ec4ee52aSMark Brown 						   freq_in, freq_out);
36128c6529dbSLiam Girdwood 	else
36138c6529dbSLiam Girdwood 		return -EINVAL;
36148c6529dbSLiam Girdwood }
36158c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
36168c6529dbSLiam Girdwood 
3617ec4ee52aSMark Brown /*
3618ec4ee52aSMark Brown  * snd_soc_codec_set_pll - configure codec PLL.
3619ec4ee52aSMark Brown  * @codec: CODEC
3620ec4ee52aSMark Brown  * @pll_id: DAI specific PLL ID
3621ec4ee52aSMark Brown  * @source: DAI specific source for the PLL
3622ec4ee52aSMark Brown  * @freq_in: PLL input clock frequency in Hz
3623ec4ee52aSMark Brown  * @freq_out: requested PLL output clock frequency in Hz
3624ec4ee52aSMark Brown  *
3625ec4ee52aSMark Brown  * Configures and enables PLL to generate output clock based on input clock.
3626ec4ee52aSMark Brown  */
3627ec4ee52aSMark Brown int snd_soc_codec_set_pll(struct snd_soc_codec *codec, int pll_id, int source,
3628ec4ee52aSMark Brown 			  unsigned int freq_in, unsigned int freq_out)
3629ec4ee52aSMark Brown {
3630ec4ee52aSMark Brown 	if (codec->driver->set_pll)
3631ec4ee52aSMark Brown 		return codec->driver->set_pll(codec, pll_id, source,
3632ec4ee52aSMark Brown 					      freq_in, freq_out);
3633ec4ee52aSMark Brown 	else
3634ec4ee52aSMark Brown 		return -EINVAL;
3635ec4ee52aSMark Brown }
3636ec4ee52aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_codec_set_pll);
3637ec4ee52aSMark Brown 
36388c6529dbSLiam Girdwood /**
3639e54cf76bSLiam Girdwood  * snd_soc_dai_set_bclk_ratio - configure BCLK to sample rate ratio.
3640e54cf76bSLiam Girdwood  * @dai: DAI
3641e54cf76bSLiam Girdwood  * @ratio Ratio of BCLK to Sample rate.
3642e54cf76bSLiam Girdwood  *
3643e54cf76bSLiam Girdwood  * Configures the DAI for a preset BCLK to sample rate ratio.
3644e54cf76bSLiam Girdwood  */
3645e54cf76bSLiam Girdwood int snd_soc_dai_set_bclk_ratio(struct snd_soc_dai *dai, unsigned int ratio)
3646e54cf76bSLiam Girdwood {
3647e54cf76bSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_bclk_ratio)
3648e54cf76bSLiam Girdwood 		return dai->driver->ops->set_bclk_ratio(dai, ratio);
3649e54cf76bSLiam Girdwood 	else
3650e54cf76bSLiam Girdwood 		return -EINVAL;
3651e54cf76bSLiam Girdwood }
3652e54cf76bSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_bclk_ratio);
3653e54cf76bSLiam Girdwood 
3654e54cf76bSLiam Girdwood /**
36558c6529dbSLiam Girdwood  * snd_soc_dai_set_fmt - configure DAI hardware audio format.
36568c6529dbSLiam Girdwood  * @dai: DAI
36578c6529dbSLiam Girdwood  * @fmt: SND_SOC_DAIFMT_ format value.
36588c6529dbSLiam Girdwood  *
36598c6529dbSLiam Girdwood  * Configures the DAI hardware format and clocking.
36608c6529dbSLiam Girdwood  */
36618c6529dbSLiam Girdwood int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
36628c6529dbSLiam Girdwood {
36635e4ba569SShawn Guo 	if (dai->driver == NULL)
36648c6529dbSLiam Girdwood 		return -EINVAL;
36655e4ba569SShawn Guo 	if (dai->driver->ops->set_fmt == NULL)
36665e4ba569SShawn Guo 		return -ENOTSUPP;
36675e4ba569SShawn Guo 	return dai->driver->ops->set_fmt(dai, fmt);
36688c6529dbSLiam Girdwood }
36698c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
36708c6529dbSLiam Girdwood 
36718c6529dbSLiam Girdwood /**
36728c6529dbSLiam Girdwood  * snd_soc_dai_set_tdm_slot - configure DAI TDM.
36738c6529dbSLiam Girdwood  * @dai: DAI
3674a5479e38SDaniel Ribeiro  * @tx_mask: bitmask representing active TX slots.
3675a5479e38SDaniel Ribeiro  * @rx_mask: bitmask representing active RX slots.
36768c6529dbSLiam Girdwood  * @slots: Number of slots in use.
3677a5479e38SDaniel Ribeiro  * @slot_width: Width in bits for each slot.
36788c6529dbSLiam Girdwood  *
36798c6529dbSLiam Girdwood  * Configures a DAI for TDM operation. Both mask and slots are codec and DAI
36808c6529dbSLiam Girdwood  * specific.
36818c6529dbSLiam Girdwood  */
36828c6529dbSLiam Girdwood int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
3683a5479e38SDaniel Ribeiro 	unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
36848c6529dbSLiam Girdwood {
3685f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_tdm_slot)
3686f0fba2adSLiam Girdwood 		return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask,
3687a5479e38SDaniel Ribeiro 				slots, slot_width);
36888c6529dbSLiam Girdwood 	else
36898c6529dbSLiam Girdwood 		return -EINVAL;
36908c6529dbSLiam Girdwood }
36918c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
36928c6529dbSLiam Girdwood 
36938c6529dbSLiam Girdwood /**
3694472df3cbSBarry Song  * snd_soc_dai_set_channel_map - configure DAI audio channel map
3695472df3cbSBarry Song  * @dai: DAI
3696472df3cbSBarry Song  * @tx_num: how many TX channels
3697472df3cbSBarry Song  * @tx_slot: pointer to an array which imply the TX slot number channel
3698472df3cbSBarry Song  *           0~num-1 uses
3699472df3cbSBarry Song  * @rx_num: how many RX channels
3700472df3cbSBarry Song  * @rx_slot: pointer to an array which imply the RX slot number channel
3701472df3cbSBarry Song  *           0~num-1 uses
3702472df3cbSBarry Song  *
3703472df3cbSBarry Song  * configure the relationship between channel number and TDM slot number.
3704472df3cbSBarry Song  */
3705472df3cbSBarry Song int snd_soc_dai_set_channel_map(struct snd_soc_dai *dai,
3706472df3cbSBarry Song 	unsigned int tx_num, unsigned int *tx_slot,
3707472df3cbSBarry Song 	unsigned int rx_num, unsigned int *rx_slot)
3708472df3cbSBarry Song {
3709f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_channel_map)
3710f0fba2adSLiam Girdwood 		return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot,
3711472df3cbSBarry Song 			rx_num, rx_slot);
3712472df3cbSBarry Song 	else
3713472df3cbSBarry Song 		return -EINVAL;
3714472df3cbSBarry Song }
3715472df3cbSBarry Song EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map);
3716472df3cbSBarry Song 
3717472df3cbSBarry Song /**
37188c6529dbSLiam Girdwood  * snd_soc_dai_set_tristate - configure DAI system or master clock.
37198c6529dbSLiam Girdwood  * @dai: DAI
37208c6529dbSLiam Girdwood  * @tristate: tristate enable
37218c6529dbSLiam Girdwood  *
37228c6529dbSLiam Girdwood  * Tristates the DAI so that others can use it.
37238c6529dbSLiam Girdwood  */
37248c6529dbSLiam Girdwood int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
37258c6529dbSLiam Girdwood {
3726f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_tristate)
3727f0fba2adSLiam Girdwood 		return dai->driver->ops->set_tristate(dai, tristate);
37288c6529dbSLiam Girdwood 	else
37298c6529dbSLiam Girdwood 		return -EINVAL;
37308c6529dbSLiam Girdwood }
37318c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate);
37328c6529dbSLiam Girdwood 
37338c6529dbSLiam Girdwood /**
37348c6529dbSLiam Girdwood  * snd_soc_dai_digital_mute - configure DAI system or master clock.
37358c6529dbSLiam Girdwood  * @dai: DAI
37368c6529dbSLiam Girdwood  * @mute: mute enable
3737da18396fSMark Brown  * @direction: stream to mute
37388c6529dbSLiam Girdwood  *
37398c6529dbSLiam Girdwood  * Mutes the DAI DAC.
37408c6529dbSLiam Girdwood  */
3741da18396fSMark Brown int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute,
3742da18396fSMark Brown 			     int direction)
37438c6529dbSLiam Girdwood {
3744da18396fSMark Brown 	if (!dai->driver)
3745da18396fSMark Brown 		return -ENOTSUPP;
3746da18396fSMark Brown 
3747da18396fSMark Brown 	if (dai->driver->ops->mute_stream)
3748da18396fSMark Brown 		return dai->driver->ops->mute_stream(dai, mute, direction);
3749da18396fSMark Brown 	else if (direction == SNDRV_PCM_STREAM_PLAYBACK &&
3750da18396fSMark Brown 		 dai->driver->ops->digital_mute)
3751f0fba2adSLiam Girdwood 		return dai->driver->ops->digital_mute(dai, mute);
37528c6529dbSLiam Girdwood 	else
375304570c62SMark Brown 		return -ENOTSUPP;
37548c6529dbSLiam Girdwood }
37558c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
37568c6529dbSLiam Girdwood 
3757c5af3a2eSMark Brown /**
3758c5af3a2eSMark Brown  * snd_soc_register_card - Register a card with the ASoC core
3759c5af3a2eSMark Brown  *
3760ac11a2b3SMark Brown  * @card: Card to register
3761c5af3a2eSMark Brown  *
3762c5af3a2eSMark Brown  */
376370a7ca34SVinod Koul int snd_soc_register_card(struct snd_soc_card *card)
3764c5af3a2eSMark Brown {
3765b19e6e7bSMark Brown 	int i, ret;
3766f0fba2adSLiam Girdwood 
3767c5af3a2eSMark Brown 	if (!card->name || !card->dev)
3768c5af3a2eSMark Brown 		return -EINVAL;
3769c5af3a2eSMark Brown 
37705a504963SStephen Warren 	for (i = 0; i < card->num_links; i++) {
37715a504963SStephen Warren 		struct snd_soc_dai_link *link = &card->dai_link[i];
37725a504963SStephen Warren 
37735a504963SStephen Warren 		/*
37745a504963SStephen Warren 		 * Codec must be specified by 1 of name or OF node,
37755a504963SStephen Warren 		 * not both or neither.
37765a504963SStephen Warren 		 */
37775a504963SStephen Warren 		if (!!link->codec_name == !!link->codec_of_node) {
377810e8aa9aSMichał Mirosław 			dev_err(card->dev,
377910e8aa9aSMichał Mirosław 				"ASoC: Neither/both codec name/of_node are set for %s\n",
378010e8aa9aSMichał Mirosław 				link->name);
37815a504963SStephen Warren 			return -EINVAL;
37825a504963SStephen Warren 		}
3783bc92657aSStephen Warren 		/* Codec DAI name must be specified */
3784bc92657aSStephen Warren 		if (!link->codec_dai_name) {
378510e8aa9aSMichał Mirosław 			dev_err(card->dev,
378610e8aa9aSMichał Mirosław 				"ASoC: codec_dai_name not set for %s\n",
378710e8aa9aSMichał Mirosław 				link->name);
3788bc92657aSStephen Warren 			return -EINVAL;
3789bc92657aSStephen Warren 		}
37905a504963SStephen Warren 
37915a504963SStephen Warren 		/*
37925a504963SStephen Warren 		 * Platform may be specified by either name or OF node, but
37935a504963SStephen Warren 		 * can be left unspecified, and a dummy platform will be used.
37945a504963SStephen Warren 		 */
37955a504963SStephen Warren 		if (link->platform_name && link->platform_of_node) {
379610e8aa9aSMichał Mirosław 			dev_err(card->dev,
379710e8aa9aSMichał Mirosław 				"ASoC: Both platform name/of_node are set for %s\n",
379810e8aa9aSMichał Mirosław 				link->name);
37995a504963SStephen Warren 			return -EINVAL;
38005a504963SStephen Warren 		}
38015a504963SStephen Warren 
38025a504963SStephen Warren 		/*
3803bc92657aSStephen Warren 		 * CPU device may be specified by either name or OF node, but
3804bc92657aSStephen Warren 		 * can be left unspecified, and will be matched based on DAI
3805bc92657aSStephen Warren 		 * name alone..
38065a504963SStephen Warren 		 */
3807bc92657aSStephen Warren 		if (link->cpu_name && link->cpu_of_node) {
380810e8aa9aSMichał Mirosław 			dev_err(card->dev,
380910e8aa9aSMichał Mirosław 				"ASoC: Neither/both cpu name/of_node are set for %s\n",
381010e8aa9aSMichał Mirosław 				link->name);
3811bc92657aSStephen Warren 			return -EINVAL;
3812bc92657aSStephen Warren 		}
3813bc92657aSStephen Warren 		/*
3814bc92657aSStephen Warren 		 * At least one of CPU DAI name or CPU device name/node must be
3815bc92657aSStephen Warren 		 * specified
3816bc92657aSStephen Warren 		 */
3817bc92657aSStephen Warren 		if (!link->cpu_dai_name &&
3818bc92657aSStephen Warren 		    !(link->cpu_name || link->cpu_of_node)) {
381910e8aa9aSMichał Mirosław 			dev_err(card->dev,
382010e8aa9aSMichał Mirosław 				"ASoC: Neither cpu_dai_name nor cpu_name/of_node are set for %s\n",
382110e8aa9aSMichał Mirosław 				link->name);
38225a504963SStephen Warren 			return -EINVAL;
38235a504963SStephen Warren 		}
38245a504963SStephen Warren 	}
38255a504963SStephen Warren 
3826ed77cc12SMark Brown 	dev_set_drvdata(card->dev, card);
3827ed77cc12SMark Brown 
3828111c6419SStephen Warren 	snd_soc_initialize_card_lists(card);
3829111c6419SStephen Warren 
3830150dd2f8SVinod Koul 	soc_init_card_debugfs(card);
3831150dd2f8SVinod Koul 
3832181a6892SMark Brown 	card->rtd = devm_kzalloc(card->dev,
3833181a6892SMark Brown 				 sizeof(struct snd_soc_pcm_runtime) *
38342eea392dSJarkko Nikula 				 (card->num_links + card->num_aux_devs),
3835f0fba2adSLiam Girdwood 				 GFP_KERNEL);
3836f0fba2adSLiam Girdwood 	if (card->rtd == NULL)
3837f0fba2adSLiam Girdwood 		return -ENOMEM;
3838a7dbb603SLiam Girdwood 	card->num_rtd = 0;
38392eea392dSJarkko Nikula 	card->rtd_aux = &card->rtd[card->num_links];
3840f0fba2adSLiam Girdwood 
3841f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_links; i++)
3842f0fba2adSLiam Girdwood 		card->rtd[i].dai_link = &card->dai_link[i];
3843f0fba2adSLiam Girdwood 
3844c5af3a2eSMark Brown 	INIT_LIST_HEAD(&card->list);
3845db432b41SMark Brown 	INIT_LIST_HEAD(&card->dapm_dirty);
3846c5af3a2eSMark Brown 	card->instantiated = 0;
3847f0fba2adSLiam Girdwood 	mutex_init(&card->mutex);
3848a73fb2dfSLiam Girdwood 	mutex_init(&card->dapm_mutex);
3849c5af3a2eSMark Brown 
3850b19e6e7bSMark Brown 	ret = snd_soc_instantiate_card(card);
3851b19e6e7bSMark Brown 	if (ret != 0)
3852b19e6e7bSMark Brown 		soc_cleanup_card_debugfs(card);
3853c5af3a2eSMark Brown 
3854988e8cc4SNicolin Chen 	/* deactivate pins to sleep state */
3855988e8cc4SNicolin Chen 	for (i = 0; i < card->num_rtd; i++) {
3856988e8cc4SNicolin Chen 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
3857988e8cc4SNicolin Chen 		struct snd_soc_dai *codec_dai = card->rtd[i].codec_dai;
3858988e8cc4SNicolin Chen 		if (!codec_dai->active)
3859988e8cc4SNicolin Chen 			pinctrl_pm_select_sleep_state(codec_dai->dev);
3860988e8cc4SNicolin Chen 		if (!cpu_dai->active)
3861988e8cc4SNicolin Chen 			pinctrl_pm_select_sleep_state(cpu_dai->dev);
3862988e8cc4SNicolin Chen 	}
3863988e8cc4SNicolin Chen 
3864b19e6e7bSMark Brown 	return ret;
3865c5af3a2eSMark Brown }
386670a7ca34SVinod Koul EXPORT_SYMBOL_GPL(snd_soc_register_card);
3867c5af3a2eSMark Brown 
3868c5af3a2eSMark Brown /**
3869c5af3a2eSMark Brown  * snd_soc_unregister_card - Unregister a card with the ASoC core
3870c5af3a2eSMark Brown  *
3871ac11a2b3SMark Brown  * @card: Card to unregister
3872c5af3a2eSMark Brown  *
3873c5af3a2eSMark Brown  */
387470a7ca34SVinod Koul int snd_soc_unregister_card(struct snd_soc_card *card)
3875c5af3a2eSMark Brown {
3876b0e26485SVinod Koul 	if (card->instantiated)
3877b0e26485SVinod Koul 		soc_cleanup_card_resources(card);
3878f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: Unregistered card '%s'\n", card->name);
3879c5af3a2eSMark Brown 
3880c5af3a2eSMark Brown 	return 0;
3881c5af3a2eSMark Brown }
388270a7ca34SVinod Koul EXPORT_SYMBOL_GPL(snd_soc_unregister_card);
3883c5af3a2eSMark Brown 
3884f0fba2adSLiam Girdwood /*
3885f0fba2adSLiam Girdwood  * Simplify DAI link configuration by removing ".-1" from device names
3886f0fba2adSLiam Girdwood  * and sanitizing names.
3887f0fba2adSLiam Girdwood  */
38880b9a214aSDimitris Papastamos static char *fmt_single_name(struct device *dev, int *id)
3889f0fba2adSLiam Girdwood {
3890f0fba2adSLiam Girdwood 	char *found, name[NAME_SIZE];
3891f0fba2adSLiam Girdwood 	int id1, id2;
3892f0fba2adSLiam Girdwood 
3893f0fba2adSLiam Girdwood 	if (dev_name(dev) == NULL)
3894f0fba2adSLiam Girdwood 		return NULL;
3895f0fba2adSLiam Girdwood 
389658818a77SDimitris Papastamos 	strlcpy(name, dev_name(dev), NAME_SIZE);
3897f0fba2adSLiam Girdwood 
3898f0fba2adSLiam Girdwood 	/* are we a "%s.%d" name (platform and SPI components) */
3899f0fba2adSLiam Girdwood 	found = strstr(name, dev->driver->name);
3900f0fba2adSLiam Girdwood 	if (found) {
3901f0fba2adSLiam Girdwood 		/* get ID */
3902f0fba2adSLiam Girdwood 		if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) {
3903f0fba2adSLiam Girdwood 
3904f0fba2adSLiam Girdwood 			/* discard ID from name if ID == -1 */
3905f0fba2adSLiam Girdwood 			if (*id == -1)
3906f0fba2adSLiam Girdwood 				found[strlen(dev->driver->name)] = '\0';
3907f0fba2adSLiam Girdwood 		}
3908f0fba2adSLiam Girdwood 
3909f0fba2adSLiam Girdwood 	} else {
3910f0fba2adSLiam Girdwood 		/* I2C component devices are named "bus-addr"  */
3911f0fba2adSLiam Girdwood 		if (sscanf(name, "%x-%x", &id1, &id2) == 2) {
3912f0fba2adSLiam Girdwood 			char tmp[NAME_SIZE];
3913f0fba2adSLiam Girdwood 
3914f0fba2adSLiam Girdwood 			/* create unique ID number from I2C addr and bus */
391505899446SJarkko Nikula 			*id = ((id1 & 0xffff) << 16) + id2;
3916f0fba2adSLiam Girdwood 
3917f0fba2adSLiam Girdwood 			/* sanitize component name for DAI link creation */
3918f0fba2adSLiam Girdwood 			snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name);
391958818a77SDimitris Papastamos 			strlcpy(name, tmp, NAME_SIZE);
3920f0fba2adSLiam Girdwood 		} else
3921f0fba2adSLiam Girdwood 			*id = 0;
3922f0fba2adSLiam Girdwood 	}
3923f0fba2adSLiam Girdwood 
3924f0fba2adSLiam Girdwood 	return kstrdup(name, GFP_KERNEL);
3925f0fba2adSLiam Girdwood }
3926f0fba2adSLiam Girdwood 
3927f0fba2adSLiam Girdwood /*
3928f0fba2adSLiam Girdwood  * Simplify DAI link naming for single devices with multiple DAIs by removing
3929f0fba2adSLiam Girdwood  * any ".-1" and using the DAI name (instead of device name).
3930f0fba2adSLiam Girdwood  */
3931f0fba2adSLiam Girdwood static inline char *fmt_multiple_name(struct device *dev,
3932f0fba2adSLiam Girdwood 		struct snd_soc_dai_driver *dai_drv)
3933f0fba2adSLiam Girdwood {
3934f0fba2adSLiam Girdwood 	if (dai_drv->name == NULL) {
393510e8aa9aSMichał Mirosław 		dev_err(dev,
393610e8aa9aSMichał Mirosław 			"ASoC: error - multiple DAI %s registered with no name\n",
393710e8aa9aSMichał Mirosław 			dev_name(dev));
3938f0fba2adSLiam Girdwood 		return NULL;
3939f0fba2adSLiam Girdwood 	}
3940f0fba2adSLiam Girdwood 
3941f0fba2adSLiam Girdwood 	return kstrdup(dai_drv->name, GFP_KERNEL);
3942f0fba2adSLiam Girdwood }
3943f0fba2adSLiam Girdwood 
39449115171aSMark Brown /**
39459115171aSMark Brown  * snd_soc_register_dai - Register a DAI with the ASoC core
39469115171aSMark Brown  *
3947ac11a2b3SMark Brown  * @dai: DAI to register
39489115171aSMark Brown  */
3949f53179c0SKuninori Morimoto static int snd_soc_register_dai(struct device *dev,
3950f0fba2adSLiam Girdwood 		struct snd_soc_dai_driver *dai_drv)
39519115171aSMark Brown {
3952054880feSMark Brown 	struct snd_soc_codec *codec;
3953f0fba2adSLiam Girdwood 	struct snd_soc_dai *dai;
39549115171aSMark Brown 
3955f110bfc7SLiam Girdwood 	dev_dbg(dev, "ASoC: dai register %s\n", dev_name(dev));
39569115171aSMark Brown 
3957f0fba2adSLiam Girdwood 	dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
3958f0fba2adSLiam Girdwood 	if (dai == NULL)
3959f0fba2adSLiam Girdwood 		return -ENOMEM;
39606335d055SEric Miao 
3961f0fba2adSLiam Girdwood 	/* create DAI component name */
3962f0fba2adSLiam Girdwood 	dai->name = fmt_single_name(dev, &dai->id);
3963f0fba2adSLiam Girdwood 	if (dai->name == NULL) {
3964f0fba2adSLiam Girdwood 		kfree(dai);
3965f0fba2adSLiam Girdwood 		return -ENOMEM;
3966f0fba2adSLiam Girdwood 	}
3967f0fba2adSLiam Girdwood 
3968f0fba2adSLiam Girdwood 	dai->dev = dev;
3969f0fba2adSLiam Girdwood 	dai->driver = dai_drv;
3970be09ad90SLiam Girdwood 	dai->dapm.dev = dev;
3971f0fba2adSLiam Girdwood 	if (!dai->driver->ops)
3972f0fba2adSLiam Girdwood 		dai->driver->ops = &null_dai_ops;
39739115171aSMark Brown 
39749115171aSMark Brown 	mutex_lock(&client_mutex);
3975054880feSMark Brown 
3976054880feSMark Brown 	list_for_each_entry(codec, &codec_list, list) {
3977054880feSMark Brown 		if (codec->dev == dev) {
3978f110bfc7SLiam Girdwood 			dev_dbg(dev, "ASoC: Mapped DAI %s to CODEC %s\n",
3979054880feSMark Brown 				dai->name, codec->name);
3980054880feSMark Brown 			dai->codec = codec;
3981054880feSMark Brown 			break;
3982054880feSMark Brown 		}
3983054880feSMark Brown 	}
3984054880feSMark Brown 
39855f800080SPeter Ujfalusi 	if (!dai->codec)
39865f800080SPeter Ujfalusi 		dai->dapm.idle_bias_off = 1;
39875f800080SPeter Ujfalusi 
39889115171aSMark Brown 	list_add(&dai->list, &dai_list);
3989054880feSMark Brown 
39909115171aSMark Brown 	mutex_unlock(&client_mutex);
39919115171aSMark Brown 
3992f110bfc7SLiam Girdwood 	dev_dbg(dev, "ASoC: Registered DAI '%s'\n", dai->name);
39939115171aSMark Brown 
39949115171aSMark Brown 	return 0;
39959115171aSMark Brown }
39969115171aSMark Brown 
39979115171aSMark Brown /**
39989115171aSMark Brown  * snd_soc_unregister_dai - Unregister a DAI from the ASoC core
39999115171aSMark Brown  *
4000ac11a2b3SMark Brown  * @dai: DAI to unregister
40019115171aSMark Brown  */
4002f53179c0SKuninori Morimoto static void snd_soc_unregister_dai(struct device *dev)
40039115171aSMark Brown {
4004f0fba2adSLiam Girdwood 	struct snd_soc_dai *dai;
4005f0fba2adSLiam Girdwood 
4006f0fba2adSLiam Girdwood 	list_for_each_entry(dai, &dai_list, list) {
4007f0fba2adSLiam Girdwood 		if (dev == dai->dev)
4008f0fba2adSLiam Girdwood 			goto found;
4009f0fba2adSLiam Girdwood 	}
4010f0fba2adSLiam Girdwood 	return;
4011f0fba2adSLiam Girdwood 
4012f0fba2adSLiam Girdwood found:
40139115171aSMark Brown 	mutex_lock(&client_mutex);
40149115171aSMark Brown 	list_del(&dai->list);
40159115171aSMark Brown 	mutex_unlock(&client_mutex);
40169115171aSMark Brown 
4017f110bfc7SLiam Girdwood 	dev_dbg(dev, "ASoC: Unregistered DAI '%s'\n", dai->name);
4018f0fba2adSLiam Girdwood 	kfree(dai->name);
4019f0fba2adSLiam Girdwood 	kfree(dai);
40209115171aSMark Brown }
40219115171aSMark Brown 
40229115171aSMark Brown /**
40239115171aSMark Brown  * snd_soc_register_dais - Register multiple DAIs with the ASoC core
40249115171aSMark Brown  *
4025ac11a2b3SMark Brown  * @dai: Array of DAIs to register
4026ac11a2b3SMark Brown  * @count: Number of DAIs
40279115171aSMark Brown  */
4028f53179c0SKuninori Morimoto static int snd_soc_register_dais(struct device *dev,
4029f0fba2adSLiam Girdwood 		struct snd_soc_dai_driver *dai_drv, size_t count)
40309115171aSMark Brown {
4031054880feSMark Brown 	struct snd_soc_codec *codec;
4032f0fba2adSLiam Girdwood 	struct snd_soc_dai *dai;
4033f0fba2adSLiam Girdwood 	int i, ret = 0;
4034f0fba2adSLiam Girdwood 
4035f110bfc7SLiam Girdwood 	dev_dbg(dev, "ASoC: dai register %s #%Zu\n", dev_name(dev), count);
40369115171aSMark Brown 
40379115171aSMark Brown 	for (i = 0; i < count; i++) {
4038f0fba2adSLiam Girdwood 
4039f0fba2adSLiam Girdwood 		dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
4040c46e0079SAxel Lin 		if (dai == NULL) {
4041c46e0079SAxel Lin 			ret = -ENOMEM;
4042c46e0079SAxel Lin 			goto err;
4043c46e0079SAxel Lin 		}
4044f0fba2adSLiam Girdwood 
4045f0fba2adSLiam Girdwood 		/* create DAI component name */
4046f0fba2adSLiam Girdwood 		dai->name = fmt_multiple_name(dev, &dai_drv[i]);
4047f0fba2adSLiam Girdwood 		if (dai->name == NULL) {
4048f0fba2adSLiam Girdwood 			kfree(dai);
4049f0fba2adSLiam Girdwood 			ret = -EINVAL;
40509115171aSMark Brown 			goto err;
40519115171aSMark Brown 		}
40529115171aSMark Brown 
4053f0fba2adSLiam Girdwood 		dai->dev = dev;
4054f0fba2adSLiam Girdwood 		dai->driver = &dai_drv[i];
40550f9141c9SMark Brown 		if (dai->driver->id)
40560f9141c9SMark Brown 			dai->id = dai->driver->id;
40570f9141c9SMark Brown 		else
40580f9141c9SMark Brown 			dai->id = i;
4059be09ad90SLiam Girdwood 		dai->dapm.dev = dev;
4060f0fba2adSLiam Girdwood 		if (!dai->driver->ops)
4061f0fba2adSLiam Girdwood 			dai->driver->ops = &null_dai_ops;
4062f0fba2adSLiam Girdwood 
4063f0fba2adSLiam Girdwood 		mutex_lock(&client_mutex);
4064054880feSMark Brown 
4065054880feSMark Brown 		list_for_each_entry(codec, &codec_list, list) {
4066054880feSMark Brown 			if (codec->dev == dev) {
406710e8aa9aSMichał Mirosław 				dev_dbg(dev,
406810e8aa9aSMichał Mirosław 					"ASoC: Mapped DAI %s to CODEC %s\n",
406910e8aa9aSMichał Mirosław 					dai->name, codec->name);
4070054880feSMark Brown 				dai->codec = codec;
4071054880feSMark Brown 				break;
4072054880feSMark Brown 			}
4073054880feSMark Brown 		}
4074054880feSMark Brown 
40755f800080SPeter Ujfalusi 		if (!dai->codec)
40765f800080SPeter Ujfalusi 			dai->dapm.idle_bias_off = 1;
40775f800080SPeter Ujfalusi 
4078f0fba2adSLiam Girdwood 		list_add(&dai->list, &dai_list);
4079054880feSMark Brown 
4080f0fba2adSLiam Girdwood 		mutex_unlock(&client_mutex);
4081f0fba2adSLiam Girdwood 
4082f110bfc7SLiam Girdwood 		dev_dbg(dai->dev, "ASoC: Registered DAI '%s'\n", dai->name);
4083f0fba2adSLiam Girdwood 	}
4084f0fba2adSLiam Girdwood 
40859115171aSMark Brown 	return 0;
40869115171aSMark Brown 
40879115171aSMark Brown err:
40889115171aSMark Brown 	for (i--; i >= 0; i--)
4089f0fba2adSLiam Girdwood 		snd_soc_unregister_dai(dev);
40909115171aSMark Brown 
40919115171aSMark Brown 	return ret;
40929115171aSMark Brown }
40939115171aSMark Brown 
40949115171aSMark Brown /**
40959115171aSMark Brown  * snd_soc_unregister_dais - Unregister multiple DAIs from the ASoC core
40969115171aSMark Brown  *
4097ac11a2b3SMark Brown  * @dai: Array of DAIs to unregister
4098ac11a2b3SMark Brown  * @count: Number of DAIs
40999115171aSMark Brown  */
4100f53179c0SKuninori Morimoto static void snd_soc_unregister_dais(struct device *dev, size_t count)
41019115171aSMark Brown {
41029115171aSMark Brown 	int i;
41039115171aSMark Brown 
41049115171aSMark Brown 	for (i = 0; i < count; i++)
4105f0fba2adSLiam Girdwood 		snd_soc_unregister_dai(dev);
41069115171aSMark Brown }
41079115171aSMark Brown 
410812a48a8cSMark Brown /**
4109d191bd8dSKuninori Morimoto  * snd_soc_register_component - Register a component with the ASoC core
4110d191bd8dSKuninori Morimoto  *
4111d191bd8dSKuninori Morimoto  */
4112d191bd8dSKuninori Morimoto static int
4113d191bd8dSKuninori Morimoto __snd_soc_register_component(struct device *dev,
4114d191bd8dSKuninori Morimoto 			     struct snd_soc_component *cmpnt,
4115d191bd8dSKuninori Morimoto 			     const struct snd_soc_component_driver *cmpnt_drv,
4116d191bd8dSKuninori Morimoto 			     struct snd_soc_dai_driver *dai_drv,
4117d191bd8dSKuninori Morimoto 			     int num_dai, bool allow_single_dai)
4118d191bd8dSKuninori Morimoto {
4119d191bd8dSKuninori Morimoto 	int ret;
4120d191bd8dSKuninori Morimoto 
4121d191bd8dSKuninori Morimoto 	dev_dbg(dev, "component register %s\n", dev_name(dev));
4122d191bd8dSKuninori Morimoto 
4123d191bd8dSKuninori Morimoto 	if (!cmpnt) {
4124d191bd8dSKuninori Morimoto 		dev_err(dev, "ASoC: Failed to connecting component\n");
4125d191bd8dSKuninori Morimoto 		return -ENOMEM;
4126d191bd8dSKuninori Morimoto 	}
4127d191bd8dSKuninori Morimoto 
4128d191bd8dSKuninori Morimoto 	cmpnt->name = fmt_single_name(dev, &cmpnt->id);
4129d191bd8dSKuninori Morimoto 	if (!cmpnt->name) {
4130d191bd8dSKuninori Morimoto 		dev_err(dev, "ASoC: Failed to simplifying name\n");
4131d191bd8dSKuninori Morimoto 		return -ENOMEM;
4132d191bd8dSKuninori Morimoto 	}
4133d191bd8dSKuninori Morimoto 
4134d191bd8dSKuninori Morimoto 	cmpnt->dev	= dev;
4135d191bd8dSKuninori Morimoto 	cmpnt->driver	= cmpnt_drv;
41366833c452SKuninori Morimoto 	cmpnt->dai_drv	= dai_drv;
4137d191bd8dSKuninori Morimoto 	cmpnt->num_dai	= num_dai;
4138d191bd8dSKuninori Morimoto 
4139d191bd8dSKuninori Morimoto 	/*
4140d191bd8dSKuninori Morimoto 	 * snd_soc_register_dai()  uses fmt_single_name(), and
4141d191bd8dSKuninori Morimoto 	 * snd_soc_register_dais() uses fmt_multiple_name()
4142d191bd8dSKuninori Morimoto 	 * for dai->name which is used for name based matching
4143d191bd8dSKuninori Morimoto 	 *
4144d191bd8dSKuninori Morimoto 	 * this function is used from cpu/codec.
4145d191bd8dSKuninori Morimoto 	 * allow_single_dai flag can ignore "codec" driver reworking
4146d191bd8dSKuninori Morimoto 	 * since it had been used snd_soc_register_dais(),
4147d191bd8dSKuninori Morimoto 	 */
4148d191bd8dSKuninori Morimoto 	if ((1 == num_dai) && allow_single_dai)
4149d191bd8dSKuninori Morimoto 		ret = snd_soc_register_dai(dev, dai_drv);
4150d191bd8dSKuninori Morimoto 	else
4151d191bd8dSKuninori Morimoto 		ret = snd_soc_register_dais(dev, dai_drv, num_dai);
4152d191bd8dSKuninori Morimoto 	if (ret < 0) {
4153d191bd8dSKuninori Morimoto 		dev_err(dev, "ASoC: Failed to regster DAIs: %d\n", ret);
4154d191bd8dSKuninori Morimoto 		goto error_component_name;
4155d191bd8dSKuninori Morimoto 	}
4156d191bd8dSKuninori Morimoto 
4157d191bd8dSKuninori Morimoto 	mutex_lock(&client_mutex);
4158d191bd8dSKuninori Morimoto 	list_add(&cmpnt->list, &component_list);
4159d191bd8dSKuninori Morimoto 	mutex_unlock(&client_mutex);
4160d191bd8dSKuninori Morimoto 
4161d191bd8dSKuninori Morimoto 	dev_dbg(cmpnt->dev, "ASoC: Registered component '%s'\n", cmpnt->name);
4162d191bd8dSKuninori Morimoto 
4163d191bd8dSKuninori Morimoto 	return ret;
4164d191bd8dSKuninori Morimoto 
4165d191bd8dSKuninori Morimoto error_component_name:
4166d191bd8dSKuninori Morimoto 	kfree(cmpnt->name);
4167d191bd8dSKuninori Morimoto 
4168d191bd8dSKuninori Morimoto 	return ret;
4169d191bd8dSKuninori Morimoto }
4170d191bd8dSKuninori Morimoto 
4171d191bd8dSKuninori Morimoto int snd_soc_register_component(struct device *dev,
4172d191bd8dSKuninori Morimoto 			       const struct snd_soc_component_driver *cmpnt_drv,
4173d191bd8dSKuninori Morimoto 			       struct snd_soc_dai_driver *dai_drv,
4174d191bd8dSKuninori Morimoto 			       int num_dai)
4175d191bd8dSKuninori Morimoto {
4176d191bd8dSKuninori Morimoto 	struct snd_soc_component *cmpnt;
4177d191bd8dSKuninori Morimoto 
4178d191bd8dSKuninori Morimoto 	cmpnt = devm_kzalloc(dev, sizeof(*cmpnt), GFP_KERNEL);
4179d191bd8dSKuninori Morimoto 	if (!cmpnt) {
4180d191bd8dSKuninori Morimoto 		dev_err(dev, "ASoC: Failed to allocate memory\n");
4181d191bd8dSKuninori Morimoto 		return -ENOMEM;
4182d191bd8dSKuninori Morimoto 	}
4183d191bd8dSKuninori Morimoto 
4184d191bd8dSKuninori Morimoto 	return __snd_soc_register_component(dev, cmpnt, cmpnt_drv,
4185d191bd8dSKuninori Morimoto 					    dai_drv, num_dai, true);
4186d191bd8dSKuninori Morimoto }
4187d191bd8dSKuninori Morimoto EXPORT_SYMBOL_GPL(snd_soc_register_component);
4188d191bd8dSKuninori Morimoto 
4189d191bd8dSKuninori Morimoto /**
4190d191bd8dSKuninori Morimoto  * snd_soc_unregister_component - Unregister a component from the ASoC core
4191d191bd8dSKuninori Morimoto  *
4192d191bd8dSKuninori Morimoto  */
4193d191bd8dSKuninori Morimoto void snd_soc_unregister_component(struct device *dev)
4194d191bd8dSKuninori Morimoto {
4195d191bd8dSKuninori Morimoto 	struct snd_soc_component *cmpnt;
4196d191bd8dSKuninori Morimoto 
4197d191bd8dSKuninori Morimoto 	list_for_each_entry(cmpnt, &component_list, list) {
4198d191bd8dSKuninori Morimoto 		if (dev == cmpnt->dev)
4199d191bd8dSKuninori Morimoto 			goto found;
4200d191bd8dSKuninori Morimoto 	}
4201d191bd8dSKuninori Morimoto 	return;
4202d191bd8dSKuninori Morimoto 
4203d191bd8dSKuninori Morimoto found:
4204d191bd8dSKuninori Morimoto 	snd_soc_unregister_dais(dev, cmpnt->num_dai);
4205d191bd8dSKuninori Morimoto 
4206d191bd8dSKuninori Morimoto 	mutex_lock(&client_mutex);
4207d191bd8dSKuninori Morimoto 	list_del(&cmpnt->list);
4208d191bd8dSKuninori Morimoto 	mutex_unlock(&client_mutex);
4209d191bd8dSKuninori Morimoto 
4210d191bd8dSKuninori Morimoto 	dev_dbg(dev, "ASoC: Unregistered component '%s'\n", cmpnt->name);
4211d191bd8dSKuninori Morimoto 	kfree(cmpnt->name);
4212d191bd8dSKuninori Morimoto }
4213d191bd8dSKuninori Morimoto EXPORT_SYMBOL_GPL(snd_soc_unregister_component);
4214d191bd8dSKuninori Morimoto 
4215d191bd8dSKuninori Morimoto /**
421671a45cdaSLars-Peter Clausen  * snd_soc_add_platform - Add a platform to the ASoC core
421771a45cdaSLars-Peter Clausen  * @dev: The parent device for the platform
421871a45cdaSLars-Peter Clausen  * @platform: The platform to add
421971a45cdaSLars-Peter Clausen  * @platform_driver: The driver for the platform
422012a48a8cSMark Brown  */
422171a45cdaSLars-Peter Clausen int snd_soc_add_platform(struct device *dev, struct snd_soc_platform *platform,
4222d79e57dbSLars-Peter Clausen 		const struct snd_soc_platform_driver *platform_drv)
422312a48a8cSMark Brown {
4224f0fba2adSLiam Girdwood 	/* create platform component name */
4225f0fba2adSLiam Girdwood 	platform->name = fmt_single_name(dev, &platform->id);
4226b5c745fbSDan Carpenter 	if (platform->name == NULL)
4227f0fba2adSLiam Girdwood 		return -ENOMEM;
4228f0fba2adSLiam Girdwood 
4229f0fba2adSLiam Girdwood 	platform->dev = dev;
4230f0fba2adSLiam Girdwood 	platform->driver = platform_drv;
4231b7950641SLiam Girdwood 	platform->dapm.dev = dev;
4232b7950641SLiam Girdwood 	platform->dapm.platform = platform;
423364a648c2SLiam Girdwood 	platform->dapm.stream_event = platform_drv->stream_event;
4234cc22d37eSLiam Girdwood 	mutex_init(&platform->mutex);
423512a48a8cSMark Brown 
423612a48a8cSMark Brown 	mutex_lock(&client_mutex);
423712a48a8cSMark Brown 	list_add(&platform->list, &platform_list);
423812a48a8cSMark Brown 	mutex_unlock(&client_mutex);
423912a48a8cSMark Brown 
4240f110bfc7SLiam Girdwood 	dev_dbg(dev, "ASoC: Registered platform '%s'\n", platform->name);
424112a48a8cSMark Brown 
424212a48a8cSMark Brown 	return 0;
424312a48a8cSMark Brown }
424471a45cdaSLars-Peter Clausen EXPORT_SYMBOL_GPL(snd_soc_add_platform);
424571a45cdaSLars-Peter Clausen 
424671a45cdaSLars-Peter Clausen /**
424771a45cdaSLars-Peter Clausen  * snd_soc_register_platform - Register a platform with the ASoC core
424871a45cdaSLars-Peter Clausen  *
424971a45cdaSLars-Peter Clausen  * @platform: platform to register
425071a45cdaSLars-Peter Clausen  */
425171a45cdaSLars-Peter Clausen int snd_soc_register_platform(struct device *dev,
425271a45cdaSLars-Peter Clausen 		const struct snd_soc_platform_driver *platform_drv)
425371a45cdaSLars-Peter Clausen {
425471a45cdaSLars-Peter Clausen 	struct snd_soc_platform *platform;
425571a45cdaSLars-Peter Clausen 	int ret;
425671a45cdaSLars-Peter Clausen 
425771a45cdaSLars-Peter Clausen 	dev_dbg(dev, "ASoC: platform register %s\n", dev_name(dev));
425871a45cdaSLars-Peter Clausen 
425971a45cdaSLars-Peter Clausen 	platform = kzalloc(sizeof(struct snd_soc_platform), GFP_KERNEL);
426071a45cdaSLars-Peter Clausen 	if (platform == NULL)
426171a45cdaSLars-Peter Clausen 		return -ENOMEM;
426271a45cdaSLars-Peter Clausen 
426371a45cdaSLars-Peter Clausen 	ret = snd_soc_add_platform(dev, platform, platform_drv);
426471a45cdaSLars-Peter Clausen 	if (ret)
426571a45cdaSLars-Peter Clausen 		kfree(platform);
426671a45cdaSLars-Peter Clausen 
426771a45cdaSLars-Peter Clausen 	return ret;
426871a45cdaSLars-Peter Clausen }
426912a48a8cSMark Brown EXPORT_SYMBOL_GPL(snd_soc_register_platform);
427012a48a8cSMark Brown 
427112a48a8cSMark Brown /**
427271a45cdaSLars-Peter Clausen  * snd_soc_remove_platform - Remove a platform from the ASoC core
427371a45cdaSLars-Peter Clausen  * @platform: the platform to remove
427471a45cdaSLars-Peter Clausen  */
427571a45cdaSLars-Peter Clausen void snd_soc_remove_platform(struct snd_soc_platform *platform)
427671a45cdaSLars-Peter Clausen {
427771a45cdaSLars-Peter Clausen 	mutex_lock(&client_mutex);
427871a45cdaSLars-Peter Clausen 	list_del(&platform->list);
427971a45cdaSLars-Peter Clausen 	mutex_unlock(&client_mutex);
428071a45cdaSLars-Peter Clausen 
428171a45cdaSLars-Peter Clausen 	dev_dbg(platform->dev, "ASoC: Unregistered platform '%s'\n",
428271a45cdaSLars-Peter Clausen 		platform->name);
428371a45cdaSLars-Peter Clausen 	kfree(platform->name);
428471a45cdaSLars-Peter Clausen }
428571a45cdaSLars-Peter Clausen EXPORT_SYMBOL_GPL(snd_soc_remove_platform);
428671a45cdaSLars-Peter Clausen 
428771a45cdaSLars-Peter Clausen struct snd_soc_platform *snd_soc_lookup_platform(struct device *dev)
428871a45cdaSLars-Peter Clausen {
428971a45cdaSLars-Peter Clausen 	struct snd_soc_platform *platform;
429071a45cdaSLars-Peter Clausen 
429171a45cdaSLars-Peter Clausen 	list_for_each_entry(platform, &platform_list, list) {
429271a45cdaSLars-Peter Clausen 		if (dev == platform->dev)
429371a45cdaSLars-Peter Clausen 			return platform;
429471a45cdaSLars-Peter Clausen 	}
429571a45cdaSLars-Peter Clausen 
429671a45cdaSLars-Peter Clausen 	return NULL;
429771a45cdaSLars-Peter Clausen }
429871a45cdaSLars-Peter Clausen EXPORT_SYMBOL_GPL(snd_soc_lookup_platform);
429971a45cdaSLars-Peter Clausen 
430071a45cdaSLars-Peter Clausen /**
430112a48a8cSMark Brown  * snd_soc_unregister_platform - Unregister a platform from the ASoC core
430212a48a8cSMark Brown  *
4303ac11a2b3SMark Brown  * @platform: platform to unregister
430412a48a8cSMark Brown  */
4305f0fba2adSLiam Girdwood void snd_soc_unregister_platform(struct device *dev)
430612a48a8cSMark Brown {
4307f0fba2adSLiam Girdwood 	struct snd_soc_platform *platform;
4308f0fba2adSLiam Girdwood 
430971a45cdaSLars-Peter Clausen 	platform = snd_soc_lookup_platform(dev);
431071a45cdaSLars-Peter Clausen 	if (!platform)
4311f0fba2adSLiam Girdwood 		return;
4312f0fba2adSLiam Girdwood 
431371a45cdaSLars-Peter Clausen 	snd_soc_remove_platform(platform);
4314f0fba2adSLiam Girdwood 	kfree(platform);
431512a48a8cSMark Brown }
431612a48a8cSMark Brown EXPORT_SYMBOL_GPL(snd_soc_unregister_platform);
431712a48a8cSMark Brown 
4318151ab22cSMark Brown static u64 codec_format_map[] = {
4319151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE,
4320151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE,
4321151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_BE,
4322151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U24_LE | SNDRV_PCM_FMTBIT_U24_BE,
4323151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE,
4324151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE,
4325151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
4326151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
4327151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S20_3BE,
4328151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U20_3LE | SNDRV_PCM_FMTBIT_U20_3BE,
4329151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S18_3BE,
4330151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U18_3LE | SNDRV_PCM_FMTBIT_U18_3BE,
4331151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_FLOAT_LE | SNDRV_PCM_FMTBIT_FLOAT_BE,
4332151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_FLOAT64_LE | SNDRV_PCM_FMTBIT_FLOAT64_BE,
4333151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE
4334151ab22cSMark Brown 	| SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE,
4335151ab22cSMark Brown };
4336151ab22cSMark Brown 
4337151ab22cSMark Brown /* Fix up the DAI formats for endianness: codecs don't actually see
4338151ab22cSMark Brown  * the endianness of the data but we're using the CPU format
4339151ab22cSMark Brown  * definitions which do need to include endianness so we ensure that
4340151ab22cSMark Brown  * codec DAIs always have both big and little endian variants set.
4341151ab22cSMark Brown  */
4342151ab22cSMark Brown static void fixup_codec_formats(struct snd_soc_pcm_stream *stream)
4343151ab22cSMark Brown {
4344151ab22cSMark Brown 	int i;
4345151ab22cSMark Brown 
4346151ab22cSMark Brown 	for (i = 0; i < ARRAY_SIZE(codec_format_map); i++)
4347151ab22cSMark Brown 		if (stream->formats & codec_format_map[i])
4348151ab22cSMark Brown 			stream->formats |= codec_format_map[i];
4349151ab22cSMark Brown }
4350151ab22cSMark Brown 
43510d0cf00aSMark Brown /**
43520d0cf00aSMark Brown  * snd_soc_register_codec - Register a codec with the ASoC core
43530d0cf00aSMark Brown  *
4354ac11a2b3SMark Brown  * @codec: codec to register
43550d0cf00aSMark Brown  */
4356f0fba2adSLiam Girdwood int snd_soc_register_codec(struct device *dev,
4357001ae4c0SMark Brown 			   const struct snd_soc_codec_driver *codec_drv,
4358001ae4c0SMark Brown 			   struct snd_soc_dai_driver *dai_drv,
4359001ae4c0SMark Brown 			   int num_dai)
43600d0cf00aSMark Brown {
4361f0fba2adSLiam Girdwood 	struct snd_soc_codec *codec;
4362f0fba2adSLiam Girdwood 	int ret, i;
4363151ab22cSMark Brown 
4364f0fba2adSLiam Girdwood 	dev_dbg(dev, "codec register %s\n", dev_name(dev));
43650d0cf00aSMark Brown 
4366f0fba2adSLiam Girdwood 	codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
4367f0fba2adSLiam Girdwood 	if (codec == NULL)
4368f0fba2adSLiam Girdwood 		return -ENOMEM;
43690d0cf00aSMark Brown 
4370f0fba2adSLiam Girdwood 	/* create CODEC component name */
4371f0fba2adSLiam Girdwood 	codec->name = fmt_single_name(dev, &codec->id);
4372f0fba2adSLiam Girdwood 	if (codec->name == NULL) {
4373f790b94dSKuninori Morimoto 		ret = -ENOMEM;
4374f790b94dSKuninori Morimoto 		goto fail_codec;
4375151ab22cSMark Brown 	}
4376151ab22cSMark Brown 
4377c3acec26SMark Brown 	codec->write = codec_drv->write;
4378c3acec26SMark Brown 	codec->read = codec_drv->read;
43791500b7b5SDimitris Papastamos 	codec->volatile_register = codec_drv->volatile_register;
43801500b7b5SDimitris Papastamos 	codec->readable_register = codec_drv->readable_register;
43818020454cSDimitris Papastamos 	codec->writable_register = codec_drv->writable_register;
43825124e69eSMark Brown 	codec->ignore_pmdown_time = codec_drv->ignore_pmdown_time;
4383ce6120ccSLiam Girdwood 	codec->dapm.bias_level = SND_SOC_BIAS_OFF;
4384ce6120ccSLiam Girdwood 	codec->dapm.dev = dev;
4385ce6120ccSLiam Girdwood 	codec->dapm.codec = codec;
4386474b62d6SMark Brown 	codec->dapm.seq_notifier = codec_drv->seq_notifier;
438764a648c2SLiam Girdwood 	codec->dapm.stream_event = codec_drv->stream_event;
4388f0fba2adSLiam Girdwood 	codec->dev = dev;
4389f0fba2adSLiam Girdwood 	codec->driver = codec_drv;
4390f0fba2adSLiam Girdwood 	codec->num_dai = num_dai;
4391f0fba2adSLiam Girdwood 	mutex_init(&codec->mutex);
4392f0fba2adSLiam Girdwood 
4393f0fba2adSLiam Girdwood 	for (i = 0; i < num_dai; i++) {
4394f0fba2adSLiam Girdwood 		fixup_codec_formats(&dai_drv[i].playback);
4395f0fba2adSLiam Girdwood 		fixup_codec_formats(&dai_drv[i].capture);
4396f0fba2adSLiam Girdwood 	}
4397f0fba2adSLiam Girdwood 
4398054880feSMark Brown 	mutex_lock(&client_mutex);
4399054880feSMark Brown 	list_add(&codec->list, &codec_list);
4400054880feSMark Brown 	mutex_unlock(&client_mutex);
4401054880feSMark Brown 
4402d191bd8dSKuninori Morimoto 	/* register component */
4403d191bd8dSKuninori Morimoto 	ret = __snd_soc_register_component(dev, &codec->component,
4404d191bd8dSKuninori Morimoto 					   &codec_drv->component_driver,
4405d191bd8dSKuninori Morimoto 					   dai_drv, num_dai, false);
44065acd7dfbSKuninori Morimoto 	if (ret < 0) {
4407d191bd8dSKuninori Morimoto 		dev_err(codec->dev, "ASoC: Failed to regster component: %d\n", ret);
44085acd7dfbSKuninori Morimoto 		goto fail_codec_name;
440926b01ccdSMark Brown 	}
4410f0fba2adSLiam Girdwood 
4411f110bfc7SLiam Girdwood 	dev_dbg(codec->dev, "ASoC: Registered codec '%s'\n", codec->name);
44120d0cf00aSMark Brown 	return 0;
4413f0fba2adSLiam Girdwood 
4414f790b94dSKuninori Morimoto fail_codec_name:
4415e1328a83SKuninori Morimoto 	mutex_lock(&client_mutex);
4416e1328a83SKuninori Morimoto 	list_del(&codec->list);
4417e1328a83SKuninori Morimoto 	mutex_unlock(&client_mutex);
4418e1328a83SKuninori Morimoto 
4419f0fba2adSLiam Girdwood 	kfree(codec->name);
4420f790b94dSKuninori Morimoto fail_codec:
4421f0fba2adSLiam Girdwood 	kfree(codec);
4422f0fba2adSLiam Girdwood 	return ret;
44230d0cf00aSMark Brown }
44240d0cf00aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_register_codec);
44250d0cf00aSMark Brown 
44260d0cf00aSMark Brown /**
44270d0cf00aSMark Brown  * snd_soc_unregister_codec - Unregister a codec from the ASoC core
44280d0cf00aSMark Brown  *
4429ac11a2b3SMark Brown  * @codec: codec to unregister
44300d0cf00aSMark Brown  */
4431f0fba2adSLiam Girdwood void snd_soc_unregister_codec(struct device *dev)
44320d0cf00aSMark Brown {
4433f0fba2adSLiam Girdwood 	struct snd_soc_codec *codec;
4434f0fba2adSLiam Girdwood 
4435f0fba2adSLiam Girdwood 	list_for_each_entry(codec, &codec_list, list) {
4436f0fba2adSLiam Girdwood 		if (dev == codec->dev)
4437f0fba2adSLiam Girdwood 			goto found;
4438f0fba2adSLiam Girdwood 	}
4439f0fba2adSLiam Girdwood 	return;
4440f0fba2adSLiam Girdwood 
4441f0fba2adSLiam Girdwood found:
4442d191bd8dSKuninori Morimoto 	snd_soc_unregister_component(dev);
4443f0fba2adSLiam Girdwood 
44440d0cf00aSMark Brown 	mutex_lock(&client_mutex);
44450d0cf00aSMark Brown 	list_del(&codec->list);
44460d0cf00aSMark Brown 	mutex_unlock(&client_mutex);
44470d0cf00aSMark Brown 
4448f110bfc7SLiam Girdwood 	dev_dbg(codec->dev, "ASoC: Unregistered codec '%s'\n", codec->name);
4449f0fba2adSLiam Girdwood 
44507a30a3dbSDimitris Papastamos 	snd_soc_cache_exit(codec);
44511aafcd4dSDimitris Papastamos 	kfree(codec->name);
4452f0fba2adSLiam Girdwood 	kfree(codec);
44530d0cf00aSMark Brown }
44540d0cf00aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_unregister_codec);
44550d0cf00aSMark Brown 
4456bec4fa05SStephen Warren /* Retrieve a card's name from device tree */
4457bec4fa05SStephen Warren int snd_soc_of_parse_card_name(struct snd_soc_card *card,
4458bec4fa05SStephen Warren 			       const char *propname)
4459bec4fa05SStephen Warren {
4460bec4fa05SStephen Warren 	struct device_node *np = card->dev->of_node;
4461bec4fa05SStephen Warren 	int ret;
4462bec4fa05SStephen Warren 
4463bec4fa05SStephen Warren 	ret = of_property_read_string_index(np, propname, 0, &card->name);
4464bec4fa05SStephen Warren 	/*
4465bec4fa05SStephen Warren 	 * EINVAL means the property does not exist. This is fine providing
4466bec4fa05SStephen Warren 	 * card->name was previously set, which is checked later in
4467bec4fa05SStephen Warren 	 * snd_soc_register_card.
4468bec4fa05SStephen Warren 	 */
4469bec4fa05SStephen Warren 	if (ret < 0 && ret != -EINVAL) {
4470bec4fa05SStephen Warren 		dev_err(card->dev,
4471f110bfc7SLiam Girdwood 			"ASoC: Property '%s' could not be read: %d\n",
4472bec4fa05SStephen Warren 			propname, ret);
4473bec4fa05SStephen Warren 		return ret;
4474bec4fa05SStephen Warren 	}
4475bec4fa05SStephen Warren 
4476bec4fa05SStephen Warren 	return 0;
4477bec4fa05SStephen Warren }
4478bec4fa05SStephen Warren EXPORT_SYMBOL_GPL(snd_soc_of_parse_card_name);
4479bec4fa05SStephen Warren 
4480a4a54dd5SStephen Warren int snd_soc_of_parse_audio_routing(struct snd_soc_card *card,
4481a4a54dd5SStephen Warren 				   const char *propname)
4482a4a54dd5SStephen Warren {
4483a4a54dd5SStephen Warren 	struct device_node *np = card->dev->of_node;
4484a4a54dd5SStephen Warren 	int num_routes;
4485a4a54dd5SStephen Warren 	struct snd_soc_dapm_route *routes;
4486a4a54dd5SStephen Warren 	int i, ret;
4487a4a54dd5SStephen Warren 
4488a4a54dd5SStephen Warren 	num_routes = of_property_count_strings(np, propname);
4489c34ce320SRichard Zhao 	if (num_routes < 0 || num_routes & 1) {
449010e8aa9aSMichał Mirosław 		dev_err(card->dev,
449110e8aa9aSMichał Mirosław 			"ASoC: Property '%s' does not exist or its length is not even\n",
449210e8aa9aSMichał Mirosław 			propname);
4493a4a54dd5SStephen Warren 		return -EINVAL;
4494a4a54dd5SStephen Warren 	}
4495a4a54dd5SStephen Warren 	num_routes /= 2;
4496a4a54dd5SStephen Warren 	if (!num_routes) {
4497f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: Property '%s's length is zero\n",
4498a4a54dd5SStephen Warren 			propname);
4499a4a54dd5SStephen Warren 		return -EINVAL;
4500a4a54dd5SStephen Warren 	}
4501a4a54dd5SStephen Warren 
4502a4a54dd5SStephen Warren 	routes = devm_kzalloc(card->dev, num_routes * sizeof(*routes),
4503a4a54dd5SStephen Warren 			      GFP_KERNEL);
4504a4a54dd5SStephen Warren 	if (!routes) {
4505a4a54dd5SStephen Warren 		dev_err(card->dev,
4506f110bfc7SLiam Girdwood 			"ASoC: Could not allocate DAPM route table\n");
4507a4a54dd5SStephen Warren 		return -EINVAL;
4508a4a54dd5SStephen Warren 	}
4509a4a54dd5SStephen Warren 
4510a4a54dd5SStephen Warren 	for (i = 0; i < num_routes; i++) {
4511a4a54dd5SStephen Warren 		ret = of_property_read_string_index(np, propname,
4512a4a54dd5SStephen Warren 			2 * i, &routes[i].sink);
4513a4a54dd5SStephen Warren 		if (ret) {
4514c871bd0bSMark Brown 			dev_err(card->dev,
4515c871bd0bSMark Brown 				"ASoC: Property '%s' index %d could not be read: %d\n",
4516c871bd0bSMark Brown 				propname, 2 * i, ret);
4517a4a54dd5SStephen Warren 			return -EINVAL;
4518a4a54dd5SStephen Warren 		}
4519a4a54dd5SStephen Warren 		ret = of_property_read_string_index(np, propname,
4520a4a54dd5SStephen Warren 			(2 * i) + 1, &routes[i].source);
4521a4a54dd5SStephen Warren 		if (ret) {
4522a4a54dd5SStephen Warren 			dev_err(card->dev,
4523c871bd0bSMark Brown 				"ASoC: Property '%s' index %d could not be read: %d\n",
4524c871bd0bSMark Brown 				propname, (2 * i) + 1, ret);
4525a4a54dd5SStephen Warren 			return -EINVAL;
4526a4a54dd5SStephen Warren 		}
4527a4a54dd5SStephen Warren 	}
4528a4a54dd5SStephen Warren 
4529a4a54dd5SStephen Warren 	card->num_dapm_routes = num_routes;
4530a4a54dd5SStephen Warren 	card->dapm_routes = routes;
4531a4a54dd5SStephen Warren 
4532a4a54dd5SStephen Warren 	return 0;
4533a4a54dd5SStephen Warren }
4534a4a54dd5SStephen Warren EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_routing);
4535a4a54dd5SStephen Warren 
4536a7930ed4SKuninori Morimoto unsigned int snd_soc_of_parse_daifmt(struct device_node *np,
4537a7930ed4SKuninori Morimoto 				     const char *prefix)
4538a7930ed4SKuninori Morimoto {
4539a7930ed4SKuninori Morimoto 	int ret, i;
4540a7930ed4SKuninori Morimoto 	char prop[128];
4541a7930ed4SKuninori Morimoto 	unsigned int format = 0;
4542a7930ed4SKuninori Morimoto 	int bit, frame;
4543a7930ed4SKuninori Morimoto 	const char *str;
4544a7930ed4SKuninori Morimoto 	struct {
4545a7930ed4SKuninori Morimoto 		char *name;
4546a7930ed4SKuninori Morimoto 		unsigned int val;
4547a7930ed4SKuninori Morimoto 	} of_fmt_table[] = {
4548a7930ed4SKuninori Morimoto 		{ "i2s",	SND_SOC_DAIFMT_I2S },
4549a7930ed4SKuninori Morimoto 		{ "right_j",	SND_SOC_DAIFMT_RIGHT_J },
4550a7930ed4SKuninori Morimoto 		{ "left_j",	SND_SOC_DAIFMT_LEFT_J },
4551a7930ed4SKuninori Morimoto 		{ "dsp_a",	SND_SOC_DAIFMT_DSP_A },
4552a7930ed4SKuninori Morimoto 		{ "dsp_b",	SND_SOC_DAIFMT_DSP_B },
4553a7930ed4SKuninori Morimoto 		{ "ac97",	SND_SOC_DAIFMT_AC97 },
4554a7930ed4SKuninori Morimoto 		{ "pdm",	SND_SOC_DAIFMT_PDM},
4555a7930ed4SKuninori Morimoto 		{ "msb",	SND_SOC_DAIFMT_MSB },
4556a7930ed4SKuninori Morimoto 		{ "lsb",	SND_SOC_DAIFMT_LSB },
4557a7930ed4SKuninori Morimoto 	};
4558a7930ed4SKuninori Morimoto 
4559a7930ed4SKuninori Morimoto 	if (!prefix)
4560a7930ed4SKuninori Morimoto 		prefix = "";
4561a7930ed4SKuninori Morimoto 
4562a7930ed4SKuninori Morimoto 	/*
4563a7930ed4SKuninori Morimoto 	 * check "[prefix]format = xxx"
4564a7930ed4SKuninori Morimoto 	 * SND_SOC_DAIFMT_FORMAT_MASK area
4565a7930ed4SKuninori Morimoto 	 */
4566a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sformat", prefix);
4567a7930ed4SKuninori Morimoto 	ret = of_property_read_string(np, prop, &str);
4568a7930ed4SKuninori Morimoto 	if (ret == 0) {
4569a7930ed4SKuninori Morimoto 		for (i = 0; i < ARRAY_SIZE(of_fmt_table); i++) {
4570a7930ed4SKuninori Morimoto 			if (strcmp(str, of_fmt_table[i].name) == 0) {
4571a7930ed4SKuninori Morimoto 				format |= of_fmt_table[i].val;
4572a7930ed4SKuninori Morimoto 				break;
4573a7930ed4SKuninori Morimoto 			}
4574a7930ed4SKuninori Morimoto 		}
4575a7930ed4SKuninori Morimoto 	}
4576a7930ed4SKuninori Morimoto 
4577a7930ed4SKuninori Morimoto 	/*
45788c2d6a9fSKuninori Morimoto 	 * check "[prefix]continuous-clock"
4579a7930ed4SKuninori Morimoto 	 * SND_SOC_DAIFMT_CLOCK_MASK area
4580a7930ed4SKuninori Morimoto 	 */
45818c2d6a9fSKuninori Morimoto 	snprintf(prop, sizeof(prop), "%scontinuous-clock", prefix);
45828c2d6a9fSKuninori Morimoto 	if (of_get_property(np, prop, NULL))
45838c2d6a9fSKuninori Morimoto 		format |= SND_SOC_DAIFMT_CONT;
45848c2d6a9fSKuninori Morimoto 	else
45858c2d6a9fSKuninori Morimoto 		format |= SND_SOC_DAIFMT_GATED;
4586a7930ed4SKuninori Morimoto 
4587a7930ed4SKuninori Morimoto 	/*
4588a7930ed4SKuninori Morimoto 	 * check "[prefix]bitclock-inversion"
4589a7930ed4SKuninori Morimoto 	 * check "[prefix]frame-inversion"
4590a7930ed4SKuninori Morimoto 	 * SND_SOC_DAIFMT_INV_MASK area
4591a7930ed4SKuninori Morimoto 	 */
4592a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sbitclock-inversion", prefix);
4593a7930ed4SKuninori Morimoto 	bit = !!of_get_property(np, prop, NULL);
4594a7930ed4SKuninori Morimoto 
4595a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sframe-inversion", prefix);
4596a7930ed4SKuninori Morimoto 	frame = !!of_get_property(np, prop, NULL);
4597a7930ed4SKuninori Morimoto 
4598a7930ed4SKuninori Morimoto 	switch ((bit << 4) + frame) {
4599a7930ed4SKuninori Morimoto 	case 0x11:
4600a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_IB_IF;
4601a7930ed4SKuninori Morimoto 		break;
4602a7930ed4SKuninori Morimoto 	case 0x10:
4603a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_IB_NF;
4604a7930ed4SKuninori Morimoto 		break;
4605a7930ed4SKuninori Morimoto 	case 0x01:
4606a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_NB_IF;
4607a7930ed4SKuninori Morimoto 		break;
4608a7930ed4SKuninori Morimoto 	default:
4609a7930ed4SKuninori Morimoto 		/* SND_SOC_DAIFMT_NB_NF is default */
4610a7930ed4SKuninori Morimoto 		break;
4611a7930ed4SKuninori Morimoto 	}
4612a7930ed4SKuninori Morimoto 
4613a7930ed4SKuninori Morimoto 	/*
4614a7930ed4SKuninori Morimoto 	 * check "[prefix]bitclock-master"
4615a7930ed4SKuninori Morimoto 	 * check "[prefix]frame-master"
4616a7930ed4SKuninori Morimoto 	 * SND_SOC_DAIFMT_MASTER_MASK area
4617a7930ed4SKuninori Morimoto 	 */
4618a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sbitclock-master", prefix);
4619a7930ed4SKuninori Morimoto 	bit = !!of_get_property(np, prop, NULL);
4620a7930ed4SKuninori Morimoto 
4621a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sframe-master", prefix);
4622a7930ed4SKuninori Morimoto 	frame = !!of_get_property(np, prop, NULL);
4623a7930ed4SKuninori Morimoto 
4624a7930ed4SKuninori Morimoto 	switch ((bit << 4) + frame) {
4625a7930ed4SKuninori Morimoto 	case 0x11:
4626a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_CBM_CFM;
4627a7930ed4SKuninori Morimoto 		break;
4628a7930ed4SKuninori Morimoto 	case 0x10:
4629a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_CBM_CFS;
4630a7930ed4SKuninori Morimoto 		break;
4631a7930ed4SKuninori Morimoto 	case 0x01:
4632a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_CBS_CFM;
4633a7930ed4SKuninori Morimoto 		break;
4634a7930ed4SKuninori Morimoto 	default:
4635a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_CBS_CFS;
4636a7930ed4SKuninori Morimoto 		break;
4637a7930ed4SKuninori Morimoto 	}
4638a7930ed4SKuninori Morimoto 
4639a7930ed4SKuninori Morimoto 	return format;
4640a7930ed4SKuninori Morimoto }
4641a7930ed4SKuninori Morimoto EXPORT_SYMBOL_GPL(snd_soc_of_parse_daifmt);
4642a7930ed4SKuninori Morimoto 
4643cb470087SKuninori Morimoto int snd_soc_of_get_dai_name(struct device_node *of_node,
4644cb470087SKuninori Morimoto 			    const char **dai_name)
4645cb470087SKuninori Morimoto {
4646cb470087SKuninori Morimoto 	struct snd_soc_component *pos;
4647cb470087SKuninori Morimoto 	struct of_phandle_args args;
4648cb470087SKuninori Morimoto 	int ret;
4649cb470087SKuninori Morimoto 
4650cb470087SKuninori Morimoto 	ret = of_parse_phandle_with_args(of_node, "sound-dai",
4651cb470087SKuninori Morimoto 					 "#sound-dai-cells", 0, &args);
4652cb470087SKuninori Morimoto 	if (ret)
4653cb470087SKuninori Morimoto 		return ret;
4654cb470087SKuninori Morimoto 
4655cb470087SKuninori Morimoto 	ret = -EPROBE_DEFER;
4656cb470087SKuninori Morimoto 
4657cb470087SKuninori Morimoto 	mutex_lock(&client_mutex);
4658cb470087SKuninori Morimoto 	list_for_each_entry(pos, &component_list, list) {
4659cb470087SKuninori Morimoto 		if (pos->dev->of_node != args.np)
4660cb470087SKuninori Morimoto 			continue;
4661cb470087SKuninori Morimoto 
46626833c452SKuninori Morimoto 		if (pos->driver->of_xlate_dai_name) {
46636833c452SKuninori Morimoto 			ret = pos->driver->of_xlate_dai_name(pos, &args, dai_name);
46646833c452SKuninori Morimoto 		} else {
46656833c452SKuninori Morimoto 			int id = -1;
46666833c452SKuninori Morimoto 
46676833c452SKuninori Morimoto 			switch (args.args_count) {
46686833c452SKuninori Morimoto 			case 0:
46696833c452SKuninori Morimoto 				id = 0; /* same as dai_drv[0] */
46706833c452SKuninori Morimoto 				break;
46716833c452SKuninori Morimoto 			case 1:
46726833c452SKuninori Morimoto 				id = args.args[0];
46736833c452SKuninori Morimoto 				break;
46746833c452SKuninori Morimoto 			default:
46756833c452SKuninori Morimoto 				/* not supported */
4676cb470087SKuninori Morimoto 				break;
4677cb470087SKuninori Morimoto 			}
4678cb470087SKuninori Morimoto 
46796833c452SKuninori Morimoto 			if (id < 0 || id >= pos->num_dai) {
46806833c452SKuninori Morimoto 				ret = -EINVAL;
4681e41975edSXiubo Li 				break;
46826833c452SKuninori Morimoto 			}
4683e41975edSXiubo Li 
4684e41975edSXiubo Li 			ret = 0;
4685e41975edSXiubo Li 
4686e41975edSXiubo Li 			*dai_name = pos->dai_drv[id].name;
4687e41975edSXiubo Li 			if (!*dai_name)
4688e41975edSXiubo Li 				*dai_name = pos->name;
46896833c452SKuninori Morimoto 		}
46906833c452SKuninori Morimoto 
4691cb470087SKuninori Morimoto 		break;
4692cb470087SKuninori Morimoto 	}
4693cb470087SKuninori Morimoto 	mutex_unlock(&client_mutex);
4694cb470087SKuninori Morimoto 
4695cb470087SKuninori Morimoto 	of_node_put(args.np);
4696cb470087SKuninori Morimoto 
4697cb470087SKuninori Morimoto 	return ret;
4698cb470087SKuninori Morimoto }
4699cb470087SKuninori Morimoto EXPORT_SYMBOL_GPL(snd_soc_of_get_dai_name);
4700cb470087SKuninori Morimoto 
4701c9b3a40fSTakashi Iwai static int __init snd_soc_init(void)
4702db2a4165SFrank Mandarino {
4703384c89e2SMark Brown #ifdef CONFIG_DEBUG_FS
47048a9dab1aSMark Brown 	snd_soc_debugfs_root = debugfs_create_dir("asoc", NULL);
47058a9dab1aSMark Brown 	if (IS_ERR(snd_soc_debugfs_root) || !snd_soc_debugfs_root) {
47060837fc62SFabio Estevam 		pr_warn("ASoC: Failed to create debugfs directory\n");
47078a9dab1aSMark Brown 		snd_soc_debugfs_root = NULL;
4708384c89e2SMark Brown 	}
4709c3c5a19aSMark Brown 
47108a9dab1aSMark Brown 	if (!debugfs_create_file("codecs", 0444, snd_soc_debugfs_root, NULL,
4711c3c5a19aSMark Brown 				 &codec_list_fops))
4712c3c5a19aSMark Brown 		pr_warn("ASoC: Failed to create CODEC list debugfs file\n");
4713c3c5a19aSMark Brown 
47148a9dab1aSMark Brown 	if (!debugfs_create_file("dais", 0444, snd_soc_debugfs_root, NULL,
4715f3208780SMark Brown 				 &dai_list_fops))
4716f3208780SMark Brown 		pr_warn("ASoC: Failed to create DAI list debugfs file\n");
471719c7ac27SMark Brown 
47188a9dab1aSMark Brown 	if (!debugfs_create_file("platforms", 0444, snd_soc_debugfs_root, NULL,
471919c7ac27SMark Brown 				 &platform_list_fops))
472019c7ac27SMark Brown 		pr_warn("ASoC: Failed to create platform list debugfs file\n");
4721384c89e2SMark Brown #endif
4722384c89e2SMark Brown 
4723fb257897SMark Brown 	snd_soc_util_init();
4724fb257897SMark Brown 
4725db2a4165SFrank Mandarino 	return platform_driver_register(&soc_driver);
4726db2a4165SFrank Mandarino }
47274abe8e16SMark Brown module_init(snd_soc_init);
4728db2a4165SFrank Mandarino 
47297d8c16a6SMark Brown static void __exit snd_soc_exit(void)
4730db2a4165SFrank Mandarino {
4731fb257897SMark Brown 	snd_soc_util_exit();
4732fb257897SMark Brown 
4733384c89e2SMark Brown #ifdef CONFIG_DEBUG_FS
47348a9dab1aSMark Brown 	debugfs_remove_recursive(snd_soc_debugfs_root);
4735384c89e2SMark Brown #endif
4736db2a4165SFrank Mandarino 	platform_driver_unregister(&soc_driver);
4737db2a4165SFrank Mandarino }
4738db2a4165SFrank Mandarino module_exit(snd_soc_exit);
4739db2a4165SFrank Mandarino 
4740db2a4165SFrank Mandarino /* Module information */
4741d331124dSLiam Girdwood MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
4742db2a4165SFrank Mandarino MODULE_DESCRIPTION("ALSA SoC Core");
4743db2a4165SFrank Mandarino MODULE_LICENSE("GPL");
47448b45a209SKay Sievers MODULE_ALIAS("platform:soc-audio");
4745