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