ASoC: add definations for compressed operations
[linux-2.6-block.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>
f0e8ed85 33#include <linux/ctype.h>
5a0e3ad6 34#include <linux/slab.h>
bec4fa05 35#include <linux/of.h>
474828a4 36#include <sound/ac97_codec.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
db2a4165
FM
50static DECLARE_WAIT_QUEUE_HEAD(soc_pm_waitq);
51
384c89e2 52#ifdef CONFIG_DEBUG_FS
8a9dab1a
MB
53struct dentry *snd_soc_debugfs_root;
54EXPORT_SYMBOL_GPL(snd_soc_debugfs_root);
384c89e2
MB
55#endif
56
c5af3a2e 57static DEFINE_MUTEX(client_mutex);
9115171a 58static LIST_HEAD(dai_list);
12a48a8c 59static LIST_HEAD(platform_list);
0d0cf00a 60static LIST_HEAD(codec_list);
c5af3a2e 61
db2a4165
FM
62/*
63 * This is a timeout to do a DAPM powerdown after a stream is closed().
64 * It can be used to eliminate pops between different playback streams, e.g.
65 * between two audio tracks.
66 */
67static int pmdown_time = 5000;
68module_param(pmdown_time, int, 0);
69MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
70
2bc9a81e
DP
71/* returns the minimum number of bytes needed to represent
72 * a particular given value */
73static int min_bytes_needed(unsigned long val)
74{
75 int c = 0;
76 int i;
77
78 for (i = (sizeof val * 8) - 1; i >= 0; --i, ++c)
79 if (val & (1UL << i))
80 break;
81 c = (sizeof val * 8) - c;
82 if (!c || (c % 8))
83 c = (c + 8) / 8;
84 else
85 c /= 8;
86 return c;
87}
88
13fd179f
DP
89/* fill buf which is 'len' bytes with a formatted
90 * string of the form 'reg: value\n' */
91static int format_register_str(struct snd_soc_codec *codec,
92 unsigned int reg, char *buf, size_t len)
93{
00b317a4
SW
94 int wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
95 int regsize = codec->driver->reg_word_size * 2;
13fd179f
DP
96 int ret;
97 char tmpbuf[len + 1];
98 char regbuf[regsize + 1];
99
100 /* since tmpbuf is allocated on the stack, warn the callers if they
101 * try to abuse this function */
102 WARN_ON(len > 63);
103
104 /* +2 for ': ' and + 1 for '\n' */
105 if (wordsize + regsize + 2 + 1 != len)
106 return -EINVAL;
107
25032c11 108 ret = snd_soc_read(codec, reg);
13fd179f
DP
109 if (ret < 0) {
110 memset(regbuf, 'X', regsize);
111 regbuf[regsize] = '\0';
112 } else {
113 snprintf(regbuf, regsize + 1, "%.*x", regsize, ret);
114 }
115
116 /* prepare the buffer */
117 snprintf(tmpbuf, len + 1, "%.*x: %s\n", wordsize, reg, regbuf);
118 /* copy it back to the caller without the '\0' */
119 memcpy(buf, tmpbuf, len);
120
121 return 0;
122}
123
2624d5fa 124/* codec register dump */
13fd179f
DP
125static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf,
126 size_t count, loff_t pos)
2624d5fa 127{
13fd179f 128 int i, step = 1;
2bc9a81e 129 int wordsize, regsize;
13fd179f
DP
130 int len;
131 size_t total = 0;
132 loff_t p = 0;
2bc9a81e 133
00b317a4
SW
134 wordsize = min_bytes_needed(codec->driver->reg_cache_size) * 2;
135 regsize = codec->driver->reg_word_size * 2;
2624d5fa 136
13fd179f
DP
137 len = wordsize + regsize + 2 + 1;
138
f0fba2ad 139 if (!codec->driver->reg_cache_size)
2624d5fa
MB
140 return 0;
141
f0fba2ad
LG
142 if (codec->driver->reg_cache_step)
143 step = codec->driver->reg_cache_step;
2624d5fa 144
f0fba2ad 145 for (i = 0; i < codec->driver->reg_cache_size; i += step) {
b92d150b 146 if (!snd_soc_codec_readable_register(codec, i))
2624d5fa 147 continue;
f0fba2ad
LG
148 if (codec->driver->display_register) {
149 count += codec->driver->display_register(codec, buf + count,
2624d5fa 150 PAGE_SIZE - count, i);
5164d74d 151 } else {
13fd179f
DP
152 /* only support larger than PAGE_SIZE bytes debugfs
153 * entries for the default case */
154 if (p >= pos) {
155 if (total + len >= count - 1)
156 break;
157 format_register_str(codec, i, buf + total, len);
158 total += len;
159 }
160 p += len;
5164d74d 161 }
2624d5fa
MB
162 }
163
13fd179f 164 total = min(total, count - 1);
2624d5fa 165
13fd179f 166 return total;
2624d5fa 167}
13fd179f 168
2624d5fa
MB
169static ssize_t codec_reg_show(struct device *dev,
170 struct device_attribute *attr, char *buf)
171{
36ae1a96 172 struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
f0fba2ad 173
13fd179f 174 return soc_codec_reg_show(rtd->codec, buf, PAGE_SIZE, 0);
2624d5fa
MB
175}
176
177static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
178
dbe21408
MB
179static ssize_t pmdown_time_show(struct device *dev,
180 struct device_attribute *attr, char *buf)
181{
36ae1a96 182 struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
dbe21408 183
f0fba2ad 184 return sprintf(buf, "%ld\n", rtd->pmdown_time);
dbe21408
MB
185}
186
187static ssize_t pmdown_time_set(struct device *dev,
188 struct device_attribute *attr,
189 const char *buf, size_t count)
190{
36ae1a96 191 struct snd_soc_pcm_runtime *rtd = dev_get_drvdata(dev);
c593b520 192 int ret;
dbe21408 193
c593b520
MB
194 ret = strict_strtol(buf, 10, &rtd->pmdown_time);
195 if (ret)
196 return ret;
dbe21408
MB
197
198 return count;
199}
200
201static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set);
202
2624d5fa 203#ifdef CONFIG_DEBUG_FS
2624d5fa 204static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
13fd179f 205 size_t count, loff_t *ppos)
2624d5fa
MB
206{
207 ssize_t ret;
208 struct snd_soc_codec *codec = file->private_data;
13fd179f
DP
209 char *buf;
210
211 if (*ppos < 0 || !count)
212 return -EINVAL;
213
214 buf = kmalloc(count, GFP_KERNEL);
2624d5fa
MB
215 if (!buf)
216 return -ENOMEM;
13fd179f
DP
217
218 ret = soc_codec_reg_show(codec, buf, count, *ppos);
219 if (ret >= 0) {
220 if (copy_to_user(user_buf, buf, ret)) {
221 kfree(buf);
222 return -EFAULT;
223 }
224 *ppos += ret;
225 }
226
2624d5fa
MB
227 kfree(buf);
228 return ret;
229}
230
231static ssize_t codec_reg_write_file(struct file *file,
232 const char __user *user_buf, size_t count, loff_t *ppos)
233{
234 char buf[32];
34e268d8 235 size_t buf_size;
2624d5fa
MB
236 char *start = buf;
237 unsigned long reg, value;
2624d5fa
MB
238 struct snd_soc_codec *codec = file->private_data;
239
240 buf_size = min(count, (sizeof(buf)-1));
241 if (copy_from_user(buf, user_buf, buf_size))
242 return -EFAULT;
243 buf[buf_size] = 0;
2624d5fa
MB
244
245 while (*start == ' ')
246 start++;
247 reg = simple_strtoul(start, &start, 16);
2624d5fa
MB
248 while (*start == ' ')
249 start++;
250 if (strict_strtoul(start, 16, &value))
251 return -EINVAL;
0d51a9cb
MB
252
253 /* Userspace has been fiddling around behind the kernel's back */
254 add_taint(TAINT_USER);
255
e4f078d8 256 snd_soc_write(codec, reg, value);
2624d5fa
MB
257 return buf_size;
258}
259
260static const struct file_operations codec_reg_fops = {
234e3405 261 .open = simple_open,
2624d5fa
MB
262 .read = codec_reg_read_file,
263 .write = codec_reg_write_file,
6038f373 264 .llseek = default_llseek,
2624d5fa
MB
265};
266
267static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
268{
d6ce4cf3
JN
269 struct dentry *debugfs_card_root = codec->card->debugfs_card_root;
270
271 codec->debugfs_codec_root = debugfs_create_dir(codec->name,
272 debugfs_card_root);
2624d5fa 273 if (!codec->debugfs_codec_root) {
64e60f9f 274 dev_warn(codec->dev, "Failed to create codec debugfs directory\n");
2624d5fa
MB
275 return;
276 }
277
aaee8ef1
MB
278 debugfs_create_bool("cache_sync", 0444, codec->debugfs_codec_root,
279 &codec->cache_sync);
280 debugfs_create_bool("cache_only", 0444, codec->debugfs_codec_root,
281 &codec->cache_only);
282
2624d5fa
MB
283 codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
284 codec->debugfs_codec_root,
285 codec, &codec_reg_fops);
286 if (!codec->debugfs_reg)
64e60f9f 287 dev_warn(codec->dev, "Failed to create codec register debugfs file\n");
2624d5fa 288
8eecaf62 289 snd_soc_dapm_debugfs_init(&codec->dapm, codec->debugfs_codec_root);
2624d5fa
MB
290}
291
292static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
293{
294 debugfs_remove_recursive(codec->debugfs_codec_root);
295}
296
731f1ab2
SG
297static void soc_init_platform_debugfs(struct snd_soc_platform *platform)
298{
299 struct dentry *debugfs_card_root = platform->card->debugfs_card_root;
300
301 platform->debugfs_platform_root = debugfs_create_dir(platform->name,
302 debugfs_card_root);
303 if (!platform->debugfs_platform_root) {
304 dev_warn(platform->dev,
305 "Failed to create platform debugfs directory\n");
306 return;
307 }
308
309 snd_soc_dapm_debugfs_init(&platform->dapm,
310 platform->debugfs_platform_root);
311}
312
313static void soc_cleanup_platform_debugfs(struct snd_soc_platform *platform)
314{
315 debugfs_remove_recursive(platform->debugfs_platform_root);
316}
317
c3c5a19a
MB
318static ssize_t codec_list_read_file(struct file *file, char __user *user_buf,
319 size_t count, loff_t *ppos)
320{
321 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
2b194f9d 322 ssize_t len, ret = 0;
c3c5a19a
MB
323 struct snd_soc_codec *codec;
324
325 if (!buf)
326 return -ENOMEM;
327
2b194f9d
MB
328 list_for_each_entry(codec, &codec_list, list) {
329 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
330 codec->name);
331 if (len >= 0)
332 ret += len;
333 if (ret > PAGE_SIZE) {
334 ret = PAGE_SIZE;
335 break;
336 }
337 }
c3c5a19a
MB
338
339 if (ret >= 0)
340 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
341
342 kfree(buf);
343
344 return ret;
345}
346
347static const struct file_operations codec_list_fops = {
348 .read = codec_list_read_file,
349 .llseek = default_llseek,/* read accesses f_pos */
350};
351
f3208780
MB
352static ssize_t dai_list_read_file(struct file *file, char __user *user_buf,
353 size_t count, loff_t *ppos)
354{
355 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
2b194f9d 356 ssize_t len, ret = 0;
f3208780
MB
357 struct snd_soc_dai *dai;
358
359 if (!buf)
360 return -ENOMEM;
361
2b194f9d
MB
362 list_for_each_entry(dai, &dai_list, list) {
363 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n", dai->name);
364 if (len >= 0)
365 ret += len;
366 if (ret > PAGE_SIZE) {
367 ret = PAGE_SIZE;
368 break;
369 }
370 }
f3208780 371
2b194f9d 372 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
f3208780
MB
373
374 kfree(buf);
375
376 return ret;
377}
378
379static const struct file_operations dai_list_fops = {
380 .read = dai_list_read_file,
381 .llseek = default_llseek,/* read accesses f_pos */
382};
383
19c7ac27
MB
384static ssize_t platform_list_read_file(struct file *file,
385 char __user *user_buf,
386 size_t count, loff_t *ppos)
387{
388 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
2b194f9d 389 ssize_t len, ret = 0;
19c7ac27
MB
390 struct snd_soc_platform *platform;
391
392 if (!buf)
393 return -ENOMEM;
394
2b194f9d
MB
395 list_for_each_entry(platform, &platform_list, list) {
396 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
397 platform->name);
398 if (len >= 0)
399 ret += len;
400 if (ret > PAGE_SIZE) {
401 ret = PAGE_SIZE;
402 break;
403 }
404 }
19c7ac27 405
2b194f9d 406 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
19c7ac27
MB
407
408 kfree(buf);
409
410 return ret;
411}
412
413static const struct file_operations platform_list_fops = {
414 .read = platform_list_read_file,
415 .llseek = default_llseek,/* read accesses f_pos */
416};
417
a6052154
JN
418static void soc_init_card_debugfs(struct snd_soc_card *card)
419{
420 card->debugfs_card_root = debugfs_create_dir(card->name,
8a9dab1a 421 snd_soc_debugfs_root);
3a45b867 422 if (!card->debugfs_card_root) {
a6052154 423 dev_warn(card->dev,
7c08be84 424 "ASoC: Failed to create card debugfs directory\n");
3a45b867
JN
425 return;
426 }
427
428 card->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0644,
429 card->debugfs_card_root,
430 &card->pop_time);
431 if (!card->debugfs_pop_time)
432 dev_warn(card->dev,
433 "Failed to create pop time debugfs file\n");
a6052154
JN
434}
435
436static void soc_cleanup_card_debugfs(struct snd_soc_card *card)
437{
438 debugfs_remove_recursive(card->debugfs_card_root);
439}
440
2624d5fa
MB
441#else
442
443static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
444{
445}
446
447static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
448{
449}
b95fccbc 450
731f1ab2
SG
451static inline void soc_init_platform_debugfs(struct snd_soc_platform *platform)
452{
453}
454
455static inline void soc_cleanup_platform_debugfs(struct snd_soc_platform *platform)
456{
457}
458
b95fccbc
AL
459static inline void soc_init_card_debugfs(struct snd_soc_card *card)
460{
461}
462
463static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card)
464{
465}
2624d5fa
MB
466#endif
467
47c88fff
LG
468struct snd_pcm_substream *snd_soc_get_dai_substream(struct snd_soc_card *card,
469 const char *dai_link, int stream)
470{
471 int i;
472
473 for (i = 0; i < card->num_links; i++) {
474 if (card->rtd[i].dai_link->no_pcm &&
475 !strcmp(card->rtd[i].dai_link->name, dai_link))
476 return card->rtd[i].pcm->streams[stream].substream;
477 }
478 dev_dbg(card->dev, "failed to find dai link %s\n", dai_link);
479 return NULL;
480}
481EXPORT_SYMBOL_GPL(snd_soc_get_dai_substream);
482
483struct snd_soc_pcm_runtime *snd_soc_get_pcm_runtime(struct snd_soc_card *card,
484 const char *dai_link)
485{
486 int i;
487
488 for (i = 0; i < card->num_links; i++) {
489 if (!strcmp(card->rtd[i].dai_link->name, dai_link))
490 return &card->rtd[i];
491 }
492 dev_dbg(card->dev, "failed to find rtd %s\n", dai_link);
493 return NULL;
494}
495EXPORT_SYMBOL_GPL(snd_soc_get_pcm_runtime);
496
db2a4165
FM
497#ifdef CONFIG_SND_SOC_AC97_BUS
498/* unregister ac97 codec */
499static int soc_ac97_dev_unregister(struct snd_soc_codec *codec)
500{
501 if (codec->ac97->dev.bus)
502 device_unregister(&codec->ac97->dev);
503 return 0;
504}
505
506/* stop no dev release warning */
507static void soc_ac97_device_release(struct device *dev){}
508
509/* register ac97 codec to bus */
510static int soc_ac97_dev_register(struct snd_soc_codec *codec)
511{
512 int err;
513
514 codec->ac97->dev.bus = &ac97_bus_type;
4ac5c61f 515 codec->ac97->dev.parent = codec->card->dev;
db2a4165
FM
516 codec->ac97->dev.release = soc_ac97_device_release;
517
bb072bf0 518 dev_set_name(&codec->ac97->dev, "%d-%d:%s",
f0fba2ad 519 codec->card->snd_card->number, 0, codec->name);
db2a4165
FM
520 err = device_register(&codec->ac97->dev);
521 if (err < 0) {
522 snd_printk(KERN_ERR "Can't register ac97 bus\n");
523 codec->ac97->dev.bus = NULL;
524 return err;
525 }
526 return 0;
527}
528#endif
529
6f8ab4ac 530#ifdef CONFIG_PM_SLEEP
db2a4165 531/* powers down audio subsystem for suspend */
6f8ab4ac 532int snd_soc_suspend(struct device *dev)
db2a4165 533{
6f8ab4ac 534 struct snd_soc_card *card = dev_get_drvdata(dev);
2eea392d 535 struct snd_soc_codec *codec;
db2a4165
FM
536 int i;
537
e3509ff0
DM
538 /* If the initialization of this soc device failed, there is no codec
539 * associated with it. Just bail out in this case.
540 */
f0fba2ad 541 if (list_empty(&card->codec_dev_list))
e3509ff0
DM
542 return 0;
543
6ed25978
AG
544 /* Due to the resume being scheduled into a workqueue we could
545 * suspend before that's finished - wait for it to complete.
546 */
f0fba2ad
LG
547 snd_power_lock(card->snd_card);
548 snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0);
549 snd_power_unlock(card->snd_card);
6ed25978
AG
550
551 /* we're going to block userspace touching us until resume completes */
f0fba2ad 552 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
6ed25978 553
a00f90f9 554 /* mute any active DACs */
f0fba2ad
LG
555 for (i = 0; i < card->num_rtd; i++) {
556 struct snd_soc_dai *dai = card->rtd[i].codec_dai;
557 struct snd_soc_dai_driver *drv = dai->driver;
3efab7dc 558
f0fba2ad 559 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
560 continue;
561
f0fba2ad
LG
562 if (drv->ops->digital_mute && dai->playback_active)
563 drv->ops->digital_mute(dai, 1);
db2a4165
FM
564 }
565
4ccab3e7 566 /* suspend all pcms */
f0fba2ad
LG
567 for (i = 0; i < card->num_rtd; i++) {
568 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
569 continue;
570
f0fba2ad 571 snd_pcm_suspend_all(card->rtd[i].pcm);
3efab7dc 572 }
4ccab3e7 573
87506549 574 if (card->suspend_pre)
70b2ac12 575 card->suspend_pre(card);
db2a4165 576
f0fba2ad
LG
577 for (i = 0; i < card->num_rtd; i++) {
578 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
579 struct snd_soc_platform *platform = card->rtd[i].platform;
3efab7dc 580
f0fba2ad 581 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
582 continue;
583
f0fba2ad
LG
584 if (cpu_dai->driver->suspend && !cpu_dai->driver->ac97_control)
585 cpu_dai->driver->suspend(cpu_dai);
586 if (platform->driver->suspend && !platform->suspended) {
587 platform->driver->suspend(cpu_dai);
588 platform->suspended = 1;
589 }
db2a4165
FM
590 }
591
592 /* close any waiting streams and save state */
f0fba2ad 593 for (i = 0; i < card->num_rtd; i++) {
5b84ba26 594 flush_delayed_work_sync(&card->rtd[i].delayed_work);
ce6120cc 595 card->rtd[i].codec->dapm.suspend_bias_level = card->rtd[i].codec->dapm.bias_level;
f0fba2ad 596 }
db2a4165 597
f0fba2ad 598 for (i = 0; i < card->num_rtd; i++) {
3efab7dc 599
f0fba2ad 600 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
601 continue;
602
7bd3a6f3
MB
603 snd_soc_dapm_stream_event(&card->rtd[i],
604 SNDRV_PCM_STREAM_PLAYBACK,
7bd3a6f3 605 SND_SOC_DAPM_STREAM_SUSPEND);
f0fba2ad 606
7bd3a6f3
MB
607 snd_soc_dapm_stream_event(&card->rtd[i],
608 SNDRV_PCM_STREAM_CAPTURE,
7bd3a6f3 609 SND_SOC_DAPM_STREAM_SUSPEND);
db2a4165
FM
610 }
611
f0fba2ad 612 /* suspend all CODECs */
2eea392d 613 list_for_each_entry(codec, &card->codec_dev_list, card_list) {
f0fba2ad
LG
614 /* If there are paths active then the CODEC will be held with
615 * bias _ON and should not be suspended. */
616 if (!codec->suspended && codec->driver->suspend) {
ce6120cc 617 switch (codec->dapm.bias_level) {
f0fba2ad 618 case SND_SOC_BIAS_STANDBY:
125a25da
MB
619 /*
620 * If the CODEC is capable of idle
621 * bias off then being in STANDBY
622 * means it's doing something,
623 * otherwise fall through.
624 */
625 if (codec->dapm.idle_bias_off) {
626 dev_dbg(codec->dev,
627 "idle_bias_off CODEC on over suspend\n");
628 break;
629 }
f0fba2ad 630 case SND_SOC_BIAS_OFF:
84b315ee 631 codec->driver->suspend(codec);
f0fba2ad 632 codec->suspended = 1;
7be4ba24 633 codec->cache_sync = 1;
f0fba2ad
LG
634 break;
635 default:
636 dev_dbg(codec->dev, "CODEC is on over suspend\n");
637 break;
638 }
1547aba9
MB
639 }
640 }
db2a4165 641
f0fba2ad
LG
642 for (i = 0; i < card->num_rtd; i++) {
643 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
3efab7dc 644
f0fba2ad 645 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
646 continue;
647
f0fba2ad
LG
648 if (cpu_dai->driver->suspend && cpu_dai->driver->ac97_control)
649 cpu_dai->driver->suspend(cpu_dai);
db2a4165
FM
650 }
651
87506549 652 if (card->suspend_post)
70b2ac12 653 card->suspend_post(card);
db2a4165
FM
654
655 return 0;
656}
6f8ab4ac 657EXPORT_SYMBOL_GPL(snd_soc_suspend);
db2a4165 658
6ed25978
AG
659/* deferred resume work, so resume can complete before we finished
660 * setting our codec back up, which can be very slow on I2C
661 */
662static void soc_resume_deferred(struct work_struct *work)
db2a4165 663{
f0fba2ad
LG
664 struct snd_soc_card *card =
665 container_of(work, struct snd_soc_card, deferred_resume_work);
2eea392d 666 struct snd_soc_codec *codec;
db2a4165
FM
667 int i;
668
6ed25978
AG
669 /* our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
670 * so userspace apps are blocked from touching us
671 */
672
f0fba2ad 673 dev_dbg(card->dev, "starting resume work\n");
6ed25978 674
9949788b 675 /* Bring us up into D2 so that DAPM starts enabling things */
f0fba2ad 676 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
9949788b 677
87506549 678 if (card->resume_pre)
70b2ac12 679 card->resume_pre(card);
db2a4165 680
f0fba2ad
LG
681 /* resume AC97 DAIs */
682 for (i = 0; i < card->num_rtd; i++) {
683 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
3efab7dc 684
f0fba2ad 685 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
686 continue;
687
f0fba2ad
LG
688 if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control)
689 cpu_dai->driver->resume(cpu_dai);
690 }
691
2eea392d 692 list_for_each_entry(codec, &card->codec_dev_list, card_list) {
f0fba2ad
LG
693 /* If the CODEC was idle over suspend then it will have been
694 * left with bias OFF or STANDBY and suspended so we must now
695 * resume. Otherwise the suspend was suppressed.
696 */
697 if (codec->driver->resume && codec->suspended) {
ce6120cc 698 switch (codec->dapm.bias_level) {
f0fba2ad
LG
699 case SND_SOC_BIAS_STANDBY:
700 case SND_SOC_BIAS_OFF:
701 codec->driver->resume(codec);
702 codec->suspended = 0;
703 break;
704 default:
705 dev_dbg(codec->dev, "CODEC was on over suspend\n");
706 break;
707 }
1547aba9
MB
708 }
709 }
db2a4165 710
f0fba2ad 711 for (i = 0; i < card->num_rtd; i++) {
3efab7dc 712
f0fba2ad 713 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
714 continue;
715
7bd3a6f3 716 snd_soc_dapm_stream_event(&card->rtd[i],
d9b0951b 717 SNDRV_PCM_STREAM_PLAYBACK,
7bd3a6f3 718 SND_SOC_DAPM_STREAM_RESUME);
f0fba2ad 719
7bd3a6f3 720 snd_soc_dapm_stream_event(&card->rtd[i],
d9b0951b 721 SNDRV_PCM_STREAM_CAPTURE,
7bd3a6f3 722 SND_SOC_DAPM_STREAM_RESUME);
db2a4165
FM
723 }
724
3ff3f64b 725 /* unmute any active DACs */
f0fba2ad
LG
726 for (i = 0; i < card->num_rtd; i++) {
727 struct snd_soc_dai *dai = card->rtd[i].codec_dai;
728 struct snd_soc_dai_driver *drv = dai->driver;
3efab7dc 729
f0fba2ad 730 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
731 continue;
732
f0fba2ad
LG
733 if (drv->ops->digital_mute && dai->playback_active)
734 drv->ops->digital_mute(dai, 0);
db2a4165
FM
735 }
736
f0fba2ad
LG
737 for (i = 0; i < card->num_rtd; i++) {
738 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
739 struct snd_soc_platform *platform = card->rtd[i].platform;
3efab7dc 740
f0fba2ad 741 if (card->rtd[i].dai_link->ignore_suspend)
3efab7dc
MB
742 continue;
743
f0fba2ad
LG
744 if (cpu_dai->driver->resume && !cpu_dai->driver->ac97_control)
745 cpu_dai->driver->resume(cpu_dai);
746 if (platform->driver->resume && platform->suspended) {
747 platform->driver->resume(cpu_dai);
748 platform->suspended = 0;
749 }
db2a4165
FM
750 }
751
87506549 752 if (card->resume_post)
70b2ac12 753 card->resume_post(card);
db2a4165 754
f0fba2ad 755 dev_dbg(card->dev, "resume work completed\n");
6ed25978
AG
756
757 /* userspace can access us now we are back as we were before */
f0fba2ad 758 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
6ed25978
AG
759}
760
761/* powers up audio subsystem after a suspend */
6f8ab4ac 762int snd_soc_resume(struct device *dev)
6ed25978 763{
6f8ab4ac 764 struct snd_soc_card *card = dev_get_drvdata(dev);
82e14e8b 765 int i, ac97_control = 0;
b9dd94a8 766
5ff1ddf2
EM
767 /* If the initialization of this soc device failed, there is no codec
768 * associated with it. Just bail out in this case.
769 */
770 if (list_empty(&card->codec_dev_list))
771 return 0;
772
64ab9baa
MB
773 /* AC97 devices might have other drivers hanging off them so
774 * need to resume immediately. Other drivers don't have that
775 * problem and may take a substantial amount of time to resume
776 * due to I/O costs and anti-pop so handle them out of line.
777 */
f0fba2ad
LG
778 for (i = 0; i < card->num_rtd; i++) {
779 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
82e14e8b
SW
780 ac97_control |= cpu_dai->driver->ac97_control;
781 }
782 if (ac97_control) {
783 dev_dbg(dev, "Resuming AC97 immediately\n");
784 soc_resume_deferred(&card->deferred_resume_work);
785 } else {
786 dev_dbg(dev, "Scheduling resume work\n");
787 if (!schedule_work(&card->deferred_resume_work))
788 dev_err(dev, "resume work item may be lost\n");
64ab9baa 789 }
6ed25978 790
db2a4165
FM
791 return 0;
792}
6f8ab4ac 793EXPORT_SYMBOL_GPL(snd_soc_resume);
db2a4165 794#else
6f8ab4ac
MB
795#define snd_soc_suspend NULL
796#define snd_soc_resume NULL
db2a4165
FM
797#endif
798
85e7652d 799static const struct snd_soc_dai_ops null_dai_ops = {
02a06d30
BS
800};
801
f0fba2ad 802static int soc_bind_dai_link(struct snd_soc_card *card, int num)
db2a4165 803{
f0fba2ad
LG
804 struct snd_soc_dai_link *dai_link = &card->dai_link[num];
805 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
fe3e78e0 806 struct snd_soc_codec *codec;
435c5e25 807 struct snd_soc_platform *platform;
f0fba2ad 808 struct snd_soc_dai *codec_dai, *cpu_dai;
848dd8be 809 const char *platform_name;
435c5e25 810
f0fba2ad 811 dev_dbg(card->dev, "binding %s at idx %d\n", dai_link->name, num);
435c5e25 812
b19e6e7b 813 /* Find CPU DAI from registered DAIs*/
f0fba2ad 814 list_for_each_entry(cpu_dai, &dai_list, list) {
bc92657a
SW
815 if (dai_link->cpu_of_node &&
816 (cpu_dai->dev->of_node != dai_link->cpu_of_node))
817 continue;
818 if (dai_link->cpu_name &&
819 strcmp(dev_name(cpu_dai->dev), dai_link->cpu_name))
820 continue;
821 if (dai_link->cpu_dai_name &&
822 strcmp(cpu_dai->name, dai_link->cpu_dai_name))
823 continue;
2610ab77
SW
824
825 rtd->cpu_dai = cpu_dai;
435c5e25 826 }
6308419a 827
b19e6e7b
MB
828 if (!rtd->cpu_dai) {
829 dev_dbg(card->dev, "CPU DAI %s not registered\n",
830 dai_link->cpu_dai_name);
831 return -EPROBE_DEFER;
f0fba2ad
LG
832 }
833
b19e6e7b 834 /* Find CODEC from registered CODECs */
f0fba2ad 835 list_for_each_entry(codec, &codec_list, list) {
5a504963
SW
836 if (dai_link->codec_of_node) {
837 if (codec->dev->of_node != dai_link->codec_of_node)
838 continue;
839 } else {
840 if (strcmp(codec->name, dai_link->codec_name))
841 continue;
842 }
2610ab77
SW
843
844 rtd->codec = codec;
845
846 /*
847 * CODEC found, so find CODEC DAI from registered DAIs from
848 * this CODEC
849 */
850 list_for_each_entry(codec_dai, &dai_list, list) {
851 if (codec->dev == codec_dai->dev &&
852 !strcmp(codec_dai->name,
853 dai_link->codec_dai_name)) {
f0fba2ad 854
2610ab77 855 rtd->codec_dai = codec_dai;
2610ab77 856 }
435c5e25 857 }
2610ab77 858
b19e6e7b
MB
859 if (!rtd->codec_dai) {
860 dev_dbg(card->dev, "CODEC DAI %s not registered\n",
861 dai_link->codec_dai_name);
862 return -EPROBE_DEFER;
863 }
f0fba2ad 864 }
6b05eda6 865
b19e6e7b
MB
866 if (!rtd->codec) {
867 dev_dbg(card->dev, "CODEC %s not registered\n",
868 dai_link->codec_name);
869 return -EPROBE_DEFER;
870 }
848dd8be
MB
871
872 /* if there's no platform we match on the empty platform */
873 platform_name = dai_link->platform_name;
5a504963 874 if (!platform_name && !dai_link->platform_of_node)
848dd8be
MB
875 platform_name = "snd-soc-dummy";
876
b19e6e7b 877 /* find one from the set of registered platforms */
f0fba2ad 878 list_for_each_entry(platform, &platform_list, list) {
5a504963
SW
879 if (dai_link->platform_of_node) {
880 if (platform->dev->of_node !=
881 dai_link->platform_of_node)
882 continue;
883 } else {
884 if (strcmp(platform->name, platform_name))
885 continue;
886 }
2610ab77
SW
887
888 rtd->platform = platform;
02a06d30 889 }
b19e6e7b
MB
890 if (!rtd->platform) {
891 dev_dbg(card->dev, "platform %s not registered\n",
f0fba2ad 892 dai_link->platform_name);
b19e6e7b 893 return -EPROBE_DEFER;
f0fba2ad 894 }
b19e6e7b
MB
895
896 card->num_rtd++;
897
898 return 0;
f0fba2ad
LG
899}
900
d12cd198
SW
901static int soc_remove_platform(struct snd_soc_platform *platform)
902{
903 int ret;
904
905 if (platform->driver->remove) {
906 ret = platform->driver->remove(platform);
907 if (ret < 0)
908 pr_err("asoc: failed to remove %s: %d\n",
909 platform->name, ret);
910 }
911
912 /* Make sure all DAPM widgets are freed */
913 snd_soc_dapm_free(&platform->dapm);
914
915 soc_cleanup_platform_debugfs(platform);
916 platform->probed = 0;
917 list_del(&platform->card_list);
918 module_put(platform->dev->driver->owner);
919
920 return 0;
921}
922
589c3563
JN
923static void soc_remove_codec(struct snd_soc_codec *codec)
924{
925 int err;
926
927 if (codec->driver->remove) {
928 err = codec->driver->remove(codec);
929 if (err < 0)
930 dev_err(codec->dev,
931 "asoc: failed to remove %s: %d\n",
932 codec->name, err);
933 }
934
935 /* Make sure all DAPM widgets are freed */
936 snd_soc_dapm_free(&codec->dapm);
937
938 soc_cleanup_codec_debugfs(codec);
939 codec->probed = 0;
940 list_del(&codec->card_list);
941 module_put(codec->dev->driver->owner);
942}
943
62ae68fa 944static void soc_remove_link_dais(struct snd_soc_card *card, int num, int order)
f0fba2ad
LG
945{
946 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
f0fba2ad
LG
947 struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
948 int err;
949
950 /* unregister the rtd device */
951 if (rtd->dev_registered) {
36ae1a96
MB
952 device_remove_file(rtd->dev, &dev_attr_pmdown_time);
953 device_remove_file(rtd->dev, &dev_attr_codec_reg);
954 device_unregister(rtd->dev);
f0fba2ad
LG
955 rtd->dev_registered = 0;
956 }
957
958 /* remove the CODEC DAI */
0168bf0d
LG
959 if (codec_dai && codec_dai->probed &&
960 codec_dai->driver->remove_order == order) {
f0fba2ad
LG
961 if (codec_dai->driver->remove) {
962 err = codec_dai->driver->remove(codec_dai);
963 if (err < 0)
0837fc62
FE
964 pr_err("asoc: failed to remove %s: %d\n",
965 codec_dai->name, err);
6b05eda6 966 }
f0fba2ad
LG
967 codec_dai->probed = 0;
968 list_del(&codec_dai->card_list);
969 }
6b05eda6 970
f0fba2ad 971 /* remove the cpu_dai */
0168bf0d
LG
972 if (cpu_dai && cpu_dai->probed &&
973 cpu_dai->driver->remove_order == order) {
f0fba2ad
LG
974 if (cpu_dai->driver->remove) {
975 err = cpu_dai->driver->remove(cpu_dai);
976 if (err < 0)
0837fc62
FE
977 pr_err("asoc: failed to remove %s: %d\n",
978 cpu_dai->name, err);
db2a4165 979 }
f0fba2ad
LG
980 cpu_dai->probed = 0;
981 list_del(&cpu_dai->card_list);
a9db7dbe 982
18d75644
SW
983 if (!cpu_dai->codec) {
984 snd_soc_dapm_free(&cpu_dai->dapm);
a9db7dbe 985 module_put(cpu_dai->dev->driver->owner);
18d75644 986 }
db2a4165 987 }
f0fba2ad 988}
db2a4165 989
62ae68fa
SW
990static void soc_remove_link_components(struct snd_soc_card *card, int num,
991 int order)
992{
993 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
994 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
995 struct snd_soc_dai *codec_dai = rtd->codec_dai;
996 struct snd_soc_platform *platform = rtd->platform;
997 struct snd_soc_codec *codec;
998
999 /* remove the platform */
1000 if (platform && platform->probed &&
1001 platform->driver->remove_order == order) {
1002 soc_remove_platform(platform);
1003 }
1004
1005 /* remove the CODEC-side CODEC */
1006 if (codec_dai) {
1007 codec = codec_dai->codec;
1008 if (codec && codec->probed &&
1009 codec->driver->remove_order == order)
1010 soc_remove_codec(codec);
1011 }
1012
1013 /* remove any CPU-side CODEC */
1014 if (cpu_dai) {
1015 codec = cpu_dai->codec;
1016 if (codec && codec->probed &&
1017 codec->driver->remove_order == order)
1018 soc_remove_codec(codec);
1019 }
1020}
1021
0671fd8e
KM
1022static void soc_remove_dai_links(struct snd_soc_card *card)
1023{
0168bf0d 1024 int dai, order;
0671fd8e 1025
0168bf0d
LG
1026 for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
1027 order++) {
1028 for (dai = 0; dai < card->num_rtd; dai++)
62ae68fa
SW
1029 soc_remove_link_dais(card, dai, order);
1030 }
1031
1032 for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
1033 order++) {
1034 for (dai = 0; dai < card->num_rtd; dai++)
1035 soc_remove_link_components(card, dai, order);
0168bf0d 1036 }
62ae68fa 1037
0671fd8e
KM
1038 card->num_rtd = 0;
1039}
1040
ead9b919
JN
1041static void soc_set_name_prefix(struct snd_soc_card *card,
1042 struct snd_soc_codec *codec)
1043{
1044 int i;
1045
ff819b83 1046 if (card->codec_conf == NULL)
ead9b919
JN
1047 return;
1048
ff819b83
DP
1049 for (i = 0; i < card->num_configs; i++) {
1050 struct snd_soc_codec_conf *map = &card->codec_conf[i];
ead9b919
JN
1051 if (map->dev_name && !strcmp(codec->name, map->dev_name)) {
1052 codec->name_prefix = map->name_prefix;
1053 break;
1054 }
1055 }
1056}
1057
589c3563
JN
1058static int soc_probe_codec(struct snd_soc_card *card,
1059 struct snd_soc_codec *codec)
1060{
1061 int ret = 0;
89b95ac0 1062 const struct snd_soc_codec_driver *driver = codec->driver;
888df395 1063 struct snd_soc_dai *dai;
589c3563
JN
1064
1065 codec->card = card;
1066 codec->dapm.card = card;
1067 soc_set_name_prefix(card, codec);
1068
70d29331
JN
1069 if (!try_module_get(codec->dev->driver->owner))
1070 return -ENODEV;
1071
d5d1e0be
LPC
1072 soc_init_codec_debugfs(codec);
1073
77530150
LPC
1074 if (driver->dapm_widgets)
1075 snd_soc_dapm_new_controls(&codec->dapm, driver->dapm_widgets,
1076 driver->num_dapm_widgets);
1077
888df395
MB
1078 /* Create DAPM widgets for each DAI stream */
1079 list_for_each_entry(dai, &dai_list, list) {
1080 if (dai->dev != codec->dev)
1081 continue;
1082
1083 snd_soc_dapm_new_dai_widgets(&codec->dapm, dai);
1084 }
1085
33c5f969
MB
1086 codec->dapm.idle_bias_off = driver->idle_bias_off;
1087
89b95ac0
MB
1088 if (driver->probe) {
1089 ret = driver->probe(codec);
589c3563
JN
1090 if (ret < 0) {
1091 dev_err(codec->dev,
1092 "asoc: failed to probe CODEC %s: %d\n",
1093 codec->name, ret);
70d29331 1094 goto err_probe;
589c3563
JN
1095 }
1096 }
1097
38cbf959 1098 /* If the driver didn't set I/O up try regmap */
98d3088e 1099 if (!codec->write && dev_get_regmap(codec->dev, NULL))
38cbf959
MB
1100 snd_soc_codec_set_cache_io(codec, 0, 0, SND_SOC_REGMAP);
1101
b7af1daf 1102 if (driver->controls)
022658be 1103 snd_soc_add_codec_controls(codec, driver->controls,
b7af1daf 1104 driver->num_controls);
89b95ac0
MB
1105 if (driver->dapm_routes)
1106 snd_soc_dapm_add_routes(&codec->dapm, driver->dapm_routes,
1107 driver->num_dapm_routes);
1108
589c3563
JN
1109 /* mark codec as probed and add to card codec list */
1110 codec->probed = 1;
1111 list_add(&codec->card_list, &card->codec_dev_list);
7be31be8 1112 list_add(&codec->dapm.list, &card->dapm_list);
589c3563 1113
70d29331
JN
1114 return 0;
1115
1116err_probe:
d5d1e0be 1117 soc_cleanup_codec_debugfs(codec);
70d29331
JN
1118 module_put(codec->dev->driver->owner);
1119
589c3563
JN
1120 return ret;
1121}
1122
956245e9
LG
1123static int soc_probe_platform(struct snd_soc_card *card,
1124 struct snd_soc_platform *platform)
1125{
1126 int ret = 0;
1127 const struct snd_soc_platform_driver *driver = platform->driver;
be09ad90 1128 struct snd_soc_dai *dai;
956245e9
LG
1129
1130 platform->card = card;
b7950641 1131 platform->dapm.card = card;
956245e9
LG
1132
1133 if (!try_module_get(platform->dev->driver->owner))
1134 return -ENODEV;
1135
731f1ab2
SG
1136 soc_init_platform_debugfs(platform);
1137
cb2cf612
LG
1138 if (driver->dapm_widgets)
1139 snd_soc_dapm_new_controls(&platform->dapm,
1140 driver->dapm_widgets, driver->num_dapm_widgets);
1141
be09ad90
LG
1142 /* Create DAPM widgets for each DAI stream */
1143 list_for_each_entry(dai, &dai_list, list) {
1144 if (dai->dev != platform->dev)
1145 continue;
1146
1147 snd_soc_dapm_new_dai_widgets(&platform->dapm, dai);
1148 }
1149
3fec6b6d
SW
1150 platform->dapm.idle_bias_off = 1;
1151
956245e9
LG
1152 if (driver->probe) {
1153 ret = driver->probe(platform);
1154 if (ret < 0) {
1155 dev_err(platform->dev,
1156 "asoc: failed to probe platform %s: %d\n",
1157 platform->name, ret);
1158 goto err_probe;
1159 }
1160 }
1161
cb2cf612
LG
1162 if (driver->controls)
1163 snd_soc_add_platform_controls(platform, driver->controls,
1164 driver->num_controls);
1165 if (driver->dapm_routes)
1166 snd_soc_dapm_add_routes(&platform->dapm, driver->dapm_routes,
1167 driver->num_dapm_routes);
1168
956245e9
LG
1169 /* mark platform as probed and add to card platform list */
1170 platform->probed = 1;
1171 list_add(&platform->card_list, &card->platform_dev_list);
b7950641 1172 list_add(&platform->dapm.list, &card->dapm_list);
956245e9
LG
1173
1174 return 0;
1175
1176err_probe:
02db1103 1177 soc_cleanup_platform_debugfs(platform);
956245e9
LG
1178 module_put(platform->dev->driver->owner);
1179
1180 return ret;
1181}
1182
36ae1a96
MB
1183static void rtd_release(struct device *dev)
1184{
1185 kfree(dev);
1186}
f0fba2ad 1187
589c3563
JN
1188static int soc_post_component_init(struct snd_soc_card *card,
1189 struct snd_soc_codec *codec,
1190 int num, int dailess)
1191{
1192 struct snd_soc_dai_link *dai_link = NULL;
1193 struct snd_soc_aux_dev *aux_dev = NULL;
1194 struct snd_soc_pcm_runtime *rtd;
1195 const char *temp, *name;
1196 int ret = 0;
1197
1198 if (!dailess) {
1199 dai_link = &card->dai_link[num];
1200 rtd = &card->rtd[num];
1201 name = dai_link->name;
1202 } else {
1203 aux_dev = &card->aux_dev[num];
1204 rtd = &card->rtd_aux[num];
1205 name = aux_dev->name;
1206 }
0962bb21 1207 rtd->card = card;
589c3563 1208
4b1cfcb4
MB
1209 /* Make sure all DAPM widgets are instantiated */
1210 snd_soc_dapm_new_widgets(&codec->dapm);
1211
589c3563
JN
1212 /* machine controls, routes and widgets are not prefixed */
1213 temp = codec->name_prefix;
1214 codec->name_prefix = NULL;
1215
1216 /* do machine specific initialization */
1217 if (!dailess && dai_link->init)
1218 ret = dai_link->init(rtd);
1219 else if (dailess && aux_dev->init)
1220 ret = aux_dev->init(&codec->dapm);
1221 if (ret < 0) {
1222 dev_err(card->dev, "asoc: failed to init %s: %d\n", name, ret);
1223 return ret;
1224 }
1225 codec->name_prefix = temp;
1226
589c3563
JN
1227 /* register the rtd device */
1228 rtd->codec = codec;
36ae1a96
MB
1229
1230 rtd->dev = kzalloc(sizeof(struct device), GFP_KERNEL);
1231 if (!rtd->dev)
1232 return -ENOMEM;
1233 device_initialize(rtd->dev);
1234 rtd->dev->parent = card->dev;
1235 rtd->dev->release = rtd_release;
1236 rtd->dev->init_name = name;
1237 dev_set_drvdata(rtd->dev, rtd);
b8c0dab9 1238 mutex_init(&rtd->pcm_mutex);
01d7584c
LG
1239 INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].be_clients);
1240 INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].be_clients);
1241 INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_PLAYBACK].fe_clients);
1242 INIT_LIST_HEAD(&rtd->dpcm[SNDRV_PCM_STREAM_CAPTURE].fe_clients);
36ae1a96 1243 ret = device_add(rtd->dev);
589c3563
JN
1244 if (ret < 0) {
1245 dev_err(card->dev,
1246 "asoc: failed to register runtime device: %d\n", ret);
1247 return ret;
1248 }
1249 rtd->dev_registered = 1;
1250
1251 /* add DAPM sysfs entries for this codec */
36ae1a96 1252 ret = snd_soc_dapm_sys_add(rtd->dev);
589c3563
JN
1253 if (ret < 0)
1254 dev_err(codec->dev,
1255 "asoc: failed to add codec dapm sysfs entries: %d\n",
1256 ret);
1257
1258 /* add codec sysfs entries */
36ae1a96 1259 ret = device_create_file(rtd->dev, &dev_attr_codec_reg);
589c3563
JN
1260 if (ret < 0)
1261 dev_err(codec->dev,
1262 "asoc: failed to add codec sysfs files: %d\n", ret);
1263
f86dcef8
LG
1264#ifdef CONFIG_DEBUG_FS
1265 /* add DPCM sysfs entries */
cd0f8911 1266 if (!dailess && !dai_link->dynamic)
f86dcef8
LG
1267 goto out;
1268
1269 ret = soc_dpcm_debugfs_add(rtd);
1270 if (ret < 0)
1271 dev_err(rtd->dev, "asoc: failed to add dpcm sysfs entries: %d\n", ret);
1272
1273out:
1274#endif
589c3563
JN
1275 return 0;
1276}
1277
62ae68fa
SW
1278static int soc_probe_link_components(struct snd_soc_card *card, int num,
1279 int order)
1280{
1281 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1282 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1283 struct snd_soc_dai *codec_dai = rtd->codec_dai;
1284 struct snd_soc_platform *platform = rtd->platform;
1285 int ret;
1286
1287 /* probe the CPU-side component, if it is a CODEC */
1288 if (cpu_dai->codec &&
1289 !cpu_dai->codec->probed &&
1290 cpu_dai->codec->driver->probe_order == order) {
1291 ret = soc_probe_codec(card, cpu_dai->codec);
1292 if (ret < 0)
1293 return ret;
1294 }
1295
1296 /* probe the CODEC-side component */
1297 if (!codec_dai->codec->probed &&
1298 codec_dai->codec->driver->probe_order == order) {
1299 ret = soc_probe_codec(card, codec_dai->codec);
1300 if (ret < 0)
1301 return ret;
1302 }
1303
1304 /* probe the platform */
1305 if (!platform->probed &&
1306 platform->driver->probe_order == order) {
1307 ret = soc_probe_platform(card, platform);
1308 if (ret < 0)
1309 return ret;
1310 }
1311
1312 return 0;
1313}
1314
1315static int soc_probe_link_dais(struct snd_soc_card *card, int num, int order)
f0fba2ad
LG
1316{
1317 struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1318 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1319 struct snd_soc_codec *codec = rtd->codec;
1320 struct snd_soc_platform *platform = rtd->platform;
c74184ed
MB
1321 struct snd_soc_dai *codec_dai = rtd->codec_dai;
1322 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
1323 struct snd_soc_dapm_widget *play_w, *capture_w;
f0fba2ad
LG
1324 int ret;
1325
0168bf0d
LG
1326 dev_dbg(card->dev, "probe %s dai link %d late %d\n",
1327 card->name, num, order);
f0fba2ad
LG
1328
1329 /* config components */
f0fba2ad 1330 cpu_dai->platform = platform;
f0fba2ad
LG
1331 codec_dai->card = card;
1332 cpu_dai->card = card;
1333
1334 /* set default power off timeout */
1335 rtd->pmdown_time = pmdown_time;
1336
1337 /* probe the cpu_dai */
0168bf0d
LG
1338 if (!cpu_dai->probed &&
1339 cpu_dai->driver->probe_order == order) {
a9db7dbe
SW
1340 if (!cpu_dai->codec) {
1341 cpu_dai->dapm.card = card;
1342 if (!try_module_get(cpu_dai->dev->driver->owner))
1343 return -ENODEV;
61b61e3c 1344
18d75644 1345 list_add(&cpu_dai->dapm.list, &card->dapm_list);
a9db7dbe
SW
1346 snd_soc_dapm_new_dai_widgets(&cpu_dai->dapm, cpu_dai);
1347 }
be09ad90 1348
f0fba2ad
LG
1349 if (cpu_dai->driver->probe) {
1350 ret = cpu_dai->driver->probe(cpu_dai);
1351 if (ret < 0) {
0837fc62
FE
1352 pr_err("asoc: failed to probe CPU DAI %s: %d\n",
1353 cpu_dai->name, ret);
61b61e3c 1354 module_put(cpu_dai->dev->driver->owner);
f0fba2ad
LG
1355 return ret;
1356 }
1357 }
1358 cpu_dai->probed = 1;
1c8371d6 1359 /* mark cpu_dai as probed and add to card dai list */
f0fba2ad 1360 list_add(&cpu_dai->card_list, &card->dai_dev_list);
db2a4165
FM
1361 }
1362
f0fba2ad 1363 /* probe the CODEC DAI */
0168bf0d 1364 if (!codec_dai->probed && codec_dai->driver->probe_order == order) {
f0fba2ad
LG
1365 if (codec_dai->driver->probe) {
1366 ret = codec_dai->driver->probe(codec_dai);
fe3e78e0 1367 if (ret < 0) {
0837fc62
FE
1368 pr_err("asoc: failed to probe CODEC DAI %s: %d\n",
1369 codec_dai->name, ret);
f0fba2ad 1370 return ret;
fe3e78e0
MB
1371 }
1372 }
f0fba2ad 1373
1c8371d6 1374 /* mark codec_dai as probed and add to card dai list */
f0fba2ad
LG
1375 codec_dai->probed = 1;
1376 list_add(&codec_dai->card_list, &card->dai_dev_list);
fe3e78e0
MB
1377 }
1378
0168bf0d
LG
1379 /* complete DAI probe during last probe */
1380 if (order != SND_SOC_COMP_ORDER_LAST)
1381 return 0;
1382
589c3563
JN
1383 ret = soc_post_component_init(card, codec, num, 0);
1384 if (ret)
f0fba2ad 1385 return ret;
fe3e78e0 1386
36ae1a96 1387 ret = device_create_file(rtd->dev, &dev_attr_pmdown_time);
f0fba2ad 1388 if (ret < 0)
0837fc62 1389 pr_warn("asoc: failed to add pmdown_time sysfs:%d\n", ret);
f0fba2ad 1390
c74184ed
MB
1391 if (!dai_link->params) {
1392 /* create the pcm */
1393 ret = soc_new_pcm(rtd, num);
1394 if (ret < 0) {
1395 pr_err("asoc: can't create pcm %s :%d\n",
1396 dai_link->stream_name, ret);
1397 return ret;
1398 }
1399 } else {
1400 /* link the DAI widgets */
1401 play_w = codec_dai->playback_widget;
1402 capture_w = cpu_dai->capture_widget;
1403 if (play_w && capture_w) {
1404 ret = snd_soc_dapm_new_pcm(card, dai_link->params,
1405 capture_w, play_w);
1406 if (ret != 0) {
1407 dev_err(card->dev, "Can't link %s to %s: %d\n",
1408 play_w->name, capture_w->name, ret);
1409 return ret;
1410 }
1411 }
1412
1413 play_w = cpu_dai->playback_widget;
1414 capture_w = codec_dai->capture_widget;
1415 if (play_w && capture_w) {
1416 ret = snd_soc_dapm_new_pcm(card, dai_link->params,
1417 capture_w, play_w);
1418 if (ret != 0) {
1419 dev_err(card->dev, "Can't link %s to %s: %d\n",
1420 play_w->name, capture_w->name, ret);
1421 return ret;
1422 }
1423 }
f0fba2ad
LG
1424 }
1425
1426 /* add platform data for AC97 devices */
1427 if (rtd->codec_dai->driver->ac97_control)
1428 snd_ac97_dev_add_pdata(codec->ac97, rtd->cpu_dai->ac97_pdata);
1429
1430 return 0;
1431}
1432
fe3e78e0 1433#ifdef CONFIG_SND_SOC_AC97_BUS
f0fba2ad
LG
1434static int soc_register_ac97_dai_link(struct snd_soc_pcm_runtime *rtd)
1435{
1436 int ret;
1437
fe3e78e0
MB
1438 /* Only instantiate AC97 if not already done by the adaptor
1439 * for the generic AC97 subsystem.
1440 */
f0fba2ad 1441 if (rtd->codec_dai->driver->ac97_control && !rtd->codec->ac97_registered) {
0562f788
MW
1442 /*
1443 * It is possible that the AC97 device is already registered to
1444 * the device subsystem. This happens when the device is created
1445 * via snd_ac97_mixer(). Currently only SoC codec that does so
1446 * is the generic AC97 glue but others migh emerge.
1447 *
1448 * In those cases we don't try to register the device again.
1449 */
1450 if (!rtd->codec->ac97_created)
1451 return 0;
f0fba2ad
LG
1452
1453 ret = soc_ac97_dev_register(rtd->codec);
fe3e78e0 1454 if (ret < 0) {
0837fc62 1455 pr_err("asoc: AC97 device register failed:%d\n", ret);
f0fba2ad 1456 return ret;
fe3e78e0 1457 }
f0fba2ad
LG
1458
1459 rtd->codec->ac97_registered = 1;
fe3e78e0 1460 }
f0fba2ad
LG
1461 return 0;
1462}
1463
1464static void soc_unregister_ac97_dai_link(struct snd_soc_codec *codec)
1465{
1466 if (codec->ac97_registered) {
1467 soc_ac97_dev_unregister(codec);
1468 codec->ac97_registered = 0;
1469 }
1470}
fe3e78e0
MB
1471#endif
1472
b19e6e7b
MB
1473static int soc_check_aux_dev(struct snd_soc_card *card, int num)
1474{
1475 struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
1476 struct snd_soc_codec *codec;
1477
1478 /* find CODEC from registered CODECs*/
1479 list_for_each_entry(codec, &codec_list, list) {
1480 if (!strcmp(codec->name, aux_dev->codec_name))
1481 return 0;
1482 }
1483
1484 return -EPROBE_DEFER;
1485}
1486
2eea392d
JN
1487static int soc_probe_aux_dev(struct snd_soc_card *card, int num)
1488{
1489 struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
2eea392d 1490 struct snd_soc_codec *codec;
676ad98a 1491 int ret = -ENODEV;
2eea392d
JN
1492
1493 /* find CODEC from registered CODECs*/
1494 list_for_each_entry(codec, &codec_list, list) {
1495 if (!strcmp(codec->name, aux_dev->codec_name)) {
1496 if (codec->probed) {
1497 dev_err(codec->dev,
1498 "asoc: codec already probed");
1499 ret = -EBUSY;
1500 goto out;
1501 }
676ad98a 1502 goto found;
2eea392d
JN
1503 }
1504 }
676ad98a
JN
1505 /* codec not found */
1506 dev_err(card->dev, "asoc: codec %s not found", aux_dev->codec_name);
b19e6e7b 1507 return -EPROBE_DEFER;
2eea392d 1508
676ad98a 1509found:
589c3563 1510 ret = soc_probe_codec(card, codec);
2eea392d 1511 if (ret < 0)
589c3563 1512 return ret;
2eea392d 1513
589c3563 1514 ret = soc_post_component_init(card, codec, num, 1);
2eea392d
JN
1515
1516out:
1517 return ret;
1518}
1519
1520static void soc_remove_aux_dev(struct snd_soc_card *card, int num)
1521{
1522 struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
1523 struct snd_soc_codec *codec = rtd->codec;
2eea392d
JN
1524
1525 /* unregister the rtd device */
1526 if (rtd->dev_registered) {
36ae1a96
MB
1527 device_remove_file(rtd->dev, &dev_attr_codec_reg);
1528 device_del(rtd->dev);
2eea392d
JN
1529 rtd->dev_registered = 0;
1530 }
1531
589c3563
JN
1532 if (codec && codec->probed)
1533 soc_remove_codec(codec);
2eea392d
JN
1534}
1535
fdf0f54d
DP
1536static int snd_soc_init_codec_cache(struct snd_soc_codec *codec,
1537 enum snd_soc_compress_type compress_type)
1538{
1539 int ret;
1540
1541 if (codec->cache_init)
1542 return 0;
1543
1544 /* override the compress_type if necessary */
1545 if (compress_type && codec->compress_type != compress_type)
1546 codec->compress_type = compress_type;
fdf0f54d
DP
1547 ret = snd_soc_cache_init(codec);
1548 if (ret < 0) {
1549 dev_err(codec->dev, "Failed to set cache compression type: %d\n",
1550 ret);
1551 return ret;
1552 }
1553 codec->cache_init = 1;
1554 return 0;
1555}
1556
b19e6e7b 1557static int snd_soc_instantiate_card(struct snd_soc_card *card)
f0fba2ad 1558{
fdf0f54d
DP
1559 struct snd_soc_codec *codec;
1560 struct snd_soc_codec_conf *codec_conf;
1561 enum snd_soc_compress_type compress_type;
75d9ac46 1562 struct snd_soc_dai_link *dai_link;
f04209a7 1563 int ret, i, order, dai_fmt;
fe3e78e0 1564
01b9d99a 1565 mutex_lock_nested(&card->mutex, SND_SOC_CARD_CLASS_INIT);
dbe21408 1566
f0fba2ad 1567 /* bind DAIs */
b19e6e7b
MB
1568 for (i = 0; i < card->num_links; i++) {
1569 ret = soc_bind_dai_link(card, i);
1570 if (ret != 0)
1571 goto base_error;
1572 }
fe3e78e0 1573
b19e6e7b
MB
1574 /* check aux_devs too */
1575 for (i = 0; i < card->num_aux_devs; i++) {
1576 ret = soc_check_aux_dev(card, i);
1577 if (ret != 0)
1578 goto base_error;
f0fba2ad 1579 }
435c5e25 1580
fdf0f54d
DP
1581 /* initialize the register cache for each available codec */
1582 list_for_each_entry(codec, &codec_list, list) {
1583 if (codec->cache_init)
1584 continue;
861f2faf
DP
1585 /* by default we don't override the compress_type */
1586 compress_type = 0;
fdf0f54d
DP
1587 /* check to see if we need to override the compress_type */
1588 for (i = 0; i < card->num_configs; ++i) {
1589 codec_conf = &card->codec_conf[i];
1590 if (!strcmp(codec->name, codec_conf->dev_name)) {
1591 compress_type = codec_conf->compress_type;
1592 if (compress_type && compress_type
1593 != codec->compress_type)
1594 break;
1595 }
1596 }
fdf0f54d 1597 ret = snd_soc_init_codec_cache(codec, compress_type);
b19e6e7b
MB
1598 if (ret < 0)
1599 goto base_error;
fdf0f54d
DP
1600 }
1601
f0fba2ad
LG
1602 /* card bind complete so register a sound card */
1603 ret = snd_card_create(SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
1604 card->owner, 0, &card->snd_card);
1605 if (ret < 0) {
0837fc62
FE
1606 pr_err("asoc: can't create sound card for card %s: %d\n",
1607 card->name, ret);
b19e6e7b 1608 goto base_error;
f0fba2ad
LG
1609 }
1610 card->snd_card->dev = card->dev;
1611
e37a4970
MB
1612 card->dapm.bias_level = SND_SOC_BIAS_OFF;
1613 card->dapm.dev = card->dev;
1614 card->dapm.card = card;
1615 list_add(&card->dapm.list, &card->dapm_list);
1616
d5d1e0be
LPC
1617#ifdef CONFIG_DEBUG_FS
1618 snd_soc_dapm_debugfs_init(&card->dapm, card->debugfs_card_root);
1619#endif
1620
88ee1c61 1621#ifdef CONFIG_PM_SLEEP
f0fba2ad
LG
1622 /* deferred resume work */
1623 INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
1624#endif
db2a4165 1625
9a841ebb
MB
1626 if (card->dapm_widgets)
1627 snd_soc_dapm_new_controls(&card->dapm, card->dapm_widgets,
1628 card->num_dapm_widgets);
1629
f0fba2ad
LG
1630 /* initialise the sound card only once */
1631 if (card->probe) {
e7361ec4 1632 ret = card->probe(card);
f0fba2ad
LG
1633 if (ret < 0)
1634 goto card_probe_error;
1635 }
fe3e78e0 1636
62ae68fa 1637 /* probe all components used by DAI links on this card */
0168bf0d
LG
1638 for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
1639 order++) {
1640 for (i = 0; i < card->num_links; i++) {
62ae68fa 1641 ret = soc_probe_link_components(card, i, order);
0168bf0d
LG
1642 if (ret < 0) {
1643 pr_err("asoc: failed to instantiate card %s: %d\n",
62ae68fa
SW
1644 card->name, ret);
1645 goto probe_dai_err;
1646 }
1647 }
1648 }
1649
1650 /* probe all DAI links on this card */
1651 for (order = SND_SOC_COMP_ORDER_FIRST; order <= SND_SOC_COMP_ORDER_LAST;
1652 order++) {
1653 for (i = 0; i < card->num_links; i++) {
1654 ret = soc_probe_link_dais(card, i, order);
1655 if (ret < 0) {
1656 pr_err("asoc: failed to instantiate card %s: %d\n",
1657 card->name, ret);
0168bf0d
LG
1658 goto probe_dai_err;
1659 }
f0fba2ad
LG
1660 }
1661 }
db2a4165 1662
2eea392d
JN
1663 for (i = 0; i < card->num_aux_devs; i++) {
1664 ret = soc_probe_aux_dev(card, i);
1665 if (ret < 0) {
1666 pr_err("asoc: failed to add auxiliary devices %s: %d\n",
1667 card->name, ret);
1668 goto probe_aux_dev_err;
1669 }
1670 }
1671
888df395
MB
1672 snd_soc_dapm_link_dai_widgets(card);
1673
b7af1daf 1674 if (card->controls)
022658be 1675 snd_soc_add_card_controls(card, card->controls, card->num_controls);
b7af1daf 1676
b8ad29de
MB
1677 if (card->dapm_routes)
1678 snd_soc_dapm_add_routes(&card->dapm, card->dapm_routes,
1679 card->num_dapm_routes);
1680
b90d2f90
MB
1681 snd_soc_dapm_new_widgets(&card->dapm);
1682
75d9ac46
MB
1683 for (i = 0; i < card->num_links; i++) {
1684 dai_link = &card->dai_link[i];
f04209a7 1685 dai_fmt = dai_link->dai_fmt;
75d9ac46 1686
f04209a7 1687 if (dai_fmt) {
75d9ac46 1688 ret = snd_soc_dai_set_fmt(card->rtd[i].codec_dai,
f04209a7 1689 dai_fmt);
5e4ba569 1690 if (ret != 0 && ret != -ENOTSUPP)
75d9ac46
MB
1691 dev_warn(card->rtd[i].codec_dai->dev,
1692 "Failed to set DAI format: %d\n",
1693 ret);
f04209a7
MB
1694 }
1695
1696 /* If this is a regular CPU link there will be a platform */
fe33d4c5
SW
1697 if (dai_fmt &&
1698 (dai_link->platform_name || dai_link->platform_of_node)) {
f04209a7
MB
1699 ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai,
1700 dai_fmt);
1701 if (ret != 0 && ret != -ENOTSUPP)
1702 dev_warn(card->rtd[i].cpu_dai->dev,
1703 "Failed to set DAI format: %d\n",
1704 ret);
1705 } else if (dai_fmt) {
1706 /* Flip the polarity for the "CPU" end */
1707 dai_fmt &= ~SND_SOC_DAIFMT_MASTER_MASK;
1708 switch (dai_link->dai_fmt &
1709 SND_SOC_DAIFMT_MASTER_MASK) {
1710 case SND_SOC_DAIFMT_CBM_CFM:
1711 dai_fmt |= SND_SOC_DAIFMT_CBS_CFS;
1712 break;
1713 case SND_SOC_DAIFMT_CBM_CFS:
1714 dai_fmt |= SND_SOC_DAIFMT_CBS_CFM;
1715 break;
1716 case SND_SOC_DAIFMT_CBS_CFM:
1717 dai_fmt |= SND_SOC_DAIFMT_CBM_CFS;
1718 break;
1719 case SND_SOC_DAIFMT_CBS_CFS:
1720 dai_fmt |= SND_SOC_DAIFMT_CBM_CFM;
1721 break;
1722 }
75d9ac46
MB
1723
1724 ret = snd_soc_dai_set_fmt(card->rtd[i].cpu_dai,
f04209a7 1725 dai_fmt);
5e4ba569 1726 if (ret != 0 && ret != -ENOTSUPP)
75d9ac46
MB
1727 dev_warn(card->rtd[i].cpu_dai->dev,
1728 "Failed to set DAI format: %d\n",
1729 ret);
1730 }
1731 }
1732
f0fba2ad 1733 snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname),
f0fba2ad 1734 "%s", card->name);
22de71ba
LG
1735 snprintf(card->snd_card->longname, sizeof(card->snd_card->longname),
1736 "%s", card->long_name ? card->long_name : card->name);
f0e8ed85
MB
1737 snprintf(card->snd_card->driver, sizeof(card->snd_card->driver),
1738 "%s", card->driver_name ? card->driver_name : card->name);
1739 for (i = 0; i < ARRAY_SIZE(card->snd_card->driver); i++) {
1740 switch (card->snd_card->driver[i]) {
1741 case '_':
1742 case '-':
1743 case '\0':
1744 break;
1745 default:
1746 if (!isalnum(card->snd_card->driver[i]))
1747 card->snd_card->driver[i] = '_';
1748 break;
1749 }
1750 }
f0fba2ad 1751
28e9ad92
MB
1752 if (card->late_probe) {
1753 ret = card->late_probe(card);
1754 if (ret < 0) {
1755 dev_err(card->dev, "%s late_probe() failed: %d\n",
1756 card->name, ret);
1757 goto probe_aux_dev_err;
1758 }
1759 }
1760
2dc00213
MB
1761 snd_soc_dapm_new_widgets(&card->dapm);
1762
1633281b 1763 if (card->fully_routed)
b05d8dc1 1764 list_for_each_entry(codec, &card->codec_dev_list, card_list)
1633281b
SW
1765 snd_soc_dapm_auto_nc_codec_pins(codec);
1766
f0fba2ad
LG
1767 ret = snd_card_register(card->snd_card);
1768 if (ret < 0) {
0837fc62
FE
1769 pr_err("asoc: failed to register soundcard for %s: %d\n",
1770 card->name, ret);
6b3ed785 1771 goto probe_aux_dev_err;
db2a4165
FM
1772 }
1773
f0fba2ad
LG
1774#ifdef CONFIG_SND_SOC_AC97_BUS
1775 /* register any AC97 codecs */
1776 for (i = 0; i < card->num_rtd; i++) {
6b3ed785
AL
1777 ret = soc_register_ac97_dai_link(&card->rtd[i]);
1778 if (ret < 0) {
0837fc62
FE
1779 pr_err("asoc: failed to register AC97 %s: %d\n",
1780 card->name, ret);
6b3ed785 1781 while (--i >= 0)
7d8316df 1782 soc_unregister_ac97_dai_link(card->rtd[i].codec);
6b3ed785 1783 goto probe_aux_dev_err;
f0fba2ad 1784 }
6b3ed785 1785 }
f0fba2ad
LG
1786#endif
1787
1788 card->instantiated = 1;
4f4c0072 1789 snd_soc_dapm_sync(&card->dapm);
f0fba2ad 1790 mutex_unlock(&card->mutex);
b19e6e7b
MB
1791
1792 return 0;
f0fba2ad 1793
2eea392d
JN
1794probe_aux_dev_err:
1795 for (i = 0; i < card->num_aux_devs; i++)
1796 soc_remove_aux_dev(card, i);
1797
f0fba2ad 1798probe_dai_err:
0671fd8e 1799 soc_remove_dai_links(card);
f0fba2ad
LG
1800
1801card_probe_error:
87506549 1802 if (card->remove)
e7361ec4 1803 card->remove(card);
f0fba2ad
LG
1804
1805 snd_card_free(card->snd_card);
1806
b19e6e7b 1807base_error:
f0fba2ad 1808 mutex_unlock(&card->mutex);
db2a4165 1809
b19e6e7b 1810 return ret;
435c5e25
MB
1811}
1812
1813/* probes a new socdev */
1814static int soc_probe(struct platform_device *pdev)
1815{
f0fba2ad 1816 struct snd_soc_card *card = platform_get_drvdata(pdev);
435c5e25 1817
70a7ca34
VK
1818 /*
1819 * no card, so machine driver should be registering card
1820 * we should not be here in that case so ret error
1821 */
1822 if (!card)
1823 return -EINVAL;
1824
fe4085e8
MB
1825 dev_warn(&pdev->dev,
1826 "ASoC machine %s should use snd_soc_register_card()\n",
1827 card->name);
1828
435c5e25
MB
1829 /* Bodge while we unpick instantiation */
1830 card->dev = &pdev->dev;
f0fba2ad 1831
28d528c8 1832 return snd_soc_register_card(card);
db2a4165
FM
1833}
1834
b0e26485 1835static int soc_cleanup_card_resources(struct snd_soc_card *card)
db2a4165
FM
1836{
1837 int i;
db2a4165 1838
b0e26485
VK
1839 /* make sure any delayed work runs */
1840 for (i = 0; i < card->num_rtd; i++) {
1841 struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
1842 flush_delayed_work_sync(&rtd->delayed_work);
1843 }
914dc182 1844
b0e26485
VK
1845 /* remove auxiliary devices */
1846 for (i = 0; i < card->num_aux_devs; i++)
1847 soc_remove_aux_dev(card, i);
db2a4165 1848
b0e26485 1849 /* remove and free each DAI */
0671fd8e 1850 soc_remove_dai_links(card);
2eea392d 1851
b0e26485 1852 soc_cleanup_card_debugfs(card);
f0fba2ad 1853
b0e26485
VK
1854 /* remove the card */
1855 if (card->remove)
e7361ec4 1856 card->remove(card);
a6052154 1857
0aaae527
LPC
1858 snd_soc_dapm_free(&card->dapm);
1859
b0e26485
VK
1860 snd_card_free(card->snd_card);
1861 return 0;
1862
1863}
1864
1865/* removes a socdev */
1866static int soc_remove(struct platform_device *pdev)
1867{
1868 struct snd_soc_card *card = platform_get_drvdata(pdev);
db2a4165 1869
c5af3a2e 1870 snd_soc_unregister_card(card);
db2a4165
FM
1871 return 0;
1872}
1873
6f8ab4ac 1874int snd_soc_poweroff(struct device *dev)
51737470 1875{
6f8ab4ac 1876 struct snd_soc_card *card = dev_get_drvdata(dev);
f0fba2ad 1877 int i;
51737470
MB
1878
1879 if (!card->instantiated)
416356fc 1880 return 0;
51737470
MB
1881
1882 /* Flush out pmdown_time work - we actually do want to run it
1883 * now, we're shutting down so no imminent restart. */
f0fba2ad
LG
1884 for (i = 0; i < card->num_rtd; i++) {
1885 struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
5b84ba26 1886 flush_delayed_work_sync(&rtd->delayed_work);
f0fba2ad 1887 }
51737470 1888
f0fba2ad 1889 snd_soc_dapm_shutdown(card);
416356fc
MB
1890
1891 return 0;
51737470 1892}
6f8ab4ac 1893EXPORT_SYMBOL_GPL(snd_soc_poweroff);
51737470 1894
6f8ab4ac 1895const struct dev_pm_ops snd_soc_pm_ops = {
b1dd5897
VK
1896 .suspend = snd_soc_suspend,
1897 .resume = snd_soc_resume,
1898 .freeze = snd_soc_suspend,
1899 .thaw = snd_soc_resume,
6f8ab4ac 1900 .poweroff = snd_soc_poweroff,
b1dd5897 1901 .restore = snd_soc_resume,
416356fc 1902};
deb2607e 1903EXPORT_SYMBOL_GPL(snd_soc_pm_ops);
416356fc 1904
db2a4165
FM
1905/* ASoC platform driver */
1906static struct platform_driver soc_driver = {
1907 .driver = {
1908 .name = "soc-audio",
8b45a209 1909 .owner = THIS_MODULE,
6f8ab4ac 1910 .pm = &snd_soc_pm_ops,
db2a4165
FM
1911 },
1912 .probe = soc_probe,
1913 .remove = soc_remove,
db2a4165
FM
1914};
1915
096e49d5
MB
1916/**
1917 * snd_soc_codec_volatile_register: Report if a register is volatile.
1918 *
1919 * @codec: CODEC to query.
1920 * @reg: Register to query.
1921 *
1922 * Boolean function indiciating if a CODEC register is volatile.
1923 */
181e055e
MB
1924int snd_soc_codec_volatile_register(struct snd_soc_codec *codec,
1925 unsigned int reg)
096e49d5 1926{
1500b7b5
DP
1927 if (codec->volatile_register)
1928 return codec->volatile_register(codec, reg);
096e49d5
MB
1929 else
1930 return 0;
1931}
1932EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register);
1933
239c9706
DP
1934/**
1935 * snd_soc_codec_readable_register: Report if a register is readable.
1936 *
1937 * @codec: CODEC to query.
1938 * @reg: Register to query.
1939 *
1940 * Boolean function indicating if a CODEC register is readable.
1941 */
1942int snd_soc_codec_readable_register(struct snd_soc_codec *codec,
1943 unsigned int reg)
1944{
1945 if (codec->readable_register)
1946 return codec->readable_register(codec, reg);
1947 else
63fa0a28 1948 return 1;
239c9706
DP
1949}
1950EXPORT_SYMBOL_GPL(snd_soc_codec_readable_register);
1951
1952/**
1953 * snd_soc_codec_writable_register: Report if a register is writable.
1954 *
1955 * @codec: CODEC to query.
1956 * @reg: Register to query.
1957 *
1958 * Boolean function indicating if a CODEC register is writable.
1959 */
1960int snd_soc_codec_writable_register(struct snd_soc_codec *codec,
1961 unsigned int reg)
1962{
1963 if (codec->writable_register)
1964 return codec->writable_register(codec, reg);
1965 else
63fa0a28 1966 return 1;
239c9706
DP
1967}
1968EXPORT_SYMBOL_GPL(snd_soc_codec_writable_register);
1969
f1442bc1
LG
1970int snd_soc_platform_read(struct snd_soc_platform *platform,
1971 unsigned int reg)
1972{
1973 unsigned int ret;
1974
1975 if (!platform->driver->read) {
1976 dev_err(platform->dev, "platform has no read back\n");
1977 return -1;
1978 }
1979
1980 ret = platform->driver->read(platform, reg);
1981 dev_dbg(platform->dev, "read %x => %x\n", reg, ret);
a82ce2ae 1982 trace_snd_soc_preg_read(platform, reg, ret);
f1442bc1
LG
1983
1984 return ret;
1985}
1986EXPORT_SYMBOL_GPL(snd_soc_platform_read);
1987
1988int snd_soc_platform_write(struct snd_soc_platform *platform,
1989 unsigned int reg, unsigned int val)
1990{
1991 if (!platform->driver->write) {
1992 dev_err(platform->dev, "platform has no write back\n");
1993 return -1;
1994 }
1995
1996 dev_dbg(platform->dev, "write %x = %x\n", reg, val);
a82ce2ae 1997 trace_snd_soc_preg_write(platform, reg, val);
f1442bc1
LG
1998 return platform->driver->write(platform, reg, val);
1999}
2000EXPORT_SYMBOL_GPL(snd_soc_platform_write);
2001
db2a4165
FM
2002/**
2003 * snd_soc_new_ac97_codec - initailise AC97 device
2004 * @codec: audio codec
2005 * @ops: AC97 bus operations
2006 * @num: AC97 codec number
2007 *
2008 * Initialises AC97 codec resources for use by ad-hoc devices only.
2009 */
2010int snd_soc_new_ac97_codec(struct snd_soc_codec *codec,
2011 struct snd_ac97_bus_ops *ops, int num)
2012{
2013 mutex_lock(&codec->mutex);
2014
2015 codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL);
2016 if (codec->ac97 == NULL) {
2017 mutex_unlock(&codec->mutex);
2018 return -ENOMEM;
2019 }
2020
2021 codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL);
2022 if (codec->ac97->bus == NULL) {
2023 kfree(codec->ac97);
2024 codec->ac97 = NULL;
2025 mutex_unlock(&codec->mutex);
2026 return -ENOMEM;
2027 }
2028
2029 codec->ac97->bus->ops = ops;
2030 codec->ac97->num = num;
0562f788
MW
2031
2032 /*
2033 * Mark the AC97 device to be created by us. This way we ensure that the
2034 * device will be registered with the device subsystem later on.
2035 */
2036 codec->ac97_created = 1;
2037
db2a4165
FM
2038 mutex_unlock(&codec->mutex);
2039 return 0;
2040}
2041EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec);
2042
2043/**
2044 * snd_soc_free_ac97_codec - free AC97 codec device
2045 * @codec: audio codec
2046 *
2047 * Frees AC97 codec device resources.
2048 */
2049void snd_soc_free_ac97_codec(struct snd_soc_codec *codec)
2050{
2051 mutex_lock(&codec->mutex);
f0fba2ad
LG
2052#ifdef CONFIG_SND_SOC_AC97_BUS
2053 soc_unregister_ac97_dai_link(codec);
2054#endif
db2a4165
FM
2055 kfree(codec->ac97->bus);
2056 kfree(codec->ac97);
2057 codec->ac97 = NULL;
0562f788 2058 codec->ac97_created = 0;
db2a4165
FM
2059 mutex_unlock(&codec->mutex);
2060}
2061EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec);
2062
c3753707
MB
2063unsigned int snd_soc_read(struct snd_soc_codec *codec, unsigned int reg)
2064{
2065 unsigned int ret;
2066
c3acec26 2067 ret = codec->read(codec, reg);
c3753707 2068 dev_dbg(codec->dev, "read %x => %x\n", reg, ret);
a8b1d34f 2069 trace_snd_soc_reg_read(codec, reg, ret);
c3753707
MB
2070
2071 return ret;
2072}
2073EXPORT_SYMBOL_GPL(snd_soc_read);
2074
2075unsigned int snd_soc_write(struct snd_soc_codec *codec,
2076 unsigned int reg, unsigned int val)
2077{
2078 dev_dbg(codec->dev, "write %x = %x\n", reg, val);
a8b1d34f 2079 trace_snd_soc_reg_write(codec, reg, val);
c3acec26 2080 return codec->write(codec, reg, val);
c3753707
MB
2081}
2082EXPORT_SYMBOL_GPL(snd_soc_write);
2083
5fb609d4
DP
2084unsigned int snd_soc_bulk_write_raw(struct snd_soc_codec *codec,
2085 unsigned int reg, const void *data, size_t len)
2086{
2087 return codec->bulk_write_raw(codec, reg, data, len);
2088}
2089EXPORT_SYMBOL_GPL(snd_soc_bulk_write_raw);
2090
db2a4165
FM
2091/**
2092 * snd_soc_update_bits - update codec register bits
2093 * @codec: audio codec
2094 * @reg: codec register
2095 * @mask: register mask
2096 * @value: new value
2097 *
2098 * Writes new register value.
2099 *
180c329d 2100 * Returns 1 for change, 0 for no change, or negative error code.
db2a4165
FM
2101 */
2102int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg,
46f5822f 2103 unsigned int mask, unsigned int value)
db2a4165 2104{
8a713da8 2105 bool change;
46f5822f 2106 unsigned int old, new;
180c329d
TT
2107 int ret;
2108
8a713da8
MB
2109 if (codec->using_regmap) {
2110 ret = regmap_update_bits_check(codec->control_data, reg,
2111 mask, value, &change);
2112 } else {
2113 ret = snd_soc_read(codec, reg);
180c329d
TT
2114 if (ret < 0)
2115 return ret;
8a713da8
MB
2116
2117 old = ret;
2118 new = (old & ~mask) | (value & mask);
2119 change = old != new;
2120 if (change)
2121 ret = snd_soc_write(codec, reg, new);
180c329d 2122 }
db2a4165 2123
8a713da8
MB
2124 if (ret < 0)
2125 return ret;
2126
db2a4165
FM
2127 return change;
2128}
2129EXPORT_SYMBOL_GPL(snd_soc_update_bits);
2130
6c508c62
EN
2131/**
2132 * snd_soc_update_bits_locked - update codec register bits
2133 * @codec: audio codec
2134 * @reg: codec register
2135 * @mask: register mask
2136 * @value: new value
2137 *
2138 * Writes new register value, and takes the codec mutex.
2139 *
2140 * Returns 1 for change else 0.
2141 */
dd1b3d53
MB
2142int snd_soc_update_bits_locked(struct snd_soc_codec *codec,
2143 unsigned short reg, unsigned int mask,
2144 unsigned int value)
6c508c62
EN
2145{
2146 int change;
2147
2148 mutex_lock(&codec->mutex);
2149 change = snd_soc_update_bits(codec, reg, mask, value);
2150 mutex_unlock(&codec->mutex);
2151
2152 return change;
2153}
dd1b3d53 2154EXPORT_SYMBOL_GPL(snd_soc_update_bits_locked);
6c508c62 2155
db2a4165
FM
2156/**
2157 * snd_soc_test_bits - test register for change
2158 * @codec: audio codec
2159 * @reg: codec register
2160 * @mask: register mask
2161 * @value: new value
2162 *
2163 * Tests a register with a new value and checks if the new value is
2164 * different from the old value.
2165 *
2166 * Returns 1 for change else 0.
2167 */
2168int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg,
46f5822f 2169 unsigned int mask, unsigned int value)
db2a4165
FM
2170{
2171 int change;
46f5822f 2172 unsigned int old, new;
db2a4165 2173
db2a4165
FM
2174 old = snd_soc_read(codec, reg);
2175 new = (old & ~mask) | value;
2176 change = old != new;
db2a4165
FM
2177
2178 return change;
2179}
2180EXPORT_SYMBOL_GPL(snd_soc_test_bits);
2181
db2a4165
FM
2182/**
2183 * snd_soc_set_runtime_hwparams - set the runtime hardware parameters
2184 * @substream: the pcm substream
2185 * @hw: the hardware parameters
2186 *
2187 * Sets the substream runtime hardware parameters.
2188 */
2189int snd_soc_set_runtime_hwparams(struct snd_pcm_substream *substream,
2190 const struct snd_pcm_hardware *hw)
2191{
2192 struct snd_pcm_runtime *runtime = substream->runtime;
2193 runtime->hw.info = hw->info;
2194 runtime->hw.formats = hw->formats;
2195 runtime->hw.period_bytes_min = hw->period_bytes_min;
2196 runtime->hw.period_bytes_max = hw->period_bytes_max;
2197 runtime->hw.periods_min = hw->periods_min;
2198 runtime->hw.periods_max = hw->periods_max;
2199 runtime->hw.buffer_bytes_max = hw->buffer_bytes_max;
2200 runtime->hw.fifo_size = hw->fifo_size;
2201 return 0;
2202}
2203EXPORT_SYMBOL_GPL(snd_soc_set_runtime_hwparams);
2204
2205/**
2206 * snd_soc_cnew - create new control
2207 * @_template: control template
2208 * @data: control private data
ac11a2b3 2209 * @long_name: control long name
efb7ac3f 2210 * @prefix: control name prefix
db2a4165
FM
2211 *
2212 * Create a new mixer control from a template control.
2213 *
2214 * Returns 0 for success, else error.
2215 */
2216struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
3056557f 2217 void *data, const char *long_name,
efb7ac3f 2218 const char *prefix)
db2a4165
FM
2219{
2220 struct snd_kcontrol_new template;
efb7ac3f
MB
2221 struct snd_kcontrol *kcontrol;
2222 char *name = NULL;
2223 int name_len;
db2a4165
FM
2224
2225 memcpy(&template, _template, sizeof(template));
db2a4165
FM
2226 template.index = 0;
2227
efb7ac3f
MB
2228 if (!long_name)
2229 long_name = template.name;
2230
2231 if (prefix) {
2232 name_len = strlen(long_name) + strlen(prefix) + 2;
57cf9d45 2233 name = kmalloc(name_len, GFP_KERNEL);
efb7ac3f
MB
2234 if (!name)
2235 return NULL;
2236
2237 snprintf(name, name_len, "%s %s", prefix, long_name);
2238
2239 template.name = name;
2240 } else {
2241 template.name = long_name;
2242 }
2243
2244 kcontrol = snd_ctl_new1(&template, data);
2245
2246 kfree(name);
2247
2248 return kcontrol;
db2a4165
FM
2249}
2250EXPORT_SYMBOL_GPL(snd_soc_cnew);
2251
022658be
LG
2252static int snd_soc_add_controls(struct snd_card *card, struct device *dev,
2253 const struct snd_kcontrol_new *controls, int num_controls,
2254 const char *prefix, void *data)
2255{
2256 int err, i;
2257
2258 for (i = 0; i < num_controls; i++) {
2259 const struct snd_kcontrol_new *control = &controls[i];
2260 err = snd_ctl_add(card, snd_soc_cnew(control, data,
2261 control->name, prefix));
2262 if (err < 0) {
2263 dev_err(dev, "Failed to add %s: %d\n", control->name, err);
2264 return err;
2265 }
2266 }
2267
2268 return 0;
2269}
2270
3e8e1952 2271/**
022658be
LG
2272 * snd_soc_add_codec_controls - add an array of controls to a codec.
2273 * Convenience function to add a list of controls. Many codecs were
3e8e1952
IM
2274 * duplicating this code.
2275 *
2276 * @codec: codec to add controls to
2277 * @controls: array of controls to add
2278 * @num_controls: number of elements in the array
2279 *
2280 * Return 0 for success, else error.
2281 */
022658be 2282int snd_soc_add_codec_controls(struct snd_soc_codec *codec,
3e8e1952
IM
2283 const struct snd_kcontrol_new *controls, int num_controls)
2284{
f0fba2ad 2285 struct snd_card *card = codec->card->snd_card;
3e8e1952 2286
022658be
LG
2287 return snd_soc_add_controls(card, codec->dev, controls, num_controls,
2288 codec->name_prefix, codec);
3e8e1952 2289}
022658be 2290EXPORT_SYMBOL_GPL(snd_soc_add_codec_controls);
3e8e1952 2291
a491a5c8
LG
2292/**
2293 * snd_soc_add_platform_controls - add an array of controls to a platform.
022658be 2294 * Convenience function to add a list of controls.
a491a5c8
LG
2295 *
2296 * @platform: platform to add controls to
2297 * @controls: array of controls to add
2298 * @num_controls: number of elements in the array
2299 *
2300 * Return 0 for success, else error.
2301 */
2302int snd_soc_add_platform_controls(struct snd_soc_platform *platform,
2303 const struct snd_kcontrol_new *controls, int num_controls)
2304{
2305 struct snd_card *card = platform->card->snd_card;
a491a5c8 2306
022658be
LG
2307 return snd_soc_add_controls(card, platform->dev, controls, num_controls,
2308 NULL, platform);
a491a5c8
LG
2309}
2310EXPORT_SYMBOL_GPL(snd_soc_add_platform_controls);
2311
022658be
LG
2312/**
2313 * snd_soc_add_card_controls - add an array of controls to a SoC card.
2314 * Convenience function to add a list of controls.
2315 *
2316 * @soc_card: SoC card to add controls to
2317 * @controls: array of controls to add
2318 * @num_controls: number of elements in the array
2319 *
2320 * Return 0 for success, else error.
2321 */
2322int snd_soc_add_card_controls(struct snd_soc_card *soc_card,
2323 const struct snd_kcontrol_new *controls, int num_controls)
2324{
2325 struct snd_card *card = soc_card->snd_card;
2326
2327 return snd_soc_add_controls(card, soc_card->dev, controls, num_controls,
2328 NULL, soc_card);
2329}
2330EXPORT_SYMBOL_GPL(snd_soc_add_card_controls);
2331
2332/**
2333 * snd_soc_add_dai_controls - add an array of controls to a DAI.
2334 * Convienience function to add a list of controls.
2335 *
2336 * @dai: DAI to add controls to
2337 * @controls: array of controls to add
2338 * @num_controls: number of elements in the array
2339 *
2340 * Return 0 for success, else error.
2341 */
2342int snd_soc_add_dai_controls(struct snd_soc_dai *dai,
2343 const struct snd_kcontrol_new *controls, int num_controls)
2344{
2345 struct snd_card *card = dai->card->snd_card;
2346
2347 return snd_soc_add_controls(card, dai->dev, controls, num_controls,
2348 NULL, dai);
2349}
2350EXPORT_SYMBOL_GPL(snd_soc_add_dai_controls);
2351
db2a4165
FM
2352/**
2353 * snd_soc_info_enum_double - enumerated double mixer info callback
2354 * @kcontrol: mixer control
2355 * @uinfo: control element information
2356 *
2357 * Callback to provide information about a double enumerated
2358 * mixer control.
2359 *
2360 * Returns 0 for success.
2361 */
2362int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol,
2363 struct snd_ctl_elem_info *uinfo)
2364{
2365 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2366
2367 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2368 uinfo->count = e->shift_l == e->shift_r ? 1 : 2;
f8ba0b7b 2369 uinfo->value.enumerated.items = e->max;
db2a4165 2370
f8ba0b7b
JS
2371 if (uinfo->value.enumerated.item > e->max - 1)
2372 uinfo->value.enumerated.item = e->max - 1;
db2a4165
FM
2373 strcpy(uinfo->value.enumerated.name,
2374 e->texts[uinfo->value.enumerated.item]);
2375 return 0;
2376}
2377EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
2378
2379/**
2380 * snd_soc_get_enum_double - enumerated double mixer get callback
2381 * @kcontrol: mixer control
ac11a2b3 2382 * @ucontrol: control element information
db2a4165
FM
2383 *
2384 * Callback to get the value of a double enumerated mixer.
2385 *
2386 * Returns 0 for success.
2387 */
2388int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol,
2389 struct snd_ctl_elem_value *ucontrol)
2390{
2391 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2392 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
46f5822f 2393 unsigned int val, bitmask;
db2a4165 2394
f8ba0b7b 2395 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
db2a4165
FM
2396 ;
2397 val = snd_soc_read(codec, e->reg);
3ff3f64b
MB
2398 ucontrol->value.enumerated.item[0]
2399 = (val >> e->shift_l) & (bitmask - 1);
db2a4165
FM
2400 if (e->shift_l != e->shift_r)
2401 ucontrol->value.enumerated.item[1] =
2402 (val >> e->shift_r) & (bitmask - 1);
2403
2404 return 0;
2405}
2406EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
2407
2408/**
2409 * snd_soc_put_enum_double - enumerated double mixer put callback
2410 * @kcontrol: mixer control
ac11a2b3 2411 * @ucontrol: control element information
db2a4165
FM
2412 *
2413 * Callback to set the value of a double enumerated mixer.
2414 *
2415 * Returns 0 for success.
2416 */
2417int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol,
2418 struct snd_ctl_elem_value *ucontrol)
2419{
2420 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2421 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
46f5822f
DR
2422 unsigned int val;
2423 unsigned int mask, bitmask;
db2a4165 2424
f8ba0b7b 2425 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
db2a4165 2426 ;
f8ba0b7b 2427 if (ucontrol->value.enumerated.item[0] > e->max - 1)
db2a4165
FM
2428 return -EINVAL;
2429 val = ucontrol->value.enumerated.item[0] << e->shift_l;
2430 mask = (bitmask - 1) << e->shift_l;
2431 if (e->shift_l != e->shift_r) {
f8ba0b7b 2432 if (ucontrol->value.enumerated.item[1] > e->max - 1)
db2a4165
FM
2433 return -EINVAL;
2434 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
2435 mask |= (bitmask - 1) << e->shift_r;
2436 }
2437
6c508c62 2438 return snd_soc_update_bits_locked(codec, e->reg, mask, val);
db2a4165
FM
2439}
2440EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
2441
2e72f8e3
PU
2442/**
2443 * snd_soc_get_value_enum_double - semi enumerated double mixer get callback
2444 * @kcontrol: mixer control
2445 * @ucontrol: control element information
2446 *
2447 * Callback to get the value of a double semi enumerated mixer.
2448 *
2449 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2450 * used for handling bitfield coded enumeration for example.
2451 *
2452 * Returns 0 for success.
2453 */
2454int snd_soc_get_value_enum_double(struct snd_kcontrol *kcontrol,
2455 struct snd_ctl_elem_value *ucontrol)
2456{
2457 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
74155556 2458 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
46f5822f 2459 unsigned int reg_val, val, mux;
2e72f8e3
PU
2460
2461 reg_val = snd_soc_read(codec, e->reg);
2462 val = (reg_val >> e->shift_l) & e->mask;
2463 for (mux = 0; mux < e->max; mux++) {
2464 if (val == e->values[mux])
2465 break;
2466 }
2467 ucontrol->value.enumerated.item[0] = mux;
2468 if (e->shift_l != e->shift_r) {
2469 val = (reg_val >> e->shift_r) & e->mask;
2470 for (mux = 0; mux < e->max; mux++) {
2471 if (val == e->values[mux])
2472 break;
2473 }
2474 ucontrol->value.enumerated.item[1] = mux;
2475 }
2476
2477 return 0;
2478}
2479EXPORT_SYMBOL_GPL(snd_soc_get_value_enum_double);
2480
2481/**
2482 * snd_soc_put_value_enum_double - semi enumerated double mixer put callback
2483 * @kcontrol: mixer control
2484 * @ucontrol: control element information
2485 *
2486 * Callback to set the value of a double semi enumerated mixer.
2487 *
2488 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2489 * used for handling bitfield coded enumeration for example.
2490 *
2491 * Returns 0 for success.
2492 */
2493int snd_soc_put_value_enum_double(struct snd_kcontrol *kcontrol,
2494 struct snd_ctl_elem_value *ucontrol)
2495{
2496 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
74155556 2497 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
46f5822f
DR
2498 unsigned int val;
2499 unsigned int mask;
2e72f8e3
PU
2500
2501 if (ucontrol->value.enumerated.item[0] > e->max - 1)
2502 return -EINVAL;
2503 val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
2504 mask = e->mask << e->shift_l;
2505 if (e->shift_l != e->shift_r) {
2506 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2507 return -EINVAL;
2508 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
2509 mask |= e->mask << e->shift_r;
2510 }
2511
6c508c62 2512 return snd_soc_update_bits_locked(codec, e->reg, mask, val);
2e72f8e3
PU
2513}
2514EXPORT_SYMBOL_GPL(snd_soc_put_value_enum_double);
2515
db2a4165
FM
2516/**
2517 * snd_soc_info_enum_ext - external enumerated single mixer info callback
2518 * @kcontrol: mixer control
2519 * @uinfo: control element information
2520 *
2521 * Callback to provide information about an external enumerated
2522 * single mixer.
2523 *
2524 * Returns 0 for success.
2525 */
2526int snd_soc_info_enum_ext(struct snd_kcontrol *kcontrol,
2527 struct snd_ctl_elem_info *uinfo)
2528{
2529 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2530
2531 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2532 uinfo->count = 1;
f8ba0b7b 2533 uinfo->value.enumerated.items = e->max;
db2a4165 2534
f8ba0b7b
JS
2535 if (uinfo->value.enumerated.item > e->max - 1)
2536 uinfo->value.enumerated.item = e->max - 1;
db2a4165
FM
2537 strcpy(uinfo->value.enumerated.name,
2538 e->texts[uinfo->value.enumerated.item]);
2539 return 0;
2540}
2541EXPORT_SYMBOL_GPL(snd_soc_info_enum_ext);
2542
2543/**
2544 * snd_soc_info_volsw_ext - external single mixer info callback
2545 * @kcontrol: mixer control
2546 * @uinfo: control element information
2547 *
2548 * Callback to provide information about a single external mixer control.
2549 *
2550 * Returns 0 for success.
2551 */
2552int snd_soc_info_volsw_ext(struct snd_kcontrol *kcontrol,
2553 struct snd_ctl_elem_info *uinfo)
2554{
a7a4ac86
PZ
2555 int max = kcontrol->private_value;
2556
fd5dfad9 2557 if (max == 1 && !strstr(kcontrol->id.name, " Volume"))
a7a4ac86
PZ
2558 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2559 else
2560 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
db2a4165 2561
db2a4165
FM
2562 uinfo->count = 1;
2563 uinfo->value.integer.min = 0;
a7a4ac86 2564 uinfo->value.integer.max = max;
db2a4165
FM
2565 return 0;
2566}
2567EXPORT_SYMBOL_GPL(snd_soc_info_volsw_ext);
2568
db2a4165
FM
2569/**
2570 * snd_soc_info_volsw - single mixer info callback
2571 * @kcontrol: mixer control
2572 * @uinfo: control element information
2573 *
e8f5a103
PU
2574 * Callback to provide information about a single mixer control, or a double
2575 * mixer control that spans 2 registers.
db2a4165
FM
2576 *
2577 * Returns 0 for success.
2578 */
2579int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
2580 struct snd_ctl_elem_info *uinfo)
2581{
4eaa9819
JS
2582 struct soc_mixer_control *mc =
2583 (struct soc_mixer_control *)kcontrol->private_value;
d11bb4a9 2584 int platform_max;
db2a4165 2585
d11bb4a9
PU
2586 if (!mc->platform_max)
2587 mc->platform_max = mc->max;
2588 platform_max = mc->platform_max;
2589
2590 if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
a7a4ac86
PZ
2591 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2592 else
2593 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2594
e8f5a103 2595 uinfo->count = snd_soc_volsw_is_stereo(mc) ? 2 : 1;
db2a4165 2596 uinfo->value.integer.min = 0;
d11bb4a9 2597 uinfo->value.integer.max = platform_max;
db2a4165
FM
2598 return 0;
2599}
2600EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
2601
2602/**
2603 * snd_soc_get_volsw - single mixer get callback
2604 * @kcontrol: mixer control
ac11a2b3 2605 * @ucontrol: control element information
db2a4165 2606 *
f7915d99
PU
2607 * Callback to get the value of a single mixer control, or a double mixer
2608 * control that spans 2 registers.
db2a4165
FM
2609 *
2610 * Returns 0 for success.
2611 */
2612int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
2613 struct snd_ctl_elem_value *ucontrol)
2614{
4eaa9819
JS
2615 struct soc_mixer_control *mc =
2616 (struct soc_mixer_control *)kcontrol->private_value;
db2a4165 2617 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
815ecf8d 2618 unsigned int reg = mc->reg;
f7915d99 2619 unsigned int reg2 = mc->rreg;
815ecf8d
JS
2620 unsigned int shift = mc->shift;
2621 unsigned int rshift = mc->rshift;
4eaa9819 2622 int max = mc->max;
815ecf8d
JS
2623 unsigned int mask = (1 << fls(max)) - 1;
2624 unsigned int invert = mc->invert;
db2a4165
FM
2625
2626 ucontrol->value.integer.value[0] =
2627 (snd_soc_read(codec, reg) >> shift) & mask;
f7915d99 2628 if (invert)
db2a4165 2629 ucontrol->value.integer.value[0] =
a7a4ac86 2630 max - ucontrol->value.integer.value[0];
f7915d99
PU
2631
2632 if (snd_soc_volsw_is_stereo(mc)) {
2633 if (reg == reg2)
2634 ucontrol->value.integer.value[1] =
2635 (snd_soc_read(codec, reg) >> rshift) & mask;
2636 else
2637 ucontrol->value.integer.value[1] =
2638 (snd_soc_read(codec, reg2) >> shift) & mask;
2639 if (invert)
db2a4165 2640 ucontrol->value.integer.value[1] =
a7a4ac86 2641 max - ucontrol->value.integer.value[1];
db2a4165
FM
2642 }
2643
2644 return 0;
2645}
2646EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
2647
2648/**
2649 * snd_soc_put_volsw - single mixer put callback
2650 * @kcontrol: mixer control
ac11a2b3 2651 * @ucontrol: control element information
db2a4165 2652 *
974815ba
PU
2653 * Callback to set the value of a single mixer control, or a double mixer
2654 * control that spans 2 registers.
db2a4165
FM
2655 *
2656 * Returns 0 for success.
2657 */
2658int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
2659 struct snd_ctl_elem_value *ucontrol)
2660{
4eaa9819
JS
2661 struct soc_mixer_control *mc =
2662 (struct soc_mixer_control *)kcontrol->private_value;
db2a4165 2663 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
815ecf8d 2664 unsigned int reg = mc->reg;
974815ba 2665 unsigned int reg2 = mc->rreg;
815ecf8d
JS
2666 unsigned int shift = mc->shift;
2667 unsigned int rshift = mc->rshift;
4eaa9819 2668 int max = mc->max;
815ecf8d
JS
2669 unsigned int mask = (1 << fls(max)) - 1;
2670 unsigned int invert = mc->invert;
974815ba
PU
2671 int err;
2672 bool type_2r = 0;
2673 unsigned int val2 = 0;
2674 unsigned int val, val_mask;
db2a4165
FM
2675
2676 val = (ucontrol->value.integer.value[0] & mask);
2677 if (invert)
a7a4ac86 2678 val = max - val;
db2a4165
FM
2679 val_mask = mask << shift;
2680 val = val << shift;
974815ba 2681 if (snd_soc_volsw_is_stereo(mc)) {
db2a4165
FM
2682 val2 = (ucontrol->value.integer.value[1] & mask);
2683 if (invert)
a7a4ac86 2684 val2 = max - val2;
974815ba
PU
2685 if (reg == reg2) {
2686 val_mask |= mask << rshift;
2687 val |= val2 << rshift;
2688 } else {
2689 val2 = val2 << shift;
2690 type_2r = 1;
2691 }
db2a4165 2692 }
6c508c62 2693 err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
3ff3f64b 2694 if (err < 0)
db2a4165
FM
2695 return err;
2696
974815ba
PU
2697 if (type_2r)
2698 err = snd_soc_update_bits_locked(codec, reg2, val_mask, val2);
2699
db2a4165
FM
2700 return err;
2701}
974815ba 2702EXPORT_SYMBOL_GPL(snd_soc_put_volsw);
db2a4165 2703
1d99f243
BA
2704/**
2705 * snd_soc_get_volsw_sx - single mixer get callback
2706 * @kcontrol: mixer control
2707 * @ucontrol: control element information
2708 *
2709 * Callback to get the value of a single mixer control, or a double mixer
2710 * control that spans 2 registers.
2711 *
2712 * Returns 0 for success.
2713 */
2714int snd_soc_get_volsw_sx(struct snd_kcontrol *kcontrol,
2715 struct snd_ctl_elem_value *ucontrol)
2716{
2717 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2718 struct soc_mixer_control *mc =
2719 (struct soc_mixer_control *)kcontrol->private_value;
2720
2721 unsigned int reg = mc->reg;
2722 unsigned int reg2 = mc->rreg;
2723 unsigned int shift = mc->shift;
2724 unsigned int rshift = mc->rshift;
2725 int max = mc->max;
2726 int min = mc->min;
2727 int mask = (1 << (fls(min + max) - 1)) - 1;
2728
2729 ucontrol->value.integer.value[0] =
2730 ((snd_soc_read(codec, reg) >> shift) - min) & mask;
2731
2732 if (snd_soc_volsw_is_stereo(mc))
2733 ucontrol->value.integer.value[1] =
2734 ((snd_soc_read(codec, reg2) >> rshift) - min) & mask;
2735
2736 return 0;
2737}
2738EXPORT_SYMBOL_GPL(snd_soc_get_volsw_sx);
2739
2740/**
2741 * snd_soc_put_volsw_sx - double mixer set callback
2742 * @kcontrol: mixer control
2743 * @uinfo: control element information
2744 *
2745 * Callback to set the value of a double mixer control that spans 2 registers.
2746 *
2747 * Returns 0 for success.
2748 */
2749int snd_soc_put_volsw_sx(struct snd_kcontrol *kcontrol,
2750 struct snd_ctl_elem_value *ucontrol)
2751{
2752 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2753 struct soc_mixer_control *mc =
2754 (struct soc_mixer_control *)kcontrol->private_value;
2755
2756 unsigned int reg = mc->reg;
2757 unsigned int reg2 = mc->rreg;
2758 unsigned int shift = mc->shift;
2759 unsigned int rshift = mc->rshift;
2760 int max = mc->max;
2761 int min = mc->min;
2762 int mask = (1 << (fls(min + max) - 1)) - 1;
27f1d759 2763 int err = 0;
1d99f243
BA
2764 unsigned short val, val_mask, val2 = 0;
2765
2766 val_mask = mask << shift;
2767 val = (ucontrol->value.integer.value[0] + min) & mask;
2768 val = val << shift;
2769
2770 if (snd_soc_update_bits_locked(codec, reg, val_mask, val))
2771 return err;
2772
2773 if (snd_soc_volsw_is_stereo(mc)) {
2774 val_mask = mask << rshift;
2775 val2 = (ucontrol->value.integer.value[1] + min) & mask;
2776 val2 = val2 << rshift;
2777
2778 if (snd_soc_update_bits_locked(codec, reg2, val_mask, val2))
2779 return err;
2780 }
2781 return 0;
2782}
2783EXPORT_SYMBOL_GPL(snd_soc_put_volsw_sx);
2784
e13ac2e9
MB
2785/**
2786 * snd_soc_info_volsw_s8 - signed mixer info callback
2787 * @kcontrol: mixer control
2788 * @uinfo: control element information
2789 *
2790 * Callback to provide information about a signed mixer control.
2791 *
2792 * Returns 0 for success.
2793 */
2794int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol,
2795 struct snd_ctl_elem_info *uinfo)
2796{
4eaa9819
JS
2797 struct soc_mixer_control *mc =
2798 (struct soc_mixer_control *)kcontrol->private_value;
d11bb4a9 2799 int platform_max;
4eaa9819 2800 int min = mc->min;
e13ac2e9 2801
d11bb4a9
PU
2802 if (!mc->platform_max)
2803 mc->platform_max = mc->max;
2804 platform_max = mc->platform_max;
2805
e13ac2e9
MB
2806 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2807 uinfo->count = 2;
2808 uinfo->value.integer.min = 0;
d11bb4a9 2809 uinfo->value.integer.max = platform_max - min;
e13ac2e9
MB
2810 return 0;
2811}
2812EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8);
2813
2814/**
2815 * snd_soc_get_volsw_s8 - signed mixer get callback
2816 * @kcontrol: mixer control
ac11a2b3 2817 * @ucontrol: control element information
e13ac2e9
MB
2818 *
2819 * Callback to get the value of a signed mixer control.
2820 *
2821 * Returns 0 for success.
2822 */
2823int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol,
2824 struct snd_ctl_elem_value *ucontrol)
2825{
4eaa9819
JS
2826 struct soc_mixer_control *mc =
2827 (struct soc_mixer_control *)kcontrol->private_value;
e13ac2e9 2828 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
815ecf8d 2829 unsigned int reg = mc->reg;
4eaa9819 2830 int min = mc->min;
e13ac2e9
MB
2831 int val = snd_soc_read(codec, reg);
2832
2833 ucontrol->value.integer.value[0] =
2834 ((signed char)(val & 0xff))-min;
2835 ucontrol->value.integer.value[1] =
2836 ((signed char)((val >> 8) & 0xff))-min;
2837 return 0;
2838}
2839EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8);
2840
2841/**
2842 * snd_soc_put_volsw_sgn - signed mixer put callback
2843 * @kcontrol: mixer control
ac11a2b3 2844 * @ucontrol: control element information
e13ac2e9
MB
2845 *
2846 * Callback to set the value of a signed mixer control.
2847 *
2848 * Returns 0 for success.
2849 */
2850int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol,
2851 struct snd_ctl_elem_value *ucontrol)
2852{
4eaa9819
JS
2853 struct soc_mixer_control *mc =
2854 (struct soc_mixer_control *)kcontrol->private_value;
e13ac2e9 2855 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
815ecf8d 2856 unsigned int reg = mc->reg;
4eaa9819 2857 int min = mc->min;
46f5822f 2858 unsigned int val;
e13ac2e9
MB
2859
2860 val = (ucontrol->value.integer.value[0]+min) & 0xff;
2861 val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8;
2862
6c508c62 2863 return snd_soc_update_bits_locked(codec, reg, 0xffff, val);
e13ac2e9
MB
2864}
2865EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8);
2866
6c9d8cf6
AT
2867/**
2868 * snd_soc_info_volsw_range - single mixer info callback with range.
2869 * @kcontrol: mixer control
2870 * @uinfo: control element information
2871 *
2872 * Callback to provide information, within a range, about a single
2873 * mixer control.
2874 *
2875 * returns 0 for success.
2876 */
2877int snd_soc_info_volsw_range(struct snd_kcontrol *kcontrol,
2878 struct snd_ctl_elem_info *uinfo)
2879{
2880 struct soc_mixer_control *mc =
2881 (struct soc_mixer_control *)kcontrol->private_value;
2882 int platform_max;
2883 int min = mc->min;
2884
2885 if (!mc->platform_max)
2886 mc->platform_max = mc->max;
2887 platform_max = mc->platform_max;
2888
2889 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2890 uinfo->count = 1;
2891 uinfo->value.integer.min = 0;
2892 uinfo->value.integer.max = platform_max - min;
2893
2894 return 0;
2895}
2896EXPORT_SYMBOL_GPL(snd_soc_info_volsw_range);
2897
2898/**
2899 * snd_soc_put_volsw_range - single mixer put value callback with range.
2900 * @kcontrol: mixer control
2901 * @ucontrol: control element information
2902 *
2903 * Callback to set the value, within a range, for a single mixer control.
2904 *
2905 * Returns 0 for success.
2906 */
2907int snd_soc_put_volsw_range(struct snd_kcontrol *kcontrol,
2908 struct snd_ctl_elem_value *ucontrol)
2909{
2910 struct soc_mixer_control *mc =
2911 (struct soc_mixer_control *)kcontrol->private_value;
2912 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2913 unsigned int reg = mc->reg;
2914 unsigned int shift = mc->shift;
2915 int min = mc->min;
2916 int max = mc->max;
2917 unsigned int mask = (1 << fls(max)) - 1;
2918 unsigned int invert = mc->invert;
2919 unsigned int val, val_mask;
2920
2921 val = ((ucontrol->value.integer.value[0] + min) & mask);
2922 if (invert)
2923 val = max - val;
2924 val_mask = mask << shift;
2925 val = val << shift;
2926
2927 return snd_soc_update_bits_locked(codec, reg, val_mask, val);
2928}
2929EXPORT_SYMBOL_GPL(snd_soc_put_volsw_range);
2930
2931/**
2932 * snd_soc_get_volsw_range - single mixer get callback with range
2933 * @kcontrol: mixer control
2934 * @ucontrol: control element information
2935 *
2936 * Callback to get the value, within a range, of a single mixer control.
2937 *
2938 * Returns 0 for success.
2939 */
2940int snd_soc_get_volsw_range(struct snd_kcontrol *kcontrol,
2941 struct snd_ctl_elem_value *ucontrol)
2942{
2943 struct soc_mixer_control *mc =
2944 (struct soc_mixer_control *)kcontrol->private_value;
2945 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2946 unsigned int reg = mc->reg;
2947 unsigned int shift = mc->shift;
2948 int min = mc->min;
2949 int max = mc->max;
2950 unsigned int mask = (1 << fls(max)) - 1;
2951 unsigned int invert = mc->invert;
2952
2953 ucontrol->value.integer.value[0] =
2954 (snd_soc_read(codec, reg) >> shift) & mask;
2955 if (invert)
2956 ucontrol->value.integer.value[0] =
2957 max - ucontrol->value.integer.value[0];
2958 ucontrol->value.integer.value[0] =
2959 ucontrol->value.integer.value[0] - min;
2960
2961 return 0;
2962}
2963EXPORT_SYMBOL_GPL(snd_soc_get_volsw_range);
2964
637d3847
PU
2965/**
2966 * snd_soc_limit_volume - Set new limit to an existing volume control.
2967 *
2968 * @codec: where to look for the control
2969 * @name: Name of the control
2970 * @max: new maximum limit
2971 *
2972 * Return 0 for success, else error.
2973 */
2974int snd_soc_limit_volume(struct snd_soc_codec *codec,
2975 const char *name, int max)
2976{
f0fba2ad 2977 struct snd_card *card = codec->card->snd_card;
637d3847
PU
2978 struct snd_kcontrol *kctl;
2979 struct soc_mixer_control *mc;
2980 int found = 0;
2981 int ret = -EINVAL;
2982
2983 /* Sanity check for name and max */
2984 if (unlikely(!name || max <= 0))
2985 return -EINVAL;
2986
2987 list_for_each_entry(kctl, &card->controls, list) {
2988 if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) {
2989 found = 1;
2990 break;
2991 }
2992 }
2993 if (found) {
2994 mc = (struct soc_mixer_control *)kctl->private_value;
2995 if (max <= mc->max) {
d11bb4a9 2996 mc->platform_max = max;
637d3847
PU
2997 ret = 0;
2998 }
2999 }
3000 return ret;
3001}
3002EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
3003
71d08516
MB
3004int snd_soc_bytes_info(struct snd_kcontrol *kcontrol,
3005 struct snd_ctl_elem_info *uinfo)
3006{
3007 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3008 struct soc_bytes *params = (void *)kcontrol->private_value;
3009
3010 uinfo->type = SNDRV_CTL_ELEM_TYPE_BYTES;
3011 uinfo->count = params->num_regs * codec->val_bytes;
3012
3013 return 0;
3014}
3015EXPORT_SYMBOL_GPL(snd_soc_bytes_info);
3016
3017int snd_soc_bytes_get(struct snd_kcontrol *kcontrol,
3018 struct snd_ctl_elem_value *ucontrol)
3019{
3020 struct soc_bytes *params = (void *)kcontrol->private_value;
3021 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3022 int ret;
3023
3024 if (codec->using_regmap)
3025 ret = regmap_raw_read(codec->control_data, params->base,
3026 ucontrol->value.bytes.data,
3027 params->num_regs * codec->val_bytes);
3028 else
3029 ret = -EINVAL;
3030
f831b055
MB
3031 /* Hide any masked bytes to ensure consistent data reporting */
3032 if (ret == 0 && params->mask) {
3033 switch (codec->val_bytes) {
3034 case 1:
3035 ucontrol->value.bytes.data[0] &= ~params->mask;
3036 break;
3037 case 2:
3038 ((u16 *)(&ucontrol->value.bytes.data))[0]
3039 &= ~params->mask;
3040 break;
3041 case 4:
3042 ((u32 *)(&ucontrol->value.bytes.data))[0]
3043 &= ~params->mask;
3044 break;
3045 default:
3046 return -EINVAL;
3047 }
3048 }
3049
71d08516
MB
3050 return ret;
3051}
3052EXPORT_SYMBOL_GPL(snd_soc_bytes_get);
3053
3054int snd_soc_bytes_put(struct snd_kcontrol *kcontrol,
3055 struct snd_ctl_elem_value *ucontrol)
3056{
3057 struct soc_bytes *params = (void *)kcontrol->private_value;
3058 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
f831b055
MB
3059 int ret, len;
3060 unsigned int val;
3061 void *data;
71d08516 3062
f831b055
MB
3063 if (!codec->using_regmap)
3064 return -EINVAL;
3065
3066 data = ucontrol->value.bytes.data;
3067 len = params->num_regs * codec->val_bytes;
3068
3069 /*
3070 * If we've got a mask then we need to preserve the register
3071 * bits. We shouldn't modify the incoming data so take a
3072 * copy.
3073 */
3074 if (params->mask) {
3075 ret = regmap_read(codec->control_data, params->base, &val);
3076 if (ret != 0)
3077 return ret;
3078
3079 val &= params->mask;
3080
3081 data = kmemdup(data, len, GFP_KERNEL);
3082 if (!data)
3083 return -ENOMEM;
3084
3085 switch (codec->val_bytes) {
3086 case 1:
3087 ((u8 *)data)[0] &= ~params->mask;
3088 ((u8 *)data)[0] |= val;
3089 break;
3090 case 2:
3091 ((u16 *)data)[0] &= cpu_to_be16(~params->mask);
3092 ((u16 *)data)[0] |= cpu_to_be16(val);
3093 break;
3094 case 4:
3095 ((u32 *)data)[0] &= cpu_to_be32(~params->mask);
3096 ((u32 *)data)[0] |= cpu_to_be32(val);
3097 break;
3098 default:
3099 return -EINVAL;
3100 }
3101 }
3102
3103 ret = regmap_raw_write(codec->control_data, params->base,
3104 data, len);
3105
3106 if (params->mask)
3107 kfree(data);
71d08516
MB
3108
3109 return ret;
3110}
3111EXPORT_SYMBOL_GPL(snd_soc_bytes_put);
3112
4183eed2
KK
3113/**
3114 * snd_soc_info_xr_sx - signed multi register info callback
3115 * @kcontrol: mreg control
3116 * @uinfo: control element information
3117 *
3118 * Callback to provide information of a control that can
3119 * span multiple codec registers which together
3120 * forms a single signed value in a MSB/LSB manner.
3121 *
3122 * Returns 0 for success.
3123 */
3124int snd_soc_info_xr_sx(struct snd_kcontrol *kcontrol,
3125 struct snd_ctl_elem_info *uinfo)
3126{
3127 struct soc_mreg_control *mc =
3128 (struct soc_mreg_control *)kcontrol->private_value;
3129 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
3130 uinfo->count = 1;
3131 uinfo->value.integer.min = mc->min;
3132 uinfo->value.integer.max = mc->max;
3133
3134 return 0;
3135}
3136EXPORT_SYMBOL_GPL(snd_soc_info_xr_sx);
3137
3138/**
3139 * snd_soc_get_xr_sx - signed multi register get callback
3140 * @kcontrol: mreg control
3141 * @ucontrol: control element information
3142 *
3143 * Callback to get the value of a control that can span
3144 * multiple codec registers which together forms a single
3145 * signed value in a MSB/LSB manner. The control supports
3146 * specifying total no of bits used to allow for bitfields
3147 * across the multiple codec registers.
3148 *
3149 * Returns 0 for success.
3150 */
3151int snd_soc_get_xr_sx(struct snd_kcontrol *kcontrol,
3152 struct snd_ctl_elem_value *ucontrol)
3153{
3154 struct soc_mreg_control *mc =
3155 (struct soc_mreg_control *)kcontrol->private_value;
3156 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3157 unsigned int regbase = mc->regbase;
3158 unsigned int regcount = mc->regcount;
3159 unsigned int regwshift = codec->driver->reg_word_size * BITS_PER_BYTE;
3160 unsigned int regwmask = (1<<regwshift)-1;
3161 unsigned int invert = mc->invert;
3162 unsigned long mask = (1UL<<mc->nbits)-1;
3163 long min = mc->min;
3164 long max = mc->max;
3165 long val = 0;
3166 unsigned long regval;
3167 unsigned int i;
3168
3169 for (i = 0; i < regcount; i++) {
3170 regval = snd_soc_read(codec, regbase+i) & regwmask;
3171 val |= regval << (regwshift*(regcount-i-1));
3172 }
3173 val &= mask;
3174 if (min < 0 && val > max)
3175 val |= ~mask;
3176 if (invert)
3177 val = max - val;
3178 ucontrol->value.integer.value[0] = val;
3179
3180 return 0;
3181}
3182EXPORT_SYMBOL_GPL(snd_soc_get_xr_sx);
3183
3184/**
3185 * snd_soc_put_xr_sx - signed multi register get callback
3186 * @kcontrol: mreg control
3187 * @ucontrol: control element information
3188 *
3189 * Callback to set the value of a control that can span
3190 * multiple codec registers which together forms a single
3191 * signed value in a MSB/LSB manner. The control supports
3192 * specifying total no of bits used to allow for bitfields
3193 * across the multiple codec registers.
3194 *
3195 * Returns 0 for success.
3196 */
3197int snd_soc_put_xr_sx(struct snd_kcontrol *kcontrol,
3198 struct snd_ctl_elem_value *ucontrol)
3199{
3200 struct soc_mreg_control *mc =
3201 (struct soc_mreg_control *)kcontrol->private_value;
3202 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3203 unsigned int regbase = mc->regbase;
3204 unsigned int regcount = mc->regcount;
3205 unsigned int regwshift = codec->driver->reg_word_size * BITS_PER_BYTE;
3206 unsigned int regwmask = (1<<regwshift)-1;
3207 unsigned int invert = mc->invert;
3208 unsigned long mask = (1UL<<mc->nbits)-1;
4183eed2
KK
3209 long max = mc->max;
3210 long val = ucontrol->value.integer.value[0];
3211 unsigned int i, regval, regmask;
3212 int err;
3213
3214 if (invert)
3215 val = max - val;
3216 val &= mask;
3217 for (i = 0; i < regcount; i++) {
3218 regval = (val >> (regwshift*(regcount-i-1))) & regwmask;
3219 regmask = (mask >> (regwshift*(regcount-i-1))) & regwmask;
3220 err = snd_soc_update_bits_locked(codec, regbase+i,
3221 regmask, regval);
3222 if (err < 0)
3223 return err;
3224 }
3225
3226 return 0;
3227}
3228EXPORT_SYMBOL_GPL(snd_soc_put_xr_sx);
3229
dd7b10b3
KK
3230/**
3231 * snd_soc_get_strobe - strobe get callback
3232 * @kcontrol: mixer control
3233 * @ucontrol: control element information
3234 *
3235 * Callback get the value of a strobe mixer control.
3236 *
3237 * Returns 0 for success.
3238 */
3239int snd_soc_get_strobe(struct snd_kcontrol *kcontrol,
3240 struct snd_ctl_elem_value *ucontrol)
3241{
3242 struct soc_mixer_control *mc =
3243 (struct soc_mixer_control *)kcontrol->private_value;
3244 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3245 unsigned int reg = mc->reg;
3246 unsigned int shift = mc->shift;
3247 unsigned int mask = 1 << shift;
3248 unsigned int invert = mc->invert != 0;
3249 unsigned int val = snd_soc_read(codec, reg) & mask;
3250
3251 if (shift != 0 && val != 0)
3252 val = val >> shift;
3253 ucontrol->value.enumerated.item[0] = val ^ invert;
3254
3255 return 0;
3256}
3257EXPORT_SYMBOL_GPL(snd_soc_get_strobe);
3258
3259/**
3260 * snd_soc_put_strobe - strobe put callback
3261 * @kcontrol: mixer control
3262 * @ucontrol: control element information
3263 *
3264 * Callback strobe a register bit to high then low (or the inverse)
3265 * in one pass of a single mixer enum control.
3266 *
3267 * Returns 1 for success.
3268 */
3269int snd_soc_put_strobe(struct snd_kcontrol *kcontrol,
3270 struct snd_ctl_elem_value *ucontrol)
3271{
3272 struct soc_mixer_control *mc =
3273 (struct soc_mixer_control *)kcontrol->private_value;
3274 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3275 unsigned int reg = mc->reg;
3276 unsigned int shift = mc->shift;
3277 unsigned int mask = 1 << shift;
3278 unsigned int invert = mc->invert != 0;
3279 unsigned int strobe = ucontrol->value.enumerated.item[0] != 0;
3280 unsigned int val1 = (strobe ^ invert) ? mask : 0;
3281 unsigned int val2 = (strobe ^ invert) ? 0 : mask;
3282 int err;
3283
3284 err = snd_soc_update_bits_locked(codec, reg, mask, val1);
3285 if (err < 0)
3286 return err;
3287
3288 err = snd_soc_update_bits_locked(codec, reg, mask, val2);
3289 return err;
3290}
3291EXPORT_SYMBOL_GPL(snd_soc_put_strobe);
3292
8c6529db
LG
3293/**
3294 * snd_soc_dai_set_sysclk - configure DAI system or master clock.
3295 * @dai: DAI
3296 * @clk_id: DAI specific clock ID
3297 * @freq: new clock frequency in Hz
3298 * @dir: new clock direction - input/output.
3299 *
3300 * Configures the DAI master (MCLK) or system (SYSCLK) clocking.
3301 */
3302int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
3303 unsigned int freq, int dir)
3304{
f0fba2ad
LG
3305 if (dai->driver && dai->driver->ops->set_sysclk)
3306 return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir);
ec4ee52a 3307 else if (dai->codec && dai->codec->driver->set_sysclk)
da1c6ea6 3308 return dai->codec->driver->set_sysclk(dai->codec, clk_id, 0,
ec4ee52a 3309 freq, dir);
8c6529db
LG
3310 else
3311 return -EINVAL;
3312}
3313EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
3314
ec4ee52a
MB
3315/**
3316 * snd_soc_codec_set_sysclk - configure CODEC system or master clock.
3317 * @codec: CODEC
3318 * @clk_id: DAI specific clock ID
da1c6ea6 3319 * @source: Source for the clock
ec4ee52a
MB
3320 * @freq: new clock frequency in Hz
3321 * @dir: new clock direction - input/output.
3322 *
3323 * Configures the CODEC master (MCLK) or system (SYSCLK) clocking.
3324 */
3325int snd_soc_codec_set_sysclk(struct snd_soc_codec *codec, int clk_id,
da1c6ea6 3326 int source, unsigned int freq, int dir)
ec4ee52a
MB
3327{
3328 if (codec->driver->set_sysclk)
da1c6ea6
MB
3329 return codec->driver->set_sysclk(codec, clk_id, source,
3330 freq, dir);
ec4ee52a
MB
3331 else
3332 return -EINVAL;
3333}
3334EXPORT_SYMBOL_GPL(snd_soc_codec_set_sysclk);
3335
8c6529db
LG
3336/**
3337 * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
3338 * @dai: DAI
ac11a2b3 3339 * @div_id: DAI specific clock divider ID
8c6529db
LG
3340 * @div: new clock divisor.
3341 *
3342 * Configures the clock dividers. This is used to derive the best DAI bit and
3343 * frame clocks from the system or master clock. It's best to set the DAI bit
3344 * and frame clocks as low as possible to save system power.
3345 */
3346int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
3347 int div_id, int div)
3348{
f0fba2ad
LG
3349 if (dai->driver && dai->driver->ops->set_clkdiv)
3350 return dai->driver->ops->set_clkdiv(dai, div_id, div);
8c6529db
LG
3351 else
3352 return -EINVAL;
3353}
3354EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv);
3355
3356/**
3357 * snd_soc_dai_set_pll - configure DAI PLL.
3358 * @dai: DAI
3359 * @pll_id: DAI specific PLL ID
85488037 3360 * @source: DAI specific source for the PLL
8c6529db
LG
3361 * @freq_in: PLL input clock frequency in Hz
3362 * @freq_out: requested PLL output clock frequency in Hz
3363 *
3364 * Configures and enables PLL to generate output clock based on input clock.
3365 */
85488037
MB
3366int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
3367 unsigned int freq_in, unsigned int freq_out)
8c6529db 3368{
f0fba2ad
LG
3369 if (dai->driver && dai->driver->ops->set_pll)
3370 return dai->driver->ops->set_pll(dai, pll_id, source,
85488037 3371 freq_in, freq_out);
ec4ee52a
MB
3372 else if (dai->codec && dai->codec->driver->set_pll)
3373 return dai->codec->driver->set_pll(dai->codec, pll_id, source,
3374 freq_in, freq_out);
8c6529db
LG
3375 else
3376 return -EINVAL;
3377}
3378EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
3379
ec4ee52a
MB
3380/*
3381 * snd_soc_codec_set_pll - configure codec PLL.
3382 * @codec: CODEC
3383 * @pll_id: DAI specific PLL ID
3384 * @source: DAI specific source for the PLL
3385 * @freq_in: PLL input clock frequency in Hz
3386 * @freq_out: requested PLL output clock frequency in Hz
3387 *
3388 * Configures and enables PLL to generate output clock based on input clock.
3389 */
3390int snd_soc_codec_set_pll(struct snd_soc_codec *codec, int pll_id, int source,
3391 unsigned int freq_in, unsigned int freq_out)
3392{
3393 if (codec->driver->set_pll)
3394 return codec->driver->set_pll(codec, pll_id, source,
3395 freq_in, freq_out);
3396 else
3397 return -EINVAL;
3398}
3399EXPORT_SYMBOL_GPL(snd_soc_codec_set_pll);
3400
8c6529db
LG
3401/**
3402 * snd_soc_dai_set_fmt - configure DAI hardware audio format.
3403 * @dai: DAI
8c6529db
LG
3404 * @fmt: SND_SOC_DAIFMT_ format value.
3405 *
3406 * Configures the DAI hardware format and clocking.
3407 */
3408int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
3409{
5e4ba569 3410 if (dai->driver == NULL)
8c6529db 3411 return -EINVAL;
5e4ba569
SG
3412 if (dai->driver->ops->set_fmt == NULL)
3413 return -ENOTSUPP;
3414 return dai->driver->ops->set_fmt(dai, fmt);
8c6529db
LG
3415}
3416EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
3417
3418/**
3419 * snd_soc_dai_set_tdm_slot - configure DAI TDM.
3420 * @dai: DAI
a5479e38
DR
3421 * @tx_mask: bitmask representing active TX slots.
3422 * @rx_mask: bitmask representing active RX slots.
8c6529db 3423 * @slots: Number of slots in use.
a5479e38 3424 * @slot_width: Width in bits for each slot.
8c6529db
LG
3425 *
3426 * Configures a DAI for TDM operation. Both mask and slots are codec and DAI
3427 * specific.
3428 */
3429int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
a5479e38 3430 unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
8c6529db 3431{
f0fba2ad
LG
3432 if (dai->driver && dai->driver->ops->set_tdm_slot)
3433 return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask,
a5479e38 3434 slots, slot_width);
8c6529db
LG
3435 else
3436 return -EINVAL;
3437}
3438EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
3439
472df3cb
BS
3440/**
3441 * snd_soc_dai_set_channel_map - configure DAI audio channel map
3442 * @dai: DAI
3443 * @tx_num: how many TX channels
3444 * @tx_slot: pointer to an array which imply the TX slot number channel
3445 * 0~num-1 uses
3446 * @rx_num: how many RX channels
3447 * @rx_slot: pointer to an array which imply the RX slot number channel
3448 * 0~num-1 uses
3449 *
3450 * configure the relationship between channel number and TDM slot number.
3451 */
3452int snd_soc_dai_set_channel_map(struct snd_soc_dai *dai,
3453 unsigned int tx_num, unsigned int *tx_slot,
3454 unsigned int rx_num, unsigned int *rx_slot)
3455{
f0fba2ad
LG
3456 if (dai->driver && dai->driver->ops->set_channel_map)
3457 return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot,
472df3cb
BS
3458 rx_num, rx_slot);
3459 else
3460 return -EINVAL;
3461}
3462EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map);
3463
8c6529db
LG
3464/**
3465 * snd_soc_dai_set_tristate - configure DAI system or master clock.
3466 * @dai: DAI
3467 * @tristate: tristate enable
3468 *
3469 * Tristates the DAI so that others can use it.
3470 */
3471int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
3472{
f0fba2ad
LG
3473 if (dai->driver && dai->driver->ops->set_tristate)
3474 return dai->driver->ops->set_tristate(dai, tristate);
8c6529db
LG
3475 else
3476 return -EINVAL;
3477}
3478EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate);
3479
3480/**
3481 * snd_soc_dai_digital_mute - configure DAI system or master clock.
3482 * @dai: DAI
3483 * @mute: mute enable
3484 *
3485 * Mutes the DAI DAC.
3486 */
3487int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute)
3488{
f0fba2ad
LG
3489 if (dai->driver && dai->driver->ops->digital_mute)
3490 return dai->driver->ops->digital_mute(dai, mute);
8c6529db 3491 else
04570c62 3492 return -ENOTSUPP;
8c6529db
LG
3493}
3494EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
3495
c5af3a2e
MB
3496/**
3497 * snd_soc_register_card - Register a card with the ASoC core
3498 *
ac11a2b3 3499 * @card: Card to register
c5af3a2e 3500 *
c5af3a2e 3501 */
70a7ca34 3502int snd_soc_register_card(struct snd_soc_card *card)
c5af3a2e 3503{
b19e6e7b 3504 int i, ret;
f0fba2ad 3505
c5af3a2e
MB
3506 if (!card->name || !card->dev)
3507 return -EINVAL;
3508
5a504963
SW
3509 for (i = 0; i < card->num_links; i++) {
3510 struct snd_soc_dai_link *link = &card->dai_link[i];
3511
3512 /*
3513 * Codec must be specified by 1 of name or OF node,
3514 * not both or neither.
3515 */
3516 if (!!link->codec_name == !!link->codec_of_node) {
3517 dev_err(card->dev,
3b09bb82
LG
3518 "Neither/both codec name/of_node are set for %s\n",
3519 link->name);
5a504963
SW
3520 return -EINVAL;
3521 }
bc92657a
SW
3522 /* Codec DAI name must be specified */
3523 if (!link->codec_dai_name) {
3524 dev_err(card->dev, "codec_dai_name not set for %s\n",
3525 link->name);
3526 return -EINVAL;
3527 }
5a504963
SW
3528
3529 /*
3530 * Platform may be specified by either name or OF node, but
3531 * can be left unspecified, and a dummy platform will be used.
3532 */
3533 if (link->platform_name && link->platform_of_node) {
3534 dev_err(card->dev,
3b09bb82 3535 "Both platform name/of_node are set for %s\n", link->name);
5a504963
SW
3536 return -EINVAL;
3537 }
3538
3539 /*
bc92657a
SW
3540 * CPU device may be specified by either name or OF node, but
3541 * can be left unspecified, and will be matched based on DAI
3542 * name alone..
3543 */
3544 if (link->cpu_name && link->cpu_of_node) {
3545 dev_err(card->dev,
3546 "Neither/both cpu name/of_node are set for %s\n",
3547 link->name);
3548 return -EINVAL;
3549 }
3550 /*
3551 * At least one of CPU DAI name or CPU device name/node must be
3552 * specified
5a504963 3553 */
bc92657a
SW
3554 if (!link->cpu_dai_name &&
3555 !(link->cpu_name || link->cpu_of_node)) {
5a504963 3556 dev_err(card->dev,
bc92657a 3557 "Neither cpu_dai_name nor cpu_name/of_node are set for %s\n",
3b09bb82 3558 link->name);
5a504963
SW
3559 return -EINVAL;
3560 }
3561 }
3562
ed77cc12
MB
3563 dev_set_drvdata(card->dev, card);
3564
111c6419
SW
3565 snd_soc_initialize_card_lists(card);
3566
150dd2f8
VK
3567 soc_init_card_debugfs(card);
3568
181a6892
MB
3569 card->rtd = devm_kzalloc(card->dev,
3570 sizeof(struct snd_soc_pcm_runtime) *
3571 (card->num_links + card->num_aux_devs),
3572 GFP_KERNEL);
f0fba2ad
LG
3573 if (card->rtd == NULL)
3574 return -ENOMEM;
a7dbb603 3575 card->num_rtd = 0;
2eea392d 3576 card->rtd_aux = &card->rtd[card->num_links];
f0fba2ad
LG
3577
3578 for (i = 0; i < card->num_links; i++)
3579 card->rtd[i].dai_link = &card->dai_link[i];
3580
c5af3a2e 3581 INIT_LIST_HEAD(&card->list);
db432b41 3582 INIT_LIST_HEAD(&card->dapm_dirty);
c5af3a2e 3583 card->instantiated = 0;
f0fba2ad 3584 mutex_init(&card->mutex);
a73fb2df 3585 mutex_init(&card->dapm_mutex);
c5af3a2e 3586
b19e6e7b
MB
3587 ret = snd_soc_instantiate_card(card);
3588 if (ret != 0)
3589 soc_cleanup_card_debugfs(card);
c5af3a2e 3590
b19e6e7b 3591 return ret;
c5af3a2e 3592}
70a7ca34 3593EXPORT_SYMBOL_GPL(snd_soc_register_card);
c5af3a2e
MB
3594
3595/**
3596 * snd_soc_unregister_card - Unregister a card with the ASoC core
3597 *
ac11a2b3 3598 * @card: Card to unregister
c5af3a2e 3599 *
c5af3a2e 3600 */
70a7ca34 3601int snd_soc_unregister_card(struct snd_soc_card *card)
c5af3a2e 3602{
b0e26485
VK
3603 if (card->instantiated)
3604 soc_cleanup_card_resources(card);
c5af3a2e
MB
3605 dev_dbg(card->dev, "Unregistered card '%s'\n", card->name);
3606
3607 return 0;
3608}
70a7ca34 3609EXPORT_SYMBOL_GPL(snd_soc_unregister_card);
c5af3a2e 3610
f0fba2ad
LG
3611/*
3612 * Simplify DAI link configuration by removing ".-1" from device names
3613 * and sanitizing names.
3614 */
0b9a214a 3615static char *fmt_single_name(struct device *dev, int *id)
f0fba2ad
LG
3616{
3617 char *found, name[NAME_SIZE];
3618 int id1, id2;
3619
3620 if (dev_name(dev) == NULL)
3621 return NULL;
3622
58818a77 3623 strlcpy(name, dev_name(dev), NAME_SIZE);
f0fba2ad
LG
3624
3625 /* are we a "%s.%d" name (platform and SPI components) */
3626 found = strstr(name, dev->driver->name);
3627 if (found) {
3628 /* get ID */
3629 if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) {
3630
3631 /* discard ID from name if ID == -1 */
3632 if (*id == -1)
3633 found[strlen(dev->driver->name)] = '\0';
3634 }
3635
3636 } else {
3637 /* I2C component devices are named "bus-addr" */
3638 if (sscanf(name, "%x-%x", &id1, &id2) == 2) {
3639 char tmp[NAME_SIZE];
3640
3641 /* create unique ID number from I2C addr and bus */
05899446 3642 *id = ((id1 & 0xffff) << 16) + id2;
f0fba2ad
LG
3643
3644 /* sanitize component name for DAI link creation */
3645 snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name);
58818a77 3646 strlcpy(name, tmp, NAME_SIZE);
f0fba2ad
LG
3647 } else
3648 *id = 0;
3649 }
3650
3651 return kstrdup(name, GFP_KERNEL);
3652}
3653
3654/*
3655 * Simplify DAI link naming for single devices with multiple DAIs by removing
3656 * any ".-1" and using the DAI name (instead of device name).
3657 */
3658static inline char *fmt_multiple_name(struct device *dev,
3659 struct snd_soc_dai_driver *dai_drv)
3660{
3661 if (dai_drv->name == NULL) {
0837fc62 3662 pr_err("asoc: error - multiple DAI %s registered with no name\n",
f0fba2ad
LG
3663 dev_name(dev));
3664 return NULL;
3665 }
3666
3667 return kstrdup(dai_drv->name, GFP_KERNEL);
3668}
3669
9115171a
MB
3670/**
3671 * snd_soc_register_dai - Register a DAI with the ASoC core
3672 *
ac11a2b3 3673 * @dai: DAI to register
9115171a 3674 */
f0fba2ad
LG
3675int snd_soc_register_dai(struct device *dev,
3676 struct snd_soc_dai_driver *dai_drv)
9115171a 3677{
054880fe 3678 struct snd_soc_codec *codec;
f0fba2ad
LG
3679 struct snd_soc_dai *dai;
3680
3681 dev_dbg(dev, "dai register %s\n", dev_name(dev));
9115171a 3682
f0fba2ad
LG
3683 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
3684 if (dai == NULL)
a7393623 3685 return -ENOMEM;
9115171a 3686
f0fba2ad
LG
3687 /* create DAI component name */
3688 dai->name = fmt_single_name(dev, &dai->id);
3689 if (dai->name == NULL) {
3690 kfree(dai);
3691 return -ENOMEM;
3692 }
6335d055 3693
f0fba2ad
LG
3694 dai->dev = dev;
3695 dai->driver = dai_drv;
be09ad90 3696 dai->dapm.dev = dev;
f0fba2ad
LG
3697 if (!dai->driver->ops)
3698 dai->driver->ops = &null_dai_ops;
9115171a
MB
3699
3700 mutex_lock(&client_mutex);
054880fe
MB
3701
3702 list_for_each_entry(codec, &codec_list, list) {
3703 if (codec->dev == dev) {
3704 dev_dbg(dev, "Mapped DAI %s to CODEC %s\n",
3705 dai->name, codec->name);
3706 dai->codec = codec;
3707 break;
3708 }
3709 }
3710
5f800080
PU
3711 if (!dai->codec)
3712 dai->dapm.idle_bias_off = 1;
3713
9115171a 3714 list_add(&dai->list, &dai_list);
054880fe 3715
9115171a
MB
3716 mutex_unlock(&client_mutex);
3717
3718 pr_debug("Registered DAI '%s'\n", dai->name);
3719
3720 return 0;
3721}
3722EXPORT_SYMBOL_GPL(snd_soc_register_dai);
3723
3724/**
3725 * snd_soc_unregister_dai - Unregister a DAI from the ASoC core
3726 *
ac11a2b3 3727 * @dai: DAI to unregister
9115171a 3728 */
f0fba2ad 3729void snd_soc_unregister_dai(struct device *dev)
9115171a 3730{
f0fba2ad
LG
3731 struct snd_soc_dai *dai;
3732
3733 list_for_each_entry(dai, &dai_list, list) {
3734 if (dev == dai->dev)
3735 goto found;
3736 }
3737 return;
3738
3739found:
9115171a
MB
3740 mutex_lock(&client_mutex);
3741 list_del(&dai->list);
3742 mutex_unlock(&client_mutex);
3743
3744 pr_debug("Unregistered DAI '%s'\n", dai->name);
f0fba2ad
LG
3745 kfree(dai->name);
3746 kfree(dai);
9115171a
MB
3747}
3748EXPORT_SYMBOL_GPL(snd_soc_unregister_dai);
3749
3750/**
3751 * snd_soc_register_dais - Register multiple DAIs with the ASoC core
3752 *
ac11a2b3
MB
3753 * @dai: Array of DAIs to register
3754 * @count: Number of DAIs
9115171a 3755 */
f0fba2ad
LG
3756int snd_soc_register_dais(struct device *dev,
3757 struct snd_soc_dai_driver *dai_drv, size_t count)
9115171a 3758{
054880fe 3759 struct snd_soc_codec *codec;
f0fba2ad
LG
3760 struct snd_soc_dai *dai;
3761 int i, ret = 0;
3762
720ffa4c 3763 dev_dbg(dev, "dai register %s #%Zu\n", dev_name(dev), count);
9115171a
MB
3764
3765 for (i = 0; i < count; i++) {
f0fba2ad
LG
3766
3767 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
c46e0079
AL
3768 if (dai == NULL) {
3769 ret = -ENOMEM;
3770 goto err;
3771 }
f0fba2ad
LG
3772
3773 /* create DAI component name */
3774 dai->name = fmt_multiple_name(dev, &dai_drv[i]);
3775 if (dai->name == NULL) {
3776 kfree(dai);
3777 ret = -EINVAL;
9115171a 3778 goto err;
f0fba2ad
LG
3779 }
3780
3781 dai->dev = dev;
f0fba2ad 3782 dai->driver = &dai_drv[i];
0f9141c9
MB
3783 if (dai->driver->id)
3784 dai->id = dai->driver->id;
3785 else
3786 dai->id = i;
be09ad90 3787 dai->dapm.dev = dev;
f0fba2ad
LG
3788 if (!dai->driver->ops)
3789 dai->driver->ops = &null_dai_ops;
3790
3791 mutex_lock(&client_mutex);
054880fe
MB
3792
3793 list_for_each_entry(codec, &codec_list, list) {
3794 if (codec->dev == dev) {
3795 dev_dbg(dev, "Mapped DAI %s to CODEC %s\n",
3796 dai->name, codec->name);
3797 dai->codec = codec;
3798 break;
3799 }
3800 }
3801
5f800080
PU
3802 if (!dai->codec)
3803 dai->dapm.idle_bias_off = 1;
3804
f0fba2ad 3805 list_add(&dai->list, &dai_list);
054880fe 3806
f0fba2ad
LG
3807 mutex_unlock(&client_mutex);
3808
3809 pr_debug("Registered DAI '%s'\n", dai->name);
9115171a
MB
3810 }
3811
3812 return 0;
3813
3814err:
3815 for (i--; i >= 0; i--)
f0fba2ad 3816 snd_soc_unregister_dai(dev);
9115171a
MB
3817
3818 return ret;
3819}
3820EXPORT_SYMBOL_GPL(snd_soc_register_dais);
3821
3822/**
3823 * snd_soc_unregister_dais - Unregister multiple DAIs from the ASoC core
3824 *
ac11a2b3
MB
3825 * @dai: Array of DAIs to unregister
3826 * @count: Number of DAIs
9115171a 3827 */
f0fba2ad 3828void snd_soc_unregister_dais(struct device *dev, size_t count)
9115171a
MB
3829{
3830 int i;
3831
3832 for (i = 0; i < count; i++)
f0fba2ad 3833 snd_soc_unregister_dai(dev);
9115171a
MB
3834}
3835EXPORT_SYMBOL_GPL(snd_soc_unregister_dais);
3836
12a48a8c
MB
3837/**
3838 * snd_soc_register_platform - Register a platform with the ASoC core
3839 *
ac11a2b3 3840 * @platform: platform to register
12a48a8c 3841 */
f0fba2ad
LG
3842int snd_soc_register_platform(struct device *dev,
3843 struct snd_soc_platform_driver *platform_drv)
12a48a8c 3844{
f0fba2ad
LG
3845 struct snd_soc_platform *platform;
3846
3847 dev_dbg(dev, "platform register %s\n", dev_name(dev));
3848
3849 platform = kzalloc(sizeof(struct snd_soc_platform), GFP_KERNEL);
3850 if (platform == NULL)
a7393623 3851 return -ENOMEM;
f0fba2ad
LG
3852
3853 /* create platform component name */
3854 platform->name = fmt_single_name(dev, &platform->id);
3855 if (platform->name == NULL) {
3856 kfree(platform);
3857 return -ENOMEM;
3858 }
12a48a8c 3859
f0fba2ad
LG
3860 platform->dev = dev;
3861 platform->driver = platform_drv;
b7950641
LG
3862 platform->dapm.dev = dev;
3863 platform->dapm.platform = platform;
64a648c2 3864 platform->dapm.stream_event = platform_drv->stream_event;
cc22d37e 3865 mutex_init(&platform->mutex);
12a48a8c
MB
3866
3867 mutex_lock(&client_mutex);
3868 list_add(&platform->list, &platform_list);
3869 mutex_unlock(&client_mutex);
3870
3871 pr_debug("Registered platform '%s'\n", platform->name);
3872
3873 return 0;
3874}
3875EXPORT_SYMBOL_GPL(snd_soc_register_platform);
3876
3877/**
3878 * snd_soc_unregister_platform - Unregister a platform from the ASoC core
3879 *
ac11a2b3 3880 * @platform: platform to unregister
12a48a8c 3881 */
f0fba2ad 3882void snd_soc_unregister_platform(struct device *dev)
12a48a8c 3883{
f0fba2ad
LG
3884 struct snd_soc_platform *platform;
3885
3886 list_for_each_entry(platform, &platform_list, list) {
3887 if (dev == platform->dev)
3888 goto found;
3889 }
3890 return;
3891
3892found:
12a48a8c
MB
3893 mutex_lock(&client_mutex);
3894 list_del(&platform->list);
3895 mutex_unlock(&client_mutex);
3896
3897 pr_debug("Unregistered platform '%s'\n", platform->name);
f0fba2ad
LG
3898 kfree(platform->name);
3899 kfree(platform);
12a48a8c
MB
3900}
3901EXPORT_SYMBOL_GPL(snd_soc_unregister_platform);
3902
151ab22c
MB
3903static u64 codec_format_map[] = {
3904 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE,
3905 SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE,
3906 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_BE,
3907 SNDRV_PCM_FMTBIT_U24_LE | SNDRV_PCM_FMTBIT_U24_BE,
3908 SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE,
3909 SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE,
3910 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
3911 SNDRV_PCM_FMTBIT_U24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
3912 SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S20_3BE,
3913 SNDRV_PCM_FMTBIT_U20_3LE | SNDRV_PCM_FMTBIT_U20_3BE,
3914 SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S18_3BE,
3915 SNDRV_PCM_FMTBIT_U18_3LE | SNDRV_PCM_FMTBIT_U18_3BE,
3916 SNDRV_PCM_FMTBIT_FLOAT_LE | SNDRV_PCM_FMTBIT_FLOAT_BE,
3917 SNDRV_PCM_FMTBIT_FLOAT64_LE | SNDRV_PCM_FMTBIT_FLOAT64_BE,
3918 SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE
3919 | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE,
3920};
3921
3922/* Fix up the DAI formats for endianness: codecs don't actually see
3923 * the endianness of the data but we're using the CPU format
3924 * definitions which do need to include endianness so we ensure that
3925 * codec DAIs always have both big and little endian variants set.
3926 */
3927static void fixup_codec_formats(struct snd_soc_pcm_stream *stream)
3928{
3929 int i;
3930
3931 for (i = 0; i < ARRAY_SIZE(codec_format_map); i++)
3932 if (stream->formats & codec_format_map[i])
3933 stream->formats |= codec_format_map[i];
3934}
3935
0d0cf00a
MB
3936/**
3937 * snd_soc_register_codec - Register a codec with the ASoC core
3938 *
ac11a2b3 3939 * @codec: codec to register
0d0cf00a 3940 */
f0fba2ad 3941int snd_soc_register_codec(struct device *dev,
001ae4c0
MB
3942 const struct snd_soc_codec_driver *codec_drv,
3943 struct snd_soc_dai_driver *dai_drv,
3944 int num_dai)
0d0cf00a 3945{
3335ddca 3946 size_t reg_size;
f0fba2ad
LG
3947 struct snd_soc_codec *codec;
3948 int ret, i;
151ab22c 3949
f0fba2ad
LG
3950 dev_dbg(dev, "codec register %s\n", dev_name(dev));
3951
3952 codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
3953 if (codec == NULL)
3954 return -ENOMEM;
0d0cf00a 3955
f0fba2ad
LG
3956 /* create CODEC component name */
3957 codec->name = fmt_single_name(dev, &codec->id);
3958 if (codec->name == NULL) {
3959 kfree(codec);
3960 return -ENOMEM;
3961 }
3962
23bbce34
DP
3963 if (codec_drv->compress_type)
3964 codec->compress_type = codec_drv->compress_type;
3965 else
3966 codec->compress_type = SND_SOC_FLAT_COMPRESSION;
3967
c3acec26
MB
3968 codec->write = codec_drv->write;
3969 codec->read = codec_drv->read;
1500b7b5
DP
3970 codec->volatile_register = codec_drv->volatile_register;
3971 codec->readable_register = codec_drv->readable_register;
8020454c 3972 codec->writable_register = codec_drv->writable_register;
5124e69e 3973 codec->ignore_pmdown_time = codec_drv->ignore_pmdown_time;
ce6120cc
LG
3974 codec->dapm.bias_level = SND_SOC_BIAS_OFF;
3975 codec->dapm.dev = dev;
3976 codec->dapm.codec = codec;
474b62d6 3977 codec->dapm.seq_notifier = codec_drv->seq_notifier;
64a648c2 3978 codec->dapm.stream_event = codec_drv->stream_event;
7a30a3db
DP
3979 codec->dev = dev;
3980 codec->driver = codec_drv;
3981 codec->num_dai = num_dai;
3982 mutex_init(&codec->mutex);
ce6120cc 3983
f0fba2ad
LG
3984 /* allocate CODEC register cache */
3985 if (codec_drv->reg_cache_size && codec_drv->reg_word_size) {
3335ddca 3986 reg_size = codec_drv->reg_cache_size * codec_drv->reg_word_size;
aea170a0 3987 codec->reg_size = reg_size;
3335ddca
DP
3988 /* it is necessary to make a copy of the default register cache
3989 * because in the case of using a compression type that requires
3990 * the default register cache to be marked as __devinitconst the
3991 * kernel might have freed the array by the time we initialize
3992 * the cache.
3993 */
2aa86323
DP
3994 if (codec_drv->reg_cache_default) {
3995 codec->reg_def_copy = kmemdup(codec_drv->reg_cache_default,
3996 reg_size, GFP_KERNEL);
3997 if (!codec->reg_def_copy) {
3998 ret = -ENOMEM;
3999 goto fail;
4000 }
f0fba2ad 4001 }
151ab22c
MB
4002 }
4003
1500b7b5
DP
4004 if (codec_drv->reg_access_size && codec_drv->reg_access_default) {
4005 if (!codec->volatile_register)
4006 codec->volatile_register = snd_soc_default_volatile_register;
4007 if (!codec->readable_register)
4008 codec->readable_register = snd_soc_default_readable_register;
8020454c
DP
4009 if (!codec->writable_register)
4010 codec->writable_register = snd_soc_default_writable_register;
1500b7b5
DP
4011 }
4012
f0fba2ad
LG
4013 for (i = 0; i < num_dai; i++) {
4014 fixup_codec_formats(&dai_drv[i].playback);
4015 fixup_codec_formats(&dai_drv[i].capture);
4016 }
4017
054880fe
MB
4018 mutex_lock(&client_mutex);
4019 list_add(&codec->list, &codec_list);
4020 mutex_unlock(&client_mutex);
4021
26b01ccd
MB
4022 /* register any DAIs */
4023 if (num_dai) {
4024 ret = snd_soc_register_dais(dev, dai_drv, num_dai);
4025 if (ret < 0)
054880fe
MB
4026 dev_err(codec->dev, "Failed to regster DAIs: %d\n",
4027 ret);
26b01ccd 4028 }
f0fba2ad 4029
0d0cf00a 4030 pr_debug("Registered codec '%s'\n", codec->name);
0d0cf00a 4031 return 0;
f0fba2ad 4032
fdf0f54d 4033fail:
3335ddca
DP
4034 kfree(codec->reg_def_copy);
4035 codec->reg_def_copy = NULL;
f0fba2ad
LG
4036 kfree(codec->name);
4037 kfree(codec);
4038 return ret;
0d0cf00a
MB
4039}
4040EXPORT_SYMBOL_GPL(snd_soc_register_codec);
4041
4042/**
4043 * snd_soc_unregister_codec - Unregister a codec from the ASoC core
4044 *
ac11a2b3 4045 * @codec: codec to unregister
0d0cf00a 4046 */
f0fba2ad 4047void snd_soc_unregister_codec(struct device *dev)
0d0cf00a 4048{
f0fba2ad
LG
4049 struct snd_soc_codec *codec;
4050 int i;
4051
4052 list_for_each_entry(codec, &codec_list, list) {
4053 if (dev == codec->dev)
4054 goto found;
4055 }
4056 return;
4057
4058found:
26b01ccd
MB
4059 if (codec->num_dai)
4060 for (i = 0; i < codec->num_dai; i++)
4061 snd_soc_unregister_dai(dev);
f0fba2ad 4062
0d0cf00a
MB
4063 mutex_lock(&client_mutex);
4064 list_del(&codec->list);
4065 mutex_unlock(&client_mutex);
4066
4067 pr_debug("Unregistered codec '%s'\n", codec->name);
f0fba2ad 4068
7a30a3db 4069 snd_soc_cache_exit(codec);
3335ddca 4070 kfree(codec->reg_def_copy);
1aafcd4d 4071 kfree(codec->name);
f0fba2ad 4072 kfree(codec);
0d0cf00a
MB
4073}
4074EXPORT_SYMBOL_GPL(snd_soc_unregister_codec);
4075
bec4fa05
SW
4076/* Retrieve a card's name from device tree */
4077int snd_soc_of_parse_card_name(struct snd_soc_card *card,
4078 const char *propname)
4079{
4080 struct device_node *np = card->dev->of_node;
4081 int ret;
4082
4083 ret = of_property_read_string_index(np, propname, 0, &card->name);
4084 /*
4085 * EINVAL means the property does not exist. This is fine providing
4086 * card->name was previously set, which is checked later in
4087 * snd_soc_register_card.
4088 */
4089 if (ret < 0 && ret != -EINVAL) {
4090 dev_err(card->dev,
4091 "Property '%s' could not be read: %d\n",
4092 propname, ret);
4093 return ret;
4094 }
4095
4096 return 0;
4097}
4098EXPORT_SYMBOL_GPL(snd_soc_of_parse_card_name);
4099
a4a54dd5
SW
4100int snd_soc_of_parse_audio_routing(struct snd_soc_card *card,
4101 const char *propname)
4102{
4103 struct device_node *np = card->dev->of_node;
4104 int num_routes;
4105 struct snd_soc_dapm_route *routes;
4106 int i, ret;
4107
4108 num_routes = of_property_count_strings(np, propname);
c34ce320 4109 if (num_routes < 0 || num_routes & 1) {
a4a54dd5 4110 dev_err(card->dev,
c34ce320
RZ
4111 "Property '%s' does not exist or its length is not even\n",
4112 propname);
a4a54dd5
SW
4113 return -EINVAL;
4114 }
4115 num_routes /= 2;
4116 if (!num_routes) {
4117 dev_err(card->dev,
4118 "Property '%s's length is zero\n",
4119 propname);
4120 return -EINVAL;
4121 }
4122
4123 routes = devm_kzalloc(card->dev, num_routes * sizeof(*routes),
4124 GFP_KERNEL);
4125 if (!routes) {
4126 dev_err(card->dev,
4127 "Could not allocate DAPM route table\n");
4128 return -EINVAL;
4129 }
4130
4131 for (i = 0; i < num_routes; i++) {
4132 ret = of_property_read_string_index(np, propname,
4133 2 * i, &routes[i].sink);
4134 if (ret) {
4135 dev_err(card->dev,
4136 "Property '%s' index %d could not be read: %d\n",
4137 propname, 2 * i, ret);
b761c0ca 4138 kfree(routes);
a4a54dd5
SW
4139 return -EINVAL;
4140 }
4141 ret = of_property_read_string_index(np, propname,
4142 (2 * i) + 1, &routes[i].source);
4143 if (ret) {
4144 dev_err(card->dev,
4145 "Property '%s' index %d could not be read: %d\n",
4146 propname, (2 * i) + 1, ret);
b761c0ca 4147 kfree(routes);
a4a54dd5
SW
4148 return -EINVAL;
4149 }
4150 }
4151
4152 card->num_dapm_routes = num_routes;
4153 card->dapm_routes = routes;
4154
4155 return 0;
4156}
4157EXPORT_SYMBOL_GPL(snd_soc_of_parse_audio_routing);
4158
c9b3a40f 4159static int __init snd_soc_init(void)
db2a4165 4160{
384c89e2 4161#ifdef CONFIG_DEBUG_FS
8a9dab1a
MB
4162 snd_soc_debugfs_root = debugfs_create_dir("asoc", NULL);
4163 if (IS_ERR(snd_soc_debugfs_root) || !snd_soc_debugfs_root) {
0837fc62 4164 pr_warn("ASoC: Failed to create debugfs directory\n");
8a9dab1a 4165 snd_soc_debugfs_root = NULL;
384c89e2 4166 }
c3c5a19a 4167
8a9dab1a 4168 if (!debugfs_create_file("codecs", 0444, snd_soc_debugfs_root, NULL,
c3c5a19a
MB
4169 &codec_list_fops))
4170 pr_warn("ASoC: Failed to create CODEC list debugfs file\n");
4171
8a9dab1a 4172 if (!debugfs_create_file("dais", 0444, snd_soc_debugfs_root, NULL,
f3208780
MB
4173 &dai_list_fops))
4174 pr_warn("ASoC: Failed to create DAI list debugfs file\n");
19c7ac27 4175
8a9dab1a 4176 if (!debugfs_create_file("platforms", 0444, snd_soc_debugfs_root, NULL,
19c7ac27
MB
4177 &platform_list_fops))
4178 pr_warn("ASoC: Failed to create platform list debugfs file\n");
384c89e2
MB
4179#endif
4180
fb257897
MB
4181 snd_soc_util_init();
4182
db2a4165
FM
4183 return platform_driver_register(&soc_driver);
4184}
4abe8e16 4185module_init(snd_soc_init);
db2a4165 4186
7d8c16a6 4187static void __exit snd_soc_exit(void)
db2a4165 4188{
fb257897
MB
4189 snd_soc_util_exit();
4190
384c89e2 4191#ifdef CONFIG_DEBUG_FS
8a9dab1a 4192 debugfs_remove_recursive(snd_soc_debugfs_root);
384c89e2 4193#endif
3ff3f64b 4194 platform_driver_unregister(&soc_driver);
db2a4165 4195}
db2a4165
FM
4196module_exit(snd_soc_exit);
4197
4198/* Module information */
d331124d 4199MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
db2a4165
FM
4200MODULE_DESCRIPTION("ALSA SoC Core");
4201MODULE_LICENSE("GPL");
8b45a209 4202MODULE_ALIAS("platform:soc-audio");