ASoC: fix wm8958-dsp2 printk format warnings
[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];
245 int buf_size;
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
LG
1928 snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname),
1929 "%s", card->name);
1930 snprintf(card->snd_card->longname, sizeof(card->snd_card->longname),
1931 "%s", card->name);
1932
28e9ad92
MB
1933 if (card->late_probe) {
1934 ret = card->late_probe(card);
1935 if (ret < 0) {
1936 dev_err(card->dev, "%s late_probe() failed: %d\n",
1937 card->name, ret);
1938 goto probe_aux_dev_err;
1939 }
1940 }
1941
f0fba2ad
LG
1942 ret = snd_card_register(card->snd_card);
1943 if (ret < 0) {
1944 printk(KERN_ERR "asoc: failed to register soundcard for %s\n", card->name);
6b3ed785 1945 goto probe_aux_dev_err;
db2a4165
FM
1946 }
1947
f0fba2ad
LG
1948#ifdef CONFIG_SND_SOC_AC97_BUS
1949 /* register any AC97 codecs */
1950 for (i = 0; i < card->num_rtd; i++) {
6b3ed785
AL
1951 ret = soc_register_ac97_dai_link(&card->rtd[i]);
1952 if (ret < 0) {
1953 printk(KERN_ERR "asoc: failed to register AC97 %s\n", card->name);
1954 while (--i >= 0)
7d8316df 1955 soc_unregister_ac97_dai_link(card->rtd[i].codec);
6b3ed785 1956 goto probe_aux_dev_err;
f0fba2ad 1957 }
6b3ed785 1958 }
f0fba2ad
LG
1959#endif
1960
1961 card->instantiated = 1;
1962 mutex_unlock(&card->mutex);
1963 return;
1964
2eea392d
JN
1965probe_aux_dev_err:
1966 for (i = 0; i < card->num_aux_devs; i++)
1967 soc_remove_aux_dev(card, i);
1968
f0fba2ad 1969probe_dai_err:
0671fd8e 1970 soc_remove_dai_links(card);
f0fba2ad
LG
1971
1972card_probe_error:
87506549 1973 if (card->remove)
e7361ec4 1974 card->remove(card);
f0fba2ad
LG
1975
1976 snd_card_free(card->snd_card);
1977
1978 mutex_unlock(&card->mutex);
435c5e25 1979}
db2a4165 1980
435c5e25 1981/*
421f91d2 1982 * Attempt to initialise any uninitialised cards. Must be called with
435c5e25
MB
1983 * client_mutex.
1984 */
1985static void snd_soc_instantiate_cards(void)
1986{
1987 struct snd_soc_card *card;
1988 list_for_each_entry(card, &card_list, list)
1989 snd_soc_instantiate_card(card);
1990}
1991
1992/* probes a new socdev */
1993static int soc_probe(struct platform_device *pdev)
1994{
f0fba2ad 1995 struct snd_soc_card *card = platform_get_drvdata(pdev);
435c5e25 1996 int ret = 0;
435c5e25 1997
70a7ca34
VK
1998 /*
1999 * no card, so machine driver should be registering card
2000 * we should not be here in that case so ret error
2001 */
2002 if (!card)
2003 return -EINVAL;
2004
435c5e25
MB
2005 /* Bodge while we unpick instantiation */
2006 card->dev = &pdev->dev;
f0fba2ad 2007
435c5e25
MB
2008 ret = snd_soc_register_card(card);
2009 if (ret != 0) {
2010 dev_err(&pdev->dev, "Failed to register card\n");
2011 return ret;
2012 }
2013
2014 return 0;
db2a4165
FM
2015}
2016
b0e26485 2017static int soc_cleanup_card_resources(struct snd_soc_card *card)
db2a4165
FM
2018{
2019 int i;
db2a4165 2020
b0e26485
VK
2021 /* make sure any delayed work runs */
2022 for (i = 0; i < card->num_rtd; i++) {
2023 struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
2024 flush_delayed_work_sync(&rtd->delayed_work);
2025 }
914dc182 2026
b0e26485
VK
2027 /* remove auxiliary devices */
2028 for (i = 0; i < card->num_aux_devs; i++)
2029 soc_remove_aux_dev(card, i);
db2a4165 2030
b0e26485 2031 /* remove and free each DAI */
0671fd8e 2032 soc_remove_dai_links(card);
2eea392d 2033
b0e26485 2034 soc_cleanup_card_debugfs(card);
f0fba2ad 2035
b0e26485
VK
2036 /* remove the card */
2037 if (card->remove)
e7361ec4 2038 card->remove(card);
a6052154 2039
0aaae527
LPC
2040 snd_soc_dapm_free(&card->dapm);
2041
b0e26485
VK
2042 kfree(card->rtd);
2043 snd_card_free(card->snd_card);
2044 return 0;
2045
2046}
2047
2048/* removes a socdev */
2049static int soc_remove(struct platform_device *pdev)
2050{
2051 struct snd_soc_card *card = platform_get_drvdata(pdev);
db2a4165 2052
c5af3a2e 2053 snd_soc_unregister_card(card);
db2a4165
FM
2054 return 0;
2055}
2056
6f8ab4ac 2057int snd_soc_poweroff(struct device *dev)
51737470 2058{
6f8ab4ac 2059 struct snd_soc_card *card = dev_get_drvdata(dev);
f0fba2ad 2060 int i;
51737470
MB
2061
2062 if (!card->instantiated)
416356fc 2063 return 0;
51737470
MB
2064
2065 /* Flush out pmdown_time work - we actually do want to run it
2066 * now, we're shutting down so no imminent restart. */
f0fba2ad
LG
2067 for (i = 0; i < card->num_rtd; i++) {
2068 struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
5b84ba26 2069 flush_delayed_work_sync(&rtd->delayed_work);
f0fba2ad 2070 }
51737470 2071
f0fba2ad 2072 snd_soc_dapm_shutdown(card);
416356fc
MB
2073
2074 return 0;
51737470 2075}
6f8ab4ac 2076EXPORT_SYMBOL_GPL(snd_soc_poweroff);
51737470 2077
6f8ab4ac
MB
2078const struct dev_pm_ops snd_soc_pm_ops = {
2079 .suspend = snd_soc_suspend,
2080 .resume = snd_soc_resume,
2081 .poweroff = snd_soc_poweroff,
416356fc 2082};
deb2607e 2083EXPORT_SYMBOL_GPL(snd_soc_pm_ops);
416356fc 2084
db2a4165
FM
2085/* ASoC platform driver */
2086static struct platform_driver soc_driver = {
2087 .driver = {
2088 .name = "soc-audio",
8b45a209 2089 .owner = THIS_MODULE,
6f8ab4ac 2090 .pm = &snd_soc_pm_ops,
db2a4165
FM
2091 },
2092 .probe = soc_probe,
2093 .remove = soc_remove,
db2a4165
FM
2094};
2095
2096/* create a new pcm */
f0fba2ad
LG
2097static int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num)
2098{
2099 struct snd_soc_codec *codec = rtd->codec;
2100 struct snd_soc_platform *platform = rtd->platform;
2101 struct snd_soc_dai *codec_dai = rtd->codec_dai;
2102 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
db2a4165
FM
2103 struct snd_pcm *pcm;
2104 char new_name[64];
2105 int ret = 0, playback = 0, capture = 0;
2106
db2a4165 2107 /* check client and interface hw capabilities */
40ca1142 2108 snprintf(new_name, sizeof(new_name), "%s %s-%d",
f0fba2ad 2109 rtd->dai_link->stream_name, codec_dai->name, num);
db2a4165 2110
f0fba2ad 2111 if (codec_dai->driver->playback.channels_min)
db2a4165 2112 playback = 1;
f0fba2ad 2113 if (codec_dai->driver->capture.channels_min)
db2a4165
FM
2114 capture = 1;
2115
f0fba2ad
LG
2116 dev_dbg(rtd->card->dev, "registered pcm #%d %s\n",num,new_name);
2117 ret = snd_pcm_new(rtd->card->snd_card, new_name,
2118 num, playback, capture, &pcm);
db2a4165 2119 if (ret < 0) {
f0fba2ad 2120 printk(KERN_ERR "asoc: can't create pcm for codec %s\n", codec->name);
db2a4165
FM
2121 return ret;
2122 }
2123
f0fba2ad 2124 rtd->pcm = pcm;
db2a4165 2125 pcm->private_data = rtd;
8842c72a
MB
2126 if (platform->driver->ops) {
2127 soc_pcm_ops.mmap = platform->driver->ops->mmap;
2128 soc_pcm_ops.pointer = platform->driver->ops->pointer;
2129 soc_pcm_ops.ioctl = platform->driver->ops->ioctl;
2130 soc_pcm_ops.copy = platform->driver->ops->copy;
2131 soc_pcm_ops.silence = platform->driver->ops->silence;
2132 soc_pcm_ops.ack = platform->driver->ops->ack;
2133 soc_pcm_ops.page = platform->driver->ops->page;
2134 }
db2a4165
FM
2135
2136 if (playback)
2137 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &soc_pcm_ops);
2138
2139 if (capture)
2140 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &soc_pcm_ops);
2141
8842c72a
MB
2142 if (platform->driver->pcm_new) {
2143 ret = platform->driver->pcm_new(rtd->card->snd_card,
2144 codec_dai, pcm);
2145 if (ret < 0) {
2146 pr_err("asoc: platform pcm constructor failed\n");
2147 return ret;
2148 }
db2a4165
FM
2149 }
2150
f0fba2ad 2151 pcm->private_free = platform->driver->pcm_free;
db2a4165
FM
2152 printk(KERN_INFO "asoc: %s <-> %s mapping ok\n", codec_dai->name,
2153 cpu_dai->name);
2154 return ret;
2155}
2156
096e49d5
MB
2157/**
2158 * snd_soc_codec_volatile_register: Report if a register is volatile.
2159 *
2160 * @codec: CODEC to query.
2161 * @reg: Register to query.
2162 *
2163 * Boolean function indiciating if a CODEC register is volatile.
2164 */
181e055e
MB
2165int snd_soc_codec_volatile_register(struct snd_soc_codec *codec,
2166 unsigned int reg)
096e49d5 2167{
1500b7b5
DP
2168 if (codec->volatile_register)
2169 return codec->volatile_register(codec, reg);
096e49d5
MB
2170 else
2171 return 0;
2172}
2173EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register);
2174
239c9706
DP
2175/**
2176 * snd_soc_codec_readable_register: Report if a register is readable.
2177 *
2178 * @codec: CODEC to query.
2179 * @reg: Register to query.
2180 *
2181 * Boolean function indicating if a CODEC register is readable.
2182 */
2183int snd_soc_codec_readable_register(struct snd_soc_codec *codec,
2184 unsigned int reg)
2185{
2186 if (codec->readable_register)
2187 return codec->readable_register(codec, reg);
2188 else
2189 return 0;
2190}
2191EXPORT_SYMBOL_GPL(snd_soc_codec_readable_register);
2192
2193/**
2194 * snd_soc_codec_writable_register: Report if a register is writable.
2195 *
2196 * @codec: CODEC to query.
2197 * @reg: Register to query.
2198 *
2199 * Boolean function indicating if a CODEC register is writable.
2200 */
2201int snd_soc_codec_writable_register(struct snd_soc_codec *codec,
2202 unsigned int reg)
2203{
2204 if (codec->writable_register)
2205 return codec->writable_register(codec, reg);
2206 else
2207 return 0;
2208}
2209EXPORT_SYMBOL_GPL(snd_soc_codec_writable_register);
2210
db2a4165
FM
2211/**
2212 * snd_soc_new_ac97_codec - initailise AC97 device
2213 * @codec: audio codec
2214 * @ops: AC97 bus operations
2215 * @num: AC97 codec number
2216 *
2217 * Initialises AC97 codec resources for use by ad-hoc devices only.
2218 */
2219int snd_soc_new_ac97_codec(struct snd_soc_codec *codec,
2220 struct snd_ac97_bus_ops *ops, int num)
2221{
2222 mutex_lock(&codec->mutex);
2223
2224 codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL);
2225 if (codec->ac97 == NULL) {
2226 mutex_unlock(&codec->mutex);
2227 return -ENOMEM;
2228 }
2229
2230 codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL);
2231 if (codec->ac97->bus == NULL) {
2232 kfree(codec->ac97);
2233 codec->ac97 = NULL;
2234 mutex_unlock(&codec->mutex);
2235 return -ENOMEM;
2236 }
2237
2238 codec->ac97->bus->ops = ops;
2239 codec->ac97->num = num;
0562f788
MW
2240
2241 /*
2242 * Mark the AC97 device to be created by us. This way we ensure that the
2243 * device will be registered with the device subsystem later on.
2244 */
2245 codec->ac97_created = 1;
2246
db2a4165
FM
2247 mutex_unlock(&codec->mutex);
2248 return 0;
2249}
2250EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec);
2251
2252/**
2253 * snd_soc_free_ac97_codec - free AC97 codec device
2254 * @codec: audio codec
2255 *
2256 * Frees AC97 codec device resources.
2257 */
2258void snd_soc_free_ac97_codec(struct snd_soc_codec *codec)
2259{
2260 mutex_lock(&codec->mutex);
f0fba2ad
LG
2261#ifdef CONFIG_SND_SOC_AC97_BUS
2262 soc_unregister_ac97_dai_link(codec);
2263#endif
db2a4165
FM
2264 kfree(codec->ac97->bus);
2265 kfree(codec->ac97);
2266 codec->ac97 = NULL;
0562f788 2267 codec->ac97_created = 0;
db2a4165
FM
2268 mutex_unlock(&codec->mutex);
2269}
2270EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec);
2271
c3753707
MB
2272unsigned int snd_soc_read(struct snd_soc_codec *codec, unsigned int reg)
2273{
2274 unsigned int ret;
2275
c3acec26 2276 ret = codec->read(codec, reg);
c3753707 2277 dev_dbg(codec->dev, "read %x => %x\n", reg, ret);
a8b1d34f 2278 trace_snd_soc_reg_read(codec, reg, ret);
c3753707
MB
2279
2280 return ret;
2281}
2282EXPORT_SYMBOL_GPL(snd_soc_read);
2283
2284unsigned int snd_soc_write(struct snd_soc_codec *codec,
2285 unsigned int reg, unsigned int val)
2286{
2287 dev_dbg(codec->dev, "write %x = %x\n", reg, val);
a8b1d34f 2288 trace_snd_soc_reg_write(codec, reg, val);
c3acec26 2289 return codec->write(codec, reg, val);
c3753707
MB
2290}
2291EXPORT_SYMBOL_GPL(snd_soc_write);
2292
5fb609d4
DP
2293unsigned int snd_soc_bulk_write_raw(struct snd_soc_codec *codec,
2294 unsigned int reg, const void *data, size_t len)
2295{
2296 return codec->bulk_write_raw(codec, reg, data, len);
2297}
2298EXPORT_SYMBOL_GPL(snd_soc_bulk_write_raw);
2299
db2a4165
FM
2300/**
2301 * snd_soc_update_bits - update codec register bits
2302 * @codec: audio codec
2303 * @reg: codec register
2304 * @mask: register mask
2305 * @value: new value
2306 *
2307 * Writes new register value.
2308 *
180c329d 2309 * Returns 1 for change, 0 for no change, or negative error code.
db2a4165
FM
2310 */
2311int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg,
46f5822f 2312 unsigned int mask, unsigned int value)
db2a4165
FM
2313{
2314 int change;
46f5822f 2315 unsigned int old, new;
180c329d
TT
2316 int ret;
2317
2318 ret = snd_soc_read(codec, reg);
2319 if (ret < 0)
2320 return ret;
db2a4165 2321
180c329d 2322 old = ret;
db2a4165
FM
2323 new = (old & ~mask) | value;
2324 change = old != new;
180c329d
TT
2325 if (change) {
2326 ret = snd_soc_write(codec, reg, new);
2327 if (ret < 0)
2328 return ret;
2329 }
db2a4165 2330
db2a4165
FM
2331 return change;
2332}
2333EXPORT_SYMBOL_GPL(snd_soc_update_bits);
2334
6c508c62
EN
2335/**
2336 * snd_soc_update_bits_locked - update codec register bits
2337 * @codec: audio codec
2338 * @reg: codec register
2339 * @mask: register mask
2340 * @value: new value
2341 *
2342 * Writes new register value, and takes the codec mutex.
2343 *
2344 * Returns 1 for change else 0.
2345 */
dd1b3d53
MB
2346int snd_soc_update_bits_locked(struct snd_soc_codec *codec,
2347 unsigned short reg, unsigned int mask,
2348 unsigned int value)
6c508c62
EN
2349{
2350 int change;
2351
2352 mutex_lock(&codec->mutex);
2353 change = snd_soc_update_bits(codec, reg, mask, value);
2354 mutex_unlock(&codec->mutex);
2355
2356 return change;
2357}
dd1b3d53 2358EXPORT_SYMBOL_GPL(snd_soc_update_bits_locked);
6c508c62 2359
db2a4165
FM
2360/**
2361 * snd_soc_test_bits - test register for change
2362 * @codec: audio codec
2363 * @reg: codec register
2364 * @mask: register mask
2365 * @value: new value
2366 *
2367 * Tests a register with a new value and checks if the new value is
2368 * different from the old value.
2369 *
2370 * Returns 1 for change else 0.
2371 */
2372int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg,
46f5822f 2373 unsigned int mask, unsigned int value)
db2a4165
FM
2374{
2375 int change;
46f5822f 2376 unsigned int old, new;
db2a4165 2377
db2a4165
FM
2378 old = snd_soc_read(codec, reg);
2379 new = (old & ~mask) | value;
2380 change = old != new;
db2a4165
FM
2381
2382 return change;
2383}
2384EXPORT_SYMBOL_GPL(snd_soc_test_bits);
2385
db2a4165
FM
2386/**
2387 * snd_soc_set_runtime_hwparams - set the runtime hardware parameters
2388 * @substream: the pcm substream
2389 * @hw: the hardware parameters
2390 *
2391 * Sets the substream runtime hardware parameters.
2392 */
2393int snd_soc_set_runtime_hwparams(struct snd_pcm_substream *substream,
2394 const struct snd_pcm_hardware *hw)
2395{
2396 struct snd_pcm_runtime *runtime = substream->runtime;
2397 runtime->hw.info = hw->info;
2398 runtime->hw.formats = hw->formats;
2399 runtime->hw.period_bytes_min = hw->period_bytes_min;
2400 runtime->hw.period_bytes_max = hw->period_bytes_max;
2401 runtime->hw.periods_min = hw->periods_min;
2402 runtime->hw.periods_max = hw->periods_max;
2403 runtime->hw.buffer_bytes_max = hw->buffer_bytes_max;
2404 runtime->hw.fifo_size = hw->fifo_size;
2405 return 0;
2406}
2407EXPORT_SYMBOL_GPL(snd_soc_set_runtime_hwparams);
2408
2409/**
2410 * snd_soc_cnew - create new control
2411 * @_template: control template
2412 * @data: control private data
ac11a2b3 2413 * @long_name: control long name
efb7ac3f 2414 * @prefix: control name prefix
db2a4165
FM
2415 *
2416 * Create a new mixer control from a template control.
2417 *
2418 * Returns 0 for success, else error.
2419 */
2420struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
efb7ac3f
MB
2421 void *data, char *long_name,
2422 const char *prefix)
db2a4165
FM
2423{
2424 struct snd_kcontrol_new template;
efb7ac3f
MB
2425 struct snd_kcontrol *kcontrol;
2426 char *name = NULL;
2427 int name_len;
db2a4165
FM
2428
2429 memcpy(&template, _template, sizeof(template));
db2a4165
FM
2430 template.index = 0;
2431
efb7ac3f
MB
2432 if (!long_name)
2433 long_name = template.name;
2434
2435 if (prefix) {
2436 name_len = strlen(long_name) + strlen(prefix) + 2;
2437 name = kmalloc(name_len, GFP_ATOMIC);
2438 if (!name)
2439 return NULL;
2440
2441 snprintf(name, name_len, "%s %s", prefix, long_name);
2442
2443 template.name = name;
2444 } else {
2445 template.name = long_name;
2446 }
2447
2448 kcontrol = snd_ctl_new1(&template, data);
2449
2450 kfree(name);
2451
2452 return kcontrol;
db2a4165
FM
2453}
2454EXPORT_SYMBOL_GPL(snd_soc_cnew);
2455
3e8e1952
IM
2456/**
2457 * snd_soc_add_controls - add an array of controls to a codec.
2458 * Convienience function to add a list of controls. Many codecs were
2459 * duplicating this code.
2460 *
2461 * @codec: codec to add controls to
2462 * @controls: array of controls to add
2463 * @num_controls: number of elements in the array
2464 *
2465 * Return 0 for success, else error.
2466 */
2467int snd_soc_add_controls(struct snd_soc_codec *codec,
2468 const struct snd_kcontrol_new *controls, int num_controls)
2469{
f0fba2ad 2470 struct snd_card *card = codec->card->snd_card;
3e8e1952
IM
2471 int err, i;
2472
2473 for (i = 0; i < num_controls; i++) {
2474 const struct snd_kcontrol_new *control = &controls[i];
efb7ac3f
MB
2475 err = snd_ctl_add(card, snd_soc_cnew(control, codec,
2476 control->name,
2477 codec->name_prefix));
3e8e1952 2478 if (err < 0) {
082100dc 2479 dev_err(codec->dev, "%s: Failed to add %s: %d\n",
efb7ac3f 2480 codec->name, control->name, err);
3e8e1952
IM
2481 return err;
2482 }
2483 }
2484
2485 return 0;
2486}
2487EXPORT_SYMBOL_GPL(snd_soc_add_controls);
2488
db2a4165
FM
2489/**
2490 * snd_soc_info_enum_double - enumerated double mixer info callback
2491 * @kcontrol: mixer control
2492 * @uinfo: control element information
2493 *
2494 * Callback to provide information about a double enumerated
2495 * mixer control.
2496 *
2497 * Returns 0 for success.
2498 */
2499int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol,
2500 struct snd_ctl_elem_info *uinfo)
2501{
2502 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2503
2504 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2505 uinfo->count = e->shift_l == e->shift_r ? 1 : 2;
f8ba0b7b 2506 uinfo->value.enumerated.items = e->max;
db2a4165 2507
f8ba0b7b
JS
2508 if (uinfo->value.enumerated.item > e->max - 1)
2509 uinfo->value.enumerated.item = e->max - 1;
db2a4165
FM
2510 strcpy(uinfo->value.enumerated.name,
2511 e->texts[uinfo->value.enumerated.item]);
2512 return 0;
2513}
2514EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
2515
2516/**
2517 * snd_soc_get_enum_double - enumerated double mixer get callback
2518 * @kcontrol: mixer control
ac11a2b3 2519 * @ucontrol: control element information
db2a4165
FM
2520 *
2521 * Callback to get the value of a double enumerated mixer.
2522 *
2523 * Returns 0 for success.
2524 */
2525int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol,
2526 struct snd_ctl_elem_value *ucontrol)
2527{
2528 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2529 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
46f5822f 2530 unsigned int val, bitmask;
db2a4165 2531
f8ba0b7b 2532 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
db2a4165
FM
2533 ;
2534 val = snd_soc_read(codec, e->reg);
3ff3f64b
MB
2535 ucontrol->value.enumerated.item[0]
2536 = (val >> e->shift_l) & (bitmask - 1);
db2a4165
FM
2537 if (e->shift_l != e->shift_r)
2538 ucontrol->value.enumerated.item[1] =
2539 (val >> e->shift_r) & (bitmask - 1);
2540
2541 return 0;
2542}
2543EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
2544
2545/**
2546 * snd_soc_put_enum_double - enumerated double mixer put callback
2547 * @kcontrol: mixer control
ac11a2b3 2548 * @ucontrol: control element information
db2a4165
FM
2549 *
2550 * Callback to set the value of a double enumerated mixer.
2551 *
2552 * Returns 0 for success.
2553 */
2554int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol,
2555 struct snd_ctl_elem_value *ucontrol)
2556{
2557 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2558 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
46f5822f
DR
2559 unsigned int val;
2560 unsigned int mask, bitmask;
db2a4165 2561
f8ba0b7b 2562 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
db2a4165 2563 ;
f8ba0b7b 2564 if (ucontrol->value.enumerated.item[0] > e->max - 1)
db2a4165
FM
2565 return -EINVAL;
2566 val = ucontrol->value.enumerated.item[0] << e->shift_l;
2567 mask = (bitmask - 1) << e->shift_l;
2568 if (e->shift_l != e->shift_r) {
f8ba0b7b 2569 if (ucontrol->value.enumerated.item[1] > e->max - 1)
db2a4165
FM
2570 return -EINVAL;
2571 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
2572 mask |= (bitmask - 1) << e->shift_r;
2573 }
2574
6c508c62 2575 return snd_soc_update_bits_locked(codec, e->reg, mask, val);
db2a4165
FM
2576}
2577EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
2578
2e72f8e3
PU
2579/**
2580 * snd_soc_get_value_enum_double - semi enumerated double mixer get callback
2581 * @kcontrol: mixer control
2582 * @ucontrol: control element information
2583 *
2584 * Callback to get the value of a double semi enumerated mixer.
2585 *
2586 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2587 * used for handling bitfield coded enumeration for example.
2588 *
2589 * Returns 0 for success.
2590 */
2591int snd_soc_get_value_enum_double(struct snd_kcontrol *kcontrol,
2592 struct snd_ctl_elem_value *ucontrol)
2593{
2594 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
74155556 2595 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
46f5822f 2596 unsigned int reg_val, val, mux;
2e72f8e3
PU
2597
2598 reg_val = snd_soc_read(codec, e->reg);
2599 val = (reg_val >> e->shift_l) & e->mask;
2600 for (mux = 0; mux < e->max; mux++) {
2601 if (val == e->values[mux])
2602 break;
2603 }
2604 ucontrol->value.enumerated.item[0] = mux;
2605 if (e->shift_l != e->shift_r) {
2606 val = (reg_val >> e->shift_r) & e->mask;
2607 for (mux = 0; mux < e->max; mux++) {
2608 if (val == e->values[mux])
2609 break;
2610 }
2611 ucontrol->value.enumerated.item[1] = mux;
2612 }
2613
2614 return 0;
2615}
2616EXPORT_SYMBOL_GPL(snd_soc_get_value_enum_double);
2617
2618/**
2619 * snd_soc_put_value_enum_double - semi enumerated double mixer put callback
2620 * @kcontrol: mixer control
2621 * @ucontrol: control element information
2622 *
2623 * Callback to set the value of a double semi enumerated mixer.
2624 *
2625 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2626 * used for handling bitfield coded enumeration for example.
2627 *
2628 * Returns 0 for success.
2629 */
2630int snd_soc_put_value_enum_double(struct snd_kcontrol *kcontrol,
2631 struct snd_ctl_elem_value *ucontrol)
2632{
2633 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
74155556 2634 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
46f5822f
DR
2635 unsigned int val;
2636 unsigned int mask;
2e72f8e3
PU
2637
2638 if (ucontrol->value.enumerated.item[0] > e->max - 1)
2639 return -EINVAL;
2640 val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
2641 mask = e->mask << e->shift_l;
2642 if (e->shift_l != e->shift_r) {
2643 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2644 return -EINVAL;
2645 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
2646 mask |= e->mask << e->shift_r;
2647 }
2648
6c508c62 2649 return snd_soc_update_bits_locked(codec, e->reg, mask, val);
2e72f8e3
PU
2650}
2651EXPORT_SYMBOL_GPL(snd_soc_put_value_enum_double);
2652
db2a4165
FM
2653/**
2654 * snd_soc_info_enum_ext - external enumerated single mixer info callback
2655 * @kcontrol: mixer control
2656 * @uinfo: control element information
2657 *
2658 * Callback to provide information about an external enumerated
2659 * single mixer.
2660 *
2661 * Returns 0 for success.
2662 */
2663int snd_soc_info_enum_ext(struct snd_kcontrol *kcontrol,
2664 struct snd_ctl_elem_info *uinfo)
2665{
2666 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2667
2668 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2669 uinfo->count = 1;
f8ba0b7b 2670 uinfo->value.enumerated.items = e->max;
db2a4165 2671
f8ba0b7b
JS
2672 if (uinfo->value.enumerated.item > e->max - 1)
2673 uinfo->value.enumerated.item = e->max - 1;
db2a4165
FM
2674 strcpy(uinfo->value.enumerated.name,
2675 e->texts[uinfo->value.enumerated.item]);
2676 return 0;
2677}
2678EXPORT_SYMBOL_GPL(snd_soc_info_enum_ext);
2679
2680/**
2681 * snd_soc_info_volsw_ext - external single mixer info callback
2682 * @kcontrol: mixer control
2683 * @uinfo: control element information
2684 *
2685 * Callback to provide information about a single external mixer control.
2686 *
2687 * Returns 0 for success.
2688 */
2689int snd_soc_info_volsw_ext(struct snd_kcontrol *kcontrol,
2690 struct snd_ctl_elem_info *uinfo)
2691{
a7a4ac86
PZ
2692 int max = kcontrol->private_value;
2693
fd5dfad9 2694 if (max == 1 && !strstr(kcontrol->id.name, " Volume"))
a7a4ac86
PZ
2695 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2696 else
2697 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
db2a4165 2698
db2a4165
FM
2699 uinfo->count = 1;
2700 uinfo->value.integer.min = 0;
a7a4ac86 2701 uinfo->value.integer.max = max;
db2a4165
FM
2702 return 0;
2703}
2704EXPORT_SYMBOL_GPL(snd_soc_info_volsw_ext);
2705
db2a4165
FM
2706/**
2707 * snd_soc_info_volsw - single mixer info callback
2708 * @kcontrol: mixer control
2709 * @uinfo: control element information
2710 *
2711 * Callback to provide information about a single mixer control.
2712 *
2713 * Returns 0 for success.
2714 */
2715int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
2716 struct snd_ctl_elem_info *uinfo)
2717{
4eaa9819
JS
2718 struct soc_mixer_control *mc =
2719 (struct soc_mixer_control *)kcontrol->private_value;
d11bb4a9 2720 int platform_max;
762b8df7 2721 unsigned int shift = mc->shift;
815ecf8d 2722 unsigned int rshift = mc->rshift;
db2a4165 2723
d11bb4a9
PU
2724 if (!mc->platform_max)
2725 mc->platform_max = mc->max;
2726 platform_max = mc->platform_max;
2727
2728 if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
a7a4ac86
PZ
2729 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2730 else
2731 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2732
db2a4165
FM
2733 uinfo->count = shift == rshift ? 1 : 2;
2734 uinfo->value.integer.min = 0;
d11bb4a9 2735 uinfo->value.integer.max = platform_max;
db2a4165
FM
2736 return 0;
2737}
2738EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
2739
2740/**
2741 * snd_soc_get_volsw - single mixer get callback
2742 * @kcontrol: mixer control
ac11a2b3 2743 * @ucontrol: control element information
db2a4165
FM
2744 *
2745 * Callback to get the value of a single mixer control.
2746 *
2747 * Returns 0 for success.
2748 */
2749int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
2750 struct snd_ctl_elem_value *ucontrol)
2751{
4eaa9819
JS
2752 struct soc_mixer_control *mc =
2753 (struct soc_mixer_control *)kcontrol->private_value;
db2a4165 2754 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
815ecf8d
JS
2755 unsigned int reg = mc->reg;
2756 unsigned int shift = mc->shift;
2757 unsigned int rshift = mc->rshift;
4eaa9819 2758 int max = mc->max;
815ecf8d
JS
2759 unsigned int mask = (1 << fls(max)) - 1;
2760 unsigned int invert = mc->invert;
db2a4165
FM
2761
2762 ucontrol->value.integer.value[0] =
2763 (snd_soc_read(codec, reg) >> shift) & mask;
2764 if (shift != rshift)
2765 ucontrol->value.integer.value[1] =
2766 (snd_soc_read(codec, reg) >> rshift) & mask;
2767 if (invert) {
2768 ucontrol->value.integer.value[0] =
a7a4ac86 2769 max - ucontrol->value.integer.value[0];
db2a4165
FM
2770 if (shift != rshift)
2771 ucontrol->value.integer.value[1] =
a7a4ac86 2772 max - ucontrol->value.integer.value[1];
db2a4165
FM
2773 }
2774
2775 return 0;
2776}
2777EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
2778
2779/**
2780 * snd_soc_put_volsw - single mixer put callback
2781 * @kcontrol: mixer control
ac11a2b3 2782 * @ucontrol: control element information
db2a4165
FM
2783 *
2784 * Callback to set the value of a single mixer control.
2785 *
2786 * Returns 0 for success.
2787 */
2788int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
2789 struct snd_ctl_elem_value *ucontrol)
2790{
4eaa9819
JS
2791 struct soc_mixer_control *mc =
2792 (struct soc_mixer_control *)kcontrol->private_value;
db2a4165 2793 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
815ecf8d
JS
2794 unsigned int reg = mc->reg;
2795 unsigned int shift = mc->shift;
2796 unsigned int rshift = mc->rshift;
4eaa9819 2797 int max = mc->max;
815ecf8d
JS
2798 unsigned int mask = (1 << fls(max)) - 1;
2799 unsigned int invert = mc->invert;
46f5822f 2800 unsigned int val, val2, val_mask;
db2a4165
FM
2801
2802 val = (ucontrol->value.integer.value[0] & mask);
2803 if (invert)
a7a4ac86 2804 val = max - val;
db2a4165
FM
2805 val_mask = mask << shift;
2806 val = val << shift;
2807 if (shift != rshift) {
2808 val2 = (ucontrol->value.integer.value[1] & mask);
2809 if (invert)
a7a4ac86 2810 val2 = max - val2;
db2a4165
FM
2811 val_mask |= mask << rshift;
2812 val |= val2 << rshift;
2813 }
6c508c62 2814 return snd_soc_update_bits_locked(codec, reg, val_mask, val);
db2a4165
FM
2815}
2816EXPORT_SYMBOL_GPL(snd_soc_put_volsw);
2817
2818/**
2819 * snd_soc_info_volsw_2r - double mixer info callback
2820 * @kcontrol: mixer control
2821 * @uinfo: control element information
2822 *
2823 * Callback to provide information about a double mixer control that
2824 * spans 2 codec registers.
2825 *
2826 * Returns 0 for success.
2827 */
2828int snd_soc_info_volsw_2r(struct snd_kcontrol *kcontrol,
2829 struct snd_ctl_elem_info *uinfo)
2830{
4eaa9819
JS
2831 struct soc_mixer_control *mc =
2832 (struct soc_mixer_control *)kcontrol->private_value;
d11bb4a9 2833 int platform_max;
a7a4ac86 2834
d11bb4a9
PU
2835 if (!mc->platform_max)
2836 mc->platform_max = mc->max;
2837 platform_max = mc->platform_max;
2838
2839 if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
a7a4ac86
PZ
2840 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2841 else
2842 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
db2a4165 2843
db2a4165
FM
2844 uinfo->count = 2;
2845 uinfo->value.integer.min = 0;
d11bb4a9 2846 uinfo->value.integer.max = platform_max;
db2a4165
FM
2847 return 0;
2848}
2849EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r);
2850
2851/**
2852 * snd_soc_get_volsw_2r - double mixer get callback
2853 * @kcontrol: mixer control
ac11a2b3 2854 * @ucontrol: control element information
db2a4165
FM
2855 *
2856 * Callback to get the value of a double mixer control that spans 2 registers.
2857 *
2858 * Returns 0 for success.
2859 */
2860int snd_soc_get_volsw_2r(struct snd_kcontrol *kcontrol,
2861 struct snd_ctl_elem_value *ucontrol)
2862{
4eaa9819
JS
2863 struct soc_mixer_control *mc =
2864 (struct soc_mixer_control *)kcontrol->private_value;
db2a4165 2865 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
815ecf8d
JS
2866 unsigned int reg = mc->reg;
2867 unsigned int reg2 = mc->rreg;
2868 unsigned int shift = mc->shift;
4eaa9819 2869 int max = mc->max;
46f5822f 2870 unsigned int mask = (1 << fls(max)) - 1;
815ecf8d 2871 unsigned int invert = mc->invert;
db2a4165
FM
2872
2873 ucontrol->value.integer.value[0] =
2874 (snd_soc_read(codec, reg) >> shift) & mask;
2875 ucontrol->value.integer.value[1] =
2876 (snd_soc_read(codec, reg2) >> shift) & mask;
2877 if (invert) {
2878 ucontrol->value.integer.value[0] =
a7a4ac86 2879 max - ucontrol->value.integer.value[0];
db2a4165 2880 ucontrol->value.integer.value[1] =
a7a4ac86 2881 max - ucontrol->value.integer.value[1];
db2a4165
FM
2882 }
2883
2884 return 0;
2885}
2886EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r);
2887
2888/**
2889 * snd_soc_put_volsw_2r - double mixer set callback
2890 * @kcontrol: mixer control
ac11a2b3 2891 * @ucontrol: control element information
db2a4165
FM
2892 *
2893 * Callback to set the value of a double mixer control that spans 2 registers.
2894 *
2895 * Returns 0 for success.
2896 */
2897int snd_soc_put_volsw_2r(struct snd_kcontrol *kcontrol,
2898 struct snd_ctl_elem_value *ucontrol)
2899{
4eaa9819
JS
2900 struct soc_mixer_control *mc =
2901 (struct soc_mixer_control *)kcontrol->private_value;
db2a4165 2902 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
815ecf8d
JS
2903 unsigned int reg = mc->reg;
2904 unsigned int reg2 = mc->rreg;
2905 unsigned int shift = mc->shift;
4eaa9819 2906 int max = mc->max;
815ecf8d
JS
2907 unsigned int mask = (1 << fls(max)) - 1;
2908 unsigned int invert = mc->invert;
db2a4165 2909 int err;
46f5822f 2910 unsigned int val, val2, val_mask;
db2a4165
FM
2911
2912 val_mask = mask << shift;
2913 val = (ucontrol->value.integer.value[0] & mask);
2914 val2 = (ucontrol->value.integer.value[1] & mask);
2915
2916 if (invert) {
a7a4ac86
PZ
2917 val = max - val;
2918 val2 = max - val2;
db2a4165
FM
2919 }
2920
2921 val = val << shift;
2922 val2 = val2 << shift;
2923
6c508c62 2924 err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
3ff3f64b 2925 if (err < 0)
db2a4165
FM
2926 return err;
2927
6c508c62 2928 err = snd_soc_update_bits_locked(codec, reg2, val_mask, val2);
db2a4165
FM
2929 return err;
2930}
2931EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r);
2932
e13ac2e9
MB
2933/**
2934 * snd_soc_info_volsw_s8 - signed mixer info callback
2935 * @kcontrol: mixer control
2936 * @uinfo: control element information
2937 *
2938 * Callback to provide information about a signed mixer control.
2939 *
2940 * Returns 0 for success.
2941 */
2942int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol,
2943 struct snd_ctl_elem_info *uinfo)
2944{
4eaa9819
JS
2945 struct soc_mixer_control *mc =
2946 (struct soc_mixer_control *)kcontrol->private_value;
d11bb4a9 2947 int platform_max;
4eaa9819 2948 int min = mc->min;
e13ac2e9 2949
d11bb4a9
PU
2950 if (!mc->platform_max)
2951 mc->platform_max = mc->max;
2952 platform_max = mc->platform_max;
2953
e13ac2e9
MB
2954 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2955 uinfo->count = 2;
2956 uinfo->value.integer.min = 0;
d11bb4a9 2957 uinfo->value.integer.max = platform_max - min;
e13ac2e9
MB
2958 return 0;
2959}
2960EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8);
2961
2962/**
2963 * snd_soc_get_volsw_s8 - signed mixer get callback
2964 * @kcontrol: mixer control
ac11a2b3 2965 * @ucontrol: control element information
e13ac2e9
MB
2966 *
2967 * Callback to get the value of a signed mixer control.
2968 *
2969 * Returns 0 for success.
2970 */
2971int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol,
2972 struct snd_ctl_elem_value *ucontrol)
2973{
4eaa9819
JS
2974 struct soc_mixer_control *mc =
2975 (struct soc_mixer_control *)kcontrol->private_value;
e13ac2e9 2976 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
815ecf8d 2977 unsigned int reg = mc->reg;
4eaa9819 2978 int min = mc->min;
e13ac2e9
MB
2979 int val = snd_soc_read(codec, reg);
2980
2981 ucontrol->value.integer.value[0] =
2982 ((signed char)(val & 0xff))-min;
2983 ucontrol->value.integer.value[1] =
2984 ((signed char)((val >> 8) & 0xff))-min;
2985 return 0;
2986}
2987EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8);
2988
2989/**
2990 * snd_soc_put_volsw_sgn - signed mixer put callback
2991 * @kcontrol: mixer control
ac11a2b3 2992 * @ucontrol: control element information
e13ac2e9
MB
2993 *
2994 * Callback to set the value of a signed mixer control.
2995 *
2996 * Returns 0 for success.
2997 */
2998int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol,
2999 struct snd_ctl_elem_value *ucontrol)
3000{
4eaa9819
JS
3001 struct soc_mixer_control *mc =
3002 (struct soc_mixer_control *)kcontrol->private_value;
e13ac2e9 3003 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
815ecf8d 3004 unsigned int reg = mc->reg;
4eaa9819 3005 int min = mc->min;
46f5822f 3006 unsigned int val;
e13ac2e9
MB
3007
3008 val = (ucontrol->value.integer.value[0]+min) & 0xff;
3009 val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8;
3010
6c508c62 3011 return snd_soc_update_bits_locked(codec, reg, 0xffff, val);
e13ac2e9
MB
3012}
3013EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8);
3014
637d3847
PU
3015/**
3016 * snd_soc_limit_volume - Set new limit to an existing volume control.
3017 *
3018 * @codec: where to look for the control
3019 * @name: Name of the control
3020 * @max: new maximum limit
3021 *
3022 * Return 0 for success, else error.
3023 */
3024int snd_soc_limit_volume(struct snd_soc_codec *codec,
3025 const char *name, int max)
3026{
f0fba2ad 3027 struct snd_card *card = codec->card->snd_card;
637d3847
PU
3028 struct snd_kcontrol *kctl;
3029 struct soc_mixer_control *mc;
3030 int found = 0;
3031 int ret = -EINVAL;
3032
3033 /* Sanity check for name and max */
3034 if (unlikely(!name || max <= 0))
3035 return -EINVAL;
3036
3037 list_for_each_entry(kctl, &card->controls, list) {
3038 if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) {
3039 found = 1;
3040 break;
3041 }
3042 }
3043 if (found) {
3044 mc = (struct soc_mixer_control *)kctl->private_value;
3045 if (max <= mc->max) {
d11bb4a9 3046 mc->platform_max = max;
637d3847
PU
3047 ret = 0;
3048 }
3049 }
3050 return ret;
3051}
3052EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
3053
b6f4bb38 3054/**
3055 * snd_soc_info_volsw_2r_sx - double with tlv and variable data size
3056 * mixer info callback
3057 * @kcontrol: mixer control
3058 * @uinfo: control element information
3059 *
3060 * Returns 0 for success.
3061 */
3062int snd_soc_info_volsw_2r_sx(struct snd_kcontrol *kcontrol,
3063 struct snd_ctl_elem_info *uinfo)
3064{
3065 struct soc_mixer_control *mc =
3066 (struct soc_mixer_control *)kcontrol->private_value;
3067 int max = mc->max;
3068 int min = mc->min;
3069
3070 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
3071 uinfo->count = 2;
3072 uinfo->value.integer.min = 0;
3073 uinfo->value.integer.max = max-min;
3074
3075 return 0;
3076}
3077EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r_sx);
3078
3079/**
3080 * snd_soc_get_volsw_2r_sx - double with tlv and variable data size
3081 * mixer get callback
3082 * @kcontrol: mixer control
3083 * @uinfo: control element information
3084 *
3085 * Returns 0 for success.
3086 */
3087int snd_soc_get_volsw_2r_sx(struct snd_kcontrol *kcontrol,
3088 struct snd_ctl_elem_value *ucontrol)
3089{
3090 struct soc_mixer_control *mc =
3091 (struct soc_mixer_control *)kcontrol->private_value;
3092 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3093 unsigned int mask = (1<<mc->shift)-1;
3094 int min = mc->min;
3095 int val = snd_soc_read(codec, mc->reg) & mask;
3096 int valr = snd_soc_read(codec, mc->rreg) & mask;
3097
20630c7f
SL
3098 ucontrol->value.integer.value[0] = ((val & 0xff)-min) & mask;
3099 ucontrol->value.integer.value[1] = ((valr & 0xff)-min) & mask;
b6f4bb38 3100 return 0;
3101}
3102EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r_sx);
3103
3104/**
3105 * snd_soc_put_volsw_2r_sx - double with tlv and variable data size
3106 * mixer put callback
3107 * @kcontrol: mixer control
3108 * @uinfo: control element information
3109 *
3110 * Returns 0 for success.
3111 */
3112int snd_soc_put_volsw_2r_sx(struct snd_kcontrol *kcontrol,
3113 struct snd_ctl_elem_value *ucontrol)
3114{
3115 struct soc_mixer_control *mc =
3116 (struct soc_mixer_control *)kcontrol->private_value;
3117 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
3118 unsigned int mask = (1<<mc->shift)-1;
3119 int min = mc->min;
3120 int ret;
3121 unsigned int val, valr, oval, ovalr;
3122
3123 val = ((ucontrol->value.integer.value[0]+min) & 0xff);
3124 val &= mask;
3125 valr = ((ucontrol->value.integer.value[1]+min) & 0xff);
3126 valr &= mask;
3127
3128 oval = snd_soc_read(codec, mc->reg) & mask;
3129 ovalr = snd_soc_read(codec, mc->rreg) & mask;
3130
3131 ret = 0;
3132 if (oval != val) {
3133 ret = snd_soc_write(codec, mc->reg, val);
3134 if (ret < 0)
f1df5aec 3135 return ret;
b6f4bb38 3136 }
3137 if (ovalr != valr) {
3138 ret = snd_soc_write(codec, mc->rreg, valr);
3139 if (ret < 0)
f1df5aec 3140 return ret;
b6f4bb38 3141 }
3142
3143 return 0;
3144}
3145EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r_sx);
3146
8c6529db
LG
3147/**
3148 * snd_soc_dai_set_sysclk - configure DAI system or master clock.
3149 * @dai: DAI
3150 * @clk_id: DAI specific clock ID
3151 * @freq: new clock frequency in Hz
3152 * @dir: new clock direction - input/output.
3153 *
3154 * Configures the DAI master (MCLK) or system (SYSCLK) clocking.
3155 */
3156int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
3157 unsigned int freq, int dir)
3158{
f0fba2ad
LG
3159 if (dai->driver && dai->driver->ops->set_sysclk)
3160 return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir);
ec4ee52a
MB
3161 else if (dai->codec && dai->codec->driver->set_sysclk)
3162 return dai->codec->driver->set_sysclk(dai->codec, clk_id,
3163 freq, dir);
8c6529db
LG
3164 else
3165 return -EINVAL;
3166}
3167EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
3168
ec4ee52a
MB
3169/**
3170 * snd_soc_codec_set_sysclk - configure CODEC system or master clock.
3171 * @codec: CODEC
3172 * @clk_id: DAI specific clock ID
3173 * @freq: new clock frequency in Hz
3174 * @dir: new clock direction - input/output.
3175 *
3176 * Configures the CODEC master (MCLK) or system (SYSCLK) clocking.
3177 */
3178int snd_soc_codec_set_sysclk(struct snd_soc_codec *codec, int clk_id,
3179 unsigned int freq, int dir)
3180{
3181 if (codec->driver->set_sysclk)
3182 return codec->driver->set_sysclk(codec, clk_id, freq, dir);
3183 else
3184 return -EINVAL;
3185}
3186EXPORT_SYMBOL_GPL(snd_soc_codec_set_sysclk);
3187
8c6529db
LG
3188/**
3189 * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
3190 * @dai: DAI
ac11a2b3 3191 * @div_id: DAI specific clock divider ID
8c6529db
LG
3192 * @div: new clock divisor.
3193 *
3194 * Configures the clock dividers. This is used to derive the best DAI bit and
3195 * frame clocks from the system or master clock. It's best to set the DAI bit
3196 * and frame clocks as low as possible to save system power.
3197 */
3198int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
3199 int div_id, int div)
3200{
f0fba2ad
LG
3201 if (dai->driver && dai->driver->ops->set_clkdiv)
3202 return dai->driver->ops->set_clkdiv(dai, div_id, div);
8c6529db
LG
3203 else
3204 return -EINVAL;
3205}
3206EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv);
3207
3208/**
3209 * snd_soc_dai_set_pll - configure DAI PLL.
3210 * @dai: DAI
3211 * @pll_id: DAI specific PLL ID
85488037 3212 * @source: DAI specific source for the PLL
8c6529db
LG
3213 * @freq_in: PLL input clock frequency in Hz
3214 * @freq_out: requested PLL output clock frequency in Hz
3215 *
3216 * Configures and enables PLL to generate output clock based on input clock.
3217 */
85488037
MB
3218int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
3219 unsigned int freq_in, unsigned int freq_out)
8c6529db 3220{
f0fba2ad
LG
3221 if (dai->driver && dai->driver->ops->set_pll)
3222 return dai->driver->ops->set_pll(dai, pll_id, source,
85488037 3223 freq_in, freq_out);
ec4ee52a
MB
3224 else if (dai->codec && dai->codec->driver->set_pll)
3225 return dai->codec->driver->set_pll(dai->codec, pll_id, source,
3226 freq_in, freq_out);
8c6529db
LG
3227 else
3228 return -EINVAL;
3229}
3230EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
3231
ec4ee52a
MB
3232/*
3233 * snd_soc_codec_set_pll - configure codec PLL.
3234 * @codec: CODEC
3235 * @pll_id: DAI specific PLL ID
3236 * @source: DAI specific source for the PLL
3237 * @freq_in: PLL input clock frequency in Hz
3238 * @freq_out: requested PLL output clock frequency in Hz
3239 *
3240 * Configures and enables PLL to generate output clock based on input clock.
3241 */
3242int snd_soc_codec_set_pll(struct snd_soc_codec *codec, int pll_id, int source,
3243 unsigned int freq_in, unsigned int freq_out)
3244{
3245 if (codec->driver->set_pll)
3246 return codec->driver->set_pll(codec, pll_id, source,
3247 freq_in, freq_out);
3248 else
3249 return -EINVAL;
3250}
3251EXPORT_SYMBOL_GPL(snd_soc_codec_set_pll);
3252
8c6529db
LG
3253/**
3254 * snd_soc_dai_set_fmt - configure DAI hardware audio format.
3255 * @dai: DAI
8c6529db
LG
3256 * @fmt: SND_SOC_DAIFMT_ format value.
3257 *
3258 * Configures the DAI hardware format and clocking.
3259 */
3260int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
3261{
f0fba2ad
LG
3262 if (dai->driver && dai->driver->ops->set_fmt)
3263 return dai->driver->ops->set_fmt(dai, fmt);
8c6529db
LG
3264 else
3265 return -EINVAL;
3266}
3267EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
3268
3269/**
3270 * snd_soc_dai_set_tdm_slot - configure DAI TDM.
3271 * @dai: DAI
a5479e38
DR
3272 * @tx_mask: bitmask representing active TX slots.
3273 * @rx_mask: bitmask representing active RX slots.
8c6529db 3274 * @slots: Number of slots in use.
a5479e38 3275 * @slot_width: Width in bits for each slot.
8c6529db
LG
3276 *
3277 * Configures a DAI for TDM operation. Both mask and slots are codec and DAI
3278 * specific.
3279 */
3280int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
a5479e38 3281 unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
8c6529db 3282{
f0fba2ad
LG
3283 if (dai->driver && dai->driver->ops->set_tdm_slot)
3284 return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask,
a5479e38 3285 slots, slot_width);
8c6529db
LG
3286 else
3287 return -EINVAL;
3288}
3289EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
3290
472df3cb
BS
3291/**
3292 * snd_soc_dai_set_channel_map - configure DAI audio channel map
3293 * @dai: DAI
3294 * @tx_num: how many TX channels
3295 * @tx_slot: pointer to an array which imply the TX slot number channel
3296 * 0~num-1 uses
3297 * @rx_num: how many RX channels
3298 * @rx_slot: pointer to an array which imply the RX slot number channel
3299 * 0~num-1 uses
3300 *
3301 * configure the relationship between channel number and TDM slot number.
3302 */
3303int snd_soc_dai_set_channel_map(struct snd_soc_dai *dai,
3304 unsigned int tx_num, unsigned int *tx_slot,
3305 unsigned int rx_num, unsigned int *rx_slot)
3306{
f0fba2ad
LG
3307 if (dai->driver && dai->driver->ops->set_channel_map)
3308 return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot,
472df3cb
BS
3309 rx_num, rx_slot);
3310 else
3311 return -EINVAL;
3312}
3313EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map);
3314
8c6529db
LG
3315/**
3316 * snd_soc_dai_set_tristate - configure DAI system or master clock.
3317 * @dai: DAI
3318 * @tristate: tristate enable
3319 *
3320 * Tristates the DAI so that others can use it.
3321 */
3322int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
3323{
f0fba2ad
LG
3324 if (dai->driver && dai->driver->ops->set_tristate)
3325 return dai->driver->ops->set_tristate(dai, tristate);
8c6529db
LG
3326 else
3327 return -EINVAL;
3328}
3329EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate);
3330
3331/**
3332 * snd_soc_dai_digital_mute - configure DAI system or master clock.
3333 * @dai: DAI
3334 * @mute: mute enable
3335 *
3336 * Mutes the DAI DAC.
3337 */
3338int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute)
3339{
f0fba2ad
LG
3340 if (dai->driver && dai->driver->ops->digital_mute)
3341 return dai->driver->ops->digital_mute(dai, mute);
8c6529db
LG
3342 else
3343 return -EINVAL;
3344}
3345EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
3346
c5af3a2e
MB
3347/**
3348 * snd_soc_register_card - Register a card with the ASoC core
3349 *
ac11a2b3 3350 * @card: Card to register
c5af3a2e 3351 *
c5af3a2e 3352 */
70a7ca34 3353int snd_soc_register_card(struct snd_soc_card *card)
c5af3a2e 3354{
f0fba2ad
LG
3355 int i;
3356
c5af3a2e
MB
3357 if (!card->name || !card->dev)
3358 return -EINVAL;
3359
ed77cc12
MB
3360 dev_set_drvdata(card->dev, card);
3361
111c6419
SW
3362 snd_soc_initialize_card_lists(card);
3363
150dd2f8
VK
3364 soc_init_card_debugfs(card);
3365
2eea392d
JN
3366 card->rtd = kzalloc(sizeof(struct snd_soc_pcm_runtime) *
3367 (card->num_links + card->num_aux_devs),
3368 GFP_KERNEL);
f0fba2ad
LG
3369 if (card->rtd == NULL)
3370 return -ENOMEM;
2eea392d 3371 card->rtd_aux = &card->rtd[card->num_links];
f0fba2ad
LG
3372
3373 for (i = 0; i < card->num_links; i++)
3374 card->rtd[i].dai_link = &card->dai_link[i];
3375
c5af3a2e
MB
3376 INIT_LIST_HEAD(&card->list);
3377 card->instantiated = 0;
f0fba2ad 3378 mutex_init(&card->mutex);
c5af3a2e
MB
3379
3380 mutex_lock(&client_mutex);
3381 list_add(&card->list, &card_list);
435c5e25 3382 snd_soc_instantiate_cards();
c5af3a2e
MB
3383 mutex_unlock(&client_mutex);
3384
3385 dev_dbg(card->dev, "Registered card '%s'\n", card->name);
3386
3387 return 0;
3388}
70a7ca34 3389EXPORT_SYMBOL_GPL(snd_soc_register_card);
c5af3a2e
MB
3390
3391/**
3392 * snd_soc_unregister_card - Unregister a card with the ASoC core
3393 *
ac11a2b3 3394 * @card: Card to unregister
c5af3a2e 3395 *
c5af3a2e 3396 */
70a7ca34 3397int snd_soc_unregister_card(struct snd_soc_card *card)
c5af3a2e 3398{
b0e26485
VK
3399 if (card->instantiated)
3400 soc_cleanup_card_resources(card);
c5af3a2e
MB
3401 mutex_lock(&client_mutex);
3402 list_del(&card->list);
3403 mutex_unlock(&client_mutex);
c5af3a2e
MB
3404 dev_dbg(card->dev, "Unregistered card '%s'\n", card->name);
3405
3406 return 0;
3407}
70a7ca34 3408EXPORT_SYMBOL_GPL(snd_soc_unregister_card);
c5af3a2e 3409
f0fba2ad
LG
3410/*
3411 * Simplify DAI link configuration by removing ".-1" from device names
3412 * and sanitizing names.
3413 */
0b9a214a 3414static char *fmt_single_name(struct device *dev, int *id)
f0fba2ad
LG
3415{
3416 char *found, name[NAME_SIZE];
3417 int id1, id2;
3418
3419 if (dev_name(dev) == NULL)
3420 return NULL;
3421
58818a77 3422 strlcpy(name, dev_name(dev), NAME_SIZE);
f0fba2ad
LG
3423
3424 /* are we a "%s.%d" name (platform and SPI components) */
3425 found = strstr(name, dev->driver->name);
3426 if (found) {
3427 /* get ID */
3428 if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) {
3429
3430 /* discard ID from name if ID == -1 */
3431 if (*id == -1)
3432 found[strlen(dev->driver->name)] = '\0';
3433 }
3434
3435 } else {
3436 /* I2C component devices are named "bus-addr" */
3437 if (sscanf(name, "%x-%x", &id1, &id2) == 2) {
3438 char tmp[NAME_SIZE];
3439
3440 /* create unique ID number from I2C addr and bus */
05899446 3441 *id = ((id1 & 0xffff) << 16) + id2;
f0fba2ad
LG
3442
3443 /* sanitize component name for DAI link creation */
3444 snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name);
58818a77 3445 strlcpy(name, tmp, NAME_SIZE);
f0fba2ad
LG
3446 } else
3447 *id = 0;
3448 }
3449
3450 return kstrdup(name, GFP_KERNEL);
3451}
3452
3453/*
3454 * Simplify DAI link naming for single devices with multiple DAIs by removing
3455 * any ".-1" and using the DAI name (instead of device name).
3456 */
3457static inline char *fmt_multiple_name(struct device *dev,
3458 struct snd_soc_dai_driver *dai_drv)
3459{
3460 if (dai_drv->name == NULL) {
3461 printk(KERN_ERR "asoc: error - multiple DAI %s registered with no name\n",
3462 dev_name(dev));
3463 return NULL;
3464 }
3465
3466 return kstrdup(dai_drv->name, GFP_KERNEL);
3467}
3468
9115171a
MB
3469/**
3470 * snd_soc_register_dai - Register a DAI with the ASoC core
3471 *
ac11a2b3 3472 * @dai: DAI to register
9115171a 3473 */
f0fba2ad
LG
3474int snd_soc_register_dai(struct device *dev,
3475 struct snd_soc_dai_driver *dai_drv)
9115171a 3476{
f0fba2ad
LG
3477 struct snd_soc_dai *dai;
3478
3479 dev_dbg(dev, "dai register %s\n", dev_name(dev));
9115171a 3480
f0fba2ad
LG
3481 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
3482 if (dai == NULL)
a7393623 3483 return -ENOMEM;
9115171a 3484
f0fba2ad
LG
3485 /* create DAI component name */
3486 dai->name = fmt_single_name(dev, &dai->id);
3487 if (dai->name == NULL) {
3488 kfree(dai);
3489 return -ENOMEM;
3490 }
6335d055 3491
f0fba2ad
LG
3492 dai->dev = dev;
3493 dai->driver = dai_drv;
3494 if (!dai->driver->ops)
3495 dai->driver->ops = &null_dai_ops;
9115171a
MB
3496
3497 mutex_lock(&client_mutex);
3498 list_add(&dai->list, &dai_list);
435c5e25 3499 snd_soc_instantiate_cards();
9115171a
MB
3500 mutex_unlock(&client_mutex);
3501
3502 pr_debug("Registered DAI '%s'\n", dai->name);
3503
3504 return 0;
3505}
3506EXPORT_SYMBOL_GPL(snd_soc_register_dai);
3507
3508/**
3509 * snd_soc_unregister_dai - Unregister a DAI from the ASoC core
3510 *
ac11a2b3 3511 * @dai: DAI to unregister
9115171a 3512 */
f0fba2ad 3513void snd_soc_unregister_dai(struct device *dev)
9115171a 3514{
f0fba2ad
LG
3515 struct snd_soc_dai *dai;
3516
3517 list_for_each_entry(dai, &dai_list, list) {
3518 if (dev == dai->dev)
3519 goto found;
3520 }
3521 return;
3522
3523found:
9115171a
MB
3524 mutex_lock(&client_mutex);
3525 list_del(&dai->list);
3526 mutex_unlock(&client_mutex);
3527
3528 pr_debug("Unregistered DAI '%s'\n", dai->name);
f0fba2ad
LG
3529 kfree(dai->name);
3530 kfree(dai);
9115171a
MB
3531}
3532EXPORT_SYMBOL_GPL(snd_soc_unregister_dai);
3533
3534/**
3535 * snd_soc_register_dais - Register multiple DAIs with the ASoC core
3536 *
ac11a2b3
MB
3537 * @dai: Array of DAIs to register
3538 * @count: Number of DAIs
9115171a 3539 */
f0fba2ad
LG
3540int snd_soc_register_dais(struct device *dev,
3541 struct snd_soc_dai_driver *dai_drv, size_t count)
9115171a 3542{
f0fba2ad
LG
3543 struct snd_soc_dai *dai;
3544 int i, ret = 0;
3545
720ffa4c 3546 dev_dbg(dev, "dai register %s #%Zu\n", dev_name(dev), count);
9115171a
MB
3547
3548 for (i = 0; i < count; i++) {
f0fba2ad
LG
3549
3550 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
c46e0079
AL
3551 if (dai == NULL) {
3552 ret = -ENOMEM;
3553 goto err;
3554 }
f0fba2ad
LG
3555
3556 /* create DAI component name */
3557 dai->name = fmt_multiple_name(dev, &dai_drv[i]);
3558 if (dai->name == NULL) {
3559 kfree(dai);
3560 ret = -EINVAL;
9115171a 3561 goto err;
f0fba2ad
LG
3562 }
3563
3564 dai->dev = dev;
f0fba2ad 3565 dai->driver = &dai_drv[i];
0f9141c9
MB
3566 if (dai->driver->id)
3567 dai->id = dai->driver->id;
3568 else
3569 dai->id = i;
f0fba2ad
LG
3570 if (!dai->driver->ops)
3571 dai->driver->ops = &null_dai_ops;
3572
3573 mutex_lock(&client_mutex);
3574 list_add(&dai->list, &dai_list);
3575 mutex_unlock(&client_mutex);
3576
3577 pr_debug("Registered DAI '%s'\n", dai->name);
9115171a
MB
3578 }
3579
1dcb4f38 3580 mutex_lock(&client_mutex);
f0fba2ad 3581 snd_soc_instantiate_cards();
1dcb4f38 3582 mutex_unlock(&client_mutex);
9115171a
MB
3583 return 0;
3584
3585err:
3586 for (i--; i >= 0; i--)
f0fba2ad 3587 snd_soc_unregister_dai(dev);
9115171a
MB
3588
3589 return ret;
3590}
3591EXPORT_SYMBOL_GPL(snd_soc_register_dais);
3592
3593/**
3594 * snd_soc_unregister_dais - Unregister multiple DAIs from the ASoC core
3595 *
ac11a2b3
MB
3596 * @dai: Array of DAIs to unregister
3597 * @count: Number of DAIs
9115171a 3598 */
f0fba2ad 3599void snd_soc_unregister_dais(struct device *dev, size_t count)
9115171a
MB
3600{
3601 int i;
3602
3603 for (i = 0; i < count; i++)
f0fba2ad 3604 snd_soc_unregister_dai(dev);
9115171a
MB
3605}
3606EXPORT_SYMBOL_GPL(snd_soc_unregister_dais);
3607
12a48a8c
MB
3608/**
3609 * snd_soc_register_platform - Register a platform with the ASoC core
3610 *
ac11a2b3 3611 * @platform: platform to register
12a48a8c 3612 */
f0fba2ad
LG
3613int snd_soc_register_platform(struct device *dev,
3614 struct snd_soc_platform_driver *platform_drv)
12a48a8c 3615{
f0fba2ad
LG
3616 struct snd_soc_platform *platform;
3617
3618 dev_dbg(dev, "platform register %s\n", dev_name(dev));
3619
3620 platform = kzalloc(sizeof(struct snd_soc_platform), GFP_KERNEL);
3621 if (platform == NULL)
a7393623 3622 return -ENOMEM;
f0fba2ad
LG
3623
3624 /* create platform component name */
3625 platform->name = fmt_single_name(dev, &platform->id);
3626 if (platform->name == NULL) {
3627 kfree(platform);
3628 return -ENOMEM;
3629 }
12a48a8c 3630
f0fba2ad
LG
3631 platform->dev = dev;
3632 platform->driver = platform_drv;
12a48a8c
MB
3633
3634 mutex_lock(&client_mutex);
3635 list_add(&platform->list, &platform_list);
435c5e25 3636 snd_soc_instantiate_cards();
12a48a8c
MB
3637 mutex_unlock(&client_mutex);
3638
3639 pr_debug("Registered platform '%s'\n", platform->name);
3640
3641 return 0;
3642}
3643EXPORT_SYMBOL_GPL(snd_soc_register_platform);
3644
3645/**
3646 * snd_soc_unregister_platform - Unregister a platform from the ASoC core
3647 *
ac11a2b3 3648 * @platform: platform to unregister
12a48a8c 3649 */
f0fba2ad 3650void snd_soc_unregister_platform(struct device *dev)
12a48a8c 3651{
f0fba2ad
LG
3652 struct snd_soc_platform *platform;
3653
3654 list_for_each_entry(platform, &platform_list, list) {
3655 if (dev == platform->dev)
3656 goto found;
3657 }
3658 return;
3659
3660found:
12a48a8c
MB
3661 mutex_lock(&client_mutex);
3662 list_del(&platform->list);
3663 mutex_unlock(&client_mutex);
3664
3665 pr_debug("Unregistered platform '%s'\n", platform->name);
f0fba2ad
LG
3666 kfree(platform->name);
3667 kfree(platform);
12a48a8c
MB
3668}
3669EXPORT_SYMBOL_GPL(snd_soc_unregister_platform);
3670
151ab22c
MB
3671static u64 codec_format_map[] = {
3672 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE,
3673 SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE,
3674 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_BE,
3675 SNDRV_PCM_FMTBIT_U24_LE | SNDRV_PCM_FMTBIT_U24_BE,
3676 SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE,
3677 SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE,
3678 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
3679 SNDRV_PCM_FMTBIT_U24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
3680 SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S20_3BE,
3681 SNDRV_PCM_FMTBIT_U20_3LE | SNDRV_PCM_FMTBIT_U20_3BE,
3682 SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S18_3BE,
3683 SNDRV_PCM_FMTBIT_U18_3LE | SNDRV_PCM_FMTBIT_U18_3BE,
3684 SNDRV_PCM_FMTBIT_FLOAT_LE | SNDRV_PCM_FMTBIT_FLOAT_BE,
3685 SNDRV_PCM_FMTBIT_FLOAT64_LE | SNDRV_PCM_FMTBIT_FLOAT64_BE,
3686 SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE
3687 | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE,
3688};
3689
3690/* Fix up the DAI formats for endianness: codecs don't actually see
3691 * the endianness of the data but we're using the CPU format
3692 * definitions which do need to include endianness so we ensure that
3693 * codec DAIs always have both big and little endian variants set.
3694 */
3695static void fixup_codec_formats(struct snd_soc_pcm_stream *stream)
3696{
3697 int i;
3698
3699 for (i = 0; i < ARRAY_SIZE(codec_format_map); i++)
3700 if (stream->formats & codec_format_map[i])
3701 stream->formats |= codec_format_map[i];
3702}
3703
0d0cf00a
MB
3704/**
3705 * snd_soc_register_codec - Register a codec with the ASoC core
3706 *
ac11a2b3 3707 * @codec: codec to register
0d0cf00a 3708 */
f0fba2ad 3709int snd_soc_register_codec(struct device *dev,
001ae4c0
MB
3710 const struct snd_soc_codec_driver *codec_drv,
3711 struct snd_soc_dai_driver *dai_drv,
3712 int num_dai)
0d0cf00a 3713{
3335ddca 3714 size_t reg_size;
f0fba2ad
LG
3715 struct snd_soc_codec *codec;
3716 int ret, i;
151ab22c 3717
f0fba2ad
LG
3718 dev_dbg(dev, "codec register %s\n", dev_name(dev));
3719
3720 codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
3721 if (codec == NULL)
3722 return -ENOMEM;
0d0cf00a 3723
f0fba2ad
LG
3724 /* create CODEC component name */
3725 codec->name = fmt_single_name(dev, &codec->id);
3726 if (codec->name == NULL) {
3727 kfree(codec);
3728 return -ENOMEM;
3729 }
3730
23bbce34
DP
3731 if (codec_drv->compress_type)
3732 codec->compress_type = codec_drv->compress_type;
3733 else
3734 codec->compress_type = SND_SOC_FLAT_COMPRESSION;
3735
c3acec26
MB
3736 codec->write = codec_drv->write;
3737 codec->read = codec_drv->read;
1500b7b5
DP
3738 codec->volatile_register = codec_drv->volatile_register;
3739 codec->readable_register = codec_drv->readable_register;
8020454c 3740 codec->writable_register = codec_drv->writable_register;
ce6120cc
LG
3741 codec->dapm.bias_level = SND_SOC_BIAS_OFF;
3742 codec->dapm.dev = dev;
3743 codec->dapm.codec = codec;
474b62d6 3744 codec->dapm.seq_notifier = codec_drv->seq_notifier;
7a30a3db
DP
3745 codec->dev = dev;
3746 codec->driver = codec_drv;
3747 codec->num_dai = num_dai;
3748 mutex_init(&codec->mutex);
ce6120cc 3749
f0fba2ad
LG
3750 /* allocate CODEC register cache */
3751 if (codec_drv->reg_cache_size && codec_drv->reg_word_size) {
3335ddca 3752 reg_size = codec_drv->reg_cache_size * codec_drv->reg_word_size;
aea170a0 3753 codec->reg_size = reg_size;
3335ddca
DP
3754 /* it is necessary to make a copy of the default register cache
3755 * because in the case of using a compression type that requires
3756 * the default register cache to be marked as __devinitconst the
3757 * kernel might have freed the array by the time we initialize
3758 * the cache.
3759 */
2aa86323
DP
3760 if (codec_drv->reg_cache_default) {
3761 codec->reg_def_copy = kmemdup(codec_drv->reg_cache_default,
3762 reg_size, GFP_KERNEL);
3763 if (!codec->reg_def_copy) {
3764 ret = -ENOMEM;
3765 goto fail;
3766 }
f0fba2ad 3767 }
151ab22c
MB
3768 }
3769
1500b7b5
DP
3770 if (codec_drv->reg_access_size && codec_drv->reg_access_default) {
3771 if (!codec->volatile_register)
3772 codec->volatile_register = snd_soc_default_volatile_register;
3773 if (!codec->readable_register)
3774 codec->readable_register = snd_soc_default_readable_register;
8020454c
DP
3775 if (!codec->writable_register)
3776 codec->writable_register = snd_soc_default_writable_register;
1500b7b5
DP
3777 }
3778
f0fba2ad
LG
3779 for (i = 0; i < num_dai; i++) {
3780 fixup_codec_formats(&dai_drv[i].playback);
3781 fixup_codec_formats(&dai_drv[i].capture);
3782 }
3783
26b01ccd
MB
3784 /* register any DAIs */
3785 if (num_dai) {
3786 ret = snd_soc_register_dais(dev, dai_drv, num_dai);
3787 if (ret < 0)
fdf0f54d 3788 goto fail;
26b01ccd 3789 }
f0fba2ad 3790
0d0cf00a
MB
3791 mutex_lock(&client_mutex);
3792 list_add(&codec->list, &codec_list);
3793 snd_soc_instantiate_cards();
3794 mutex_unlock(&client_mutex);
3795
3796 pr_debug("Registered codec '%s'\n", codec->name);
0d0cf00a 3797 return 0;
f0fba2ad 3798
fdf0f54d 3799fail:
3335ddca
DP
3800 kfree(codec->reg_def_copy);
3801 codec->reg_def_copy = NULL;
f0fba2ad
LG
3802 kfree(codec->name);
3803 kfree(codec);
3804 return ret;
0d0cf00a
MB
3805}
3806EXPORT_SYMBOL_GPL(snd_soc_register_codec);
3807
3808/**
3809 * snd_soc_unregister_codec - Unregister a codec from the ASoC core
3810 *
ac11a2b3 3811 * @codec: codec to unregister
0d0cf00a 3812 */
f0fba2ad 3813void snd_soc_unregister_codec(struct device *dev)
0d0cf00a 3814{
f0fba2ad
LG
3815 struct snd_soc_codec *codec;
3816 int i;
3817
3818 list_for_each_entry(codec, &codec_list, list) {
3819 if (dev == codec->dev)
3820 goto found;
3821 }
3822 return;
3823
3824found:
26b01ccd
MB
3825 if (codec->num_dai)
3826 for (i = 0; i < codec->num_dai; i++)
3827 snd_soc_unregister_dai(dev);
f0fba2ad 3828
0d0cf00a
MB
3829 mutex_lock(&client_mutex);
3830 list_del(&codec->list);
3831 mutex_unlock(&client_mutex);
3832
3833 pr_debug("Unregistered codec '%s'\n", codec->name);
f0fba2ad 3834
7a30a3db 3835 snd_soc_cache_exit(codec);
3335ddca 3836 kfree(codec->reg_def_copy);
1aafcd4d 3837 kfree(codec->name);
f0fba2ad 3838 kfree(codec);
0d0cf00a
MB
3839}
3840EXPORT_SYMBOL_GPL(snd_soc_unregister_codec);
3841
c9b3a40f 3842static int __init snd_soc_init(void)
db2a4165 3843{
384c89e2 3844#ifdef CONFIG_DEBUG_FS
8a9dab1a
MB
3845 snd_soc_debugfs_root = debugfs_create_dir("asoc", NULL);
3846 if (IS_ERR(snd_soc_debugfs_root) || !snd_soc_debugfs_root) {
384c89e2
MB
3847 printk(KERN_WARNING
3848 "ASoC: Failed to create debugfs directory\n");
8a9dab1a 3849 snd_soc_debugfs_root = NULL;
384c89e2 3850 }
c3c5a19a 3851
8a9dab1a 3852 if (!debugfs_create_file("codecs", 0444, snd_soc_debugfs_root, NULL,
c3c5a19a
MB
3853 &codec_list_fops))
3854 pr_warn("ASoC: Failed to create CODEC list debugfs file\n");
3855
8a9dab1a 3856 if (!debugfs_create_file("dais", 0444, snd_soc_debugfs_root, NULL,
f3208780
MB
3857 &dai_list_fops))
3858 pr_warn("ASoC: Failed to create DAI list debugfs file\n");
19c7ac27 3859
8a9dab1a 3860 if (!debugfs_create_file("platforms", 0444, snd_soc_debugfs_root, NULL,
19c7ac27
MB
3861 &platform_list_fops))
3862 pr_warn("ASoC: Failed to create platform list debugfs file\n");
384c89e2
MB
3863#endif
3864
fb257897
MB
3865 snd_soc_util_init();
3866
db2a4165
FM
3867 return platform_driver_register(&soc_driver);
3868}
4abe8e16 3869module_init(snd_soc_init);
db2a4165 3870
7d8c16a6 3871static void __exit snd_soc_exit(void)
db2a4165 3872{
fb257897
MB
3873 snd_soc_util_exit();
3874
384c89e2 3875#ifdef CONFIG_DEBUG_FS
8a9dab1a 3876 debugfs_remove_recursive(snd_soc_debugfs_root);
384c89e2 3877#endif
3ff3f64b 3878 platform_driver_unregister(&soc_driver);
db2a4165 3879}
db2a4165
FM
3880module_exit(snd_soc_exit);
3881
3882/* Module information */
d331124d 3883MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
db2a4165
FM
3884MODULE_DESCRIPTION("ALSA SoC Core");
3885MODULE_LICENSE("GPL");
8b45a209 3886MODULE_ALIAS("platform:soc-audio");