xref: /openbmc/linux/sound/soc/soc-core.c (revision 2436a723f3e1fbca517c9318efe9af5ecf7cbcbb)
1db2a4165SFrank Mandarino /*
2db2a4165SFrank Mandarino  * soc-core.c  --  ALSA SoC Audio Layer
3db2a4165SFrank Mandarino  *
4db2a4165SFrank Mandarino  * Copyright 2005 Wolfson Microelectronics PLC.
50664d888SLiam Girdwood  * Copyright 2005 Openedhand Ltd.
6f0fba2adSLiam Girdwood  * Copyright (C) 2010 Slimlogic Ltd.
7f0fba2adSLiam Girdwood  * Copyright (C) 2010 Texas Instruments Inc.
80664d888SLiam Girdwood  *
9d331124dSLiam Girdwood  * Author: Liam Girdwood <lrg@slimlogic.co.uk>
100664d888SLiam Girdwood  *         with code, comments and ideas from :-
110664d888SLiam Girdwood  *         Richard Purdie <richard@openedhand.com>
12db2a4165SFrank Mandarino  *
13db2a4165SFrank Mandarino  *  This program is free software; you can redistribute  it and/or modify it
14db2a4165SFrank Mandarino  *  under  the terms of  the GNU General  Public License as published by the
15db2a4165SFrank Mandarino  *  Free Software Foundation;  either version 2 of the  License, or (at your
16db2a4165SFrank Mandarino  *  option) any later version.
17db2a4165SFrank Mandarino  *
18db2a4165SFrank Mandarino  *  TODO:
19db2a4165SFrank Mandarino  *   o Add hw rules to enforce rates, etc.
20db2a4165SFrank Mandarino  *   o More testing with other codecs/machines.
21db2a4165SFrank Mandarino  *   o Add more codecs and platforms to ensure good API coverage.
22db2a4165SFrank Mandarino  *   o Support TDM on PCM and I2S
23db2a4165SFrank Mandarino  */
24db2a4165SFrank Mandarino 
25db2a4165SFrank Mandarino #include <linux/module.h>
26db2a4165SFrank Mandarino #include <linux/moduleparam.h>
27db2a4165SFrank Mandarino #include <linux/init.h>
28db2a4165SFrank Mandarino #include <linux/delay.h>
29db2a4165SFrank Mandarino #include <linux/pm.h>
30db2a4165SFrank Mandarino #include <linux/bitops.h>
3112ef193dSTroy Kisky #include <linux/debugfs.h>
32db2a4165SFrank Mandarino #include <linux/platform_device.h>
33741a509fSMarkus Pargmann #include <linux/pinctrl/consumer.h>
34f0e8ed85SMark Brown #include <linux/ctype.h>
355a0e3ad6STejun Heo #include <linux/slab.h>
36bec4fa05SStephen Warren #include <linux/of.h>
37741a509fSMarkus Pargmann #include <linux/gpio.h>
38741a509fSMarkus Pargmann #include <linux/of_gpio.h>
39474828a4SMarek Vasut #include <sound/ac97_codec.h>
40db2a4165SFrank Mandarino #include <sound/core.h>
413028eb8cSMark Brown #include <sound/jack.h>
42db2a4165SFrank Mandarino #include <sound/pcm.h>
43db2a4165SFrank Mandarino #include <sound/pcm_params.h>
44db2a4165SFrank Mandarino #include <sound/soc.h>
4501d7584cSLiam Girdwood #include <sound/soc-dpcm.h>
46db2a4165SFrank Mandarino #include <sound/initval.h>
47db2a4165SFrank Mandarino 
48a8b1d34fSMark Brown #define CREATE_TRACE_POINTS
49a8b1d34fSMark Brown #include <trace/events/asoc.h>
50a8b1d34fSMark Brown 
51f0fba2adSLiam Girdwood #define NAME_SIZE	32
52f0fba2adSLiam Girdwood 
53384c89e2SMark Brown #ifdef CONFIG_DEBUG_FS
548a9dab1aSMark Brown struct dentry *snd_soc_debugfs_root;
558a9dab1aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_debugfs_root);
56384c89e2SMark Brown #endif
57384c89e2SMark Brown 
58c5af3a2eSMark Brown static DEFINE_MUTEX(client_mutex);
5912a48a8cSMark Brown static LIST_HEAD(platform_list);
600d0cf00aSMark Brown static LIST_HEAD(codec_list);
61030e79f6SKuninori Morimoto static LIST_HEAD(component_list);
62c5af3a2eSMark Brown 
63db2a4165SFrank Mandarino /*
64db2a4165SFrank Mandarino  * This is a timeout to do a DAPM powerdown after a stream is closed().
65db2a4165SFrank Mandarino  * It can be used to eliminate pops between different playback streams, e.g.
66db2a4165SFrank Mandarino  * between two audio tracks.
67db2a4165SFrank Mandarino  */
68db2a4165SFrank Mandarino static int pmdown_time = 5000;
69db2a4165SFrank Mandarino module_param(pmdown_time, int, 0);
70db2a4165SFrank Mandarino MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
71db2a4165SFrank Mandarino 
72741a509fSMarkus Pargmann struct snd_ac97_reset_cfg {
73741a509fSMarkus Pargmann 	struct pinctrl *pctl;
74741a509fSMarkus Pargmann 	struct pinctrl_state *pstate_reset;
75741a509fSMarkus Pargmann 	struct pinctrl_state *pstate_warm_reset;
76741a509fSMarkus Pargmann 	struct pinctrl_state *pstate_run;
77741a509fSMarkus Pargmann 	int gpio_sdata;
78741a509fSMarkus Pargmann 	int gpio_sync;
79741a509fSMarkus Pargmann 	int gpio_reset;
80741a509fSMarkus Pargmann };
81741a509fSMarkus Pargmann 
822bc9a81eSDimitris Papastamos /* returns the minimum number of bytes needed to represent
832bc9a81eSDimitris Papastamos  * a particular given value */
842bc9a81eSDimitris Papastamos static int min_bytes_needed(unsigned long val)
852bc9a81eSDimitris Papastamos {
862bc9a81eSDimitris Papastamos 	int c = 0;
872bc9a81eSDimitris Papastamos 	int i;
882bc9a81eSDimitris Papastamos 
892bc9a81eSDimitris Papastamos 	for (i = (sizeof val * 8) - 1; i >= 0; --i, ++c)
902bc9a81eSDimitris Papastamos 		if (val & (1UL << i))
912bc9a81eSDimitris Papastamos 			break;
922bc9a81eSDimitris Papastamos 	c = (sizeof val * 8) - c;
932bc9a81eSDimitris Papastamos 	if (!c || (c % 8))
942bc9a81eSDimitris Papastamos 		c = (c + 8) / 8;
952bc9a81eSDimitris Papastamos 	else
962bc9a81eSDimitris Papastamos 		c /= 8;
972bc9a81eSDimitris Papastamos 	return c;
982bc9a81eSDimitris Papastamos }
992bc9a81eSDimitris Papastamos 
10013fd179fSDimitris Papastamos /* fill buf which is 'len' bytes with a formatted
10113fd179fSDimitris Papastamos  * string of the form 'reg: value\n' */
10213fd179fSDimitris Papastamos static int format_register_str(struct snd_soc_codec *codec,
10313fd179fSDimitris Papastamos 			       unsigned int reg, char *buf, size_t len)
1042624d5faSMark Brown {
10500b317a4SStephen Warren 	int wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
10600b317a4SStephen Warren 	int regsize = codec->driver->reg_word_size * 2;
10713fd179fSDimitris Papastamos 	int ret;
10813fd179fSDimitris Papastamos 	char tmpbuf[len + 1];
10913fd179fSDimitris Papastamos 	char regbuf[regsize + 1];
11013fd179fSDimitris Papastamos 
11113fd179fSDimitris Papastamos 	/* since tmpbuf is allocated on the stack, warn the callers if they
11213fd179fSDimitris Papastamos 	 * try to abuse this function */
11313fd179fSDimitris Papastamos 	WARN_ON(len > 63);
11413fd179fSDimitris Papastamos 
11513fd179fSDimitris Papastamos 	/* +2 for ': ' and + 1 for '\n' */
11613fd179fSDimitris Papastamos 	if (wordsize + regsize + 2 + 1 != len)
11713fd179fSDimitris Papastamos 		return -EINVAL;
11813fd179fSDimitris Papastamos 
11913fd179fSDimitris Papastamos 	ret = snd_soc_read(codec, reg);
12013fd179fSDimitris Papastamos 	if (ret < 0) {
12113fd179fSDimitris Papastamos 		memset(regbuf, 'X', regsize);
12213fd179fSDimitris Papastamos 		regbuf[regsize] = '\0';
12313fd179fSDimitris Papastamos 	} else {
12413fd179fSDimitris Papastamos 		snprintf(regbuf, regsize + 1, "%.*x", regsize, ret);
12513fd179fSDimitris Papastamos 	}
12613fd179fSDimitris Papastamos 
12713fd179fSDimitris Papastamos 	/* prepare the buffer */
12813fd179fSDimitris Papastamos 	snprintf(tmpbuf, len + 1, "%.*x: %s\n", wordsize, reg, regbuf);
12913fd179fSDimitris Papastamos 	/* copy it back to the caller without the '\0' */
13013fd179fSDimitris Papastamos 	memcpy(buf, tmpbuf, len);
13113fd179fSDimitris Papastamos 
13213fd179fSDimitris Papastamos 	return 0;
13313fd179fSDimitris Papastamos }
13413fd179fSDimitris Papastamos 
13513fd179fSDimitris Papastamos /* codec register dump */
13613fd179fSDimitris Papastamos static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf,
13713fd179fSDimitris Papastamos 				  size_t count, loff_t pos)
13813fd179fSDimitris Papastamos {
13913fd179fSDimitris Papastamos 	int i, step = 1;
1402bc9a81eSDimitris Papastamos 	int wordsize, regsize;
14113fd179fSDimitris Papastamos 	int len;
14213fd179fSDimitris Papastamos 	size_t total = 0;
14313fd179fSDimitris Papastamos 	loff_t p = 0;
1442bc9a81eSDimitris Papastamos 
14500b317a4SStephen Warren 	wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
14600b317a4SStephen Warren 	regsize = codec->driver->reg_word_size * 2;
1472624d5faSMark Brown 
14813fd179fSDimitris Papastamos 	len = wordsize + regsize + 2 + 1;
14913fd179fSDimitris Papastamos 
150f0fba2adSLiam Girdwood 	if (!codec->driver->reg_cache_size)
1512624d5faSMark Brown 		return 0;
1522624d5faSMark Brown 
153f0fba2adSLiam Girdwood 	if (codec->driver->reg_cache_step)
154f0fba2adSLiam Girdwood 		step = codec->driver->reg_cache_step;
1552624d5faSMark Brown 
156f0fba2adSLiam Girdwood 	for (i = 0; i < codec->driver->reg_cache_size; i += step) {
157b92d150bSLars-Peter Clausen 		if (!snd_soc_codec_readable_register(codec, i))
1582624d5faSMark Brown 			continue;
159f0fba2adSLiam Girdwood 		if (codec->driver->display_register) {
160f0fba2adSLiam Girdwood 			count += codec->driver->display_register(codec, buf + count,
1612624d5faSMark Brown 							 PAGE_SIZE - count, i);
1625164d74dSMark Brown 		} else {
16313fd179fSDimitris Papastamos 			/* only support larger than PAGE_SIZE bytes debugfs
16413fd179fSDimitris Papastamos 			 * entries for the default case */
16513fd179fSDimitris Papastamos 			if (p >= pos) {
16613fd179fSDimitris Papastamos 				if (total + len >= count - 1)
1672624d5faSMark Brown 					break;
16813fd179fSDimitris Papastamos 				format_register_str(codec, i, buf + total, len);
16913fd179fSDimitris Papastamos 				total += len;
17013fd179fSDimitris Papastamos 			}
17113fd179fSDimitris Papastamos 			p += len;
17213fd179fSDimitris Papastamos 		}
1732624d5faSMark Brown 	}
1742624d5faSMark Brown 
17513fd179fSDimitris Papastamos 	total = min(total, count - 1);
1762624d5faSMark Brown 
17713fd179fSDimitris Papastamos 	return total;
1782624d5faSMark Brown }
17913fd179fSDimitris Papastamos 
1802624d5faSMark Brown static ssize_t codec_reg_show(struct device *dev,
1812624d5faSMark Brown 	struct device_attribute *attr, char *buf)
1822624d5faSMark Brown {
18336ae1a96SMark Brown 	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
184f0fba2adSLiam Girdwood 
18513fd179fSDimitris Papastamos 	return soc_codec_reg_show(rtd->codec, buf, PAGE_SIZE, 0);
1862624d5faSMark Brown }
1872624d5faSMark Brown 
1882624d5faSMark Brown static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
1892624d5faSMark Brown 
190dbe21408SMark Brown static ssize_t pmdown_time_show(struct device *dev,
191dbe21408SMark Brown 				struct device_attribute *attr, char *buf)
192dbe21408SMark Brown {
19336ae1a96SMark Brown 	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
194dbe21408SMark Brown 
195f0fba2adSLiam Girdwood 	return sprintf(buf, "%ld\n", rtd->pmdown_time);
196dbe21408SMark Brown }
197dbe21408SMark Brown 
198dbe21408SMark Brown static ssize_t pmdown_time_set(struct device *dev,
199dbe21408SMark Brown 			       struct device_attribute *attr,
200dbe21408SMark Brown 			       const char *buf, size_t count)
201dbe21408SMark Brown {
20236ae1a96SMark Brown 	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
203c593b520SMark Brown 	int ret;
204dbe21408SMark Brown 
205b785a492SJingoo Han 	ret = kstrtol(buf, 10, &rtd->pmdown_time);
206c593b520SMark Brown 	if (ret)
207c593b520SMark Brown 		return ret;
208dbe21408SMark Brown 
209dbe21408SMark Brown 	return count;
210dbe21408SMark Brown }
211dbe21408SMark Brown 
212dbe21408SMark Brown static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set);
213dbe21408SMark Brown 
2142624d5faSMark Brown #ifdef CONFIG_DEBUG_FS
2152624d5faSMark Brown static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
2162624d5faSMark Brown 				   size_t count, loff_t *ppos)
2172624d5faSMark Brown {
2182624d5faSMark Brown 	ssize_t ret;
2192624d5faSMark Brown 	struct snd_soc_codec *codec = file->private_data;
22013fd179fSDimitris Papastamos 	char *buf;
22113fd179fSDimitris Papastamos 
22213fd179fSDimitris Papastamos 	if (*ppos < 0 || !count)
22313fd179fSDimitris Papastamos 		return -EINVAL;
22413fd179fSDimitris Papastamos 
22513fd179fSDimitris Papastamos 	buf = kmalloc(count, GFP_KERNEL);
2262624d5faSMark Brown 	if (!buf)
2272624d5faSMark Brown 		return -ENOMEM;
22813fd179fSDimitris Papastamos 
22913fd179fSDimitris Papastamos 	ret = soc_codec_reg_show(codec, buf, count, *ppos);
23013fd179fSDimitris Papastamos 	if (ret >= 0) {
23113fd179fSDimitris Papastamos 		if (copy_to_user(user_buf, buf, ret)) {
23213fd179fSDimitris Papastamos 			kfree(buf);
23313fd179fSDimitris Papastamos 			return -EFAULT;
23413fd179fSDimitris Papastamos 		}
23513fd179fSDimitris Papastamos 		*ppos += ret;
23613fd179fSDimitris Papastamos 	}
23713fd179fSDimitris Papastamos 
2382624d5faSMark Brown 	kfree(buf);
2392624d5faSMark Brown 	return ret;
2402624d5faSMark Brown }
2412624d5faSMark Brown 
2422624d5faSMark Brown static ssize_t codec_reg_write_file(struct file *file,
2432624d5faSMark Brown 		const char __user *user_buf, size_t count, loff_t *ppos)
2442624d5faSMark Brown {
2452624d5faSMark Brown 	char buf[32];
24634e268d8SStephen Boyd 	size_t buf_size;
2472624d5faSMark Brown 	char *start = buf;
2482624d5faSMark Brown 	unsigned long reg, value;
2492624d5faSMark Brown 	struct snd_soc_codec *codec = file->private_data;
250b785a492SJingoo Han 	int ret;
2512624d5faSMark Brown 
2522624d5faSMark Brown 	buf_size = min(count, (sizeof(buf)-1));
2532624d5faSMark Brown 	if (copy_from_user(buf, user_buf, buf_size))
2542624d5faSMark Brown 		return -EFAULT;
2552624d5faSMark Brown 	buf[buf_size] = 0;
2562624d5faSMark Brown 
2572624d5faSMark Brown 	while (*start == ' ')
2582624d5faSMark Brown 		start++;
2592624d5faSMark Brown 	reg = simple_strtoul(start, &start, 16);
2602624d5faSMark Brown 	while (*start == ' ')
2612624d5faSMark Brown 		start++;
262b785a492SJingoo Han 	ret = kstrtoul(start, 16, &value);
263b785a492SJingoo Han 	if (ret)
264b785a492SJingoo Han 		return ret;
2650d51a9cbSMark Brown 
2660d51a9cbSMark Brown 	/* Userspace has been fiddling around behind the kernel's back */
267373d4d09SRusty Russell 	add_taint(TAINT_USER, LOCKDEP_NOW_UNRELIABLE);
2680d51a9cbSMark Brown 
269e4f078d8SDimitris Papastamos 	snd_soc_write(codec, reg, value);
2702624d5faSMark Brown 	return buf_size;
2712624d5faSMark Brown }
2722624d5faSMark Brown 
2732624d5faSMark Brown static const struct file_operations codec_reg_fops = {
274234e3405SStephen Boyd 	.open = simple_open,
2752624d5faSMark Brown 	.read = codec_reg_read_file,
2762624d5faSMark Brown 	.write = codec_reg_write_file,
2776038f373SArnd Bergmann 	.llseek = default_llseek,
2782624d5faSMark Brown };
2792624d5faSMark Brown 
2802624d5faSMark Brown static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
2812624d5faSMark Brown {
282d6ce4cf3SJarkko Nikula 	struct dentry *debugfs_card_root = codec->card->debugfs_card_root;
283d6ce4cf3SJarkko Nikula 
2846ba6c9c3SMark Brown 	codec->debugfs_codec_root = debugfs_create_dir(codec->name,
285d6ce4cf3SJarkko Nikula 						       debugfs_card_root);
2862624d5faSMark Brown 	if (!codec->debugfs_codec_root) {
28710e8aa9aSMichał Mirosław 		dev_warn(codec->dev,
28810e8aa9aSMichał Mirosław 			"ASoC: Failed to create codec debugfs directory\n");
2892624d5faSMark Brown 		return;
2902624d5faSMark Brown 	}
2912624d5faSMark Brown 
292aaee8ef1SMark Brown 	debugfs_create_bool("cache_sync", 0444, codec->debugfs_codec_root,
293aaee8ef1SMark Brown 			    &codec->cache_sync);
294aaee8ef1SMark Brown 	debugfs_create_bool("cache_only", 0444, codec->debugfs_codec_root,
295aaee8ef1SMark Brown 			    &codec->cache_only);
296aaee8ef1SMark Brown 
2972624d5faSMark Brown 	codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
2982624d5faSMark Brown 						 codec->debugfs_codec_root,
2992624d5faSMark Brown 						 codec, &codec_reg_fops);
3002624d5faSMark Brown 	if (!codec->debugfs_reg)
30110e8aa9aSMichał Mirosław 		dev_warn(codec->dev,
30210e8aa9aSMichał Mirosław 			"ASoC: Failed to create codec register debugfs file\n");
3032624d5faSMark Brown 
3048eecaf62SLars-Peter Clausen 	snd_soc_dapm_debugfs_init(&codec->dapm, codec->debugfs_codec_root);
3052624d5faSMark Brown }
3062624d5faSMark Brown 
3072624d5faSMark Brown static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
3082624d5faSMark Brown {
3092624d5faSMark Brown 	debugfs_remove_recursive(codec->debugfs_codec_root);
3102624d5faSMark Brown }
3112624d5faSMark Brown 
312731f1ab2SSebastien Guiriec static void soc_init_platform_debugfs(struct snd_soc_platform *platform)
313731f1ab2SSebastien Guiriec {
314731f1ab2SSebastien Guiriec 	struct dentry *debugfs_card_root = platform->card->debugfs_card_root;
315731f1ab2SSebastien Guiriec 
316731f1ab2SSebastien Guiriec 	platform->debugfs_platform_root = debugfs_create_dir(platform->name,
317731f1ab2SSebastien Guiriec 						       debugfs_card_root);
318731f1ab2SSebastien Guiriec 	if (!platform->debugfs_platform_root) {
319731f1ab2SSebastien Guiriec 		dev_warn(platform->dev,
320f110bfc7SLiam Girdwood 			"ASoC: Failed to create platform debugfs directory\n");
321731f1ab2SSebastien Guiriec 		return;
322731f1ab2SSebastien Guiriec 	}
323731f1ab2SSebastien Guiriec 
324731f1ab2SSebastien Guiriec 	snd_soc_dapm_debugfs_init(&platform->dapm,
325731f1ab2SSebastien Guiriec 		platform->debugfs_platform_root);
326731f1ab2SSebastien Guiriec }
327731f1ab2SSebastien Guiriec 
328731f1ab2SSebastien Guiriec static void soc_cleanup_platform_debugfs(struct snd_soc_platform *platform)
329731f1ab2SSebastien Guiriec {
330731f1ab2SSebastien Guiriec 	debugfs_remove_recursive(platform->debugfs_platform_root);
331731f1ab2SSebastien Guiriec }
332731f1ab2SSebastien Guiriec 
333c3c5a19aSMark Brown static ssize_t codec_list_read_file(struct file *file, char __user *user_buf,
334c3c5a19aSMark Brown 				    size_t count, loff_t *ppos)
335c3c5a19aSMark Brown {
336c3c5a19aSMark Brown 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
3372b194f9dSMark Brown 	ssize_t len, ret = 0;
338c3c5a19aSMark Brown 	struct snd_soc_codec *codec;
339c3c5a19aSMark Brown 
340c3c5a19aSMark Brown 	if (!buf)
341c3c5a19aSMark Brown 		return -ENOMEM;
342c3c5a19aSMark Brown 
3432b194f9dSMark Brown 	list_for_each_entry(codec, &codec_list, list) {
3442b194f9dSMark Brown 		len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
345c3c5a19aSMark Brown 			       codec->name);
3462b194f9dSMark Brown 		if (len >= 0)
3472b194f9dSMark Brown 			ret += len;
3482b194f9dSMark Brown 		if (ret > PAGE_SIZE) {
3492b194f9dSMark Brown 			ret = PAGE_SIZE;
3502b194f9dSMark Brown 			break;
3512b194f9dSMark Brown 		}
3522b194f9dSMark Brown 	}
353c3c5a19aSMark Brown 
354c3c5a19aSMark Brown 	if (ret >= 0)
355c3c5a19aSMark Brown 		ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
356c3c5a19aSMark Brown 
357c3c5a19aSMark Brown 	kfree(buf);
358c3c5a19aSMark Brown 
359c3c5a19aSMark Brown 	return ret;
360c3c5a19aSMark Brown }
361c3c5a19aSMark Brown 
362c3c5a19aSMark Brown static const struct file_operations codec_list_fops = {
363c3c5a19aSMark Brown 	.read = codec_list_read_file,
364c3c5a19aSMark Brown 	.llseek = default_llseek,/* read accesses f_pos */
365c3c5a19aSMark Brown };
366c3c5a19aSMark Brown 
367f3208780SMark Brown static ssize_t dai_list_read_file(struct file *file, char __user *user_buf,
368f3208780SMark Brown 				  size_t count, loff_t *ppos)
369f3208780SMark Brown {
370f3208780SMark Brown 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
3712b194f9dSMark Brown 	ssize_t len, ret = 0;
3721438c2f6SLars-Peter Clausen 	struct snd_soc_component *component;
373f3208780SMark Brown 	struct snd_soc_dai *dai;
374f3208780SMark Brown 
375f3208780SMark Brown 	if (!buf)
376f3208780SMark Brown 		return -ENOMEM;
377f3208780SMark Brown 
3781438c2f6SLars-Peter Clausen 	list_for_each_entry(component, &component_list, list) {
3791438c2f6SLars-Peter Clausen 		list_for_each_entry(dai, &component->dai_list, list) {
3801438c2f6SLars-Peter Clausen 			len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
3811438c2f6SLars-Peter Clausen 				dai->name);
3822b194f9dSMark Brown 			if (len >= 0)
3832b194f9dSMark Brown 				ret += len;
3842b194f9dSMark Brown 			if (ret > PAGE_SIZE) {
3852b194f9dSMark Brown 				ret = PAGE_SIZE;
3862b194f9dSMark Brown 				break;
3872b194f9dSMark Brown 			}
3882b194f9dSMark Brown 		}
3891438c2f6SLars-Peter Clausen 	}
390f3208780SMark Brown 
391f3208780SMark Brown 	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
392f3208780SMark Brown 
393f3208780SMark Brown 	kfree(buf);
394f3208780SMark Brown 
395f3208780SMark Brown 	return ret;
396f3208780SMark Brown }
397f3208780SMark Brown 
398f3208780SMark Brown static const struct file_operations dai_list_fops = {
399f3208780SMark Brown 	.read = dai_list_read_file,
400f3208780SMark Brown 	.llseek = default_llseek,/* read accesses f_pos */
401f3208780SMark Brown };
402f3208780SMark Brown 
40319c7ac27SMark Brown static ssize_t platform_list_read_file(struct file *file,
40419c7ac27SMark Brown 				       char __user *user_buf,
40519c7ac27SMark Brown 				       size_t count, loff_t *ppos)
40619c7ac27SMark Brown {
40719c7ac27SMark Brown 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
4082b194f9dSMark Brown 	ssize_t len, ret = 0;
40919c7ac27SMark Brown 	struct snd_soc_platform *platform;
41019c7ac27SMark Brown 
41119c7ac27SMark Brown 	if (!buf)
41219c7ac27SMark Brown 		return -ENOMEM;
41319c7ac27SMark Brown 
4142b194f9dSMark Brown 	list_for_each_entry(platform, &platform_list, list) {
4152b194f9dSMark Brown 		len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
41619c7ac27SMark Brown 			       platform->name);
4172b194f9dSMark Brown 		if (len >= 0)
4182b194f9dSMark Brown 			ret += len;
4192b194f9dSMark Brown 		if (ret > PAGE_SIZE) {
4202b194f9dSMark Brown 			ret = PAGE_SIZE;
4212b194f9dSMark Brown 			break;
4222b194f9dSMark Brown 		}
4232b194f9dSMark Brown 	}
42419c7ac27SMark Brown 
42519c7ac27SMark Brown 	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
42619c7ac27SMark Brown 
42719c7ac27SMark Brown 	kfree(buf);
42819c7ac27SMark Brown 
42919c7ac27SMark Brown 	return ret;
43019c7ac27SMark Brown }
43119c7ac27SMark Brown 
43219c7ac27SMark Brown static const struct file_operations platform_list_fops = {
43319c7ac27SMark Brown 	.read = platform_list_read_file,
43419c7ac27SMark Brown 	.llseek = default_llseek,/* read accesses f_pos */
43519c7ac27SMark Brown };
43619c7ac27SMark Brown 
437a6052154SJarkko Nikula static void soc_init_card_debugfs(struct snd_soc_card *card)
438a6052154SJarkko Nikula {
439a6052154SJarkko Nikula 	card->debugfs_card_root = debugfs_create_dir(card->name,
4408a9dab1aSMark Brown 						     snd_soc_debugfs_root);
4413a45b867SJarkko Nikula 	if (!card->debugfs_card_root) {
442a6052154SJarkko Nikula 		dev_warn(card->dev,
4437c08be84SLothar Waßmann 			 "ASoC: Failed to create card debugfs directory\n");
4443a45b867SJarkko Nikula 		return;
4453a45b867SJarkko Nikula 	}
4463a45b867SJarkko Nikula 
4473a45b867SJarkko Nikula 	card->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0644,
4483a45b867SJarkko Nikula 						    card->debugfs_card_root,
4493a45b867SJarkko Nikula 						    &card->pop_time);
4503a45b867SJarkko Nikula 	if (!card->debugfs_pop_time)
4513a45b867SJarkko Nikula 		dev_warn(card->dev,
452f110bfc7SLiam Girdwood 		       "ASoC: Failed to create pop time debugfs file\n");
453a6052154SJarkko Nikula }
454a6052154SJarkko Nikula 
455a6052154SJarkko Nikula static void soc_cleanup_card_debugfs(struct snd_soc_card *card)
456a6052154SJarkko Nikula {
457a6052154SJarkko Nikula 	debugfs_remove_recursive(card->debugfs_card_root);
458a6052154SJarkko Nikula }
459a6052154SJarkko Nikula 
4602624d5faSMark Brown #else
4612624d5faSMark Brown 
4622624d5faSMark Brown static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
4632624d5faSMark Brown {
4642624d5faSMark Brown }
4652624d5faSMark Brown 
4662624d5faSMark Brown static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
4672624d5faSMark Brown {
4682624d5faSMark Brown }
469b95fccbcSAxel Lin 
470731f1ab2SSebastien Guiriec static inline void soc_init_platform_debugfs(struct snd_soc_platform *platform)
471731f1ab2SSebastien Guiriec {
472731f1ab2SSebastien Guiriec }
473731f1ab2SSebastien Guiriec 
474731f1ab2SSebastien Guiriec static inline void soc_cleanup_platform_debugfs(struct snd_soc_platform *platform)
475731f1ab2SSebastien Guiriec {
476731f1ab2SSebastien Guiriec }
477731f1ab2SSebastien Guiriec 
478b95fccbcSAxel Lin static inline void soc_init_card_debugfs(struct snd_soc_card *card)
479b95fccbcSAxel Lin {
480b95fccbcSAxel Lin }
481b95fccbcSAxel Lin 
482b95fccbcSAxel Lin static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card)
483b95fccbcSAxel Lin {
484b95fccbcSAxel Lin }
4852624d5faSMark Brown #endif
4862624d5faSMark Brown 
48747c88fffSLiam Girdwood struct snd_pcm_substream *snd_soc_get_dai_substream(struct snd_soc_card *card,
48847c88fffSLiam Girdwood 		const char *dai_link, int stream)
48947c88fffSLiam Girdwood {
49047c88fffSLiam Girdwood 	int i;
49147c88fffSLiam Girdwood 
49247c88fffSLiam Girdwood 	for (i = 0; i < card->num_links; i++) {
49347c88fffSLiam Girdwood 		if (card->rtd[i].dai_link->no_pcm &&
49447c88fffSLiam Girdwood 			!strcmp(card->rtd[i].dai_link->name, dai_link))
49547c88fffSLiam Girdwood 			return card->rtd[i].pcm->streams[stream].substream;
49647c88fffSLiam Girdwood 	}
497f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: failed to find dai link %s\n", dai_link);
49847c88fffSLiam Girdwood 	return NULL;
49947c88fffSLiam Girdwood }
50047c88fffSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_get_dai_substream);
50147c88fffSLiam Girdwood 
50247c88fffSLiam Girdwood struct snd_soc_pcm_runtime *snd_soc_get_pcm_runtime(struct snd_soc_card *card,
50347c88fffSLiam Girdwood 		const char *dai_link)
50447c88fffSLiam Girdwood {
50547c88fffSLiam Girdwood 	int i;
50647c88fffSLiam Girdwood 
50747c88fffSLiam Girdwood 	for (i = 0; i < card->num_links; i++) {
50847c88fffSLiam Girdwood 		if (!strcmp(card->rtd[i].dai_link->name, dai_link))
50947c88fffSLiam Girdwood 			return &card->rtd[i];
51047c88fffSLiam Girdwood 	}
511f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: failed to find rtd %s\n", dai_link);
51247c88fffSLiam Girdwood 	return NULL;
51347c88fffSLiam Girdwood }
51447c88fffSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_get_pcm_runtime);
51547c88fffSLiam Girdwood 
516db2a4165SFrank Mandarino #ifdef CONFIG_SND_SOC_AC97_BUS
517db2a4165SFrank Mandarino /* unregister ac97 codec */
518db2a4165SFrank Mandarino static int soc_ac97_dev_unregister(struct snd_soc_codec *codec)
519db2a4165SFrank Mandarino {
520db2a4165SFrank Mandarino 	if (codec->ac97->dev.bus)
521db2a4165SFrank Mandarino 		device_unregister(&codec->ac97->dev);
522db2a4165SFrank Mandarino 	return 0;
523db2a4165SFrank Mandarino }
524db2a4165SFrank Mandarino 
525db2a4165SFrank Mandarino /* stop no dev release warning */
526db2a4165SFrank Mandarino static void soc_ac97_device_release(struct device *dev){}
527db2a4165SFrank Mandarino 
528db2a4165SFrank Mandarino /* register ac97 codec to bus */
529db2a4165SFrank Mandarino static int soc_ac97_dev_register(struct snd_soc_codec *codec)
530db2a4165SFrank Mandarino {
531db2a4165SFrank Mandarino 	int err;
532db2a4165SFrank Mandarino 
533db2a4165SFrank Mandarino 	codec->ac97->dev.bus = &ac97_bus_type;
5344ac5c61fSMark Brown 	codec->ac97->dev.parent = codec->card->dev;
535db2a4165SFrank Mandarino 	codec->ac97->dev.release = soc_ac97_device_release;
536db2a4165SFrank Mandarino 
537bb072bf0SKay Sievers 	dev_set_name(&codec->ac97->dev, "%d-%d:%s",
538f0fba2adSLiam Girdwood 		     codec->card->snd_card->number, 0, codec->name);
539db2a4165SFrank Mandarino 	err = device_register(&codec->ac97->dev);
540db2a4165SFrank Mandarino 	if (err < 0) {
541f110bfc7SLiam Girdwood 		dev_err(codec->dev, "ASoC: Can't register ac97 bus\n");
542db2a4165SFrank Mandarino 		codec->ac97->dev.bus = NULL;
543db2a4165SFrank Mandarino 		return err;
544db2a4165SFrank Mandarino 	}
545db2a4165SFrank Mandarino 	return 0;
546db2a4165SFrank Mandarino }
547db2a4165SFrank Mandarino #endif
548db2a4165SFrank Mandarino 
5499d58a077SRichard Fitzgerald static void codec2codec_close_delayed_work(struct work_struct *work)
5509d58a077SRichard Fitzgerald {
5519d58a077SRichard Fitzgerald 	/* Currently nothing to do for c2c links
5529d58a077SRichard Fitzgerald 	 * Since c2c links are internal nodes in the DAPM graph and
5539d58a077SRichard Fitzgerald 	 * don't interface with the outside world or application layer
5549d58a077SRichard Fitzgerald 	 * we don't have to do any special handling on close.
5559d58a077SRichard Fitzgerald 	 */
5569d58a077SRichard Fitzgerald }
5579d58a077SRichard Fitzgerald 
5586f8ab4acSMark Brown #ifdef CONFIG_PM_SLEEP
559db2a4165SFrank Mandarino /* powers down audio subsystem for suspend */
5606f8ab4acSMark Brown int snd_soc_suspend(struct device *dev)
561db2a4165SFrank Mandarino {
5626f8ab4acSMark Brown 	struct snd_soc_card *card = dev_get_drvdata(dev);
5632eea392dSJarkko Nikula 	struct snd_soc_codec *codec;
564db2a4165SFrank Mandarino 	int i;
565db2a4165SFrank Mandarino 
566e3509ff0SDaniel Mack 	/* If the initialization of this soc device failed, there is no codec
567e3509ff0SDaniel Mack 	 * associated with it. Just bail out in this case.
568e3509ff0SDaniel Mack 	 */
569f0fba2adSLiam Girdwood 	if (list_empty(&card->codec_dev_list))
570e3509ff0SDaniel Mack 		return 0;
571e3509ff0SDaniel Mack 
5726ed25978SAndy Green 	/* Due to the resume being scheduled into a workqueue we could
5736ed25978SAndy Green 	* suspend before that's finished - wait for it to complete.
5746ed25978SAndy Green 	 */
575f0fba2adSLiam Girdwood 	snd_power_lock(card->snd_card);
576f0fba2adSLiam Girdwood 	snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0);
577f0fba2adSLiam Girdwood 	snd_power_unlock(card->snd_card);
5786ed25978SAndy Green 
5796ed25978SAndy Green 	/* we're going to block userspace touching us until resume completes */
580f0fba2adSLiam Girdwood 	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
5816ed25978SAndy Green 
582a00f90f9SMark Brown 	/* mute any active DACs */
583f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
584f0fba2adSLiam Girdwood 		struct snd_soc_dai *dai = card->rtd[i].codec_dai;
585f0fba2adSLiam Girdwood 		struct snd_soc_dai_driver *drv = dai->driver;
5863efab7dcSMark Brown 
587f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
5883efab7dcSMark Brown 			continue;
5893efab7dcSMark Brown 
590f0fba2adSLiam Girdwood 		if (drv->ops->digital_mute && dai->playback_active)
591f0fba2adSLiam Girdwood 			drv->ops->digital_mute(dai, 1);
592db2a4165SFrank Mandarino 	}
593db2a4165SFrank Mandarino 
5944ccab3e7SLiam Girdwood 	/* suspend all pcms */
595f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
596f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
5973efab7dcSMark Brown 			continue;
5983efab7dcSMark Brown 
599f0fba2adSLiam Girdwood 		snd_pcm_suspend_all(card->rtd[i].pcm);
6003efab7dcSMark Brown 	}
6014ccab3e7SLiam Girdwood 
60287506549SMark Brown 	if (card->suspend_pre)
60370b2ac12SMark Brown 		card->suspend_pre(card);
604db2a4165SFrank Mandarino 
605f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
606f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
607f0fba2adSLiam Girdwood 		struct snd_soc_platform *platform = card->rtd[i].platform;
6083efab7dcSMark Brown 
609f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
6103efab7dcSMark Brown 			continue;
6113efab7dcSMark Brown 
612f0fba2adSLiam Girdwood 		if (cpu_dai->driver->suspend && !cpu_dai->driver->ac97_control)
613f0fba2adSLiam Girdwood 			cpu_dai->driver->suspend(cpu_dai);
614f0fba2adSLiam Girdwood 		if (platform->driver->suspend && !platform->suspended) {
615f0fba2adSLiam Girdwood 			platform->driver->suspend(cpu_dai);
616f0fba2adSLiam Girdwood 			platform->suspended = 1;
617f0fba2adSLiam Girdwood 		}
618db2a4165SFrank Mandarino 	}
619db2a4165SFrank Mandarino 
620db2a4165SFrank Mandarino 	/* close any waiting streams and save state */
621f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
62243829731STejun Heo 		flush_delayed_work(&card->rtd[i].delayed_work);
623ce6120ccSLiam Girdwood 		card->rtd[i].codec->dapm.suspend_bias_level = card->rtd[i].codec->dapm.bias_level;
624f0fba2adSLiam Girdwood 	}
625db2a4165SFrank Mandarino 
626f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
6273efab7dcSMark Brown 
628f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
6293efab7dcSMark Brown 			continue;
6303efab7dcSMark Brown 
6317bd3a6f3SMark Brown 		snd_soc_dapm_stream_event(&card->rtd[i],
6327bd3a6f3SMark Brown 					  SNDRV_PCM_STREAM_PLAYBACK,
633db2a4165SFrank Mandarino 					  SND_SOC_DAPM_STREAM_SUSPEND);
634f0fba2adSLiam Girdwood 
6357bd3a6f3SMark Brown 		snd_soc_dapm_stream_event(&card->rtd[i],
6367bd3a6f3SMark Brown 					  SNDRV_PCM_STREAM_CAPTURE,
637db2a4165SFrank Mandarino 					  SND_SOC_DAPM_STREAM_SUSPEND);
638db2a4165SFrank Mandarino 	}
639db2a4165SFrank Mandarino 
640e2d32ff6SMark Brown 	/* Recheck all analogue paths too */
641e2d32ff6SMark Brown 	dapm_mark_io_dirty(&card->dapm);
642e2d32ff6SMark Brown 	snd_soc_dapm_sync(&card->dapm);
643e2d32ff6SMark Brown 
644f0fba2adSLiam Girdwood 	/* suspend all CODECs */
6452eea392dSJarkko Nikula 	list_for_each_entry(codec, &card->codec_dev_list, card_list) {
6461547aba9SMark Brown 		/* If there are paths active then the CODEC will be held with
6471547aba9SMark Brown 		 * bias _ON and should not be suspended. */
648f0fba2adSLiam Girdwood 		if (!codec->suspended && codec->driver->suspend) {
649ce6120ccSLiam Girdwood 			switch (codec->dapm.bias_level) {
6501547aba9SMark Brown 			case SND_SOC_BIAS_STANDBY:
651125a25daSMark Brown 				/*
652125a25daSMark Brown 				 * If the CODEC is capable of idle
653125a25daSMark Brown 				 * bias off then being in STANDBY
654125a25daSMark Brown 				 * means it's doing something,
655125a25daSMark Brown 				 * otherwise fall through.
656125a25daSMark Brown 				 */
657125a25daSMark Brown 				if (codec->dapm.idle_bias_off) {
658125a25daSMark Brown 					dev_dbg(codec->dev,
65910e8aa9aSMichał Mirosław 						"ASoC: idle_bias_off CODEC on over suspend\n");
660125a25daSMark Brown 					break;
661125a25daSMark Brown 				}
6621547aba9SMark Brown 			case SND_SOC_BIAS_OFF:
66384b315eeSLars-Peter Clausen 				codec->driver->suspend(codec);
664f0fba2adSLiam Girdwood 				codec->suspended = 1;
6657be4ba24SMark Brown 				codec->cache_sync = 1;
666da8b8e0fSMark Brown 				if (codec->using_regmap)
667da8b8e0fSMark Brown 					regcache_mark_dirty(codec->control_data);
668988e8cc4SNicolin Chen 				/* deactivate pins to sleep state */
669988e8cc4SNicolin Chen 				pinctrl_pm_select_sleep_state(codec->dev);
6701547aba9SMark Brown 				break;
6711547aba9SMark Brown 			default:
67210e8aa9aSMichał Mirosław 				dev_dbg(codec->dev,
67310e8aa9aSMichał Mirosław 					"ASoC: CODEC is on over suspend\n");
6741547aba9SMark Brown 				break;
6751547aba9SMark Brown 			}
6761547aba9SMark Brown 		}
677f0fba2adSLiam Girdwood 	}
678db2a4165SFrank Mandarino 
679f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
680f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
6813efab7dcSMark Brown 
682f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
6833efab7dcSMark Brown 			continue;
6843efab7dcSMark Brown 
685f0fba2adSLiam Girdwood 		if (cpu_dai->driver->suspend && cpu_dai->driver->ac97_control)
686f0fba2adSLiam Girdwood 			cpu_dai->driver->suspend(cpu_dai);
687988e8cc4SNicolin Chen 
688988e8cc4SNicolin Chen 		/* deactivate pins to sleep state */
689988e8cc4SNicolin Chen 		pinctrl_pm_select_sleep_state(cpu_dai->dev);
690db2a4165SFrank Mandarino 	}
691db2a4165SFrank Mandarino 
69287506549SMark Brown 	if (card->suspend_post)
69370b2ac12SMark Brown 		card->suspend_post(card);
694db2a4165SFrank Mandarino 
695db2a4165SFrank Mandarino 	return 0;
696db2a4165SFrank Mandarino }
6976f8ab4acSMark Brown EXPORT_SYMBOL_GPL(snd_soc_suspend);
698db2a4165SFrank Mandarino 
6996ed25978SAndy Green /* deferred resume work, so resume can complete before we finished
7006ed25978SAndy Green  * setting our codec back up, which can be very slow on I2C
7016ed25978SAndy Green  */
7026ed25978SAndy Green static void soc_resume_deferred(struct work_struct *work)
703db2a4165SFrank Mandarino {
704f0fba2adSLiam Girdwood 	struct snd_soc_card *card =
705f0fba2adSLiam Girdwood 			container_of(work, struct snd_soc_card, deferred_resume_work);
7062eea392dSJarkko Nikula 	struct snd_soc_codec *codec;
707db2a4165SFrank Mandarino 	int i;
708db2a4165SFrank Mandarino 
7096ed25978SAndy Green 	/* our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
7106ed25978SAndy Green 	 * so userspace apps are blocked from touching us
7116ed25978SAndy Green 	 */
7126ed25978SAndy Green 
713f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: starting resume work\n");
7146ed25978SAndy Green 
7159949788bSMark Brown 	/* Bring us up into D2 so that DAPM starts enabling things */
716f0fba2adSLiam Girdwood 	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
7179949788bSMark Brown 
71887506549SMark Brown 	if (card->resume_pre)
71970b2ac12SMark Brown 		card->resume_pre(card);
720db2a4165SFrank Mandarino 
721f0fba2adSLiam Girdwood 	/* resume AC97 DAIs */
722f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
723f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
7243efab7dcSMark Brown 
725f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
7263efab7dcSMark Brown 			continue;
7273efab7dcSMark Brown 
728f0fba2adSLiam Girdwood 		if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control)
729f0fba2adSLiam Girdwood 			cpu_dai->driver->resume(cpu_dai);
730db2a4165SFrank Mandarino 	}
731db2a4165SFrank Mandarino 
7322eea392dSJarkko Nikula 	list_for_each_entry(codec, &card->codec_dev_list, card_list) {
7331547aba9SMark Brown 		/* If the CODEC was idle over suspend then it will have been
7341547aba9SMark Brown 		 * left with bias OFF or STANDBY and suspended so we must now
7351547aba9SMark Brown 		 * resume.  Otherwise the suspend was suppressed.
7361547aba9SMark Brown 		 */
737f0fba2adSLiam Girdwood 		if (codec->driver->resume && codec->suspended) {
738ce6120ccSLiam Girdwood 			switch (codec->dapm.bias_level) {
7391547aba9SMark Brown 			case SND_SOC_BIAS_STANDBY:
7401547aba9SMark Brown 			case SND_SOC_BIAS_OFF:
741f0fba2adSLiam Girdwood 				codec->driver->resume(codec);
742f0fba2adSLiam Girdwood 				codec->suspended = 0;
7431547aba9SMark Brown 				break;
7441547aba9SMark Brown 			default:
74510e8aa9aSMichał Mirosław 				dev_dbg(codec->dev,
74610e8aa9aSMichał Mirosław 					"ASoC: CODEC was on over suspend\n");
7471547aba9SMark Brown 				break;
7481547aba9SMark Brown 			}
7491547aba9SMark Brown 		}
750f0fba2adSLiam Girdwood 	}
751db2a4165SFrank Mandarino 
752f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
7533efab7dcSMark Brown 
754f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
7553efab7dcSMark Brown 			continue;
7563efab7dcSMark Brown 
7577bd3a6f3SMark Brown 		snd_soc_dapm_stream_event(&card->rtd[i],
758d9b0951bSLiam Girdwood 					  SNDRV_PCM_STREAM_PLAYBACK,
759db2a4165SFrank Mandarino 					  SND_SOC_DAPM_STREAM_RESUME);
760f0fba2adSLiam Girdwood 
7617bd3a6f3SMark Brown 		snd_soc_dapm_stream_event(&card->rtd[i],
762d9b0951bSLiam Girdwood 					  SNDRV_PCM_STREAM_CAPTURE,
763db2a4165SFrank Mandarino 					  SND_SOC_DAPM_STREAM_RESUME);
764db2a4165SFrank Mandarino 	}
765db2a4165SFrank Mandarino 
7663ff3f64bSMark Brown 	/* unmute any active DACs */
767f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
768f0fba2adSLiam Girdwood 		struct snd_soc_dai *dai = card->rtd[i].codec_dai;
769f0fba2adSLiam Girdwood 		struct snd_soc_dai_driver *drv = dai->driver;
7703efab7dcSMark Brown 
771f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
7723efab7dcSMark Brown 			continue;
7733efab7dcSMark Brown 
774f0fba2adSLiam Girdwood 		if (drv->ops->digital_mute && dai->playback_active)
775f0fba2adSLiam Girdwood 			drv->ops->digital_mute(dai, 0);
776db2a4165SFrank Mandarino 	}
777db2a4165SFrank Mandarino 
778f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
779f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
780f0fba2adSLiam Girdwood 		struct snd_soc_platform *platform = card->rtd[i].platform;
7813efab7dcSMark Brown 
782f0fba2adSLiam Girdwood 		if (card->rtd[i].dai_link->ignore_suspend)
7833efab7dcSMark Brown 			continue;
7843efab7dcSMark Brown 
785f0fba2adSLiam Girdwood 		if (cpu_dai->driver->resume && !cpu_dai->driver->ac97_control)
786f0fba2adSLiam Girdwood 			cpu_dai->driver->resume(cpu_dai);
787f0fba2adSLiam Girdwood 		if (platform->driver->resume && platform->suspended) {
788f0fba2adSLiam Girdwood 			platform->driver->resume(cpu_dai);
789f0fba2adSLiam Girdwood 			platform->suspended = 0;
790f0fba2adSLiam Girdwood 		}
791db2a4165SFrank Mandarino 	}
792db2a4165SFrank Mandarino 
79387506549SMark Brown 	if (card->resume_post)
79470b2ac12SMark Brown 		card->resume_post(card);
795db2a4165SFrank Mandarino 
796f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: resume work completed\n");
7976ed25978SAndy Green 
7986ed25978SAndy Green 	/* userspace can access us now we are back as we were before */
799f0fba2adSLiam Girdwood 	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
800e2d32ff6SMark Brown 
801e2d32ff6SMark Brown 	/* Recheck all analogue paths too */
802e2d32ff6SMark Brown 	dapm_mark_io_dirty(&card->dapm);
803e2d32ff6SMark Brown 	snd_soc_dapm_sync(&card->dapm);
8046ed25978SAndy Green }
8056ed25978SAndy Green 
8066ed25978SAndy Green /* powers up audio subsystem after a suspend */
8076f8ab4acSMark Brown int snd_soc_resume(struct device *dev)
8086ed25978SAndy Green {
8096f8ab4acSMark Brown 	struct snd_soc_card *card = dev_get_drvdata(dev);
81082e14e8bSStephen Warren 	int i, ac97_control = 0;
811b9dd94a8SPeter Ujfalusi 
8125ff1ddf2SEric Miao 	/* If the initialization of this soc device failed, there is no codec
8135ff1ddf2SEric Miao 	 * associated with it. Just bail out in this case.
8145ff1ddf2SEric Miao 	 */
8155ff1ddf2SEric Miao 	if (list_empty(&card->codec_dev_list))
8165ff1ddf2SEric Miao 		return 0;
8175ff1ddf2SEric Miao 
818988e8cc4SNicolin Chen 	/* activate pins from sleep state */
819988e8cc4SNicolin Chen 	for (i = 0; i < card->num_rtd; i++) {
820988e8cc4SNicolin Chen 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
821988e8cc4SNicolin Chen 		struct snd_soc_dai *codec_dai = card->rtd[i].codec_dai;
822988e8cc4SNicolin Chen 		if (cpu_dai->active)
823988e8cc4SNicolin Chen 			pinctrl_pm_select_default_state(cpu_dai->dev);
824988e8cc4SNicolin Chen 		if (codec_dai->active)
825988e8cc4SNicolin Chen 			pinctrl_pm_select_default_state(codec_dai->dev);
826988e8cc4SNicolin Chen 	}
827988e8cc4SNicolin Chen 
82864ab9baaSMark Brown 	/* AC97 devices might have other drivers hanging off them so
82964ab9baaSMark Brown 	 * need to resume immediately.  Other drivers don't have that
83064ab9baaSMark Brown 	 * problem and may take a substantial amount of time to resume
83164ab9baaSMark Brown 	 * due to I/O costs and anti-pop so handle them out of line.
83264ab9baaSMark Brown 	 */
833f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
834f0fba2adSLiam Girdwood 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
83582e14e8bSStephen Warren 		ac97_control |= cpu_dai->driver->ac97_control;
83682e14e8bSStephen Warren 	}
83782e14e8bSStephen Warren 	if (ac97_control) {
838f110bfc7SLiam Girdwood 		dev_dbg(dev, "ASoC: Resuming AC97 immediately\n");
83964ab9baaSMark Brown 		soc_resume_deferred(&card->deferred_resume_work);
84064ab9baaSMark Brown 	} else {
841f110bfc7SLiam Girdwood 		dev_dbg(dev, "ASoC: Scheduling resume work\n");
8426308419aSMark Brown 		if (!schedule_work(&card->deferred_resume_work))
843f110bfc7SLiam Girdwood 			dev_err(dev, "ASoC: resume work item may be lost\n");
844f0fba2adSLiam Girdwood 	}
8456ed25978SAndy Green 
846db2a4165SFrank Mandarino 	return 0;
847db2a4165SFrank Mandarino }
8486f8ab4acSMark Brown EXPORT_SYMBOL_GPL(snd_soc_resume);
849db2a4165SFrank Mandarino #else
8506f8ab4acSMark Brown #define snd_soc_suspend NULL
8516f8ab4acSMark Brown #define snd_soc_resume NULL
852db2a4165SFrank Mandarino #endif
853db2a4165SFrank Mandarino 
85485e7652dSLars-Peter Clausen static const struct snd_soc_dai_ops null_dai_ops = {
85502a06d30SBarry Song };
85602a06d30SBarry Song 
85712023a9aSMisael Lopez Cruz static struct snd_soc_codec *soc_find_codec(const struct device_node *codec_of_node,
85812023a9aSMisael Lopez Cruz 					    const char *codec_name)
85912023a9aSMisael Lopez Cruz {
86012023a9aSMisael Lopez Cruz 	struct snd_soc_codec *codec;
86112023a9aSMisael Lopez Cruz 
86212023a9aSMisael Lopez Cruz 	list_for_each_entry(codec, &codec_list, list) {
86312023a9aSMisael Lopez Cruz 		if (codec_of_node) {
86412023a9aSMisael Lopez Cruz 			if (codec->dev->of_node != codec_of_node)
86512023a9aSMisael Lopez Cruz 				continue;
86612023a9aSMisael Lopez Cruz 		} else {
86712023a9aSMisael Lopez Cruz 			if (strcmp(codec->name, codec_name))
86812023a9aSMisael Lopez Cruz 				continue;
86912023a9aSMisael Lopez Cruz 		}
87012023a9aSMisael Lopez Cruz 
87112023a9aSMisael Lopez Cruz 		return codec;
87212023a9aSMisael Lopez Cruz 	}
87312023a9aSMisael Lopez Cruz 
87412023a9aSMisael Lopez Cruz 	return NULL;
87512023a9aSMisael Lopez Cruz }
87612023a9aSMisael Lopez Cruz 
87712023a9aSMisael Lopez Cruz static struct snd_soc_dai *soc_find_codec_dai(struct snd_soc_codec *codec,
87812023a9aSMisael Lopez Cruz 					      const char *codec_dai_name)
87912023a9aSMisael Lopez Cruz {
88012023a9aSMisael Lopez Cruz 	struct snd_soc_dai *codec_dai;
88112023a9aSMisael Lopez Cruz 
88212023a9aSMisael Lopez Cruz 	list_for_each_entry(codec_dai, &codec->component.dai_list, list) {
88312023a9aSMisael Lopez Cruz 		if (!strcmp(codec_dai->name, codec_dai_name)) {
88412023a9aSMisael Lopez Cruz 			return codec_dai;
88512023a9aSMisael Lopez Cruz 		}
88612023a9aSMisael Lopez Cruz 	}
88712023a9aSMisael Lopez Cruz 
88812023a9aSMisael Lopez Cruz 	return NULL;
88912023a9aSMisael Lopez Cruz }
89012023a9aSMisael Lopez Cruz 
891f0fba2adSLiam Girdwood static int soc_bind_dai_link(struct snd_soc_card *card, int num)
892db2a4165SFrank Mandarino {
893f0fba2adSLiam Girdwood 	struct snd_soc_dai_link *dai_link = &card->dai_link[num];
894f0fba2adSLiam Girdwood 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
8951438c2f6SLars-Peter Clausen 	struct snd_soc_component *component;
896435c5e25SMark Brown 	struct snd_soc_platform *platform;
89712023a9aSMisael Lopez Cruz 	struct snd_soc_dai *cpu_dai;
898848dd8beSMark Brown 	const char *platform_name;
899db2a4165SFrank Mandarino 
900f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: binding %s at idx %d\n", dai_link->name, num);
9016308419aSMark Brown 
902b19e6e7bSMark Brown 	/* Find CPU DAI from registered DAIs*/
9031438c2f6SLars-Peter Clausen 	list_for_each_entry(component, &component_list, list) {
904bc92657aSStephen Warren 		if (dai_link->cpu_of_node &&
9051438c2f6SLars-Peter Clausen 			component->dev->of_node != dai_link->cpu_of_node)
9065a504963SStephen Warren 			continue;
907bc92657aSStephen Warren 		if (dai_link->cpu_name &&
9081438c2f6SLars-Peter Clausen 			strcmp(dev_name(component->dev), dai_link->cpu_name))
9092610ab77SStephen Warren 			continue;
9101438c2f6SLars-Peter Clausen 		list_for_each_entry(cpu_dai, &component->dai_list, list) {
911bc92657aSStephen Warren 			if (dai_link->cpu_dai_name &&
912bc92657aSStephen Warren 				strcmp(cpu_dai->name, dai_link->cpu_dai_name))
913bc92657aSStephen Warren 				continue;
9142610ab77SStephen Warren 
915f0fba2adSLiam Girdwood 			rtd->cpu_dai = cpu_dai;
916f0fba2adSLiam Girdwood 		}
9171438c2f6SLars-Peter Clausen 	}
918b19e6e7bSMark Brown 
919b19e6e7bSMark Brown 	if (!rtd->cpu_dai) {
920f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: CPU DAI %s not registered\n",
921f0fba2adSLiam Girdwood 			dai_link->cpu_dai_name);
922b19e6e7bSMark Brown 		return -EPROBE_DEFER;
923c5af3a2eSMark Brown 	}
924c5af3a2eSMark Brown 
92512023a9aSMisael Lopez Cruz 	/* Find CODEC from registered list */
92612023a9aSMisael Lopez Cruz 	rtd->codec = soc_find_codec(dai_link->codec_of_node,
92712023a9aSMisael Lopez Cruz 				    dai_link->codec_name);
928b19e6e7bSMark Brown 	if (!rtd->codec) {
929f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: CODEC %s not registered\n",
930f0fba2adSLiam Girdwood 			dai_link->codec_name);
931b19e6e7bSMark Brown 		return -EPROBE_DEFER;
932b19e6e7bSMark Brown 	}
933848dd8beSMark Brown 
93412023a9aSMisael Lopez Cruz 	/* Find CODEC DAI from registered list */
93512023a9aSMisael Lopez Cruz 	rtd->codec_dai = soc_find_codec_dai(rtd->codec,
93612023a9aSMisael Lopez Cruz 					    dai_link->codec_dai_name);
93712023a9aSMisael Lopez Cruz 	if (!rtd->codec_dai) {
93812023a9aSMisael Lopez Cruz 		dev_err(card->dev, "ASoC: CODEC DAI %s not registered\n",
93912023a9aSMisael Lopez Cruz 			dai_link->codec_dai_name);
94012023a9aSMisael Lopez Cruz 		return -EPROBE_DEFER;
94112023a9aSMisael Lopez Cruz 	}
94212023a9aSMisael Lopez Cruz 
943848dd8beSMark Brown 	/* if there's no platform we match on the empty platform */
944848dd8beSMark Brown 	platform_name = dai_link->platform_name;
9455a504963SStephen Warren 	if (!platform_name && !dai_link->platform_of_node)
946848dd8beSMark Brown 		platform_name = "snd-soc-dummy";
947848dd8beSMark Brown 
948b19e6e7bSMark Brown 	/* find one from the set of registered platforms */
949f0fba2adSLiam Girdwood 	list_for_each_entry(platform, &platform_list, list) {
9505a504963SStephen Warren 		if (dai_link->platform_of_node) {
9515a504963SStephen Warren 			if (platform->dev->of_node !=
9525a504963SStephen Warren 			    dai_link->platform_of_node)
9535a504963SStephen Warren 				continue;
9545a504963SStephen Warren 		} else {
9552610ab77SStephen Warren 			if (strcmp(platform->name, platform_name))
9562610ab77SStephen Warren 				continue;
9575a504963SStephen Warren 		}
9582610ab77SStephen Warren 
959f0fba2adSLiam Girdwood 		rtd->platform = platform;
960f0fba2adSLiam Girdwood 	}
961b19e6e7bSMark Brown 	if (!rtd->platform) {
962f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: platform %s not registered\n",
963f0fba2adSLiam Girdwood 			dai_link->platform_name);
964b19e6e7bSMark Brown 		return -EPROBE_DEFER;
965f0fba2adSLiam Girdwood 	}
966b19e6e7bSMark Brown 
967b19e6e7bSMark Brown 	card->num_rtd++;
968b19e6e7bSMark Brown 
969b19e6e7bSMark Brown 	return 0;
9706b05eda6SMark Brown }
9716b05eda6SMark Brown 
972d12cd198SStephen Warren static int soc_remove_platform(struct snd_soc_platform *platform)
973d12cd198SStephen Warren {
974d12cd198SStephen Warren 	int ret;
975d12cd198SStephen Warren 
976d12cd198SStephen Warren 	if (platform->driver->remove) {
977d12cd198SStephen Warren 		ret = platform->driver->remove(platform);
978d12cd198SStephen Warren 		if (ret < 0)
979f110bfc7SLiam Girdwood 			dev_err(platform->dev, "ASoC: failed to remove %d\n",
980f110bfc7SLiam Girdwood 				ret);
981d12cd198SStephen Warren 	}
982d12cd198SStephen Warren 
983d12cd198SStephen Warren 	/* Make sure all DAPM widgets are freed */
984d12cd198SStephen Warren 	snd_soc_dapm_free(&platform->dapm);
985d12cd198SStephen Warren 
986d12cd198SStephen Warren 	soc_cleanup_platform_debugfs(platform);
987d12cd198SStephen Warren 	platform->probed = 0;
988d12cd198SStephen Warren 	list_del(&platform->card_list);
989d12cd198SStephen Warren 	module_put(platform->dev->driver->owner);
990d12cd198SStephen Warren 
991d12cd198SStephen Warren 	return 0;
992d12cd198SStephen Warren }
993d12cd198SStephen Warren 
994589c3563SJarkko Nikula static void soc_remove_codec(struct snd_soc_codec *codec)
995589c3563SJarkko Nikula {
996589c3563SJarkko Nikula 	int err;
997589c3563SJarkko Nikula 
998589c3563SJarkko Nikula 	if (codec->driver->remove) {
999589c3563SJarkko Nikula 		err = codec->driver->remove(codec);
1000589c3563SJarkko Nikula 		if (err < 0)
1001f110bfc7SLiam Girdwood 			dev_err(codec->dev, "ASoC: failed to remove %d\n", err);
1002589c3563SJarkko Nikula 	}
1003589c3563SJarkko Nikula 
1004589c3563SJarkko Nikula 	/* Make sure all DAPM widgets are freed */
1005589c3563SJarkko Nikula 	snd_soc_dapm_free(&codec->dapm);
1006589c3563SJarkko Nikula 
1007589c3563SJarkko Nikula 	soc_cleanup_codec_debugfs(codec);
1008589c3563SJarkko Nikula 	codec->probed = 0;
1009589c3563SJarkko Nikula 	list_del(&codec->card_list);
1010589c3563SJarkko Nikula 	module_put(codec->dev->driver->owner);
1011589c3563SJarkko Nikula }
1012589c3563SJarkko Nikula 
1013b0aa88afSMisael Lopez Cruz static void soc_remove_codec_dai(struct snd_soc_dai *codec_dai, int order)
1014b0aa88afSMisael Lopez Cruz {
1015b0aa88afSMisael Lopez Cruz 	int err;
1016b0aa88afSMisael Lopez Cruz 
1017b0aa88afSMisael Lopez Cruz 	if (codec_dai && codec_dai->probed &&
1018b0aa88afSMisael Lopez Cruz 			codec_dai->driver->remove_order == order) {
1019b0aa88afSMisael Lopez Cruz 		if (codec_dai->driver->remove) {
1020b0aa88afSMisael Lopez Cruz 			err = codec_dai->driver->remove(codec_dai);
1021b0aa88afSMisael Lopez Cruz 			if (err < 0)
1022b0aa88afSMisael Lopez Cruz 				dev_err(codec_dai->dev,
1023b0aa88afSMisael Lopez Cruz 					"ASoC: failed to remove %s: %d\n",
1024b0aa88afSMisael Lopez Cruz 					codec_dai->name, err);
1025b0aa88afSMisael Lopez Cruz 		}
1026b0aa88afSMisael Lopez Cruz 		codec_dai->probed = 0;
1027b0aa88afSMisael Lopez Cruz 		list_del(&codec_dai->card_list);
1028b0aa88afSMisael Lopez Cruz 	}
1029b0aa88afSMisael Lopez Cruz }
1030b0aa88afSMisael Lopez Cruz 
103162ae68faSStephen Warren static void soc_remove_link_dais(struct snd_soc_card *card, int num, int order)
1032f0fba2adSLiam Girdwood {
1033f0fba2adSLiam Girdwood 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1034f0fba2adSLiam Girdwood 	struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
1035f0fba2adSLiam Girdwood 	int err;
1036f0fba2adSLiam Girdwood 
1037f0fba2adSLiam Girdwood 	/* unregister the rtd device */
1038f0fba2adSLiam Girdwood 	if (rtd->dev_registered) {
103936ae1a96SMark Brown 		device_remove_file(rtd->dev, &dev_attr_pmdown_time);
104036ae1a96SMark Brown 		device_remove_file(rtd->dev, &dev_attr_codec_reg);
104136ae1a96SMark Brown 		device_unregister(rtd->dev);
1042f0fba2adSLiam Girdwood 		rtd->dev_registered = 0;
104302a06d30SBarry Song 	}
104402a06d30SBarry Song 
1045f0fba2adSLiam Girdwood 	/* remove the CODEC DAI */
1046b0aa88afSMisael Lopez Cruz 	soc_remove_codec_dai(codec_dai, order);
1047f0fba2adSLiam Girdwood 
1048f0fba2adSLiam Girdwood 	/* remove the cpu_dai */
10490168bf0dSLiam Girdwood 	if (cpu_dai && cpu_dai->probed &&
10500168bf0dSLiam Girdwood 			cpu_dai->driver->remove_order == order) {
1051f0fba2adSLiam Girdwood 		if (cpu_dai->driver->remove) {
1052f0fba2adSLiam Girdwood 			err = cpu_dai->driver->remove(cpu_dai);
1053f0fba2adSLiam Girdwood 			if (err < 0)
1054f110bfc7SLiam Girdwood 				dev_err(cpu_dai->dev,
1055f110bfc7SLiam Girdwood 					"ASoC: failed to remove %s: %d\n",
10560837fc62SFabio Estevam 					cpu_dai->name, err);
1057f0fba2adSLiam Girdwood 		}
1058f0fba2adSLiam Girdwood 		cpu_dai->probed = 0;
1059f0fba2adSLiam Girdwood 		list_del(&cpu_dai->card_list);
1060a9db7dbeSStephen Warren 
106118d75644SStephen Warren 		if (!cpu_dai->codec) {
106218d75644SStephen Warren 			snd_soc_dapm_free(&cpu_dai->dapm);
1063f0fba2adSLiam Girdwood 			module_put(cpu_dai->dev->driver->owner);
1064f0fba2adSLiam Girdwood 		}
1065f0fba2adSLiam Girdwood 	}
106618d75644SStephen Warren }
1067f0fba2adSLiam Girdwood 
106862ae68faSStephen Warren static void soc_remove_link_components(struct snd_soc_card *card, int num,
106962ae68faSStephen Warren 				       int order)
107062ae68faSStephen Warren {
107162ae68faSStephen Warren 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
107262ae68faSStephen Warren 	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
107362ae68faSStephen Warren 	struct snd_soc_dai *codec_dai = rtd->codec_dai;
107462ae68faSStephen Warren 	struct snd_soc_platform *platform = rtd->platform;
107562ae68faSStephen Warren 	struct snd_soc_codec *codec;
107662ae68faSStephen Warren 
107762ae68faSStephen Warren 	/* remove the platform */
107862ae68faSStephen Warren 	if (platform && platform->probed &&
107962ae68faSStephen Warren 	    platform->driver->remove_order == order) {
108062ae68faSStephen Warren 		soc_remove_platform(platform);
108162ae68faSStephen Warren 	}
108262ae68faSStephen Warren 
108362ae68faSStephen Warren 	/* remove the CODEC-side CODEC */
108462ae68faSStephen Warren 	if (codec_dai) {
108562ae68faSStephen Warren 		codec = codec_dai->codec;
108662ae68faSStephen Warren 		if (codec && codec->probed &&
108762ae68faSStephen Warren 		    codec->driver->remove_order == order)
108862ae68faSStephen Warren 			soc_remove_codec(codec);
108962ae68faSStephen Warren 	}
109062ae68faSStephen Warren 
109162ae68faSStephen Warren 	/* remove any CPU-side CODEC */
109262ae68faSStephen Warren 	if (cpu_dai) {
109362ae68faSStephen Warren 		codec = cpu_dai->codec;
109462ae68faSStephen Warren 		if (codec && codec->probed &&
109562ae68faSStephen Warren 		    codec->driver->remove_order == order)
109662ae68faSStephen Warren 			soc_remove_codec(codec);
109762ae68faSStephen Warren 	}
109862ae68faSStephen Warren }
109962ae68faSStephen Warren 
11000671fd8eSKuninori Morimoto static void soc_remove_dai_links(struct snd_soc_card *card)
11010671fd8eSKuninori Morimoto {
11020168bf0dSLiam Girdwood 	int dai, order;
11030671fd8eSKuninori Morimoto 
11040168bf0dSLiam Girdwood 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
11050168bf0dSLiam Girdwood 			order++) {
11060168bf0dSLiam Girdwood 		for (dai = 0; dai < card->num_rtd; dai++)
110762ae68faSStephen Warren 			soc_remove_link_dais(card, dai, order);
11080168bf0dSLiam Girdwood 	}
110962ae68faSStephen Warren 
111062ae68faSStephen Warren 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
111162ae68faSStephen Warren 			order++) {
111262ae68faSStephen Warren 		for (dai = 0; dai < card->num_rtd; dai++)
111362ae68faSStephen Warren 			soc_remove_link_components(card, dai, order);
111462ae68faSStephen Warren 	}
111562ae68faSStephen Warren 
11160671fd8eSKuninori Morimoto 	card->num_rtd = 0;
11170671fd8eSKuninori Morimoto }
11180671fd8eSKuninori Morimoto 
1119ead9b919SJarkko Nikula static void soc_set_name_prefix(struct snd_soc_card *card,
1120ead9b919SJarkko Nikula 				struct snd_soc_codec *codec)
1121ead9b919SJarkko Nikula {
1122ead9b919SJarkko Nikula 	int i;
1123ead9b919SJarkko Nikula 
1124ff819b83SDimitris Papastamos 	if (card->codec_conf == NULL)
1125ead9b919SJarkko Nikula 		return;
1126ead9b919SJarkko Nikula 
1127ff819b83SDimitris Papastamos 	for (i = 0; i < card->num_configs; i++) {
1128ff819b83SDimitris Papastamos 		struct snd_soc_codec_conf *map = &card->codec_conf[i];
1129ead9b919SJarkko Nikula 		if (map->dev_name && !strcmp(codec->name, map->dev_name)) {
1130ead9b919SJarkko Nikula 			codec->name_prefix = map->name_prefix;
1131ead9b919SJarkko Nikula 			break;
1132ead9b919SJarkko Nikula 		}
1133ead9b919SJarkko Nikula 	}
1134ead9b919SJarkko Nikula }
1135ead9b919SJarkko Nikula 
1136589c3563SJarkko Nikula static int soc_probe_codec(struct snd_soc_card *card,
1137589c3563SJarkko Nikula 			   struct snd_soc_codec *codec)
1138589c3563SJarkko Nikula {
1139589c3563SJarkko Nikula 	int ret = 0;
114089b95ac0SMark Brown 	const struct snd_soc_codec_driver *driver = codec->driver;
1141888df395SMark Brown 	struct snd_soc_dai *dai;
1142589c3563SJarkko Nikula 
1143589c3563SJarkko Nikula 	codec->card = card;
1144589c3563SJarkko Nikula 	codec->dapm.card = card;
1145589c3563SJarkko Nikula 	soc_set_name_prefix(card, codec);
1146589c3563SJarkko Nikula 
114770d29331SJarkko Nikula 	if (!try_module_get(codec->dev->driver->owner))
114870d29331SJarkko Nikula 		return -ENODEV;
114970d29331SJarkko Nikula 
1150d5d1e0beSLars-Peter Clausen 	soc_init_codec_debugfs(codec);
1151d5d1e0beSLars-Peter Clausen 
115277530150SLars-Peter Clausen 	if (driver->dapm_widgets)
115377530150SLars-Peter Clausen 		snd_soc_dapm_new_controls(&codec->dapm, driver->dapm_widgets,
115477530150SLars-Peter Clausen 					  driver->num_dapm_widgets);
115577530150SLars-Peter Clausen 
1156888df395SMark Brown 	/* Create DAPM widgets for each DAI stream */
11571438c2f6SLars-Peter Clausen 	list_for_each_entry(dai, &codec->component.dai_list, list)
1158888df395SMark Brown 		snd_soc_dapm_new_dai_widgets(&codec->dapm, dai);
1159888df395SMark Brown 
116033c5f969SMark Brown 	codec->dapm.idle_bias_off = driver->idle_bias_off;
116133c5f969SMark Brown 
1162a32c17b8SXiubo Li 	if (!codec->write && dev_get_regmap(codec->dev, NULL)) {
1163fe2265e4SXiubo Li 		/* Set the default I/O up try regmap */
1164a32c17b8SXiubo Li 		ret = snd_soc_codec_set_cache_io(codec, NULL);
1165a32c17b8SXiubo Li 		if (ret < 0) {
1166a32c17b8SXiubo Li 			dev_err(codec->dev,
1167a32c17b8SXiubo Li 				"Failed to set cache I/O: %d\n", ret);
1168a32c17b8SXiubo Li 			goto err_probe;
1169a32c17b8SXiubo Li 		}
1170a32c17b8SXiubo Li 	}
1171fe2265e4SXiubo Li 
117289b95ac0SMark Brown 	if (driver->probe) {
117389b95ac0SMark Brown 		ret = driver->probe(codec);
1174589c3563SJarkko Nikula 		if (ret < 0) {
1175589c3563SJarkko Nikula 			dev_err(codec->dev,
1176f110bfc7SLiam Girdwood 				"ASoC: failed to probe CODEC %d\n", ret);
117770d29331SJarkko Nikula 			goto err_probe;
1178589c3563SJarkko Nikula 		}
1179ff541f4bSChuansheng Liu 		WARN(codec->dapm.idle_bias_off &&
1180ff541f4bSChuansheng Liu 			codec->dapm.bias_level != SND_SOC_BIAS_OFF,
118110e8aa9aSMichał Mirosław 			"codec %s can not start from non-off bias with idle_bias_off==1\n",
118210e8aa9aSMichał Mirosław 			codec->name);
1183589c3563SJarkko Nikula 	}
1184589c3563SJarkko Nikula 
1185b7af1dafSMark Brown 	if (driver->controls)
1186022658beSLiam Girdwood 		snd_soc_add_codec_controls(codec, driver->controls,
1187b7af1dafSMark Brown 				     driver->num_controls);
118889b95ac0SMark Brown 	if (driver->dapm_routes)
118989b95ac0SMark Brown 		snd_soc_dapm_add_routes(&codec->dapm, driver->dapm_routes,
119089b95ac0SMark Brown 					driver->num_dapm_routes);
119189b95ac0SMark Brown 
1192589c3563SJarkko Nikula 	/* mark codec as probed and add to card codec list */
1193589c3563SJarkko Nikula 	codec->probed = 1;
1194589c3563SJarkko Nikula 	list_add(&codec->card_list, &card->codec_dev_list);
11957be31be8SJarkko Nikula 	list_add(&codec->dapm.list, &card->dapm_list);
1196589c3563SJarkko Nikula 
119770d29331SJarkko Nikula 	return 0;
119870d29331SJarkko Nikula 
119970d29331SJarkko Nikula err_probe:
1200d5d1e0beSLars-Peter Clausen 	soc_cleanup_codec_debugfs(codec);
120170d29331SJarkko Nikula 	module_put(codec->dev->driver->owner);
120270d29331SJarkko Nikula 
1203589c3563SJarkko Nikula 	return ret;
1204589c3563SJarkko Nikula }
1205589c3563SJarkko Nikula 
1206956245e9SLiam Girdwood static int soc_probe_platform(struct snd_soc_card *card,
1207956245e9SLiam Girdwood 			   struct snd_soc_platform *platform)
1208956245e9SLiam Girdwood {
1209956245e9SLiam Girdwood 	int ret = 0;
1210956245e9SLiam Girdwood 	const struct snd_soc_platform_driver *driver = platform->driver;
12111438c2f6SLars-Peter Clausen 	struct snd_soc_component *component;
1212be09ad90SLiam Girdwood 	struct snd_soc_dai *dai;
1213956245e9SLiam Girdwood 
1214956245e9SLiam Girdwood 	platform->card = card;
1215b7950641SLiam Girdwood 	platform->dapm.card = card;
1216956245e9SLiam Girdwood 
1217956245e9SLiam Girdwood 	if (!try_module_get(platform->dev->driver->owner))
1218956245e9SLiam Girdwood 		return -ENODEV;
1219956245e9SLiam Girdwood 
1220731f1ab2SSebastien Guiriec 	soc_init_platform_debugfs(platform);
1221731f1ab2SSebastien Guiriec 
1222cb2cf612SLiam Girdwood 	if (driver->dapm_widgets)
1223cb2cf612SLiam Girdwood 		snd_soc_dapm_new_controls(&platform->dapm,
1224cb2cf612SLiam Girdwood 			driver->dapm_widgets, driver->num_dapm_widgets);
1225cb2cf612SLiam Girdwood 
1226be09ad90SLiam Girdwood 	/* Create DAPM widgets for each DAI stream */
12271438c2f6SLars-Peter Clausen 	list_for_each_entry(component, &component_list, list) {
12281438c2f6SLars-Peter Clausen 		if (component->dev != platform->dev)
1229be09ad90SLiam Girdwood 			continue;
12301438c2f6SLars-Peter Clausen 		list_for_each_entry(dai, &component->dai_list, list)
1231be09ad90SLiam Girdwood 			snd_soc_dapm_new_dai_widgets(&platform->dapm, dai);
1232be09ad90SLiam Girdwood 	}
1233be09ad90SLiam Girdwood 
12343fec6b6dSStephen Warren 	platform->dapm.idle_bias_off = 1;
12353fec6b6dSStephen Warren 
1236956245e9SLiam Girdwood 	if (driver->probe) {
1237956245e9SLiam Girdwood 		ret = driver->probe(platform);
1238956245e9SLiam Girdwood 		if (ret < 0) {
1239956245e9SLiam Girdwood 			dev_err(platform->dev,
1240f110bfc7SLiam Girdwood 				"ASoC: failed to probe platform %d\n", ret);
1241956245e9SLiam Girdwood 			goto err_probe;
1242956245e9SLiam Girdwood 		}
1243956245e9SLiam Girdwood 	}
1244956245e9SLiam Girdwood 
1245cb2cf612SLiam Girdwood 	if (driver->controls)
1246cb2cf612SLiam Girdwood 		snd_soc_add_platform_controls(platform, driver->controls,
1247cb2cf612SLiam Girdwood 				     driver->num_controls);
1248cb2cf612SLiam Girdwood 	if (driver->dapm_routes)
1249cb2cf612SLiam Girdwood 		snd_soc_dapm_add_routes(&platform->dapm, driver->dapm_routes,
1250cb2cf612SLiam Girdwood 					driver->num_dapm_routes);
1251cb2cf612SLiam Girdwood 
1252956245e9SLiam Girdwood 	/* mark platform as probed and add to card platform list */
1253956245e9SLiam Girdwood 	platform->probed = 1;
1254956245e9SLiam Girdwood 	list_add(&platform->card_list, &card->platform_dev_list);
1255b7950641SLiam Girdwood 	list_add(&platform->dapm.list, &card->dapm_list);
1256956245e9SLiam Girdwood 
1257956245e9SLiam Girdwood 	return 0;
1258956245e9SLiam Girdwood 
1259956245e9SLiam Girdwood err_probe:
126002db1103SLiam Girdwood 	soc_cleanup_platform_debugfs(platform);
1261956245e9SLiam Girdwood 	module_put(platform->dev->driver->owner);
1262956245e9SLiam Girdwood 
1263956245e9SLiam Girdwood 	return ret;
1264956245e9SLiam Girdwood }
1265956245e9SLiam Girdwood 
126636ae1a96SMark Brown static void rtd_release(struct device *dev)
126736ae1a96SMark Brown {
126836ae1a96SMark Brown 	kfree(dev);
126936ae1a96SMark Brown }
1270f0fba2adSLiam Girdwood 
1271589c3563SJarkko Nikula static int soc_post_component_init(struct snd_soc_card *card,
1272589c3563SJarkko Nikula 				   struct snd_soc_codec *codec,
1273589c3563SJarkko Nikula 				   int num, int dailess)
1274589c3563SJarkko Nikula {
1275589c3563SJarkko Nikula 	struct snd_soc_dai_link *dai_link = NULL;
1276589c3563SJarkko Nikula 	struct snd_soc_aux_dev *aux_dev = NULL;
1277589c3563SJarkko Nikula 	struct snd_soc_pcm_runtime *rtd;
12786479f15aSLars-Peter Clausen 	const char *name;
1279589c3563SJarkko Nikula 	int ret = 0;
1280589c3563SJarkko Nikula 
1281589c3563SJarkko Nikula 	if (!dailess) {
1282589c3563SJarkko Nikula 		dai_link = &card->dai_link[num];
1283589c3563SJarkko Nikula 		rtd = &card->rtd[num];
1284589c3563SJarkko Nikula 		name = dai_link->name;
1285589c3563SJarkko Nikula 	} else {
1286589c3563SJarkko Nikula 		aux_dev = &card->aux_dev[num];
1287589c3563SJarkko Nikula 		rtd = &card->rtd_aux[num];
1288589c3563SJarkko Nikula 		name = aux_dev->name;
1289589c3563SJarkko Nikula 	}
12900962bb21SJanusz Krzysztofik 	rtd->card = card;
1291589c3563SJarkko Nikula 
1292589c3563SJarkko Nikula 	/* do machine specific initialization */
1293589c3563SJarkko Nikula 	if (!dailess && dai_link->init)
1294589c3563SJarkko Nikula 		ret = dai_link->init(rtd);
1295589c3563SJarkko Nikula 	else if (dailess && aux_dev->init)
1296589c3563SJarkko Nikula 		ret = aux_dev->init(&codec->dapm);
1297589c3563SJarkko Nikula 	if (ret < 0) {
1298f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: failed to init %s: %d\n", name, ret);
1299589c3563SJarkko Nikula 		return ret;
1300589c3563SJarkko Nikula 	}
1301589c3563SJarkko Nikula 
1302589c3563SJarkko Nikula 	/* register the rtd device */
1303589c3563SJarkko Nikula 	rtd->codec = codec;
130436ae1a96SMark Brown 
130536ae1a96SMark Brown 	rtd->dev = kzalloc(sizeof(struct device), GFP_KERNEL);
130636ae1a96SMark Brown 	if (!rtd->dev)
130736ae1a96SMark Brown 		return -ENOMEM;
130836ae1a96SMark Brown 	device_initialize(rtd->dev);
130936ae1a96SMark Brown 	rtd->dev->parent = card->dev;
131036ae1a96SMark Brown 	rtd->dev->release = rtd_release;
131136ae1a96SMark Brown 	rtd->dev->init_name = name;
131236ae1a96SMark Brown 	dev_set_drvdata(rtd->dev, rtd);
1313b8c0dab9SLiam Girdwood 	mutex_init(&rtd->pcm_mutex);
131401d7584cSLiam Girdwood 	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].be_clients);
131501d7584cSLiam Girdwood 	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].be_clients);
131601d7584cSLiam Girdwood 	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].fe_clients);
131701d7584cSLiam Girdwood 	INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].fe_clients);
131836ae1a96SMark Brown 	ret = device_add(rtd->dev);
1319589c3563SJarkko Nikula 	if (ret < 0) {
1320865df9cbSChuansheng Liu 		/* calling put_device() here to free the rtd->dev */
1321865df9cbSChuansheng Liu 		put_device(rtd->dev);
1322589c3563SJarkko Nikula 		dev_err(card->dev,
1323f110bfc7SLiam Girdwood 			"ASoC: failed to register runtime device: %d\n", ret);
1324589c3563SJarkko Nikula 		return ret;
1325589c3563SJarkko Nikula 	}
1326589c3563SJarkko Nikula 	rtd->dev_registered = 1;
1327589c3563SJarkko Nikula 
1328589c3563SJarkko Nikula 	/* add DAPM sysfs entries for this codec */
132936ae1a96SMark Brown 	ret = snd_soc_dapm_sys_add(rtd->dev);
1330589c3563SJarkko Nikula 	if (ret < 0)
1331589c3563SJarkko Nikula 		dev_err(codec->dev,
1332f110bfc7SLiam Girdwood 			"ASoC: failed to add codec dapm sysfs entries: %d\n", ret);
1333589c3563SJarkko Nikula 
1334589c3563SJarkko Nikula 	/* add codec sysfs entries */
133536ae1a96SMark Brown 	ret = device_create_file(rtd->dev, &dev_attr_codec_reg);
1336589c3563SJarkko Nikula 	if (ret < 0)
1337589c3563SJarkko Nikula 		dev_err(codec->dev,
1338f110bfc7SLiam Girdwood 			"ASoC: failed to add codec sysfs files: %d\n", ret);
1339589c3563SJarkko Nikula 
1340f86dcef8SLiam Girdwood #ifdef CONFIG_DEBUG_FS
1341f86dcef8SLiam Girdwood 	/* add DPCM sysfs entries */
1342cd0f8911SLiam Girdwood 	if (!dailess && !dai_link->dynamic)
1343f86dcef8SLiam Girdwood 		goto out;
1344f86dcef8SLiam Girdwood 
1345f86dcef8SLiam Girdwood 	ret = soc_dpcm_debugfs_add(rtd);
1346f86dcef8SLiam Girdwood 	if (ret < 0)
1347f110bfc7SLiam Girdwood 		dev_err(rtd->dev, "ASoC: failed to add dpcm sysfs entries: %d\n", ret);
1348f86dcef8SLiam Girdwood 
1349f86dcef8SLiam Girdwood out:
1350f86dcef8SLiam Girdwood #endif
1351589c3563SJarkko Nikula 	return 0;
1352589c3563SJarkko Nikula }
1353589c3563SJarkko Nikula 
135462ae68faSStephen Warren static int soc_probe_link_components(struct snd_soc_card *card, int num,
135562ae68faSStephen Warren 				     int order)
135662ae68faSStephen Warren {
135762ae68faSStephen Warren 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
135862ae68faSStephen Warren 	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
135962ae68faSStephen Warren 	struct snd_soc_dai *codec_dai = rtd->codec_dai;
136062ae68faSStephen Warren 	struct snd_soc_platform *platform = rtd->platform;
136162ae68faSStephen Warren 	int ret;
136262ae68faSStephen Warren 
136362ae68faSStephen Warren 	/* probe the CPU-side component, if it is a CODEC */
136462ae68faSStephen Warren 	if (cpu_dai->codec &&
136562ae68faSStephen Warren 	    !cpu_dai->codec->probed &&
136662ae68faSStephen Warren 	    cpu_dai->codec->driver->probe_order == order) {
136762ae68faSStephen Warren 		ret = soc_probe_codec(card, cpu_dai->codec);
136862ae68faSStephen Warren 		if (ret < 0)
136962ae68faSStephen Warren 			return ret;
137062ae68faSStephen Warren 	}
137162ae68faSStephen Warren 
137262ae68faSStephen Warren 	/* probe the CODEC-side component */
137362ae68faSStephen Warren 	if (!codec_dai->codec->probed &&
137462ae68faSStephen Warren 	    codec_dai->codec->driver->probe_order == order) {
137562ae68faSStephen Warren 		ret = soc_probe_codec(card, codec_dai->codec);
137662ae68faSStephen Warren 		if (ret < 0)
137762ae68faSStephen Warren 			return ret;
137862ae68faSStephen Warren 	}
137962ae68faSStephen Warren 
138062ae68faSStephen Warren 	/* probe the platform */
138162ae68faSStephen Warren 	if (!platform->probed &&
138262ae68faSStephen Warren 	    platform->driver->probe_order == order) {
138362ae68faSStephen Warren 		ret = soc_probe_platform(card, platform);
138462ae68faSStephen Warren 		if (ret < 0)
138562ae68faSStephen Warren 			return ret;
138662ae68faSStephen Warren 	}
138762ae68faSStephen Warren 
138862ae68faSStephen Warren 	return 0;
138962ae68faSStephen Warren }
139062ae68faSStephen Warren 
1391b0aa88afSMisael Lopez Cruz static int soc_probe_codec_dai(struct snd_soc_card *card,
1392b0aa88afSMisael Lopez Cruz 			       struct snd_soc_dai *codec_dai,
1393b0aa88afSMisael Lopez Cruz 			       int order)
1394b0aa88afSMisael Lopez Cruz {
1395b0aa88afSMisael Lopez Cruz 	int ret;
1396b0aa88afSMisael Lopez Cruz 
1397b0aa88afSMisael Lopez Cruz 	if (!codec_dai->probed && codec_dai->driver->probe_order == order) {
1398b0aa88afSMisael Lopez Cruz 		if (codec_dai->driver->probe) {
1399b0aa88afSMisael Lopez Cruz 			ret = codec_dai->driver->probe(codec_dai);
1400b0aa88afSMisael Lopez Cruz 			if (ret < 0) {
1401b0aa88afSMisael Lopez Cruz 				dev_err(codec_dai->dev,
1402b0aa88afSMisael Lopez Cruz 					"ASoC: failed to probe CODEC DAI %s: %d\n",
1403b0aa88afSMisael Lopez Cruz 					codec_dai->name, ret);
1404b0aa88afSMisael Lopez Cruz 				return ret;
1405b0aa88afSMisael Lopez Cruz 			}
1406b0aa88afSMisael Lopez Cruz 		}
1407b0aa88afSMisael Lopez Cruz 
1408b0aa88afSMisael Lopez Cruz 		/* mark codec_dai as probed and add to card dai list */
1409b0aa88afSMisael Lopez Cruz 		codec_dai->probed = 1;
1410b0aa88afSMisael Lopez Cruz 		list_add(&codec_dai->card_list, &card->dai_dev_list);
1411b0aa88afSMisael Lopez Cruz 	}
1412b0aa88afSMisael Lopez Cruz 
1413b0aa88afSMisael Lopez Cruz 	return 0;
1414b0aa88afSMisael Lopez Cruz }
1415b0aa88afSMisael Lopez Cruz 
1416*2436a723SMisael Lopez Cruz static int soc_link_dai_widgets(struct snd_soc_card *card,
1417*2436a723SMisael Lopez Cruz 				struct snd_soc_dai_link *dai_link,
1418*2436a723SMisael Lopez Cruz 				struct snd_soc_dai *cpu_dai,
1419*2436a723SMisael Lopez Cruz 				struct snd_soc_dai *codec_dai)
1420*2436a723SMisael Lopez Cruz {
1421*2436a723SMisael Lopez Cruz 	struct snd_soc_dapm_widget *play_w, *capture_w;
1422*2436a723SMisael Lopez Cruz 	int ret;
1423*2436a723SMisael Lopez Cruz 
1424*2436a723SMisael Lopez Cruz 	/* link the DAI widgets */
1425*2436a723SMisael Lopez Cruz 	play_w = codec_dai->playback_widget;
1426*2436a723SMisael Lopez Cruz 	capture_w = cpu_dai->capture_widget;
1427*2436a723SMisael Lopez Cruz 	if (play_w && capture_w) {
1428*2436a723SMisael Lopez Cruz 		ret = snd_soc_dapm_new_pcm(card, dai_link->params,
1429*2436a723SMisael Lopez Cruz 					   capture_w, play_w);
1430*2436a723SMisael Lopez Cruz 		if (ret != 0) {
1431*2436a723SMisael Lopez Cruz 			dev_err(card->dev, "ASoC: Can't link %s to %s: %d\n",
1432*2436a723SMisael Lopez Cruz 				play_w->name, capture_w->name, ret);
1433*2436a723SMisael Lopez Cruz 			return ret;
1434*2436a723SMisael Lopez Cruz 		}
1435*2436a723SMisael Lopez Cruz 	}
1436*2436a723SMisael Lopez Cruz 
1437*2436a723SMisael Lopez Cruz 	play_w = cpu_dai->playback_widget;
1438*2436a723SMisael Lopez Cruz 	capture_w = codec_dai->capture_widget;
1439*2436a723SMisael Lopez Cruz 	if (play_w && capture_w) {
1440*2436a723SMisael Lopez Cruz 		ret = snd_soc_dapm_new_pcm(card, dai_link->params,
1441*2436a723SMisael Lopez Cruz 					   capture_w, play_w);
1442*2436a723SMisael Lopez Cruz 		if (ret != 0) {
1443*2436a723SMisael Lopez Cruz 			dev_err(card->dev, "ASoC: Can't link %s to %s: %d\n",
1444*2436a723SMisael Lopez Cruz 				play_w->name, capture_w->name, ret);
1445*2436a723SMisael Lopez Cruz 			return ret;
1446*2436a723SMisael Lopez Cruz 		}
1447*2436a723SMisael Lopez Cruz 	}
1448*2436a723SMisael Lopez Cruz 
1449*2436a723SMisael Lopez Cruz 	return 0;
1450*2436a723SMisael Lopez Cruz }
1451*2436a723SMisael Lopez Cruz 
145262ae68faSStephen Warren static int soc_probe_link_dais(struct snd_soc_card *card, int num, int order)
1453f0fba2adSLiam Girdwood {
1454f0fba2adSLiam Girdwood 	struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1455f0fba2adSLiam Girdwood 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1456f0fba2adSLiam Girdwood 	struct snd_soc_codec *codec = rtd->codec;
1457f0fba2adSLiam Girdwood 	struct snd_soc_platform *platform = rtd->platform;
1458c74184edSMark Brown 	struct snd_soc_dai *codec_dai = rtd->codec_dai;
1459c74184edSMark Brown 	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1460f0fba2adSLiam Girdwood 	int ret;
1461f0fba2adSLiam Girdwood 
1462f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: probe %s dai link %d late %d\n",
14630168bf0dSLiam Girdwood 			card->name, num, order);
1464f0fba2adSLiam Girdwood 
1465f0fba2adSLiam Girdwood 	/* config components */
1466f0fba2adSLiam Girdwood 	cpu_dai->platform = platform;
1467f0fba2adSLiam Girdwood 	codec_dai->card = card;
1468f0fba2adSLiam Girdwood 	cpu_dai->card = card;
1469f0fba2adSLiam Girdwood 
1470f0fba2adSLiam Girdwood 	/* set default power off timeout */
1471f0fba2adSLiam Girdwood 	rtd->pmdown_time = pmdown_time;
1472f0fba2adSLiam Girdwood 
1473f0fba2adSLiam Girdwood 	/* probe the cpu_dai */
14740168bf0dSLiam Girdwood 	if (!cpu_dai->probed &&
14750168bf0dSLiam Girdwood 			cpu_dai->driver->probe_order == order) {
1476a9db7dbeSStephen Warren 		if (!cpu_dai->codec) {
1477be09ad90SLiam Girdwood 			cpu_dai->dapm.card = card;
147861b61e3cSLiam Girdwood 			if (!try_module_get(cpu_dai->dev->driver->owner))
147961b61e3cSLiam Girdwood 				return -ENODEV;
148061b61e3cSLiam Girdwood 
148118d75644SStephen Warren 			list_add(&cpu_dai->dapm.list, &card->dapm_list);
1482a9db7dbeSStephen Warren 		}
1483be09ad90SLiam Girdwood 
1484f0fba2adSLiam Girdwood 		if (cpu_dai->driver->probe) {
1485f0fba2adSLiam Girdwood 			ret = cpu_dai->driver->probe(cpu_dai);
1486f0fba2adSLiam Girdwood 			if (ret < 0) {
1487f110bfc7SLiam Girdwood 				dev_err(cpu_dai->dev,
1488f110bfc7SLiam Girdwood 					"ASoC: failed to probe CPU DAI %s: %d\n",
14890837fc62SFabio Estevam 					cpu_dai->name, ret);
149061b61e3cSLiam Girdwood 				module_put(cpu_dai->dev->driver->owner);
1491f0fba2adSLiam Girdwood 				return ret;
1492f0fba2adSLiam Girdwood 			}
1493f0fba2adSLiam Girdwood 		}
1494f0fba2adSLiam Girdwood 		cpu_dai->probed = 1;
14951c8371d6SWolfram Sang 		/* mark cpu_dai as probed and add to card dai list */
1496f0fba2adSLiam Girdwood 		list_add(&cpu_dai->card_list, &card->dai_dev_list);
1497f0fba2adSLiam Girdwood 	}
1498f0fba2adSLiam Girdwood 
1499f0fba2adSLiam Girdwood 	/* probe the CODEC DAI */
1500b0aa88afSMisael Lopez Cruz 	ret = soc_probe_codec_dai(card, codec_dai, order);
1501b0aa88afSMisael Lopez Cruz 	if (ret)
1502f0fba2adSLiam Girdwood 		return ret;
1503f0fba2adSLiam Girdwood 
15040168bf0dSLiam Girdwood 	/* complete DAI probe during last probe */
15050168bf0dSLiam Girdwood 	if (order != SND_SOC_COMP_ORDER_LAST)
15060168bf0dSLiam Girdwood 		return 0;
15070168bf0dSLiam Girdwood 
1508589c3563SJarkko Nikula 	ret = soc_post_component_init(card, codec, num, 0);
1509589c3563SJarkko Nikula 	if (ret)
1510f0fba2adSLiam Girdwood 		return ret;
1511f0fba2adSLiam Girdwood 
151236ae1a96SMark Brown 	ret = device_create_file(rtd->dev, &dev_attr_pmdown_time);
1513f0fba2adSLiam Girdwood 	if (ret < 0)
1514f110bfc7SLiam Girdwood 		dev_warn(rtd->dev, "ASoC: failed to add pmdown_time sysfs: %d\n",
1515f110bfc7SLiam Girdwood 			ret);
1516f0fba2adSLiam Girdwood 
15171245b700SNamarta Kohli 	if (cpu_dai->driver->compress_dai) {
15181245b700SNamarta Kohli 		/*create compress_device"*/
15191245b700SNamarta Kohli 		ret = soc_new_compress(rtd, num);
15201245b700SNamarta Kohli 		if (ret < 0) {
1521f110bfc7SLiam Girdwood 			dev_err(card->dev, "ASoC: can't create compress %s\n",
15221245b700SNamarta Kohli 					 dai_link->stream_name);
15231245b700SNamarta Kohli 			return ret;
15241245b700SNamarta Kohli 		}
15251245b700SNamarta Kohli 	} else {
15261245b700SNamarta Kohli 
1527c74184edSMark Brown 		if (!dai_link->params) {
1528f0fba2adSLiam Girdwood 			/* create the pcm */
1529f0fba2adSLiam Girdwood 			ret = soc_new_pcm(rtd, num);
1530f0fba2adSLiam Girdwood 			if (ret < 0) {
1531f110bfc7SLiam Girdwood 				dev_err(card->dev, "ASoC: can't create pcm %s :%d\n",
15320837fc62SFabio Estevam 				       dai_link->stream_name, ret);
1533f0fba2adSLiam Girdwood 				return ret;
1534f0fba2adSLiam Girdwood 			}
1535c74184edSMark Brown 		} else {
15369d58a077SRichard Fitzgerald 			INIT_DELAYED_WORK(&rtd->delayed_work,
15379d58a077SRichard Fitzgerald 						codec2codec_close_delayed_work);
15389d58a077SRichard Fitzgerald 
1539c74184edSMark Brown 			/* link the DAI widgets */
1540*2436a723SMisael Lopez Cruz 			ret = soc_link_dai_widgets(card, dai_link,
1541*2436a723SMisael Lopez Cruz 					cpu_dai, codec_dai);
1542*2436a723SMisael Lopez Cruz 			if (ret)
1543c74184edSMark Brown 				return ret;
1544c74184edSMark Brown 		}
1545c74184edSMark Brown 	}
1546c74184edSMark Brown 
1547f0fba2adSLiam Girdwood 	/* add platform data for AC97 devices */
1548f0fba2adSLiam Girdwood 	if (rtd->codec_dai->driver->ac97_control)
1549f0fba2adSLiam Girdwood 		snd_ac97_dev_add_pdata(codec->ac97, rtd->cpu_dai->ac97_pdata);
1550f0fba2adSLiam Girdwood 
1551f0fba2adSLiam Girdwood 	return 0;
1552f0fba2adSLiam Girdwood }
1553f0fba2adSLiam Girdwood 
1554f0fba2adSLiam Girdwood #ifdef CONFIG_SND_SOC_AC97_BUS
1555f0fba2adSLiam Girdwood static int soc_register_ac97_dai_link(struct snd_soc_pcm_runtime *rtd)
1556f0fba2adSLiam Girdwood {
1557f0fba2adSLiam Girdwood 	int ret;
1558f0fba2adSLiam Girdwood 
1559f0fba2adSLiam Girdwood 	/* Only instantiate AC97 if not already done by the adaptor
1560f0fba2adSLiam Girdwood 	 * for the generic AC97 subsystem.
15616b05eda6SMark Brown 	 */
1562f0fba2adSLiam Girdwood 	if (rtd->codec_dai->driver->ac97_control && !rtd->codec->ac97_registered) {
15630562f788SMika Westerberg 		/*
15640562f788SMika Westerberg 		 * It is possible that the AC97 device is already registered to
15650562f788SMika Westerberg 		 * the device subsystem. This happens when the device is created
15660562f788SMika Westerberg 		 * via snd_ac97_mixer(). Currently only SoC codec that does so
15670562f788SMika Westerberg 		 * is the generic AC97 glue but others migh emerge.
15680562f788SMika Westerberg 		 *
15690562f788SMika Westerberg 		 * In those cases we don't try to register the device again.
15700562f788SMika Westerberg 		 */
15710562f788SMika Westerberg 		if (!rtd->codec->ac97_created)
15720562f788SMika Westerberg 			return 0;
1573f0fba2adSLiam Girdwood 
1574f0fba2adSLiam Girdwood 		ret = soc_ac97_dev_register(rtd->codec);
1575f0fba2adSLiam Girdwood 		if (ret < 0) {
1576f110bfc7SLiam Girdwood 			dev_err(rtd->codec->dev,
1577f110bfc7SLiam Girdwood 				"ASoC: AC97 device register failed: %d\n", ret);
1578f0fba2adSLiam Girdwood 			return ret;
1579435c5e25SMark Brown 		}
1580435c5e25SMark Brown 
1581f0fba2adSLiam Girdwood 		rtd->codec->ac97_registered = 1;
1582f0fba2adSLiam Girdwood 	}
1583f0fba2adSLiam Girdwood 	return 0;
1584f0fba2adSLiam Girdwood }
1585435c5e25SMark Brown 
1586f0fba2adSLiam Girdwood static void soc_unregister_ac97_dai_link(struct snd_soc_codec *codec)
1587f0fba2adSLiam Girdwood {
1588f0fba2adSLiam Girdwood 	if (codec->ac97_registered) {
1589f0fba2adSLiam Girdwood 		soc_ac97_dev_unregister(codec);
1590f0fba2adSLiam Girdwood 		codec->ac97_registered = 0;
1591f0fba2adSLiam Girdwood 	}
1592f0fba2adSLiam Girdwood }
1593f0fba2adSLiam Girdwood #endif
1594435c5e25SMark Brown 
1595b19e6e7bSMark Brown static int soc_check_aux_dev(struct snd_soc_card *card, int num)
1596b19e6e7bSMark Brown {
1597b19e6e7bSMark Brown 	struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
1598b19e6e7bSMark Brown 	struct snd_soc_codec *codec;
1599b19e6e7bSMark Brown 
1600b19e6e7bSMark Brown 	/* find CODEC from registered CODECs*/
1601b19e6e7bSMark Brown 	list_for_each_entry(codec, &codec_list, list) {
1602b19e6e7bSMark Brown 		if (!strcmp(codec->name, aux_dev->codec_name))
1603b19e6e7bSMark Brown 			return 0;
1604b19e6e7bSMark Brown 	}
1605b19e6e7bSMark Brown 
1606f110bfc7SLiam Girdwood 	dev_err(card->dev, "ASoC: %s not registered\n", aux_dev->codec_name);
1607fb099cb7SMark Brown 
1608b19e6e7bSMark Brown 	return -EPROBE_DEFER;
1609b19e6e7bSMark Brown }
1610b19e6e7bSMark Brown 
16112eea392dSJarkko Nikula static int soc_probe_aux_dev(struct snd_soc_card *card, int num)
16122eea392dSJarkko Nikula {
16132eea392dSJarkko Nikula 	struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
16142eea392dSJarkko Nikula 	struct snd_soc_codec *codec;
1615676ad98aSJarkko Nikula 	int ret = -ENODEV;
16162eea392dSJarkko Nikula 
16172eea392dSJarkko Nikula 	/* find CODEC from registered CODECs*/
16182eea392dSJarkko Nikula 	list_for_each_entry(codec, &codec_list, list) {
16192eea392dSJarkko Nikula 		if (!strcmp(codec->name, aux_dev->codec_name)) {
16202eea392dSJarkko Nikula 			if (codec->probed) {
16212eea392dSJarkko Nikula 				dev_err(codec->dev,
1622f110bfc7SLiam Girdwood 					"ASoC: codec already probed");
16232eea392dSJarkko Nikula 				ret = -EBUSY;
16242eea392dSJarkko Nikula 				goto out;
16252eea392dSJarkko Nikula 			}
1626676ad98aSJarkko Nikula 			goto found;
16272eea392dSJarkko Nikula 		}
16282eea392dSJarkko Nikula 	}
1629676ad98aSJarkko Nikula 	/* codec not found */
1630f110bfc7SLiam Girdwood 	dev_err(card->dev, "ASoC: codec %s not found", aux_dev->codec_name);
1631b19e6e7bSMark Brown 	return -EPROBE_DEFER;
16322eea392dSJarkko Nikula 
1633676ad98aSJarkko Nikula found:
1634589c3563SJarkko Nikula 	ret = soc_probe_codec(card, codec);
16352eea392dSJarkko Nikula 	if (ret < 0)
1636589c3563SJarkko Nikula 		return ret;
16372eea392dSJarkko Nikula 
1638589c3563SJarkko Nikula 	ret = soc_post_component_init(card, codec, num, 1);
16392eea392dSJarkko Nikula 
16402eea392dSJarkko Nikula out:
16412eea392dSJarkko Nikula 	return ret;
16422eea392dSJarkko Nikula }
16432eea392dSJarkko Nikula 
16442eea392dSJarkko Nikula static void soc_remove_aux_dev(struct snd_soc_card *card, int num)
16452eea392dSJarkko Nikula {
16462eea392dSJarkko Nikula 	struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
16472eea392dSJarkko Nikula 	struct snd_soc_codec *codec = rtd->codec;
16482eea392dSJarkko Nikula 
16492eea392dSJarkko Nikula 	/* unregister the rtd device */
16502eea392dSJarkko Nikula 	if (rtd->dev_registered) {
165136ae1a96SMark Brown 		device_remove_file(rtd->dev, &dev_attr_codec_reg);
1652d3bf1561SChuansheng Liu 		device_unregister(rtd->dev);
16532eea392dSJarkko Nikula 		rtd->dev_registered = 0;
16542eea392dSJarkko Nikula 	}
16552eea392dSJarkko Nikula 
1656589c3563SJarkko Nikula 	if (codec && codec->probed)
1657589c3563SJarkko Nikula 		soc_remove_codec(codec);
16582eea392dSJarkko Nikula }
16592eea392dSJarkko Nikula 
1660f90fb3f7SLars-Peter Clausen static int snd_soc_init_codec_cache(struct snd_soc_codec *codec)
1661fdf0f54dSDimitris Papastamos {
1662fdf0f54dSDimitris Papastamos 	int ret;
1663fdf0f54dSDimitris Papastamos 
1664fdf0f54dSDimitris Papastamos 	if (codec->cache_init)
1665fdf0f54dSDimitris Papastamos 		return 0;
1666fdf0f54dSDimitris Papastamos 
1667fdf0f54dSDimitris Papastamos 	ret = snd_soc_cache_init(codec);
1668fdf0f54dSDimitris Papastamos 	if (ret < 0) {
166910e8aa9aSMichał Mirosław 		dev_err(codec->dev,
167010e8aa9aSMichał Mirosław 			"ASoC: Failed to set cache compression type: %d\n",
167110e8aa9aSMichał Mirosław 			ret);
1672fdf0f54dSDimitris Papastamos 		return ret;
1673fdf0f54dSDimitris Papastamos 	}
1674fdf0f54dSDimitris Papastamos 	codec->cache_init = 1;
1675fdf0f54dSDimitris Papastamos 	return 0;
1676fdf0f54dSDimitris Papastamos }
1677fdf0f54dSDimitris Papastamos 
1678b19e6e7bSMark Brown static int snd_soc_instantiate_card(struct snd_soc_card *card)
1679f0fba2adSLiam Girdwood {
1680fdf0f54dSDimitris Papastamos 	struct snd_soc_codec *codec;
168175d9ac46SMark Brown 	struct snd_soc_dai_link *dai_link;
1682f04209a7SMark Brown 	int ret, i, order, dai_fmt;
168396dd3622SMark Brown 
168401b9d99aSLiam Girdwood 	mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_INIT);
1685f0fba2adSLiam Girdwood 
1686b19e6e7bSMark Brown 	/* bind DAIs */
1687b19e6e7bSMark Brown 	for (i = 0; i < card->num_links; i++) {
1688b19e6e7bSMark Brown 		ret = soc_bind_dai_link(card, i);
1689b19e6e7bSMark Brown 		if (ret != 0)
1690b19e6e7bSMark Brown 			goto base_error;
1691db2a4165SFrank Mandarino 	}
1692db2a4165SFrank Mandarino 
1693b19e6e7bSMark Brown 	/* check aux_devs too */
1694b19e6e7bSMark Brown 	for (i = 0; i < card->num_aux_devs; i++) {
1695b19e6e7bSMark Brown 		ret = soc_check_aux_dev(card, i);
1696b19e6e7bSMark Brown 		if (ret != 0)
1697b19e6e7bSMark Brown 			goto base_error;
1698db2a4165SFrank Mandarino 	}
1699db2a4165SFrank Mandarino 
1700fdf0f54dSDimitris Papastamos 	/* initialize the register cache for each available codec */
1701fdf0f54dSDimitris Papastamos 	list_for_each_entry(codec, &codec_list, list) {
1702fdf0f54dSDimitris Papastamos 		if (codec->cache_init)
1703fdf0f54dSDimitris Papastamos 			continue;
1704f90fb3f7SLars-Peter Clausen 		ret = snd_soc_init_codec_cache(codec);
1705b19e6e7bSMark Brown 		if (ret < 0)
1706b19e6e7bSMark Brown 			goto base_error;
1707fdf0f54dSDimitris Papastamos 	}
1708fdf0f54dSDimitris Papastamos 
1709f0fba2adSLiam Girdwood 	/* card bind complete so register a sound card */
1710102b5a8dSTakashi Iwai 	ret = snd_card_new(card->dev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
1711f0fba2adSLiam Girdwood 			card->owner, 0, &card->snd_card);
1712f0fba2adSLiam Girdwood 	if (ret < 0) {
171310e8aa9aSMichał Mirosław 		dev_err(card->dev,
171410e8aa9aSMichał Mirosław 			"ASoC: can't create sound card for card %s: %d\n",
171510e8aa9aSMichał Mirosław 			card->name, ret);
1716b19e6e7bSMark Brown 		goto base_error;
1717db2a4165SFrank Mandarino 	}
1718db2a4165SFrank Mandarino 
1719e37a4970SMark Brown 	card->dapm.bias_level = SND_SOC_BIAS_OFF;
1720e37a4970SMark Brown 	card->dapm.dev = card->dev;
1721e37a4970SMark Brown 	card->dapm.card = card;
1722e37a4970SMark Brown 	list_add(&card->dapm.list, &card->dapm_list);
1723e37a4970SMark Brown 
1724d5d1e0beSLars-Peter Clausen #ifdef CONFIG_DEBUG_FS
1725d5d1e0beSLars-Peter Clausen 	snd_soc_dapm_debugfs_init(&card->dapm, card->debugfs_card_root);
1726d5d1e0beSLars-Peter Clausen #endif
1727d5d1e0beSLars-Peter Clausen 
172888ee1c61SMark Brown #ifdef CONFIG_PM_SLEEP
17296ed25978SAndy Green 	/* deferred resume work */
17306308419aSMark Brown 	INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
17311301a964SRandy Dunlap #endif
17326ed25978SAndy Green 
17339a841ebbSMark Brown 	if (card->dapm_widgets)
17349a841ebbSMark Brown 		snd_soc_dapm_new_controls(&card->dapm, card->dapm_widgets,
17359a841ebbSMark Brown 					  card->num_dapm_widgets);
17369a841ebbSMark Brown 
1737f0fba2adSLiam Girdwood 	/* initialise the sound card only once */
1738f0fba2adSLiam Girdwood 	if (card->probe) {
1739e7361ec4SMark Brown 		ret = card->probe(card);
1740f0fba2adSLiam Girdwood 		if (ret < 0)
1741f0fba2adSLiam Girdwood 			goto card_probe_error;
1742f0fba2adSLiam Girdwood 	}
1743f0fba2adSLiam Girdwood 
174462ae68faSStephen Warren 	/* probe all components used by DAI links on this card */
17450168bf0dSLiam Girdwood 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
17460168bf0dSLiam Girdwood 			order++) {
1747fe3e78e0SMark Brown 		for (i = 0; i < card->num_links; i++) {
174862ae68faSStephen Warren 			ret = soc_probe_link_components(card, i, order);
174962ae68faSStephen Warren 			if (ret < 0) {
1750f110bfc7SLiam Girdwood 				dev_err(card->dev,
1751f110bfc7SLiam Girdwood 					"ASoC: failed to instantiate card %d\n",
1752f110bfc7SLiam Girdwood 					ret);
175362ae68faSStephen Warren 				goto probe_dai_err;
175462ae68faSStephen Warren 			}
175562ae68faSStephen Warren 		}
175662ae68faSStephen Warren 	}
175762ae68faSStephen Warren 
175862ae68faSStephen Warren 	/* probe all DAI links on this card */
175962ae68faSStephen Warren 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
176062ae68faSStephen Warren 			order++) {
176162ae68faSStephen Warren 		for (i = 0; i < card->num_links; i++) {
176262ae68faSStephen Warren 			ret = soc_probe_link_dais(card, i, order);
1763fe3e78e0SMark Brown 			if (ret < 0) {
1764f110bfc7SLiam Girdwood 				dev_err(card->dev,
1765f110bfc7SLiam Girdwood 					"ASoC: failed to instantiate card %d\n",
1766f110bfc7SLiam Girdwood 					ret);
1767f0fba2adSLiam Girdwood 				goto probe_dai_err;
1768fe3e78e0SMark Brown 			}
1769fe3e78e0SMark Brown 		}
17700168bf0dSLiam Girdwood 	}
1771fe3e78e0SMark Brown 
17722eea392dSJarkko Nikula 	for (i = 0; i < card->num_aux_devs; i++) {
17732eea392dSJarkko Nikula 		ret = soc_probe_aux_dev(card, i);
17742eea392dSJarkko Nikula 		if (ret < 0) {
1775f110bfc7SLiam Girdwood 			dev_err(card->dev,
1776f110bfc7SLiam Girdwood 				"ASoC: failed to add auxiliary devices %d\n",
1777f110bfc7SLiam Girdwood 				ret);
17782eea392dSJarkko Nikula 			goto probe_aux_dev_err;
17792eea392dSJarkko Nikula 		}
17802eea392dSJarkko Nikula 	}
17812eea392dSJarkko Nikula 
1782888df395SMark Brown 	snd_soc_dapm_link_dai_widgets(card);
1783b893ea5fSLiam Girdwood 	snd_soc_dapm_connect_dai_link_widgets(card);
1784888df395SMark Brown 
1785b7af1dafSMark Brown 	if (card->controls)
1786022658beSLiam Girdwood 		snd_soc_add_card_controls(card, card->controls, card->num_controls);
1787b7af1dafSMark Brown 
1788b8ad29deSMark Brown 	if (card->dapm_routes)
1789b8ad29deSMark Brown 		snd_soc_dapm_add_routes(&card->dapm, card->dapm_routes,
1790b8ad29deSMark Brown 					card->num_dapm_routes);
1791b8ad29deSMark Brown 
179275d9ac46SMark Brown 	for (i = 0; i < card->num_links; i++) {
179375d9ac46SMark Brown 		dai_link = &card->dai_link[i];
1794f04209a7SMark Brown 		dai_fmt = dai_link->dai_fmt;
179575d9ac46SMark Brown 
1796f04209a7SMark Brown 		if (dai_fmt) {
179775d9ac46SMark Brown 			ret = snd_soc_dai_set_fmt(card->rtd[i].codec_dai,
1798f04209a7SMark Brown 						  dai_fmt);
17995e4ba569SShawn Guo 			if (ret != 0 && ret != -ENOTSUPP)
180075d9ac46SMark Brown 				dev_warn(card->rtd[i].codec_dai->dev,
1801f110bfc7SLiam Girdwood 					 "ASoC: Failed to set DAI format: %d\n",
180275d9ac46SMark Brown 					 ret);
1803f04209a7SMark Brown 		}
1804f04209a7SMark Brown 
1805f04209a7SMark Brown 		/* If this is a regular CPU link there will be a platform */
1806fe33d4c5SStephen Warren 		if (dai_fmt &&
1807fe33d4c5SStephen Warren 		    (dai_link->platform_name || dai_link->platform_of_node)) {
1808f04209a7SMark Brown 			ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai,
1809f04209a7SMark Brown 						  dai_fmt);
1810f04209a7SMark Brown 			if (ret != 0 && ret != -ENOTSUPP)
1811f04209a7SMark Brown 				dev_warn(card->rtd[i].cpu_dai->dev,
1812f110bfc7SLiam Girdwood 					 "ASoC: Failed to set DAI format: %d\n",
1813f04209a7SMark Brown 					 ret);
1814f04209a7SMark Brown 		} else if (dai_fmt) {
1815f04209a7SMark Brown 			/* Flip the polarity for the "CPU" end */
1816f04209a7SMark Brown 			dai_fmt &= ~SND_SOC_DAIFMT_MASTER_MASK;
1817f04209a7SMark Brown 			switch (dai_link->dai_fmt &
1818f04209a7SMark Brown 				SND_SOC_DAIFMT_MASTER_MASK) {
1819f04209a7SMark Brown 			case SND_SOC_DAIFMT_CBM_CFM:
1820f04209a7SMark Brown 				dai_fmt |= SND_SOC_DAIFMT_CBS_CFS;
1821f04209a7SMark Brown 				break;
1822f04209a7SMark Brown 			case SND_SOC_DAIFMT_CBM_CFS:
1823f04209a7SMark Brown 				dai_fmt |= SND_SOC_DAIFMT_CBS_CFM;
1824f04209a7SMark Brown 				break;
1825f04209a7SMark Brown 			case SND_SOC_DAIFMT_CBS_CFM:
1826f04209a7SMark Brown 				dai_fmt |= SND_SOC_DAIFMT_CBM_CFS;
1827f04209a7SMark Brown 				break;
1828f04209a7SMark Brown 			case SND_SOC_DAIFMT_CBS_CFS:
1829f04209a7SMark Brown 				dai_fmt |= SND_SOC_DAIFMT_CBM_CFM;
1830f04209a7SMark Brown 				break;
1831f04209a7SMark Brown 			}
183275d9ac46SMark Brown 
183375d9ac46SMark Brown 			ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai,
1834f04209a7SMark Brown 						  dai_fmt);
18355e4ba569SShawn Guo 			if (ret != 0 && ret != -ENOTSUPP)
183675d9ac46SMark Brown 				dev_warn(card->rtd[i].cpu_dai->dev,
1837f110bfc7SLiam Girdwood 					 "ASoC: Failed to set DAI format: %d\n",
183875d9ac46SMark Brown 					 ret);
183975d9ac46SMark Brown 		}
184075d9ac46SMark Brown 	}
184175d9ac46SMark Brown 
1842f0fba2adSLiam Girdwood 	snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname),
1843fe3e78e0SMark Brown 		 "%s", card->name);
1844f0fba2adSLiam Girdwood 	snprintf(card->snd_card->longname, sizeof(card->snd_card->longname),
184522de71baSLiam Girdwood 		 "%s", card->long_name ? card->long_name : card->name);
1846f0e8ed85SMark Brown 	snprintf(card->snd_card->driver, sizeof(card->snd_card->driver),
1847f0e8ed85SMark Brown 		 "%s", card->driver_name ? card->driver_name : card->name);
1848f0e8ed85SMark Brown 	for (i = 0; i < ARRAY_SIZE(card->snd_card->driver); i++) {
1849f0e8ed85SMark Brown 		switch (card->snd_card->driver[i]) {
1850f0e8ed85SMark Brown 		case '_':
1851f0e8ed85SMark Brown 		case '-':
1852f0e8ed85SMark Brown 		case '\0':
1853f0e8ed85SMark Brown 			break;
1854f0e8ed85SMark Brown 		default:
1855f0e8ed85SMark Brown 			if (!isalnum(card->snd_card->driver[i]))
1856f0e8ed85SMark Brown 				card->snd_card->driver[i] = '_';
1857f0e8ed85SMark Brown 			break;
1858f0e8ed85SMark Brown 		}
1859f0e8ed85SMark Brown 	}
1860fe3e78e0SMark Brown 
186128e9ad92SMark Brown 	if (card->late_probe) {
186228e9ad92SMark Brown 		ret = card->late_probe(card);
186328e9ad92SMark Brown 		if (ret < 0) {
1864f110bfc7SLiam Girdwood 			dev_err(card->dev, "ASoC: %s late_probe() failed: %d\n",
186528e9ad92SMark Brown 				card->name, ret);
186628e9ad92SMark Brown 			goto probe_aux_dev_err;
186728e9ad92SMark Brown 		}
186828e9ad92SMark Brown 	}
186928e9ad92SMark Brown 
18701633281bSStephen Warren 	if (card->fully_routed)
1871b05d8dc1SMark Brown 		list_for_each_entry(codec, &card->codec_dev_list, card_list)
18721633281bSStephen Warren 			snd_soc_dapm_auto_nc_codec_pins(codec);
18731633281bSStephen Warren 
1874824ef826SLars-Peter Clausen 	snd_soc_dapm_new_widgets(card);
18758c193b8dSLars-Peter Clausen 
1876f0fba2adSLiam Girdwood 	ret = snd_card_register(card->snd_card);
1877fe3e78e0SMark Brown 	if (ret < 0) {
1878f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: failed to register soundcard %d\n",
1879f110bfc7SLiam Girdwood 				ret);
18806b3ed785SAxel Lin 		goto probe_aux_dev_err;
1881fe3e78e0SMark Brown 	}
1882fe3e78e0SMark Brown 
1883fe3e78e0SMark Brown #ifdef CONFIG_SND_SOC_AC97_BUS
1884f0fba2adSLiam Girdwood 	/* register any AC97 codecs */
1885f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
1886f0fba2adSLiam Girdwood 		ret = soc_register_ac97_dai_link(&card->rtd[i]);
1887fe3e78e0SMark Brown 		if (ret < 0) {
188810e8aa9aSMichał Mirosław 			dev_err(card->dev,
188910e8aa9aSMichał Mirosław 				"ASoC: failed to register AC97: %d\n", ret);
18906b3ed785SAxel Lin 			while (--i >= 0)
18917d8316dfSMark Brown 				soc_unregister_ac97_dai_link(card->rtd[i].codec);
18926b3ed785SAxel Lin 			goto probe_aux_dev_err;
1893fe3e78e0SMark Brown 		}
1894fe3e78e0SMark Brown 	}
1895fe3e78e0SMark Brown #endif
1896fe3e78e0SMark Brown 
1897435c5e25SMark Brown 	card->instantiated = 1;
18984f4c0072SMark Brown 	snd_soc_dapm_sync(&card->dapm);
1899f0fba2adSLiam Girdwood 	mutex_unlock(&card->mutex);
1900b19e6e7bSMark Brown 
1901b19e6e7bSMark Brown 	return 0;
1902db2a4165SFrank Mandarino 
19032eea392dSJarkko Nikula probe_aux_dev_err:
19042eea392dSJarkko Nikula 	for (i = 0; i < card->num_aux_devs; i++)
19052eea392dSJarkko Nikula 		soc_remove_aux_dev(card, i);
19062eea392dSJarkko Nikula 
1907f0fba2adSLiam Girdwood probe_dai_err:
19080671fd8eSKuninori Morimoto 	soc_remove_dai_links(card);
1909fe3e78e0SMark Brown 
1910f0fba2adSLiam Girdwood card_probe_error:
191187506549SMark Brown 	if (card->remove)
1912e7361ec4SMark Brown 		card->remove(card);
1913f0fba2adSLiam Girdwood 
1914f0fba2adSLiam Girdwood 	snd_card_free(card->snd_card);
1915f0fba2adSLiam Girdwood 
1916b19e6e7bSMark Brown base_error:
1917f0fba2adSLiam Girdwood 	mutex_unlock(&card->mutex);
1918db2a4165SFrank Mandarino 
1919b19e6e7bSMark Brown 	return ret;
1920435c5e25SMark Brown }
1921435c5e25SMark Brown 
1922435c5e25SMark Brown /* probes a new socdev */
1923435c5e25SMark Brown static int soc_probe(struct platform_device *pdev)
1924435c5e25SMark Brown {
1925f0fba2adSLiam Girdwood 	struct snd_soc_card *card = platform_get_drvdata(pdev);
1926435c5e25SMark Brown 
192770a7ca34SVinod Koul 	/*
192870a7ca34SVinod Koul 	 * no card, so machine driver should be registering card
192970a7ca34SVinod Koul 	 * we should not be here in that case so ret error
193070a7ca34SVinod Koul 	 */
193170a7ca34SVinod Koul 	if (!card)
193270a7ca34SVinod Koul 		return -EINVAL;
193370a7ca34SVinod Koul 
1934fe4085e8SMark Brown 	dev_warn(&pdev->dev,
1935f110bfc7SLiam Girdwood 		 "ASoC: machine %s should use snd_soc_register_card()\n",
1936fe4085e8SMark Brown 		 card->name);
1937fe4085e8SMark Brown 
1938435c5e25SMark Brown 	/* Bodge while we unpick instantiation */
1939435c5e25SMark Brown 	card->dev = &pdev->dev;
1940f0fba2adSLiam Girdwood 
194128d528c8SMark Brown 	return snd_soc_register_card(card);
1942435c5e25SMark Brown }
1943435c5e25SMark Brown 
1944b0e26485SVinod Koul static int soc_cleanup_card_resources(struct snd_soc_card *card)
1945db2a4165SFrank Mandarino {
1946db2a4165SFrank Mandarino 	int i;
1947db2a4165SFrank Mandarino 
1948f0fba2adSLiam Girdwood 	/* make sure any delayed work runs */
1949f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
1950f0fba2adSLiam Girdwood 		struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
195143829731STejun Heo 		flush_delayed_work(&rtd->delayed_work);
1952db2a4165SFrank Mandarino 	}
1953db2a4165SFrank Mandarino 
19542eea392dSJarkko Nikula 	/* remove auxiliary devices */
19552eea392dSJarkko Nikula 	for (i = 0; i < card->num_aux_devs; i++)
19562eea392dSJarkko Nikula 		soc_remove_aux_dev(card, i);
19572eea392dSJarkko Nikula 
1958f0fba2adSLiam Girdwood 	/* remove and free each DAI */
19590671fd8eSKuninori Morimoto 	soc_remove_dai_links(card);
1960f0fba2adSLiam Girdwood 
1961a6052154SJarkko Nikula 	soc_cleanup_card_debugfs(card);
1962a6052154SJarkko Nikula 
1963f0fba2adSLiam Girdwood 	/* remove the card */
196487506549SMark Brown 	if (card->remove)
1965e7361ec4SMark Brown 		card->remove(card);
1966f0fba2adSLiam Girdwood 
19670aaae527SLars-Peter Clausen 	snd_soc_dapm_free(&card->dapm);
19680aaae527SLars-Peter Clausen 
1969f0fba2adSLiam Girdwood 	snd_card_free(card->snd_card);
1970b0e26485SVinod Koul 	return 0;
1971b0e26485SVinod Koul 
1972b2dfa62cSGuennadi Liakhovetski }
1973b0e26485SVinod Koul 
1974b0e26485SVinod Koul /* removes a socdev */
1975b0e26485SVinod Koul static int soc_remove(struct platform_device *pdev)
1976b0e26485SVinod Koul {
1977b0e26485SVinod Koul 	struct snd_soc_card *card = platform_get_drvdata(pdev);
1978b0e26485SVinod Koul 
1979c5af3a2eSMark Brown 	snd_soc_unregister_card(card);
1980db2a4165SFrank Mandarino 	return 0;
1981db2a4165SFrank Mandarino }
1982db2a4165SFrank Mandarino 
19836f8ab4acSMark Brown int snd_soc_poweroff(struct device *dev)
198451737470SMark Brown {
19856f8ab4acSMark Brown 	struct snd_soc_card *card = dev_get_drvdata(dev);
1986f0fba2adSLiam Girdwood 	int i;
198751737470SMark Brown 
198851737470SMark Brown 	if (!card->instantiated)
1989416356fcSMark Brown 		return 0;
199051737470SMark Brown 
199151737470SMark Brown 	/* Flush out pmdown_time work - we actually do want to run it
199251737470SMark Brown 	 * now, we're shutting down so no imminent restart. */
1993f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_rtd; i++) {
1994f0fba2adSLiam Girdwood 		struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
199543829731STejun Heo 		flush_delayed_work(&rtd->delayed_work);
1996f0fba2adSLiam Girdwood 	}
199751737470SMark Brown 
1998f0fba2adSLiam Girdwood 	snd_soc_dapm_shutdown(card);
1999416356fcSMark Brown 
2000988e8cc4SNicolin Chen 	/* deactivate pins to sleep state */
2001988e8cc4SNicolin Chen 	for (i = 0; i < card->num_rtd; i++) {
2002988e8cc4SNicolin Chen 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
2003988e8cc4SNicolin Chen 		struct snd_soc_dai *codec_dai = card->rtd[i].codec_dai;
2004988e8cc4SNicolin Chen 		pinctrl_pm_select_sleep_state(codec_dai->dev);
2005988e8cc4SNicolin Chen 		pinctrl_pm_select_sleep_state(cpu_dai->dev);
2006988e8cc4SNicolin Chen 	}
2007988e8cc4SNicolin Chen 
2008416356fcSMark Brown 	return 0;
200951737470SMark Brown }
20106f8ab4acSMark Brown EXPORT_SYMBOL_GPL(snd_soc_poweroff);
201151737470SMark Brown 
20126f8ab4acSMark Brown const struct dev_pm_ops snd_soc_pm_ops = {
2013b1dd5897SViresh Kumar 	.suspend = snd_soc_suspend,
2014b1dd5897SViresh Kumar 	.resume = snd_soc_resume,
2015b1dd5897SViresh Kumar 	.freeze = snd_soc_suspend,
2016b1dd5897SViresh Kumar 	.thaw = snd_soc_resume,
20176f8ab4acSMark Brown 	.poweroff = snd_soc_poweroff,
2018b1dd5897SViresh Kumar 	.restore = snd_soc_resume,
2019416356fcSMark Brown };
2020deb2607eSStephen Warren EXPORT_SYMBOL_GPL(snd_soc_pm_ops);
2021416356fcSMark Brown 
2022db2a4165SFrank Mandarino /* ASoC platform driver */
2023db2a4165SFrank Mandarino static struct platform_driver soc_driver = {
2024db2a4165SFrank Mandarino 	.driver		= {
2025db2a4165SFrank Mandarino 		.name		= "soc-audio",
20268b45a209SKay Sievers 		.owner		= THIS_MODULE,
20276f8ab4acSMark Brown 		.pm		= &snd_soc_pm_ops,
2028db2a4165SFrank Mandarino 	},
2029db2a4165SFrank Mandarino 	.probe		= soc_probe,
2030db2a4165SFrank Mandarino 	.remove		= soc_remove,
2031db2a4165SFrank Mandarino };
2032db2a4165SFrank Mandarino 
2033096e49d5SMark Brown /**
2034096e49d5SMark Brown  * snd_soc_codec_volatile_register: Report if a register is volatile.
2035096e49d5SMark Brown  *
2036096e49d5SMark Brown  * @codec: CODEC to query.
2037096e49d5SMark Brown  * @reg: Register to query.
2038096e49d5SMark Brown  *
2039096e49d5SMark Brown  * Boolean function indiciating if a CODEC register is volatile.
2040096e49d5SMark Brown  */
2041181e055eSMark Brown int snd_soc_codec_volatile_register(struct snd_soc_codec *codec,
2042181e055eSMark Brown 				    unsigned int reg)
2043096e49d5SMark Brown {
20441500b7b5SDimitris Papastamos 	if (codec->volatile_register)
20451500b7b5SDimitris Papastamos 		return codec->volatile_register(codec, reg);
2046096e49d5SMark Brown 	else
2047096e49d5SMark Brown 		return 0;
2048096e49d5SMark Brown }
2049096e49d5SMark Brown EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register);
2050096e49d5SMark Brown 
2051db2a4165SFrank Mandarino /**
2052239c9706SDimitris Papastamos  * snd_soc_codec_readable_register: Report if a register is readable.
2053239c9706SDimitris Papastamos  *
2054239c9706SDimitris Papastamos  * @codec: CODEC to query.
2055239c9706SDimitris Papastamos  * @reg: Register to query.
2056239c9706SDimitris Papastamos  *
2057239c9706SDimitris Papastamos  * Boolean function indicating if a CODEC register is readable.
2058239c9706SDimitris Papastamos  */
2059239c9706SDimitris Papastamos int snd_soc_codec_readable_register(struct snd_soc_codec *codec,
2060239c9706SDimitris Papastamos 				    unsigned int reg)
2061239c9706SDimitris Papastamos {
2062239c9706SDimitris Papastamos 	if (codec->readable_register)
2063239c9706SDimitris Papastamos 		return codec->readable_register(codec, reg);
2064239c9706SDimitris Papastamos 	else
206563fa0a28SLars-Peter Clausen 		return 1;
2066239c9706SDimitris Papastamos }
2067239c9706SDimitris Papastamos EXPORT_SYMBOL_GPL(snd_soc_codec_readable_register);
2068239c9706SDimitris Papastamos 
2069239c9706SDimitris Papastamos /**
2070239c9706SDimitris Papastamos  * snd_soc_codec_writable_register: Report if a register is writable.
2071239c9706SDimitris Papastamos  *
2072239c9706SDimitris Papastamos  * @codec: CODEC to query.
2073239c9706SDimitris Papastamos  * @reg: Register to query.
2074239c9706SDimitris Papastamos  *
2075239c9706SDimitris Papastamos  * Boolean function indicating if a CODEC register is writable.
2076239c9706SDimitris Papastamos  */
2077239c9706SDimitris Papastamos int snd_soc_codec_writable_register(struct snd_soc_codec *codec,
2078239c9706SDimitris Papastamos 				    unsigned int reg)
2079239c9706SDimitris Papastamos {
2080239c9706SDimitris Papastamos 	if (codec->writable_register)
2081239c9706SDimitris Papastamos 		return codec->writable_register(codec, reg);
2082239c9706SDimitris Papastamos 	else
208363fa0a28SLars-Peter Clausen 		return 1;
2084239c9706SDimitris Papastamos }
2085239c9706SDimitris Papastamos EXPORT_SYMBOL_GPL(snd_soc_codec_writable_register);
2086239c9706SDimitris Papastamos 
2087f1442bc1SLiam Girdwood int snd_soc_platform_read(struct snd_soc_platform *platform,
2088f1442bc1SLiam Girdwood 					unsigned int reg)
2089f1442bc1SLiam Girdwood {
2090f1442bc1SLiam Girdwood 	unsigned int ret;
2091f1442bc1SLiam Girdwood 
2092f1442bc1SLiam Girdwood 	if (!platform->driver->read) {
2093f110bfc7SLiam Girdwood 		dev_err(platform->dev, "ASoC: platform has no read back\n");
2094f1442bc1SLiam Girdwood 		return -1;
2095f1442bc1SLiam Girdwood 	}
2096f1442bc1SLiam Girdwood 
2097f1442bc1SLiam Girdwood 	ret = platform->driver->read(platform, reg);
2098f1442bc1SLiam Girdwood 	dev_dbg(platform->dev, "read %x => %x\n", reg, ret);
2099a82ce2aeSLiam Girdwood 	trace_snd_soc_preg_read(platform, reg, ret);
2100f1442bc1SLiam Girdwood 
2101f1442bc1SLiam Girdwood 	return ret;
2102f1442bc1SLiam Girdwood }
2103f1442bc1SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_platform_read);
2104f1442bc1SLiam Girdwood 
2105f1442bc1SLiam Girdwood int snd_soc_platform_write(struct snd_soc_platform *platform,
2106f1442bc1SLiam Girdwood 					 unsigned int reg, unsigned int val)
2107f1442bc1SLiam Girdwood {
2108f1442bc1SLiam Girdwood 	if (!platform->driver->write) {
2109f110bfc7SLiam Girdwood 		dev_err(platform->dev, "ASoC: platform has no write back\n");
2110f1442bc1SLiam Girdwood 		return -1;
2111f1442bc1SLiam Girdwood 	}
2112f1442bc1SLiam Girdwood 
2113f1442bc1SLiam Girdwood 	dev_dbg(platform->dev, "write %x = %x\n", reg, val);
2114a82ce2aeSLiam Girdwood 	trace_snd_soc_preg_write(platform, reg, val);
2115f1442bc1SLiam Girdwood 	return platform->driver->write(platform, reg, val);
2116f1442bc1SLiam Girdwood }
2117f1442bc1SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_platform_write);
2118f1442bc1SLiam Girdwood 
2119239c9706SDimitris Papastamos /**
2120db2a4165SFrank Mandarino  * snd_soc_new_ac97_codec - initailise AC97 device
2121db2a4165SFrank Mandarino  * @codec: audio codec
2122db2a4165SFrank Mandarino  * @ops: AC97 bus operations
2123db2a4165SFrank Mandarino  * @num: AC97 codec number
2124db2a4165SFrank Mandarino  *
2125db2a4165SFrank Mandarino  * Initialises AC97 codec resources for use by ad-hoc devices only.
2126db2a4165SFrank Mandarino  */
2127db2a4165SFrank Mandarino int snd_soc_new_ac97_codec(struct snd_soc_codec *codec,
2128db2a4165SFrank Mandarino 	struct snd_ac97_bus_ops *ops, int num)
2129db2a4165SFrank Mandarino {
2130db2a4165SFrank Mandarino 	mutex_lock(&codec->mutex);
2131db2a4165SFrank Mandarino 
2132db2a4165SFrank Mandarino 	codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL);
2133db2a4165SFrank Mandarino 	if (codec->ac97 == NULL) {
2134db2a4165SFrank Mandarino 		mutex_unlock(&codec->mutex);
2135db2a4165SFrank Mandarino 		return -ENOMEM;
2136db2a4165SFrank Mandarino 	}
2137db2a4165SFrank Mandarino 
2138db2a4165SFrank Mandarino 	codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL);
2139db2a4165SFrank Mandarino 	if (codec->ac97->bus == NULL) {
2140db2a4165SFrank Mandarino 		kfree(codec->ac97);
2141db2a4165SFrank Mandarino 		codec->ac97 = NULL;
2142db2a4165SFrank Mandarino 		mutex_unlock(&codec->mutex);
2143db2a4165SFrank Mandarino 		return -ENOMEM;
2144db2a4165SFrank Mandarino 	}
2145db2a4165SFrank Mandarino 
2146db2a4165SFrank Mandarino 	codec->ac97->bus->ops = ops;
2147db2a4165SFrank Mandarino 	codec->ac97->num = num;
21480562f788SMika Westerberg 
21490562f788SMika Westerberg 	/*
21500562f788SMika Westerberg 	 * Mark the AC97 device to be created by us. This way we ensure that the
21510562f788SMika Westerberg 	 * device will be registered with the device subsystem later on.
21520562f788SMika Westerberg 	 */
21530562f788SMika Westerberg 	codec->ac97_created = 1;
21540562f788SMika Westerberg 
2155db2a4165SFrank Mandarino 	mutex_unlock(&codec->mutex);
2156db2a4165SFrank Mandarino 	return 0;
2157db2a4165SFrank Mandarino }
2158db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec);
2159db2a4165SFrank Mandarino 
2160741a509fSMarkus Pargmann static struct snd_ac97_reset_cfg snd_ac97_rst_cfg;
2161741a509fSMarkus Pargmann 
2162741a509fSMarkus Pargmann static void snd_soc_ac97_warm_reset(struct snd_ac97 *ac97)
2163741a509fSMarkus Pargmann {
2164741a509fSMarkus Pargmann 	struct pinctrl *pctl = snd_ac97_rst_cfg.pctl;
2165741a509fSMarkus Pargmann 
2166741a509fSMarkus Pargmann 	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_warm_reset);
2167741a509fSMarkus Pargmann 
2168741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 1);
2169741a509fSMarkus Pargmann 
2170741a509fSMarkus Pargmann 	udelay(10);
2171741a509fSMarkus Pargmann 
2172741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 0);
2173741a509fSMarkus Pargmann 
2174741a509fSMarkus Pargmann 	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_run);
2175741a509fSMarkus Pargmann 	msleep(2);
2176741a509fSMarkus Pargmann }
2177741a509fSMarkus Pargmann 
2178741a509fSMarkus Pargmann static void snd_soc_ac97_reset(struct snd_ac97 *ac97)
2179741a509fSMarkus Pargmann {
2180741a509fSMarkus Pargmann 	struct pinctrl *pctl = snd_ac97_rst_cfg.pctl;
2181741a509fSMarkus Pargmann 
2182741a509fSMarkus Pargmann 	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_reset);
2183741a509fSMarkus Pargmann 
2184741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_sync, 0);
2185741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_sdata, 0);
2186741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_reset, 0);
2187741a509fSMarkus Pargmann 
2188741a509fSMarkus Pargmann 	udelay(10);
2189741a509fSMarkus Pargmann 
2190741a509fSMarkus Pargmann 	gpio_direction_output(snd_ac97_rst_cfg.gpio_reset, 1);
2191741a509fSMarkus Pargmann 
2192741a509fSMarkus Pargmann 	pinctrl_select_state(pctl, snd_ac97_rst_cfg.pstate_run);
2193741a509fSMarkus Pargmann 	msleep(2);
2194741a509fSMarkus Pargmann }
2195741a509fSMarkus Pargmann 
2196741a509fSMarkus Pargmann static int snd_soc_ac97_parse_pinctl(struct device *dev,
2197741a509fSMarkus Pargmann 		struct snd_ac97_reset_cfg *cfg)
2198741a509fSMarkus Pargmann {
2199741a509fSMarkus Pargmann 	struct pinctrl *p;
2200741a509fSMarkus Pargmann 	struct pinctrl_state *state;
2201741a509fSMarkus Pargmann 	int gpio;
2202741a509fSMarkus Pargmann 	int ret;
2203741a509fSMarkus Pargmann 
2204741a509fSMarkus Pargmann 	p = devm_pinctrl_get(dev);
2205741a509fSMarkus Pargmann 	if (IS_ERR(p)) {
2206741a509fSMarkus Pargmann 		dev_err(dev, "Failed to get pinctrl\n");
2207741a509fSMarkus Pargmann 		return PTR_RET(p);
2208741a509fSMarkus Pargmann 	}
2209741a509fSMarkus Pargmann 	cfg->pctl = p;
2210741a509fSMarkus Pargmann 
2211741a509fSMarkus Pargmann 	state = pinctrl_lookup_state(p, "ac97-reset");
2212741a509fSMarkus Pargmann 	if (IS_ERR(state)) {
2213741a509fSMarkus Pargmann 		dev_err(dev, "Can't find pinctrl state ac97-reset\n");
2214741a509fSMarkus Pargmann 		return PTR_RET(state);
2215741a509fSMarkus Pargmann 	}
2216741a509fSMarkus Pargmann 	cfg->pstate_reset = state;
2217741a509fSMarkus Pargmann 
2218741a509fSMarkus Pargmann 	state = pinctrl_lookup_state(p, "ac97-warm-reset");
2219741a509fSMarkus Pargmann 	if (IS_ERR(state)) {
2220741a509fSMarkus Pargmann 		dev_err(dev, "Can't find pinctrl state ac97-warm-reset\n");
2221741a509fSMarkus Pargmann 		return PTR_RET(state);
2222741a509fSMarkus Pargmann 	}
2223741a509fSMarkus Pargmann 	cfg->pstate_warm_reset = state;
2224741a509fSMarkus Pargmann 
2225741a509fSMarkus Pargmann 	state = pinctrl_lookup_state(p, "ac97-running");
2226741a509fSMarkus Pargmann 	if (IS_ERR(state)) {
2227741a509fSMarkus Pargmann 		dev_err(dev, "Can't find pinctrl state ac97-running\n");
2228741a509fSMarkus Pargmann 		return PTR_RET(state);
2229741a509fSMarkus Pargmann 	}
2230741a509fSMarkus Pargmann 	cfg->pstate_run = state;
2231741a509fSMarkus Pargmann 
2232741a509fSMarkus Pargmann 	gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 0);
2233741a509fSMarkus Pargmann 	if (gpio < 0) {
2234741a509fSMarkus Pargmann 		dev_err(dev, "Can't find ac97-sync gpio\n");
2235741a509fSMarkus Pargmann 		return gpio;
2236741a509fSMarkus Pargmann 	}
2237741a509fSMarkus Pargmann 	ret = devm_gpio_request(dev, gpio, "AC97 link sync");
2238741a509fSMarkus Pargmann 	if (ret) {
2239741a509fSMarkus Pargmann 		dev_err(dev, "Failed requesting ac97-sync gpio\n");
2240741a509fSMarkus Pargmann 		return ret;
2241741a509fSMarkus Pargmann 	}
2242741a509fSMarkus Pargmann 	cfg->gpio_sync = gpio;
2243741a509fSMarkus Pargmann 
2244741a509fSMarkus Pargmann 	gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 1);
2245741a509fSMarkus Pargmann 	if (gpio < 0) {
2246741a509fSMarkus Pargmann 		dev_err(dev, "Can't find ac97-sdata gpio %d\n", gpio);
2247741a509fSMarkus Pargmann 		return gpio;
2248741a509fSMarkus Pargmann 	}
2249741a509fSMarkus Pargmann 	ret = devm_gpio_request(dev, gpio, "AC97 link sdata");
2250741a509fSMarkus Pargmann 	if (ret) {
2251741a509fSMarkus Pargmann 		dev_err(dev, "Failed requesting ac97-sdata gpio\n");
2252741a509fSMarkus Pargmann 		return ret;
2253741a509fSMarkus Pargmann 	}
2254741a509fSMarkus Pargmann 	cfg->gpio_sdata = gpio;
2255741a509fSMarkus Pargmann 
2256741a509fSMarkus Pargmann 	gpio = of_get_named_gpio(dev->of_node, "ac97-gpios", 2);
2257741a509fSMarkus Pargmann 	if (gpio < 0) {
2258741a509fSMarkus Pargmann 		dev_err(dev, "Can't find ac97-reset gpio\n");
2259741a509fSMarkus Pargmann 		return gpio;
2260741a509fSMarkus Pargmann 	}
2261741a509fSMarkus Pargmann 	ret = devm_gpio_request(dev, gpio, "AC97 link reset");
2262741a509fSMarkus Pargmann 	if (ret) {
2263741a509fSMarkus Pargmann 		dev_err(dev, "Failed requesting ac97-reset gpio\n");
2264741a509fSMarkus Pargmann 		return ret;
2265741a509fSMarkus Pargmann 	}
2266741a509fSMarkus Pargmann 	cfg->gpio_reset = gpio;
2267741a509fSMarkus Pargmann 
2268741a509fSMarkus Pargmann 	return 0;
2269741a509fSMarkus Pargmann }
2270741a509fSMarkus Pargmann 
2271b047e1ccSMark Brown struct snd_ac97_bus_ops *soc_ac97_ops;
2272f74b5e25SKevin Hilman EXPORT_SYMBOL_GPL(soc_ac97_ops);
2273b047e1ccSMark Brown 
2274b047e1ccSMark Brown int snd_soc_set_ac97_ops(struct snd_ac97_bus_ops *ops)
2275b047e1ccSMark Brown {
2276b047e1ccSMark Brown 	if (ops == soc_ac97_ops)
2277b047e1ccSMark Brown 		return 0;
2278b047e1ccSMark Brown 
2279b047e1ccSMark Brown 	if (soc_ac97_ops && ops)
2280b047e1ccSMark Brown 		return -EBUSY;
2281b047e1ccSMark Brown 
2282b047e1ccSMark Brown 	soc_ac97_ops = ops;
2283b047e1ccSMark Brown 
2284b047e1ccSMark Brown 	return 0;
2285b047e1ccSMark Brown }
2286b047e1ccSMark Brown EXPORT_SYMBOL_GPL(snd_soc_set_ac97_ops);
2287b047e1ccSMark Brown 
2288db2a4165SFrank Mandarino /**
2289741a509fSMarkus Pargmann  * snd_soc_set_ac97_ops_of_reset - Set ac97 ops with generic ac97 reset functions
2290741a509fSMarkus Pargmann  *
2291741a509fSMarkus Pargmann  * This function sets the reset and warm_reset properties of ops and parses
2292741a509fSMarkus Pargmann  * the device node of pdev to get pinctrl states and gpio numbers to use.
2293741a509fSMarkus Pargmann  */
2294741a509fSMarkus Pargmann int snd_soc_set_ac97_ops_of_reset(struct snd_ac97_bus_ops *ops,
2295741a509fSMarkus Pargmann 		struct platform_device *pdev)
2296741a509fSMarkus Pargmann {
2297741a509fSMarkus Pargmann 	struct device *dev = &pdev->dev;
2298741a509fSMarkus Pargmann 	struct snd_ac97_reset_cfg cfg;
2299741a509fSMarkus Pargmann 	int ret;
2300741a509fSMarkus Pargmann 
2301741a509fSMarkus Pargmann 	ret = snd_soc_ac97_parse_pinctl(dev, &cfg);
2302741a509fSMarkus Pargmann 	if (ret)
2303741a509fSMarkus Pargmann 		return ret;
2304741a509fSMarkus Pargmann 
2305741a509fSMarkus Pargmann 	ret = snd_soc_set_ac97_ops(ops);
2306741a509fSMarkus Pargmann 	if (ret)
2307741a509fSMarkus Pargmann 		return ret;
2308741a509fSMarkus Pargmann 
2309741a509fSMarkus Pargmann 	ops->warm_reset = snd_soc_ac97_warm_reset;
2310741a509fSMarkus Pargmann 	ops->reset = snd_soc_ac97_reset;
2311741a509fSMarkus Pargmann 
2312741a509fSMarkus Pargmann 	snd_ac97_rst_cfg = cfg;
2313741a509fSMarkus Pargmann 	return 0;
2314741a509fSMarkus Pargmann }
2315741a509fSMarkus Pargmann EXPORT_SYMBOL_GPL(snd_soc_set_ac97_ops_of_reset);
2316741a509fSMarkus Pargmann 
2317741a509fSMarkus Pargmann /**
2318db2a4165SFrank Mandarino  * snd_soc_free_ac97_codec - free AC97 codec device
2319db2a4165SFrank Mandarino  * @codec: audio codec
2320db2a4165SFrank Mandarino  *
2321db2a4165SFrank Mandarino  * Frees AC97 codec device resources.
2322db2a4165SFrank Mandarino  */
2323db2a4165SFrank Mandarino void snd_soc_free_ac97_codec(struct snd_soc_codec *codec)
2324db2a4165SFrank Mandarino {
2325db2a4165SFrank Mandarino 	mutex_lock(&codec->mutex);
2326f0fba2adSLiam Girdwood #ifdef CONFIG_SND_SOC_AC97_BUS
2327f0fba2adSLiam Girdwood 	soc_unregister_ac97_dai_link(codec);
2328f0fba2adSLiam Girdwood #endif
2329db2a4165SFrank Mandarino 	kfree(codec->ac97->bus);
2330db2a4165SFrank Mandarino 	kfree(codec->ac97);
2331db2a4165SFrank Mandarino 	codec->ac97 = NULL;
23320562f788SMika Westerberg 	codec->ac97_created = 0;
2333db2a4165SFrank Mandarino 	mutex_unlock(&codec->mutex);
2334db2a4165SFrank Mandarino }
2335db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec);
2336db2a4165SFrank Mandarino 
2337c3753707SMark Brown unsigned int snd_soc_read(struct snd_soc_codec *codec, unsigned int reg)
2338c3753707SMark Brown {
2339c3753707SMark Brown 	unsigned int ret;
2340c3753707SMark Brown 
2341c3acec26SMark Brown 	ret = codec->read(codec, reg);
2342c3753707SMark Brown 	dev_dbg(codec->dev, "read %x => %x\n", reg, ret);
2343a8b1d34fSMark Brown 	trace_snd_soc_reg_read(codec, reg, ret);
2344c3753707SMark Brown 
2345c3753707SMark Brown 	return ret;
2346c3753707SMark Brown }
2347c3753707SMark Brown EXPORT_SYMBOL_GPL(snd_soc_read);
2348c3753707SMark Brown 
2349c3753707SMark Brown unsigned int snd_soc_write(struct snd_soc_codec *codec,
2350c3753707SMark Brown 			   unsigned int reg, unsigned int val)
2351c3753707SMark Brown {
2352c3753707SMark Brown 	dev_dbg(codec->dev, "write %x = %x\n", reg, val);
2353a8b1d34fSMark Brown 	trace_snd_soc_reg_write(codec, reg, val);
2354c3acec26SMark Brown 	return codec->write(codec, reg, val);
2355c3753707SMark Brown }
2356c3753707SMark Brown EXPORT_SYMBOL_GPL(snd_soc_write);
2357c3753707SMark Brown 
2358db2a4165SFrank Mandarino /**
2359db2a4165SFrank Mandarino  * snd_soc_update_bits - update codec register bits
2360db2a4165SFrank Mandarino  * @codec: audio codec
2361db2a4165SFrank Mandarino  * @reg: codec register
2362db2a4165SFrank Mandarino  * @mask: register mask
2363db2a4165SFrank Mandarino  * @value: new value
2364db2a4165SFrank Mandarino  *
2365db2a4165SFrank Mandarino  * Writes new register value.
2366db2a4165SFrank Mandarino  *
2367180c329dSTimur Tabi  * Returns 1 for change, 0 for no change, or negative error code.
2368db2a4165SFrank Mandarino  */
2369db2a4165SFrank Mandarino int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg,
237046f5822fSDaniel Ribeiro 				unsigned int mask, unsigned int value)
2371db2a4165SFrank Mandarino {
23728a713da8SMark Brown 	bool change;
237346f5822fSDaniel Ribeiro 	unsigned int old, new;
2374180c329dSTimur Tabi 	int ret;
2375db2a4165SFrank Mandarino 
23768a713da8SMark Brown 	if (codec->using_regmap) {
23778a713da8SMark Brown 		ret = regmap_update_bits_check(codec->control_data, reg,
23788a713da8SMark Brown 					       mask, value, &change);
23798a713da8SMark Brown 	} else {
2380180c329dSTimur Tabi 		ret = snd_soc_read(codec, reg);
2381180c329dSTimur Tabi 		if (ret < 0)
2382180c329dSTimur Tabi 			return ret;
2383180c329dSTimur Tabi 
2384180c329dSTimur Tabi 		old = ret;
238578bf3c9aSMark Brown 		new = (old & ~mask) | (value & mask);
2386db2a4165SFrank Mandarino 		change = old != new;
23878a713da8SMark Brown 		if (change)
2388180c329dSTimur Tabi 			ret = snd_soc_write(codec, reg, new);
23898a713da8SMark Brown 	}
23908a713da8SMark Brown 
2391180c329dSTimur Tabi 	if (ret < 0)
2392180c329dSTimur Tabi 		return ret;
2393db2a4165SFrank Mandarino 
2394db2a4165SFrank Mandarino 	return change;
2395db2a4165SFrank Mandarino }
2396db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_update_bits);
2397db2a4165SFrank Mandarino 
2398db2a4165SFrank Mandarino /**
23996c508c62SEero Nurkkala  * snd_soc_update_bits_locked - update codec register bits
24006c508c62SEero Nurkkala  * @codec: audio codec
24016c508c62SEero Nurkkala  * @reg: codec register
24026c508c62SEero Nurkkala  * @mask: register mask
24036c508c62SEero Nurkkala  * @value: new value
24046c508c62SEero Nurkkala  *
24056c508c62SEero Nurkkala  * Writes new register value, and takes the codec mutex.
24066c508c62SEero Nurkkala  *
24076c508c62SEero Nurkkala  * Returns 1 for change else 0.
24086c508c62SEero Nurkkala  */
2409dd1b3d53SMark Brown int snd_soc_update_bits_locked(struct snd_soc_codec *codec,
24106c508c62SEero Nurkkala 			       unsigned short reg, unsigned int mask,
24116c508c62SEero Nurkkala 			       unsigned int value)
24126c508c62SEero Nurkkala {
24136c508c62SEero Nurkkala 	int change;
24146c508c62SEero Nurkkala 
24156c508c62SEero Nurkkala 	mutex_lock(&codec->mutex);
24166c508c62SEero Nurkkala 	change = snd_soc_update_bits(codec, reg, mask, value);
24176c508c62SEero Nurkkala 	mutex_unlock(&codec->mutex);
24186c508c62SEero Nurkkala 
24196c508c62SEero Nurkkala 	return change;
24206c508c62SEero Nurkkala }
2421dd1b3d53SMark Brown EXPORT_SYMBOL_GPL(snd_soc_update_bits_locked);
24226c508c62SEero Nurkkala 
24236c508c62SEero Nurkkala /**
2424db2a4165SFrank Mandarino  * snd_soc_test_bits - test register for change
2425db2a4165SFrank Mandarino  * @codec: audio codec
2426db2a4165SFrank Mandarino  * @reg: codec register
2427db2a4165SFrank Mandarino  * @mask: register mask
2428db2a4165SFrank Mandarino  * @value: new value
2429db2a4165SFrank Mandarino  *
2430db2a4165SFrank Mandarino  * Tests a register with a new value and checks if the new value is
2431db2a4165SFrank Mandarino  * different from the old value.
2432db2a4165SFrank Mandarino  *
2433db2a4165SFrank Mandarino  * Returns 1 for change else 0.
2434db2a4165SFrank Mandarino  */
2435db2a4165SFrank Mandarino int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg,
243646f5822fSDaniel Ribeiro 				unsigned int mask, unsigned int value)
2437db2a4165SFrank Mandarino {
2438db2a4165SFrank Mandarino 	int change;
243946f5822fSDaniel Ribeiro 	unsigned int old, new;
2440db2a4165SFrank Mandarino 
2441db2a4165SFrank Mandarino 	old = snd_soc_read(codec, reg);
2442db2a4165SFrank Mandarino 	new = (old & ~mask) | value;
2443db2a4165SFrank Mandarino 	change = old != new;
2444db2a4165SFrank Mandarino 
2445db2a4165SFrank Mandarino 	return change;
2446db2a4165SFrank Mandarino }
2447db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_test_bits);
2448db2a4165SFrank Mandarino 
2449db2a4165SFrank Mandarino /**
2450db2a4165SFrank Mandarino  * snd_soc_cnew - create new control
2451db2a4165SFrank Mandarino  * @_template: control template
2452db2a4165SFrank Mandarino  * @data: control private data
2453ac11a2b3SMark Brown  * @long_name: control long name
2454efb7ac3fSMark Brown  * @prefix: control name prefix
2455db2a4165SFrank Mandarino  *
2456db2a4165SFrank Mandarino  * Create a new mixer control from a template control.
2457db2a4165SFrank Mandarino  *
2458db2a4165SFrank Mandarino  * Returns 0 for success, else error.
2459db2a4165SFrank Mandarino  */
2460db2a4165SFrank Mandarino struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
24613056557fSMark Brown 				  void *data, const char *long_name,
2462efb7ac3fSMark Brown 				  const char *prefix)
2463db2a4165SFrank Mandarino {
2464db2a4165SFrank Mandarino 	struct snd_kcontrol_new template;
2465efb7ac3fSMark Brown 	struct snd_kcontrol *kcontrol;
2466efb7ac3fSMark Brown 	char *name = NULL;
2467db2a4165SFrank Mandarino 
2468db2a4165SFrank Mandarino 	memcpy(&template, _template, sizeof(template));
2469db2a4165SFrank Mandarino 	template.index = 0;
2470db2a4165SFrank Mandarino 
2471efb7ac3fSMark Brown 	if (!long_name)
2472efb7ac3fSMark Brown 		long_name = template.name;
2473efb7ac3fSMark Brown 
2474efb7ac3fSMark Brown 	if (prefix) {
24752b581074SLars-Peter Clausen 		name = kasprintf(GFP_KERNEL, "%s %s", prefix, long_name);
2476efb7ac3fSMark Brown 		if (!name)
2477efb7ac3fSMark Brown 			return NULL;
2478efb7ac3fSMark Brown 
2479efb7ac3fSMark Brown 		template.name = name;
2480efb7ac3fSMark Brown 	} else {
2481efb7ac3fSMark Brown 		template.name = long_name;
2482efb7ac3fSMark Brown 	}
2483efb7ac3fSMark Brown 
2484efb7ac3fSMark Brown 	kcontrol = snd_ctl_new1(&template, data);
2485efb7ac3fSMark Brown 
2486efb7ac3fSMark Brown 	kfree(name);
2487efb7ac3fSMark Brown 
2488efb7ac3fSMark Brown 	return kcontrol;
2489db2a4165SFrank Mandarino }
2490db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_cnew);
2491db2a4165SFrank Mandarino 
2492022658beSLiam Girdwood static int snd_soc_add_controls(struct snd_card *card, struct device *dev,
2493022658beSLiam Girdwood 	const struct snd_kcontrol_new *controls, int num_controls,
2494022658beSLiam Girdwood 	const char *prefix, void *data)
2495022658beSLiam Girdwood {
2496022658beSLiam Girdwood 	int err, i;
2497022658beSLiam Girdwood 
2498022658beSLiam Girdwood 	for (i = 0; i < num_controls; i++) {
2499022658beSLiam Girdwood 		const struct snd_kcontrol_new *control = &controls[i];
2500022658beSLiam Girdwood 		err = snd_ctl_add(card, snd_soc_cnew(control, data,
2501022658beSLiam Girdwood 						     control->name, prefix));
2502022658beSLiam Girdwood 		if (err < 0) {
2503f110bfc7SLiam Girdwood 			dev_err(dev, "ASoC: Failed to add %s: %d\n",
2504f110bfc7SLiam Girdwood 				control->name, err);
2505022658beSLiam Girdwood 			return err;
2506022658beSLiam Girdwood 		}
2507022658beSLiam Girdwood 	}
2508022658beSLiam Girdwood 
2509022658beSLiam Girdwood 	return 0;
2510022658beSLiam Girdwood }
2511022658beSLiam Girdwood 
25124fefd698SDimitris Papastamos struct snd_kcontrol *snd_soc_card_get_kcontrol(struct snd_soc_card *soc_card,
25134fefd698SDimitris Papastamos 					       const char *name)
25144fefd698SDimitris Papastamos {
25154fefd698SDimitris Papastamos 	struct snd_card *card = soc_card->snd_card;
25164fefd698SDimitris Papastamos 	struct snd_kcontrol *kctl;
25174fefd698SDimitris Papastamos 
25184fefd698SDimitris Papastamos 	if (unlikely(!name))
25194fefd698SDimitris Papastamos 		return NULL;
25204fefd698SDimitris Papastamos 
25214fefd698SDimitris Papastamos 	list_for_each_entry(kctl, &card->controls, list)
25224fefd698SDimitris Papastamos 		if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name)))
25234fefd698SDimitris Papastamos 			return kctl;
25244fefd698SDimitris Papastamos 	return NULL;
25254fefd698SDimitris Papastamos }
25264fefd698SDimitris Papastamos EXPORT_SYMBOL_GPL(snd_soc_card_get_kcontrol);
25274fefd698SDimitris Papastamos 
2528db2a4165SFrank Mandarino /**
2529022658beSLiam Girdwood  * snd_soc_add_codec_controls - add an array of controls to a codec.
2530022658beSLiam Girdwood  * Convenience function to add a list of controls. Many codecs were
25313e8e1952SIan Molton  * duplicating this code.
25323e8e1952SIan Molton  *
25333e8e1952SIan Molton  * @codec: codec to add controls to
25343e8e1952SIan Molton  * @controls: array of controls to add
25353e8e1952SIan Molton  * @num_controls: number of elements in the array
25363e8e1952SIan Molton  *
25373e8e1952SIan Molton  * Return 0 for success, else error.
25383e8e1952SIan Molton  */
2539022658beSLiam Girdwood int snd_soc_add_codec_controls(struct snd_soc_codec *codec,
25403e8e1952SIan Molton 	const struct snd_kcontrol_new *controls, int num_controls)
25413e8e1952SIan Molton {
2542f0fba2adSLiam Girdwood 	struct snd_card *card = codec->card->snd_card;
25433e8e1952SIan Molton 
2544022658beSLiam Girdwood 	return snd_soc_add_controls(card, codec->dev, controls, num_controls,
2545022658beSLiam Girdwood 			codec->name_prefix, codec);
25463e8e1952SIan Molton }
2547022658beSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_add_codec_controls);
25483e8e1952SIan Molton 
25493e8e1952SIan Molton /**
2550a491a5c8SLiam Girdwood  * snd_soc_add_platform_controls - add an array of controls to a platform.
2551022658beSLiam Girdwood  * Convenience function to add a list of controls.
2552a491a5c8SLiam Girdwood  *
2553a491a5c8SLiam Girdwood  * @platform: platform to add controls to
2554a491a5c8SLiam Girdwood  * @controls: array of controls to add
2555a491a5c8SLiam Girdwood  * @num_controls: number of elements in the array
2556a491a5c8SLiam Girdwood  *
2557a491a5c8SLiam Girdwood  * Return 0 for success, else error.
2558a491a5c8SLiam Girdwood  */
2559a491a5c8SLiam Girdwood int snd_soc_add_platform_controls(struct snd_soc_platform *platform,
2560a491a5c8SLiam Girdwood 	const struct snd_kcontrol_new *controls, int num_controls)
2561a491a5c8SLiam Girdwood {
2562a491a5c8SLiam Girdwood 	struct snd_card *card = platform->card->snd_card;
2563a491a5c8SLiam Girdwood 
2564022658beSLiam Girdwood 	return snd_soc_add_controls(card, platform->dev, controls, num_controls,
2565022658beSLiam Girdwood 			NULL, platform);
2566a491a5c8SLiam Girdwood }
2567a491a5c8SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_add_platform_controls);
2568a491a5c8SLiam Girdwood 
2569a491a5c8SLiam Girdwood /**
2570022658beSLiam Girdwood  * snd_soc_add_card_controls - add an array of controls to a SoC card.
2571022658beSLiam Girdwood  * Convenience function to add a list of controls.
2572022658beSLiam Girdwood  *
2573022658beSLiam Girdwood  * @soc_card: SoC card to add controls to
2574022658beSLiam Girdwood  * @controls: array of controls to add
2575022658beSLiam Girdwood  * @num_controls: number of elements in the array
2576022658beSLiam Girdwood  *
2577022658beSLiam Girdwood  * Return 0 for success, else error.
2578022658beSLiam Girdwood  */
2579022658beSLiam Girdwood int snd_soc_add_card_controls(struct snd_soc_card *soc_card,
2580022658beSLiam Girdwood 	const struct snd_kcontrol_new *controls, int num_controls)
2581022658beSLiam Girdwood {
2582022658beSLiam Girdwood 	struct snd_card *card = soc_card->snd_card;
2583022658beSLiam Girdwood 
2584022658beSLiam Girdwood 	return snd_soc_add_controls(card, soc_card->dev, controls, num_controls,
2585022658beSLiam Girdwood 			NULL, soc_card);
2586022658beSLiam Girdwood }
2587022658beSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_add_card_controls);
2588022658beSLiam Girdwood 
2589022658beSLiam Girdwood /**
2590022658beSLiam Girdwood  * snd_soc_add_dai_controls - add an array of controls to a DAI.
2591022658beSLiam Girdwood  * Convienience function to add a list of controls.
2592022658beSLiam Girdwood  *
2593022658beSLiam Girdwood  * @dai: DAI to add controls to
2594022658beSLiam Girdwood  * @controls: array of controls to add
2595022658beSLiam Girdwood  * @num_controls: number of elements in the array
2596022658beSLiam Girdwood  *
2597022658beSLiam Girdwood  * Return 0 for success, else error.
2598022658beSLiam Girdwood  */
2599022658beSLiam Girdwood int snd_soc_add_dai_controls(struct snd_soc_dai *dai,
2600022658beSLiam Girdwood 	const struct snd_kcontrol_new *controls, int num_controls)
2601022658beSLiam Girdwood {
2602022658beSLiam Girdwood 	struct snd_card *card = dai->card->snd_card;
2603022658beSLiam Girdwood 
2604022658beSLiam Girdwood 	return snd_soc_add_controls(card, dai->dev, controls, num_controls,
2605022658beSLiam Girdwood 			NULL, dai);
2606022658beSLiam Girdwood }
2607022658beSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_add_dai_controls);
2608022658beSLiam Girdwood 
2609022658beSLiam Girdwood /**
2610db2a4165SFrank Mandarino  * snd_soc_info_enum_double - enumerated double mixer info callback
2611db2a4165SFrank Mandarino  * @kcontrol: mixer control
2612db2a4165SFrank Mandarino  * @uinfo: control element information
2613db2a4165SFrank Mandarino  *
2614db2a4165SFrank Mandarino  * Callback to provide information about a double enumerated
2615db2a4165SFrank Mandarino  * mixer control.
2616db2a4165SFrank Mandarino  *
2617db2a4165SFrank Mandarino  * Returns 0 for success.
2618db2a4165SFrank Mandarino  */
2619db2a4165SFrank Mandarino int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol,
2620db2a4165SFrank Mandarino 	struct snd_ctl_elem_info *uinfo)
2621db2a4165SFrank Mandarino {
2622db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2623db2a4165SFrank Mandarino 
2624db2a4165SFrank Mandarino 	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2625db2a4165SFrank Mandarino 	uinfo->count = e->shift_l == e->shift_r ? 1 : 2;
26269a8d38dbSTakashi Iwai 	uinfo->value.enumerated.items = e->items;
2627db2a4165SFrank Mandarino 
26289a8d38dbSTakashi Iwai 	if (uinfo->value.enumerated.item >= e->items)
26299a8d38dbSTakashi Iwai 		uinfo->value.enumerated.item = e->items - 1;
2630a19685cbSTakashi Iwai 	strlcpy(uinfo->value.enumerated.name,
2631a19685cbSTakashi Iwai 		e->texts[uinfo->value.enumerated.item],
2632a19685cbSTakashi Iwai 		sizeof(uinfo->value.enumerated.name));
2633db2a4165SFrank Mandarino 	return 0;
2634db2a4165SFrank Mandarino }
2635db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
2636db2a4165SFrank Mandarino 
2637db2a4165SFrank Mandarino /**
2638db2a4165SFrank Mandarino  * snd_soc_get_enum_double - enumerated double mixer get callback
2639db2a4165SFrank Mandarino  * @kcontrol: mixer control
2640ac11a2b3SMark Brown  * @ucontrol: control element information
2641db2a4165SFrank Mandarino  *
2642db2a4165SFrank Mandarino  * Callback to get the value of a double enumerated mixer.
2643db2a4165SFrank Mandarino  *
2644db2a4165SFrank Mandarino  * Returns 0 for success.
2645db2a4165SFrank Mandarino  */
2646db2a4165SFrank Mandarino int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol,
2647db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
2648db2a4165SFrank Mandarino {
2649db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2650db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
265129ae2fa5SLars-Peter Clausen 	unsigned int val, item;
265229ae2fa5SLars-Peter Clausen 	unsigned int reg_val;
2653db2a4165SFrank Mandarino 
265429ae2fa5SLars-Peter Clausen 	reg_val = snd_soc_read(codec, e->reg);
265529ae2fa5SLars-Peter Clausen 	val = (reg_val >> e->shift_l) & e->mask;
265629ae2fa5SLars-Peter Clausen 	item = snd_soc_enum_val_to_item(e, val);
265729ae2fa5SLars-Peter Clausen 	ucontrol->value.enumerated.item[0] = item;
265829ae2fa5SLars-Peter Clausen 	if (e->shift_l != e->shift_r) {
265929ae2fa5SLars-Peter Clausen 		val = (reg_val >> e->shift_l) & e->mask;
266029ae2fa5SLars-Peter Clausen 		item = snd_soc_enum_val_to_item(e, val);
266129ae2fa5SLars-Peter Clausen 		ucontrol->value.enumerated.item[1] = item;
266229ae2fa5SLars-Peter Clausen 	}
2663db2a4165SFrank Mandarino 
2664db2a4165SFrank Mandarino 	return 0;
2665db2a4165SFrank Mandarino }
2666db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
2667db2a4165SFrank Mandarino 
2668db2a4165SFrank Mandarino /**
2669db2a4165SFrank Mandarino  * snd_soc_put_enum_double - enumerated double mixer put callback
2670db2a4165SFrank Mandarino  * @kcontrol: mixer control
2671ac11a2b3SMark Brown  * @ucontrol: control element information
2672db2a4165SFrank Mandarino  *
2673db2a4165SFrank Mandarino  * Callback to set the value of a double enumerated mixer.
2674db2a4165SFrank Mandarino  *
2675db2a4165SFrank Mandarino  * Returns 0 for success.
2676db2a4165SFrank Mandarino  */
2677db2a4165SFrank Mandarino int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol,
2678db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
2679db2a4165SFrank Mandarino {
2680db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2681db2a4165SFrank Mandarino 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
268229ae2fa5SLars-Peter Clausen 	unsigned int *item = ucontrol->value.enumerated.item;
268346f5822fSDaniel Ribeiro 	unsigned int val;
268486767b7dSLars-Peter Clausen 	unsigned int mask;
2685db2a4165SFrank Mandarino 
268629ae2fa5SLars-Peter Clausen 	if (item[0] >= e->items)
2687db2a4165SFrank Mandarino 		return -EINVAL;
268829ae2fa5SLars-Peter Clausen 	val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l;
268986767b7dSLars-Peter Clausen 	mask = e->mask << e->shift_l;
2690db2a4165SFrank Mandarino 	if (e->shift_l != e->shift_r) {
269129ae2fa5SLars-Peter Clausen 		if (item[1] >= e->items)
2692db2a4165SFrank Mandarino 			return -EINVAL;
269329ae2fa5SLars-Peter Clausen 		val |= snd_soc_enum_item_to_val(e, item[1]) << e->shift_r;
269486767b7dSLars-Peter Clausen 		mask |= e->mask << e->shift_r;
2695db2a4165SFrank Mandarino 	}
2696db2a4165SFrank Mandarino 
26976c508c62SEero Nurkkala 	return snd_soc_update_bits_locked(codec, e->reg, mask, val);
2698db2a4165SFrank Mandarino }
2699db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
2700db2a4165SFrank Mandarino 
2701db2a4165SFrank Mandarino /**
2702f227b88fSMarkus Pargmann  * snd_soc_read_signed - Read a codec register and interprete as signed value
2703f227b88fSMarkus Pargmann  * @codec: codec
2704f227b88fSMarkus Pargmann  * @reg: Register to read
2705f227b88fSMarkus Pargmann  * @mask: Mask to use after shifting the register value
2706f227b88fSMarkus Pargmann  * @shift: Right shift of register value
2707f227b88fSMarkus Pargmann  * @sign_bit: Bit that describes if a number is negative or not.
27082e72f8e3SPeter Ujfalusi  *
2709f227b88fSMarkus Pargmann  * This functions reads a codec register. The register value is shifted right
2710f227b88fSMarkus Pargmann  * by 'shift' bits and masked with the given 'mask'. Afterwards it translates
2711f227b88fSMarkus Pargmann  * the given registervalue into a signed integer if sign_bit is non-zero.
27122e72f8e3SPeter Ujfalusi  *
2713f227b88fSMarkus Pargmann  * Returns the register value as signed int.
27142e72f8e3SPeter Ujfalusi  */
2715f227b88fSMarkus Pargmann static int snd_soc_read_signed(struct snd_soc_codec *codec, unsigned int reg,
2716f227b88fSMarkus Pargmann 		unsigned int mask, unsigned int shift, unsigned int sign_bit)
27172e72f8e3SPeter Ujfalusi {
2718f227b88fSMarkus Pargmann 	int ret;
271946f5822fSDaniel Ribeiro 	unsigned int val;
27202e72f8e3SPeter Ujfalusi 
2721f227b88fSMarkus Pargmann 	val = (snd_soc_read(codec, reg) >> shift) & mask;
27222e72f8e3SPeter Ujfalusi 
2723f227b88fSMarkus Pargmann 	if (!sign_bit)
2724f227b88fSMarkus Pargmann 		return val;
2725f227b88fSMarkus Pargmann 
2726f227b88fSMarkus Pargmann 	/* non-negative number */
2727f227b88fSMarkus Pargmann 	if (!(val & BIT(sign_bit)))
2728f227b88fSMarkus Pargmann 		return val;
2729f227b88fSMarkus Pargmann 
2730f227b88fSMarkus Pargmann 	ret = val;
2731f227b88fSMarkus Pargmann 
2732f227b88fSMarkus Pargmann 	/*
2733f227b88fSMarkus Pargmann 	 * The register most probably does not contain a full-sized int.
2734f227b88fSMarkus Pargmann 	 * Instead we have an arbitrary number of bits in a signed
2735f227b88fSMarkus Pargmann 	 * representation which has to be translated into a full-sized int.
2736f227b88fSMarkus Pargmann 	 * This is done by filling up all bits above the sign-bit.
2737f227b88fSMarkus Pargmann 	 */
2738f227b88fSMarkus Pargmann 	ret |= ~((int)(BIT(sign_bit) - 1));
2739f227b88fSMarkus Pargmann 
2740f227b88fSMarkus Pargmann 	return ret;
27412e72f8e3SPeter Ujfalusi }
27422e72f8e3SPeter Ujfalusi 
27432e72f8e3SPeter Ujfalusi /**
2744db2a4165SFrank Mandarino  * snd_soc_info_volsw - single mixer info callback
2745db2a4165SFrank Mandarino  * @kcontrol: mixer control
2746db2a4165SFrank Mandarino  * @uinfo: control element information
2747db2a4165SFrank Mandarino  *
2748e8f5a103SPeter Ujfalusi  * Callback to provide information about a single mixer control, or a double
2749e8f5a103SPeter Ujfalusi  * mixer control that spans 2 registers.
2750db2a4165SFrank Mandarino  *
2751db2a4165SFrank Mandarino  * Returns 0 for success.
2752db2a4165SFrank Mandarino  */
2753db2a4165SFrank Mandarino int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
2754db2a4165SFrank Mandarino 	struct snd_ctl_elem_info *uinfo)
2755db2a4165SFrank Mandarino {
27564eaa9819SJon Smirl 	struct soc_mixer_control *mc =
27574eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2758d11bb4a9SPeter Ujfalusi 	int platform_max;
2759db2a4165SFrank Mandarino 
2760d11bb4a9SPeter Ujfalusi 	if (!mc->platform_max)
2761d11bb4a9SPeter Ujfalusi 		mc->platform_max = mc->max;
2762d11bb4a9SPeter Ujfalusi 	platform_max = mc->platform_max;
2763d11bb4a9SPeter Ujfalusi 
2764d11bb4a9SPeter Ujfalusi 	if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
2765a7a4ac86SPhilipp Zabel 		uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2766a7a4ac86SPhilipp Zabel 	else
2767a7a4ac86SPhilipp Zabel 		uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2768a7a4ac86SPhilipp Zabel 
2769e8f5a103SPeter Ujfalusi 	uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
2770db2a4165SFrank Mandarino 	uinfo->value.integer.min = 0;
2771f227b88fSMarkus Pargmann 	uinfo->value.integer.max = platform_max - mc->min;
2772db2a4165SFrank Mandarino 	return 0;
2773db2a4165SFrank Mandarino }
2774db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
2775db2a4165SFrank Mandarino 
2776db2a4165SFrank Mandarino /**
2777db2a4165SFrank Mandarino  * snd_soc_get_volsw - single mixer get callback
2778db2a4165SFrank Mandarino  * @kcontrol: mixer control
2779ac11a2b3SMark Brown  * @ucontrol: control element information
2780db2a4165SFrank Mandarino  *
2781f7915d99SPeter Ujfalusi  * Callback to get the value of a single mixer control, or a double mixer
2782f7915d99SPeter Ujfalusi  * control that spans 2 registers.
2783db2a4165SFrank Mandarino  *
2784db2a4165SFrank Mandarino  * Returns 0 for success.
2785db2a4165SFrank Mandarino  */
2786db2a4165SFrank Mandarino int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
2787db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
2788db2a4165SFrank Mandarino {
27894eaa9819SJon Smirl 	struct soc_mixer_control *mc =
27904eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2791db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2792815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
2793f7915d99SPeter Ujfalusi 	unsigned int reg2 = mc->rreg;
2794815ecf8dSJon Smirl 	unsigned int shift = mc->shift;
2795815ecf8dSJon Smirl 	unsigned int rshift = mc->rshift;
27964eaa9819SJon Smirl 	int max = mc->max;
2797f227b88fSMarkus Pargmann 	int min = mc->min;
2798f227b88fSMarkus Pargmann 	int sign_bit = mc->sign_bit;
2799815ecf8dSJon Smirl 	unsigned int mask = (1 << fls(max)) - 1;
2800815ecf8dSJon Smirl 	unsigned int invert = mc->invert;
2801db2a4165SFrank Mandarino 
2802f227b88fSMarkus Pargmann 	if (sign_bit)
2803f227b88fSMarkus Pargmann 		mask = BIT(sign_bit + 1) - 1;
2804f227b88fSMarkus Pargmann 
2805f227b88fSMarkus Pargmann 	ucontrol->value.integer.value[0] = snd_soc_read_signed(codec, reg, mask,
2806f227b88fSMarkus Pargmann 			shift, sign_bit) - min;
2807f7915d99SPeter Ujfalusi 	if (invert)
2808db2a4165SFrank Mandarino 		ucontrol->value.integer.value[0] =
2809a7a4ac86SPhilipp Zabel 			max - ucontrol->value.integer.value[0];
2810f7915d99SPeter Ujfalusi 
2811f7915d99SPeter Ujfalusi 	if (snd_soc_volsw_is_stereo(mc)) {
2812f7915d99SPeter Ujfalusi 		if (reg == reg2)
2813f7915d99SPeter Ujfalusi 			ucontrol->value.integer.value[1] =
2814f227b88fSMarkus Pargmann 				snd_soc_read_signed(codec, reg, mask, rshift,
2815f227b88fSMarkus Pargmann 						sign_bit) - min;
2816f7915d99SPeter Ujfalusi 		else
2817f7915d99SPeter Ujfalusi 			ucontrol->value.integer.value[1] =
2818f227b88fSMarkus Pargmann 				snd_soc_read_signed(codec, reg2, mask, shift,
2819f227b88fSMarkus Pargmann 						sign_bit) - min;
2820f7915d99SPeter Ujfalusi 		if (invert)
2821db2a4165SFrank Mandarino 			ucontrol->value.integer.value[1] =
2822a7a4ac86SPhilipp Zabel 				max - ucontrol->value.integer.value[1];
2823db2a4165SFrank Mandarino 	}
2824db2a4165SFrank Mandarino 
2825db2a4165SFrank Mandarino 	return 0;
2826db2a4165SFrank Mandarino }
2827db2a4165SFrank Mandarino EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
2828db2a4165SFrank Mandarino 
2829db2a4165SFrank Mandarino /**
2830db2a4165SFrank Mandarino  * snd_soc_put_volsw - single mixer put callback
2831db2a4165SFrank Mandarino  * @kcontrol: mixer control
2832ac11a2b3SMark Brown  * @ucontrol: control element information
2833db2a4165SFrank Mandarino  *
2834974815baSPeter Ujfalusi  * Callback to set the value of a single mixer control, or a double mixer
2835974815baSPeter Ujfalusi  * control that spans 2 registers.
2836db2a4165SFrank Mandarino  *
2837db2a4165SFrank Mandarino  * Returns 0 for success.
2838db2a4165SFrank Mandarino  */
2839db2a4165SFrank Mandarino int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
2840db2a4165SFrank Mandarino 	struct snd_ctl_elem_value *ucontrol)
2841db2a4165SFrank Mandarino {
28424eaa9819SJon Smirl 	struct soc_mixer_control *mc =
28434eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2844db2a4165SFrank Mandarino 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2845815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
2846974815baSPeter Ujfalusi 	unsigned int reg2 = mc->rreg;
2847815ecf8dSJon Smirl 	unsigned int shift = mc->shift;
2848815ecf8dSJon Smirl 	unsigned int rshift = mc->rshift;
28494eaa9819SJon Smirl 	int max = mc->max;
2850f227b88fSMarkus Pargmann 	int min = mc->min;
2851f227b88fSMarkus Pargmann 	unsigned int sign_bit = mc->sign_bit;
2852815ecf8dSJon Smirl 	unsigned int mask = (1 << fls(max)) - 1;
2853815ecf8dSJon Smirl 	unsigned int invert = mc->invert;
2854974815baSPeter Ujfalusi 	int err;
2855939d9f16SNenghua Cao 	bool type_2r = false;
2856974815baSPeter Ujfalusi 	unsigned int val2 = 0;
2857974815baSPeter Ujfalusi 	unsigned int val, val_mask;
2858db2a4165SFrank Mandarino 
2859f227b88fSMarkus Pargmann 	if (sign_bit)
2860f227b88fSMarkus Pargmann 		mask = BIT(sign_bit + 1) - 1;
2861f227b88fSMarkus Pargmann 
2862f227b88fSMarkus Pargmann 	val = ((ucontrol->value.integer.value[0] + min) & mask);
2863db2a4165SFrank Mandarino 	if (invert)
2864a7a4ac86SPhilipp Zabel 		val = max - val;
2865db2a4165SFrank Mandarino 	val_mask = mask << shift;
2866db2a4165SFrank Mandarino 	val = val << shift;
2867974815baSPeter Ujfalusi 	if (snd_soc_volsw_is_stereo(mc)) {
2868f227b88fSMarkus Pargmann 		val2 = ((ucontrol->value.integer.value[1] + min) & mask);
2869db2a4165SFrank Mandarino 		if (invert)
2870a7a4ac86SPhilipp Zabel 			val2 = max - val2;
2871974815baSPeter Ujfalusi 		if (reg == reg2) {
2872db2a4165SFrank Mandarino 			val_mask |= mask << rshift;
2873db2a4165SFrank Mandarino 			val |= val2 << rshift;
2874974815baSPeter Ujfalusi 		} else {
2875db2a4165SFrank Mandarino 			val2 = val2 << shift;
2876939d9f16SNenghua Cao 			type_2r = true;
2877974815baSPeter Ujfalusi 		}
2878974815baSPeter Ujfalusi 	}
28796c508c62SEero Nurkkala 	err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
28803ff3f64bSMark Brown 	if (err < 0)
2881db2a4165SFrank Mandarino 		return err;
2882db2a4165SFrank Mandarino 
2883974815baSPeter Ujfalusi 	if (type_2r)
28846c508c62SEero Nurkkala 		err = snd_soc_update_bits_locked(codec, reg2, val_mask, val2);
2885974815baSPeter Ujfalusi 
2886db2a4165SFrank Mandarino 	return err;
2887db2a4165SFrank Mandarino }
2888974815baSPeter Ujfalusi EXPORT_SYMBOL_GPL(snd_soc_put_volsw);
2889db2a4165SFrank Mandarino 
2890e13ac2e9SMark Brown /**
28911d99f243SBrian Austin  * snd_soc_get_volsw_sx - single mixer get callback
28921d99f243SBrian Austin  * @kcontrol: mixer control
28931d99f243SBrian Austin  * @ucontrol: control element information
28941d99f243SBrian Austin  *
28951d99f243SBrian Austin  * Callback to get the value of a single mixer control, or a double mixer
28961d99f243SBrian Austin  * control that spans 2 registers.
28971d99f243SBrian Austin  *
28981d99f243SBrian Austin  * Returns 0 for success.
28991d99f243SBrian Austin  */
29001d99f243SBrian Austin int snd_soc_get_volsw_sx(struct snd_kcontrol *kcontrol,
29011d99f243SBrian Austin 		      struct snd_ctl_elem_value *ucontrol)
29021d99f243SBrian Austin {
29031d99f243SBrian Austin 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
29041d99f243SBrian Austin 	struct soc_mixer_control *mc =
29051d99f243SBrian Austin 	    (struct soc_mixer_control *)kcontrol->private_value;
29061d99f243SBrian Austin 
29071d99f243SBrian Austin 	unsigned int reg = mc->reg;
29081d99f243SBrian Austin 	unsigned int reg2 = mc->rreg;
29091d99f243SBrian Austin 	unsigned int shift = mc->shift;
29101d99f243SBrian Austin 	unsigned int rshift = mc->rshift;
29111d99f243SBrian Austin 	int max = mc->max;
29121d99f243SBrian Austin 	int min = mc->min;
29131d99f243SBrian Austin 	int mask = (1 << (fls(min + max) - 1)) - 1;
29141d99f243SBrian Austin 
29151d99f243SBrian Austin 	ucontrol->value.integer.value[0] =
29161d99f243SBrian Austin 	    ((snd_soc_read(codec, reg) >> shift) - min) & mask;
29171d99f243SBrian Austin 
29181d99f243SBrian Austin 	if (snd_soc_volsw_is_stereo(mc))
29191d99f243SBrian Austin 		ucontrol->value.integer.value[1] =
29201d99f243SBrian Austin 			((snd_soc_read(codec, reg2) >> rshift) - min) & mask;
29211d99f243SBrian Austin 
29221d99f243SBrian Austin 	return 0;
29231d99f243SBrian Austin }
29241d99f243SBrian Austin EXPORT_SYMBOL_GPL(snd_soc_get_volsw_sx);
29251d99f243SBrian Austin 
29261d99f243SBrian Austin /**
29271d99f243SBrian Austin  * snd_soc_put_volsw_sx - double mixer set callback
29281d99f243SBrian Austin  * @kcontrol: mixer control
29291d99f243SBrian Austin  * @uinfo: control element information
29301d99f243SBrian Austin  *
29311d99f243SBrian Austin  * Callback to set the value of a double mixer control that spans 2 registers.
29321d99f243SBrian Austin  *
29331d99f243SBrian Austin  * Returns 0 for success.
29341d99f243SBrian Austin  */
29351d99f243SBrian Austin int snd_soc_put_volsw_sx(struct snd_kcontrol *kcontrol,
29361d99f243SBrian Austin 			 struct snd_ctl_elem_value *ucontrol)
29371d99f243SBrian Austin {
29381d99f243SBrian Austin 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
29391d99f243SBrian Austin 	struct soc_mixer_control *mc =
29401d99f243SBrian Austin 	    (struct soc_mixer_control *)kcontrol->private_value;
29411d99f243SBrian Austin 
29421d99f243SBrian Austin 	unsigned int reg = mc->reg;
29431d99f243SBrian Austin 	unsigned int reg2 = mc->rreg;
29441d99f243SBrian Austin 	unsigned int shift = mc->shift;
29451d99f243SBrian Austin 	unsigned int rshift = mc->rshift;
29461d99f243SBrian Austin 	int max = mc->max;
29471d99f243SBrian Austin 	int min = mc->min;
29481d99f243SBrian Austin 	int mask = (1 << (fls(min + max) - 1)) - 1;
294927f1d759SBrian Austin 	int err = 0;
29501d99f243SBrian Austin 	unsigned short val, val_mask, val2 = 0;
29511d99f243SBrian Austin 
29521d99f243SBrian Austin 	val_mask = mask << shift;
29531d99f243SBrian Austin 	val = (ucontrol->value.integer.value[0] + min) & mask;
29541d99f243SBrian Austin 	val = val << shift;
29551d99f243SBrian Austin 
2956d055852eSMukund Navada 	err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
2957d055852eSMukund Navada 	if (err < 0)
29581d99f243SBrian Austin 		return err;
29591d99f243SBrian Austin 
29601d99f243SBrian Austin 	if (snd_soc_volsw_is_stereo(mc)) {
29611d99f243SBrian Austin 		val_mask = mask << rshift;
29621d99f243SBrian Austin 		val2 = (ucontrol->value.integer.value[1] + min) & mask;
29631d99f243SBrian Austin 		val2 = val2 << rshift;
29641d99f243SBrian Austin 
29651d99f243SBrian Austin 		if (snd_soc_update_bits_locked(codec, reg2, val_mask, val2))
29661d99f243SBrian Austin 			return err;
29671d99f243SBrian Austin 	}
29681d99f243SBrian Austin 	return 0;
29691d99f243SBrian Austin }
29701d99f243SBrian Austin EXPORT_SYMBOL_GPL(snd_soc_put_volsw_sx);
29711d99f243SBrian Austin 
29721d99f243SBrian Austin /**
2973e13ac2e9SMark Brown  * snd_soc_info_volsw_s8 - signed mixer info callback
2974e13ac2e9SMark Brown  * @kcontrol: mixer control
2975e13ac2e9SMark Brown  * @uinfo: control element information
2976e13ac2e9SMark Brown  *
2977e13ac2e9SMark Brown  * Callback to provide information about a signed mixer control.
2978e13ac2e9SMark Brown  *
2979e13ac2e9SMark Brown  * Returns 0 for success.
2980e13ac2e9SMark Brown  */
2981e13ac2e9SMark Brown int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol,
2982e13ac2e9SMark Brown 	struct snd_ctl_elem_info *uinfo)
2983e13ac2e9SMark Brown {
29844eaa9819SJon Smirl 	struct soc_mixer_control *mc =
29854eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
2986d11bb4a9SPeter Ujfalusi 	int platform_max;
29874eaa9819SJon Smirl 	int min = mc->min;
2988e13ac2e9SMark Brown 
2989d11bb4a9SPeter Ujfalusi 	if (!mc->platform_max)
2990d11bb4a9SPeter Ujfalusi 		mc->platform_max = mc->max;
2991d11bb4a9SPeter Ujfalusi 	platform_max = mc->platform_max;
2992d11bb4a9SPeter Ujfalusi 
2993e13ac2e9SMark Brown 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2994e13ac2e9SMark Brown 	uinfo->count = 2;
2995e13ac2e9SMark Brown 	uinfo->value.integer.min = 0;
2996d11bb4a9SPeter Ujfalusi 	uinfo->value.integer.max = platform_max - min;
2997e13ac2e9SMark Brown 	return 0;
2998e13ac2e9SMark Brown }
2999e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8);
3000e13ac2e9SMark Brown 
3001e13ac2e9SMark Brown /**
3002e13ac2e9SMark Brown  * snd_soc_get_volsw_s8 - signed mixer get callback
3003e13ac2e9SMark Brown  * @kcontrol: mixer control
3004ac11a2b3SMark Brown  * @ucontrol: control element information
3005e13ac2e9SMark Brown  *
3006e13ac2e9SMark Brown  * Callback to get the value of a signed mixer control.
3007e13ac2e9SMark Brown  *
3008e13ac2e9SMark Brown  * Returns 0 for success.
3009e13ac2e9SMark Brown  */
3010e13ac2e9SMark Brown int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol,
3011e13ac2e9SMark Brown 	struct snd_ctl_elem_value *ucontrol)
3012e13ac2e9SMark Brown {
30134eaa9819SJon Smirl 	struct soc_mixer_control *mc =
30144eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
3015e13ac2e9SMark Brown 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3016815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
30174eaa9819SJon Smirl 	int min = mc->min;
3018e13ac2e9SMark Brown 	int val = snd_soc_read(codec, reg);
3019e13ac2e9SMark Brown 
3020e13ac2e9SMark Brown 	ucontrol->value.integer.value[0] =
3021e13ac2e9SMark Brown 		((signed char)(val & 0xff))-min;
3022e13ac2e9SMark Brown 	ucontrol->value.integer.value[1] =
3023e13ac2e9SMark Brown 		((signed char)((val >> 8) & 0xff))-min;
3024e13ac2e9SMark Brown 	return 0;
3025e13ac2e9SMark Brown }
3026e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8);
3027e13ac2e9SMark Brown 
3028e13ac2e9SMark Brown /**
3029e13ac2e9SMark Brown  * snd_soc_put_volsw_sgn - signed mixer put callback
3030e13ac2e9SMark Brown  * @kcontrol: mixer control
3031ac11a2b3SMark Brown  * @ucontrol: control element information
3032e13ac2e9SMark Brown  *
3033e13ac2e9SMark Brown  * Callback to set the value of a signed mixer control.
3034e13ac2e9SMark Brown  *
3035e13ac2e9SMark Brown  * Returns 0 for success.
3036e13ac2e9SMark Brown  */
3037e13ac2e9SMark Brown int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol,
3038e13ac2e9SMark Brown 	struct snd_ctl_elem_value *ucontrol)
3039e13ac2e9SMark Brown {
30404eaa9819SJon Smirl 	struct soc_mixer_control *mc =
30414eaa9819SJon Smirl 		(struct soc_mixer_control *)kcontrol->private_value;
3042e13ac2e9SMark Brown 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3043815ecf8dSJon Smirl 	unsigned int reg = mc->reg;
30444eaa9819SJon Smirl 	int min = mc->min;
304546f5822fSDaniel Ribeiro 	unsigned int val;
3046e13ac2e9SMark Brown 
3047e13ac2e9SMark Brown 	val = (ucontrol->value.integer.value[0]+min) & 0xff;
3048e13ac2e9SMark Brown 	val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8;
3049e13ac2e9SMark Brown 
30506c508c62SEero Nurkkala 	return snd_soc_update_bits_locked(codec, reg, 0xffff, val);
3051e13ac2e9SMark Brown }
3052e13ac2e9SMark Brown EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8);
3053e13ac2e9SMark Brown 
30548c6529dbSLiam Girdwood /**
30556c9d8cf6SAdam Thomson  * snd_soc_info_volsw_range - single mixer info callback with range.
30566c9d8cf6SAdam Thomson  * @kcontrol: mixer control
30576c9d8cf6SAdam Thomson  * @uinfo: control element information
30586c9d8cf6SAdam Thomson  *
30596c9d8cf6SAdam Thomson  * Callback to provide information, within a range, about a single
30606c9d8cf6SAdam Thomson  * mixer control.
30616c9d8cf6SAdam Thomson  *
30626c9d8cf6SAdam Thomson  * returns 0 for success.
30636c9d8cf6SAdam Thomson  */
30646c9d8cf6SAdam Thomson int snd_soc_info_volsw_range(struct snd_kcontrol *kcontrol,
30656c9d8cf6SAdam Thomson 	struct snd_ctl_elem_info *uinfo)
30666c9d8cf6SAdam Thomson {
30676c9d8cf6SAdam Thomson 	struct soc_mixer_control *mc =
30686c9d8cf6SAdam Thomson 		(struct soc_mixer_control *)kcontrol->private_value;
30696c9d8cf6SAdam Thomson 	int platform_max;
30706c9d8cf6SAdam Thomson 	int min = mc->min;
30716c9d8cf6SAdam Thomson 
30726c9d8cf6SAdam Thomson 	if (!mc->platform_max)
30736c9d8cf6SAdam Thomson 		mc->platform_max = mc->max;
30746c9d8cf6SAdam Thomson 	platform_max = mc->platform_max;
30756c9d8cf6SAdam Thomson 
30766c9d8cf6SAdam Thomson 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
30779bde4f0bSMark Brown 	uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
30786c9d8cf6SAdam Thomson 	uinfo->value.integer.min = 0;
30796c9d8cf6SAdam Thomson 	uinfo->value.integer.max = platform_max - min;
30806c9d8cf6SAdam Thomson 
30816c9d8cf6SAdam Thomson 	return 0;
30826c9d8cf6SAdam Thomson }
30836c9d8cf6SAdam Thomson EXPORT_SYMBOL_GPL(snd_soc_info_volsw_range);
30846c9d8cf6SAdam Thomson 
30856c9d8cf6SAdam Thomson /**
30866c9d8cf6SAdam Thomson  * snd_soc_put_volsw_range - single mixer put value callback with range.
30876c9d8cf6SAdam Thomson  * @kcontrol: mixer control
30886c9d8cf6SAdam Thomson  * @ucontrol: control element information
30896c9d8cf6SAdam Thomson  *
30906c9d8cf6SAdam Thomson  * Callback to set the value, within a range, for a single mixer control.
30916c9d8cf6SAdam Thomson  *
30926c9d8cf6SAdam Thomson  * Returns 0 for success.
30936c9d8cf6SAdam Thomson  */
30946c9d8cf6SAdam Thomson int snd_soc_put_volsw_range(struct snd_kcontrol *kcontrol,
30956c9d8cf6SAdam Thomson 	struct snd_ctl_elem_value *ucontrol)
30966c9d8cf6SAdam Thomson {
30976c9d8cf6SAdam Thomson 	struct soc_mixer_control *mc =
30986c9d8cf6SAdam Thomson 		(struct soc_mixer_control *)kcontrol->private_value;
30996c9d8cf6SAdam Thomson 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
31006c9d8cf6SAdam Thomson 	unsigned int reg = mc->reg;
31019bde4f0bSMark Brown 	unsigned int rreg = mc->rreg;
31026c9d8cf6SAdam Thomson 	unsigned int shift = mc->shift;
31036c9d8cf6SAdam Thomson 	int min = mc->min;
31046c9d8cf6SAdam Thomson 	int max = mc->max;
31056c9d8cf6SAdam Thomson 	unsigned int mask = (1 << fls(max)) - 1;
31066c9d8cf6SAdam Thomson 	unsigned int invert = mc->invert;
31076c9d8cf6SAdam Thomson 	unsigned int val, val_mask;
31089bde4f0bSMark Brown 	int ret;
31096c9d8cf6SAdam Thomson 
31106c9d8cf6SAdam Thomson 	val = ((ucontrol->value.integer.value[0] + min) & mask);
31116c9d8cf6SAdam Thomson 	if (invert)
31126c9d8cf6SAdam Thomson 		val = max - val;
31136c9d8cf6SAdam Thomson 	val_mask = mask << shift;
31146c9d8cf6SAdam Thomson 	val = val << shift;
31156c9d8cf6SAdam Thomson 
31169bde4f0bSMark Brown 	ret = snd_soc_update_bits_locked(codec, reg, val_mask, val);
31170eaa6ccaSJoonyoung Shim 	if (ret < 0)
31189bde4f0bSMark Brown 		return ret;
31199bde4f0bSMark Brown 
31209bde4f0bSMark Brown 	if (snd_soc_volsw_is_stereo(mc)) {
31219bde4f0bSMark Brown 		val = ((ucontrol->value.integer.value[1] + min) & mask);
31229bde4f0bSMark Brown 		if (invert)
31239bde4f0bSMark Brown 			val = max - val;
31249bde4f0bSMark Brown 		val_mask = mask << shift;
31259bde4f0bSMark Brown 		val = val << shift;
31269bde4f0bSMark Brown 
31279bde4f0bSMark Brown 		ret = snd_soc_update_bits_locked(codec, rreg, val_mask, val);
31289bde4f0bSMark Brown 	}
31299bde4f0bSMark Brown 
31309bde4f0bSMark Brown 	return ret;
31316c9d8cf6SAdam Thomson }
31326c9d8cf6SAdam Thomson EXPORT_SYMBOL_GPL(snd_soc_put_volsw_range);
31336c9d8cf6SAdam Thomson 
31346c9d8cf6SAdam Thomson /**
31356c9d8cf6SAdam Thomson  * snd_soc_get_volsw_range - single mixer get callback with range
31366c9d8cf6SAdam Thomson  * @kcontrol: mixer control
31376c9d8cf6SAdam Thomson  * @ucontrol: control element information
31386c9d8cf6SAdam Thomson  *
31396c9d8cf6SAdam Thomson  * Callback to get the value, within a range, of a single mixer control.
31406c9d8cf6SAdam Thomson  *
31416c9d8cf6SAdam Thomson  * Returns 0 for success.
31426c9d8cf6SAdam Thomson  */
31436c9d8cf6SAdam Thomson int snd_soc_get_volsw_range(struct snd_kcontrol *kcontrol,
31446c9d8cf6SAdam Thomson 	struct snd_ctl_elem_value *ucontrol)
31456c9d8cf6SAdam Thomson {
31466c9d8cf6SAdam Thomson 	struct soc_mixer_control *mc =
31476c9d8cf6SAdam Thomson 		(struct soc_mixer_control *)kcontrol->private_value;
31486c9d8cf6SAdam Thomson 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
31496c9d8cf6SAdam Thomson 	unsigned int reg = mc->reg;
31509bde4f0bSMark Brown 	unsigned int rreg = mc->rreg;
31516c9d8cf6SAdam Thomson 	unsigned int shift = mc->shift;
31526c9d8cf6SAdam Thomson 	int min = mc->min;
31536c9d8cf6SAdam Thomson 	int max = mc->max;
31546c9d8cf6SAdam Thomson 	unsigned int mask = (1 << fls(max)) - 1;
31556c9d8cf6SAdam Thomson 	unsigned int invert = mc->invert;
31566c9d8cf6SAdam Thomson 
31576c9d8cf6SAdam Thomson 	ucontrol->value.integer.value[0] =
31586c9d8cf6SAdam Thomson 		(snd_soc_read(codec, reg) >> shift) & mask;
31596c9d8cf6SAdam Thomson 	if (invert)
31606c9d8cf6SAdam Thomson 		ucontrol->value.integer.value[0] =
31616c9d8cf6SAdam Thomson 			max - ucontrol->value.integer.value[0];
31626c9d8cf6SAdam Thomson 	ucontrol->value.integer.value[0] =
31636c9d8cf6SAdam Thomson 		ucontrol->value.integer.value[0] - min;
31646c9d8cf6SAdam Thomson 
31659bde4f0bSMark Brown 	if (snd_soc_volsw_is_stereo(mc)) {
31669bde4f0bSMark Brown 		ucontrol->value.integer.value[1] =
31679bde4f0bSMark Brown 			(snd_soc_read(codec, rreg) >> shift) & mask;
31689bde4f0bSMark Brown 		if (invert)
31699bde4f0bSMark Brown 			ucontrol->value.integer.value[1] =
31709bde4f0bSMark Brown 				max - ucontrol->value.integer.value[1];
31719bde4f0bSMark Brown 		ucontrol->value.integer.value[1] =
31729bde4f0bSMark Brown 			ucontrol->value.integer.value[1] - min;
31739bde4f0bSMark Brown 	}
31749bde4f0bSMark Brown 
31756c9d8cf6SAdam Thomson 	return 0;
31766c9d8cf6SAdam Thomson }
31776c9d8cf6SAdam Thomson EXPORT_SYMBOL_GPL(snd_soc_get_volsw_range);
31786c9d8cf6SAdam Thomson 
31796c9d8cf6SAdam Thomson /**
3180637d3847SPeter Ujfalusi  * snd_soc_limit_volume - Set new limit to an existing volume control.
3181637d3847SPeter Ujfalusi  *
3182637d3847SPeter Ujfalusi  * @codec: where to look for the control
3183637d3847SPeter Ujfalusi  * @name: Name of the control
3184637d3847SPeter Ujfalusi  * @max: new maximum limit
3185637d3847SPeter Ujfalusi  *
3186637d3847SPeter Ujfalusi  * Return 0 for success, else error.
3187637d3847SPeter Ujfalusi  */
3188637d3847SPeter Ujfalusi int snd_soc_limit_volume(struct snd_soc_codec *codec,
3189637d3847SPeter Ujfalusi 	const char *name, int max)
3190637d3847SPeter Ujfalusi {
3191f0fba2adSLiam Girdwood 	struct snd_card *card = codec->card->snd_card;
3192637d3847SPeter Ujfalusi 	struct snd_kcontrol *kctl;
3193637d3847SPeter Ujfalusi 	struct soc_mixer_control *mc;
3194637d3847SPeter Ujfalusi 	int found = 0;
3195637d3847SPeter Ujfalusi 	int ret = -EINVAL;
3196637d3847SPeter Ujfalusi 
3197637d3847SPeter Ujfalusi 	/* Sanity check for name and max */
3198637d3847SPeter Ujfalusi 	if (unlikely(!name || max <= 0))
3199637d3847SPeter Ujfalusi 		return -EINVAL;
3200637d3847SPeter Ujfalusi 
3201637d3847SPeter Ujfalusi 	list_for_each_entry(kctl, &card->controls, list) {
3202637d3847SPeter Ujfalusi 		if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) {
3203637d3847SPeter Ujfalusi 			found = 1;
3204637d3847SPeter Ujfalusi 			break;
3205637d3847SPeter Ujfalusi 		}
3206637d3847SPeter Ujfalusi 	}
3207637d3847SPeter Ujfalusi 	if (found) {
3208637d3847SPeter Ujfalusi 		mc = (struct soc_mixer_control *)kctl->private_value;
3209637d3847SPeter Ujfalusi 		if (max <= mc->max) {
3210d11bb4a9SPeter Ujfalusi 			mc->platform_max = max;
3211637d3847SPeter Ujfalusi 			ret = 0;
3212637d3847SPeter Ujfalusi 		}
3213637d3847SPeter Ujfalusi 	}
3214637d3847SPeter Ujfalusi 	return ret;
3215637d3847SPeter Ujfalusi }
3216637d3847SPeter Ujfalusi EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
3217637d3847SPeter Ujfalusi 
321871d08516SMark Brown int snd_soc_bytes_info(struct snd_kcontrol *kcontrol,
321971d08516SMark Brown 		       struct snd_ctl_elem_info *uinfo)
322071d08516SMark Brown {
322171d08516SMark Brown 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
322271d08516SMark Brown 	struct soc_bytes *params = (void *)kcontrol->private_value;
322371d08516SMark Brown 
322471d08516SMark Brown 	uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
322571d08516SMark Brown 	uinfo->count = params->num_regs * codec->val_bytes;
322671d08516SMark Brown 
322771d08516SMark Brown 	return 0;
322871d08516SMark Brown }
322971d08516SMark Brown EXPORT_SYMBOL_GPL(snd_soc_bytes_info);
323071d08516SMark Brown 
323171d08516SMark Brown int snd_soc_bytes_get(struct snd_kcontrol *kcontrol,
323271d08516SMark Brown 		      struct snd_ctl_elem_value *ucontrol)
323371d08516SMark Brown {
323471d08516SMark Brown 	struct soc_bytes *params = (void *)kcontrol->private_value;
323571d08516SMark Brown 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
323671d08516SMark Brown 	int ret;
323771d08516SMark Brown 
323871d08516SMark Brown 	if (codec->using_regmap)
323971d08516SMark Brown 		ret = regmap_raw_read(codec->control_data, params->base,
324071d08516SMark Brown 				      ucontrol->value.bytes.data,
324171d08516SMark Brown 				      params->num_regs * codec->val_bytes);
324271d08516SMark Brown 	else
324371d08516SMark Brown 		ret = -EINVAL;
324471d08516SMark Brown 
3245f831b055SMark Brown 	/* Hide any masked bytes to ensure consistent data reporting */
3246f831b055SMark Brown 	if (ret == 0 && params->mask) {
3247f831b055SMark Brown 		switch (codec->val_bytes) {
3248f831b055SMark Brown 		case 1:
3249f831b055SMark Brown 			ucontrol->value.bytes.data[0] &= ~params->mask;
3250f831b055SMark Brown 			break;
3251f831b055SMark Brown 		case 2:
3252f831b055SMark Brown 			((u16 *)(&ucontrol->value.bytes.data))[0]
32538f1ec93aSCharles Keepax 				&= cpu_to_be16(~params->mask);
3254f831b055SMark Brown 			break;
3255f831b055SMark Brown 		case 4:
3256f831b055SMark Brown 			((u32 *)(&ucontrol->value.bytes.data))[0]
32578f1ec93aSCharles Keepax 				&= cpu_to_be32(~params->mask);
3258f831b055SMark Brown 			break;
3259f831b055SMark Brown 		default:
3260f831b055SMark Brown 			return -EINVAL;
3261f831b055SMark Brown 		}
3262f831b055SMark Brown 	}
3263f831b055SMark Brown 
326471d08516SMark Brown 	return ret;
326571d08516SMark Brown }
326671d08516SMark Brown EXPORT_SYMBOL_GPL(snd_soc_bytes_get);
326771d08516SMark Brown 
326871d08516SMark Brown int snd_soc_bytes_put(struct snd_kcontrol *kcontrol,
326971d08516SMark Brown 		      struct snd_ctl_elem_value *ucontrol)
327071d08516SMark Brown {
327171d08516SMark Brown 	struct soc_bytes *params = (void *)kcontrol->private_value;
327271d08516SMark Brown 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3273f831b055SMark Brown 	int ret, len;
3274a1a564edSNenghua Cao 	unsigned int val, mask;
3275f831b055SMark Brown 	void *data;
327671d08516SMark Brown 
3277f831b055SMark Brown 	if (!codec->using_regmap)
3278f831b055SMark Brown 		return -EINVAL;
3279f831b055SMark Brown 
3280f831b055SMark Brown 	len = params->num_regs * codec->val_bytes;
3281f831b055SMark Brown 
3282b5a8fe43SMark Brown 	data = kmemdup(ucontrol->value.bytes.data, len, GFP_KERNEL | GFP_DMA);
3283b5a8fe43SMark Brown 	if (!data)
3284b5a8fe43SMark Brown 		return -ENOMEM;
3285b5a8fe43SMark Brown 
3286f831b055SMark Brown 	/*
3287f831b055SMark Brown 	 * If we've got a mask then we need to preserve the register
3288f831b055SMark Brown 	 * bits.  We shouldn't modify the incoming data so take a
3289f831b055SMark Brown 	 * copy.
3290f831b055SMark Brown 	 */
3291f831b055SMark Brown 	if (params->mask) {
3292f831b055SMark Brown 		ret = regmap_read(codec->control_data, params->base, &val);
3293f831b055SMark Brown 		if (ret != 0)
3294e8b18addSWei Yongjun 			goto out;
3295f831b055SMark Brown 
3296f831b055SMark Brown 		val &= params->mask;
3297f831b055SMark Brown 
3298f831b055SMark Brown 		switch (codec->val_bytes) {
3299f831b055SMark Brown 		case 1:
3300f831b055SMark Brown 			((u8 *)data)[0] &= ~params->mask;
3301f831b055SMark Brown 			((u8 *)data)[0] |= val;
3302f831b055SMark Brown 			break;
3303f831b055SMark Brown 		case 2:
3304a1a564edSNenghua Cao 			mask = ~params->mask;
3305a1a564edSNenghua Cao 			ret = regmap_parse_val(codec->control_data,
3306a1a564edSNenghua Cao 							&mask, &mask);
3307a1a564edSNenghua Cao 			if (ret != 0)
3308a1a564edSNenghua Cao 				goto out;
3309a1a564edSNenghua Cao 
3310a1a564edSNenghua Cao 			((u16 *)data)[0] &= mask;
3311a1a564edSNenghua Cao 
3312a1a564edSNenghua Cao 			ret = regmap_parse_val(codec->control_data,
3313a1a564edSNenghua Cao 							&val, &val);
3314a1a564edSNenghua Cao 			if (ret != 0)
3315a1a564edSNenghua Cao 				goto out;
3316a1a564edSNenghua Cao 
3317a1a564edSNenghua Cao 			((u16 *)data)[0] |= val;
3318f831b055SMark Brown 			break;
3319f831b055SMark Brown 		case 4:
3320a1a564edSNenghua Cao 			mask = ~params->mask;
3321a1a564edSNenghua Cao 			ret = regmap_parse_val(codec->control_data,
3322a1a564edSNenghua Cao 							&mask, &mask);
3323a1a564edSNenghua Cao 			if (ret != 0)
3324a1a564edSNenghua Cao 				goto out;
3325a1a564edSNenghua Cao 
3326a1a564edSNenghua Cao 			((u32 *)data)[0] &= mask;
3327a1a564edSNenghua Cao 
3328a1a564edSNenghua Cao 			ret = regmap_parse_val(codec->control_data,
3329a1a564edSNenghua Cao 							&val, &val);
3330a1a564edSNenghua Cao 			if (ret != 0)
3331a1a564edSNenghua Cao 				goto out;
3332a1a564edSNenghua Cao 
3333a1a564edSNenghua Cao 			((u32 *)data)[0] |= val;
3334f831b055SMark Brown 			break;
3335f831b055SMark Brown 		default:
3336e8b18addSWei Yongjun 			ret = -EINVAL;
3337e8b18addSWei Yongjun 			goto out;
3338f831b055SMark Brown 		}
3339f831b055SMark Brown 	}
3340f831b055SMark Brown 
334171d08516SMark Brown 	ret = regmap_raw_write(codec->control_data, params->base,
3342f831b055SMark Brown 			       data, len);
3343f831b055SMark Brown 
3344e8b18addSWei Yongjun out:
3345f831b055SMark Brown 	kfree(data);
334671d08516SMark Brown 
334771d08516SMark Brown 	return ret;
334871d08516SMark Brown }
334971d08516SMark Brown EXPORT_SYMBOL_GPL(snd_soc_bytes_put);
335071d08516SMark Brown 
3351b6f4bb38Sapatard@mandriva.com /**
33524183eed2SKristoffer KARLSSON  * snd_soc_info_xr_sx - signed multi register info callback
33534183eed2SKristoffer KARLSSON  * @kcontrol: mreg control
33544183eed2SKristoffer KARLSSON  * @uinfo: control element information
33554183eed2SKristoffer KARLSSON  *
33564183eed2SKristoffer KARLSSON  * Callback to provide information of a control that can
33574183eed2SKristoffer KARLSSON  * span multiple codec registers which together
33584183eed2SKristoffer KARLSSON  * forms a single signed value in a MSB/LSB manner.
33594183eed2SKristoffer KARLSSON  *
33604183eed2SKristoffer KARLSSON  * Returns 0 for success.
33614183eed2SKristoffer KARLSSON  */
33624183eed2SKristoffer KARLSSON int snd_soc_info_xr_sx(struct snd_kcontrol *kcontrol,
33634183eed2SKristoffer KARLSSON 	struct snd_ctl_elem_info *uinfo)
33644183eed2SKristoffer KARLSSON {
33654183eed2SKristoffer KARLSSON 	struct soc_mreg_control *mc =
33664183eed2SKristoffer KARLSSON 		(struct soc_mreg_control *)kcontrol->private_value;
33674183eed2SKristoffer KARLSSON 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
33684183eed2SKristoffer KARLSSON 	uinfo->count = 1;
33694183eed2SKristoffer KARLSSON 	uinfo->value.integer.min = mc->min;
33704183eed2SKristoffer KARLSSON 	uinfo->value.integer.max = mc->max;
33714183eed2SKristoffer KARLSSON 
33724183eed2SKristoffer KARLSSON 	return 0;
33734183eed2SKristoffer KARLSSON }
33744183eed2SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_info_xr_sx);
33754183eed2SKristoffer KARLSSON 
33764183eed2SKristoffer KARLSSON /**
33774183eed2SKristoffer KARLSSON  * snd_soc_get_xr_sx - signed multi register get callback
33784183eed2SKristoffer KARLSSON  * @kcontrol: mreg control
33794183eed2SKristoffer KARLSSON  * @ucontrol: control element information
33804183eed2SKristoffer KARLSSON  *
33814183eed2SKristoffer KARLSSON  * Callback to get the value of a control that can span
33824183eed2SKristoffer KARLSSON  * multiple codec registers which together forms a single
33834183eed2SKristoffer KARLSSON  * signed value in a MSB/LSB manner. The control supports
33844183eed2SKristoffer KARLSSON  * specifying total no of bits used to allow for bitfields
33854183eed2SKristoffer KARLSSON  * across the multiple codec registers.
33864183eed2SKristoffer KARLSSON  *
33874183eed2SKristoffer KARLSSON  * Returns 0 for success.
33884183eed2SKristoffer KARLSSON  */
33894183eed2SKristoffer KARLSSON int snd_soc_get_xr_sx(struct snd_kcontrol *kcontrol,
33904183eed2SKristoffer KARLSSON 	struct snd_ctl_elem_value *ucontrol)
33914183eed2SKristoffer KARLSSON {
33924183eed2SKristoffer KARLSSON 	struct soc_mreg_control *mc =
33934183eed2SKristoffer KARLSSON 		(struct soc_mreg_control *)kcontrol->private_value;
33944183eed2SKristoffer KARLSSON 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
33954183eed2SKristoffer KARLSSON 	unsigned int regbase = mc->regbase;
33964183eed2SKristoffer KARLSSON 	unsigned int regcount = mc->regcount;
33974183eed2SKristoffer KARLSSON 	unsigned int regwshift = codec->driver->reg_word_size * BITS_PER_BYTE;
33984183eed2SKristoffer KARLSSON 	unsigned int regwmask = (1<<regwshift)-1;
33994183eed2SKristoffer KARLSSON 	unsigned int invert = mc->invert;
34004183eed2SKristoffer KARLSSON 	unsigned long mask = (1UL<<mc->nbits)-1;
34014183eed2SKristoffer KARLSSON 	long min = mc->min;
34024183eed2SKristoffer KARLSSON 	long max = mc->max;
34034183eed2SKristoffer KARLSSON 	long val = 0;
34044183eed2SKristoffer KARLSSON 	unsigned long regval;
34054183eed2SKristoffer KARLSSON 	unsigned int i;
34064183eed2SKristoffer KARLSSON 
34074183eed2SKristoffer KARLSSON 	for (i = 0; i < regcount; i++) {
34084183eed2SKristoffer KARLSSON 		regval = snd_soc_read(codec, regbase+i) & regwmask;
34094183eed2SKristoffer KARLSSON 		val |= regval << (regwshift*(regcount-i-1));
34104183eed2SKristoffer KARLSSON 	}
34114183eed2SKristoffer KARLSSON 	val &= mask;
34124183eed2SKristoffer KARLSSON 	if (min < 0 && val > max)
34134183eed2SKristoffer KARLSSON 		val |= ~mask;
34144183eed2SKristoffer KARLSSON 	if (invert)
34154183eed2SKristoffer KARLSSON 		val = max - val;
34164183eed2SKristoffer KARLSSON 	ucontrol->value.integer.value[0] = val;
34174183eed2SKristoffer KARLSSON 
34184183eed2SKristoffer KARLSSON 	return 0;
34194183eed2SKristoffer KARLSSON }
34204183eed2SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_get_xr_sx);
34214183eed2SKristoffer KARLSSON 
34224183eed2SKristoffer KARLSSON /**
34234183eed2SKristoffer KARLSSON  * snd_soc_put_xr_sx - signed multi register get callback
34244183eed2SKristoffer KARLSSON  * @kcontrol: mreg control
34254183eed2SKristoffer KARLSSON  * @ucontrol: control element information
34264183eed2SKristoffer KARLSSON  *
34274183eed2SKristoffer KARLSSON  * Callback to set the value of a control that can span
34284183eed2SKristoffer KARLSSON  * multiple codec registers which together forms a single
34294183eed2SKristoffer KARLSSON  * signed value in a MSB/LSB manner. The control supports
34304183eed2SKristoffer KARLSSON  * specifying total no of bits used to allow for bitfields
34314183eed2SKristoffer KARLSSON  * across the multiple codec registers.
34324183eed2SKristoffer KARLSSON  *
34334183eed2SKristoffer KARLSSON  * Returns 0 for success.
34344183eed2SKristoffer KARLSSON  */
34354183eed2SKristoffer KARLSSON int snd_soc_put_xr_sx(struct snd_kcontrol *kcontrol,
34364183eed2SKristoffer KARLSSON 	struct snd_ctl_elem_value *ucontrol)
34374183eed2SKristoffer KARLSSON {
34384183eed2SKristoffer KARLSSON 	struct soc_mreg_control *mc =
34394183eed2SKristoffer KARLSSON 		(struct soc_mreg_control *)kcontrol->private_value;
34404183eed2SKristoffer KARLSSON 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
34414183eed2SKristoffer KARLSSON 	unsigned int regbase = mc->regbase;
34424183eed2SKristoffer KARLSSON 	unsigned int regcount = mc->regcount;
34434183eed2SKristoffer KARLSSON 	unsigned int regwshift = codec->driver->reg_word_size * BITS_PER_BYTE;
34444183eed2SKristoffer KARLSSON 	unsigned int regwmask = (1<<regwshift)-1;
34454183eed2SKristoffer KARLSSON 	unsigned int invert = mc->invert;
34464183eed2SKristoffer KARLSSON 	unsigned long mask = (1UL<<mc->nbits)-1;
34474183eed2SKristoffer KARLSSON 	long max = mc->max;
34484183eed2SKristoffer KARLSSON 	long val = ucontrol->value.integer.value[0];
34494183eed2SKristoffer KARLSSON 	unsigned int i, regval, regmask;
34504183eed2SKristoffer KARLSSON 	int err;
34514183eed2SKristoffer KARLSSON 
34524183eed2SKristoffer KARLSSON 	if (invert)
34534183eed2SKristoffer KARLSSON 		val = max - val;
34544183eed2SKristoffer KARLSSON 	val &= mask;
34554183eed2SKristoffer KARLSSON 	for (i = 0; i < regcount; i++) {
34564183eed2SKristoffer KARLSSON 		regval = (val >> (regwshift*(regcount-i-1))) & regwmask;
34574183eed2SKristoffer KARLSSON 		regmask = (mask >> (regwshift*(regcount-i-1))) & regwmask;
34584183eed2SKristoffer KARLSSON 		err = snd_soc_update_bits_locked(codec, regbase+i,
34594183eed2SKristoffer KARLSSON 				regmask, regval);
34604183eed2SKristoffer KARLSSON 		if (err < 0)
34614183eed2SKristoffer KARLSSON 			return err;
34624183eed2SKristoffer KARLSSON 	}
34634183eed2SKristoffer KARLSSON 
34644183eed2SKristoffer KARLSSON 	return 0;
34654183eed2SKristoffer KARLSSON }
34664183eed2SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_put_xr_sx);
34674183eed2SKristoffer KARLSSON 
34684183eed2SKristoffer KARLSSON /**
3469dd7b10b3SKristoffer KARLSSON  * snd_soc_get_strobe - strobe get callback
3470dd7b10b3SKristoffer KARLSSON  * @kcontrol: mixer control
3471dd7b10b3SKristoffer KARLSSON  * @ucontrol: control element information
3472dd7b10b3SKristoffer KARLSSON  *
3473dd7b10b3SKristoffer KARLSSON  * Callback get the value of a strobe mixer control.
3474dd7b10b3SKristoffer KARLSSON  *
3475dd7b10b3SKristoffer KARLSSON  * Returns 0 for success.
3476dd7b10b3SKristoffer KARLSSON  */
3477dd7b10b3SKristoffer KARLSSON int snd_soc_get_strobe(struct snd_kcontrol *kcontrol,
3478dd7b10b3SKristoffer KARLSSON 	struct snd_ctl_elem_value *ucontrol)
3479dd7b10b3SKristoffer KARLSSON {
3480dd7b10b3SKristoffer KARLSSON 	struct soc_mixer_control *mc =
3481dd7b10b3SKristoffer KARLSSON 		(struct soc_mixer_control *)kcontrol->private_value;
3482dd7b10b3SKristoffer KARLSSON 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3483dd7b10b3SKristoffer KARLSSON 	unsigned int reg = mc->reg;
3484dd7b10b3SKristoffer KARLSSON 	unsigned int shift = mc->shift;
3485dd7b10b3SKristoffer KARLSSON 	unsigned int mask = 1 << shift;
3486dd7b10b3SKristoffer KARLSSON 	unsigned int invert = mc->invert != 0;
3487dd7b10b3SKristoffer KARLSSON 	unsigned int val = snd_soc_read(codec, reg) & mask;
3488dd7b10b3SKristoffer KARLSSON 
3489dd7b10b3SKristoffer KARLSSON 	if (shift != 0 && val != 0)
3490dd7b10b3SKristoffer KARLSSON 		val = val >> shift;
3491dd7b10b3SKristoffer KARLSSON 	ucontrol->value.enumerated.item[0] = val ^ invert;
3492dd7b10b3SKristoffer KARLSSON 
3493dd7b10b3SKristoffer KARLSSON 	return 0;
3494dd7b10b3SKristoffer KARLSSON }
3495dd7b10b3SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_get_strobe);
3496dd7b10b3SKristoffer KARLSSON 
3497dd7b10b3SKristoffer KARLSSON /**
3498dd7b10b3SKristoffer KARLSSON  * snd_soc_put_strobe - strobe put callback
3499dd7b10b3SKristoffer KARLSSON  * @kcontrol: mixer control
3500dd7b10b3SKristoffer KARLSSON  * @ucontrol: control element information
3501dd7b10b3SKristoffer KARLSSON  *
3502dd7b10b3SKristoffer KARLSSON  * Callback strobe a register bit to high then low (or the inverse)
3503dd7b10b3SKristoffer KARLSSON  * in one pass of a single mixer enum control.
3504dd7b10b3SKristoffer KARLSSON  *
3505dd7b10b3SKristoffer KARLSSON  * Returns 1 for success.
3506dd7b10b3SKristoffer KARLSSON  */
3507dd7b10b3SKristoffer KARLSSON int snd_soc_put_strobe(struct snd_kcontrol *kcontrol,
3508dd7b10b3SKristoffer KARLSSON 	struct snd_ctl_elem_value *ucontrol)
3509dd7b10b3SKristoffer KARLSSON {
3510dd7b10b3SKristoffer KARLSSON 	struct soc_mixer_control *mc =
3511dd7b10b3SKristoffer KARLSSON 		(struct soc_mixer_control *)kcontrol->private_value;
3512dd7b10b3SKristoffer KARLSSON 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3513dd7b10b3SKristoffer KARLSSON 	unsigned int reg = mc->reg;
3514dd7b10b3SKristoffer KARLSSON 	unsigned int shift = mc->shift;
3515dd7b10b3SKristoffer KARLSSON 	unsigned int mask = 1 << shift;
3516dd7b10b3SKristoffer KARLSSON 	unsigned int invert = mc->invert != 0;
3517dd7b10b3SKristoffer KARLSSON 	unsigned int strobe = ucontrol->value.enumerated.item[0] != 0;
3518dd7b10b3SKristoffer KARLSSON 	unsigned int val1 = (strobe ^ invert) ? mask : 0;
3519dd7b10b3SKristoffer KARLSSON 	unsigned int val2 = (strobe ^ invert) ? 0 : mask;
3520dd7b10b3SKristoffer KARLSSON 	int err;
3521dd7b10b3SKristoffer KARLSSON 
3522dd7b10b3SKristoffer KARLSSON 	err = snd_soc_update_bits_locked(codec, reg, mask, val1);
3523dd7b10b3SKristoffer KARLSSON 	if (err < 0)
3524dd7b10b3SKristoffer KARLSSON 		return err;
3525dd7b10b3SKristoffer KARLSSON 
3526dd7b10b3SKristoffer KARLSSON 	err = snd_soc_update_bits_locked(codec, reg, mask, val2);
3527dd7b10b3SKristoffer KARLSSON 	return err;
3528dd7b10b3SKristoffer KARLSSON }
3529dd7b10b3SKristoffer KARLSSON EXPORT_SYMBOL_GPL(snd_soc_put_strobe);
3530dd7b10b3SKristoffer KARLSSON 
3531dd7b10b3SKristoffer KARLSSON /**
35328c6529dbSLiam Girdwood  * snd_soc_dai_set_sysclk - configure DAI system or master clock.
35338c6529dbSLiam Girdwood  * @dai: DAI
35348c6529dbSLiam Girdwood  * @clk_id: DAI specific clock ID
35358c6529dbSLiam Girdwood  * @freq: new clock frequency in Hz
35368c6529dbSLiam Girdwood  * @dir: new clock direction - input/output.
35378c6529dbSLiam Girdwood  *
35388c6529dbSLiam Girdwood  * Configures the DAI master (MCLK) or system (SYSCLK) clocking.
35398c6529dbSLiam Girdwood  */
35408c6529dbSLiam Girdwood int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
35418c6529dbSLiam Girdwood 	unsigned int freq, int dir)
35428c6529dbSLiam Girdwood {
3543f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_sysclk)
3544f0fba2adSLiam Girdwood 		return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir);
3545ec4ee52aSMark Brown 	else if (dai->codec && dai->codec->driver->set_sysclk)
3546da1c6ea6SMark Brown 		return dai->codec->driver->set_sysclk(dai->codec, clk_id, 0,
3547ec4ee52aSMark Brown 						      freq, dir);
35488c6529dbSLiam Girdwood 	else
35491104a9c8SMark Brown 		return -ENOTSUPP;
35508c6529dbSLiam Girdwood }
35518c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
35528c6529dbSLiam Girdwood 
35538c6529dbSLiam Girdwood /**
3554ec4ee52aSMark Brown  * snd_soc_codec_set_sysclk - configure CODEC system or master clock.
3555ec4ee52aSMark Brown  * @codec: CODEC
3556ec4ee52aSMark Brown  * @clk_id: DAI specific clock ID
3557da1c6ea6SMark Brown  * @source: Source for the clock
3558ec4ee52aSMark Brown  * @freq: new clock frequency in Hz
3559ec4ee52aSMark Brown  * @dir: new clock direction - input/output.
3560ec4ee52aSMark Brown  *
3561ec4ee52aSMark Brown  * Configures the CODEC master (MCLK) or system (SYSCLK) clocking.
3562ec4ee52aSMark Brown  */
3563ec4ee52aSMark Brown int snd_soc_codec_set_sysclk(struct snd_soc_codec *codec, int clk_id,
3564da1c6ea6SMark Brown 			     int source, unsigned int freq, int dir)
3565ec4ee52aSMark Brown {
3566ec4ee52aSMark Brown 	if (codec->driver->set_sysclk)
3567da1c6ea6SMark Brown 		return codec->driver->set_sysclk(codec, clk_id, source,
3568da1c6ea6SMark Brown 						 freq, dir);
3569ec4ee52aSMark Brown 	else
35701104a9c8SMark Brown 		return -ENOTSUPP;
3571ec4ee52aSMark Brown }
3572ec4ee52aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_codec_set_sysclk);
3573ec4ee52aSMark Brown 
3574ec4ee52aSMark Brown /**
35758c6529dbSLiam Girdwood  * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
35768c6529dbSLiam Girdwood  * @dai: DAI
3577ac11a2b3SMark Brown  * @div_id: DAI specific clock divider ID
35788c6529dbSLiam Girdwood  * @div: new clock divisor.
35798c6529dbSLiam Girdwood  *
35808c6529dbSLiam Girdwood  * Configures the clock dividers. This is used to derive the best DAI bit and
35818c6529dbSLiam Girdwood  * frame clocks from the system or master clock. It's best to set the DAI bit
35828c6529dbSLiam Girdwood  * and frame clocks as low as possible to save system power.
35838c6529dbSLiam Girdwood  */
35848c6529dbSLiam Girdwood int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
35858c6529dbSLiam Girdwood 	int div_id, int div)
35868c6529dbSLiam Girdwood {
3587f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_clkdiv)
3588f0fba2adSLiam Girdwood 		return dai->driver->ops->set_clkdiv(dai, div_id, div);
35898c6529dbSLiam Girdwood 	else
35908c6529dbSLiam Girdwood 		return -EINVAL;
35918c6529dbSLiam Girdwood }
35928c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv);
35938c6529dbSLiam Girdwood 
35948c6529dbSLiam Girdwood /**
35958c6529dbSLiam Girdwood  * snd_soc_dai_set_pll - configure DAI PLL.
35968c6529dbSLiam Girdwood  * @dai: DAI
35978c6529dbSLiam Girdwood  * @pll_id: DAI specific PLL ID
359885488037SMark Brown  * @source: DAI specific source for the PLL
35998c6529dbSLiam Girdwood  * @freq_in: PLL input clock frequency in Hz
36008c6529dbSLiam Girdwood  * @freq_out: requested PLL output clock frequency in Hz
36018c6529dbSLiam Girdwood  *
36028c6529dbSLiam Girdwood  * Configures and enables PLL to generate output clock based on input clock.
36038c6529dbSLiam Girdwood  */
360485488037SMark Brown int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
360585488037SMark Brown 	unsigned int freq_in, unsigned int freq_out)
36068c6529dbSLiam Girdwood {
3607f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_pll)
3608f0fba2adSLiam Girdwood 		return dai->driver->ops->set_pll(dai, pll_id, source,
360985488037SMark Brown 					 freq_in, freq_out);
3610ec4ee52aSMark Brown 	else if (dai->codec && dai->codec->driver->set_pll)
3611ec4ee52aSMark Brown 		return dai->codec->driver->set_pll(dai->codec, pll_id, source,
3612ec4ee52aSMark Brown 						   freq_in, freq_out);
36138c6529dbSLiam Girdwood 	else
36148c6529dbSLiam Girdwood 		return -EINVAL;
36158c6529dbSLiam Girdwood }
36168c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
36178c6529dbSLiam Girdwood 
3618ec4ee52aSMark Brown /*
3619ec4ee52aSMark Brown  * snd_soc_codec_set_pll - configure codec PLL.
3620ec4ee52aSMark Brown  * @codec: CODEC
3621ec4ee52aSMark Brown  * @pll_id: DAI specific PLL ID
3622ec4ee52aSMark Brown  * @source: DAI specific source for the PLL
3623ec4ee52aSMark Brown  * @freq_in: PLL input clock frequency in Hz
3624ec4ee52aSMark Brown  * @freq_out: requested PLL output clock frequency in Hz
3625ec4ee52aSMark Brown  *
3626ec4ee52aSMark Brown  * Configures and enables PLL to generate output clock based on input clock.
3627ec4ee52aSMark Brown  */
3628ec4ee52aSMark Brown int snd_soc_codec_set_pll(struct snd_soc_codec *codec, int pll_id, int source,
3629ec4ee52aSMark Brown 			  unsigned int freq_in, unsigned int freq_out)
3630ec4ee52aSMark Brown {
3631ec4ee52aSMark Brown 	if (codec->driver->set_pll)
3632ec4ee52aSMark Brown 		return codec->driver->set_pll(codec, pll_id, source,
3633ec4ee52aSMark Brown 					      freq_in, freq_out);
3634ec4ee52aSMark Brown 	else
3635ec4ee52aSMark Brown 		return -EINVAL;
3636ec4ee52aSMark Brown }
3637ec4ee52aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_codec_set_pll);
3638ec4ee52aSMark Brown 
36398c6529dbSLiam Girdwood /**
3640e54cf76bSLiam Girdwood  * snd_soc_dai_set_bclk_ratio - configure BCLK to sample rate ratio.
3641e54cf76bSLiam Girdwood  * @dai: DAI
3642e54cf76bSLiam Girdwood  * @ratio Ratio of BCLK to Sample rate.
3643e54cf76bSLiam Girdwood  *
3644e54cf76bSLiam Girdwood  * Configures the DAI for a preset BCLK to sample rate ratio.
3645e54cf76bSLiam Girdwood  */
3646e54cf76bSLiam Girdwood int snd_soc_dai_set_bclk_ratio(struct snd_soc_dai *dai, unsigned int ratio)
3647e54cf76bSLiam Girdwood {
3648e54cf76bSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_bclk_ratio)
3649e54cf76bSLiam Girdwood 		return dai->driver->ops->set_bclk_ratio(dai, ratio);
3650e54cf76bSLiam Girdwood 	else
3651e54cf76bSLiam Girdwood 		return -EINVAL;
3652e54cf76bSLiam Girdwood }
3653e54cf76bSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_bclk_ratio);
3654e54cf76bSLiam Girdwood 
3655e54cf76bSLiam Girdwood /**
36568c6529dbSLiam Girdwood  * snd_soc_dai_set_fmt - configure DAI hardware audio format.
36578c6529dbSLiam Girdwood  * @dai: DAI
36588c6529dbSLiam Girdwood  * @fmt: SND_SOC_DAIFMT_ format value.
36598c6529dbSLiam Girdwood  *
36608c6529dbSLiam Girdwood  * Configures the DAI hardware format and clocking.
36618c6529dbSLiam Girdwood  */
36628c6529dbSLiam Girdwood int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
36638c6529dbSLiam Girdwood {
36645e4ba569SShawn Guo 	if (dai->driver == NULL)
36658c6529dbSLiam Girdwood 		return -EINVAL;
36665e4ba569SShawn Guo 	if (dai->driver->ops->set_fmt == NULL)
36675e4ba569SShawn Guo 		return -ENOTSUPP;
36685e4ba569SShawn Guo 	return dai->driver->ops->set_fmt(dai, fmt);
36698c6529dbSLiam Girdwood }
36708c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
36718c6529dbSLiam Girdwood 
36728c6529dbSLiam Girdwood /**
3673e5c21514SXiubo Li  * snd_soc_xlate_tdm_slot - generate tx/rx slot mask.
367489c67857SXiubo Li  * @slots: Number of slots in use.
367589c67857SXiubo Li  * @tx_mask: bitmask representing active TX slots.
367689c67857SXiubo Li  * @rx_mask: bitmask representing active RX slots.
367789c67857SXiubo Li  *
367889c67857SXiubo Li  * Generates the TDM tx and rx slot default masks for DAI.
367989c67857SXiubo Li  */
3680e5c21514SXiubo Li static int snd_soc_xlate_tdm_slot_mask(unsigned int slots,
368189c67857SXiubo Li 					  unsigned int *tx_mask,
368289c67857SXiubo Li 					  unsigned int *rx_mask)
368389c67857SXiubo Li {
368489c67857SXiubo Li 	if (*tx_mask || *rx_mask)
368589c67857SXiubo Li 		return 0;
368689c67857SXiubo Li 
368789c67857SXiubo Li 	if (!slots)
368889c67857SXiubo Li 		return -EINVAL;
368989c67857SXiubo Li 
369089c67857SXiubo Li 	*tx_mask = (1 << slots) - 1;
369189c67857SXiubo Li 	*rx_mask = (1 << slots) - 1;
369289c67857SXiubo Li 
369389c67857SXiubo Li 	return 0;
369489c67857SXiubo Li }
369589c67857SXiubo Li 
369689c67857SXiubo Li /**
36978c6529dbSLiam Girdwood  * snd_soc_dai_set_tdm_slot - configure DAI TDM.
36988c6529dbSLiam Girdwood  * @dai: DAI
3699a5479e38SDaniel Ribeiro  * @tx_mask: bitmask representing active TX slots.
3700a5479e38SDaniel Ribeiro  * @rx_mask: bitmask representing active RX slots.
37018c6529dbSLiam Girdwood  * @slots: Number of slots in use.
3702a5479e38SDaniel Ribeiro  * @slot_width: Width in bits for each slot.
37038c6529dbSLiam Girdwood  *
37048c6529dbSLiam Girdwood  * Configures a DAI for TDM operation. Both mask and slots are codec and DAI
37058c6529dbSLiam Girdwood  * specific.
37068c6529dbSLiam Girdwood  */
37078c6529dbSLiam Girdwood int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
3708a5479e38SDaniel Ribeiro 	unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
37098c6529dbSLiam Girdwood {
3710e5c21514SXiubo Li 	if (dai->driver && dai->driver->ops->xlate_tdm_slot_mask)
3711e5c21514SXiubo Li 		dai->driver->ops->xlate_tdm_slot_mask(slots,
371289c67857SXiubo Li 						&tx_mask, &rx_mask);
371389c67857SXiubo Li 	else
3714e5c21514SXiubo Li 		snd_soc_xlate_tdm_slot_mask(slots, &tx_mask, &rx_mask);
371589c67857SXiubo Li 
3716f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_tdm_slot)
3717f0fba2adSLiam Girdwood 		return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask,
3718a5479e38SDaniel Ribeiro 				slots, slot_width);
37198c6529dbSLiam Girdwood 	else
3720b2cbb6e1SXiubo Li 		return -ENOTSUPP;
37218c6529dbSLiam Girdwood }
37228c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
37238c6529dbSLiam Girdwood 
37248c6529dbSLiam Girdwood /**
3725472df3cbSBarry Song  * snd_soc_dai_set_channel_map - configure DAI audio channel map
3726472df3cbSBarry Song  * @dai: DAI
3727472df3cbSBarry Song  * @tx_num: how many TX channels
3728472df3cbSBarry Song  * @tx_slot: pointer to an array which imply the TX slot number channel
3729472df3cbSBarry Song  *           0~num-1 uses
3730472df3cbSBarry Song  * @rx_num: how many RX channels
3731472df3cbSBarry Song  * @rx_slot: pointer to an array which imply the RX slot number channel
3732472df3cbSBarry Song  *           0~num-1 uses
3733472df3cbSBarry Song  *
3734472df3cbSBarry Song  * configure the relationship between channel number and TDM slot number.
3735472df3cbSBarry Song  */
3736472df3cbSBarry Song int snd_soc_dai_set_channel_map(struct snd_soc_dai *dai,
3737472df3cbSBarry Song 	unsigned int tx_num, unsigned int *tx_slot,
3738472df3cbSBarry Song 	unsigned int rx_num, unsigned int *rx_slot)
3739472df3cbSBarry Song {
3740f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_channel_map)
3741f0fba2adSLiam Girdwood 		return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot,
3742472df3cbSBarry Song 			rx_num, rx_slot);
3743472df3cbSBarry Song 	else
3744472df3cbSBarry Song 		return -EINVAL;
3745472df3cbSBarry Song }
3746472df3cbSBarry Song EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map);
3747472df3cbSBarry Song 
3748472df3cbSBarry Song /**
37498c6529dbSLiam Girdwood  * snd_soc_dai_set_tristate - configure DAI system or master clock.
37508c6529dbSLiam Girdwood  * @dai: DAI
37518c6529dbSLiam Girdwood  * @tristate: tristate enable
37528c6529dbSLiam Girdwood  *
37538c6529dbSLiam Girdwood  * Tristates the DAI so that others can use it.
37548c6529dbSLiam Girdwood  */
37558c6529dbSLiam Girdwood int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
37568c6529dbSLiam Girdwood {
3757f0fba2adSLiam Girdwood 	if (dai->driver && dai->driver->ops->set_tristate)
3758f0fba2adSLiam Girdwood 		return dai->driver->ops->set_tristate(dai, tristate);
37598c6529dbSLiam Girdwood 	else
37608c6529dbSLiam Girdwood 		return -EINVAL;
37618c6529dbSLiam Girdwood }
37628c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate);
37638c6529dbSLiam Girdwood 
37648c6529dbSLiam Girdwood /**
37658c6529dbSLiam Girdwood  * snd_soc_dai_digital_mute - configure DAI system or master clock.
37668c6529dbSLiam Girdwood  * @dai: DAI
37678c6529dbSLiam Girdwood  * @mute: mute enable
3768da18396fSMark Brown  * @direction: stream to mute
37698c6529dbSLiam Girdwood  *
37708c6529dbSLiam Girdwood  * Mutes the DAI DAC.
37718c6529dbSLiam Girdwood  */
3772da18396fSMark Brown int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute,
3773da18396fSMark Brown 			     int direction)
37748c6529dbSLiam Girdwood {
3775da18396fSMark Brown 	if (!dai->driver)
3776da18396fSMark Brown 		return -ENOTSUPP;
3777da18396fSMark Brown 
3778da18396fSMark Brown 	if (dai->driver->ops->mute_stream)
3779da18396fSMark Brown 		return dai->driver->ops->mute_stream(dai, mute, direction);
3780da18396fSMark Brown 	else if (direction == SNDRV_PCM_STREAM_PLAYBACK &&
3781da18396fSMark Brown 		 dai->driver->ops->digital_mute)
3782f0fba2adSLiam Girdwood 		return dai->driver->ops->digital_mute(dai, mute);
37838c6529dbSLiam Girdwood 	else
378404570c62SMark Brown 		return -ENOTSUPP;
37858c6529dbSLiam Girdwood }
37868c6529dbSLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
37878c6529dbSLiam Girdwood 
3788c5af3a2eSMark Brown /**
3789c5af3a2eSMark Brown  * snd_soc_register_card - Register a card with the ASoC core
3790c5af3a2eSMark Brown  *
3791ac11a2b3SMark Brown  * @card: Card to register
3792c5af3a2eSMark Brown  *
3793c5af3a2eSMark Brown  */
379470a7ca34SVinod Koul int snd_soc_register_card(struct snd_soc_card *card)
3795c5af3a2eSMark Brown {
3796b19e6e7bSMark Brown 	int i, ret;
3797f0fba2adSLiam Girdwood 
3798c5af3a2eSMark Brown 	if (!card->name || !card->dev)
3799c5af3a2eSMark Brown 		return -EINVAL;
3800c5af3a2eSMark Brown 
38015a504963SStephen Warren 	for (i = 0; i < card->num_links; i++) {
38025a504963SStephen Warren 		struct snd_soc_dai_link *link = &card->dai_link[i];
38035a504963SStephen Warren 
38045a504963SStephen Warren 		/*
38055a504963SStephen Warren 		 * Codec must be specified by 1 of name or OF node,
38065a504963SStephen Warren 		 * not both or neither.
38075a504963SStephen Warren 		 */
38085a504963SStephen Warren 		if (!!link->codec_name == !!link->codec_of_node) {
380910e8aa9aSMichał Mirosław 			dev_err(card->dev,
381010e8aa9aSMichał Mirosław 				"ASoC: Neither/both codec name/of_node are set for %s\n",
381110e8aa9aSMichał Mirosław 				link->name);
38125a504963SStephen Warren 			return -EINVAL;
38135a504963SStephen Warren 		}
3814bc92657aSStephen Warren 		/* Codec DAI name must be specified */
3815bc92657aSStephen Warren 		if (!link->codec_dai_name) {
381610e8aa9aSMichał Mirosław 			dev_err(card->dev,
381710e8aa9aSMichał Mirosław 				"ASoC: codec_dai_name not set for %s\n",
381810e8aa9aSMichał Mirosław 				link->name);
3819bc92657aSStephen Warren 			return -EINVAL;
3820bc92657aSStephen Warren 		}
38215a504963SStephen Warren 
38225a504963SStephen Warren 		/*
38235a504963SStephen Warren 		 * Platform may be specified by either name or OF node, but
38245a504963SStephen Warren 		 * can be left unspecified, and a dummy platform will be used.
38255a504963SStephen Warren 		 */
38265a504963SStephen Warren 		if (link->platform_name && link->platform_of_node) {
382710e8aa9aSMichał Mirosław 			dev_err(card->dev,
382810e8aa9aSMichał Mirosław 				"ASoC: Both platform name/of_node are set for %s\n",
382910e8aa9aSMichał Mirosław 				link->name);
38305a504963SStephen Warren 			return -EINVAL;
38315a504963SStephen Warren 		}
38325a504963SStephen Warren 
38335a504963SStephen Warren 		/*
3834bc92657aSStephen Warren 		 * CPU device may be specified by either name or OF node, but
3835bc92657aSStephen Warren 		 * can be left unspecified, and will be matched based on DAI
3836bc92657aSStephen Warren 		 * name alone..
38375a504963SStephen Warren 		 */
3838bc92657aSStephen Warren 		if (link->cpu_name && link->cpu_of_node) {
383910e8aa9aSMichał Mirosław 			dev_err(card->dev,
384010e8aa9aSMichał Mirosław 				"ASoC: Neither/both cpu name/of_node are set for %s\n",
384110e8aa9aSMichał Mirosław 				link->name);
3842bc92657aSStephen Warren 			return -EINVAL;
3843bc92657aSStephen Warren 		}
3844bc92657aSStephen Warren 		/*
3845bc92657aSStephen Warren 		 * At least one of CPU DAI name or CPU device name/node must be
3846bc92657aSStephen Warren 		 * specified
3847bc92657aSStephen Warren 		 */
3848bc92657aSStephen Warren 		if (!link->cpu_dai_name &&
3849bc92657aSStephen Warren 		    !(link->cpu_name || link->cpu_of_node)) {
385010e8aa9aSMichał Mirosław 			dev_err(card->dev,
385110e8aa9aSMichał Mirosław 				"ASoC: Neither cpu_dai_name nor cpu_name/of_node are set for %s\n",
385210e8aa9aSMichał Mirosław 				link->name);
38535a504963SStephen Warren 			return -EINVAL;
38545a504963SStephen Warren 		}
38555a504963SStephen Warren 	}
38565a504963SStephen Warren 
3857ed77cc12SMark Brown 	dev_set_drvdata(card->dev, card);
3858ed77cc12SMark Brown 
3859111c6419SStephen Warren 	snd_soc_initialize_card_lists(card);
3860111c6419SStephen Warren 
3861150dd2f8SVinod Koul 	soc_init_card_debugfs(card);
3862150dd2f8SVinod Koul 
3863181a6892SMark Brown 	card->rtd = devm_kzalloc(card->dev,
3864181a6892SMark Brown 				 sizeof(struct snd_soc_pcm_runtime) *
38652eea392dSJarkko Nikula 				 (card->num_links + card->num_aux_devs),
3866f0fba2adSLiam Girdwood 				 GFP_KERNEL);
3867f0fba2adSLiam Girdwood 	if (card->rtd == NULL)
3868f0fba2adSLiam Girdwood 		return -ENOMEM;
3869a7dbb603SLiam Girdwood 	card->num_rtd = 0;
38702eea392dSJarkko Nikula 	card->rtd_aux = &card->rtd[card->num_links];
3871f0fba2adSLiam Girdwood 
3872f0fba2adSLiam Girdwood 	for (i = 0; i < card->num_links; i++)
3873f0fba2adSLiam Girdwood 		card->rtd[i].dai_link = &card->dai_link[i];
3874f0fba2adSLiam Girdwood 
3875c5af3a2eSMark Brown 	INIT_LIST_HEAD(&card->list);
3876db432b41SMark Brown 	INIT_LIST_HEAD(&card->dapm_dirty);
3877c5af3a2eSMark Brown 	card->instantiated = 0;
3878f0fba2adSLiam Girdwood 	mutex_init(&card->mutex);
3879a73fb2dfSLiam Girdwood 	mutex_init(&card->dapm_mutex);
3880c5af3a2eSMark Brown 
3881b19e6e7bSMark Brown 	ret = snd_soc_instantiate_card(card);
3882b19e6e7bSMark Brown 	if (ret != 0)
3883b19e6e7bSMark Brown 		soc_cleanup_card_debugfs(card);
3884c5af3a2eSMark Brown 
3885988e8cc4SNicolin Chen 	/* deactivate pins to sleep state */
3886988e8cc4SNicolin Chen 	for (i = 0; i < card->num_rtd; i++) {
3887988e8cc4SNicolin Chen 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
3888988e8cc4SNicolin Chen 		struct snd_soc_dai *codec_dai = card->rtd[i].codec_dai;
3889988e8cc4SNicolin Chen 		if (!codec_dai->active)
3890988e8cc4SNicolin Chen 			pinctrl_pm_select_sleep_state(codec_dai->dev);
3891988e8cc4SNicolin Chen 		if (!cpu_dai->active)
3892988e8cc4SNicolin Chen 			pinctrl_pm_select_sleep_state(cpu_dai->dev);
3893988e8cc4SNicolin Chen 	}
3894988e8cc4SNicolin Chen 
3895b19e6e7bSMark Brown 	return ret;
3896c5af3a2eSMark Brown }
389770a7ca34SVinod Koul EXPORT_SYMBOL_GPL(snd_soc_register_card);
3898c5af3a2eSMark Brown 
3899c5af3a2eSMark Brown /**
3900c5af3a2eSMark Brown  * snd_soc_unregister_card - Unregister a card with the ASoC core
3901c5af3a2eSMark Brown  *
3902ac11a2b3SMark Brown  * @card: Card to unregister
3903c5af3a2eSMark Brown  *
3904c5af3a2eSMark Brown  */
390570a7ca34SVinod Koul int snd_soc_unregister_card(struct snd_soc_card *card)
3906c5af3a2eSMark Brown {
3907b0e26485SVinod Koul 	if (card->instantiated)
3908b0e26485SVinod Koul 		soc_cleanup_card_resources(card);
3909f110bfc7SLiam Girdwood 	dev_dbg(card->dev, "ASoC: Unregistered card '%s'\n", card->name);
3910c5af3a2eSMark Brown 
3911c5af3a2eSMark Brown 	return 0;
3912c5af3a2eSMark Brown }
391370a7ca34SVinod Koul EXPORT_SYMBOL_GPL(snd_soc_unregister_card);
3914c5af3a2eSMark Brown 
3915f0fba2adSLiam Girdwood /*
3916f0fba2adSLiam Girdwood  * Simplify DAI link configuration by removing ".-1" from device names
3917f0fba2adSLiam Girdwood  * and sanitizing names.
3918f0fba2adSLiam Girdwood  */
39190b9a214aSDimitris Papastamos static char *fmt_single_name(struct device *dev, int *id)
3920f0fba2adSLiam Girdwood {
3921f0fba2adSLiam Girdwood 	char *found, name[NAME_SIZE];
3922f0fba2adSLiam Girdwood 	int id1, id2;
3923f0fba2adSLiam Girdwood 
3924f0fba2adSLiam Girdwood 	if (dev_name(dev) == NULL)
3925f0fba2adSLiam Girdwood 		return NULL;
3926f0fba2adSLiam Girdwood 
392758818a77SDimitris Papastamos 	strlcpy(name, dev_name(dev), NAME_SIZE);
3928f0fba2adSLiam Girdwood 
3929f0fba2adSLiam Girdwood 	/* are we a "%s.%d" name (platform and SPI components) */
3930f0fba2adSLiam Girdwood 	found = strstr(name, dev->driver->name);
3931f0fba2adSLiam Girdwood 	if (found) {
3932f0fba2adSLiam Girdwood 		/* get ID */
3933f0fba2adSLiam Girdwood 		if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) {
3934f0fba2adSLiam Girdwood 
3935f0fba2adSLiam Girdwood 			/* discard ID from name if ID == -1 */
3936f0fba2adSLiam Girdwood 			if (*id == -1)
3937f0fba2adSLiam Girdwood 				found[strlen(dev->driver->name)] = '\0';
3938f0fba2adSLiam Girdwood 		}
3939f0fba2adSLiam Girdwood 
3940f0fba2adSLiam Girdwood 	} else {
3941f0fba2adSLiam Girdwood 		/* I2C component devices are named "bus-addr"  */
3942f0fba2adSLiam Girdwood 		if (sscanf(name, "%x-%x", &id1, &id2) == 2) {
3943f0fba2adSLiam Girdwood 			char tmp[NAME_SIZE];
3944f0fba2adSLiam Girdwood 
3945f0fba2adSLiam Girdwood 			/* create unique ID number from I2C addr and bus */
394605899446SJarkko Nikula 			*id = ((id1 & 0xffff) << 16) + id2;
3947f0fba2adSLiam Girdwood 
3948f0fba2adSLiam Girdwood 			/* sanitize component name for DAI link creation */
3949f0fba2adSLiam Girdwood 			snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name);
395058818a77SDimitris Papastamos 			strlcpy(name, tmp, NAME_SIZE);
3951f0fba2adSLiam Girdwood 		} else
3952f0fba2adSLiam Girdwood 			*id = 0;
3953f0fba2adSLiam Girdwood 	}
3954f0fba2adSLiam Girdwood 
3955f0fba2adSLiam Girdwood 	return kstrdup(name, GFP_KERNEL);
3956f0fba2adSLiam Girdwood }
3957f0fba2adSLiam Girdwood 
3958f0fba2adSLiam Girdwood /*
3959f0fba2adSLiam Girdwood  * Simplify DAI link naming for single devices with multiple DAIs by removing
3960f0fba2adSLiam Girdwood  * any ".-1" and using the DAI name (instead of device name).
3961f0fba2adSLiam Girdwood  */
3962f0fba2adSLiam Girdwood static inline char *fmt_multiple_name(struct device *dev,
3963f0fba2adSLiam Girdwood 		struct snd_soc_dai_driver *dai_drv)
3964f0fba2adSLiam Girdwood {
3965f0fba2adSLiam Girdwood 	if (dai_drv->name == NULL) {
396610e8aa9aSMichał Mirosław 		dev_err(dev,
396710e8aa9aSMichał Mirosław 			"ASoC: error - multiple DAI %s registered with no name\n",
396810e8aa9aSMichał Mirosław 			dev_name(dev));
3969f0fba2adSLiam Girdwood 		return NULL;
3970f0fba2adSLiam Girdwood 	}
3971f0fba2adSLiam Girdwood 
3972f0fba2adSLiam Girdwood 	return kstrdup(dai_drv->name, GFP_KERNEL);
3973f0fba2adSLiam Girdwood }
3974f0fba2adSLiam Girdwood 
39759115171aSMark Brown /**
397632c9ba54SLars-Peter Clausen  * snd_soc_unregister_dai - Unregister DAIs from the ASoC core
39779115171aSMark Brown  *
397832c9ba54SLars-Peter Clausen  * @component: The component for which the DAIs should be unregistered
39799115171aSMark Brown  */
398032c9ba54SLars-Peter Clausen static void snd_soc_unregister_dais(struct snd_soc_component *component)
39819115171aSMark Brown {
39825c1d5f09SLars-Peter Clausen 	struct snd_soc_dai *dai, *_dai;
39839115171aSMark Brown 
39845c1d5f09SLars-Peter Clausen 	list_for_each_entry_safe(dai, _dai, &component->dai_list, list) {
398532c9ba54SLars-Peter Clausen 		dev_dbg(component->dev, "ASoC: Unregistered DAI '%s'\n",
398632c9ba54SLars-Peter Clausen 			dai->name);
39879115171aSMark Brown 		list_del(&dai->list);
3988f0fba2adSLiam Girdwood 		kfree(dai->name);
3989f0fba2adSLiam Girdwood 		kfree(dai);
39909115171aSMark Brown 	}
399132c9ba54SLars-Peter Clausen }
39929115171aSMark Brown 
39939115171aSMark Brown /**
399432c9ba54SLars-Peter Clausen  * snd_soc_register_dais - Register a DAI with the ASoC core
39959115171aSMark Brown  *
39966106d129SLars-Peter Clausen  * @component: The component the DAIs are registered for
39976cc240f3SLars-Peter Clausen  * @codec: The CODEC that the DAIs are registered for, NULL if the component is
39986cc240f3SLars-Peter Clausen  *         not a CODEC.
39996106d129SLars-Peter Clausen  * @dai_drv: DAI driver to use for the DAIs
4000ac11a2b3SMark Brown  * @count: Number of DAIs
400132c9ba54SLars-Peter Clausen  * @legacy_dai_naming: Use the legacy naming scheme and let the DAI inherit the
400232c9ba54SLars-Peter Clausen  *                     parent's name.
40039115171aSMark Brown  */
400432c9ba54SLars-Peter Clausen static int snd_soc_register_dais(struct snd_soc_component *component,
40056cc240f3SLars-Peter Clausen 	struct snd_soc_codec *codec, struct snd_soc_dai_driver *dai_drv,
40066cc240f3SLars-Peter Clausen 	size_t count, bool legacy_dai_naming)
40079115171aSMark Brown {
40086106d129SLars-Peter Clausen 	struct device *dev = component->dev;
4009f0fba2adSLiam Girdwood 	struct snd_soc_dai *dai;
401032c9ba54SLars-Peter Clausen 	unsigned int i;
401132c9ba54SLars-Peter Clausen 	int ret;
4012f0fba2adSLiam Girdwood 
4013f110bfc7SLiam Girdwood 	dev_dbg(dev, "ASoC: dai register %s #%Zu\n", dev_name(dev), count);
40149115171aSMark Brown 
40159115171aSMark Brown 	for (i = 0; i < count; i++) {
4016f0fba2adSLiam Girdwood 
4017f0fba2adSLiam Girdwood 		dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
4018c46e0079SAxel Lin 		if (dai == NULL) {
4019c46e0079SAxel Lin 			ret = -ENOMEM;
4020c46e0079SAxel Lin 			goto err;
4021c46e0079SAxel Lin 		}
4022f0fba2adSLiam Girdwood 
402332c9ba54SLars-Peter Clausen 		/*
402432c9ba54SLars-Peter Clausen 		 * Back in the old days when we still had component-less DAIs,
402532c9ba54SLars-Peter Clausen 		 * instead of having a static name, component-less DAIs would
402632c9ba54SLars-Peter Clausen 		 * inherit the name of the parent device so it is possible to
402732c9ba54SLars-Peter Clausen 		 * register multiple instances of the DAI. We still need to keep
402832c9ba54SLars-Peter Clausen 		 * the same naming style even though those DAIs are not
402932c9ba54SLars-Peter Clausen 		 * component-less anymore.
403032c9ba54SLars-Peter Clausen 		 */
403132c9ba54SLars-Peter Clausen 		if (count == 1 && legacy_dai_naming) {
4032db2a4165SFrank Mandarino 			dai->name = fmt_single_name(dev, &dai->id);
403332c9ba54SLars-Peter Clausen 		} else {
4034f0fba2adSLiam Girdwood 			dai->name = fmt_multiple_name(dev, &dai_drv[i]);
403532c9ba54SLars-Peter Clausen 			if (dai_drv[i].id)
403632c9ba54SLars-Peter Clausen 				dai->id = dai_drv[i].id;
403732c9ba54SLars-Peter Clausen 			else
403832c9ba54SLars-Peter Clausen 				dai->id = i;
403932c9ba54SLars-Peter Clausen 		}
4040f0fba2adSLiam Girdwood 		if (dai->name == NULL) {
4041f0fba2adSLiam Girdwood 			kfree(dai);
404232c9ba54SLars-Peter Clausen 			ret = -ENOMEM;
40439115171aSMark Brown 			goto err;
40449115171aSMark Brown 		}
40459115171aSMark Brown 
40466106d129SLars-Peter Clausen 		dai->component = component;
40476cc240f3SLars-Peter Clausen 		dai->codec = codec;
4048f0fba2adSLiam Girdwood 		dai->dev = dev;
4049f0fba2adSLiam Girdwood 		dai->driver = &dai_drv[i];
4050be09ad90SLiam Girdwood 		dai->dapm.dev = dev;
4051f0fba2adSLiam Girdwood 		if (!dai->driver->ops)
4052f0fba2adSLiam Girdwood 			dai->driver->ops = &null_dai_ops;
4053f0fba2adSLiam Girdwood 
40545f800080SPeter Ujfalusi 		if (!dai->codec)
40555f800080SPeter Ujfalusi 			dai->dapm.idle_bias_off = 1;
40565f800080SPeter Ujfalusi 
40571438c2f6SLars-Peter Clausen 		list_add(&dai->list, &component->dai_list);
4058054880feSMark Brown 
40599115171aSMark Brown 		dev_dbg(dev, "ASoC: Registered DAI '%s'\n", dai->name);
4060f0fba2adSLiam Girdwood 	}
4061f0fba2adSLiam Girdwood 
40629115171aSMark Brown 	return 0;
40639115171aSMark Brown 
40649115171aSMark Brown err:
406532c9ba54SLars-Peter Clausen 	snd_soc_unregister_dais(component);
40669115171aSMark Brown 
40679115171aSMark Brown 	return ret;
40689115171aSMark Brown }
40699115171aSMark Brown 
40709115171aSMark Brown /**
4071d191bd8dSKuninori Morimoto  * snd_soc_register_component - Register a component with the ASoC core
4072d191bd8dSKuninori Morimoto  *
4073d191bd8dSKuninori Morimoto  */
4074d191bd8dSKuninori Morimoto static int
4075d191bd8dSKuninori Morimoto __snd_soc_register_component(struct device *dev,
4076d191bd8dSKuninori Morimoto 			     struct snd_soc_component *cmpnt,
4077d191bd8dSKuninori Morimoto 			     const struct snd_soc_component_driver *cmpnt_drv,
40786cc240f3SLars-Peter Clausen 			     struct snd_soc_codec *codec,
4079d191bd8dSKuninori Morimoto 			     struct snd_soc_dai_driver *dai_drv,
4080d191bd8dSKuninori Morimoto 			     int num_dai, bool allow_single_dai)
4081d191bd8dSKuninori Morimoto {
4082d191bd8dSKuninori Morimoto 	int ret;
4083d191bd8dSKuninori Morimoto 
4084d191bd8dSKuninori Morimoto 	dev_dbg(dev, "component register %s\n", dev_name(dev));
4085d191bd8dSKuninori Morimoto 
4086d191bd8dSKuninori Morimoto 	if (!cmpnt) {
4087d191bd8dSKuninori Morimoto 		dev_err(dev, "ASoC: Failed to connecting component\n");
4088d191bd8dSKuninori Morimoto 		return -ENOMEM;
4089d191bd8dSKuninori Morimoto 	}
4090d191bd8dSKuninori Morimoto 
4091d191bd8dSKuninori Morimoto 	cmpnt->name = fmt_single_name(dev, &cmpnt->id);
4092d191bd8dSKuninori Morimoto 	if (!cmpnt->name) {
4093d191bd8dSKuninori Morimoto 		dev_err(dev, "ASoC: Failed to simplifying name\n");
4094d191bd8dSKuninori Morimoto 		return -ENOMEM;
4095d191bd8dSKuninori Morimoto 	}
4096d191bd8dSKuninori Morimoto 
4097d191bd8dSKuninori Morimoto 	cmpnt->dev	= dev;
4098d191bd8dSKuninori Morimoto 	cmpnt->driver	= cmpnt_drv;
40996833c452SKuninori Morimoto 	cmpnt->dai_drv	= dai_drv;
4100d191bd8dSKuninori Morimoto 	cmpnt->num_dai	= num_dai;
41011438c2f6SLars-Peter Clausen 	INIT_LIST_HEAD(&cmpnt->dai_list);
4102d191bd8dSKuninori Morimoto 
41036cc240f3SLars-Peter Clausen 	ret = snd_soc_register_dais(cmpnt, codec, dai_drv, num_dai,
41046cc240f3SLars-Peter Clausen 		allow_single_dai);
4105d191bd8dSKuninori Morimoto 	if (ret < 0) {
4106d191bd8dSKuninori Morimoto 		dev_err(dev, "ASoC: Failed to regster DAIs: %d\n", ret);
4107d191bd8dSKuninori Morimoto 		goto error_component_name;
4108d191bd8dSKuninori Morimoto 	}
4109d191bd8dSKuninori Morimoto 
4110d191bd8dSKuninori Morimoto 	mutex_lock(&client_mutex);
4111d191bd8dSKuninori Morimoto 	list_add(&cmpnt->list, &component_list);
4112d191bd8dSKuninori Morimoto 	mutex_unlock(&client_mutex);
4113d191bd8dSKuninori Morimoto 
4114d191bd8dSKuninori Morimoto 	dev_dbg(cmpnt->dev, "ASoC: Registered component '%s'\n", cmpnt->name);
4115d191bd8dSKuninori Morimoto 
4116d191bd8dSKuninori Morimoto 	return ret;
4117d191bd8dSKuninori Morimoto 
4118d191bd8dSKuninori Morimoto error_component_name:
4119d191bd8dSKuninori Morimoto 	kfree(cmpnt->name);
4120d191bd8dSKuninori Morimoto 
4121d191bd8dSKuninori Morimoto 	return ret;
4122d191bd8dSKuninori Morimoto }
4123d191bd8dSKuninori Morimoto 
4124d191bd8dSKuninori Morimoto int snd_soc_register_component(struct device *dev,
4125d191bd8dSKuninori Morimoto 			       const struct snd_soc_component_driver *cmpnt_drv,
4126d191bd8dSKuninori Morimoto 			       struct snd_soc_dai_driver *dai_drv,
4127d191bd8dSKuninori Morimoto 			       int num_dai)
4128d191bd8dSKuninori Morimoto {
4129d191bd8dSKuninori Morimoto 	struct snd_soc_component *cmpnt;
4130d191bd8dSKuninori Morimoto 
4131d191bd8dSKuninori Morimoto 	cmpnt = devm_kzalloc(dev, sizeof(*cmpnt), GFP_KERNEL);
4132d191bd8dSKuninori Morimoto 	if (!cmpnt) {
4133d191bd8dSKuninori Morimoto 		dev_err(dev, "ASoC: Failed to allocate memory\n");
4134d191bd8dSKuninori Morimoto 		return -ENOMEM;
4135d191bd8dSKuninori Morimoto 	}
4136d191bd8dSKuninori Morimoto 
41373d59400fSLars-Peter Clausen 	cmpnt->ignore_pmdown_time = true;
41383d59400fSLars-Peter Clausen 
41396cc240f3SLars-Peter Clausen 	return __snd_soc_register_component(dev, cmpnt, cmpnt_drv, NULL,
4140d191bd8dSKuninori Morimoto 					    dai_drv, num_dai, true);
4141d191bd8dSKuninori Morimoto }
4142d191bd8dSKuninori Morimoto EXPORT_SYMBOL_GPL(snd_soc_register_component);
4143d191bd8dSKuninori Morimoto 
4144d191bd8dSKuninori Morimoto /**
4145d191bd8dSKuninori Morimoto  * snd_soc_unregister_component - Unregister a component from the ASoC core
4146d191bd8dSKuninori Morimoto  *
4147d191bd8dSKuninori Morimoto  */
4148d191bd8dSKuninori Morimoto void snd_soc_unregister_component(struct device *dev)
4149d191bd8dSKuninori Morimoto {
4150d191bd8dSKuninori Morimoto 	struct snd_soc_component *cmpnt;
4151d191bd8dSKuninori Morimoto 
4152d191bd8dSKuninori Morimoto 	list_for_each_entry(cmpnt, &component_list, list) {
4153d191bd8dSKuninori Morimoto 		if (dev == cmpnt->dev)
4154d191bd8dSKuninori Morimoto 			goto found;
4155d191bd8dSKuninori Morimoto 	}
4156d191bd8dSKuninori Morimoto 	return;
4157d191bd8dSKuninori Morimoto 
4158d191bd8dSKuninori Morimoto found:
415932c9ba54SLars-Peter Clausen 	snd_soc_unregister_dais(cmpnt);
4160d191bd8dSKuninori Morimoto 
4161d191bd8dSKuninori Morimoto 	mutex_lock(&client_mutex);
4162d191bd8dSKuninori Morimoto 	list_del(&cmpnt->list);
4163d191bd8dSKuninori Morimoto 	mutex_unlock(&client_mutex);
4164d191bd8dSKuninori Morimoto 
4165d191bd8dSKuninori Morimoto 	dev_dbg(dev, "ASoC: Unregistered component '%s'\n", cmpnt->name);
4166d191bd8dSKuninori Morimoto 	kfree(cmpnt->name);
4167d191bd8dSKuninori Morimoto }
4168d191bd8dSKuninori Morimoto EXPORT_SYMBOL_GPL(snd_soc_unregister_component);
4169d191bd8dSKuninori Morimoto 
4170d191bd8dSKuninori Morimoto /**
417171a45cdaSLars-Peter Clausen  * snd_soc_add_platform - Add a platform to the ASoC core
417271a45cdaSLars-Peter Clausen  * @dev: The parent device for the platform
417371a45cdaSLars-Peter Clausen  * @platform: The platform to add
417471a45cdaSLars-Peter Clausen  * @platform_driver: The driver for the platform
417512a48a8cSMark Brown  */
417671a45cdaSLars-Peter Clausen int snd_soc_add_platform(struct device *dev, struct snd_soc_platform *platform,
4177d79e57dbSLars-Peter Clausen 		const struct snd_soc_platform_driver *platform_drv)
417812a48a8cSMark Brown {
4179f0fba2adSLiam Girdwood 	/* create platform component name */
4180f0fba2adSLiam Girdwood 	platform->name = fmt_single_name(dev, &platform->id);
4181b5c745fbSDan Carpenter 	if (platform->name == NULL)
4182f0fba2adSLiam Girdwood 		return -ENOMEM;
4183f0fba2adSLiam Girdwood 
4184f0fba2adSLiam Girdwood 	platform->dev = dev;
4185f0fba2adSLiam Girdwood 	platform->driver = platform_drv;
4186b7950641SLiam Girdwood 	platform->dapm.dev = dev;
4187b7950641SLiam Girdwood 	platform->dapm.platform = platform;
418864a648c2SLiam Girdwood 	platform->dapm.stream_event = platform_drv->stream_event;
4189cc22d37eSLiam Girdwood 	mutex_init(&platform->mutex);
419012a48a8cSMark Brown 
419112a48a8cSMark Brown 	mutex_lock(&client_mutex);
419212a48a8cSMark Brown 	list_add(&platform->list, &platform_list);
419312a48a8cSMark Brown 	mutex_unlock(&client_mutex);
419412a48a8cSMark Brown 
4195f110bfc7SLiam Girdwood 	dev_dbg(dev, "ASoC: Registered platform '%s'\n", platform->name);
419612a48a8cSMark Brown 
419712a48a8cSMark Brown 	return 0;
419812a48a8cSMark Brown }
419971a45cdaSLars-Peter Clausen EXPORT_SYMBOL_GPL(snd_soc_add_platform);
420071a45cdaSLars-Peter Clausen 
420171a45cdaSLars-Peter Clausen /**
420271a45cdaSLars-Peter Clausen  * snd_soc_register_platform - Register a platform with the ASoC core
420371a45cdaSLars-Peter Clausen  *
420471a45cdaSLars-Peter Clausen  * @platform: platform to register
420571a45cdaSLars-Peter Clausen  */
420671a45cdaSLars-Peter Clausen int snd_soc_register_platform(struct device *dev,
420771a45cdaSLars-Peter Clausen 		const struct snd_soc_platform_driver *platform_drv)
420871a45cdaSLars-Peter Clausen {
420971a45cdaSLars-Peter Clausen 	struct snd_soc_platform *platform;
421071a45cdaSLars-Peter Clausen 	int ret;
421171a45cdaSLars-Peter Clausen 
421271a45cdaSLars-Peter Clausen 	dev_dbg(dev, "ASoC: platform register %s\n", dev_name(dev));
421371a45cdaSLars-Peter Clausen 
421471a45cdaSLars-Peter Clausen 	platform = kzalloc(sizeof(struct snd_soc_platform), GFP_KERNEL);
421571a45cdaSLars-Peter Clausen 	if (platform == NULL)
421671a45cdaSLars-Peter Clausen 		return -ENOMEM;
421771a45cdaSLars-Peter Clausen 
421871a45cdaSLars-Peter Clausen 	ret = snd_soc_add_platform(dev, platform, platform_drv);
421971a45cdaSLars-Peter Clausen 	if (ret)
422071a45cdaSLars-Peter Clausen 		kfree(platform);
422171a45cdaSLars-Peter Clausen 
422271a45cdaSLars-Peter Clausen 	return ret;
422371a45cdaSLars-Peter Clausen }
422412a48a8cSMark Brown EXPORT_SYMBOL_GPL(snd_soc_register_platform);
422512a48a8cSMark Brown 
422612a48a8cSMark Brown /**
422771a45cdaSLars-Peter Clausen  * snd_soc_remove_platform - Remove a platform from the ASoC core
422871a45cdaSLars-Peter Clausen  * @platform: the platform to remove
422971a45cdaSLars-Peter Clausen  */
423071a45cdaSLars-Peter Clausen void snd_soc_remove_platform(struct snd_soc_platform *platform)
423171a45cdaSLars-Peter Clausen {
423271a45cdaSLars-Peter Clausen 	mutex_lock(&client_mutex);
423371a45cdaSLars-Peter Clausen 	list_del(&platform->list);
423471a45cdaSLars-Peter Clausen 	mutex_unlock(&client_mutex);
423571a45cdaSLars-Peter Clausen 
423671a45cdaSLars-Peter Clausen 	dev_dbg(platform->dev, "ASoC: Unregistered platform '%s'\n",
423771a45cdaSLars-Peter Clausen 		platform->name);
423871a45cdaSLars-Peter Clausen 	kfree(platform->name);
423971a45cdaSLars-Peter Clausen }
424071a45cdaSLars-Peter Clausen EXPORT_SYMBOL_GPL(snd_soc_remove_platform);
424171a45cdaSLars-Peter Clausen 
424271a45cdaSLars-Peter Clausen struct snd_soc_platform *snd_soc_lookup_platform(struct device *dev)
424371a45cdaSLars-Peter Clausen {
424471a45cdaSLars-Peter Clausen 	struct snd_soc_platform *platform;
424571a45cdaSLars-Peter Clausen 
424671a45cdaSLars-Peter Clausen 	list_for_each_entry(platform, &platform_list, list) {
424771a45cdaSLars-Peter Clausen 		if (dev == platform->dev)
424871a45cdaSLars-Peter Clausen 			return platform;
424971a45cdaSLars-Peter Clausen 	}
425071a45cdaSLars-Peter Clausen 
425171a45cdaSLars-Peter Clausen 	return NULL;
425271a45cdaSLars-Peter Clausen }
425371a45cdaSLars-Peter Clausen EXPORT_SYMBOL_GPL(snd_soc_lookup_platform);
425471a45cdaSLars-Peter Clausen 
425571a45cdaSLars-Peter Clausen /**
425612a48a8cSMark Brown  * snd_soc_unregister_platform - Unregister a platform from the ASoC core
425712a48a8cSMark Brown  *
4258ac11a2b3SMark Brown  * @platform: platform to unregister
425912a48a8cSMark Brown  */
4260f0fba2adSLiam Girdwood void snd_soc_unregister_platform(struct device *dev)
426112a48a8cSMark Brown {
4262f0fba2adSLiam Girdwood 	struct snd_soc_platform *platform;
4263f0fba2adSLiam Girdwood 
426471a45cdaSLars-Peter Clausen 	platform = snd_soc_lookup_platform(dev);
426571a45cdaSLars-Peter Clausen 	if (!platform)
4266f0fba2adSLiam Girdwood 		return;
4267f0fba2adSLiam Girdwood 
426871a45cdaSLars-Peter Clausen 	snd_soc_remove_platform(platform);
4269f0fba2adSLiam Girdwood 	kfree(platform);
427012a48a8cSMark Brown }
427112a48a8cSMark Brown EXPORT_SYMBOL_GPL(snd_soc_unregister_platform);
427212a48a8cSMark Brown 
4273151ab22cSMark Brown static u64 codec_format_map[] = {
4274151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE,
4275151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE,
4276151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_BE,
4277151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U24_LE | SNDRV_PCM_FMTBIT_U24_BE,
4278151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE,
4279151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE,
4280151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
4281151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
4282151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S20_3BE,
4283151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U20_3LE | SNDRV_PCM_FMTBIT_U20_3BE,
4284151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S18_3BE,
4285151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_U18_3LE | SNDRV_PCM_FMTBIT_U18_3BE,
4286151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_FLOAT_LE | SNDRV_PCM_FMTBIT_FLOAT_BE,
4287151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_FLOAT64_LE | SNDRV_PCM_FMTBIT_FLOAT64_BE,
4288151ab22cSMark Brown 	SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE
4289151ab22cSMark Brown 	| SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE,
4290151ab22cSMark Brown };
4291151ab22cSMark Brown 
4292151ab22cSMark Brown /* Fix up the DAI formats for endianness: codecs don't actually see
4293151ab22cSMark Brown  * the endianness of the data but we're using the CPU format
4294151ab22cSMark Brown  * definitions which do need to include endianness so we ensure that
4295151ab22cSMark Brown  * codec DAIs always have both big and little endian variants set.
4296151ab22cSMark Brown  */
4297151ab22cSMark Brown static void fixup_codec_formats(struct snd_soc_pcm_stream *stream)
4298151ab22cSMark Brown {
4299151ab22cSMark Brown 	int i;
4300151ab22cSMark Brown 
4301151ab22cSMark Brown 	for (i = 0; i < ARRAY_SIZE(codec_format_map); i++)
4302151ab22cSMark Brown 		if (stream->formats & codec_format_map[i])
4303151ab22cSMark Brown 			stream->formats |= codec_format_map[i];
4304151ab22cSMark Brown }
4305151ab22cSMark Brown 
43060d0cf00aSMark Brown /**
43070d0cf00aSMark Brown  * snd_soc_register_codec - Register a codec with the ASoC core
43080d0cf00aSMark Brown  *
4309ac11a2b3SMark Brown  * @codec: codec to register
43100d0cf00aSMark Brown  */
4311f0fba2adSLiam Girdwood int snd_soc_register_codec(struct device *dev,
4312001ae4c0SMark Brown 			   const struct snd_soc_codec_driver *codec_drv,
4313001ae4c0SMark Brown 			   struct snd_soc_dai_driver *dai_drv,
4314001ae4c0SMark Brown 			   int num_dai)
43150d0cf00aSMark Brown {
4316f0fba2adSLiam Girdwood 	struct snd_soc_codec *codec;
4317f0fba2adSLiam Girdwood 	int ret, i;
4318151ab22cSMark Brown 
4319f0fba2adSLiam Girdwood 	dev_dbg(dev, "codec register %s\n", dev_name(dev));
43200d0cf00aSMark Brown 
4321f0fba2adSLiam Girdwood 	codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
4322f0fba2adSLiam Girdwood 	if (codec == NULL)
4323f0fba2adSLiam Girdwood 		return -ENOMEM;
43240d0cf00aSMark Brown 
4325f0fba2adSLiam Girdwood 	/* create CODEC component name */
4326f0fba2adSLiam Girdwood 	codec->name = fmt_single_name(dev, &codec->id);
4327f0fba2adSLiam Girdwood 	if (codec->name == NULL) {
4328f790b94dSKuninori Morimoto 		ret = -ENOMEM;
4329f790b94dSKuninori Morimoto 		goto fail_codec;
4330151ab22cSMark Brown 	}
4331151ab22cSMark Brown 
4332c3acec26SMark Brown 	codec->write = codec_drv->write;
4333c3acec26SMark Brown 	codec->read = codec_drv->read;
43341500b7b5SDimitris Papastamos 	codec->volatile_register = codec_drv->volatile_register;
43351500b7b5SDimitris Papastamos 	codec->readable_register = codec_drv->readable_register;
43368020454cSDimitris Papastamos 	codec->writable_register = codec_drv->writable_register;
43373d59400fSLars-Peter Clausen 	codec->component.ignore_pmdown_time = codec_drv->ignore_pmdown_time;
4338ce6120ccSLiam Girdwood 	codec->dapm.bias_level = SND_SOC_BIAS_OFF;
4339ce6120ccSLiam Girdwood 	codec->dapm.dev = dev;
4340ce6120ccSLiam Girdwood 	codec->dapm.codec = codec;
4341474b62d6SMark Brown 	codec->dapm.seq_notifier = codec_drv->seq_notifier;
434264a648c2SLiam Girdwood 	codec->dapm.stream_event = codec_drv->stream_event;
4343f0fba2adSLiam Girdwood 	codec->dev = dev;
4344f0fba2adSLiam Girdwood 	codec->driver = codec_drv;
4345f0fba2adSLiam Girdwood 	codec->num_dai = num_dai;
4346f0fba2adSLiam Girdwood 	mutex_init(&codec->mutex);
4347f0fba2adSLiam Girdwood 
4348f0fba2adSLiam Girdwood 	for (i = 0; i < num_dai; i++) {
4349f0fba2adSLiam Girdwood 		fixup_codec_formats(&dai_drv[i].playback);
4350f0fba2adSLiam Girdwood 		fixup_codec_formats(&dai_drv[i].capture);
4351f0fba2adSLiam Girdwood 	}
4352f0fba2adSLiam Girdwood 
4353054880feSMark Brown 	mutex_lock(&client_mutex);
4354054880feSMark Brown 	list_add(&codec->list, &codec_list);
4355054880feSMark Brown 	mutex_unlock(&client_mutex);
4356054880feSMark Brown 
4357d191bd8dSKuninori Morimoto 	/* register component */
4358d191bd8dSKuninori Morimoto 	ret = __snd_soc_register_component(dev, &codec->component,
4359d191bd8dSKuninori Morimoto 					   &codec_drv->component_driver,
43606cc240f3SLars-Peter Clausen 					   codec, dai_drv, num_dai, false);
43615acd7dfbSKuninori Morimoto 	if (ret < 0) {
4362d191bd8dSKuninori Morimoto 		dev_err(codec->dev, "ASoC: Failed to regster component: %d\n", ret);
43635acd7dfbSKuninori Morimoto 		goto fail_codec_name;
436426b01ccdSMark Brown 	}
4365f0fba2adSLiam Girdwood 
4366f110bfc7SLiam Girdwood 	dev_dbg(codec->dev, "ASoC: Registered codec '%s'\n", codec->name);
43670d0cf00aSMark Brown 	return 0;
4368f0fba2adSLiam Girdwood 
4369f790b94dSKuninori Morimoto fail_codec_name:
4370e1328a83SKuninori Morimoto 	mutex_lock(&client_mutex);
4371e1328a83SKuninori Morimoto 	list_del(&codec->list);
4372e1328a83SKuninori Morimoto 	mutex_unlock(&client_mutex);
4373e1328a83SKuninori Morimoto 
4374f0fba2adSLiam Girdwood 	kfree(codec->name);
4375f790b94dSKuninori Morimoto fail_codec:
4376f0fba2adSLiam Girdwood 	kfree(codec);
4377f0fba2adSLiam Girdwood 	return ret;
43780d0cf00aSMark Brown }
43790d0cf00aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_register_codec);
43800d0cf00aSMark Brown 
43810d0cf00aSMark Brown /**
43820d0cf00aSMark Brown  * snd_soc_unregister_codec - Unregister a codec from the ASoC core
43830d0cf00aSMark Brown  *
4384ac11a2b3SMark Brown  * @codec: codec to unregister
43850d0cf00aSMark Brown  */
4386f0fba2adSLiam Girdwood void snd_soc_unregister_codec(struct device *dev)
43870d0cf00aSMark Brown {
4388f0fba2adSLiam Girdwood 	struct snd_soc_codec *codec;
4389f0fba2adSLiam Girdwood 
4390f0fba2adSLiam Girdwood 	list_for_each_entry(codec, &codec_list, list) {
4391f0fba2adSLiam Girdwood 		if (dev == codec->dev)
4392f0fba2adSLiam Girdwood 			goto found;
4393f0fba2adSLiam Girdwood 	}
4394f0fba2adSLiam Girdwood 	return;
4395f0fba2adSLiam Girdwood 
4396f0fba2adSLiam Girdwood found:
4397d191bd8dSKuninori Morimoto 	snd_soc_unregister_component(dev);
4398f0fba2adSLiam Girdwood 
43990d0cf00aSMark Brown 	mutex_lock(&client_mutex);
44000d0cf00aSMark Brown 	list_del(&codec->list);
44010d0cf00aSMark Brown 	mutex_unlock(&client_mutex);
44020d0cf00aSMark Brown 
4403f110bfc7SLiam Girdwood 	dev_dbg(codec->dev, "ASoC: Unregistered codec '%s'\n", codec->name);
4404f0fba2adSLiam Girdwood 
44057a30a3dbSDimitris Papastamos 	snd_soc_cache_exit(codec);
44061aafcd4dSDimitris Papastamos 	kfree(codec->name);
4407f0fba2adSLiam Girdwood 	kfree(codec);
44080d0cf00aSMark Brown }
44090d0cf00aSMark Brown EXPORT_SYMBOL_GPL(snd_soc_unregister_codec);
44100d0cf00aSMark Brown 
4411bec4fa05SStephen Warren /* Retrieve a card's name from device tree */
4412bec4fa05SStephen Warren int snd_soc_of_parse_card_name(struct snd_soc_card *card,
4413bec4fa05SStephen Warren 			       const char *propname)
4414bec4fa05SStephen Warren {
4415bec4fa05SStephen Warren 	struct device_node *np = card->dev->of_node;
4416bec4fa05SStephen Warren 	int ret;
4417bec4fa05SStephen Warren 
4418bec4fa05SStephen Warren 	ret = of_property_read_string_index(np, propname, 0, &card->name);
4419bec4fa05SStephen Warren 	/*
4420bec4fa05SStephen Warren 	 * EINVAL means the property does not exist. This is fine providing
4421bec4fa05SStephen Warren 	 * card->name was previously set, which is checked later in
4422bec4fa05SStephen Warren 	 * snd_soc_register_card.
4423bec4fa05SStephen Warren 	 */
4424bec4fa05SStephen Warren 	if (ret < 0 && ret != -EINVAL) {
4425bec4fa05SStephen Warren 		dev_err(card->dev,
4426f110bfc7SLiam Girdwood 			"ASoC: Property '%s' could not be read: %d\n",
4427bec4fa05SStephen Warren 			propname, ret);
4428bec4fa05SStephen Warren 		return ret;
4429bec4fa05SStephen Warren 	}
4430bec4fa05SStephen Warren 
4431bec4fa05SStephen Warren 	return 0;
4432bec4fa05SStephen Warren }
4433bec4fa05SStephen Warren EXPORT_SYMBOL_GPL(snd_soc_of_parse_card_name);
4434bec4fa05SStephen Warren 
44359a6d4860SXiubo Li static const struct snd_soc_dapm_widget simple_widgets[] = {
44369a6d4860SXiubo Li 	SND_SOC_DAPM_MIC("Microphone", NULL),
44379a6d4860SXiubo Li 	SND_SOC_DAPM_LINE("Line", NULL),
44389a6d4860SXiubo Li 	SND_SOC_DAPM_HP("Headphone", NULL),
44399a6d4860SXiubo Li 	SND_SOC_DAPM_SPK("Speaker", NULL),
44409a6d4860SXiubo Li };
44419a6d4860SXiubo Li 
44429a6d4860SXiubo Li int snd_soc_of_parse_audio_simple_widgets(struct snd_soc_card *card,
44439a6d4860SXiubo Li 					  const char *propname)
44449a6d4860SXiubo Li {
44459a6d4860SXiubo Li 	struct device_node *np = card->dev->of_node;
44469a6d4860SXiubo Li 	struct snd_soc_dapm_widget *widgets;
44479a6d4860SXiubo Li 	const char *template, *wname;
44489a6d4860SXiubo Li 	int i, j, num_widgets, ret;
44499a6d4860SXiubo Li 
44509a6d4860SXiubo Li 	num_widgets = of_property_count_strings(np, propname);
44519a6d4860SXiubo Li 	if (num_widgets < 0) {
44529a6d4860SXiubo Li 		dev_err(card->dev,
44539a6d4860SXiubo Li 			"ASoC: Property '%s' does not exist\n",	propname);
44549a6d4860SXiubo Li 		return -EINVAL;
44559a6d4860SXiubo Li 	}
44569a6d4860SXiubo Li 	if (num_widgets & 1) {
44579a6d4860SXiubo Li 		dev_err(card->dev,
44589a6d4860SXiubo Li 			"ASoC: Property '%s' length is not even\n", propname);
44599a6d4860SXiubo Li 		return -EINVAL;
44609a6d4860SXiubo Li 	}
44619a6d4860SXiubo Li 
44629a6d4860SXiubo Li 	num_widgets /= 2;
44639a6d4860SXiubo Li 	if (!num_widgets) {
44649a6d4860SXiubo Li 		dev_err(card->dev, "ASoC: Property '%s's length is zero\n",
44659a6d4860SXiubo Li 			propname);
44669a6d4860SXiubo Li 		return -EINVAL;
44679a6d4860SXiubo Li 	}
44689a6d4860SXiubo Li 
44699a6d4860SXiubo Li 	widgets = devm_kcalloc(card->dev, num_widgets, sizeof(*widgets),
44709a6d4860SXiubo Li 			       GFP_KERNEL);
44719a6d4860SXiubo Li 	if (!widgets) {
44729a6d4860SXiubo Li 		dev_err(card->dev,
44739a6d4860SXiubo Li 			"ASoC: Could not allocate memory for widgets\n");
44749a6d4860SXiubo Li 		return -ENOMEM;
44759a6d4860SXiubo Li 	}
44769a6d4860SXiubo Li 
44779a6d4860SXiubo Li 	for (i = 0; i < num_widgets; i++) {
44789a6d4860SXiubo Li 		ret = of_property_read_string_index(np, propname,
44799a6d4860SXiubo Li 			2 * i, &template);
44809a6d4860SXiubo Li 		if (ret) {
44819a6d4860SXiubo Li 			dev_err(card->dev,
44829a6d4860SXiubo Li 				"ASoC: Property '%s' index %d read error:%d\n",
44839a6d4860SXiubo Li 				propname, 2 * i, ret);
44849a6d4860SXiubo Li 			return -EINVAL;
44859a6d4860SXiubo Li 		}
44869a6d4860SXiubo Li 
44879a6d4860SXiubo Li 		for (j = 0; j < ARRAY_SIZE(simple_widgets); j++) {
44889a6d4860SXiubo Li 			if (!strncmp(template, simple_widgets[j].name,
44899a6d4860SXiubo Li 				     strlen(simple_widgets[j].name))) {
44909a6d4860SXiubo Li 				widgets[i] = simple_widgets[j];
44919a6d4860SXiubo Li 				break;
44929a6d4860SXiubo Li 			}
44939a6d4860SXiubo Li 		}
44949a6d4860SXiubo Li 
44959a6d4860SXiubo Li 		if (j >= ARRAY_SIZE(simple_widgets)) {
44969a6d4860SXiubo Li 			dev_err(card->dev,
44979a6d4860SXiubo Li 				"ASoC: DAPM widget '%s' is not supported\n",
44989a6d4860SXiubo Li 				template);
44999a6d4860SXiubo Li 			return -EINVAL;
45009a6d4860SXiubo Li 		}
45019a6d4860SXiubo Li 
45029a6d4860SXiubo Li 		ret = of_property_read_string_index(np, propname,
45039a6d4860SXiubo Li 						    (2 * i) + 1,
45049a6d4860SXiubo Li 						    &wname);
45059a6d4860SXiubo Li 		if (ret) {
45069a6d4860SXiubo Li 			dev_err(card->dev,
45079a6d4860SXiubo Li 				"ASoC: Property '%s' index %d read error:%d\n",
45089a6d4860SXiubo Li 				propname, (2 * i) + 1, ret);
45099a6d4860SXiubo Li 			return -EINVAL;
45109a6d4860SXiubo Li 		}
45119a6d4860SXiubo Li 
45129a6d4860SXiubo Li 		widgets[i].name = wname;
45139a6d4860SXiubo Li 	}
45149a6d4860SXiubo Li 
45159a6d4860SXiubo Li 	card->dapm_widgets = widgets;
45169a6d4860SXiubo Li 	card->num_dapm_widgets = num_widgets;
45179a6d4860SXiubo Li 
45189a6d4860SXiubo Li 	return 0;
45199a6d4860SXiubo Li }
45209a6d4860SXiubo Li EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_simple_widgets);
45219a6d4860SXiubo Li 
452289c67857SXiubo Li int snd_soc_of_parse_tdm_slot(struct device_node *np,
452389c67857SXiubo Li 			      unsigned int *slots,
452489c67857SXiubo Li 			      unsigned int *slot_width)
452589c67857SXiubo Li {
452689c67857SXiubo Li 	u32 val;
452789c67857SXiubo Li 	int ret;
452889c67857SXiubo Li 
452989c67857SXiubo Li 	if (of_property_read_bool(np, "dai-tdm-slot-num")) {
453089c67857SXiubo Li 		ret = of_property_read_u32(np, "dai-tdm-slot-num", &val);
453189c67857SXiubo Li 		if (ret)
453289c67857SXiubo Li 			return ret;
453389c67857SXiubo Li 
453489c67857SXiubo Li 		if (slots)
453589c67857SXiubo Li 			*slots = val;
453689c67857SXiubo Li 	}
453789c67857SXiubo Li 
453889c67857SXiubo Li 	if (of_property_read_bool(np, "dai-tdm-slot-width")) {
453989c67857SXiubo Li 		ret = of_property_read_u32(np, "dai-tdm-slot-width", &val);
454089c67857SXiubo Li 		if (ret)
454189c67857SXiubo Li 			return ret;
454289c67857SXiubo Li 
454389c67857SXiubo Li 		if (slot_width)
454489c67857SXiubo Li 			*slot_width = val;
454589c67857SXiubo Li 	}
454689c67857SXiubo Li 
454789c67857SXiubo Li 	return 0;
454889c67857SXiubo Li }
454989c67857SXiubo Li EXPORT_SYMBOL_GPL(snd_soc_of_parse_tdm_slot);
455089c67857SXiubo Li 
4551a4a54dd5SStephen Warren int snd_soc_of_parse_audio_routing(struct snd_soc_card *card,
4552a4a54dd5SStephen Warren 				   const char *propname)
4553a4a54dd5SStephen Warren {
4554a4a54dd5SStephen Warren 	struct device_node *np = card->dev->of_node;
4555a4a54dd5SStephen Warren 	int num_routes;
4556a4a54dd5SStephen Warren 	struct snd_soc_dapm_route *routes;
4557a4a54dd5SStephen Warren 	int i, ret;
4558a4a54dd5SStephen Warren 
4559a4a54dd5SStephen Warren 	num_routes = of_property_count_strings(np, propname);
4560c34ce320SRichard Zhao 	if (num_routes < 0 || num_routes & 1) {
456110e8aa9aSMichał Mirosław 		dev_err(card->dev,
456210e8aa9aSMichał Mirosław 			"ASoC: Property '%s' does not exist or its length is not even\n",
456310e8aa9aSMichał Mirosław 			propname);
4564a4a54dd5SStephen Warren 		return -EINVAL;
4565a4a54dd5SStephen Warren 	}
4566a4a54dd5SStephen Warren 	num_routes /= 2;
4567a4a54dd5SStephen Warren 	if (!num_routes) {
4568f110bfc7SLiam Girdwood 		dev_err(card->dev, "ASoC: Property '%s's length is zero\n",
4569a4a54dd5SStephen Warren 			propname);
4570a4a54dd5SStephen Warren 		return -EINVAL;
4571a4a54dd5SStephen Warren 	}
4572a4a54dd5SStephen Warren 
4573a4a54dd5SStephen Warren 	routes = devm_kzalloc(card->dev, num_routes * sizeof(*routes),
4574a4a54dd5SStephen Warren 			      GFP_KERNEL);
4575a4a54dd5SStephen Warren 	if (!routes) {
4576a4a54dd5SStephen Warren 		dev_err(card->dev,
4577f110bfc7SLiam Girdwood 			"ASoC: Could not allocate DAPM route table\n");
4578a4a54dd5SStephen Warren 		return -EINVAL;
4579a4a54dd5SStephen Warren 	}
4580a4a54dd5SStephen Warren 
4581a4a54dd5SStephen Warren 	for (i = 0; i < num_routes; i++) {
4582a4a54dd5SStephen Warren 		ret = of_property_read_string_index(np, propname,
4583a4a54dd5SStephen Warren 			2 * i, &routes[i].sink);
4584a4a54dd5SStephen Warren 		if (ret) {
4585c871bd0bSMark Brown 			dev_err(card->dev,
4586c871bd0bSMark Brown 				"ASoC: Property '%s' index %d could not be read: %d\n",
4587c871bd0bSMark Brown 				propname, 2 * i, ret);
4588a4a54dd5SStephen Warren 			return -EINVAL;
4589a4a54dd5SStephen Warren 		}
4590a4a54dd5SStephen Warren 		ret = of_property_read_string_index(np, propname,
4591a4a54dd5SStephen Warren 			(2 * i) + 1, &routes[i].source);
4592a4a54dd5SStephen Warren 		if (ret) {
4593a4a54dd5SStephen Warren 			dev_err(card->dev,
4594c871bd0bSMark Brown 				"ASoC: Property '%s' index %d could not be read: %d\n",
4595c871bd0bSMark Brown 				propname, (2 * i) + 1, ret);
4596a4a54dd5SStephen Warren 			return -EINVAL;
4597a4a54dd5SStephen Warren 		}
4598a4a54dd5SStephen Warren 	}
4599a4a54dd5SStephen Warren 
4600a4a54dd5SStephen Warren 	card->num_dapm_routes = num_routes;
4601a4a54dd5SStephen Warren 	card->dapm_routes = routes;
4602a4a54dd5SStephen Warren 
4603a4a54dd5SStephen Warren 	return 0;
4604a4a54dd5SStephen Warren }
4605a4a54dd5SStephen Warren EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_routing);
4606a4a54dd5SStephen Warren 
4607a7930ed4SKuninori Morimoto unsigned int snd_soc_of_parse_daifmt(struct device_node *np,
4608a7930ed4SKuninori Morimoto 				     const char *prefix)
4609a7930ed4SKuninori Morimoto {
4610a7930ed4SKuninori Morimoto 	int ret, i;
4611a7930ed4SKuninori Morimoto 	char prop[128];
4612a7930ed4SKuninori Morimoto 	unsigned int format = 0;
4613a7930ed4SKuninori Morimoto 	int bit, frame;
4614a7930ed4SKuninori Morimoto 	const char *str;
4615a7930ed4SKuninori Morimoto 	struct {
4616a7930ed4SKuninori Morimoto 		char *name;
4617a7930ed4SKuninori Morimoto 		unsigned int val;
4618a7930ed4SKuninori Morimoto 	} of_fmt_table[] = {
4619a7930ed4SKuninori Morimoto 		{ "i2s",	SND_SOC_DAIFMT_I2S },
4620a7930ed4SKuninori Morimoto 		{ "right_j",	SND_SOC_DAIFMT_RIGHT_J },
4621a7930ed4SKuninori Morimoto 		{ "left_j",	SND_SOC_DAIFMT_LEFT_J },
4622a7930ed4SKuninori Morimoto 		{ "dsp_a",	SND_SOC_DAIFMT_DSP_A },
4623a7930ed4SKuninori Morimoto 		{ "dsp_b",	SND_SOC_DAIFMT_DSP_B },
4624a7930ed4SKuninori Morimoto 		{ "ac97",	SND_SOC_DAIFMT_AC97 },
4625a7930ed4SKuninori Morimoto 		{ "pdm",	SND_SOC_DAIFMT_PDM},
4626a7930ed4SKuninori Morimoto 		{ "msb",	SND_SOC_DAIFMT_MSB },
4627a7930ed4SKuninori Morimoto 		{ "lsb",	SND_SOC_DAIFMT_LSB },
4628a7930ed4SKuninori Morimoto 	};
4629a7930ed4SKuninori Morimoto 
4630a7930ed4SKuninori Morimoto 	if (!prefix)
4631a7930ed4SKuninori Morimoto 		prefix = "";
4632a7930ed4SKuninori Morimoto 
4633a7930ed4SKuninori Morimoto 	/*
4634a7930ed4SKuninori Morimoto 	 * check "[prefix]format = xxx"
4635a7930ed4SKuninori Morimoto 	 * SND_SOC_DAIFMT_FORMAT_MASK area
4636a7930ed4SKuninori Morimoto 	 */
4637a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sformat", prefix);
4638a7930ed4SKuninori Morimoto 	ret = of_property_read_string(np, prop, &str);
4639a7930ed4SKuninori Morimoto 	if (ret == 0) {
4640a7930ed4SKuninori Morimoto 		for (i = 0; i < ARRAY_SIZE(of_fmt_table); i++) {
4641a7930ed4SKuninori Morimoto 			if (strcmp(str, of_fmt_table[i].name) == 0) {
4642a7930ed4SKuninori Morimoto 				format |= of_fmt_table[i].val;
4643a7930ed4SKuninori Morimoto 				break;
4644a7930ed4SKuninori Morimoto 			}
4645a7930ed4SKuninori Morimoto 		}
4646a7930ed4SKuninori Morimoto 	}
4647a7930ed4SKuninori Morimoto 
4648a7930ed4SKuninori Morimoto 	/*
46498c2d6a9fSKuninori Morimoto 	 * check "[prefix]continuous-clock"
4650a7930ed4SKuninori Morimoto 	 * SND_SOC_DAIFMT_CLOCK_MASK area
4651a7930ed4SKuninori Morimoto 	 */
46528c2d6a9fSKuninori Morimoto 	snprintf(prop, sizeof(prop), "%scontinuous-clock", prefix);
46538c2d6a9fSKuninori Morimoto 	if (of_get_property(np, prop, NULL))
46548c2d6a9fSKuninori Morimoto 		format |= SND_SOC_DAIFMT_CONT;
46558c2d6a9fSKuninori Morimoto 	else
46568c2d6a9fSKuninori Morimoto 		format |= SND_SOC_DAIFMT_GATED;
4657a7930ed4SKuninori Morimoto 
4658a7930ed4SKuninori Morimoto 	/*
4659a7930ed4SKuninori Morimoto 	 * check "[prefix]bitclock-inversion"
4660a7930ed4SKuninori Morimoto 	 * check "[prefix]frame-inversion"
4661a7930ed4SKuninori Morimoto 	 * SND_SOC_DAIFMT_INV_MASK area
4662a7930ed4SKuninori Morimoto 	 */
4663a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sbitclock-inversion", prefix);
4664a7930ed4SKuninori Morimoto 	bit = !!of_get_property(np, prop, NULL);
4665a7930ed4SKuninori Morimoto 
4666a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sframe-inversion", prefix);
4667a7930ed4SKuninori Morimoto 	frame = !!of_get_property(np, prop, NULL);
4668a7930ed4SKuninori Morimoto 
4669a7930ed4SKuninori Morimoto 	switch ((bit << 4) + frame) {
4670a7930ed4SKuninori Morimoto 	case 0x11:
4671a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_IB_IF;
4672a7930ed4SKuninori Morimoto 		break;
4673a7930ed4SKuninori Morimoto 	case 0x10:
4674a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_IB_NF;
4675a7930ed4SKuninori Morimoto 		break;
4676a7930ed4SKuninori Morimoto 	case 0x01:
4677a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_NB_IF;
4678a7930ed4SKuninori Morimoto 		break;
4679a7930ed4SKuninori Morimoto 	default:
4680a7930ed4SKuninori Morimoto 		/* SND_SOC_DAIFMT_NB_NF is default */
4681a7930ed4SKuninori Morimoto 		break;
4682a7930ed4SKuninori Morimoto 	}
4683a7930ed4SKuninori Morimoto 
4684a7930ed4SKuninori Morimoto 	/*
4685a7930ed4SKuninori Morimoto 	 * check "[prefix]bitclock-master"
4686a7930ed4SKuninori Morimoto 	 * check "[prefix]frame-master"
4687a7930ed4SKuninori Morimoto 	 * SND_SOC_DAIFMT_MASTER_MASK area
4688a7930ed4SKuninori Morimoto 	 */
4689a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sbitclock-master", prefix);
4690a7930ed4SKuninori Morimoto 	bit = !!of_get_property(np, prop, NULL);
4691a7930ed4SKuninori Morimoto 
4692a7930ed4SKuninori Morimoto 	snprintf(prop, sizeof(prop), "%sframe-master", prefix);
4693a7930ed4SKuninori Morimoto 	frame = !!of_get_property(np, prop, NULL);
4694a7930ed4SKuninori Morimoto 
4695a7930ed4SKuninori Morimoto 	switch ((bit << 4) + frame) {
4696a7930ed4SKuninori Morimoto 	case 0x11:
4697a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_CBM_CFM;
4698a7930ed4SKuninori Morimoto 		break;
4699a7930ed4SKuninori Morimoto 	case 0x10:
4700a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_CBM_CFS;
4701a7930ed4SKuninori Morimoto 		break;
4702a7930ed4SKuninori Morimoto 	case 0x01:
4703a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_CBS_CFM;
4704a7930ed4SKuninori Morimoto 		break;
4705a7930ed4SKuninori Morimoto 	default:
4706a7930ed4SKuninori Morimoto 		format |= SND_SOC_DAIFMT_CBS_CFS;
4707a7930ed4SKuninori Morimoto 		break;
4708a7930ed4SKuninori Morimoto 	}
4709a7930ed4SKuninori Morimoto 
4710a7930ed4SKuninori Morimoto 	return format;
4711a7930ed4SKuninori Morimoto }
4712a7930ed4SKuninori Morimoto EXPORT_SYMBOL_GPL(snd_soc_of_parse_daifmt);
4713a7930ed4SKuninori Morimoto 
4714cb470087SKuninori Morimoto int snd_soc_of_get_dai_name(struct device_node *of_node,
4715cb470087SKuninori Morimoto 			    const char **dai_name)
4716cb470087SKuninori Morimoto {
4717cb470087SKuninori Morimoto 	struct snd_soc_component *pos;
4718cb470087SKuninori Morimoto 	struct of_phandle_args args;
4719cb470087SKuninori Morimoto 	int ret;
4720cb470087SKuninori Morimoto 
4721cb470087SKuninori Morimoto 	ret = of_parse_phandle_with_args(of_node, "sound-dai",
4722cb470087SKuninori Morimoto 					 "#sound-dai-cells", 0, &args);
4723cb470087SKuninori Morimoto 	if (ret)
4724cb470087SKuninori Morimoto 		return ret;
4725cb470087SKuninori Morimoto 
4726cb470087SKuninori Morimoto 	ret = -EPROBE_DEFER;
4727cb470087SKuninori Morimoto 
4728cb470087SKuninori Morimoto 	mutex_lock(&client_mutex);
4729cb470087SKuninori Morimoto 	list_for_each_entry(pos, &component_list, list) {
4730cb470087SKuninori Morimoto 		if (pos->dev->of_node != args.np)
4731cb470087SKuninori Morimoto 			continue;
4732cb470087SKuninori Morimoto 
47336833c452SKuninori Morimoto 		if (pos->driver->of_xlate_dai_name) {
47346833c452SKuninori Morimoto 			ret = pos->driver->of_xlate_dai_name(pos, &args, dai_name);
47356833c452SKuninori Morimoto 		} else {
47366833c452SKuninori Morimoto 			int id = -1;
47376833c452SKuninori Morimoto 
47386833c452SKuninori Morimoto 			switch (args.args_count) {
47396833c452SKuninori Morimoto 			case 0:
47406833c452SKuninori Morimoto 				id = 0; /* same as dai_drv[0] */
47416833c452SKuninori Morimoto 				break;
47426833c452SKuninori Morimoto 			case 1:
47436833c452SKuninori Morimoto 				id = args.args[0];
47446833c452SKuninori Morimoto 				break;
47456833c452SKuninori Morimoto 			default:
47466833c452SKuninori Morimoto 				/* not supported */
4747cb470087SKuninori Morimoto 				break;
4748cb470087SKuninori Morimoto 			}
4749cb470087SKuninori Morimoto 
47506833c452SKuninori Morimoto 			if (id < 0 || id >= pos->num_dai) {
47516833c452SKuninori Morimoto 				ret = -EINVAL;
4752e41975edSXiubo Li 				break;
47536833c452SKuninori Morimoto 			}
4754e41975edSXiubo Li 
4755e41975edSXiubo Li 			ret = 0;
4756e41975edSXiubo Li 
4757e41975edSXiubo Li 			*dai_name = pos->dai_drv[id].name;
4758e41975edSXiubo Li 			if (!*dai_name)
4759e41975edSXiubo Li 				*dai_name = pos->name;
47606833c452SKuninori Morimoto 		}
47616833c452SKuninori Morimoto 
4762cb470087SKuninori Morimoto 		break;
4763cb470087SKuninori Morimoto 	}
4764cb470087SKuninori Morimoto 	mutex_unlock(&client_mutex);
4765cb470087SKuninori Morimoto 
4766cb470087SKuninori Morimoto 	of_node_put(args.np);
4767cb470087SKuninori Morimoto 
4768cb470087SKuninori Morimoto 	return ret;
4769cb470087SKuninori Morimoto }
4770cb470087SKuninori Morimoto EXPORT_SYMBOL_GPL(snd_soc_of_get_dai_name);
4771cb470087SKuninori Morimoto 
4772c9b3a40fSTakashi Iwai static int __init snd_soc_init(void)
4773db2a4165SFrank Mandarino {
4774db2a4165SFrank Mandarino #ifdef CONFIG_DEBUG_FS
47758a9dab1aSMark Brown 	snd_soc_debugfs_root = debugfs_create_dir("asoc", NULL);
47768a9dab1aSMark Brown 	if (IS_ERR(snd_soc_debugfs_root) || !snd_soc_debugfs_root) {
47770837fc62SFabio Estevam 		pr_warn("ASoC: Failed to create debugfs directory\n");
47788a9dab1aSMark Brown 		snd_soc_debugfs_root = NULL;
4779db2a4165SFrank Mandarino 	}
4780c3c5a19aSMark Brown 
47818a9dab1aSMark Brown 	if (!debugfs_create_file("codecs", 0444, snd_soc_debugfs_root, NULL,
4782c3c5a19aSMark Brown 				 &codec_list_fops))
4783c3c5a19aSMark Brown 		pr_warn("ASoC: Failed to create CODEC list debugfs file\n");
4784c3c5a19aSMark Brown 
47858a9dab1aSMark Brown 	if (!debugfs_create_file("dais", 0444, snd_soc_debugfs_root, NULL,
4786f3208780SMark Brown 				 &dai_list_fops))
4787f3208780SMark Brown 		pr_warn("ASoC: Failed to create DAI list debugfs file\n");
478819c7ac27SMark Brown 
47898a9dab1aSMark Brown 	if (!debugfs_create_file("platforms", 0444, snd_soc_debugfs_root, NULL,
479019c7ac27SMark Brown 				 &platform_list_fops))
479119c7ac27SMark Brown 		pr_warn("ASoC: Failed to create platform list debugfs file\n");
4792db2a4165SFrank Mandarino #endif
4793db2a4165SFrank Mandarino 
4794fb257897SMark Brown 	snd_soc_util_init();
4795fb257897SMark Brown 
4796db2a4165SFrank Mandarino 	return platform_driver_register(&soc_driver);
4797db2a4165SFrank Mandarino }
47984abe8e16SMark Brown module_init(snd_soc_init);
4799db2a4165SFrank Mandarino 
4800db2a4165SFrank Mandarino static void __exit snd_soc_exit(void)
4801db2a4165SFrank Mandarino {
4802fb257897SMark Brown 	snd_soc_util_exit();
4803fb257897SMark Brown 
4804db2a4165SFrank Mandarino #ifdef CONFIG_DEBUG_FS
48058a9dab1aSMark Brown 	debugfs_remove_recursive(snd_soc_debugfs_root);
4806db2a4165SFrank Mandarino #endif
4807db2a4165SFrank Mandarino 	platform_driver_unregister(&soc_driver);
4808db2a4165SFrank Mandarino }
4809db2a4165SFrank Mandarino module_exit(snd_soc_exit);
4810db2a4165SFrank Mandarino 
4811db2a4165SFrank Mandarino /* Module information */
4812db2a4165SFrank Mandarino MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
4813db2a4165SFrank Mandarino MODULE_DESCRIPTION("ALSA SoC Core");
4814db2a4165SFrank Mandarino MODULE_LICENSE("GPL");
4815db2a4165SFrank Mandarino MODULE_ALIAS("platform:soc-audio");
4816