ASoC: max9850: Replace direct snd_soc_codec dapm field access
[deliverable/linux.git] / sound / soc / soc-core.c
CommitLineData
db2a4165
FM
1/*
2 * soc-core.c -- ALSA SoC Audio Layer
3 *
4 * Copyright 2005 Wolfson Microelectronics PLC.
0664d888 5 * Copyright 2005 Openedhand Ltd.
f0fba2ad
LG
6 * Copyright (C) 2010 Slimlogic Ltd.
7 * Copyright (C) 2010 Texas Instruments Inc.
0664d888 8 *
d331124d 9 * Author: Liam Girdwood <lrg@slimlogic.co.uk>
0664d888
LG
10 * with code, comments and ideas from :-
11 * Richard Purdie <richard@openedhand.com>
db2a4165
FM
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 *
db2a4165
FM
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>
12ef193d 31#include <linux/debugfs.h>
db2a4165 32#include <linux/platform_device.h>
741a509f 33#include <linux/pinctrl/consumer.h>
f0e8ed85 34#include <linux/ctype.h>
5a0e3ad6 35#include <linux/slab.h>
bec4fa05 36#include <linux/of.h>
db2a4165 37#include <sound/core.h>
3028eb8c 38#include <sound/jack.h>
db2a4165
FM
39#include <sound/pcm.h>
40#include <sound/pcm_params.h>
41#include <sound/soc.h>
01d7584c 42#include <sound/soc-dpcm.h>
db2a4165
FM
43#include <sound/initval.h>
44
a8b1d34f
MB
45#define CREATE_TRACE_POINTS
46#include <trace/events/asoc.h>
47
f0fba2ad
LG
48#define NAME_SIZE 32
49
384c89e2 50#ifdef CONFIG_DEBUG_FS
8a9dab1a
MB
51struct dentry *snd_soc_debugfs_root;
52EXPORT_SYMBOL_GPL(snd_soc_debugfs_root);
384c89e2
MB
53#endif
54
c5af3a2e 55static DEFINE_MUTEX(client_mutex);
12a48a8c 56static LIST_HEAD(platform_list);
0d0cf00a 57static LIST_HEAD(codec_list);
030e79f6 58static LIST_HEAD(component_list);
c5af3a2e 59
db2a4165
FM
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 */
65static int pmdown_time = 5000;
66module_param(pmdown_time, int, 0);
67MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
68
2bc9a81e
DP
69/* returns the minimum number of bytes needed to represent
70 * a particular given value */
71static 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
13fd179f
DP
87/* fill buf which is 'len' bytes with a formatted
88 * string of the form 'reg: value\n' */
89static int format_register_str(struct snd_soc_codec *codec,
90 unsigned int reg, char *buf, size_t len)
91{
00b317a4
SW
92 int wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
93 int regsize = codec->driver->reg_word_size * 2;
13fd179f
DP
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
25032c11 106 ret = snd_soc_read(codec, reg);
13fd179f
DP
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
2624d5fa 122/* codec register dump */
13fd179f
DP
123static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf,
124 size_t count, loff_t pos)
2624d5fa 125{
13fd179f 126 int i, step = 1;
2bc9a81e 127 int wordsize, regsize;
13fd179f
DP
128 int len;
129 size_t total = 0;
130 loff_t p = 0;
2bc9a81e 131
00b317a4
SW
132 wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
133 regsize = codec->driver->reg_word_size * 2;
2624d5fa 134
13fd179f
DP
135 len = wordsize + regsize + 2 + 1;
136
f0fba2ad 137 if (!codec->driver->reg_cache_size)
2624d5fa
MB
138 return 0;
139
f0fba2ad
LG
140 if (codec->driver->reg_cache_step)
141 step = codec->driver->reg_cache_step;
2624d5fa 142
f0fba2ad 143 for (i = 0; i < codec->driver->reg_cache_size; i += step) {
20a0ec27
LPC
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;
5164d74d 151 }
20a0ec27 152 p += len;
2624d5fa
MB
153 }
154
13fd179f 155 total = min(total, count - 1);
2624d5fa 156
13fd179f 157 return total;
2624d5fa 158}
13fd179f 159
2624d5fa
MB
160static ssize_t codec_reg_show(struct device *dev,
161 struct device_attribute *attr, char *buf)
162{
36ae1a96 163 struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
f0fba2ad 164
13fd179f 165 return soc_codec_reg_show(rtd->codec, buf, PAGE_SIZE, 0);
2624d5fa
MB
166}
167
168static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
169
dbe21408
MB
170static ssize_t pmdown_time_show(struct device *dev,
171 struct device_attribute *attr, char *buf)
172{
36ae1a96 173 struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
dbe21408 174
f0fba2ad 175 return sprintf(buf, "%ld\n", rtd->pmdown_time);
dbe21408
MB
176}
177
178static ssize_t pmdown_time_set(struct device *dev,
179 struct device_attribute *attr,
180 const char *buf, size_t count)
181{
36ae1a96 182 struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
c593b520 183 int ret;
dbe21408 184
b785a492 185 ret = kstrtol(buf, 10, &rtd->pmdown_time);
c593b520
MB
186 if (ret)
187 return ret;
dbe21408
MB
188
189 return count;
190}
191
192static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set);
193
d29697dc
TI
194static struct attribute *soc_dev_attrs[] = {
195 &dev_attr_codec_reg.attr,
196 &dev_attr_pmdown_time.attr,
197 NULL
198};
199
200static 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
211static const struct attribute_group soc_dapm_dev_group = {
212 .attrs = soc_dapm_dev_attrs,
213 .is_visible = soc_dev_attr_is_visible,
214};
215
216static const struct attribute_group soc_dev_roup = {
217 .attrs = soc_dev_attrs,
218 .is_visible = soc_dev_attr_is_visible,
219};
220
221static const struct attribute_group *soc_dev_attr_groups[] = {
222 &soc_dapm_dev_group,
223 &soc_dev_roup,
224 NULL
225};
226
2624d5fa 227#ifdef CONFIG_DEBUG_FS
2624d5fa 228static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
13fd179f 229 size_t count, loff_t *ppos)
2624d5fa
MB
230{
231 ssize_t ret;
232 struct snd_soc_codec *codec = file->private_data;
13fd179f
DP
233 char *buf;
234
235 if (*ppos < 0 || !count)
236 return -EINVAL;
237
238 buf = kmalloc(count, GFP_KERNEL);
2624d5fa
MB
239 if (!buf)
240 return -ENOMEM;
13fd179f
DP
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
2624d5fa
MB
251 kfree(buf);
252 return ret;
253}
254
255static 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];
34e268d8 259 size_t buf_size;
2624d5fa
MB
260 char *start = buf;
261 unsigned long reg, value;
2624d5fa 262 struct snd_soc_codec *codec = file->private_data;
b785a492 263 int ret;
2624d5fa
MB
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;
2624d5fa
MB
269
270 while (*start == ' ')
271 start++;
272 reg = simple_strtoul(start, &start, 16);
2624d5fa
MB
273 while (*start == ' ')
274 start++;
b785a492
JH
275 ret = kstrtoul(start, 16, &value);
276 if (ret)
277 return ret;
0d51a9cb
MB
278
279 /* Userspace has been fiddling around behind the kernel's back */
373d4d09 280 add_taint(TAINT_USER, LOCKDEP_NOW_UNRELIABLE);
0d51a9cb 281
e4f078d8 282 snd_soc_write(codec, reg, value);
2624d5fa
MB
283 return buf_size;
284}
285
286static const struct file_operations codec_reg_fops = {
234e3405 287 .open = simple_open,
2624d5fa
MB
288 .read = codec_reg_read_file,
289 .write = codec_reg_write_file,
6038f373 290 .llseek = default_llseek,
2624d5fa
MB
291};
292
81c7cfd1 293static void soc_init_component_debugfs(struct snd_soc_component *component)
e73f3de5 294{
6553bf06
LPC
295 if (!component->card->debugfs_card_root)
296 return;
297
81c7cfd1
LPC
298 if (component->debugfs_prefix) {
299 char *name;
e73f3de5 300
81c7cfd1
LPC
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 }
e73f3de5 312
81c7cfd1
LPC
313 if (!component->debugfs_root) {
314 dev_warn(component->dev,
315 "ASoC: Failed to create component debugfs directory\n");
316 return;
317 }
e73f3de5 318
81c7cfd1
LPC
319 snd_soc_dapm_debugfs_init(snd_soc_component_get_dapm(component),
320 component->debugfs_root);
e73f3de5 321
81c7cfd1
LPC
322 if (component->init_debugfs)
323 component->init_debugfs(component);
e73f3de5
RK
324}
325
81c7cfd1 326static void soc_cleanup_component_debugfs(struct snd_soc_component *component)
2624d5fa 327{
81c7cfd1
LPC
328 debugfs_remove_recursive(component->debugfs_root);
329}
d6ce4cf3 330
81c7cfd1
LPC
331static void soc_init_codec_debugfs(struct snd_soc_component *component)
332{
333 struct snd_soc_codec *codec = snd_soc_component_to_codec(component);
2624d5fa
MB
334
335 codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
81c7cfd1 336 codec->component.debugfs_root,
2624d5fa
MB
337 codec, &codec_reg_fops);
338 if (!codec->debugfs_reg)
10e8aa9a
MM
339 dev_warn(codec->dev,
340 "ASoC: Failed to create codec register debugfs file\n");
731f1ab2
SG
341}
342
c3c5a19a
MB
343static 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);
2b194f9d 347 ssize_t len, ret = 0;
c3c5a19a
MB
348 struct snd_soc_codec *codec;
349
350 if (!buf)
351 return -ENOMEM;
352
34e81ab4
LPC
353 mutex_lock(&client_mutex);
354
2b194f9d
MB
355 list_for_each_entry(codec, &codec_list, list) {
356 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
f4333203 357 codec->component.name);
2b194f9d
MB
358 if (len >= 0)
359 ret += len;
360 if (ret > PAGE_SIZE) {
361 ret = PAGE_SIZE;
362 break;
363 }
364 }
c3c5a19a 365
34e81ab4
LPC
366 mutex_unlock(&client_mutex);
367
c3c5a19a
MB
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
376static const struct file_operations codec_list_fops = {
377 .read = codec_list_read_file,
378 .llseek = default_llseek,/* read accesses f_pos */
379};
380
f3208780
MB
381static 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);
2b194f9d 385 ssize_t len, ret = 0;
1438c2f6 386 struct snd_soc_component *component;
f3208780
MB
387 struct snd_soc_dai *dai;
388
389 if (!buf)
390 return -ENOMEM;
391
34e81ab4
LPC
392 mutex_lock(&client_mutex);
393
1438c2f6
LPC
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 }
2b194f9d
MB
404 }
405 }
f3208780 406
34e81ab4
LPC
407 mutex_unlock(&client_mutex);
408
2b194f9d 409 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
f3208780
MB
410
411 kfree(buf);
412
413 return ret;
414}
415
416static const struct file_operations dai_list_fops = {
417 .read = dai_list_read_file,
418 .llseek = default_llseek,/* read accesses f_pos */
419};
420
19c7ac27
MB
421static 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);
2b194f9d 426 ssize_t len, ret = 0;
19c7ac27
MB
427 struct snd_soc_platform *platform;
428
429 if (!buf)
430 return -ENOMEM;
431
34e81ab4
LPC
432 mutex_lock(&client_mutex);
433
2b194f9d
MB
434 list_for_each_entry(platform, &platform_list, list) {
435 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
f4333203 436 platform->component.name);
2b194f9d
MB
437 if (len >= 0)
438 ret += len;
439 if (ret > PAGE_SIZE) {
440 ret = PAGE_SIZE;
441 break;
442 }
443 }
19c7ac27 444
34e81ab4
LPC
445 mutex_unlock(&client_mutex);
446
2b194f9d 447 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
19c7ac27
MB
448
449 kfree(buf);
450
451 return ret;
452}
453
454static const struct file_operations platform_list_fops = {
455 .read = platform_list_read_file,
456 .llseek = default_llseek,/* read accesses f_pos */
457};
458
a6052154
JN
459static void soc_init_card_debugfs(struct snd_soc_card *card)
460{
6553bf06
LPC
461 if (!snd_soc_debugfs_root)
462 return;
463
a6052154 464 card->debugfs_card_root = debugfs_create_dir(card->name,
8a9dab1a 465 snd_soc_debugfs_root);
3a45b867 466 if (!card->debugfs_card_root) {
a6052154 467 dev_warn(card->dev,
7c08be84 468 "ASoC: Failed to create card debugfs directory\n");
3a45b867
JN
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,
f110bfc7 477 "ASoC: Failed to create pop time debugfs file\n");
a6052154
JN
478}
479
480static void soc_cleanup_card_debugfs(struct snd_soc_card *card)
481{
482 debugfs_remove_recursive(card->debugfs_card_root);
483}
484
6553bf06
LPC
485
486static 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
508static void snd_soc_debugfs_exit(void)
509{
510 debugfs_remove_recursive(snd_soc_debugfs_root);
511}
512
2624d5fa
MB
513#else
514
81c7cfd1 515#define soc_init_codec_debugfs NULL
b95fccbc 516
81c7cfd1
LPC
517static inline void soc_init_component_debugfs(
518 struct snd_soc_component *component)
731f1ab2
SG
519{
520}
521
81c7cfd1
LPC
522static inline void soc_cleanup_component_debugfs(
523 struct snd_soc_component *component)
731f1ab2
SG
524{
525}
526
b95fccbc
AL
527static inline void soc_init_card_debugfs(struct snd_soc_card *card)
528{
529}
530
531static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card)
532{
533}
6553bf06
LPC
534
535static inline void snd_soc_debugfs_init(void)
536{
537}
538
539static inline void snd_soc_debugfs_exit(void)
540{
541}
542
2624d5fa
MB
543#endif
544
47c88fff
LG
545struct 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 }
f110bfc7 555 dev_dbg(card->dev, "ASoC: failed to find dai link %s\n", dai_link);
47c88fff
LG
556 return NULL;
557}
558EXPORT_SYMBOL_GPL(snd_soc_get_dai_substream);
559
560struct 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 }
f110bfc7 569 dev_dbg(card->dev, "ASoC: failed to find rtd %s\n", dai_link);
47c88fff
LG
570 return NULL;
571}
572EXPORT_SYMBOL_GPL(snd_soc_get_pcm_runtime);
573
9d58a077
RF
574static 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
6f8ab4ac 583#ifdef CONFIG_PM_SLEEP
db2a4165 584/* powers down audio subsystem for suspend */
6f8ab4ac 585int snd_soc_suspend(struct device *dev)
db2a4165 586{
6f8ab4ac 587 struct snd_soc_card *card = dev_get_drvdata(dev);
2eea392d 588 struct snd_soc_codec *codec;
88bd870f 589 int i, j;
db2a4165 590
c5599b87
LPC
591 /* If the card is not initialized yet there is nothing to do */
592 if (!card->instantiated)
e3509ff0
DM
593 return 0;
594
6ed25978
AG
595 /* Due to the resume being scheduled into a workqueue we could
596 * suspend before that's finished - wait for it to complete.
597 */
f0fba2ad
LG
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);
6ed25978
AG
601
602 /* we're going to block userspace touching us until resume completes */
f0fba2ad 603 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
6ed25978 604
a00f90f9 605 /* mute any active DACs */
f0fba2ad 606 for (i = 0; i < card->num_rtd; i++) {
3efab7dc 607
f0fba2ad 608 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
609 continue;
610
88bd870f
BC
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 }
db2a4165
FM
618 }
619
4ccab3e7 620 /* suspend all pcms */
f0fba2ad
LG
621 for (i = 0; i < card->num_rtd; i++) {
622 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
623 continue;
624
f0fba2ad 625 snd_pcm_suspend_all(card->rtd[i].pcm);
3efab7dc 626 }
4ccab3e7 627
87506549 628 if (card->suspend_pre)
70b2ac12 629 card->suspend_pre(card);
db2a4165 630
f0fba2ad
LG
631 for (i = 0; i < card->num_rtd; i++) {
632 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
3efab7dc 633
f0fba2ad 634 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
635 continue;
636
bc263214 637 if (cpu_dai->driver->suspend && !cpu_dai->driver->bus_control)
f0fba2ad 638 cpu_dai->driver->suspend(cpu_dai);
db2a4165
FM
639 }
640
37660b6d
LPC
641 /* close any waiting streams */
642 for (i = 0; i < card->num_rtd; i++)
43829731 643 flush_delayed_work(&card->rtd[i].delayed_work);
db2a4165 644
f0fba2ad 645 for (i = 0; i < card->num_rtd; i++) {
3efab7dc 646
f0fba2ad 647 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
648 continue;
649
7bd3a6f3
MB
650 snd_soc_dapm_stream_event(&card->rtd[i],
651 SNDRV_PCM_STREAM_PLAYBACK,
7bd3a6f3 652 SND_SOC_DAPM_STREAM_SUSPEND);
f0fba2ad 653
7bd3a6f3
MB
654 snd_soc_dapm_stream_event(&card->rtd[i],
655 SNDRV_PCM_STREAM_CAPTURE,
7bd3a6f3 656 SND_SOC_DAPM_STREAM_SUSPEND);
db2a4165
FM
657 }
658
8be4da29
LPC
659 /* Recheck all endpoints too, their state is affected by suspend */
660 dapm_mark_endpoints_dirty(card);
e2d32ff6
MB
661 snd_soc_dapm_sync(&card->dapm);
662
f0fba2ad 663 /* suspend all CODECs */
2eea392d 664 list_for_each_entry(codec, &card->codec_dev_list, card_list) {
f0fba2ad
LG
665 /* If there are paths active then the CODEC will be held with
666 * bias _ON and should not be suspended. */
a8093297 667 if (!codec->suspended) {
ce6120cc 668 switch (codec->dapm.bias_level) {
f0fba2ad 669 case SND_SOC_BIAS_STANDBY:
125a25da
MB
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,
10e8aa9a 678 "ASoC: idle_bias_off CODEC on over suspend\n");
125a25da
MB
679 break;
680 }
a8093297 681
f0fba2ad 682 case SND_SOC_BIAS_OFF:
a8093297
LPC
683 if (codec->driver->suspend)
684 codec->driver->suspend(codec);
f0fba2ad 685 codec->suspended = 1;
e2c330b9
LPC
686 if (codec->component.regmap)
687 regcache_mark_dirty(codec->component.regmap);
988e8cc4
NC
688 /* deactivate pins to sleep state */
689 pinctrl_pm_select_sleep_state(codec->dev);
f0fba2ad
LG
690 break;
691 default:
10e8aa9a
MM
692 dev_dbg(codec->dev,
693 "ASoC: CODEC is on over suspend\n");
f0fba2ad
LG
694 break;
695 }
1547aba9
MB
696 }
697 }
db2a4165 698
f0fba2ad
LG
699 for (i = 0; i < card->num_rtd; i++) {
700 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
3efab7dc 701
f0fba2ad 702 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
703 continue;
704
bc263214 705 if (cpu_dai->driver->suspend && cpu_dai->driver->bus_control)
f0fba2ad 706 cpu_dai->driver->suspend(cpu_dai);
988e8cc4
NC
707
708 /* deactivate pins to sleep state */
709 pinctrl_pm_select_sleep_state(cpu_dai->dev);
db2a4165
FM
710 }
711
87506549 712 if (card->suspend_post)
70b2ac12 713 card->suspend_post(card);
db2a4165
FM
714
715 return 0;
716}
6f8ab4ac 717EXPORT_SYMBOL_GPL(snd_soc_suspend);
db2a4165 718
6ed25978
AG
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 */
722static void soc_resume_deferred(struct work_struct *work)
db2a4165 723{
f0fba2ad
LG
724 struct snd_soc_card *card =
725 container_of(work, struct snd_soc_card, deferred_resume_work);
2eea392d 726 struct snd_soc_codec *codec;
88bd870f 727 int i, j;
db2a4165 728
6ed25978
AG
729 /* our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
730 * so userspace apps are blocked from touching us
731 */
732
f110bfc7 733 dev_dbg(card->dev, "ASoC: starting resume work\n");
6ed25978 734
9949788b 735 /* Bring us up into D2 so that DAPM starts enabling things */
f0fba2ad 736 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
9949788b 737
87506549 738 if (card->resume_pre)
70b2ac12 739 card->resume_pre(card);
db2a4165 740
bc263214 741 /* resume control bus DAIs */
f0fba2ad
LG
742 for (i = 0; i < card->num_rtd; i++) {
743 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
3efab7dc 744
f0fba2ad 745 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
746 continue;
747
bc263214 748 if (cpu_dai->driver->resume && cpu_dai->driver->bus_control)
f0fba2ad
LG
749 cpu_dai->driver->resume(cpu_dai);
750 }
751
2eea392d 752 list_for_each_entry(codec, &card->codec_dev_list, card_list) {
a8093297 753 if (codec->suspended) {
b8faaba4
LPC
754 if (codec->driver->resume)
755 codec->driver->resume(codec);
756 codec->suspended = 0;
1547aba9
MB
757 }
758 }
db2a4165 759
f0fba2ad 760 for (i = 0; i < card->num_rtd; i++) {
3efab7dc 761
f0fba2ad 762 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
763 continue;
764
7bd3a6f3 765 snd_soc_dapm_stream_event(&card->rtd[i],
d9b0951b 766 SNDRV_PCM_STREAM_PLAYBACK,
7bd3a6f3 767 SND_SOC_DAPM_STREAM_RESUME);
f0fba2ad 768
7bd3a6f3 769 snd_soc_dapm_stream_event(&card->rtd[i],
d9b0951b 770 SNDRV_PCM_STREAM_CAPTURE,
7bd3a6f3 771 SND_SOC_DAPM_STREAM_RESUME);
db2a4165
FM
772 }
773
3ff3f64b 774 /* unmute any active DACs */
f0fba2ad 775 for (i = 0; i < card->num_rtd; i++) {
3efab7dc 776
f0fba2ad 777 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
778 continue;
779
88bd870f
BC
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 }
db2a4165
FM
787 }
788
f0fba2ad
LG
789 for (i = 0; i < card->num_rtd; i++) {
790 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
3efab7dc 791
f0fba2ad 792 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
793 continue;
794
bc263214 795 if (cpu_dai->driver->resume && !cpu_dai->driver->bus_control)
f0fba2ad 796 cpu_dai->driver->resume(cpu_dai);
db2a4165
FM
797 }
798
87506549 799 if (card->resume_post)
70b2ac12 800 card->resume_post(card);
db2a4165 801
f110bfc7 802 dev_dbg(card->dev, "ASoC: resume work completed\n");
6ed25978
AG
803
804 /* userspace can access us now we are back as we were before */
f0fba2ad 805 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
e2d32ff6 806
8be4da29
LPC
807 /* Recheck all endpoints too, their state is affected by suspend */
808 dapm_mark_endpoints_dirty(card);
e2d32ff6 809 snd_soc_dapm_sync(&card->dapm);
6ed25978
AG
810}
811
812/* powers up audio subsystem after a suspend */
6f8ab4ac 813int snd_soc_resume(struct device *dev)
6ed25978 814{
6f8ab4ac 815 struct snd_soc_card *card = dev_get_drvdata(dev);
bc263214
LPC
816 bool bus_control = false;
817 int i;
b9dd94a8 818
c5599b87
LPC
819 /* If the card is not initialized yet there is nothing to do */
820 if (!card->instantiated)
5ff1ddf2
EM
821 return 0;
822
988e8cc4
NC
823 /* activate pins from sleep state */
824 for (i = 0; i < card->num_rtd; i++) {
88bd870f
BC
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
988e8cc4
NC
830 if (cpu_dai->active)
831 pinctrl_pm_select_default_state(cpu_dai->dev);
88bd870f
BC
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 }
988e8cc4
NC
838 }
839
bc263214
LPC
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
64ab9baa
MB
844 * due to I/O costs and anti-pop so handle them out of line.
845 */
f0fba2ad
LG
846 for (i = 0; i < card->num_rtd; i++) {
847 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
bc263214 848 bus_control |= cpu_dai->driver->bus_control;
82e14e8b 849 }
bc263214
LPC
850 if (bus_control) {
851 dev_dbg(dev, "ASoC: Resuming control bus master immediately\n");
82e14e8b
SW
852 soc_resume_deferred(&card->deferred_resume_work);
853 } else {
f110bfc7 854 dev_dbg(dev, "ASoC: Scheduling resume work\n");
82e14e8b 855 if (!schedule_work(&card->deferred_resume_work))
f110bfc7 856 dev_err(dev, "ASoC: resume work item may be lost\n");
64ab9baa 857 }
6ed25978 858
db2a4165
FM
859 return 0;
860}
6f8ab4ac 861EXPORT_SYMBOL_GPL(snd_soc_resume);
db2a4165 862#else
6f8ab4ac
MB
863#define snd_soc_suspend NULL
864#define snd_soc_resume NULL
db2a4165
FM
865#endif
866
85e7652d 867static const struct snd_soc_dai_ops null_dai_ops = {
02a06d30
BS
868};
869
65d9361f
LPC
870static struct snd_soc_component *soc_find_component(
871 const struct device_node *of_node, const char *name)
12023a9a 872{
65d9361f 873 struct snd_soc_component *component;
12023a9a 874
34e81ab4
LPC
875 lockdep_assert_held(&client_mutex);
876
65d9361f
LPC
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;
12023a9a 883 }
12023a9a
MLC
884 }
885
886 return NULL;
887}
888
14621c7e
LPC
889static struct snd_soc_dai *snd_soc_find_dai(
890 const struct snd_soc_dai_link_component *dlc)
12023a9a 891{
14621c7e
LPC
892 struct snd_soc_component *component;
893 struct snd_soc_dai *dai;
12023a9a 894
34e81ab4
LPC
895 lockdep_assert_held(&client_mutex);
896
14621c7e
LPC
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;
1ffae361 901 if (dlc->name && strcmp(component->name, dlc->name))
14621c7e
LPC
902 continue;
903 list_for_each_entry(dai, &component->dai_list, list) {
904 if (dlc->dai_name && strcmp(dai->name, dlc->dai_name))
12023a9a 905 continue;
12023a9a 906
14621c7e 907 return dai;
12023a9a
MLC
908 }
909 }
910
911 return NULL;
912}
913
f0fba2ad 914static int soc_bind_dai_link(struct snd_soc_card *card, int num)
db2a4165 915{
f0fba2ad
LG
916 struct snd_soc_dai_link *dai_link = &card->dai_link[num];
917 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
88bd870f 918 struct snd_soc_dai_link_component *codecs = dai_link->codecs;
14621c7e 919 struct snd_soc_dai_link_component cpu_dai_component;
88bd870f 920 struct snd_soc_dai **codec_dais = rtd->codec_dais;
435c5e25 921 struct snd_soc_platform *platform;
848dd8be 922 const char *platform_name;
88bd870f 923 int i;
435c5e25 924
f110bfc7 925 dev_dbg(card->dev, "ASoC: binding %s at idx %d\n", dai_link->name, num);
435c5e25 926
14621c7e
LPC
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);
b19e6e7b 931 if (!rtd->cpu_dai) {
f110bfc7 932 dev_err(card->dev, "ASoC: CPU DAI %s not registered\n",
b19e6e7b
MB
933 dai_link->cpu_dai_name);
934 return -EPROBE_DEFER;
f0fba2ad
LG
935 }
936
88bd870f 937 rtd->num_codecs = dai_link->num_codecs;
848dd8be 938
88bd870f
BC
939 /* Find CODEC from registered CODECs */
940 for (i = 0; i < rtd->num_codecs; i++) {
14621c7e 941 codec_dais[i] = snd_soc_find_dai(&codecs[i]);
88bd870f
BC
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 }
12023a9a
MLC
947 }
948
88bd870f
BC
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
848dd8be
MB
953 /* if there's no platform we match on the empty platform */
954 platform_name = dai_link->platform_name;
5a504963 955 if (!platform_name && !dai_link->platform_of_node)
848dd8be
MB
956 platform_name = "snd-soc-dummy";
957
b19e6e7b 958 /* find one from the set of registered platforms */
f0fba2ad 959 list_for_each_entry(platform, &platform_list, list) {
5a504963
SW
960 if (dai_link->platform_of_node) {
961 if (platform->dev->of_node !=
962 dai_link->platform_of_node)
963 continue;
964 } else {
f4333203 965 if (strcmp(platform->component.name, platform_name))
5a504963
SW
966 continue;
967 }
2610ab77
SW
968
969 rtd->platform = platform;
02a06d30 970 }
b19e6e7b 971 if (!rtd->platform) {
f110bfc7 972 dev_err(card->dev, "ASoC: platform %s not registered\n",
f0fba2ad 973 dai_link->platform_name);
b19e6e7b 974 return -EPROBE_DEFER;
f0fba2ad 975 }
b19e6e7b
MB
976
977 card->num_rtd++;
978
979 return 0;
f0fba2ad
LG
980}
981
f1d45cc3 982static void soc_remove_component(struct snd_soc_component *component)
d12cd198 983{
70090bbb
LPC
984 if (!component->probed)
985 return;
d12cd198 986
f1d45cc3
LPC
987 /* This is a HACK and will be removed soon */
988 if (component->codec)
989 list_del(&component->codec->card_list);
589c3563 990
f1d45cc3
LPC
991 if (component->remove)
992 component->remove(component);
589c3563 993
f1d45cc3 994 snd_soc_dapm_free(snd_soc_component_get_dapm(component));
589c3563 995
f1d45cc3
LPC
996 soc_cleanup_component_debugfs(component);
997 component->probed = 0;
998 module_put(component->dev->driver->owner);
589c3563
JN
999}
1000
e60cd14f 1001static void soc_remove_dai(struct snd_soc_dai *dai, int order)
f0fba2ad 1002{
f0fba2ad
LG
1003 int err;
1004
e60cd14f
LPC
1005 if (dai && dai->probed &&
1006 dai->driver->remove_order == order) {
1007 if (dai->driver->remove) {
1008 err = dai->driver->remove(dai);
f0fba2ad 1009 if (err < 0)
e60cd14f 1010 dev_err(dai->dev,
f110bfc7 1011 "ASoC: failed to remove %s: %d\n",
e60cd14f 1012 dai->name, err);
6b05eda6 1013 }
e60cd14f 1014 dai->probed = 0;
f0fba2ad 1015 }
b0aa88af
MLC
1016}
1017
1018static 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];
e60cd14f 1021 int i;
b0aa88af
MLC
1022
1023 /* unregister the rtd device */
1024 if (rtd->dev_registered) {
b0aa88af
MLC
1025 device_unregister(rtd->dev);
1026 rtd->dev_registered = 0;
1027 }
1028
1029 /* remove the CODEC DAI */
88bd870f 1030 for (i = 0; i < rtd->num_codecs; i++)
e60cd14f 1031 soc_remove_dai(rtd->codec_dais[i], order);
6b05eda6 1032
e60cd14f 1033 soc_remove_dai(rtd->cpu_dai, order);
f0fba2ad 1034}
db2a4165 1035
62ae68fa
SW
1036static 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;
62ae68fa 1041 struct snd_soc_platform *platform = rtd->platform;
61aca564 1042 struct snd_soc_component *component;
88bd870f 1043 int i;
62ae68fa
SW
1044
1045 /* remove the platform */
70090bbb 1046 if (platform && platform->component.driver->remove_order == order)
f1d45cc3 1047 soc_remove_component(&platform->component);
62ae68fa
SW
1048
1049 /* remove the CODEC-side CODEC */
88bd870f 1050 for (i = 0; i < rtd->num_codecs; i++) {
61aca564 1051 component = rtd->codec_dais[i]->component;
70090bbb 1052 if (component->driver->remove_order == order)
61aca564 1053 soc_remove_component(component);
62ae68fa
SW
1054 }
1055
1056 /* remove any CPU-side CODEC */
1057 if (cpu_dai) {
70090bbb 1058 if (cpu_dai->component->driver->remove_order == order)
61aca564 1059 soc_remove_component(cpu_dai->component);
62ae68fa
SW
1060 }
1061}
1062
0671fd8e
KM
1063static void soc_remove_dai_links(struct snd_soc_card *card)
1064{
0168bf0d 1065 int dai, order;
0671fd8e 1066
0168bf0d
LG
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++)
62ae68fa
SW
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);
0168bf0d 1077 }
62ae68fa 1078
0671fd8e
KM
1079 card->num_rtd = 0;
1080}
1081
ead9b919 1082static void soc_set_name_prefix(struct snd_soc_card *card,
94f99c87 1083 struct snd_soc_component *component)
ead9b919
JN
1084{
1085 int i;
1086
ff819b83 1087 if (card->codec_conf == NULL)
ead9b919
JN
1088 return;
1089
ff819b83
DP
1090 for (i = 0; i < card->num_configs; i++) {
1091 struct snd_soc_codec_conf *map = &card->codec_conf[i];
94f99c87 1092 if (map->of_node && component->dev->of_node != map->of_node)
3ca041ed 1093 continue;
94f99c87 1094 if (map->dev_name && strcmp(component->name, map->dev_name))
3ca041ed 1095 continue;
94f99c87 1096 component->name_prefix = map->name_prefix;
3ca041ed 1097 break;
ead9b919
JN
1098 }
1099}
1100
f1d45cc3
LPC
1101static int soc_probe_component(struct snd_soc_card *card,
1102 struct snd_soc_component *component)
589c3563 1103{
f1d45cc3 1104 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
888df395 1105 struct snd_soc_dai *dai;
f1d45cc3 1106 int ret;
589c3563 1107
70090bbb
LPC
1108 if (component->probed)
1109 return 0;
589c3563 1110
f1d45cc3
LPC
1111 component->card = card;
1112 dapm->card = card;
1113 soc_set_name_prefix(card, component);
589c3563 1114
f1d45cc3 1115 if (!try_module_get(component->dev->driver->owner))
70d29331
JN
1116 return -ENODEV;
1117
f1d45cc3 1118 soc_init_component_debugfs(component);
d5d1e0be 1119
f1d45cc3
LPC
1120 if (component->dapm_widgets) {
1121 ret = snd_soc_dapm_new_controls(dapm, component->dapm_widgets,
1122 component->num_dapm_widgets);
b318ad50
NP
1123
1124 if (ret != 0) {
f1d45cc3 1125 dev_err(component->dev,
b318ad50
NP
1126 "Failed to create new controls %d\n", ret);
1127 goto err_probe;
1128 }
1129 }
77530150 1130
0634814f
LPC
1131 list_for_each_entry(dai, &component->dai_list, list) {
1132 ret = snd_soc_dapm_new_dai_widgets(dapm, dai);
261edc70 1133 if (ret != 0) {
0634814f 1134 dev_err(component->dev,
261edc70
NP
1135 "Failed to create DAI widgets %d\n", ret);
1136 goto err_probe;
1137 }
1138 }
888df395 1139
f1d45cc3
LPC
1140 if (component->probe) {
1141 ret = component->probe(component);
589c3563 1142 if (ret < 0) {
f1d45cc3
LPC
1143 dev_err(component->dev,
1144 "ASoC: failed to probe component %d\n", ret);
70d29331 1145 goto err_probe;
589c3563 1146 }
cb2cf612 1147
f1d45cc3
LPC
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);
be09ad90
LG
1152 }
1153
f1d45cc3
LPC
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);
3fec6b6d 1160
f1d45cc3
LPC
1161 component->probed = 1;
1162 list_add(&dapm->list, &card->dapm_list);
cb2cf612 1163
f1d45cc3
LPC
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);
956245e9
LG
1167
1168 return 0;
1169
1170err_probe:
f1d45cc3
LPC
1171 soc_cleanup_component_debugfs(component);
1172 module_put(component->dev->driver->owner);
956245e9
LG
1173
1174 return ret;
1175}
1176
36ae1a96
MB
1177static void rtd_release(struct device *dev)
1178{
1179 kfree(dev);
1180}
f0fba2ad 1181
5f3484ac
LPC
1182static int soc_post_component_init(struct snd_soc_pcm_runtime *rtd,
1183 const char *name)
503ae5e0 1184{
589c3563
JN
1185 int ret = 0;
1186
589c3563 1187 /* register the rtd device */
36ae1a96
MB
1188 rtd->dev = kzalloc(sizeof(struct device), GFP_KERNEL);
1189 if (!rtd->dev)
1190 return -ENOMEM;
1191 device_initialize(rtd->dev);
5f3484ac 1192 rtd->dev->parent = rtd->card->dev;
36ae1a96 1193 rtd->dev->release = rtd_release;
d29697dc 1194 rtd->dev->groups = soc_dev_attr_groups;
f294afed 1195 dev_set_name(rtd->dev, "%s", name);
36ae1a96 1196 dev_set_drvdata(rtd->dev, rtd);
b8c0dab9 1197 mutex_init(&rtd->pcm_mutex);
01d7584c
LG
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);
36ae1a96 1202 ret = device_add(rtd->dev);
589c3563 1203 if (ret < 0) {
865df9cb
CL
1204 /* calling put_device() here to free the rtd->dev */
1205 put_device(rtd->dev);
5f3484ac 1206 dev_err(rtd->card->dev,
f110bfc7 1207 "ASoC: failed to register runtime device: %d\n", ret);
589c3563
JN
1208 return ret;
1209 }
1210 rtd->dev_registered = 1;
589c3563
JN
1211 return 0;
1212}
1213
62ae68fa
SW
1214static 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];
62ae68fa 1218 struct snd_soc_platform *platform = rtd->platform;
f1d45cc3 1219 struct snd_soc_component *component;
88bd870f 1220 int i, ret;
62ae68fa
SW
1221
1222 /* probe the CPU-side component, if it is a CODEC */
61aca564 1223 component = rtd->cpu_dai->component;
70090bbb 1224 if (component->driver->probe_order == order) {
61aca564 1225 ret = soc_probe_component(card, component);
62ae68fa
SW
1226 if (ret < 0)
1227 return ret;
1228 }
1229
88bd870f
BC
1230 /* probe the CODEC-side components */
1231 for (i = 0; i < rtd->num_codecs; i++) {
61aca564 1232 component = rtd->codec_dais[i]->component;
70090bbb 1233 if (component->driver->probe_order == order) {
f1d45cc3 1234 ret = soc_probe_component(card, component);
88bd870f
BC
1235 if (ret < 0)
1236 return ret;
1237 }
62ae68fa
SW
1238 }
1239
1240 /* probe the platform */
70090bbb 1241 if (platform->component.driver->probe_order == order) {
f1d45cc3 1242 ret = soc_probe_component(card, &platform->component);
62ae68fa
SW
1243 if (ret < 0)
1244 return ret;
1245 }
1246
1247 return 0;
1248}
1249
8e2be562 1250static int soc_probe_dai(struct snd_soc_dai *dai, int order)
b0aa88af
MLC
1251{
1252 int ret;
1253
8e2be562
LPC
1254 if (!dai->probed && dai->driver->probe_order == order) {
1255 if (dai->driver->probe) {
1256 ret = dai->driver->probe(dai);
b0aa88af 1257 if (ret < 0) {
8e2be562
LPC
1258 dev_err(dai->dev,
1259 "ASoC: failed to probe DAI %s: %d\n",
1260 dai->name, ret);
b0aa88af
MLC
1261 return ret;
1262 }
1263 }
1264
8e2be562 1265 dai->probed = 1;
b0aa88af
MLC
1266 }
1267
1268 return 0;
1269}
1270
2436a723
MLC
1271static int soc_link_dai_widgets(struct snd_soc_card *card,
1272 struct snd_soc_dai_link *dai_link,
3f901a02 1273 struct snd_soc_pcm_runtime *rtd)
2436a723 1274{
3f901a02
BC
1275 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1276 struct snd_soc_dai *codec_dai = rtd->codec_dai;
2436a723
MLC
1277 struct snd_soc_dapm_widget *play_w, *capture_w;
1278 int ret;
1279
88bd870f
BC
1280 if (rtd->num_codecs > 1)
1281 dev_warn(card->dev, "ASoC: Multiple codecs not supported yet\n");
1282
2436a723
MLC
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,
c6615082
NO
1288 dai_link->num_params, capture_w,
1289 play_w);
2436a723
MLC
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,
c6615082
NO
1301 dai_link->num_params, capture_w,
1302 play_w);
2436a723
MLC
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
62ae68fa 1313static int soc_probe_link_dais(struct snd_soc_card *card, int num, int order)
f0fba2ad
LG
1314{
1315 struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1316 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
c74184ed 1317 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
88bd870f 1318 int i, ret;
f0fba2ad 1319
f110bfc7 1320 dev_dbg(card->dev, "ASoC: probe %s dai link %d late %d\n",
0168bf0d 1321 card->name, num, order);
f0fba2ad 1322
f0fba2ad
LG
1323 /* set default power off timeout */
1324 rtd->pmdown_time = pmdown_time;
1325
8e2be562
LPC
1326 ret = soc_probe_dai(cpu_dai, order);
1327 if (ret)
1328 return ret;
db2a4165 1329
f0fba2ad 1330 /* probe the CODEC DAI */
88bd870f 1331 for (i = 0; i < rtd->num_codecs; i++) {
8e2be562 1332 ret = soc_probe_dai(rtd->codec_dais[i], order);
88bd870f
BC
1333 if (ret)
1334 return ret;
1335 }
fe3e78e0 1336
0168bf0d
LG
1337 /* complete DAI probe during last probe */
1338 if (order != SND_SOC_COMP_ORDER_LAST)
1339 return 0;
1340
5f3484ac
LPC
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
a5053a8e
KM
1351 if (dai_link->dai_fmt)
1352 snd_soc_runtime_set_dai_fmt(rtd, dai_link->dai_fmt);
1353
5f3484ac 1354 ret = soc_post_component_init(rtd, dai_link->name);
589c3563 1355 if (ret)
f0fba2ad 1356 return ret;
fe3e78e0 1357
5f3484ac
LPC
1358#ifdef CONFIG_DEBUG_FS
1359 /* add DPCM sysfs entries */
2e55b90a
LPC
1360 if (dai_link->dynamic)
1361 soc_dpcm_debugfs_add(rtd);
5f3484ac
LPC
1362#endif
1363
1245b700
NK
1364 if (cpu_dai->driver->compress_dai) {
1365 /*create compress_device"*/
1366 ret = soc_new_compress(rtd, num);
c74184ed 1367 if (ret < 0) {
f110bfc7 1368 dev_err(card->dev, "ASoC: can't create compress %s\n",
1245b700 1369 dai_link->stream_name);
c74184ed
MB
1370 return ret;
1371 }
1372 } else {
1245b700
NK
1373
1374 if (!dai_link->params) {
1375 /* create the pcm */
1376 ret = soc_new_pcm(rtd, num);
1377 if (ret < 0) {
f110bfc7 1378 dev_err(card->dev, "ASoC: can't create pcm %s :%d\n",
1245b700 1379 dai_link->stream_name, ret);
c74184ed
MB
1380 return ret;
1381 }
1245b700 1382 } else {
9d58a077
RF
1383 INIT_DELAYED_WORK(&rtd->delayed_work,
1384 codec2codec_close_delayed_work);
1385
1245b700 1386 /* link the DAI widgets */
3f901a02 1387 ret = soc_link_dai_widgets(card, dai_link, rtd);
2436a723
MLC
1388 if (ret)
1389 return ret;
c74184ed 1390 }
f0fba2ad
LG
1391 }
1392
f0fba2ad
LG
1393 return 0;
1394}
1395
44c69bb1 1396static int soc_bind_aux_dev(struct snd_soc_card *card, int num)
3ca041ed 1397{
44c69bb1 1398 struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
3ca041ed 1399 struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
65d9361f 1400 const char *name = aux_dev->codec_name;
3ca041ed 1401
65d9361f
LPC
1402 rtd->component = soc_find_component(aux_dev->codec_of_node, name);
1403 if (!rtd->component) {
3ca041ed 1404 if (aux_dev->codec_of_node)
65d9361f 1405 name = of_node_full_name(aux_dev->codec_of_node);
3ca041ed 1406
65d9361f 1407 dev_err(card->dev, "ASoC: %s not registered\n", name);
3ca041ed
SR
1408 return -EPROBE_DEFER;
1409 }
fb099cb7 1410
65d9361f
LPC
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
44c69bb1 1418 return 0;
b19e6e7b
MB
1419}
1420
2eea392d
JN
1421static int soc_probe_aux_dev(struct snd_soc_card *card, int num)
1422{
44c69bb1 1423 struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
2eea392d 1424 struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
44c69bb1 1425 int ret;
3ca041ed 1426
65d9361f 1427 ret = soc_probe_component(card, rtd->component);
2eea392d 1428 if (ret < 0)
589c3563 1429 return ret;
2eea392d 1430
5f3484ac
LPC
1431 /* do machine specific initialization */
1432 if (aux_dev->init) {
57bf7726 1433 ret = aux_dev->init(rtd->component);
5f3484ac
LPC
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 }
2eea392d 1440
5f3484ac 1441 return soc_post_component_init(rtd, aux_dev->name);
2eea392d
JN
1442}
1443
1444static void soc_remove_aux_dev(struct snd_soc_card *card, int num)
1445{
1446 struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
65d9361f 1447 struct snd_soc_component *component = rtd->component;
2eea392d
JN
1448
1449 /* unregister the rtd device */
1450 if (rtd->dev_registered) {
d3bf1561 1451 device_unregister(rtd->dev);
2eea392d
JN
1452 rtd->dev_registered = 0;
1453 }
1454
65d9361f
LPC
1455 if (component && component->probed)
1456 soc_remove_component(component);
2eea392d
JN
1457}
1458
f90fb3f7 1459static int snd_soc_init_codec_cache(struct snd_soc_codec *codec)
fdf0f54d
DP
1460{
1461 int ret;
1462
1463 if (codec->cache_init)
1464 return 0;
1465
fdf0f54d
DP
1466 ret = snd_soc_cache_init(codec);
1467 if (ret < 0) {
10e8aa9a
MM
1468 dev_err(codec->dev,
1469 "ASoC: Failed to set cache compression type: %d\n",
1470 ret);
fdf0f54d
DP
1471 return ret;
1472 }
1473 codec->cache_init = 1;
1474 return 0;
1475}
1476
ce64c8b9
LPC
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 */
1490int 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}
ddaca25a 1541EXPORT_SYMBOL_GPL(snd_soc_runtime_set_dai_fmt);
ce64c8b9 1542
b19e6e7b 1543static int snd_soc_instantiate_card(struct snd_soc_card *card)
f0fba2ad 1544{
fdf0f54d 1545 struct snd_soc_codec *codec;
ce64c8b9 1546 int ret, i, order;
fe3e78e0 1547
34e81ab4 1548 mutex_lock(&client_mutex);
01b9d99a 1549 mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_INIT);
dbe21408 1550
f0fba2ad 1551 /* bind DAIs */
b19e6e7b
MB
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 }
fe3e78e0 1557
44c69bb1 1558 /* bind aux_devs too */
b19e6e7b 1559 for (i = 0; i < card->num_aux_devs; i++) {
44c69bb1 1560 ret = soc_bind_aux_dev(card, i);
b19e6e7b
MB
1561 if (ret != 0)
1562 goto base_error;
f0fba2ad 1563 }
435c5e25 1564
fdf0f54d
DP
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;
f90fb3f7 1569 ret = snd_soc_init_codec_cache(codec);
b19e6e7b
MB
1570 if (ret < 0)
1571 goto base_error;
fdf0f54d
DP
1572 }
1573
f0fba2ad 1574 /* card bind complete so register a sound card */
102b5a8d 1575 ret = snd_card_new(card->dev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
f0fba2ad
LG
1576 card->owner, 0, &card->snd_card);
1577 if (ret < 0) {
10e8aa9a
MM
1578 dev_err(card->dev,
1579 "ASoC: can't create sound card for card %s: %d\n",
1580 card->name, ret);
b19e6e7b 1581 goto base_error;
f0fba2ad 1582 }
f0fba2ad 1583
0757d834
LPC
1584 soc_init_card_debugfs(card);
1585
e37a4970
MB
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
d5d1e0be
LPC
1591#ifdef CONFIG_DEBUG_FS
1592 snd_soc_dapm_debugfs_init(&card->dapm, card->debugfs_card_root);
1593#endif
1594
88ee1c61 1595#ifdef CONFIG_PM_SLEEP
f0fba2ad
LG
1596 /* deferred resume work */
1597 INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
1598#endif
db2a4165 1599
9a841ebb
MB
1600 if (card->dapm_widgets)
1601 snd_soc_dapm_new_controls(&card->dapm, card->dapm_widgets,
1602 card->num_dapm_widgets);
1603
f23e860e
NC
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
f0fba2ad
LG
1608 /* initialise the sound card only once */
1609 if (card->probe) {
e7361ec4 1610 ret = card->probe(card);
f0fba2ad
LG
1611 if (ret < 0)
1612 goto card_probe_error;
1613 }
fe3e78e0 1614
62ae68fa 1615 /* probe all components used by DAI links on this card */
0168bf0d
LG
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++) {
62ae68fa 1619 ret = soc_probe_link_components(card, i, order);
0168bf0d 1620 if (ret < 0) {
f110bfc7
LG
1621 dev_err(card->dev,
1622 "ASoC: failed to instantiate card %d\n",
1623 ret);
62ae68fa
SW
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) {
f110bfc7
LG
1635 dev_err(card->dev,
1636 "ASoC: failed to instantiate card %d\n",
1637 ret);
0168bf0d
LG
1638 goto probe_dai_err;
1639 }
f0fba2ad
LG
1640 }
1641 }
db2a4165 1642
2eea392d
JN
1643 for (i = 0; i < card->num_aux_devs; i++) {
1644 ret = soc_probe_aux_dev(card, i);
1645 if (ret < 0) {
f110bfc7
LG
1646 dev_err(card->dev,
1647 "ASoC: failed to add auxiliary devices %d\n",
1648 ret);
2eea392d
JN
1649 goto probe_aux_dev_err;
1650 }
1651 }
1652
888df395 1653 snd_soc_dapm_link_dai_widgets(card);
b893ea5f 1654 snd_soc_dapm_connect_dai_link_widgets(card);
888df395 1655
b7af1daf 1656 if (card->controls)
022658be 1657 snd_soc_add_card_controls(card, card->controls, card->num_controls);
b7af1daf 1658
b8ad29de
MB
1659 if (card->dapm_routes)
1660 snd_soc_dapm_add_routes(&card->dapm, card->dapm_routes,
1661 card->num_dapm_routes);
1662
f23e860e
NC
1663 if (card->of_dapm_routes)
1664 snd_soc_dapm_add_routes(&card->dapm, card->of_dapm_routes,
1665 card->num_of_dapm_routes);
75d9ac46 1666
f0fba2ad 1667 snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname),
f0fba2ad 1668 "%s", card->name);
22de71ba
LG
1669 snprintf(card->snd_card->longname, sizeof(card->snd_card->longname),
1670 "%s", card->long_name ? card->long_name : card->name);
f0e8ed85
MB
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 }
f0fba2ad 1685
28e9ad92
MB
1686 if (card->late_probe) {
1687 ret = card->late_probe(card);
1688 if (ret < 0) {
f110bfc7 1689 dev_err(card->dev, "ASoC: %s late_probe() failed: %d\n",
28e9ad92
MB
1690 card->name, ret);
1691 goto probe_aux_dev_err;
1692 }
1693 }
1694
824ef826 1695 snd_soc_dapm_new_widgets(card);
8c193b8d 1696
f0fba2ad
LG
1697 ret = snd_card_register(card->snd_card);
1698 if (ret < 0) {
f110bfc7
LG
1699 dev_err(card->dev, "ASoC: failed to register soundcard %d\n",
1700 ret);
6b3ed785 1701 goto probe_aux_dev_err;
db2a4165
FM
1702 }
1703
f0fba2ad 1704 card->instantiated = 1;
4f4c0072 1705 snd_soc_dapm_sync(&card->dapm);
f0fba2ad 1706 mutex_unlock(&card->mutex);
34e81ab4 1707 mutex_unlock(&client_mutex);
b19e6e7b
MB
1708
1709 return 0;
f0fba2ad 1710
2eea392d
JN
1711probe_aux_dev_err:
1712 for (i = 0; i < card->num_aux_devs; i++)
1713 soc_remove_aux_dev(card, i);
1714
f0fba2ad 1715probe_dai_err:
0671fd8e 1716 soc_remove_dai_links(card);
f0fba2ad
LG
1717
1718card_probe_error:
87506549 1719 if (card->remove)
e7361ec4 1720 card->remove(card);
f0fba2ad 1721
0757d834 1722 soc_cleanup_card_debugfs(card);
f0fba2ad
LG
1723 snd_card_free(card->snd_card);
1724
b19e6e7b 1725base_error:
f0fba2ad 1726 mutex_unlock(&card->mutex);
34e81ab4 1727 mutex_unlock(&client_mutex);
db2a4165 1728
b19e6e7b 1729 return ret;
435c5e25
MB
1730}
1731
1732/* probes a new socdev */
1733static int soc_probe(struct platform_device *pdev)
1734{
f0fba2ad 1735 struct snd_soc_card *card = platform_get_drvdata(pdev);
435c5e25 1736
70a7ca34
VK
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
fe4085e8 1744 dev_warn(&pdev->dev,
f110bfc7 1745 "ASoC: machine %s should use snd_soc_register_card()\n",
fe4085e8
MB
1746 card->name);
1747
435c5e25
MB
1748 /* Bodge while we unpick instantiation */
1749 card->dev = &pdev->dev;
f0fba2ad 1750
28d528c8 1751 return snd_soc_register_card(card);
db2a4165
FM
1752}
1753
b0e26485 1754static int soc_cleanup_card_resources(struct snd_soc_card *card)
db2a4165
FM
1755{
1756 int i;
db2a4165 1757
b0e26485
VK
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];
43829731 1761 flush_delayed_work(&rtd->delayed_work);
b0e26485 1762 }
914dc182 1763
b0e26485
VK
1764 /* remove auxiliary devices */
1765 for (i = 0; i < card->num_aux_devs; i++)
1766 soc_remove_aux_dev(card, i);
db2a4165 1767
b0e26485 1768 /* remove and free each DAI */
0671fd8e 1769 soc_remove_dai_links(card);
2eea392d 1770
b0e26485 1771 soc_cleanup_card_debugfs(card);
f0fba2ad 1772
b0e26485
VK
1773 /* remove the card */
1774 if (card->remove)
e7361ec4 1775 card->remove(card);
a6052154 1776
0aaae527
LPC
1777 snd_soc_dapm_free(&card->dapm);
1778
b0e26485
VK
1779 snd_card_free(card->snd_card);
1780 return 0;
1781
1782}
1783
1784/* removes a socdev */
1785static int soc_remove(struct platform_device *pdev)
1786{
1787 struct snd_soc_card *card = platform_get_drvdata(pdev);
db2a4165 1788
c5af3a2e 1789 snd_soc_unregister_card(card);
db2a4165
FM
1790 return 0;
1791}
1792
6f8ab4ac 1793int snd_soc_poweroff(struct device *dev)
51737470 1794{
6f8ab4ac 1795 struct snd_soc_card *card = dev_get_drvdata(dev);
f0fba2ad 1796 int i;
51737470
MB
1797
1798 if (!card->instantiated)
416356fc 1799 return 0;
51737470
MB
1800
1801 /* Flush out pmdown_time work - we actually do want to run it
1802 * now, we're shutting down so no imminent restart. */
f0fba2ad
LG
1803 for (i = 0; i < card->num_rtd; i++) {
1804 struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
43829731 1805 flush_delayed_work(&rtd->delayed_work);
f0fba2ad 1806 }
51737470 1807
f0fba2ad 1808 snd_soc_dapm_shutdown(card);
416356fc 1809
988e8cc4
NC
1810 /* deactivate pins to sleep state */
1811 for (i = 0; i < card->num_rtd; i++) {
88bd870f
BC
1812 struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
1813 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1814 int j;
1815
988e8cc4 1816 pinctrl_pm_select_sleep_state(cpu_dai->dev);
88bd870f
BC
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 }
988e8cc4
NC
1821 }
1822
416356fc 1823 return 0;
51737470 1824}
6f8ab4ac 1825EXPORT_SYMBOL_GPL(snd_soc_poweroff);
51737470 1826
6f8ab4ac 1827const struct dev_pm_ops snd_soc_pm_ops = {
b1dd5897
VK
1828 .suspend = snd_soc_suspend,
1829 .resume = snd_soc_resume,
1830 .freeze = snd_soc_suspend,
1831 .thaw = snd_soc_resume,
6f8ab4ac 1832 .poweroff = snd_soc_poweroff,
b1dd5897 1833 .restore = snd_soc_resume,
416356fc 1834};
deb2607e 1835EXPORT_SYMBOL_GPL(snd_soc_pm_ops);
416356fc 1836
db2a4165
FM
1837/* ASoC platform driver */
1838static struct platform_driver soc_driver = {
1839 .driver = {
1840 .name = "soc-audio",
6f8ab4ac 1841 .pm = &snd_soc_pm_ops,
db2a4165
FM
1842 },
1843 .probe = soc_probe,
1844 .remove = soc_remove,
db2a4165
FM
1845};
1846
db2a4165
FM
1847/**
1848 * snd_soc_cnew - create new control
1849 * @_template: control template
1850 * @data: control private data
ac11a2b3 1851 * @long_name: control long name
efb7ac3f 1852 * @prefix: control name prefix
db2a4165
FM
1853 *
1854 * Create a new mixer control from a template control.
1855 *
1856 * Returns 0 for success, else error.
1857 */
1858struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
3056557f 1859 void *data, const char *long_name,
efb7ac3f 1860 const char *prefix)
db2a4165
FM
1861{
1862 struct snd_kcontrol_new template;
efb7ac3f
MB
1863 struct snd_kcontrol *kcontrol;
1864 char *name = NULL;
db2a4165
FM
1865
1866 memcpy(&template, _template, sizeof(template));
db2a4165
FM
1867 template.index = 0;
1868
efb7ac3f
MB
1869 if (!long_name)
1870 long_name = template.name;
1871
1872 if (prefix) {
2b581074 1873 name = kasprintf(GFP_KERNEL, "%s %s", prefix, long_name);
efb7ac3f
MB
1874 if (!name)
1875 return NULL;
1876
efb7ac3f
MB
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;
db2a4165
FM
1887}
1888EXPORT_SYMBOL_GPL(snd_soc_cnew);
1889
022658be
LG
1890static 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) {
f110bfc7
LG
1901 dev_err(dev, "ASoC: Failed to add %s: %d\n",
1902 control->name, err);
022658be
LG
1903 return err;
1904 }
1905 }
1906
1907 return 0;
1908}
1909
4fefd698
DP
1910struct 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}
1924EXPORT_SYMBOL_GPL(snd_soc_card_get_kcontrol);
1925
0f2780ad
LPC
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 */
1935int 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}
1943EXPORT_SYMBOL_GPL(snd_soc_add_component_controls);
1944
3e8e1952 1945/**
022658be
LG
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
3e8e1952
IM
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 */
022658be 1956int snd_soc_add_codec_controls(struct snd_soc_codec *codec,
0f2780ad 1957 const struct snd_kcontrol_new *controls, unsigned int num_controls)
3e8e1952 1958{
0f2780ad
LPC
1959 return snd_soc_add_component_controls(&codec->component, controls,
1960 num_controls);
3e8e1952 1961}
022658be 1962EXPORT_SYMBOL_GPL(snd_soc_add_codec_controls);
3e8e1952 1963
a491a5c8
LG
1964/**
1965 * snd_soc_add_platform_controls - add an array of controls to a platform.
022658be 1966 * Convenience function to add a list of controls.
a491a5c8
LG
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 */
1974int snd_soc_add_platform_controls(struct snd_soc_platform *platform,
0f2780ad 1975 const struct snd_kcontrol_new *controls, unsigned int num_controls)
a491a5c8 1976{
0f2780ad
LPC
1977 return snd_soc_add_component_controls(&platform->component, controls,
1978 num_controls);
a491a5c8
LG
1979}
1980EXPORT_SYMBOL_GPL(snd_soc_add_platform_controls);
1981
022658be
LG
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 */
1992int 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}
2000EXPORT_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 */
2012int snd_soc_add_dai_controls(struct snd_soc_dai *dai,
2013 const struct snd_kcontrol_new *controls, int num_controls)
2014{
313665b9 2015 struct snd_card *card = dai->component->card->snd_card;
022658be
LG
2016
2017 return snd_soc_add_controls(card, dai->dev, controls, num_controls,
2018 NULL, dai);
2019}
2020EXPORT_SYMBOL_GPL(snd_soc_add_dai_controls);
2021
8c6529db
LG
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 */
2031int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
2032 unsigned int freq, int dir)
2033{
f0fba2ad
LG
2034 if (dai->driver && dai->driver->ops->set_sysclk)
2035 return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir);
ec4ee52a 2036 else if (dai->codec && dai->codec->driver->set_sysclk)
da1c6ea6 2037 return dai->codec->driver->set_sysclk(dai->codec, clk_id, 0,
ec4ee52a 2038 freq, dir);
8c6529db 2039 else
1104a9c8 2040 return -ENOTSUPP;
8c6529db
LG
2041}
2042EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
2043
ec4ee52a
MB
2044/**
2045 * snd_soc_codec_set_sysclk - configure CODEC system or master clock.
2046 * @codec: CODEC
2047 * @clk_id: DAI specific clock ID
da1c6ea6 2048 * @source: Source for the clock
ec4ee52a
MB
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 */
2054int snd_soc_codec_set_sysclk(struct snd_soc_codec *codec, int clk_id,
da1c6ea6 2055 int source, unsigned int freq, int dir)
ec4ee52a
MB
2056{
2057 if (codec->driver->set_sysclk)
da1c6ea6
MB
2058 return codec->driver->set_sysclk(codec, clk_id, source,
2059 freq, dir);
ec4ee52a 2060 else
1104a9c8 2061 return -ENOTSUPP;
ec4ee52a
MB
2062}
2063EXPORT_SYMBOL_GPL(snd_soc_codec_set_sysclk);
2064
8c6529db
LG
2065/**
2066 * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
2067 * @dai: DAI
ac11a2b3 2068 * @div_id: DAI specific clock divider ID
8c6529db
LG
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 */
2075int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
2076 int div_id, int div)
2077{
f0fba2ad
LG
2078 if (dai->driver && dai->driver->ops->set_clkdiv)
2079 return dai->driver->ops->set_clkdiv(dai, div_id, div);
8c6529db
LG
2080 else
2081 return -EINVAL;
2082}
2083EXPORT_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
85488037 2089 * @source: DAI specific source for the PLL
8c6529db
LG
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 */
85488037
MB
2095int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
2096 unsigned int freq_in, unsigned int freq_out)
8c6529db 2097{
f0fba2ad
LG
2098 if (dai->driver && dai->driver->ops->set_pll)
2099 return dai->driver->ops->set_pll(dai, pll_id, source,
85488037 2100 freq_in, freq_out);
ec4ee52a
MB
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);
8c6529db
LG
2104 else
2105 return -EINVAL;
2106}
2107EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
2108
ec4ee52a
MB
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 */
2119int 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}
2128EXPORT_SYMBOL_GPL(snd_soc_codec_set_pll);
2129
e54cf76b
LG
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 */
2137int 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}
2144EXPORT_SYMBOL_GPL(snd_soc_dai_set_bclk_ratio);
2145
8c6529db
LG
2146/**
2147 * snd_soc_dai_set_fmt - configure DAI hardware audio format.
2148 * @dai: DAI
8c6529db
LG
2149 * @fmt: SND_SOC_DAIFMT_ format value.
2150 *
2151 * Configures the DAI hardware format and clocking.
2152 */
2153int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
2154{
5e4ba569 2155 if (dai->driver == NULL)
8c6529db 2156 return -EINVAL;
5e4ba569
SG
2157 if (dai->driver->ops->set_fmt == NULL)
2158 return -ENOTSUPP;
2159 return dai->driver->ops->set_fmt(dai, fmt);
8c6529db
LG
2160}
2161EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
2162
89c67857 2163/**
e5c21514 2164 * snd_soc_xlate_tdm_slot - generate tx/rx slot mask.
89c67857
XL
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 */
e5c21514 2171static int snd_soc_xlate_tdm_slot_mask(unsigned int slots,
89c67857
XL
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
8c6529db 2187/**
e46c9366
LPC
2188 * snd_soc_dai_set_tdm_slot() - Configures a DAI for TDM operation
2189 * @dai: The DAI to configure
a5479e38
DR
2190 * @tx_mask: bitmask representing active TX slots.
2191 * @rx_mask: bitmask representing active RX slots.
8c6529db 2192 * @slots: Number of slots in use.
a5479e38 2193 * @slot_width: Width in bits for each slot.
8c6529db 2194 *
e46c9366
LPC
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.
8c6529db
LG
2209 */
2210int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
a5479e38 2211 unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
8c6529db 2212{
e5c21514
XL
2213 if (dai->driver && dai->driver->ops->xlate_tdm_slot_mask)
2214 dai->driver->ops->xlate_tdm_slot_mask(slots,
89c67857
XL
2215 &tx_mask, &rx_mask);
2216 else
e5c21514 2217 snd_soc_xlate_tdm_slot_mask(slots, &tx_mask, &rx_mask);
89c67857 2218
88bd870f
BC
2219 dai->tx_mask = tx_mask;
2220 dai->rx_mask = rx_mask;
2221
f0fba2ad
LG
2222 if (dai->driver && dai->driver->ops->set_tdm_slot)
2223 return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask,
a5479e38 2224 slots, slot_width);
8c6529db 2225 else
b2cbb6e1 2226 return -ENOTSUPP;
8c6529db
LG
2227}
2228EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
2229
472df3cb
BS
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 */
2242int 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{
f0fba2ad
LG
2246 if (dai->driver && dai->driver->ops->set_channel_map)
2247 return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot,
472df3cb
BS
2248 rx_num, rx_slot);
2249 else
2250 return -EINVAL;
2251}
2252EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map);
2253
8c6529db
LG
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 */
2261int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
2262{
f0fba2ad
LG
2263 if (dai->driver && dai->driver->ops->set_tristate)
2264 return dai->driver->ops->set_tristate(dai, tristate);
8c6529db
LG
2265 else
2266 return -EINVAL;
2267}
2268EXPORT_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
da18396f 2274 * @direction: stream to mute
8c6529db
LG
2275 *
2276 * Mutes the DAI DAC.
2277 */
da18396f
MB
2278int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute,
2279 int direction)
8c6529db 2280{
da18396f
MB
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)
f0fba2ad 2288 return dai->driver->ops->digital_mute(dai, mute);
8c6529db 2289 else
04570c62 2290 return -ENOTSUPP;
8c6529db
LG
2291}
2292EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
2293
88bd870f
BC
2294static 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
c5af3a2e
MB
2321/**
2322 * snd_soc_register_card - Register a card with the ASoC core
2323 *
ac11a2b3 2324 * @card: Card to register
c5af3a2e 2325 *
c5af3a2e 2326 */
70a7ca34 2327int snd_soc_register_card(struct snd_soc_card *card)
c5af3a2e 2328{
88bd870f 2329 int i, j, ret;
f0fba2ad 2330
c5af3a2e
MB
2331 if (!card->name || !card->dev)
2332 return -EINVAL;
2333
5a504963
SW
2334 for (i = 0; i < card->num_links; i++) {
2335 struct snd_soc_dai_link *link = &card->dai_link[i];
2336
88bd870f
BC
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;
5a504963 2341 }
88bd870f
BC
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 }
bc92657a 2360 }
5a504963
SW
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) {
10e8aa9a
MM
2367 dev_err(card->dev,
2368 "ASoC: Both platform name/of_node are set for %s\n",
2369 link->name);
5a504963
SW
2370 return -EINVAL;
2371 }
2372
2373 /*
bc92657a
SW
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) {
10e8aa9a
MM
2379 dev_err(card->dev,
2380 "ASoC: Neither/both cpu name/of_node are set for %s\n",
2381 link->name);
bc92657a
SW
2382 return -EINVAL;
2383 }
2384 /*
2385 * At least one of CPU DAI name or CPU device name/node must be
2386 * specified
5a504963 2387 */
bc92657a
SW
2388 if (!link->cpu_dai_name &&
2389 !(link->cpu_name || link->cpu_of_node)) {
10e8aa9a
MM
2390 dev_err(card->dev,
2391 "ASoC: Neither cpu_dai_name nor cpu_name/of_node are set for %s\n",
2392 link->name);
5a504963
SW
2393 return -EINVAL;
2394 }
2395 }
2396
ed77cc12
MB
2397 dev_set_drvdata(card->dev, card);
2398
111c6419
SW
2399 snd_soc_initialize_card_lists(card);
2400
181a6892
MB
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);
f0fba2ad
LG
2405 if (card->rtd == NULL)
2406 return -ENOMEM;
a7dbb603 2407 card->num_rtd = 0;
2eea392d 2408 card->rtd_aux = &card->rtd[card->num_links];
f0fba2ad 2409
5f3484ac
LPC
2410 for (i = 0; i < card->num_links; i++) {
2411 card->rtd[i].card = card;
f0fba2ad 2412 card->rtd[i].dai_link = &card->dai_link[i];
88bd870f
BC
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;
5f3484ac
LPC
2419 }
2420
2421 for (i = 0; i < card->num_aux_devs; i++)
2422 card->rtd_aux[i].card = card;
f0fba2ad 2423
db432b41 2424 INIT_LIST_HEAD(&card->dapm_dirty);
c5af3a2e 2425 card->instantiated = 0;
f0fba2ad 2426 mutex_init(&card->mutex);
a73fb2df 2427 mutex_init(&card->dapm_mutex);
c5af3a2e 2428
b19e6e7b
MB
2429 ret = snd_soc_instantiate_card(card);
2430 if (ret != 0)
4e2576bd 2431 return ret;
c5af3a2e 2432
988e8cc4
NC
2433 /* deactivate pins to sleep state */
2434 for (i = 0; i < card->num_rtd; i++) {
88bd870f
BC
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
988e8cc4
NC
2445 if (!cpu_dai->active)
2446 pinctrl_pm_select_sleep_state(cpu_dai->dev);
2447 }
2448
b19e6e7b 2449 return ret;
c5af3a2e 2450}
70a7ca34 2451EXPORT_SYMBOL_GPL(snd_soc_register_card);
c5af3a2e
MB
2452
2453/**
2454 * snd_soc_unregister_card - Unregister a card with the ASoC core
2455 *
ac11a2b3 2456 * @card: Card to unregister
c5af3a2e 2457 *
c5af3a2e 2458 */
70a7ca34 2459int snd_soc_unregister_card(struct snd_soc_card *card)
c5af3a2e 2460{
01e0df66
LPC
2461 if (card->instantiated) {
2462 card->instantiated = false;
1c325f77 2463 snd_soc_dapm_shutdown(card);
b0e26485 2464 soc_cleanup_card_resources(card);
8f6f9b29 2465 dev_dbg(card->dev, "ASoC: Unregistered card '%s'\n", card->name);
01e0df66 2466 }
c5af3a2e
MB
2467
2468 return 0;
2469}
70a7ca34 2470EXPORT_SYMBOL_GPL(snd_soc_unregister_card);
c5af3a2e 2471
f0fba2ad
LG
2472/*
2473 * Simplify DAI link configuration by removing ".-1" from device names
2474 * and sanitizing names.
2475 */
0b9a214a 2476static char *fmt_single_name(struct device *dev, int *id)
f0fba2ad
LG
2477{
2478 char *found, name[NAME_SIZE];
2479 int id1, id2;
2480
2481 if (dev_name(dev) == NULL)
2482 return NULL;
2483
58818a77 2484 strlcpy(name, dev_name(dev), NAME_SIZE);
f0fba2ad
LG
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 */
05899446 2503 *id = ((id1 & 0xffff) << 16) + id2;
f0fba2ad
LG
2504
2505 /* sanitize component name for DAI link creation */
2506 snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name);
58818a77 2507 strlcpy(name, tmp, NAME_SIZE);
f0fba2ad
LG
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 */
2519static inline char *fmt_multiple_name(struct device *dev,
2520 struct snd_soc_dai_driver *dai_drv)
2521{
2522 if (dai_drv->name == NULL) {
10e8aa9a
MM
2523 dev_err(dev,
2524 "ASoC: error - multiple DAI %s registered with no name\n",
2525 dev_name(dev));
f0fba2ad
LG
2526 return NULL;
2527 }
2528
2529 return kstrdup(dai_drv->name, GFP_KERNEL);
2530}
2531
9115171a 2532/**
32c9ba54 2533 * snd_soc_unregister_dai - Unregister DAIs from the ASoC core
9115171a 2534 *
32c9ba54 2535 * @component: The component for which the DAIs should be unregistered
9115171a 2536 */
32c9ba54 2537static void snd_soc_unregister_dais(struct snd_soc_component *component)
9115171a 2538{
5c1d5f09 2539 struct snd_soc_dai *dai, *_dai;
9115171a 2540
5c1d5f09 2541 list_for_each_entry_safe(dai, _dai, &component->dai_list, list) {
32c9ba54
LPC
2542 dev_dbg(component->dev, "ASoC: Unregistered DAI '%s'\n",
2543 dai->name);
5c1d5f09 2544 list_del(&dai->list);
32c9ba54 2545 kfree(dai->name);
f0fba2ad 2546 kfree(dai);
f0fba2ad 2547 }
9115171a 2548}
9115171a
MB
2549
2550/**
32c9ba54 2551 * snd_soc_register_dais - Register a DAI with the ASoC core
9115171a 2552 *
6106d129
LPC
2553 * @component: The component the DAIs are registered for
2554 * @dai_drv: DAI driver to use for the DAIs
ac11a2b3 2555 * @count: Number of DAIs
32c9ba54
LPC
2556 * @legacy_dai_naming: Use the legacy naming scheme and let the DAI inherit the
2557 * parent's name.
9115171a 2558 */
6106d129 2559static int snd_soc_register_dais(struct snd_soc_component *component,
bb13109d
LPC
2560 struct snd_soc_dai_driver *dai_drv, size_t count,
2561 bool legacy_dai_naming)
9115171a 2562{
6106d129 2563 struct device *dev = component->dev;
f0fba2ad 2564 struct snd_soc_dai *dai;
32c9ba54
LPC
2565 unsigned int i;
2566 int ret;
f0fba2ad 2567
f110bfc7 2568 dev_dbg(dev, "ASoC: dai register %s #%Zu\n", dev_name(dev), count);
9115171a 2569
bb13109d
LPC
2570 component->dai_drv = dai_drv;
2571 component->num_dai = count;
2572
9115171a 2573 for (i = 0; i < count; i++) {
f0fba2ad
LG
2574
2575 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
c46e0079
AL
2576 if (dai == NULL) {
2577 ret = -ENOMEM;
2578 goto err;
2579 }
f0fba2ad 2580
32c9ba54
LPC
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 }
f0fba2ad
LG
2598 if (dai->name == NULL) {
2599 kfree(dai);
32c9ba54 2600 ret = -ENOMEM;
9115171a 2601 goto err;
f0fba2ad
LG
2602 }
2603
6106d129 2604 dai->component = component;
f0fba2ad 2605 dai->dev = dev;
f0fba2ad
LG
2606 dai->driver = &dai_drv[i];
2607 if (!dai->driver->ops)
2608 dai->driver->ops = &null_dai_ops;
2609
1438c2f6 2610 list_add(&dai->list, &component->dai_list);
054880fe 2611
32c9ba54 2612 dev_dbg(dev, "ASoC: Registered DAI '%s'\n", dai->name);
9115171a
MB
2613 }
2614
2615 return 0;
2616
2617err:
32c9ba54 2618 snd_soc_unregister_dais(component);
9115171a
MB
2619
2620 return ret;
2621}
9115171a 2622
14e8bdeb
LPC
2623static void snd_soc_component_seq_notifier(struct snd_soc_dapm_context *dapm,
2624 enum snd_soc_dapm_type type, int subseq)
d191bd8d 2625{
14e8bdeb 2626 struct snd_soc_component *component = dapm->component;
d191bd8d 2627
14e8bdeb
LPC
2628 component->driver->seq_notifier(component, type, subseq);
2629}
d191bd8d 2630
14e8bdeb
LPC
2631static int snd_soc_component_stream_event(struct snd_soc_dapm_context *dapm,
2632 int event)
2633{
2634 struct snd_soc_component *component = dapm->component;
d191bd8d 2635
14e8bdeb
LPC
2636 return component->driver->stream_event(component, event);
2637}
e2c330b9 2638
bb13109d
LPC
2639static int snd_soc_component_initialize(struct snd_soc_component *component,
2640 const struct snd_soc_component_driver *driver, struct device *dev)
d191bd8d 2641{
ce0fc93a
LPC
2642 struct snd_soc_dapm_context *dapm;
2643
bb13109d
LPC
2644 component->name = fmt_single_name(dev, &component->id);
2645 if (!component->name) {
2646 dev_err(dev, "ASoC: Failed to allocate name\n");
d191bd8d
KM
2647 return -ENOMEM;
2648 }
2649
bb13109d
LPC
2650 component->dev = dev;
2651 component->driver = driver;
61aca564
LPC
2652 component->probe = component->driver->probe;
2653 component->remove = component->driver->remove;
d191bd8d 2654
ce0fc93a
LPC
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;
5819c2fa 2662 dapm->idle_bias_off = true;
14e8bdeb
LPC
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;
d191bd8d 2667
61aca564
LPC
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
bb13109d
LPC
2675 INIT_LIST_HEAD(&component->dai_list);
2676 mutex_init(&component->io_mutex);
d191bd8d 2677
bb13109d
LPC
2678 return 0;
2679}
d191bd8d 2680
20feb881 2681static void snd_soc_component_setup_regmap(struct snd_soc_component *component)
886f5692 2682{
20feb881
LPC
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
e874bf5f
LPC
2690#ifdef CONFIG_REGMAP
2691
20feb881
LPC
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 */
2702void 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);
886f5692 2707}
20feb881
LPC
2708EXPORT_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 */
2720void snd_soc_component_exit_regmap(struct snd_soc_component *component)
2721{
2722 regmap_exit(component->regmap);
2723 component->regmap = NULL;
2724}
2725EXPORT_SYMBOL_GPL(snd_soc_component_exit_regmap);
886f5692 2726
e874bf5f 2727#endif
886f5692 2728
bb13109d
LPC
2729static void snd_soc_component_add_unlocked(struct snd_soc_component *component)
2730{
20feb881
LPC
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 }
886f5692 2737
bb13109d
LPC
2738 list_add(&component->list, &component_list);
2739}
d191bd8d 2740
bb13109d
LPC
2741static void snd_soc_component_add(struct snd_soc_component *component)
2742{
d191bd8d 2743 mutex_lock(&client_mutex);
bb13109d 2744 snd_soc_component_add_unlocked(component);
d191bd8d 2745 mutex_unlock(&client_mutex);
bb13109d 2746}
d191bd8d 2747
bb13109d
LPC
2748static void snd_soc_component_cleanup(struct snd_soc_component *component)
2749{
2750 snd_soc_unregister_dais(component);
2751 kfree(component->name);
2752}
d191bd8d 2753
bb13109d
LPC
2754static void snd_soc_component_del_unlocked(struct snd_soc_component *component)
2755{
2756 list_del(&component->list);
2757}
d191bd8d 2758
d191bd8d
KM
2759int 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;
bb13109d 2765 int ret;
d191bd8d 2766
bb13109d 2767 cmpnt = kzalloc(sizeof(*cmpnt), GFP_KERNEL);
d191bd8d
KM
2768 if (!cmpnt) {
2769 dev_err(dev, "ASoC: Failed to allocate memory\n");
2770 return -ENOMEM;
2771 }
2772
bb13109d
LPC
2773 ret = snd_soc_component_initialize(cmpnt, cmpnt_drv, dev);
2774 if (ret)
2775 goto err_free;
2776
3d59400f 2777 cmpnt->ignore_pmdown_time = true;
98e639fb 2778 cmpnt->registered_as_component = true;
3d59400f 2779
bb13109d
LPC
2780 ret = snd_soc_register_dais(cmpnt, dai_drv, num_dai, true);
2781 if (ret < 0) {
f42cf8d6 2782 dev_err(dev, "ASoC: Failed to register DAIs: %d\n", ret);
bb13109d
LPC
2783 goto err_cleanup;
2784 }
d191bd8d 2785
bb13109d 2786 snd_soc_component_add(cmpnt);
4da53393 2787
bb13109d 2788 return 0;
4da53393 2789
bb13109d
LPC
2790err_cleanup:
2791 snd_soc_component_cleanup(cmpnt);
2792err_free:
2793 kfree(cmpnt);
2794 return ret;
4da53393 2795}
bb13109d 2796EXPORT_SYMBOL_GPL(snd_soc_register_component);
4da53393 2797
d191bd8d
KM
2798/**
2799 * snd_soc_unregister_component - Unregister a component from the ASoC core
2800 *
2801 */
2802void snd_soc_unregister_component(struct device *dev)
2803{
2804 struct snd_soc_component *cmpnt;
2805
34e81ab4 2806 mutex_lock(&client_mutex);
d191bd8d 2807 list_for_each_entry(cmpnt, &component_list, list) {
98e639fb 2808 if (dev == cmpnt->dev && cmpnt->registered_as_component)
d191bd8d
KM
2809 goto found;
2810 }
34e81ab4 2811 mutex_unlock(&client_mutex);
d191bd8d
KM
2812 return;
2813
2814found:
34e81ab4
LPC
2815 snd_soc_component_del_unlocked(cmpnt);
2816 mutex_unlock(&client_mutex);
bb13109d
LPC
2817 snd_soc_component_cleanup(cmpnt);
2818 kfree(cmpnt);
d191bd8d
KM
2819}
2820EXPORT_SYMBOL_GPL(snd_soc_unregister_component);
d191bd8d 2821
f1d45cc3 2822static int snd_soc_platform_drv_probe(struct snd_soc_component *component)
e2c330b9
LPC
2823{
2824 struct snd_soc_platform *platform = snd_soc_component_to_platform(component);
d191bd8d 2825
f1d45cc3 2826 return platform->driver->probe(platform);
e2c330b9
LPC
2827}
2828
f1d45cc3 2829static void snd_soc_platform_drv_remove(struct snd_soc_component *component)
e2c330b9
LPC
2830{
2831 struct snd_soc_platform *platform = snd_soc_component_to_platform(component);
2832
f1d45cc3 2833 platform->driver->remove(platform);
d191bd8d 2834}
d191bd8d 2835
12a48a8c 2836/**
71a45cda
LPC
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
12a48a8c 2841 */
71a45cda 2842int snd_soc_add_platform(struct device *dev, struct snd_soc_platform *platform,
d79e57db 2843 const struct snd_soc_platform_driver *platform_drv)
12a48a8c 2844{
b37f1d12
LPC
2845 int ret;
2846
bb13109d
LPC
2847 ret = snd_soc_component_initialize(&platform->component,
2848 &platform_drv->component_driver, dev);
2849 if (ret)
2850 return ret;
12a48a8c 2851
f0fba2ad
LG
2852 platform->dev = dev;
2853 platform->driver = platform_drv;
f1d45cc3
LPC
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;
12a48a8c 2859
81c7cfd1
LPC
2860#ifdef CONFIG_DEBUG_FS
2861 platform->component.debugfs_prefix = "platform";
2862#endif
12a48a8c
MB
2863
2864 mutex_lock(&client_mutex);
bb13109d 2865 snd_soc_component_add_unlocked(&platform->component);
12a48a8c
MB
2866 list_add(&platform->list, &platform_list);
2867 mutex_unlock(&client_mutex);
2868
f4333203
LPC
2869 dev_dbg(dev, "ASoC: Registered platform '%s'\n",
2870 platform->component.name);
12a48a8c
MB
2871
2872 return 0;
2873}
71a45cda 2874EXPORT_SYMBOL_GPL(snd_soc_add_platform);
12a48a8c
MB
2875
2876/**
71a45cda 2877 * snd_soc_register_platform - Register a platform with the ASoC core
12a48a8c 2878 *
71a45cda 2879 * @platform: platform to register
12a48a8c 2880 */
71a45cda
LPC
2881int snd_soc_register_platform(struct device *dev,
2882 const struct snd_soc_platform_driver *platform_drv)
12a48a8c 2883{
f0fba2ad 2884 struct snd_soc_platform *platform;
71a45cda 2885 int ret;
f0fba2ad 2886
71a45cda 2887 dev_dbg(dev, "ASoC: platform register %s\n", dev_name(dev));
f0fba2ad 2888
71a45cda
LPC
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}
2899EXPORT_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 */
2905void snd_soc_remove_platform(struct snd_soc_platform *platform)
2906{
b37f1d12 2907
12a48a8c
MB
2908 mutex_lock(&client_mutex);
2909 list_del(&platform->list);
bb13109d 2910 snd_soc_component_del_unlocked(&platform->component);
12a48a8c
MB
2911 mutex_unlock(&client_mutex);
2912
71a45cda 2913 dev_dbg(platform->dev, "ASoC: Unregistered platform '%s'\n",
f4333203 2914 platform->component.name);
decc27b0
DM
2915
2916 snd_soc_component_cleanup(&platform->component);
71a45cda
LPC
2917}
2918EXPORT_SYMBOL_GPL(snd_soc_remove_platform);
2919
2920struct snd_soc_platform *snd_soc_lookup_platform(struct device *dev)
2921{
2922 struct snd_soc_platform *platform;
2923
34e81ab4 2924 mutex_lock(&client_mutex);
71a45cda 2925 list_for_each_entry(platform, &platform_list, list) {
34e81ab4
LPC
2926 if (dev == platform->dev) {
2927 mutex_unlock(&client_mutex);
71a45cda 2928 return platform;
34e81ab4 2929 }
71a45cda 2930 }
34e81ab4 2931 mutex_unlock(&client_mutex);
71a45cda
LPC
2932
2933 return NULL;
2934}
2935EXPORT_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 */
2942void 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);
f0fba2ad 2951 kfree(platform);
12a48a8c
MB
2952}
2953EXPORT_SYMBOL_GPL(snd_soc_unregister_platform);
2954
151ab22c
MB
2955static 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 */
2979static 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
f1d45cc3
LPC
2988static 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
2995static 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
e2c330b9
LPC
3002static 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
3010static 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
68f831c2
LPC
3020static 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
0d0cf00a
MB
3028/**
3029 * snd_soc_register_codec - Register a codec with the ASoC core
3030 *
ac11a2b3 3031 * @codec: codec to register
0d0cf00a 3032 */
f0fba2ad 3033int snd_soc_register_codec(struct device *dev,
001ae4c0
MB
3034 const struct snd_soc_codec_driver *codec_drv,
3035 struct snd_soc_dai_driver *dai_drv,
3036 int num_dai)
0d0cf00a 3037{
f0fba2ad 3038 struct snd_soc_codec *codec;
bb13109d 3039 struct snd_soc_dai *dai;
f0fba2ad 3040 int ret, i;
151ab22c 3041
f0fba2ad
LG
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;
0d0cf00a 3047
ce0fc93a 3048 codec->component.dapm_ptr = &codec->dapm;
f1d45cc3 3049 codec->component.codec = codec;
ce0fc93a 3050
bb13109d
LPC
3051 ret = snd_soc_component_initialize(&codec->component,
3052 &codec_drv->component_driver, dev);
3053 if (ret)
3054 goto err_free;
f0fba2ad 3055
f1d45cc3
LPC
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;
e2c330b9
LPC
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;
3d59400f 3077 codec->component.ignore_pmdown_time = codec_drv->ignore_pmdown_time;
5819c2fa 3078 codec->dapm.idle_bias_off = codec_drv->idle_bias_off;
86dbf2ac 3079 codec->dapm.suspend_bias_off = codec_drv->suspend_bias_off;
14e8bdeb
LPC
3080 if (codec_drv->seq_notifier)
3081 codec->dapm.seq_notifier = codec_drv->seq_notifier;
68f831c2
LPC
3082 if (codec_drv->set_bias_level)
3083 codec->dapm.set_bias_level = snd_soc_codec_set_bias_level;
7a30a3db
DP
3084 codec->dev = dev;
3085 codec->driver = codec_drv;
e2c330b9 3086 codec->component.val_bytes = codec_drv->reg_word_size;
ce6120cc 3087
81c7cfd1
LPC
3088#ifdef CONFIG_DEBUG_FS
3089 codec->component.init_debugfs = soc_init_codec_debugfs;
3090 codec->component.debugfs_prefix = "codec";
3091#endif
3092
886f5692
LPC
3093 if (codec_drv->get_regmap)
3094 codec->component.regmap = codec_drv->get_regmap(dev);
a39f75f7 3095
f0fba2ad
LG
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
bb13109d 3101 ret = snd_soc_register_dais(&codec->component, dai_drv, num_dai, false);
5acd7dfb 3102 if (ret < 0) {
f42cf8d6 3103 dev_err(dev, "ASoC: Failed to register DAIs: %d\n", ret);
bb13109d 3104 goto err_cleanup;
26b01ccd 3105 }
f0fba2ad 3106
bb13109d
LPC
3107 list_for_each_entry(dai, &codec->component.dai_list, list)
3108 dai->codec = codec;
f0fba2ad 3109
e1328a83 3110 mutex_lock(&client_mutex);
bb13109d 3111 snd_soc_component_add_unlocked(&codec->component);
054880fe 3112 list_add(&codec->list, &codec_list);
e1328a83
KM
3113 mutex_unlock(&client_mutex);
3114
f4333203
LPC
3115 dev_dbg(codec->dev, "ASoC: Registered codec '%s'\n",
3116 codec->component.name);
0d0cf00a 3117 return 0;
f0fba2ad 3118
bb13109d
LPC
3119err_cleanup:
3120 snd_soc_component_cleanup(&codec->component);
3121err_free:
f0fba2ad
LG
3122 kfree(codec);
3123 return ret;
0d0cf00a
MB
3124}
3125EXPORT_SYMBOL_GPL(snd_soc_register_codec);
3126
3127/**
3128 * snd_soc_unregister_codec - Unregister a codec from the ASoC core
3129 *
ac11a2b3 3130 * @codec: codec to unregister
0d0cf00a 3131 */
f0fba2ad 3132void snd_soc_unregister_codec(struct device *dev)
0d0cf00a 3133{
f0fba2ad 3134 struct snd_soc_codec *codec;
f0fba2ad 3135
34e81ab4 3136 mutex_lock(&client_mutex);
f0fba2ad
LG
3137 list_for_each_entry(codec, &codec_list, list) {
3138 if (dev == codec->dev)
3139 goto found;
3140 }
34e81ab4 3141 mutex_unlock(&client_mutex);
f0fba2ad
LG
3142 return;
3143
3144found:
0d0cf00a 3145 list_del(&codec->list);
bb13109d 3146 snd_soc_component_del_unlocked(&codec->component);
0d0cf00a
MB
3147 mutex_unlock(&client_mutex);
3148
f4333203
LPC
3149 dev_dbg(codec->dev, "ASoC: Unregistered codec '%s'\n",
3150 codec->component.name);
f0fba2ad 3151
bb13109d 3152 snd_soc_component_cleanup(&codec->component);
7a30a3db 3153 snd_soc_cache_exit(codec);
f0fba2ad 3154 kfree(codec);
0d0cf00a
MB
3155}
3156EXPORT_SYMBOL_GPL(snd_soc_unregister_codec);
3157
bec4fa05
SW
3158/* Retrieve a card's name from device tree */
3159int snd_soc_of_parse_card_name(struct snd_soc_card *card,
3160 const char *propname)
3161{
7e07e7c0 3162 struct device_node *np;
bec4fa05
SW
3163 int ret;
3164
7e07e7c0
TB
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
bec4fa05
SW
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,
f110bfc7 3180 "ASoC: Property '%s' could not be read: %d\n",
bec4fa05
SW
3181 propname, ret);
3182 return ret;
3183 }
3184
3185 return 0;
3186}
3187EXPORT_SYMBOL_GPL(snd_soc_of_parse_card_name);
3188
9a6d4860
XL
3189static 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
3196int 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
f23e860e
NC
3269 card->of_dapm_widgets = widgets;
3270 card->num_of_dapm_widgets = num_widgets;
9a6d4860
XL
3271
3272 return 0;
3273}
3274EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_simple_widgets);
3275
89c67857
XL
3276int 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}
3303EXPORT_SYMBOL_GPL(snd_soc_of_parse_tdm_slot);
3304
a4a54dd5
SW
3305int 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;
e3b1e6a1 3309 int num_routes;
a4a54dd5
SW
3310 struct snd_soc_dapm_route *routes;
3311 int i, ret;
3312
3313 num_routes = of_property_count_strings(np, propname);
c34ce320 3314 if (num_routes < 0 || num_routes & 1) {
10e8aa9a
MM
3315 dev_err(card->dev,
3316 "ASoC: Property '%s' does not exist or its length is not even\n",
3317 propname);
a4a54dd5
SW
3318 return -EINVAL;
3319 }
3320 num_routes /= 2;
3321 if (!num_routes) {
f110bfc7 3322 dev_err(card->dev, "ASoC: Property '%s's length is zero\n",
a4a54dd5
SW
3323 propname);
3324 return -EINVAL;
3325 }
3326
e3b1e6a1 3327 routes = devm_kzalloc(card->dev, num_routes * sizeof(*routes),
a4a54dd5
SW
3328 GFP_KERNEL);
3329 if (!routes) {
3330 dev_err(card->dev,
f110bfc7 3331 "ASoC: Could not allocate DAPM route table\n");
a4a54dd5
SW
3332 return -EINVAL;
3333 }
3334
3335 for (i = 0; i < num_routes; i++) {
3336 ret = of_property_read_string_index(np, propname,
e3b1e6a1 3337 2 * i, &routes[i].sink);
a4a54dd5 3338 if (ret) {
c871bd0b
MB
3339 dev_err(card->dev,
3340 "ASoC: Property '%s' index %d could not be read: %d\n",
3341 propname, 2 * i, ret);
a4a54dd5
SW
3342 return -EINVAL;
3343 }
3344 ret = of_property_read_string_index(np, propname,
e3b1e6a1 3345 (2 * i) + 1, &routes[i].source);
a4a54dd5
SW
3346 if (ret) {
3347 dev_err(card->dev,
c871bd0b
MB
3348 "ASoC: Property '%s' index %d could not be read: %d\n",
3349 propname, (2 * i) + 1, ret);
a4a54dd5
SW
3350 return -EINVAL;
3351 }
3352 }
3353
f23e860e
NC
3354 card->num_of_dapm_routes = num_routes;
3355 card->of_dapm_routes = routes;
a4a54dd5
SW
3356
3357 return 0;
3358}
3359EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_routing);
3360
a7930ed4 3361unsigned int snd_soc_of_parse_daifmt(struct device_node *np,
389cb834
JS
3362 const char *prefix,
3363 struct device_node **bitclkmaster,
3364 struct device_node **framemaster)
a7930ed4
KM
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 },
a7930ed4
KM
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 /*
8c2d6a9f 3405 * check "[prefix]continuous-clock"
a7930ed4
KM
3406 * SND_SOC_DAIFMT_CLOCK_MASK area
3407 */
8c2d6a9f
KM
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;
a7930ed4
KM
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);
389cb834
JS
3447 if (bit && bitclkmaster)
3448 *bitclkmaster = of_parse_phandle(np, prop, 0);
a7930ed4
KM
3449
3450 snprintf(prop, sizeof(prop), "%sframe-master", prefix);
3451 frame = !!of_get_property(np, prop, NULL);
389cb834
JS
3452 if (frame && framemaster)
3453 *framemaster = of_parse_phandle(np, prop, 0);
a7930ed4
KM
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}
3472EXPORT_SYMBOL_GPL(snd_soc_of_parse_daifmt);
3473
93b0f3ee
JFM
3474static int snd_soc_get_dai_name(struct of_phandle_args *args,
3475 const char **dai_name)
cb470087
KM
3476{
3477 struct snd_soc_component *pos;
93b0f3ee 3478 int ret = -EPROBE_DEFER;
cb470087
KM
3479
3480 mutex_lock(&client_mutex);
3481 list_for_each_entry(pos, &component_list, list) {
93b0f3ee 3482 if (pos->dev->of_node != args->np)
cb470087
KM
3483 continue;
3484
6833c452 3485 if (pos->driver->of_xlate_dai_name) {
93b0f3ee
JFM
3486 ret = pos->driver->of_xlate_dai_name(pos,
3487 args,
3488 dai_name);
6833c452
KM
3489 } else {
3490 int id = -1;
3491
93b0f3ee 3492 switch (args->args_count) {
6833c452
KM
3493 case 0:
3494 id = 0; /* same as dai_drv[0] */
3495 break;
3496 case 1:
93b0f3ee 3497 id = args->args[0];
6833c452
KM
3498 break;
3499 default:
3500 /* not supported */
3501 break;
3502 }
3503
3504 if (id < 0 || id >= pos->num_dai) {
3505 ret = -EINVAL;
3dcba280 3506 continue;
6833c452 3507 }
e41975ed
XL
3508
3509 ret = 0;
3510
3511 *dai_name = pos->dai_drv[id].name;
3512 if (!*dai_name)
3513 *dai_name = pos->name;
cb470087
KM
3514 }
3515
cb470087
KM
3516 break;
3517 }
3518 mutex_unlock(&client_mutex);
93b0f3ee
JFM
3519 return ret;
3520}
3521
3522int 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);
cb470087
KM
3534
3535 of_node_put(args.np);
3536
3537 return ret;
3538}
3539EXPORT_SYMBOL_GPL(snd_soc_of_get_dai_name);
3540
93b0f3ee
JFM
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 */
3554int 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;
3597err:
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}
3610EXPORT_SYMBOL_GPL(snd_soc_of_get_dai_link_codecs);
3611
c9b3a40f 3612static int __init snd_soc_init(void)
db2a4165 3613{
6553bf06 3614 snd_soc_debugfs_init();
fb257897
MB
3615 snd_soc_util_init();
3616
db2a4165
FM
3617 return platform_driver_register(&soc_driver);
3618}
4abe8e16 3619module_init(snd_soc_init);
db2a4165 3620
7d8c16a6 3621static void __exit snd_soc_exit(void)
db2a4165 3622{
fb257897 3623 snd_soc_util_exit();
6553bf06 3624 snd_soc_debugfs_exit();
fb257897 3625
384c89e2 3626#ifdef CONFIG_DEBUG_FS
384c89e2 3627#endif
3ff3f64b 3628 platform_driver_unregister(&soc_driver);
db2a4165 3629}
db2a4165
FM
3630module_exit(snd_soc_exit);
3631
3632/* Module information */
d331124d 3633MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
db2a4165
FM
3634MODULE_DESCRIPTION("ALSA SoC Core");
3635MODULE_LICENSE("GPL");
8b45a209 3636MODULE_ALIAS("platform:soc-audio");
This page took 1.769922 seconds and 5 git commands to generate.