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