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