xref: /openbmc/linux/sound/soc/soc-core.c (revision d78c317f)
1 /*
2  * soc-core.c  --  ALSA SoC Audio Layer
3  *
4  * Copyright 2005 Wolfson Microelectronics PLC.
5  * Copyright 2005 Openedhand Ltd.
6  * Copyright (C) 2010 Slimlogic Ltd.
7  * Copyright (C) 2010 Texas Instruments Inc.
8  *
9  * Author: Liam Girdwood <lrg@slimlogic.co.uk>
10  *         with code, comments and ideas from :-
11  *         Richard Purdie <richard@openedhand.com>
12  *
13  *  This program is free software; you can redistribute  it and/or modify it
14  *  under  the terms of  the GNU General  Public License as published by the
15  *  Free Software Foundation;  either version 2 of the  License, or (at your
16  *  option) any later version.
17  *
18  *  TODO:
19  *   o Add hw rules to enforce rates, etc.
20  *   o More testing with other codecs/machines.
21  *   o Add more codecs and platforms to ensure good API coverage.
22  *   o Support TDM on PCM and I2S
23  */
24 
25 #include <linux/module.h>
26 #include <linux/moduleparam.h>
27 #include <linux/init.h>
28 #include <linux/delay.h>
29 #include <linux/pm.h>
30 #include <linux/bitops.h>
31 #include <linux/debugfs.h>
32 #include <linux/platform_device.h>
33 #include <linux/ctype.h>
34 #include <linux/slab.h>
35 #include <linux/of.h>
36 #include <sound/ac97_codec.h>
37 #include <sound/core.h>
38 #include <sound/jack.h>
39 #include <sound/pcm.h>
40 #include <sound/pcm_params.h>
41 #include <sound/soc.h>
42 #include <sound/initval.h>
43 
44 #define CREATE_TRACE_POINTS
45 #include <trace/events/asoc.h>
46 
47 #define NAME_SIZE	32
48 
49 static DECLARE_WAIT_QUEUE_HEAD(soc_pm_waitq);
50 
51 #ifdef CONFIG_DEBUG_FS
52 struct dentry *snd_soc_debugfs_root;
53 EXPORT_SYMBOL_GPL(snd_soc_debugfs_root);
54 #endif
55 
56 static DEFINE_MUTEX(client_mutex);
57 static LIST_HEAD(card_list);
58 static LIST_HEAD(dai_list);
59 static LIST_HEAD(platform_list);
60 static LIST_HEAD(codec_list);
61 
62 /*
63  * This is a timeout to do a DAPM powerdown after a stream is closed().
64  * It can be used to eliminate pops between different playback streams, e.g.
65  * between two audio tracks.
66  */
67 static int pmdown_time = 5000;
68 module_param(pmdown_time, int, 0);
69 MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
70 
71 /* returns the minimum number of bytes needed to represent
72  * a particular given value */
73 static int min_bytes_needed(unsigned long val)
74 {
75 	int c = 0;
76 	int i;
77 
78 	for (i = (sizeof val * 8) - 1; i >= 0; --i, ++c)
79 		if (val & (1UL << i))
80 			break;
81 	c = (sizeof val * 8) - c;
82 	if (!c || (c % 8))
83 		c = (c + 8) / 8;
84 	else
85 		c /= 8;
86 	return c;
87 }
88 
89 /* fill buf which is 'len' bytes with a formatted
90  * string of the form 'reg: value\n' */
91 static int format_register_str(struct snd_soc_codec *codec,
92 			       unsigned int reg, char *buf, size_t len)
93 {
94 	int wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
95 	int regsize = codec->driver->reg_word_size * 2;
96 	int ret;
97 	char tmpbuf[len + 1];
98 	char regbuf[regsize + 1];
99 
100 	/* since tmpbuf is allocated on the stack, warn the callers if they
101 	 * try to abuse this function */
102 	WARN_ON(len > 63);
103 
104 	/* +2 for ': ' and + 1 for '\n' */
105 	if (wordsize + regsize + 2 + 1 != len)
106 		return -EINVAL;
107 
108 	ret = snd_soc_read(codec, reg);
109 	if (ret < 0) {
110 		memset(regbuf, 'X', regsize);
111 		regbuf[regsize] = '\0';
112 	} else {
113 		snprintf(regbuf, regsize + 1, "%.*x", regsize, ret);
114 	}
115 
116 	/* prepare the buffer */
117 	snprintf(tmpbuf, len + 1, "%.*x: %s\n", wordsize, reg, regbuf);
118 	/* copy it back to the caller without the '\0' */
119 	memcpy(buf, tmpbuf, len);
120 
121 	return 0;
122 }
123 
124 /* codec register dump */
125 static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf,
126 				  size_t count, loff_t pos)
127 {
128 	int i, step = 1;
129 	int wordsize, regsize;
130 	int len;
131 	size_t total = 0;
132 	loff_t p = 0;
133 
134 	wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
135 	regsize = codec->driver->reg_word_size * 2;
136 
137 	len = wordsize + regsize + 2 + 1;
138 
139 	if (!codec->driver->reg_cache_size)
140 		return 0;
141 
142 	if (codec->driver->reg_cache_step)
143 		step = codec->driver->reg_cache_step;
144 
145 	for (i = 0; i < codec->driver->reg_cache_size; i += step) {
146 		if (!snd_soc_codec_readable_register(codec, i))
147 			continue;
148 		if (codec->driver->display_register) {
149 			count += codec->driver->display_register(codec, buf + count,
150 							 PAGE_SIZE - count, i);
151 		} else {
152 			/* only support larger than PAGE_SIZE bytes debugfs
153 			 * entries for the default case */
154 			if (p >= pos) {
155 				if (total + len >= count - 1)
156 					break;
157 				format_register_str(codec, i, buf + total, len);
158 				total += len;
159 			}
160 			p += len;
161 		}
162 	}
163 
164 	total = min(total, count - 1);
165 
166 	return total;
167 }
168 
169 static ssize_t codec_reg_show(struct device *dev,
170 	struct device_attribute *attr, char *buf)
171 {
172 	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
173 
174 	return soc_codec_reg_show(rtd->codec, buf, PAGE_SIZE, 0);
175 }
176 
177 static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
178 
179 static ssize_t pmdown_time_show(struct device *dev,
180 				struct device_attribute *attr, char *buf)
181 {
182 	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
183 
184 	return sprintf(buf, "%ld\n", rtd->pmdown_time);
185 }
186 
187 static ssize_t pmdown_time_set(struct device *dev,
188 			       struct device_attribute *attr,
189 			       const char *buf, size_t count)
190 {
191 	struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
192 	int ret;
193 
194 	ret = strict_strtol(buf, 10, &rtd->pmdown_time);
195 	if (ret)
196 		return ret;
197 
198 	return count;
199 }
200 
201 static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set);
202 
203 #ifdef CONFIG_DEBUG_FS
204 static int codec_reg_open_file(struct inode *inode, struct file *file)
205 {
206 	file->private_data = inode->i_private;
207 	return 0;
208 }
209 
210 static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
211 				   size_t count, loff_t *ppos)
212 {
213 	ssize_t ret;
214 	struct snd_soc_codec *codec = file->private_data;
215 	char *buf;
216 
217 	if (*ppos < 0 || !count)
218 		return -EINVAL;
219 
220 	buf = kmalloc(count, GFP_KERNEL);
221 	if (!buf)
222 		return -ENOMEM;
223 
224 	ret = soc_codec_reg_show(codec, buf, count, *ppos);
225 	if (ret >= 0) {
226 		if (copy_to_user(user_buf, buf, ret)) {
227 			kfree(buf);
228 			return -EFAULT;
229 		}
230 		*ppos += ret;
231 	}
232 
233 	kfree(buf);
234 	return ret;
235 }
236 
237 static ssize_t codec_reg_write_file(struct file *file,
238 		const char __user *user_buf, size_t count, loff_t *ppos)
239 {
240 	char buf[32];
241 	size_t buf_size;
242 	char *start = buf;
243 	unsigned long reg, value;
244 	struct snd_soc_codec *codec = file->private_data;
245 
246 	buf_size = min(count, (sizeof(buf)-1));
247 	if (copy_from_user(buf, user_buf, buf_size))
248 		return -EFAULT;
249 	buf[buf_size] = 0;
250 
251 	while (*start == ' ')
252 		start++;
253 	reg = simple_strtoul(start, &start, 16);
254 	while (*start == ' ')
255 		start++;
256 	if (strict_strtoul(start, 16, &value))
257 		return -EINVAL;
258 
259 	/* Userspace has been fiddling around behind the kernel's back */
260 	add_taint(TAINT_USER);
261 
262 	snd_soc_write(codec, reg, value);
263 	return buf_size;
264 }
265 
266 static const struct file_operations codec_reg_fops = {
267 	.open = codec_reg_open_file,
268 	.read = codec_reg_read_file,
269 	.write = codec_reg_write_file,
270 	.llseek = default_llseek,
271 };
272 
273 static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
274 {
275 	struct dentry *debugfs_card_root = codec->card->debugfs_card_root;
276 
277 	codec->debugfs_codec_root = debugfs_create_dir(codec->name,
278 						       debugfs_card_root);
279 	if (!codec->debugfs_codec_root) {
280 		printk(KERN_WARNING
281 		       "ASoC: Failed to create codec debugfs directory\n");
282 		return;
283 	}
284 
285 	debugfs_create_bool("cache_sync", 0444, codec->debugfs_codec_root,
286 			    &codec->cache_sync);
287 	debugfs_create_bool("cache_only", 0444, codec->debugfs_codec_root,
288 			    &codec->cache_only);
289 
290 	codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
291 						 codec->debugfs_codec_root,
292 						 codec, &codec_reg_fops);
293 	if (!codec->debugfs_reg)
294 		printk(KERN_WARNING
295 		       "ASoC: Failed to create codec register debugfs file\n");
296 
297 	snd_soc_dapm_debugfs_init(&codec->dapm, codec->debugfs_codec_root);
298 }
299 
300 static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
301 {
302 	debugfs_remove_recursive(codec->debugfs_codec_root);
303 }
304 
305 static ssize_t codec_list_read_file(struct file *file, char __user *user_buf,
306 				    size_t count, loff_t *ppos)
307 {
308 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
309 	ssize_t len, ret = 0;
310 	struct snd_soc_codec *codec;
311 
312 	if (!buf)
313 		return -ENOMEM;
314 
315 	list_for_each_entry(codec, &codec_list, list) {
316 		len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
317 			       codec->name);
318 		if (len >= 0)
319 			ret += len;
320 		if (ret > PAGE_SIZE) {
321 			ret = PAGE_SIZE;
322 			break;
323 		}
324 	}
325 
326 	if (ret >= 0)
327 		ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
328 
329 	kfree(buf);
330 
331 	return ret;
332 }
333 
334 static const struct file_operations codec_list_fops = {
335 	.read = codec_list_read_file,
336 	.llseek = default_llseek,/* read accesses f_pos */
337 };
338 
339 static ssize_t dai_list_read_file(struct file *file, char __user *user_buf,
340 				  size_t count, loff_t *ppos)
341 {
342 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
343 	ssize_t len, ret = 0;
344 	struct snd_soc_dai *dai;
345 
346 	if (!buf)
347 		return -ENOMEM;
348 
349 	list_for_each_entry(dai, &dai_list, list) {
350 		len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n", dai->name);
351 		if (len >= 0)
352 			ret += len;
353 		if (ret > PAGE_SIZE) {
354 			ret = PAGE_SIZE;
355 			break;
356 		}
357 	}
358 
359 	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
360 
361 	kfree(buf);
362 
363 	return ret;
364 }
365 
366 static const struct file_operations dai_list_fops = {
367 	.read = dai_list_read_file,
368 	.llseek = default_llseek,/* read accesses f_pos */
369 };
370 
371 static ssize_t platform_list_read_file(struct file *file,
372 				       char __user *user_buf,
373 				       size_t count, loff_t *ppos)
374 {
375 	char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
376 	ssize_t len, ret = 0;
377 	struct snd_soc_platform *platform;
378 
379 	if (!buf)
380 		return -ENOMEM;
381 
382 	list_for_each_entry(platform, &platform_list, list) {
383 		len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
384 			       platform->name);
385 		if (len >= 0)
386 			ret += len;
387 		if (ret > PAGE_SIZE) {
388 			ret = PAGE_SIZE;
389 			break;
390 		}
391 	}
392 
393 	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
394 
395 	kfree(buf);
396 
397 	return ret;
398 }
399 
400 static const struct file_operations platform_list_fops = {
401 	.read = platform_list_read_file,
402 	.llseek = default_llseek,/* read accesses f_pos */
403 };
404 
405 static void soc_init_card_debugfs(struct snd_soc_card *card)
406 {
407 	card->debugfs_card_root = debugfs_create_dir(card->name,
408 						     snd_soc_debugfs_root);
409 	if (!card->debugfs_card_root) {
410 		dev_warn(card->dev,
411 			 "ASoC: Failed to create card debugfs directory\n");
412 		return;
413 	}
414 
415 	card->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0644,
416 						    card->debugfs_card_root,
417 						    &card->pop_time);
418 	if (!card->debugfs_pop_time)
419 		dev_warn(card->dev,
420 		       "Failed to create pop time debugfs file\n");
421 }
422 
423 static void soc_cleanup_card_debugfs(struct snd_soc_card *card)
424 {
425 	debugfs_remove_recursive(card->debugfs_card_root);
426 }
427 
428 #else
429 
430 static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
431 {
432 }
433 
434 static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
435 {
436 }
437 
438 static inline void soc_init_card_debugfs(struct snd_soc_card *card)
439 {
440 }
441 
442 static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card)
443 {
444 }
445 #endif
446 
447 #ifdef CONFIG_SND_SOC_AC97_BUS
448 /* unregister ac97 codec */
449 static int soc_ac97_dev_unregister(struct snd_soc_codec *codec)
450 {
451 	if (codec->ac97->dev.bus)
452 		device_unregister(&codec->ac97->dev);
453 	return 0;
454 }
455 
456 /* stop no dev release warning */
457 static void soc_ac97_device_release(struct device *dev){}
458 
459 /* register ac97 codec to bus */
460 static int soc_ac97_dev_register(struct snd_soc_codec *codec)
461 {
462 	int err;
463 
464 	codec->ac97->dev.bus = &ac97_bus_type;
465 	codec->ac97->dev.parent = codec->card->dev;
466 	codec->ac97->dev.release = soc_ac97_device_release;
467 
468 	dev_set_name(&codec->ac97->dev, "%d-%d:%s",
469 		     codec->card->snd_card->number, 0, codec->name);
470 	err = device_register(&codec->ac97->dev);
471 	if (err < 0) {
472 		snd_printk(KERN_ERR "Can't register ac97 bus\n");
473 		codec->ac97->dev.bus = NULL;
474 		return err;
475 	}
476 	return 0;
477 }
478 #endif
479 
480 #ifdef CONFIG_PM_SLEEP
481 /* powers down audio subsystem for suspend */
482 int snd_soc_suspend(struct device *dev)
483 {
484 	struct snd_soc_card *card = dev_get_drvdata(dev);
485 	struct snd_soc_codec *codec;
486 	int i;
487 
488 	/* If the initialization of this soc device failed, there is no codec
489 	 * associated with it. Just bail out in this case.
490 	 */
491 	if (list_empty(&card->codec_dev_list))
492 		return 0;
493 
494 	/* Due to the resume being scheduled into a workqueue we could
495 	* suspend before that's finished - wait for it to complete.
496 	 */
497 	snd_power_lock(card->snd_card);
498 	snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0);
499 	snd_power_unlock(card->snd_card);
500 
501 	/* we're going to block userspace touching us until resume completes */
502 	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
503 
504 	/* mute any active DACs */
505 	for (i = 0; i < card->num_rtd; i++) {
506 		struct snd_soc_dai *dai = card->rtd[i].codec_dai;
507 		struct snd_soc_dai_driver *drv = dai->driver;
508 
509 		if (card->rtd[i].dai_link->ignore_suspend)
510 			continue;
511 
512 		if (drv->ops->digital_mute && dai->playback_active)
513 			drv->ops->digital_mute(dai, 1);
514 	}
515 
516 	/* suspend all pcms */
517 	for (i = 0; i < card->num_rtd; i++) {
518 		if (card->rtd[i].dai_link->ignore_suspend)
519 			continue;
520 
521 		snd_pcm_suspend_all(card->rtd[i].pcm);
522 	}
523 
524 	if (card->suspend_pre)
525 		card->suspend_pre(card);
526 
527 	for (i = 0; i < card->num_rtd; i++) {
528 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
529 		struct snd_soc_platform *platform = card->rtd[i].platform;
530 
531 		if (card->rtd[i].dai_link->ignore_suspend)
532 			continue;
533 
534 		if (cpu_dai->driver->suspend && !cpu_dai->driver->ac97_control)
535 			cpu_dai->driver->suspend(cpu_dai);
536 		if (platform->driver->suspend && !platform->suspended) {
537 			platform->driver->suspend(cpu_dai);
538 			platform->suspended = 1;
539 		}
540 	}
541 
542 	/* close any waiting streams and save state */
543 	for (i = 0; i < card->num_rtd; i++) {
544 		flush_delayed_work_sync(&card->rtd[i].delayed_work);
545 		card->rtd[i].codec->dapm.suspend_bias_level = card->rtd[i].codec->dapm.bias_level;
546 	}
547 
548 	for (i = 0; i < card->num_rtd; i++) {
549 		struct snd_soc_dai_driver *driver = card->rtd[i].codec_dai->driver;
550 
551 		if (card->rtd[i].dai_link->ignore_suspend)
552 			continue;
553 
554 		if (driver->playback.stream_name != NULL)
555 			snd_soc_dapm_stream_event(&card->rtd[i], driver->playback.stream_name,
556 				SND_SOC_DAPM_STREAM_SUSPEND);
557 
558 		if (driver->capture.stream_name != NULL)
559 			snd_soc_dapm_stream_event(&card->rtd[i], driver->capture.stream_name,
560 				SND_SOC_DAPM_STREAM_SUSPEND);
561 	}
562 
563 	/* suspend all CODECs */
564 	list_for_each_entry(codec, &card->codec_dev_list, card_list) {
565 		/* If there are paths active then the CODEC will be held with
566 		 * bias _ON and should not be suspended. */
567 		if (!codec->suspended && codec->driver->suspend) {
568 			switch (codec->dapm.bias_level) {
569 			case SND_SOC_BIAS_STANDBY:
570 				/*
571 				 * If the CODEC is capable of idle
572 				 * bias off then being in STANDBY
573 				 * means it's doing something,
574 				 * otherwise fall through.
575 				 */
576 				if (codec->dapm.idle_bias_off) {
577 					dev_dbg(codec->dev,
578 						"idle_bias_off CODEC on over suspend\n");
579 					break;
580 				}
581 			case SND_SOC_BIAS_OFF:
582 				codec->driver->suspend(codec);
583 				codec->suspended = 1;
584 				codec->cache_sync = 1;
585 				break;
586 			default:
587 				dev_dbg(codec->dev, "CODEC is on over suspend\n");
588 				break;
589 			}
590 		}
591 	}
592 
593 	for (i = 0; i < card->num_rtd; i++) {
594 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
595 
596 		if (card->rtd[i].dai_link->ignore_suspend)
597 			continue;
598 
599 		if (cpu_dai->driver->suspend && cpu_dai->driver->ac97_control)
600 			cpu_dai->driver->suspend(cpu_dai);
601 	}
602 
603 	if (card->suspend_post)
604 		card->suspend_post(card);
605 
606 	return 0;
607 }
608 EXPORT_SYMBOL_GPL(snd_soc_suspend);
609 
610 /* deferred resume work, so resume can complete before we finished
611  * setting our codec back up, which can be very slow on I2C
612  */
613 static void soc_resume_deferred(struct work_struct *work)
614 {
615 	struct snd_soc_card *card =
616 			container_of(work, struct snd_soc_card, deferred_resume_work);
617 	struct snd_soc_codec *codec;
618 	int i;
619 
620 	/* our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
621 	 * so userspace apps are blocked from touching us
622 	 */
623 
624 	dev_dbg(card->dev, "starting resume work\n");
625 
626 	/* Bring us up into D2 so that DAPM starts enabling things */
627 	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
628 
629 	if (card->resume_pre)
630 		card->resume_pre(card);
631 
632 	/* resume AC97 DAIs */
633 	for (i = 0; i < card->num_rtd; i++) {
634 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
635 
636 		if (card->rtd[i].dai_link->ignore_suspend)
637 			continue;
638 
639 		if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control)
640 			cpu_dai->driver->resume(cpu_dai);
641 	}
642 
643 	list_for_each_entry(codec, &card->codec_dev_list, card_list) {
644 		/* If the CODEC was idle over suspend then it will have been
645 		 * left with bias OFF or STANDBY and suspended so we must now
646 		 * resume.  Otherwise the suspend was suppressed.
647 		 */
648 		if (codec->driver->resume && codec->suspended) {
649 			switch (codec->dapm.bias_level) {
650 			case SND_SOC_BIAS_STANDBY:
651 			case SND_SOC_BIAS_OFF:
652 				codec->driver->resume(codec);
653 				codec->suspended = 0;
654 				break;
655 			default:
656 				dev_dbg(codec->dev, "CODEC was on over suspend\n");
657 				break;
658 			}
659 		}
660 	}
661 
662 	for (i = 0; i < card->num_rtd; i++) {
663 		struct snd_soc_dai_driver *driver = card->rtd[i].codec_dai->driver;
664 
665 		if (card->rtd[i].dai_link->ignore_suspend)
666 			continue;
667 
668 		if (driver->playback.stream_name != NULL)
669 			snd_soc_dapm_stream_event(&card->rtd[i], driver->playback.stream_name,
670 				SND_SOC_DAPM_STREAM_RESUME);
671 
672 		if (driver->capture.stream_name != NULL)
673 			snd_soc_dapm_stream_event(&card->rtd[i], driver->capture.stream_name,
674 				SND_SOC_DAPM_STREAM_RESUME);
675 	}
676 
677 	/* unmute any active DACs */
678 	for (i = 0; i < card->num_rtd; i++) {
679 		struct snd_soc_dai *dai = card->rtd[i].codec_dai;
680 		struct snd_soc_dai_driver *drv = dai->driver;
681 
682 		if (card->rtd[i].dai_link->ignore_suspend)
683 			continue;
684 
685 		if (drv->ops->digital_mute && dai->playback_active)
686 			drv->ops->digital_mute(dai, 0);
687 	}
688 
689 	for (i = 0; i < card->num_rtd; i++) {
690 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
691 		struct snd_soc_platform *platform = card->rtd[i].platform;
692 
693 		if (card->rtd[i].dai_link->ignore_suspend)
694 			continue;
695 
696 		if (cpu_dai->driver->resume && !cpu_dai->driver->ac97_control)
697 			cpu_dai->driver->resume(cpu_dai);
698 		if (platform->driver->resume && platform->suspended) {
699 			platform->driver->resume(cpu_dai);
700 			platform->suspended = 0;
701 		}
702 	}
703 
704 	if (card->resume_post)
705 		card->resume_post(card);
706 
707 	dev_dbg(card->dev, "resume work completed\n");
708 
709 	/* userspace can access us now we are back as we were before */
710 	snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
711 }
712 
713 /* powers up audio subsystem after a suspend */
714 int snd_soc_resume(struct device *dev)
715 {
716 	struct snd_soc_card *card = dev_get_drvdata(dev);
717 	int i, ac97_control = 0;
718 
719 	/* If the initialization of this soc device failed, there is no codec
720 	 * associated with it. Just bail out in this case.
721 	 */
722 	if (list_empty(&card->codec_dev_list))
723 		return 0;
724 
725 	/* AC97 devices might have other drivers hanging off them so
726 	 * need to resume immediately.  Other drivers don't have that
727 	 * problem and may take a substantial amount of time to resume
728 	 * due to I/O costs and anti-pop so handle them out of line.
729 	 */
730 	for (i = 0; i < card->num_rtd; i++) {
731 		struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
732 		ac97_control |= cpu_dai->driver->ac97_control;
733 	}
734 	if (ac97_control) {
735 		dev_dbg(dev, "Resuming AC97 immediately\n");
736 		soc_resume_deferred(&card->deferred_resume_work);
737 	} else {
738 		dev_dbg(dev, "Scheduling resume work\n");
739 		if (!schedule_work(&card->deferred_resume_work))
740 			dev_err(dev, "resume work item may be lost\n");
741 	}
742 
743 	return 0;
744 }
745 EXPORT_SYMBOL_GPL(snd_soc_resume);
746 #else
747 #define snd_soc_suspend NULL
748 #define snd_soc_resume NULL
749 #endif
750 
751 static const struct snd_soc_dai_ops null_dai_ops = {
752 };
753 
754 static int soc_bind_dai_link(struct snd_soc_card *card, int num)
755 {
756 	struct snd_soc_dai_link *dai_link = &card->dai_link[num];
757 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
758 	struct snd_soc_codec *codec;
759 	struct snd_soc_platform *platform;
760 	struct snd_soc_dai *codec_dai, *cpu_dai;
761 	const char *platform_name;
762 
763 	if (rtd->complete)
764 		return 1;
765 	dev_dbg(card->dev, "binding %s at idx %d\n", dai_link->name, num);
766 
767 	/* do we already have the CPU DAI for this link ? */
768 	if (rtd->cpu_dai) {
769 		goto find_codec;
770 	}
771 	/* no, then find CPU DAI from registered DAIs*/
772 	list_for_each_entry(cpu_dai, &dai_list, list) {
773 		if (dai_link->cpu_dai_of_node) {
774 			if (cpu_dai->dev->of_node != dai_link->cpu_dai_of_node)
775 				continue;
776 		} else {
777 			if (strcmp(cpu_dai->name, dai_link->cpu_dai_name))
778 				continue;
779 		}
780 
781 		rtd->cpu_dai = cpu_dai;
782 		goto find_codec;
783 	}
784 	dev_dbg(card->dev, "CPU DAI %s not registered\n",
785 			dai_link->cpu_dai_name);
786 
787 find_codec:
788 	/* do we already have the CODEC for this link ? */
789 	if (rtd->codec) {
790 		goto find_platform;
791 	}
792 
793 	/* no, then find CODEC from registered CODECs*/
794 	list_for_each_entry(codec, &codec_list, list) {
795 		if (dai_link->codec_of_node) {
796 			if (codec->dev->of_node != dai_link->codec_of_node)
797 				continue;
798 		} else {
799 			if (strcmp(codec->name, dai_link->codec_name))
800 				continue;
801 		}
802 
803 		rtd->codec = codec;
804 
805 		/*
806 		 * CODEC found, so find CODEC DAI from registered DAIs from
807 		 * this CODEC
808 		 */
809 		list_for_each_entry(codec_dai, &dai_list, list) {
810 			if (codec->dev == codec_dai->dev &&
811 				!strcmp(codec_dai->name,
812 					dai_link->codec_dai_name)) {
813 
814 				rtd->codec_dai = codec_dai;
815 				goto find_platform;
816 			}
817 		}
818 		dev_dbg(card->dev, "CODEC DAI %s not registered\n",
819 				dai_link->codec_dai_name);
820 
821 		goto find_platform;
822 	}
823 	dev_dbg(card->dev, "CODEC %s not registered\n",
824 			dai_link->codec_name);
825 
826 find_platform:
827 	/* do we need a platform? */
828 	if (rtd->platform)
829 		goto out;
830 
831 	/* if there's no platform we match on the empty platform */
832 	platform_name = dai_link->platform_name;
833 	if (!platform_name && !dai_link->platform_of_node)
834 		platform_name = "snd-soc-dummy";
835 
836 	/* no, then find one from the set of registered platforms */
837 	list_for_each_entry(platform, &platform_list, list) {
838 		if (dai_link->platform_of_node) {
839 			if (platform->dev->of_node !=
840 			    dai_link->platform_of_node)
841 				continue;
842 		} else {
843 			if (strcmp(platform->name, platform_name))
844 				continue;
845 		}
846 
847 		rtd->platform = platform;
848 		goto out;
849 	}
850 
851 	dev_dbg(card->dev, "platform %s not registered\n",
852 			dai_link->platform_name);
853 	return 0;
854 
855 out:
856 	/* mark rtd as complete if we found all 4 of our client devices */
857 	if (rtd->codec && rtd->codec_dai && rtd->platform && rtd->cpu_dai) {
858 		rtd->complete = 1;
859 		card->num_rtd++;
860 	}
861 	return 1;
862 }
863 
864 static void soc_remove_codec(struct snd_soc_codec *codec)
865 {
866 	int err;
867 
868 	if (codec->driver->remove) {
869 		err = codec->driver->remove(codec);
870 		if (err < 0)
871 			dev_err(codec->dev,
872 				"asoc: failed to remove %s: %d\n",
873 				codec->name, err);
874 	}
875 
876 	/* Make sure all DAPM widgets are freed */
877 	snd_soc_dapm_free(&codec->dapm);
878 
879 	soc_cleanup_codec_debugfs(codec);
880 	codec->probed = 0;
881 	list_del(&codec->card_list);
882 	module_put(codec->dev->driver->owner);
883 }
884 
885 static void soc_remove_dai_link(struct snd_soc_card *card, int num, int order)
886 {
887 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
888 	struct snd_soc_codec *codec = rtd->codec;
889 	struct snd_soc_platform *platform = rtd->platform;
890 	struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
891 	int err;
892 
893 	/* unregister the rtd device */
894 	if (rtd->dev_registered) {
895 		device_remove_file(rtd->dev, &dev_attr_pmdown_time);
896 		device_remove_file(rtd->dev, &dev_attr_codec_reg);
897 		device_unregister(rtd->dev);
898 		rtd->dev_registered = 0;
899 	}
900 
901 	/* remove the CODEC DAI */
902 	if (codec_dai && codec_dai->probed &&
903 			codec_dai->driver->remove_order == order) {
904 		if (codec_dai->driver->remove) {
905 			err = codec_dai->driver->remove(codec_dai);
906 			if (err < 0)
907 				printk(KERN_ERR "asoc: failed to remove %s\n", codec_dai->name);
908 		}
909 		codec_dai->probed = 0;
910 		list_del(&codec_dai->card_list);
911 	}
912 
913 	/* remove the platform */
914 	if (platform && platform->probed &&
915 			platform->driver->remove_order == order) {
916 		if (platform->driver->remove) {
917 			err = platform->driver->remove(platform);
918 			if (err < 0)
919 				printk(KERN_ERR "asoc: failed to remove %s\n", platform->name);
920 		}
921 
922 		/* Make sure all DAPM widgets are freed */
923 		snd_soc_dapm_free(&platform->dapm);
924 
925 		platform->probed = 0;
926 		list_del(&platform->card_list);
927 		module_put(platform->dev->driver->owner);
928 	}
929 
930 	/* remove the CODEC */
931 	if (codec && codec->probed &&
932 			codec->driver->remove_order == order)
933 		soc_remove_codec(codec);
934 
935 	/* remove the cpu_dai */
936 	if (cpu_dai && cpu_dai->probed &&
937 			cpu_dai->driver->remove_order == order) {
938 		if (cpu_dai->driver->remove) {
939 			err = cpu_dai->driver->remove(cpu_dai);
940 			if (err < 0)
941 				printk(KERN_ERR "asoc: failed to remove %s\n", cpu_dai->name);
942 		}
943 		cpu_dai->probed = 0;
944 		list_del(&cpu_dai->card_list);
945 		module_put(cpu_dai->dev->driver->owner);
946 	}
947 }
948 
949 static void soc_remove_dai_links(struct snd_soc_card *card)
950 {
951 	int dai, order;
952 
953 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
954 			order++) {
955 		for (dai = 0; dai < card->num_rtd; dai++)
956 			soc_remove_dai_link(card, dai, order);
957 	}
958 	card->num_rtd = 0;
959 }
960 
961 static void soc_set_name_prefix(struct snd_soc_card *card,
962 				struct snd_soc_codec *codec)
963 {
964 	int i;
965 
966 	if (card->codec_conf == NULL)
967 		return;
968 
969 	for (i = 0; i < card->num_configs; i++) {
970 		struct snd_soc_codec_conf *map = &card->codec_conf[i];
971 		if (map->dev_name && !strcmp(codec->name, map->dev_name)) {
972 			codec->name_prefix = map->name_prefix;
973 			break;
974 		}
975 	}
976 }
977 
978 static int soc_probe_codec(struct snd_soc_card *card,
979 			   struct snd_soc_codec *codec)
980 {
981 	int ret = 0;
982 	const struct snd_soc_codec_driver *driver = codec->driver;
983 
984 	codec->card = card;
985 	codec->dapm.card = card;
986 	soc_set_name_prefix(card, codec);
987 
988 	if (!try_module_get(codec->dev->driver->owner))
989 		return -ENODEV;
990 
991 	soc_init_codec_debugfs(codec);
992 
993 	if (driver->dapm_widgets)
994 		snd_soc_dapm_new_controls(&codec->dapm, driver->dapm_widgets,
995 					  driver->num_dapm_widgets);
996 
997 	codec->dapm.idle_bias_off = driver->idle_bias_off;
998 
999 	if (driver->probe) {
1000 		ret = driver->probe(codec);
1001 		if (ret < 0) {
1002 			dev_err(codec->dev,
1003 				"asoc: failed to probe CODEC %s: %d\n",
1004 				codec->name, ret);
1005 			goto err_probe;
1006 		}
1007 	}
1008 
1009 	if (driver->controls)
1010 		snd_soc_add_controls(codec, driver->controls,
1011 				     driver->num_controls);
1012 	if (driver->dapm_routes)
1013 		snd_soc_dapm_add_routes(&codec->dapm, driver->dapm_routes,
1014 					driver->num_dapm_routes);
1015 
1016 	/* mark codec as probed and add to card codec list */
1017 	codec->probed = 1;
1018 	list_add(&codec->card_list, &card->codec_dev_list);
1019 	list_add(&codec->dapm.list, &card->dapm_list);
1020 
1021 	return 0;
1022 
1023 err_probe:
1024 	soc_cleanup_codec_debugfs(codec);
1025 	module_put(codec->dev->driver->owner);
1026 
1027 	return ret;
1028 }
1029 
1030 static int soc_probe_platform(struct snd_soc_card *card,
1031 			   struct snd_soc_platform *platform)
1032 {
1033 	int ret = 0;
1034 	const struct snd_soc_platform_driver *driver = platform->driver;
1035 
1036 	platform->card = card;
1037 	platform->dapm.card = card;
1038 
1039 	if (!try_module_get(platform->dev->driver->owner))
1040 		return -ENODEV;
1041 
1042 	if (driver->dapm_widgets)
1043 		snd_soc_dapm_new_controls(&platform->dapm,
1044 			driver->dapm_widgets, driver->num_dapm_widgets);
1045 
1046 	if (driver->probe) {
1047 		ret = driver->probe(platform);
1048 		if (ret < 0) {
1049 			dev_err(platform->dev,
1050 				"asoc: failed to probe platform %s: %d\n",
1051 				platform->name, ret);
1052 			goto err_probe;
1053 		}
1054 	}
1055 
1056 	if (driver->controls)
1057 		snd_soc_add_platform_controls(platform, driver->controls,
1058 				     driver->num_controls);
1059 	if (driver->dapm_routes)
1060 		snd_soc_dapm_add_routes(&platform->dapm, driver->dapm_routes,
1061 					driver->num_dapm_routes);
1062 
1063 	/* mark platform as probed and add to card platform list */
1064 	platform->probed = 1;
1065 	list_add(&platform->card_list, &card->platform_dev_list);
1066 	list_add(&platform->dapm.list, &card->dapm_list);
1067 
1068 	return 0;
1069 
1070 err_probe:
1071 	module_put(platform->dev->driver->owner);
1072 
1073 	return ret;
1074 }
1075 
1076 static void rtd_release(struct device *dev)
1077 {
1078 	kfree(dev);
1079 }
1080 
1081 static int soc_post_component_init(struct snd_soc_card *card,
1082 				   struct snd_soc_codec *codec,
1083 				   int num, int dailess)
1084 {
1085 	struct snd_soc_dai_link *dai_link = NULL;
1086 	struct snd_soc_aux_dev *aux_dev = NULL;
1087 	struct snd_soc_pcm_runtime *rtd;
1088 	const char *temp, *name;
1089 	int ret = 0;
1090 
1091 	if (!dailess) {
1092 		dai_link = &card->dai_link[num];
1093 		rtd = &card->rtd[num];
1094 		name = dai_link->name;
1095 	} else {
1096 		aux_dev = &card->aux_dev[num];
1097 		rtd = &card->rtd_aux[num];
1098 		name = aux_dev->name;
1099 	}
1100 	rtd->card = card;
1101 
1102 	/* Make sure all DAPM widgets are instantiated */
1103 	snd_soc_dapm_new_widgets(&codec->dapm);
1104 
1105 	/* machine controls, routes and widgets are not prefixed */
1106 	temp = codec->name_prefix;
1107 	codec->name_prefix = NULL;
1108 
1109 	/* do machine specific initialization */
1110 	if (!dailess && dai_link->init)
1111 		ret = dai_link->init(rtd);
1112 	else if (dailess && aux_dev->init)
1113 		ret = aux_dev->init(&codec->dapm);
1114 	if (ret < 0) {
1115 		dev_err(card->dev, "asoc: failed to init %s: %d\n", name, ret);
1116 		return ret;
1117 	}
1118 	codec->name_prefix = temp;
1119 
1120 	/* register the rtd device */
1121 	rtd->codec = codec;
1122 
1123 	rtd->dev = kzalloc(sizeof(struct device), GFP_KERNEL);
1124 	if (!rtd->dev)
1125 		return -ENOMEM;
1126 	device_initialize(rtd->dev);
1127 	rtd->dev->parent = card->dev;
1128 	rtd->dev->release = rtd_release;
1129 	rtd->dev->init_name = name;
1130 	dev_set_drvdata(rtd->dev, rtd);
1131 	mutex_init(&rtd->pcm_mutex);
1132 	ret = device_add(rtd->dev);
1133 	if (ret < 0) {
1134 		dev_err(card->dev,
1135 			"asoc: failed to register runtime device: %d\n", ret);
1136 		return ret;
1137 	}
1138 	rtd->dev_registered = 1;
1139 
1140 	/* add DAPM sysfs entries for this codec */
1141 	ret = snd_soc_dapm_sys_add(rtd->dev);
1142 	if (ret < 0)
1143 		dev_err(codec->dev,
1144 			"asoc: failed to add codec dapm sysfs entries: %d\n",
1145 			ret);
1146 
1147 	/* add codec sysfs entries */
1148 	ret = device_create_file(rtd->dev, &dev_attr_codec_reg);
1149 	if (ret < 0)
1150 		dev_err(codec->dev,
1151 			"asoc: failed to add codec sysfs files: %d\n", ret);
1152 
1153 	return 0;
1154 }
1155 
1156 static int soc_probe_dai_link(struct snd_soc_card *card, int num, int order)
1157 {
1158 	struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1159 	struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1160 	struct snd_soc_codec *codec = rtd->codec;
1161 	struct snd_soc_platform *platform = rtd->platform;
1162 	struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
1163 	int ret;
1164 
1165 	dev_dbg(card->dev, "probe %s dai link %d late %d\n",
1166 			card->name, num, order);
1167 
1168 	/* config components */
1169 	codec_dai->codec = codec;
1170 	cpu_dai->platform = platform;
1171 	codec_dai->card = card;
1172 	cpu_dai->card = card;
1173 
1174 	/* set default power off timeout */
1175 	rtd->pmdown_time = pmdown_time;
1176 
1177 	/* probe the cpu_dai */
1178 	if (!cpu_dai->probed &&
1179 			cpu_dai->driver->probe_order == order) {
1180 		if (!try_module_get(cpu_dai->dev->driver->owner))
1181 			return -ENODEV;
1182 
1183 		if (cpu_dai->driver->probe) {
1184 			ret = cpu_dai->driver->probe(cpu_dai);
1185 			if (ret < 0) {
1186 				printk(KERN_ERR "asoc: failed to probe CPU DAI %s\n",
1187 						cpu_dai->name);
1188 				module_put(cpu_dai->dev->driver->owner);
1189 				return ret;
1190 			}
1191 		}
1192 		cpu_dai->probed = 1;
1193 		/* mark cpu_dai as probed and add to card dai list */
1194 		list_add(&cpu_dai->card_list, &card->dai_dev_list);
1195 	}
1196 
1197 	/* probe the CODEC */
1198 	if (!codec->probed &&
1199 			codec->driver->probe_order == order) {
1200 		ret = soc_probe_codec(card, codec);
1201 		if (ret < 0)
1202 			return ret;
1203 	}
1204 
1205 	/* probe the platform */
1206 	if (!platform->probed &&
1207 			platform->driver->probe_order == order) {
1208 		ret = soc_probe_platform(card, platform);
1209 		if (ret < 0)
1210 			return ret;
1211 	}
1212 
1213 	/* probe the CODEC DAI */
1214 	if (!codec_dai->probed && codec_dai->driver->probe_order == order) {
1215 		if (codec_dai->driver->probe) {
1216 			ret = codec_dai->driver->probe(codec_dai);
1217 			if (ret < 0) {
1218 				printk(KERN_ERR "asoc: failed to probe CODEC DAI %s\n",
1219 						codec_dai->name);
1220 				return ret;
1221 			}
1222 		}
1223 
1224 		/* mark codec_dai as probed and add to card dai list */
1225 		codec_dai->probed = 1;
1226 		list_add(&codec_dai->card_list, &card->dai_dev_list);
1227 	}
1228 
1229 	/* complete DAI probe during last probe */
1230 	if (order != SND_SOC_COMP_ORDER_LAST)
1231 		return 0;
1232 
1233 	ret = soc_post_component_init(card, codec, num, 0);
1234 	if (ret)
1235 		return ret;
1236 
1237 	ret = device_create_file(rtd->dev, &dev_attr_pmdown_time);
1238 	if (ret < 0)
1239 		printk(KERN_WARNING "asoc: failed to add pmdown_time sysfs\n");
1240 
1241 	/* create the pcm */
1242 	ret = soc_new_pcm(rtd, num);
1243 	if (ret < 0) {
1244 		printk(KERN_ERR "asoc: can't create pcm %s\n", dai_link->stream_name);
1245 		return ret;
1246 	}
1247 
1248 	/* add platform data for AC97 devices */
1249 	if (rtd->codec_dai->driver->ac97_control)
1250 		snd_ac97_dev_add_pdata(codec->ac97, rtd->cpu_dai->ac97_pdata);
1251 
1252 	return 0;
1253 }
1254 
1255 #ifdef CONFIG_SND_SOC_AC97_BUS
1256 static int soc_register_ac97_dai_link(struct snd_soc_pcm_runtime *rtd)
1257 {
1258 	int ret;
1259 
1260 	/* Only instantiate AC97 if not already done by the adaptor
1261 	 * for the generic AC97 subsystem.
1262 	 */
1263 	if (rtd->codec_dai->driver->ac97_control && !rtd->codec->ac97_registered) {
1264 		/*
1265 		 * It is possible that the AC97 device is already registered to
1266 		 * the device subsystem. This happens when the device is created
1267 		 * via snd_ac97_mixer(). Currently only SoC codec that does so
1268 		 * is the generic AC97 glue but others migh emerge.
1269 		 *
1270 		 * In those cases we don't try to register the device again.
1271 		 */
1272 		if (!rtd->codec->ac97_created)
1273 			return 0;
1274 
1275 		ret = soc_ac97_dev_register(rtd->codec);
1276 		if (ret < 0) {
1277 			printk(KERN_ERR "asoc: AC97 device register failed\n");
1278 			return ret;
1279 		}
1280 
1281 		rtd->codec->ac97_registered = 1;
1282 	}
1283 	return 0;
1284 }
1285 
1286 static void soc_unregister_ac97_dai_link(struct snd_soc_codec *codec)
1287 {
1288 	if (codec->ac97_registered) {
1289 		soc_ac97_dev_unregister(codec);
1290 		codec->ac97_registered = 0;
1291 	}
1292 }
1293 #endif
1294 
1295 static int soc_probe_aux_dev(struct snd_soc_card *card, int num)
1296 {
1297 	struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
1298 	struct snd_soc_codec *codec;
1299 	int ret = -ENODEV;
1300 
1301 	/* find CODEC from registered CODECs*/
1302 	list_for_each_entry(codec, &codec_list, list) {
1303 		if (!strcmp(codec->name, aux_dev->codec_name)) {
1304 			if (codec->probed) {
1305 				dev_err(codec->dev,
1306 					"asoc: codec already probed");
1307 				ret = -EBUSY;
1308 				goto out;
1309 			}
1310 			goto found;
1311 		}
1312 	}
1313 	/* codec not found */
1314 	dev_err(card->dev, "asoc: codec %s not found", aux_dev->codec_name);
1315 	goto out;
1316 
1317 found:
1318 	ret = soc_probe_codec(card, codec);
1319 	if (ret < 0)
1320 		return ret;
1321 
1322 	ret = soc_post_component_init(card, codec, num, 1);
1323 
1324 out:
1325 	return ret;
1326 }
1327 
1328 static void soc_remove_aux_dev(struct snd_soc_card *card, int num)
1329 {
1330 	struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
1331 	struct snd_soc_codec *codec = rtd->codec;
1332 
1333 	/* unregister the rtd device */
1334 	if (rtd->dev_registered) {
1335 		device_remove_file(rtd->dev, &dev_attr_codec_reg);
1336 		device_del(rtd->dev);
1337 		rtd->dev_registered = 0;
1338 	}
1339 
1340 	if (codec && codec->probed)
1341 		soc_remove_codec(codec);
1342 }
1343 
1344 static int snd_soc_init_codec_cache(struct snd_soc_codec *codec,
1345 				    enum snd_soc_compress_type compress_type)
1346 {
1347 	int ret;
1348 
1349 	if (codec->cache_init)
1350 		return 0;
1351 
1352 	/* override the compress_type if necessary */
1353 	if (compress_type && codec->compress_type != compress_type)
1354 		codec->compress_type = compress_type;
1355 	ret = snd_soc_cache_init(codec);
1356 	if (ret < 0) {
1357 		dev_err(codec->dev, "Failed to set cache compression type: %d\n",
1358 			ret);
1359 		return ret;
1360 	}
1361 	codec->cache_init = 1;
1362 	return 0;
1363 }
1364 
1365 static void snd_soc_instantiate_card(struct snd_soc_card *card)
1366 {
1367 	struct snd_soc_codec *codec;
1368 	struct snd_soc_codec_conf *codec_conf;
1369 	enum snd_soc_compress_type compress_type;
1370 	struct snd_soc_dai_link *dai_link;
1371 	int ret, i, order;
1372 
1373 	mutex_lock(&card->mutex);
1374 
1375 	if (card->instantiated) {
1376 		mutex_unlock(&card->mutex);
1377 		return;
1378 	}
1379 
1380 	/* bind DAIs */
1381 	for (i = 0; i < card->num_links; i++)
1382 		soc_bind_dai_link(card, i);
1383 
1384 	/* bind completed ? */
1385 	if (card->num_rtd != card->num_links) {
1386 		mutex_unlock(&card->mutex);
1387 		return;
1388 	}
1389 
1390 	/* initialize the register cache for each available codec */
1391 	list_for_each_entry(codec, &codec_list, list) {
1392 		if (codec->cache_init)
1393 			continue;
1394 		/* by default we don't override the compress_type */
1395 		compress_type = 0;
1396 		/* check to see if we need to override the compress_type */
1397 		for (i = 0; i < card->num_configs; ++i) {
1398 			codec_conf = &card->codec_conf[i];
1399 			if (!strcmp(codec->name, codec_conf->dev_name)) {
1400 				compress_type = codec_conf->compress_type;
1401 				if (compress_type && compress_type
1402 				    != codec->compress_type)
1403 					break;
1404 			}
1405 		}
1406 		ret = snd_soc_init_codec_cache(codec, compress_type);
1407 		if (ret < 0) {
1408 			mutex_unlock(&card->mutex);
1409 			return;
1410 		}
1411 	}
1412 
1413 	/* card bind complete so register a sound card */
1414 	ret = snd_card_create(SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
1415 			card->owner, 0, &card->snd_card);
1416 	if (ret < 0) {
1417 		printk(KERN_ERR "asoc: can't create sound card for card %s\n",
1418 			card->name);
1419 		mutex_unlock(&card->mutex);
1420 		return;
1421 	}
1422 	card->snd_card->dev = card->dev;
1423 
1424 	card->dapm.bias_level = SND_SOC_BIAS_OFF;
1425 	card->dapm.dev = card->dev;
1426 	card->dapm.card = card;
1427 	list_add(&card->dapm.list, &card->dapm_list);
1428 
1429 #ifdef CONFIG_DEBUG_FS
1430 	snd_soc_dapm_debugfs_init(&card->dapm, card->debugfs_card_root);
1431 #endif
1432 
1433 #ifdef CONFIG_PM_SLEEP
1434 	/* deferred resume work */
1435 	INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
1436 #endif
1437 
1438 	if (card->dapm_widgets)
1439 		snd_soc_dapm_new_controls(&card->dapm, card->dapm_widgets,
1440 					  card->num_dapm_widgets);
1441 
1442 	/* initialise the sound card only once */
1443 	if (card->probe) {
1444 		ret = card->probe(card);
1445 		if (ret < 0)
1446 			goto card_probe_error;
1447 	}
1448 
1449 	/* early DAI link probe */
1450 	for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
1451 			order++) {
1452 		for (i = 0; i < card->num_links; i++) {
1453 			ret = soc_probe_dai_link(card, i, order);
1454 			if (ret < 0) {
1455 				pr_err("asoc: failed to instantiate card %s: %d\n",
1456 			       card->name, ret);
1457 				goto probe_dai_err;
1458 			}
1459 		}
1460 	}
1461 
1462 	for (i = 0; i < card->num_aux_devs; i++) {
1463 		ret = soc_probe_aux_dev(card, i);
1464 		if (ret < 0) {
1465 			pr_err("asoc: failed to add auxiliary devices %s: %d\n",
1466 			       card->name, ret);
1467 			goto probe_aux_dev_err;
1468 		}
1469 	}
1470 
1471 	/* We should have a non-codec control add function but we don't */
1472 	if (card->controls)
1473 		snd_soc_add_controls(list_first_entry(&card->codec_dev_list,
1474 						      struct snd_soc_codec,
1475 						      card_list),
1476 				     card->controls,
1477 				     card->num_controls);
1478 
1479 	if (card->dapm_routes)
1480 		snd_soc_dapm_add_routes(&card->dapm, card->dapm_routes,
1481 					card->num_dapm_routes);
1482 
1483 	snd_soc_dapm_new_widgets(&card->dapm);
1484 
1485 	for (i = 0; i < card->num_links; i++) {
1486 		dai_link = &card->dai_link[i];
1487 
1488 		if (dai_link->dai_fmt) {
1489 			ret = snd_soc_dai_set_fmt(card->rtd[i].codec_dai,
1490 						  dai_link->dai_fmt);
1491 			if (ret != 0)
1492 				dev_warn(card->rtd[i].codec_dai->dev,
1493 					 "Failed to set DAI format: %d\n",
1494 					 ret);
1495 
1496 			ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai,
1497 						  dai_link->dai_fmt);
1498 			if (ret != 0)
1499 				dev_warn(card->rtd[i].cpu_dai->dev,
1500 					 "Failed to set DAI format: %d\n",
1501 					 ret);
1502 		}
1503 	}
1504 
1505 	snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname),
1506 		 "%s", card->name);
1507 	snprintf(card->snd_card->longname, sizeof(card->snd_card->longname),
1508 		 "%s", card->long_name ? card->long_name : card->name);
1509 	snprintf(card->snd_card->driver, sizeof(card->snd_card->driver),
1510 		 "%s", card->driver_name ? card->driver_name : card->name);
1511 	for (i = 0; i < ARRAY_SIZE(card->snd_card->driver); i++) {
1512 		switch (card->snd_card->driver[i]) {
1513 		case '_':
1514 		case '-':
1515 		case '\0':
1516 			break;
1517 		default:
1518 			if (!isalnum(card->snd_card->driver[i]))
1519 				card->snd_card->driver[i] = '_';
1520 			break;
1521 		}
1522 	}
1523 
1524 	if (card->late_probe) {
1525 		ret = card->late_probe(card);
1526 		if (ret < 0) {
1527 			dev_err(card->dev, "%s late_probe() failed: %d\n",
1528 				card->name, ret);
1529 			goto probe_aux_dev_err;
1530 		}
1531 	}
1532 
1533 	snd_soc_dapm_new_widgets(&card->dapm);
1534 
1535 	if (card->fully_routed)
1536 		list_for_each_entry(codec, &card->codec_dev_list, card_list)
1537 			snd_soc_dapm_auto_nc_codec_pins(codec);
1538 
1539 	ret = snd_card_register(card->snd_card);
1540 	if (ret < 0) {
1541 		printk(KERN_ERR "asoc: failed to register soundcard for %s\n", card->name);
1542 		goto probe_aux_dev_err;
1543 	}
1544 
1545 #ifdef CONFIG_SND_SOC_AC97_BUS
1546 	/* register any AC97 codecs */
1547 	for (i = 0; i < card->num_rtd; i++) {
1548 		ret = soc_register_ac97_dai_link(&card->rtd[i]);
1549 		if (ret < 0) {
1550 			printk(KERN_ERR "asoc: failed to register AC97 %s\n", card->name);
1551 			while (--i >= 0)
1552 				soc_unregister_ac97_dai_link(card->rtd[i].codec);
1553 			goto probe_aux_dev_err;
1554 		}
1555 	}
1556 #endif
1557 
1558 	card->instantiated = 1;
1559 	snd_soc_dapm_sync(&card->dapm);
1560 	mutex_unlock(&card->mutex);
1561 	return;
1562 
1563 probe_aux_dev_err:
1564 	for (i = 0; i < card->num_aux_devs; i++)
1565 		soc_remove_aux_dev(card, i);
1566 
1567 probe_dai_err:
1568 	soc_remove_dai_links(card);
1569 
1570 card_probe_error:
1571 	if (card->remove)
1572 		card->remove(card);
1573 
1574 	snd_card_free(card->snd_card);
1575 
1576 	mutex_unlock(&card->mutex);
1577 }
1578 
1579 /*
1580  * Attempt to initialise any uninitialised cards.  Must be called with
1581  * client_mutex.
1582  */
1583 static void snd_soc_instantiate_cards(void)
1584 {
1585 	struct snd_soc_card *card;
1586 	list_for_each_entry(card, &card_list, list)
1587 		snd_soc_instantiate_card(card);
1588 }
1589 
1590 /* probes a new socdev */
1591 static int soc_probe(struct platform_device *pdev)
1592 {
1593 	struct snd_soc_card *card = platform_get_drvdata(pdev);
1594 	int ret = 0;
1595 
1596 	/*
1597 	 * no card, so machine driver should be registering card
1598 	 * we should not be here in that case so ret error
1599 	 */
1600 	if (!card)
1601 		return -EINVAL;
1602 
1603 	/* Bodge while we unpick instantiation */
1604 	card->dev = &pdev->dev;
1605 
1606 	ret = snd_soc_register_card(card);
1607 	if (ret != 0) {
1608 		dev_err(&pdev->dev, "Failed to register card\n");
1609 		return ret;
1610 	}
1611 
1612 	return 0;
1613 }
1614 
1615 static int soc_cleanup_card_resources(struct snd_soc_card *card)
1616 {
1617 	int i;
1618 
1619 	/* make sure any delayed work runs */
1620 	for (i = 0; i < card->num_rtd; i++) {
1621 		struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
1622 		flush_delayed_work_sync(&rtd->delayed_work);
1623 	}
1624 
1625 	/* remove auxiliary devices */
1626 	for (i = 0; i < card->num_aux_devs; i++)
1627 		soc_remove_aux_dev(card, i);
1628 
1629 	/* remove and free each DAI */
1630 	soc_remove_dai_links(card);
1631 
1632 	soc_cleanup_card_debugfs(card);
1633 
1634 	/* remove the card */
1635 	if (card->remove)
1636 		card->remove(card);
1637 
1638 	snd_soc_dapm_free(&card->dapm);
1639 
1640 	kfree(card->rtd);
1641 	snd_card_free(card->snd_card);
1642 	return 0;
1643 
1644 }
1645 
1646 /* removes a socdev */
1647 static int soc_remove(struct platform_device *pdev)
1648 {
1649 	struct snd_soc_card *card = platform_get_drvdata(pdev);
1650 
1651 	snd_soc_unregister_card(card);
1652 	return 0;
1653 }
1654 
1655 int snd_soc_poweroff(struct device *dev)
1656 {
1657 	struct snd_soc_card *card = dev_get_drvdata(dev);
1658 	int i;
1659 
1660 	if (!card->instantiated)
1661 		return 0;
1662 
1663 	/* Flush out pmdown_time work - we actually do want to run it
1664 	 * now, we're shutting down so no imminent restart. */
1665 	for (i = 0; i < card->num_rtd; i++) {
1666 		struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
1667 		flush_delayed_work_sync(&rtd->delayed_work);
1668 	}
1669 
1670 	snd_soc_dapm_shutdown(card);
1671 
1672 	return 0;
1673 }
1674 EXPORT_SYMBOL_GPL(snd_soc_poweroff);
1675 
1676 const struct dev_pm_ops snd_soc_pm_ops = {
1677 	.suspend = snd_soc_suspend,
1678 	.resume = snd_soc_resume,
1679 	.poweroff = snd_soc_poweroff,
1680 };
1681 EXPORT_SYMBOL_GPL(snd_soc_pm_ops);
1682 
1683 /* ASoC platform driver */
1684 static struct platform_driver soc_driver = {
1685 	.driver		= {
1686 		.name		= "soc-audio",
1687 		.owner		= THIS_MODULE,
1688 		.pm		= &snd_soc_pm_ops,
1689 	},
1690 	.probe		= soc_probe,
1691 	.remove		= soc_remove,
1692 };
1693 
1694 /**
1695  * snd_soc_codec_volatile_register: Report if a register is volatile.
1696  *
1697  * @codec: CODEC to query.
1698  * @reg: Register to query.
1699  *
1700  * Boolean function indiciating if a CODEC register is volatile.
1701  */
1702 int snd_soc_codec_volatile_register(struct snd_soc_codec *codec,
1703 				    unsigned int reg)
1704 {
1705 	if (codec->volatile_register)
1706 		return codec->volatile_register(codec, reg);
1707 	else
1708 		return 0;
1709 }
1710 EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register);
1711 
1712 /**
1713  * snd_soc_codec_readable_register: Report if a register is readable.
1714  *
1715  * @codec: CODEC to query.
1716  * @reg: Register to query.
1717  *
1718  * Boolean function indicating if a CODEC register is readable.
1719  */
1720 int snd_soc_codec_readable_register(struct snd_soc_codec *codec,
1721 				    unsigned int reg)
1722 {
1723 	if (codec->readable_register)
1724 		return codec->readable_register(codec, reg);
1725 	else
1726 		return 1;
1727 }
1728 EXPORT_SYMBOL_GPL(snd_soc_codec_readable_register);
1729 
1730 /**
1731  * snd_soc_codec_writable_register: Report if a register is writable.
1732  *
1733  * @codec: CODEC to query.
1734  * @reg: Register to query.
1735  *
1736  * Boolean function indicating if a CODEC register is writable.
1737  */
1738 int snd_soc_codec_writable_register(struct snd_soc_codec *codec,
1739 				    unsigned int reg)
1740 {
1741 	if (codec->writable_register)
1742 		return codec->writable_register(codec, reg);
1743 	else
1744 		return 1;
1745 }
1746 EXPORT_SYMBOL_GPL(snd_soc_codec_writable_register);
1747 
1748 int snd_soc_platform_read(struct snd_soc_platform *platform,
1749 					unsigned int reg)
1750 {
1751 	unsigned int ret;
1752 
1753 	if (!platform->driver->read) {
1754 		dev_err(platform->dev, "platform has no read back\n");
1755 		return -1;
1756 	}
1757 
1758 	ret = platform->driver->read(platform, reg);
1759 	dev_dbg(platform->dev, "read %x => %x\n", reg, ret);
1760 	trace_snd_soc_preg_read(platform, reg, ret);
1761 
1762 	return ret;
1763 }
1764 EXPORT_SYMBOL_GPL(snd_soc_platform_read);
1765 
1766 int snd_soc_platform_write(struct snd_soc_platform *platform,
1767 					 unsigned int reg, unsigned int val)
1768 {
1769 	if (!platform->driver->write) {
1770 		dev_err(platform->dev, "platform has no write back\n");
1771 		return -1;
1772 	}
1773 
1774 	dev_dbg(platform->dev, "write %x = %x\n", reg, val);
1775 	trace_snd_soc_preg_write(platform, reg, val);
1776 	return platform->driver->write(platform, reg, val);
1777 }
1778 EXPORT_SYMBOL_GPL(snd_soc_platform_write);
1779 
1780 /**
1781  * snd_soc_new_ac97_codec - initailise AC97 device
1782  * @codec: audio codec
1783  * @ops: AC97 bus operations
1784  * @num: AC97 codec number
1785  *
1786  * Initialises AC97 codec resources for use by ad-hoc devices only.
1787  */
1788 int snd_soc_new_ac97_codec(struct snd_soc_codec *codec,
1789 	struct snd_ac97_bus_ops *ops, int num)
1790 {
1791 	mutex_lock(&codec->mutex);
1792 
1793 	codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL);
1794 	if (codec->ac97 == NULL) {
1795 		mutex_unlock(&codec->mutex);
1796 		return -ENOMEM;
1797 	}
1798 
1799 	codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL);
1800 	if (codec->ac97->bus == NULL) {
1801 		kfree(codec->ac97);
1802 		codec->ac97 = NULL;
1803 		mutex_unlock(&codec->mutex);
1804 		return -ENOMEM;
1805 	}
1806 
1807 	codec->ac97->bus->ops = ops;
1808 	codec->ac97->num = num;
1809 
1810 	/*
1811 	 * Mark the AC97 device to be created by us. This way we ensure that the
1812 	 * device will be registered with the device subsystem later on.
1813 	 */
1814 	codec->ac97_created = 1;
1815 
1816 	mutex_unlock(&codec->mutex);
1817 	return 0;
1818 }
1819 EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec);
1820 
1821 /**
1822  * snd_soc_free_ac97_codec - free AC97 codec device
1823  * @codec: audio codec
1824  *
1825  * Frees AC97 codec device resources.
1826  */
1827 void snd_soc_free_ac97_codec(struct snd_soc_codec *codec)
1828 {
1829 	mutex_lock(&codec->mutex);
1830 #ifdef CONFIG_SND_SOC_AC97_BUS
1831 	soc_unregister_ac97_dai_link(codec);
1832 #endif
1833 	kfree(codec->ac97->bus);
1834 	kfree(codec->ac97);
1835 	codec->ac97 = NULL;
1836 	codec->ac97_created = 0;
1837 	mutex_unlock(&codec->mutex);
1838 }
1839 EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec);
1840 
1841 unsigned int snd_soc_read(struct snd_soc_codec *codec, unsigned int reg)
1842 {
1843 	unsigned int ret;
1844 
1845 	ret = codec->read(codec, reg);
1846 	dev_dbg(codec->dev, "read %x => %x\n", reg, ret);
1847 	trace_snd_soc_reg_read(codec, reg, ret);
1848 
1849 	return ret;
1850 }
1851 EXPORT_SYMBOL_GPL(snd_soc_read);
1852 
1853 unsigned int snd_soc_write(struct snd_soc_codec *codec,
1854 			   unsigned int reg, unsigned int val)
1855 {
1856 	dev_dbg(codec->dev, "write %x = %x\n", reg, val);
1857 	trace_snd_soc_reg_write(codec, reg, val);
1858 	return codec->write(codec, reg, val);
1859 }
1860 EXPORT_SYMBOL_GPL(snd_soc_write);
1861 
1862 unsigned int snd_soc_bulk_write_raw(struct snd_soc_codec *codec,
1863 				    unsigned int reg, const void *data, size_t len)
1864 {
1865 	return codec->bulk_write_raw(codec, reg, data, len);
1866 }
1867 EXPORT_SYMBOL_GPL(snd_soc_bulk_write_raw);
1868 
1869 /**
1870  * snd_soc_update_bits - update codec register bits
1871  * @codec: audio codec
1872  * @reg: codec register
1873  * @mask: register mask
1874  * @value: new value
1875  *
1876  * Writes new register value.
1877  *
1878  * Returns 1 for change, 0 for no change, or negative error code.
1879  */
1880 int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg,
1881 				unsigned int mask, unsigned int value)
1882 {
1883 	int change;
1884 	unsigned int old, new;
1885 	int ret;
1886 
1887 	ret = snd_soc_read(codec, reg);
1888 	if (ret < 0)
1889 		return ret;
1890 
1891 	old = ret;
1892 	new = (old & ~mask) | (value & mask);
1893 	change = old != new;
1894 	if (change) {
1895 		ret = snd_soc_write(codec, reg, new);
1896 		if (ret < 0)
1897 			return ret;
1898 	}
1899 
1900 	return change;
1901 }
1902 EXPORT_SYMBOL_GPL(snd_soc_update_bits);
1903 
1904 /**
1905  * snd_soc_update_bits_locked - update codec register bits
1906  * @codec: audio codec
1907  * @reg: codec register
1908  * @mask: register mask
1909  * @value: new value
1910  *
1911  * Writes new register value, and takes the codec mutex.
1912  *
1913  * Returns 1 for change else 0.
1914  */
1915 int snd_soc_update_bits_locked(struct snd_soc_codec *codec,
1916 			       unsigned short reg, unsigned int mask,
1917 			       unsigned int value)
1918 {
1919 	int change;
1920 
1921 	mutex_lock(&codec->mutex);
1922 	change = snd_soc_update_bits(codec, reg, mask, value);
1923 	mutex_unlock(&codec->mutex);
1924 
1925 	return change;
1926 }
1927 EXPORT_SYMBOL_GPL(snd_soc_update_bits_locked);
1928 
1929 /**
1930  * snd_soc_test_bits - test register for change
1931  * @codec: audio codec
1932  * @reg: codec register
1933  * @mask: register mask
1934  * @value: new value
1935  *
1936  * Tests a register with a new value and checks if the new value is
1937  * different from the old value.
1938  *
1939  * Returns 1 for change else 0.
1940  */
1941 int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg,
1942 				unsigned int mask, unsigned int value)
1943 {
1944 	int change;
1945 	unsigned int old, new;
1946 
1947 	old = snd_soc_read(codec, reg);
1948 	new = (old & ~mask) | value;
1949 	change = old != new;
1950 
1951 	return change;
1952 }
1953 EXPORT_SYMBOL_GPL(snd_soc_test_bits);
1954 
1955 /**
1956  * snd_soc_set_runtime_hwparams - set the runtime hardware parameters
1957  * @substream: the pcm substream
1958  * @hw: the hardware parameters
1959  *
1960  * Sets the substream runtime hardware parameters.
1961  */
1962 int snd_soc_set_runtime_hwparams(struct snd_pcm_substream *substream,
1963 	const struct snd_pcm_hardware *hw)
1964 {
1965 	struct snd_pcm_runtime *runtime = substream->runtime;
1966 	runtime->hw.info = hw->info;
1967 	runtime->hw.formats = hw->formats;
1968 	runtime->hw.period_bytes_min = hw->period_bytes_min;
1969 	runtime->hw.period_bytes_max = hw->period_bytes_max;
1970 	runtime->hw.periods_min = hw->periods_min;
1971 	runtime->hw.periods_max = hw->periods_max;
1972 	runtime->hw.buffer_bytes_max = hw->buffer_bytes_max;
1973 	runtime->hw.fifo_size = hw->fifo_size;
1974 	return 0;
1975 }
1976 EXPORT_SYMBOL_GPL(snd_soc_set_runtime_hwparams);
1977 
1978 /**
1979  * snd_soc_cnew - create new control
1980  * @_template: control template
1981  * @data: control private data
1982  * @long_name: control long name
1983  * @prefix: control name prefix
1984  *
1985  * Create a new mixer control from a template control.
1986  *
1987  * Returns 0 for success, else error.
1988  */
1989 struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
1990 				  void *data, char *long_name,
1991 				  const char *prefix)
1992 {
1993 	struct snd_kcontrol_new template;
1994 	struct snd_kcontrol *kcontrol;
1995 	char *name = NULL;
1996 	int name_len;
1997 
1998 	memcpy(&template, _template, sizeof(template));
1999 	template.index = 0;
2000 
2001 	if (!long_name)
2002 		long_name = template.name;
2003 
2004 	if (prefix) {
2005 		name_len = strlen(long_name) + strlen(prefix) + 2;
2006 		name = kmalloc(name_len, GFP_KERNEL);
2007 		if (!name)
2008 			return NULL;
2009 
2010 		snprintf(name, name_len, "%s %s", prefix, long_name);
2011 
2012 		template.name = name;
2013 	} else {
2014 		template.name = long_name;
2015 	}
2016 
2017 	kcontrol = snd_ctl_new1(&template, data);
2018 
2019 	kfree(name);
2020 
2021 	return kcontrol;
2022 }
2023 EXPORT_SYMBOL_GPL(snd_soc_cnew);
2024 
2025 /**
2026  * snd_soc_add_controls - add an array of controls to a codec.
2027  * Convienience function to add a list of controls. Many codecs were
2028  * duplicating this code.
2029  *
2030  * @codec: codec to add controls to
2031  * @controls: array of controls to add
2032  * @num_controls: number of elements in the array
2033  *
2034  * Return 0 for success, else error.
2035  */
2036 int snd_soc_add_controls(struct snd_soc_codec *codec,
2037 	const struct snd_kcontrol_new *controls, int num_controls)
2038 {
2039 	struct snd_card *card = codec->card->snd_card;
2040 	int err, i;
2041 
2042 	for (i = 0; i < num_controls; i++) {
2043 		const struct snd_kcontrol_new *control = &controls[i];
2044 		err = snd_ctl_add(card, snd_soc_cnew(control, codec,
2045 						     control->name,
2046 						     codec->name_prefix));
2047 		if (err < 0) {
2048 			dev_err(codec->dev, "%s: Failed to add %s: %d\n",
2049 				codec->name, control->name, err);
2050 			return err;
2051 		}
2052 	}
2053 
2054 	return 0;
2055 }
2056 EXPORT_SYMBOL_GPL(snd_soc_add_controls);
2057 
2058 /**
2059  * snd_soc_add_platform_controls - add an array of controls to a platform.
2060  * Convienience function to add a list of controls.
2061  *
2062  * @platform: platform to add controls to
2063  * @controls: array of controls to add
2064  * @num_controls: number of elements in the array
2065  *
2066  * Return 0 for success, else error.
2067  */
2068 int snd_soc_add_platform_controls(struct snd_soc_platform *platform,
2069 	const struct snd_kcontrol_new *controls, int num_controls)
2070 {
2071 	struct snd_card *card = platform->card->snd_card;
2072 	int err, i;
2073 
2074 	for (i = 0; i < num_controls; i++) {
2075 		const struct snd_kcontrol_new *control = &controls[i];
2076 		err = snd_ctl_add(card, snd_soc_cnew(control, platform,
2077 				control->name, NULL));
2078 		if (err < 0) {
2079 			dev_err(platform->dev, "Failed to add %s %d\n",control->name, err);
2080 			return err;
2081 		}
2082 	}
2083 
2084 	return 0;
2085 }
2086 EXPORT_SYMBOL_GPL(snd_soc_add_platform_controls);
2087 
2088 /**
2089  * snd_soc_info_enum_double - enumerated double mixer info callback
2090  * @kcontrol: mixer control
2091  * @uinfo: control element information
2092  *
2093  * Callback to provide information about a double enumerated
2094  * mixer control.
2095  *
2096  * Returns 0 for success.
2097  */
2098 int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol,
2099 	struct snd_ctl_elem_info *uinfo)
2100 {
2101 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2102 
2103 	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2104 	uinfo->count = e->shift_l == e->shift_r ? 1 : 2;
2105 	uinfo->value.enumerated.items = e->max;
2106 
2107 	if (uinfo->value.enumerated.item > e->max - 1)
2108 		uinfo->value.enumerated.item = e->max - 1;
2109 	strcpy(uinfo->value.enumerated.name,
2110 		e->texts[uinfo->value.enumerated.item]);
2111 	return 0;
2112 }
2113 EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
2114 
2115 /**
2116  * snd_soc_get_enum_double - enumerated double mixer get callback
2117  * @kcontrol: mixer control
2118  * @ucontrol: control element information
2119  *
2120  * Callback to get the value of a double enumerated mixer.
2121  *
2122  * Returns 0 for success.
2123  */
2124 int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol,
2125 	struct snd_ctl_elem_value *ucontrol)
2126 {
2127 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2128 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2129 	unsigned int val, bitmask;
2130 
2131 	for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2132 		;
2133 	val = snd_soc_read(codec, e->reg);
2134 	ucontrol->value.enumerated.item[0]
2135 		= (val >> e->shift_l) & (bitmask - 1);
2136 	if (e->shift_l != e->shift_r)
2137 		ucontrol->value.enumerated.item[1] =
2138 			(val >> e->shift_r) & (bitmask - 1);
2139 
2140 	return 0;
2141 }
2142 EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
2143 
2144 /**
2145  * snd_soc_put_enum_double - enumerated double mixer put callback
2146  * @kcontrol: mixer control
2147  * @ucontrol: control element information
2148  *
2149  * Callback to set the value of a double enumerated mixer.
2150  *
2151  * Returns 0 for success.
2152  */
2153 int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol,
2154 	struct snd_ctl_elem_value *ucontrol)
2155 {
2156 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2157 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2158 	unsigned int val;
2159 	unsigned int mask, bitmask;
2160 
2161 	for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2162 		;
2163 	if (ucontrol->value.enumerated.item[0] > e->max - 1)
2164 		return -EINVAL;
2165 	val = ucontrol->value.enumerated.item[0] << e->shift_l;
2166 	mask = (bitmask - 1) << e->shift_l;
2167 	if (e->shift_l != e->shift_r) {
2168 		if (ucontrol->value.enumerated.item[1] > e->max - 1)
2169 			return -EINVAL;
2170 		val |= ucontrol->value.enumerated.item[1] << e->shift_r;
2171 		mask |= (bitmask - 1) << e->shift_r;
2172 	}
2173 
2174 	return snd_soc_update_bits_locked(codec, e->reg, mask, val);
2175 }
2176 EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
2177 
2178 /**
2179  * snd_soc_get_value_enum_double - semi enumerated double mixer get callback
2180  * @kcontrol: mixer control
2181  * @ucontrol: control element information
2182  *
2183  * Callback to get the value of a double semi enumerated mixer.
2184  *
2185  * Semi enumerated mixer: the enumerated items are referred as values. Can be
2186  * used for handling bitfield coded enumeration for example.
2187  *
2188  * Returns 0 for success.
2189  */
2190 int snd_soc_get_value_enum_double(struct snd_kcontrol *kcontrol,
2191 	struct snd_ctl_elem_value *ucontrol)
2192 {
2193 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2194 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2195 	unsigned int reg_val, val, mux;
2196 
2197 	reg_val = snd_soc_read(codec, e->reg);
2198 	val = (reg_val >> e->shift_l) & e->mask;
2199 	for (mux = 0; mux < e->max; mux++) {
2200 		if (val == e->values[mux])
2201 			break;
2202 	}
2203 	ucontrol->value.enumerated.item[0] = mux;
2204 	if (e->shift_l != e->shift_r) {
2205 		val = (reg_val >> e->shift_r) & e->mask;
2206 		for (mux = 0; mux < e->max; mux++) {
2207 			if (val == e->values[mux])
2208 				break;
2209 		}
2210 		ucontrol->value.enumerated.item[1] = mux;
2211 	}
2212 
2213 	return 0;
2214 }
2215 EXPORT_SYMBOL_GPL(snd_soc_get_value_enum_double);
2216 
2217 /**
2218  * snd_soc_put_value_enum_double - semi enumerated double mixer put callback
2219  * @kcontrol: mixer control
2220  * @ucontrol: control element information
2221  *
2222  * Callback to set the value of a double semi enumerated mixer.
2223  *
2224  * Semi enumerated mixer: the enumerated items are referred as values. Can be
2225  * used for handling bitfield coded enumeration for example.
2226  *
2227  * Returns 0 for success.
2228  */
2229 int snd_soc_put_value_enum_double(struct snd_kcontrol *kcontrol,
2230 	struct snd_ctl_elem_value *ucontrol)
2231 {
2232 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2233 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2234 	unsigned int val;
2235 	unsigned int mask;
2236 
2237 	if (ucontrol->value.enumerated.item[0] > e->max - 1)
2238 		return -EINVAL;
2239 	val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
2240 	mask = e->mask << e->shift_l;
2241 	if (e->shift_l != e->shift_r) {
2242 		if (ucontrol->value.enumerated.item[1] > e->max - 1)
2243 			return -EINVAL;
2244 		val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
2245 		mask |= e->mask << e->shift_r;
2246 	}
2247 
2248 	return snd_soc_update_bits_locked(codec, e->reg, mask, val);
2249 }
2250 EXPORT_SYMBOL_GPL(snd_soc_put_value_enum_double);
2251 
2252 /**
2253  * snd_soc_info_enum_ext - external enumerated single mixer info callback
2254  * @kcontrol: mixer control
2255  * @uinfo: control element information
2256  *
2257  * Callback to provide information about an external enumerated
2258  * single mixer.
2259  *
2260  * Returns 0 for success.
2261  */
2262 int snd_soc_info_enum_ext(struct snd_kcontrol *kcontrol,
2263 	struct snd_ctl_elem_info *uinfo)
2264 {
2265 	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2266 
2267 	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2268 	uinfo->count = 1;
2269 	uinfo->value.enumerated.items = e->max;
2270 
2271 	if (uinfo->value.enumerated.item > e->max - 1)
2272 		uinfo->value.enumerated.item = e->max - 1;
2273 	strcpy(uinfo->value.enumerated.name,
2274 		e->texts[uinfo->value.enumerated.item]);
2275 	return 0;
2276 }
2277 EXPORT_SYMBOL_GPL(snd_soc_info_enum_ext);
2278 
2279 /**
2280  * snd_soc_info_volsw_ext - external single mixer info callback
2281  * @kcontrol: mixer control
2282  * @uinfo: control element information
2283  *
2284  * Callback to provide information about a single external mixer control.
2285  *
2286  * Returns 0 for success.
2287  */
2288 int snd_soc_info_volsw_ext(struct snd_kcontrol *kcontrol,
2289 	struct snd_ctl_elem_info *uinfo)
2290 {
2291 	int max = kcontrol->private_value;
2292 
2293 	if (max == 1 && !strstr(kcontrol->id.name, " Volume"))
2294 		uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2295 	else
2296 		uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2297 
2298 	uinfo->count = 1;
2299 	uinfo->value.integer.min = 0;
2300 	uinfo->value.integer.max = max;
2301 	return 0;
2302 }
2303 EXPORT_SYMBOL_GPL(snd_soc_info_volsw_ext);
2304 
2305 /**
2306  * snd_soc_info_volsw - single mixer info callback
2307  * @kcontrol: mixer control
2308  * @uinfo: control element information
2309  *
2310  * Callback to provide information about a single mixer control, or a double
2311  * mixer control that spans 2 registers.
2312  *
2313  * Returns 0 for success.
2314  */
2315 int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
2316 	struct snd_ctl_elem_info *uinfo)
2317 {
2318 	struct soc_mixer_control *mc =
2319 		(struct soc_mixer_control *)kcontrol->private_value;
2320 	int platform_max;
2321 
2322 	if (!mc->platform_max)
2323 		mc->platform_max = mc->max;
2324 	platform_max = mc->platform_max;
2325 
2326 	if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
2327 		uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2328 	else
2329 		uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2330 
2331 	uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
2332 	uinfo->value.integer.min = 0;
2333 	uinfo->value.integer.max = platform_max;
2334 	return 0;
2335 }
2336 EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
2337 
2338 /**
2339  * snd_soc_get_volsw - single mixer get callback
2340  * @kcontrol: mixer control
2341  * @ucontrol: control element information
2342  *
2343  * Callback to get the value of a single mixer control, or a double mixer
2344  * control that spans 2 registers.
2345  *
2346  * Returns 0 for success.
2347  */
2348 int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
2349 	struct snd_ctl_elem_value *ucontrol)
2350 {
2351 	struct soc_mixer_control *mc =
2352 		(struct soc_mixer_control *)kcontrol->private_value;
2353 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2354 	unsigned int reg = mc->reg;
2355 	unsigned int reg2 = mc->rreg;
2356 	unsigned int shift = mc->shift;
2357 	unsigned int rshift = mc->rshift;
2358 	int max = mc->max;
2359 	unsigned int mask = (1 << fls(max)) - 1;
2360 	unsigned int invert = mc->invert;
2361 
2362 	ucontrol->value.integer.value[0] =
2363 		(snd_soc_read(codec, reg) >> shift) & mask;
2364 	if (invert)
2365 		ucontrol->value.integer.value[0] =
2366 			max - ucontrol->value.integer.value[0];
2367 
2368 	if (snd_soc_volsw_is_stereo(mc)) {
2369 		if (reg == reg2)
2370 			ucontrol->value.integer.value[1] =
2371 				(snd_soc_read(codec, reg) >> rshift) & mask;
2372 		else
2373 			ucontrol->value.integer.value[1] =
2374 				(snd_soc_read(codec, reg2) >> shift) & mask;
2375 		if (invert)
2376 			ucontrol->value.integer.value[1] =
2377 				max - ucontrol->value.integer.value[1];
2378 	}
2379 
2380 	return 0;
2381 }
2382 EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
2383 
2384 /**
2385  * snd_soc_put_volsw - single mixer put callback
2386  * @kcontrol: mixer control
2387  * @ucontrol: control element information
2388  *
2389  * Callback to set the value of a single mixer control, or a double mixer
2390  * control that spans 2 registers.
2391  *
2392  * Returns 0 for success.
2393  */
2394 int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
2395 	struct snd_ctl_elem_value *ucontrol)
2396 {
2397 	struct soc_mixer_control *mc =
2398 		(struct soc_mixer_control *)kcontrol->private_value;
2399 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2400 	unsigned int reg = mc->reg;
2401 	unsigned int reg2 = mc->rreg;
2402 	unsigned int shift = mc->shift;
2403 	unsigned int rshift = mc->rshift;
2404 	int max = mc->max;
2405 	unsigned int mask = (1 << fls(max)) - 1;
2406 	unsigned int invert = mc->invert;
2407 	int err;
2408 	bool type_2r = 0;
2409 	unsigned int val2 = 0;
2410 	unsigned int val, val_mask;
2411 
2412 	val = (ucontrol->value.integer.value[0] & mask);
2413 	if (invert)
2414 		val = max - val;
2415 	val_mask = mask << shift;
2416 	val = val << shift;
2417 	if (snd_soc_volsw_is_stereo(mc)) {
2418 		val2 = (ucontrol->value.integer.value[1] & mask);
2419 		if (invert)
2420 			val2 = max - val2;
2421 		if (reg == reg2) {
2422 			val_mask |= mask << rshift;
2423 			val |= val2 << rshift;
2424 		} else {
2425 			val2 = val2 << shift;
2426 			type_2r = 1;
2427 		}
2428 	}
2429 	err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
2430 	if (err < 0)
2431 		return err;
2432 
2433 	if (type_2r)
2434 		err = snd_soc_update_bits_locked(codec, reg2, val_mask, val2);
2435 
2436 	return err;
2437 }
2438 EXPORT_SYMBOL_GPL(snd_soc_put_volsw);
2439 
2440 /**
2441  * snd_soc_info_volsw_s8 - signed mixer info callback
2442  * @kcontrol: mixer control
2443  * @uinfo: control element information
2444  *
2445  * Callback to provide information about a signed mixer control.
2446  *
2447  * Returns 0 for success.
2448  */
2449 int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol,
2450 	struct snd_ctl_elem_info *uinfo)
2451 {
2452 	struct soc_mixer_control *mc =
2453 		(struct soc_mixer_control *)kcontrol->private_value;
2454 	int platform_max;
2455 	int min = mc->min;
2456 
2457 	if (!mc->platform_max)
2458 		mc->platform_max = mc->max;
2459 	platform_max = mc->platform_max;
2460 
2461 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2462 	uinfo->count = 2;
2463 	uinfo->value.integer.min = 0;
2464 	uinfo->value.integer.max = platform_max - min;
2465 	return 0;
2466 }
2467 EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8);
2468 
2469 /**
2470  * snd_soc_get_volsw_s8 - signed mixer get callback
2471  * @kcontrol: mixer control
2472  * @ucontrol: control element information
2473  *
2474  * Callback to get the value of a signed mixer control.
2475  *
2476  * Returns 0 for success.
2477  */
2478 int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol,
2479 	struct snd_ctl_elem_value *ucontrol)
2480 {
2481 	struct soc_mixer_control *mc =
2482 		(struct soc_mixer_control *)kcontrol->private_value;
2483 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2484 	unsigned int reg = mc->reg;
2485 	int min = mc->min;
2486 	int val = snd_soc_read(codec, reg);
2487 
2488 	ucontrol->value.integer.value[0] =
2489 		((signed char)(val & 0xff))-min;
2490 	ucontrol->value.integer.value[1] =
2491 		((signed char)((val >> 8) & 0xff))-min;
2492 	return 0;
2493 }
2494 EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8);
2495 
2496 /**
2497  * snd_soc_put_volsw_sgn - signed mixer put callback
2498  * @kcontrol: mixer control
2499  * @ucontrol: control element information
2500  *
2501  * Callback to set the value of a signed mixer control.
2502  *
2503  * Returns 0 for success.
2504  */
2505 int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol,
2506 	struct snd_ctl_elem_value *ucontrol)
2507 {
2508 	struct soc_mixer_control *mc =
2509 		(struct soc_mixer_control *)kcontrol->private_value;
2510 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2511 	unsigned int reg = mc->reg;
2512 	int min = mc->min;
2513 	unsigned int val;
2514 
2515 	val = (ucontrol->value.integer.value[0]+min) & 0xff;
2516 	val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8;
2517 
2518 	return snd_soc_update_bits_locked(codec, reg, 0xffff, val);
2519 }
2520 EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8);
2521 
2522 /**
2523  * snd_soc_limit_volume - Set new limit to an existing volume control.
2524  *
2525  * @codec: where to look for the control
2526  * @name: Name of the control
2527  * @max: new maximum limit
2528  *
2529  * Return 0 for success, else error.
2530  */
2531 int snd_soc_limit_volume(struct snd_soc_codec *codec,
2532 	const char *name, int max)
2533 {
2534 	struct snd_card *card = codec->card->snd_card;
2535 	struct snd_kcontrol *kctl;
2536 	struct soc_mixer_control *mc;
2537 	int found = 0;
2538 	int ret = -EINVAL;
2539 
2540 	/* Sanity check for name and max */
2541 	if (unlikely(!name || max <= 0))
2542 		return -EINVAL;
2543 
2544 	list_for_each_entry(kctl, &card->controls, list) {
2545 		if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) {
2546 			found = 1;
2547 			break;
2548 		}
2549 	}
2550 	if (found) {
2551 		mc = (struct soc_mixer_control *)kctl->private_value;
2552 		if (max <= mc->max) {
2553 			mc->platform_max = max;
2554 			ret = 0;
2555 		}
2556 	}
2557 	return ret;
2558 }
2559 EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
2560 
2561 /**
2562  * snd_soc_info_volsw_2r_sx - double with tlv and variable data size
2563  *  mixer info callback
2564  * @kcontrol: mixer control
2565  * @uinfo: control element information
2566  *
2567  * Returns 0 for success.
2568  */
2569 int snd_soc_info_volsw_2r_sx(struct snd_kcontrol *kcontrol,
2570 			struct snd_ctl_elem_info *uinfo)
2571 {
2572 	struct soc_mixer_control *mc =
2573 		(struct soc_mixer_control *)kcontrol->private_value;
2574 	int max = mc->max;
2575 	int min = mc->min;
2576 
2577 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2578 	uinfo->count = 2;
2579 	uinfo->value.integer.min = 0;
2580 	uinfo->value.integer.max = max-min;
2581 
2582 	return 0;
2583 }
2584 EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r_sx);
2585 
2586 /**
2587  * snd_soc_get_volsw_2r_sx - double with tlv and variable data size
2588  *  mixer get callback
2589  * @kcontrol: mixer control
2590  * @uinfo: control element information
2591  *
2592  * Returns 0 for success.
2593  */
2594 int snd_soc_get_volsw_2r_sx(struct snd_kcontrol *kcontrol,
2595 			struct snd_ctl_elem_value *ucontrol)
2596 {
2597 	struct soc_mixer_control *mc =
2598 		(struct soc_mixer_control *)kcontrol->private_value;
2599 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2600 	unsigned int mask = (1<<mc->shift)-1;
2601 	int min = mc->min;
2602 	int val = snd_soc_read(codec, mc->reg) & mask;
2603 	int valr = snd_soc_read(codec, mc->rreg) & mask;
2604 
2605 	ucontrol->value.integer.value[0] = ((val & 0xff)-min) & mask;
2606 	ucontrol->value.integer.value[1] = ((valr & 0xff)-min) & mask;
2607 	return 0;
2608 }
2609 EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r_sx);
2610 
2611 /**
2612  * snd_soc_put_volsw_2r_sx - double with tlv and variable data size
2613  *  mixer put callback
2614  * @kcontrol: mixer control
2615  * @uinfo: control element information
2616  *
2617  * Returns 0 for success.
2618  */
2619 int snd_soc_put_volsw_2r_sx(struct snd_kcontrol *kcontrol,
2620 			struct snd_ctl_elem_value *ucontrol)
2621 {
2622 	struct soc_mixer_control *mc =
2623 		(struct soc_mixer_control *)kcontrol->private_value;
2624 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2625 	unsigned int mask = (1<<mc->shift)-1;
2626 	int min = mc->min;
2627 	int ret;
2628 	unsigned int val, valr, oval, ovalr;
2629 
2630 	val = ((ucontrol->value.integer.value[0]+min) & 0xff);
2631 	val &= mask;
2632 	valr = ((ucontrol->value.integer.value[1]+min) & 0xff);
2633 	valr &= mask;
2634 
2635 	oval = snd_soc_read(codec, mc->reg) & mask;
2636 	ovalr = snd_soc_read(codec, mc->rreg) & mask;
2637 
2638 	ret = 0;
2639 	if (oval != val) {
2640 		ret = snd_soc_write(codec, mc->reg, val);
2641 		if (ret < 0)
2642 			return ret;
2643 	}
2644 	if (ovalr != valr) {
2645 		ret = snd_soc_write(codec, mc->rreg, valr);
2646 		if (ret < 0)
2647 			return ret;
2648 	}
2649 
2650 	return 0;
2651 }
2652 EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r_sx);
2653 
2654 /**
2655  * snd_soc_dai_set_sysclk - configure DAI system or master clock.
2656  * @dai: DAI
2657  * @clk_id: DAI specific clock ID
2658  * @freq: new clock frequency in Hz
2659  * @dir: new clock direction - input/output.
2660  *
2661  * Configures the DAI master (MCLK) or system (SYSCLK) clocking.
2662  */
2663 int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
2664 	unsigned int freq, int dir)
2665 {
2666 	if (dai->driver && dai->driver->ops->set_sysclk)
2667 		return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir);
2668 	else if (dai->codec && dai->codec->driver->set_sysclk)
2669 		return dai->codec->driver->set_sysclk(dai->codec, clk_id, 0,
2670 						      freq, dir);
2671 	else
2672 		return -EINVAL;
2673 }
2674 EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
2675 
2676 /**
2677  * snd_soc_codec_set_sysclk - configure CODEC system or master clock.
2678  * @codec: CODEC
2679  * @clk_id: DAI specific clock ID
2680  * @source: Source for the clock
2681  * @freq: new clock frequency in Hz
2682  * @dir: new clock direction - input/output.
2683  *
2684  * Configures the CODEC master (MCLK) or system (SYSCLK) clocking.
2685  */
2686 int snd_soc_codec_set_sysclk(struct snd_soc_codec *codec, int clk_id,
2687 			     int source, unsigned int freq, int dir)
2688 {
2689 	if (codec->driver->set_sysclk)
2690 		return codec->driver->set_sysclk(codec, clk_id, source,
2691 						 freq, dir);
2692 	else
2693 		return -EINVAL;
2694 }
2695 EXPORT_SYMBOL_GPL(snd_soc_codec_set_sysclk);
2696 
2697 /**
2698  * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
2699  * @dai: DAI
2700  * @div_id: DAI specific clock divider ID
2701  * @div: new clock divisor.
2702  *
2703  * Configures the clock dividers. This is used to derive the best DAI bit and
2704  * frame clocks from the system or master clock. It's best to set the DAI bit
2705  * and frame clocks as low as possible to save system power.
2706  */
2707 int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
2708 	int div_id, int div)
2709 {
2710 	if (dai->driver && dai->driver->ops->set_clkdiv)
2711 		return dai->driver->ops->set_clkdiv(dai, div_id, div);
2712 	else
2713 		return -EINVAL;
2714 }
2715 EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv);
2716 
2717 /**
2718  * snd_soc_dai_set_pll - configure DAI PLL.
2719  * @dai: DAI
2720  * @pll_id: DAI specific PLL ID
2721  * @source: DAI specific source for the PLL
2722  * @freq_in: PLL input clock frequency in Hz
2723  * @freq_out: requested PLL output clock frequency in Hz
2724  *
2725  * Configures and enables PLL to generate output clock based on input clock.
2726  */
2727 int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
2728 	unsigned int freq_in, unsigned int freq_out)
2729 {
2730 	if (dai->driver && dai->driver->ops->set_pll)
2731 		return dai->driver->ops->set_pll(dai, pll_id, source,
2732 					 freq_in, freq_out);
2733 	else if (dai->codec && dai->codec->driver->set_pll)
2734 		return dai->codec->driver->set_pll(dai->codec, pll_id, source,
2735 						   freq_in, freq_out);
2736 	else
2737 		return -EINVAL;
2738 }
2739 EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
2740 
2741 /*
2742  * snd_soc_codec_set_pll - configure codec PLL.
2743  * @codec: CODEC
2744  * @pll_id: DAI specific PLL ID
2745  * @source: DAI specific source for the PLL
2746  * @freq_in: PLL input clock frequency in Hz
2747  * @freq_out: requested PLL output clock frequency in Hz
2748  *
2749  * Configures and enables PLL to generate output clock based on input clock.
2750  */
2751 int snd_soc_codec_set_pll(struct snd_soc_codec *codec, int pll_id, int source,
2752 			  unsigned int freq_in, unsigned int freq_out)
2753 {
2754 	if (codec->driver->set_pll)
2755 		return codec->driver->set_pll(codec, pll_id, source,
2756 					      freq_in, freq_out);
2757 	else
2758 		return -EINVAL;
2759 }
2760 EXPORT_SYMBOL_GPL(snd_soc_codec_set_pll);
2761 
2762 /**
2763  * snd_soc_dai_set_fmt - configure DAI hardware audio format.
2764  * @dai: DAI
2765  * @fmt: SND_SOC_DAIFMT_ format value.
2766  *
2767  * Configures the DAI hardware format and clocking.
2768  */
2769 int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
2770 {
2771 	if (dai->driver && dai->driver->ops->set_fmt)
2772 		return dai->driver->ops->set_fmt(dai, fmt);
2773 	else
2774 		return -EINVAL;
2775 }
2776 EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
2777 
2778 /**
2779  * snd_soc_dai_set_tdm_slot - configure DAI TDM.
2780  * @dai: DAI
2781  * @tx_mask: bitmask representing active TX slots.
2782  * @rx_mask: bitmask representing active RX slots.
2783  * @slots: Number of slots in use.
2784  * @slot_width: Width in bits for each slot.
2785  *
2786  * Configures a DAI for TDM operation. Both mask and slots are codec and DAI
2787  * specific.
2788  */
2789 int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
2790 	unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
2791 {
2792 	if (dai->driver && dai->driver->ops->set_tdm_slot)
2793 		return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask,
2794 				slots, slot_width);
2795 	else
2796 		return -EINVAL;
2797 }
2798 EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
2799 
2800 /**
2801  * snd_soc_dai_set_channel_map - configure DAI audio channel map
2802  * @dai: DAI
2803  * @tx_num: how many TX channels
2804  * @tx_slot: pointer to an array which imply the TX slot number channel
2805  *           0~num-1 uses
2806  * @rx_num: how many RX channels
2807  * @rx_slot: pointer to an array which imply the RX slot number channel
2808  *           0~num-1 uses
2809  *
2810  * configure the relationship between channel number and TDM slot number.
2811  */
2812 int snd_soc_dai_set_channel_map(struct snd_soc_dai *dai,
2813 	unsigned int tx_num, unsigned int *tx_slot,
2814 	unsigned int rx_num, unsigned int *rx_slot)
2815 {
2816 	if (dai->driver && dai->driver->ops->set_channel_map)
2817 		return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot,
2818 			rx_num, rx_slot);
2819 	else
2820 		return -EINVAL;
2821 }
2822 EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map);
2823 
2824 /**
2825  * snd_soc_dai_set_tristate - configure DAI system or master clock.
2826  * @dai: DAI
2827  * @tristate: tristate enable
2828  *
2829  * Tristates the DAI so that others can use it.
2830  */
2831 int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
2832 {
2833 	if (dai->driver && dai->driver->ops->set_tristate)
2834 		return dai->driver->ops->set_tristate(dai, tristate);
2835 	else
2836 		return -EINVAL;
2837 }
2838 EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate);
2839 
2840 /**
2841  * snd_soc_dai_digital_mute - configure DAI system or master clock.
2842  * @dai: DAI
2843  * @mute: mute enable
2844  *
2845  * Mutes the DAI DAC.
2846  */
2847 int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute)
2848 {
2849 	if (dai->driver && dai->driver->ops->digital_mute)
2850 		return dai->driver->ops->digital_mute(dai, mute);
2851 	else
2852 		return -EINVAL;
2853 }
2854 EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
2855 
2856 /**
2857  * snd_soc_register_card - Register a card with the ASoC core
2858  *
2859  * @card: Card to register
2860  *
2861  */
2862 int snd_soc_register_card(struct snd_soc_card *card)
2863 {
2864 	int i;
2865 
2866 	if (!card->name || !card->dev)
2867 		return -EINVAL;
2868 
2869 	for (i = 0; i < card->num_links; i++) {
2870 		struct snd_soc_dai_link *link = &card->dai_link[i];
2871 
2872 		/*
2873 		 * Codec must be specified by 1 of name or OF node,
2874 		 * not both or neither.
2875 		 */
2876 		if (!!link->codec_name == !!link->codec_of_node) {
2877 			dev_err(card->dev,
2878 				"Neither/both codec name/of_node are set\n");
2879 			return -EINVAL;
2880 		}
2881 
2882 		/*
2883 		 * Platform may be specified by either name or OF node, but
2884 		 * can be left unspecified, and a dummy platform will be used.
2885 		 */
2886 		if (link->platform_name && link->platform_of_node) {
2887 			dev_err(card->dev,
2888 				"Both platform name/of_node are set\n");
2889 			return -EINVAL;
2890 		}
2891 
2892 		/*
2893 		 * CPU DAI must be specified by 1 of name or OF node,
2894 		 * not both or neither.
2895 		 */
2896 		if (!!link->cpu_dai_name == !!link->cpu_dai_of_node) {
2897 			dev_err(card->dev,
2898 				"Neither/both cpu_dai name/of_node are set\n");
2899 			return -EINVAL;
2900 		}
2901 	}
2902 
2903 	dev_set_drvdata(card->dev, card);
2904 
2905 	snd_soc_initialize_card_lists(card);
2906 
2907 	soc_init_card_debugfs(card);
2908 
2909 	card->rtd = kzalloc(sizeof(struct snd_soc_pcm_runtime) *
2910 			    (card->num_links + card->num_aux_devs),
2911 			    GFP_KERNEL);
2912 	if (card->rtd == NULL)
2913 		return -ENOMEM;
2914 	card->rtd_aux = &card->rtd[card->num_links];
2915 
2916 	for (i = 0; i < card->num_links; i++)
2917 		card->rtd[i].dai_link = &card->dai_link[i];
2918 
2919 	INIT_LIST_HEAD(&card->list);
2920 	INIT_LIST_HEAD(&card->dapm_dirty);
2921 	card->instantiated = 0;
2922 	mutex_init(&card->mutex);
2923 
2924 	mutex_lock(&client_mutex);
2925 	list_add(&card->list, &card_list);
2926 	snd_soc_instantiate_cards();
2927 	mutex_unlock(&client_mutex);
2928 
2929 	dev_dbg(card->dev, "Registered card '%s'\n", card->name);
2930 
2931 	return 0;
2932 }
2933 EXPORT_SYMBOL_GPL(snd_soc_register_card);
2934 
2935 /**
2936  * snd_soc_unregister_card - Unregister a card with the ASoC core
2937  *
2938  * @card: Card to unregister
2939  *
2940  */
2941 int snd_soc_unregister_card(struct snd_soc_card *card)
2942 {
2943 	if (card->instantiated)
2944 		soc_cleanup_card_resources(card);
2945 	mutex_lock(&client_mutex);
2946 	list_del(&card->list);
2947 	mutex_unlock(&client_mutex);
2948 	dev_dbg(card->dev, "Unregistered card '%s'\n", card->name);
2949 
2950 	return 0;
2951 }
2952 EXPORT_SYMBOL_GPL(snd_soc_unregister_card);
2953 
2954 /*
2955  * Simplify DAI link configuration by removing ".-1" from device names
2956  * and sanitizing names.
2957  */
2958 static char *fmt_single_name(struct device *dev, int *id)
2959 {
2960 	char *found, name[NAME_SIZE];
2961 	int id1, id2;
2962 
2963 	if (dev_name(dev) == NULL)
2964 		return NULL;
2965 
2966 	strlcpy(name, dev_name(dev), NAME_SIZE);
2967 
2968 	/* are we a "%s.%d" name (platform and SPI components) */
2969 	found = strstr(name, dev->driver->name);
2970 	if (found) {
2971 		/* get ID */
2972 		if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) {
2973 
2974 			/* discard ID from name if ID == -1 */
2975 			if (*id == -1)
2976 				found[strlen(dev->driver->name)] = '\0';
2977 		}
2978 
2979 	} else {
2980 		/* I2C component devices are named "bus-addr"  */
2981 		if (sscanf(name, "%x-%x", &id1, &id2) == 2) {
2982 			char tmp[NAME_SIZE];
2983 
2984 			/* create unique ID number from I2C addr and bus */
2985 			*id = ((id1 & 0xffff) << 16) + id2;
2986 
2987 			/* sanitize component name for DAI link creation */
2988 			snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name);
2989 			strlcpy(name, tmp, NAME_SIZE);
2990 		} else
2991 			*id = 0;
2992 	}
2993 
2994 	return kstrdup(name, GFP_KERNEL);
2995 }
2996 
2997 /*
2998  * Simplify DAI link naming for single devices with multiple DAIs by removing
2999  * any ".-1" and using the DAI name (instead of device name).
3000  */
3001 static inline char *fmt_multiple_name(struct device *dev,
3002 		struct snd_soc_dai_driver *dai_drv)
3003 {
3004 	if (dai_drv->name == NULL) {
3005 		printk(KERN_ERR "asoc: error - multiple DAI %s registered with no name\n",
3006 				dev_name(dev));
3007 		return NULL;
3008 	}
3009 
3010 	return kstrdup(dai_drv->name, GFP_KERNEL);
3011 }
3012 
3013 /**
3014  * snd_soc_register_dai - Register a DAI with the ASoC core
3015  *
3016  * @dai: DAI to register
3017  */
3018 int snd_soc_register_dai(struct device *dev,
3019 		struct snd_soc_dai_driver *dai_drv)
3020 {
3021 	struct snd_soc_dai *dai;
3022 
3023 	dev_dbg(dev, "dai register %s\n", dev_name(dev));
3024 
3025 	dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
3026 	if (dai == NULL)
3027 		return -ENOMEM;
3028 
3029 	/* create DAI component name */
3030 	dai->name = fmt_single_name(dev, &dai->id);
3031 	if (dai->name == NULL) {
3032 		kfree(dai);
3033 		return -ENOMEM;
3034 	}
3035 
3036 	dai->dev = dev;
3037 	dai->driver = dai_drv;
3038 	if (!dai->driver->ops)
3039 		dai->driver->ops = &null_dai_ops;
3040 
3041 	mutex_lock(&client_mutex);
3042 	list_add(&dai->list, &dai_list);
3043 	snd_soc_instantiate_cards();
3044 	mutex_unlock(&client_mutex);
3045 
3046 	pr_debug("Registered DAI '%s'\n", dai->name);
3047 
3048 	return 0;
3049 }
3050 EXPORT_SYMBOL_GPL(snd_soc_register_dai);
3051 
3052 /**
3053  * snd_soc_unregister_dai - Unregister a DAI from the ASoC core
3054  *
3055  * @dai: DAI to unregister
3056  */
3057 void snd_soc_unregister_dai(struct device *dev)
3058 {
3059 	struct snd_soc_dai *dai;
3060 
3061 	list_for_each_entry(dai, &dai_list, list) {
3062 		if (dev == dai->dev)
3063 			goto found;
3064 	}
3065 	return;
3066 
3067 found:
3068 	mutex_lock(&client_mutex);
3069 	list_del(&dai->list);
3070 	mutex_unlock(&client_mutex);
3071 
3072 	pr_debug("Unregistered DAI '%s'\n", dai->name);
3073 	kfree(dai->name);
3074 	kfree(dai);
3075 }
3076 EXPORT_SYMBOL_GPL(snd_soc_unregister_dai);
3077 
3078 /**
3079  * snd_soc_register_dais - Register multiple DAIs with the ASoC core
3080  *
3081  * @dai: Array of DAIs to register
3082  * @count: Number of DAIs
3083  */
3084 int snd_soc_register_dais(struct device *dev,
3085 		struct snd_soc_dai_driver *dai_drv, size_t count)
3086 {
3087 	struct snd_soc_dai *dai;
3088 	int i, ret = 0;
3089 
3090 	dev_dbg(dev, "dai register %s #%Zu\n", dev_name(dev), count);
3091 
3092 	for (i = 0; i < count; i++) {
3093 
3094 		dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
3095 		if (dai == NULL) {
3096 			ret = -ENOMEM;
3097 			goto err;
3098 		}
3099 
3100 		/* create DAI component name */
3101 		dai->name = fmt_multiple_name(dev, &dai_drv[i]);
3102 		if (dai->name == NULL) {
3103 			kfree(dai);
3104 			ret = -EINVAL;
3105 			goto err;
3106 		}
3107 
3108 		dai->dev = dev;
3109 		dai->driver = &dai_drv[i];
3110 		if (dai->driver->id)
3111 			dai->id = dai->driver->id;
3112 		else
3113 			dai->id = i;
3114 		if (!dai->driver->ops)
3115 			dai->driver->ops = &null_dai_ops;
3116 
3117 		mutex_lock(&client_mutex);
3118 		list_add(&dai->list, &dai_list);
3119 		mutex_unlock(&client_mutex);
3120 
3121 		pr_debug("Registered DAI '%s'\n", dai->name);
3122 	}
3123 
3124 	mutex_lock(&client_mutex);
3125 	snd_soc_instantiate_cards();
3126 	mutex_unlock(&client_mutex);
3127 	return 0;
3128 
3129 err:
3130 	for (i--; i >= 0; i--)
3131 		snd_soc_unregister_dai(dev);
3132 
3133 	return ret;
3134 }
3135 EXPORT_SYMBOL_GPL(snd_soc_register_dais);
3136 
3137 /**
3138  * snd_soc_unregister_dais - Unregister multiple DAIs from the ASoC core
3139  *
3140  * @dai: Array of DAIs to unregister
3141  * @count: Number of DAIs
3142  */
3143 void snd_soc_unregister_dais(struct device *dev, size_t count)
3144 {
3145 	int i;
3146 
3147 	for (i = 0; i < count; i++)
3148 		snd_soc_unregister_dai(dev);
3149 }
3150 EXPORT_SYMBOL_GPL(snd_soc_unregister_dais);
3151 
3152 /**
3153  * snd_soc_register_platform - Register a platform with the ASoC core
3154  *
3155  * @platform: platform to register
3156  */
3157 int snd_soc_register_platform(struct device *dev,
3158 		struct snd_soc_platform_driver *platform_drv)
3159 {
3160 	struct snd_soc_platform *platform;
3161 
3162 	dev_dbg(dev, "platform register %s\n", dev_name(dev));
3163 
3164 	platform = kzalloc(sizeof(struct snd_soc_platform), GFP_KERNEL);
3165 	if (platform == NULL)
3166 		return -ENOMEM;
3167 
3168 	/* create platform component name */
3169 	platform->name = fmt_single_name(dev, &platform->id);
3170 	if (platform->name == NULL) {
3171 		kfree(platform);
3172 		return -ENOMEM;
3173 	}
3174 
3175 	platform->dev = dev;
3176 	platform->driver = platform_drv;
3177 	platform->dapm.dev = dev;
3178 	platform->dapm.platform = platform;
3179 	platform->dapm.stream_event = platform_drv->stream_event;
3180 
3181 	mutex_lock(&client_mutex);
3182 	list_add(&platform->list, &platform_list);
3183 	snd_soc_instantiate_cards();
3184 	mutex_unlock(&client_mutex);
3185 
3186 	pr_debug("Registered platform '%s'\n", platform->name);
3187 
3188 	return 0;
3189 }
3190 EXPORT_SYMBOL_GPL(snd_soc_register_platform);
3191 
3192 /**
3193  * snd_soc_unregister_platform - Unregister a platform from the ASoC core
3194  *
3195  * @platform: platform to unregister
3196  */
3197 void snd_soc_unregister_platform(struct device *dev)
3198 {
3199 	struct snd_soc_platform *platform;
3200 
3201 	list_for_each_entry(platform, &platform_list, list) {
3202 		if (dev == platform->dev)
3203 			goto found;
3204 	}
3205 	return;
3206 
3207 found:
3208 	mutex_lock(&client_mutex);
3209 	list_del(&platform->list);
3210 	mutex_unlock(&client_mutex);
3211 
3212 	pr_debug("Unregistered platform '%s'\n", platform->name);
3213 	kfree(platform->name);
3214 	kfree(platform);
3215 }
3216 EXPORT_SYMBOL_GPL(snd_soc_unregister_platform);
3217 
3218 static u64 codec_format_map[] = {
3219 	SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE,
3220 	SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE,
3221 	SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_BE,
3222 	SNDRV_PCM_FMTBIT_U24_LE | SNDRV_PCM_FMTBIT_U24_BE,
3223 	SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE,
3224 	SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE,
3225 	SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
3226 	SNDRV_PCM_FMTBIT_U24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
3227 	SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S20_3BE,
3228 	SNDRV_PCM_FMTBIT_U20_3LE | SNDRV_PCM_FMTBIT_U20_3BE,
3229 	SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S18_3BE,
3230 	SNDRV_PCM_FMTBIT_U18_3LE | SNDRV_PCM_FMTBIT_U18_3BE,
3231 	SNDRV_PCM_FMTBIT_FLOAT_LE | SNDRV_PCM_FMTBIT_FLOAT_BE,
3232 	SNDRV_PCM_FMTBIT_FLOAT64_LE | SNDRV_PCM_FMTBIT_FLOAT64_BE,
3233 	SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE
3234 	| SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE,
3235 };
3236 
3237 /* Fix up the DAI formats for endianness: codecs don't actually see
3238  * the endianness of the data but we're using the CPU format
3239  * definitions which do need to include endianness so we ensure that
3240  * codec DAIs always have both big and little endian variants set.
3241  */
3242 static void fixup_codec_formats(struct snd_soc_pcm_stream *stream)
3243 {
3244 	int i;
3245 
3246 	for (i = 0; i < ARRAY_SIZE(codec_format_map); i++)
3247 		if (stream->formats & codec_format_map[i])
3248 			stream->formats |= codec_format_map[i];
3249 }
3250 
3251 /**
3252  * snd_soc_register_codec - Register a codec with the ASoC core
3253  *
3254  * @codec: codec to register
3255  */
3256 int snd_soc_register_codec(struct device *dev,
3257 			   const struct snd_soc_codec_driver *codec_drv,
3258 			   struct snd_soc_dai_driver *dai_drv,
3259 			   int num_dai)
3260 {
3261 	size_t reg_size;
3262 	struct snd_soc_codec *codec;
3263 	int ret, i;
3264 
3265 	dev_dbg(dev, "codec register %s\n", dev_name(dev));
3266 
3267 	codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
3268 	if (codec == NULL)
3269 		return -ENOMEM;
3270 
3271 	/* create CODEC component name */
3272 	codec->name = fmt_single_name(dev, &codec->id);
3273 	if (codec->name == NULL) {
3274 		kfree(codec);
3275 		return -ENOMEM;
3276 	}
3277 
3278 	if (codec_drv->compress_type)
3279 		codec->compress_type = codec_drv->compress_type;
3280 	else
3281 		codec->compress_type = SND_SOC_FLAT_COMPRESSION;
3282 
3283 	codec->write = codec_drv->write;
3284 	codec->read = codec_drv->read;
3285 	codec->volatile_register = codec_drv->volatile_register;
3286 	codec->readable_register = codec_drv->readable_register;
3287 	codec->writable_register = codec_drv->writable_register;
3288 	codec->dapm.bias_level = SND_SOC_BIAS_OFF;
3289 	codec->dapm.dev = dev;
3290 	codec->dapm.codec = codec;
3291 	codec->dapm.seq_notifier = codec_drv->seq_notifier;
3292 	codec->dapm.stream_event = codec_drv->stream_event;
3293 	codec->dev = dev;
3294 	codec->driver = codec_drv;
3295 	codec->num_dai = num_dai;
3296 	mutex_init(&codec->mutex);
3297 
3298 	/* allocate CODEC register cache */
3299 	if (codec_drv->reg_cache_size && codec_drv->reg_word_size) {
3300 		reg_size = codec_drv->reg_cache_size * codec_drv->reg_word_size;
3301 		codec->reg_size = reg_size;
3302 		/* it is necessary to make a copy of the default register cache
3303 		 * because in the case of using a compression type that requires
3304 		 * the default register cache to be marked as __devinitconst the
3305 		 * kernel might have freed the array by the time we initialize
3306 		 * the cache.
3307 		 */
3308 		if (codec_drv->reg_cache_default) {
3309 			codec->reg_def_copy = kmemdup(codec_drv->reg_cache_default,
3310 						      reg_size, GFP_KERNEL);
3311 			if (!codec->reg_def_copy) {
3312 				ret = -ENOMEM;
3313 				goto fail;
3314 			}
3315 		}
3316 	}
3317 
3318 	if (codec_drv->reg_access_size && codec_drv->reg_access_default) {
3319 		if (!codec->volatile_register)
3320 			codec->volatile_register = snd_soc_default_volatile_register;
3321 		if (!codec->readable_register)
3322 			codec->readable_register = snd_soc_default_readable_register;
3323 		if (!codec->writable_register)
3324 			codec->writable_register = snd_soc_default_writable_register;
3325 	}
3326 
3327 	for (i = 0; i < num_dai; i++) {
3328 		fixup_codec_formats(&dai_drv[i].playback);
3329 		fixup_codec_formats(&dai_drv[i].capture);
3330 	}
3331 
3332 	/* register any DAIs */
3333 	if (num_dai) {
3334 		ret = snd_soc_register_dais(dev, dai_drv, num_dai);
3335 		if (ret < 0)
3336 			goto fail;
3337 	}
3338 
3339 	mutex_lock(&client_mutex);
3340 	list_add(&codec->list, &codec_list);
3341 	snd_soc_instantiate_cards();
3342 	mutex_unlock(&client_mutex);
3343 
3344 	pr_debug("Registered codec '%s'\n", codec->name);
3345 	return 0;
3346 
3347 fail:
3348 	kfree(codec->reg_def_copy);
3349 	codec->reg_def_copy = NULL;
3350 	kfree(codec->name);
3351 	kfree(codec);
3352 	return ret;
3353 }
3354 EXPORT_SYMBOL_GPL(snd_soc_register_codec);
3355 
3356 /**
3357  * snd_soc_unregister_codec - Unregister a codec from the ASoC core
3358  *
3359  * @codec: codec to unregister
3360  */
3361 void snd_soc_unregister_codec(struct device *dev)
3362 {
3363 	struct snd_soc_codec *codec;
3364 	int i;
3365 
3366 	list_for_each_entry(codec, &codec_list, list) {
3367 		if (dev == codec->dev)
3368 			goto found;
3369 	}
3370 	return;
3371 
3372 found:
3373 	if (codec->num_dai)
3374 		for (i = 0; i < codec->num_dai; i++)
3375 			snd_soc_unregister_dai(dev);
3376 
3377 	mutex_lock(&client_mutex);
3378 	list_del(&codec->list);
3379 	mutex_unlock(&client_mutex);
3380 
3381 	pr_debug("Unregistered codec '%s'\n", codec->name);
3382 
3383 	snd_soc_cache_exit(codec);
3384 	kfree(codec->reg_def_copy);
3385 	kfree(codec->name);
3386 	kfree(codec);
3387 }
3388 EXPORT_SYMBOL_GPL(snd_soc_unregister_codec);
3389 
3390 /* Retrieve a card's name from device tree */
3391 int snd_soc_of_parse_card_name(struct snd_soc_card *card,
3392 			       const char *propname)
3393 {
3394 	struct device_node *np = card->dev->of_node;
3395 	int ret;
3396 
3397 	ret = of_property_read_string_index(np, propname, 0, &card->name);
3398 	/*
3399 	 * EINVAL means the property does not exist. This is fine providing
3400 	 * card->name was previously set, which is checked later in
3401 	 * snd_soc_register_card.
3402 	 */
3403 	if (ret < 0 && ret != -EINVAL) {
3404 		dev_err(card->dev,
3405 			"Property '%s' could not be read: %d\n",
3406 			propname, ret);
3407 		return ret;
3408 	}
3409 
3410 	return 0;
3411 }
3412 EXPORT_SYMBOL_GPL(snd_soc_of_parse_card_name);
3413 
3414 int snd_soc_of_parse_audio_routing(struct snd_soc_card *card,
3415 				   const char *propname)
3416 {
3417 	struct device_node *np = card->dev->of_node;
3418 	int num_routes;
3419 	struct snd_soc_dapm_route *routes;
3420 	int i, ret;
3421 
3422 	num_routes = of_property_count_strings(np, propname);
3423 	if (num_routes & 1) {
3424 		dev_err(card->dev,
3425 			"Property '%s's length is not even\n",
3426 			propname);
3427 		return -EINVAL;
3428 	}
3429 	num_routes /= 2;
3430 	if (!num_routes) {
3431 		dev_err(card->dev,
3432 			"Property '%s's length is zero\n",
3433 			propname);
3434 		return -EINVAL;
3435 	}
3436 
3437 	routes = devm_kzalloc(card->dev, num_routes * sizeof(*routes),
3438 			      GFP_KERNEL);
3439 	if (!routes) {
3440 		dev_err(card->dev,
3441 			"Could not allocate DAPM route table\n");
3442 		return -EINVAL;
3443 	}
3444 
3445 	for (i = 0; i < num_routes; i++) {
3446 		ret = of_property_read_string_index(np, propname,
3447 			2 * i, &routes[i].sink);
3448 		if (ret) {
3449 			dev_err(card->dev,
3450 				"Property '%s' index %d could not be read: %d\n",
3451 				propname, 2 * i, ret);
3452 			return -EINVAL;
3453 		}
3454 		ret = of_property_read_string_index(np, propname,
3455 			(2 * i) + 1, &routes[i].source);
3456 		if (ret) {
3457 			dev_err(card->dev,
3458 				"Property '%s' index %d could not be read: %d\n",
3459 				propname, (2 * i) + 1, ret);
3460 			return -EINVAL;
3461 		}
3462 	}
3463 
3464 	card->num_dapm_routes = num_routes;
3465 	card->dapm_routes = routes;
3466 
3467 	return 0;
3468 }
3469 EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_routing);
3470 
3471 static int __init snd_soc_init(void)
3472 {
3473 #ifdef CONFIG_DEBUG_FS
3474 	snd_soc_debugfs_root = debugfs_create_dir("asoc", NULL);
3475 	if (IS_ERR(snd_soc_debugfs_root) || !snd_soc_debugfs_root) {
3476 		printk(KERN_WARNING
3477 		       "ASoC: Failed to create debugfs directory\n");
3478 		snd_soc_debugfs_root = NULL;
3479 	}
3480 
3481 	if (!debugfs_create_file("codecs", 0444, snd_soc_debugfs_root, NULL,
3482 				 &codec_list_fops))
3483 		pr_warn("ASoC: Failed to create CODEC list debugfs file\n");
3484 
3485 	if (!debugfs_create_file("dais", 0444, snd_soc_debugfs_root, NULL,
3486 				 &dai_list_fops))
3487 		pr_warn("ASoC: Failed to create DAI list debugfs file\n");
3488 
3489 	if (!debugfs_create_file("platforms", 0444, snd_soc_debugfs_root, NULL,
3490 				 &platform_list_fops))
3491 		pr_warn("ASoC: Failed to create platform list debugfs file\n");
3492 #endif
3493 
3494 	snd_soc_util_init();
3495 
3496 	return platform_driver_register(&soc_driver);
3497 }
3498 module_init(snd_soc_init);
3499 
3500 static void __exit snd_soc_exit(void)
3501 {
3502 	snd_soc_util_exit();
3503 
3504 #ifdef CONFIG_DEBUG_FS
3505 	debugfs_remove_recursive(snd_soc_debugfs_root);
3506 #endif
3507 	platform_driver_unregister(&soc_driver);
3508 }
3509 module_exit(snd_soc_exit);
3510 
3511 /* Module information */
3512 MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
3513 MODULE_DESCRIPTION("ALSA SoC Core");
3514 MODULE_LICENSE("GPL");
3515 MODULE_ALIAS("platform:soc-audio");
3516