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