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