blob: bdb2ca9da58bb75cd6c96b71b62e810d551c3b7e [file] [log] [blame]
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001/*
2 * soc-core.c -- ALSA SoC Audio Layer
3 *
4 * Copyright 2005 Wolfson Microelectronics PLC.
Liam Girdwood0664d882006-12-18 14:39:02 +01005 * Copyright 2005 Openedhand Ltd.
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00006 * Copyright (C) 2010 Slimlogic Ltd.
7 * Copyright (C) 2010 Texas Instruments Inc.
Liam Girdwood0664d882006-12-18 14:39:02 +01008 *
Liam Girdwoodd3311242008-10-12 13:17:36 +01009 * Author: Liam Girdwood <lrg@slimlogic.co.uk>
Liam Girdwood0664d882006-12-18 14:39:02 +010010 * with code, comments and ideas from :-
11 * Richard Purdie <richard@openedhand.com>
Frank Mandarinodb2a4162006-10-06 18:31:09 +020012 *
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 *
Frank Mandarinodb2a4162006-10-06 18:31:09 +020018 * 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>
Troy Kisky12ef1932008-10-13 17:42:14 -070031#include <linux/debugfs.h>
Frank Mandarinodb2a4162006-10-06 18:31:09 +020032#include <linux/platform_device.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090033#include <linux/slab.h>
Marek Vasut474828a2009-07-22 13:01:03 +020034#include <sound/ac97_codec.h>
Frank Mandarinodb2a4162006-10-06 18:31:09 +020035#include <sound/core.h>
Mark Brown3028eb82010-12-05 12:22:46 +000036#include <sound/jack.h>
Frank Mandarinodb2a4162006-10-06 18:31:09 +020037#include <sound/pcm.h>
38#include <sound/pcm_params.h>
39#include <sound/soc.h>
Frank Mandarinodb2a4162006-10-06 18:31:09 +020040#include <sound/initval.h>
41
Mark Browna8b1d342010-11-03 18:05:58 -040042#define CREATE_TRACE_POINTS
43#include <trace/events/asoc.h>
44
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000045#define NAME_SIZE 32
46
Frank Mandarinodb2a4162006-10-06 18:31:09 +020047static DEFINE_MUTEX(pcm_mutex);
Frank Mandarinodb2a4162006-10-06 18:31:09 +020048static DECLARE_WAIT_QUEUE_HEAD(soc_pm_waitq);
49
Mark Brown384c89e2008-12-03 17:34:03 +000050#ifdef CONFIG_DEBUG_FS
51static struct dentry *debugfs_root;
52#endif
53
Mark Brownc5af3a22008-11-28 13:29:45 +000054static DEFINE_MUTEX(client_mutex);
55static LIST_HEAD(card_list);
Mark Brown91151712008-11-30 23:31:24 +000056static LIST_HEAD(dai_list);
Mark Brown12a48a8c2008-12-03 19:40:30 +000057static LIST_HEAD(platform_list);
Mark Brown0d0cf002008-12-10 14:32:45 +000058static LIST_HEAD(codec_list);
Mark Brownc5af3a22008-11-28 13:29:45 +000059
60static int snd_soc_register_card(struct snd_soc_card *card);
61static int snd_soc_unregister_card(struct snd_soc_card *card);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000062static int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num);
Mark Brownc5af3a22008-11-28 13:29:45 +000063
Frank Mandarinodb2a4162006-10-06 18:31:09 +020064/*
65 * This is a timeout to do a DAPM powerdown after a stream is closed().
66 * It can be used to eliminate pops between different playback streams, e.g.
67 * between two audio tracks.
68 */
69static int pmdown_time = 5000;
70module_param(pmdown_time, int, 0);
71MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
72
Mark Brown2624d5f2009-11-03 21:56:13 +000073/* codec register dump */
74static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf)
75{
Mark Brown5164d742010-07-14 16:14:33 +010076 int ret, i, step = 1, count = 0;
Mark Brown2624d5f2009-11-03 21:56:13 +000077
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000078 if (!codec->driver->reg_cache_size)
Mark Brown2624d5f2009-11-03 21:56:13 +000079 return 0;
80
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000081 if (codec->driver->reg_cache_step)
82 step = codec->driver->reg_cache_step;
Mark Brown2624d5f2009-11-03 21:56:13 +000083
84 count += sprintf(buf, "%s registers\n", codec->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000085 for (i = 0; i < codec->driver->reg_cache_size; i += step) {
86 if (codec->driver->readable_register && !codec->driver->readable_register(i))
Mark Brown2624d5f2009-11-03 21:56:13 +000087 continue;
88
89 count += sprintf(buf + count, "%2x: ", i);
90 if (count >= PAGE_SIZE - 1)
91 break;
92
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000093 if (codec->driver->display_register) {
94 count += codec->driver->display_register(codec, buf + count,
Mark Brown2624d5f2009-11-03 21:56:13 +000095 PAGE_SIZE - count, i);
Mark Brown5164d742010-07-14 16:14:33 +010096 } else {
97 /* If the read fails it's almost certainly due to
98 * the register being volatile and the device being
99 * powered off.
100 */
Dimitris Papastamose4f078d2010-12-07 16:30:38 +0000101 ret = snd_soc_read(codec, i);
Mark Brown5164d742010-07-14 16:14:33 +0100102 if (ret >= 0)
103 count += snprintf(buf + count,
104 PAGE_SIZE - count,
105 "%4x", ret);
106 else
107 count += snprintf(buf + count,
108 PAGE_SIZE - count,
109 "<no data: %d>", ret);
110 }
Mark Brown2624d5f2009-11-03 21:56:13 +0000111
112 if (count >= PAGE_SIZE - 1)
113 break;
114
115 count += snprintf(buf + count, PAGE_SIZE - count, "\n");
116 if (count >= PAGE_SIZE - 1)
117 break;
118 }
119
120 /* Truncate count; min() would cause a warning */
121 if (count >= PAGE_SIZE)
122 count = PAGE_SIZE - 1;
123
124 return count;
125}
126static ssize_t codec_reg_show(struct device *dev,
127 struct device_attribute *attr, char *buf)
128{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000129 struct snd_soc_pcm_runtime *rtd =
130 container_of(dev, struct snd_soc_pcm_runtime, dev);
131
132 return soc_codec_reg_show(rtd->codec, buf);
Mark Brown2624d5f2009-11-03 21:56:13 +0000133}
134
135static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
136
Mark Browndbe21402010-02-12 11:37:24 +0000137static ssize_t pmdown_time_show(struct device *dev,
138 struct device_attribute *attr, char *buf)
139{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000140 struct snd_soc_pcm_runtime *rtd =
141 container_of(dev, struct snd_soc_pcm_runtime, dev);
Mark Browndbe21402010-02-12 11:37:24 +0000142
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000143 return sprintf(buf, "%ld\n", rtd->pmdown_time);
Mark Browndbe21402010-02-12 11:37:24 +0000144}
145
146static ssize_t pmdown_time_set(struct device *dev,
147 struct device_attribute *attr,
148 const char *buf, size_t count)
149{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000150 struct snd_soc_pcm_runtime *rtd =
151 container_of(dev, struct snd_soc_pcm_runtime, dev);
Mark Brownc593b522010-10-27 20:11:17 -0700152 int ret;
Mark Browndbe21402010-02-12 11:37:24 +0000153
Mark Brownc593b522010-10-27 20:11:17 -0700154 ret = strict_strtol(buf, 10, &rtd->pmdown_time);
155 if (ret)
156 return ret;
Mark Browndbe21402010-02-12 11:37:24 +0000157
158 return count;
159}
160
161static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set);
162
Mark Brown2624d5f2009-11-03 21:56:13 +0000163#ifdef CONFIG_DEBUG_FS
164static int codec_reg_open_file(struct inode *inode, struct file *file)
165{
166 file->private_data = inode->i_private;
167 return 0;
168}
169
170static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
171 size_t count, loff_t *ppos)
172{
173 ssize_t ret;
174 struct snd_soc_codec *codec = file->private_data;
175 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
176 if (!buf)
177 return -ENOMEM;
178 ret = soc_codec_reg_show(codec, buf);
179 if (ret >= 0)
180 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
181 kfree(buf);
182 return ret;
183}
184
185static ssize_t codec_reg_write_file(struct file *file,
186 const char __user *user_buf, size_t count, loff_t *ppos)
187{
188 char buf[32];
189 int buf_size;
190 char *start = buf;
191 unsigned long reg, value;
192 int step = 1;
193 struct snd_soc_codec *codec = file->private_data;
194
195 buf_size = min(count, (sizeof(buf)-1));
196 if (copy_from_user(buf, user_buf, buf_size))
197 return -EFAULT;
198 buf[buf_size] = 0;
199
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000200 if (codec->driver->reg_cache_step)
201 step = codec->driver->reg_cache_step;
Mark Brown2624d5f2009-11-03 21:56:13 +0000202
203 while (*start == ' ')
204 start++;
205 reg = simple_strtoul(start, &start, 16);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000206 if ((reg >= codec->driver->reg_cache_size) || (reg % step))
Mark Brown2624d5f2009-11-03 21:56:13 +0000207 return -EINVAL;
208 while (*start == ' ')
209 start++;
210 if (strict_strtoul(start, 16, &value))
211 return -EINVAL;
Dimitris Papastamose4f078d2010-12-07 16:30:38 +0000212 snd_soc_write(codec, reg, value);
Mark Brown2624d5f2009-11-03 21:56:13 +0000213 return buf_size;
214}
215
216static const struct file_operations codec_reg_fops = {
217 .open = codec_reg_open_file,
218 .read = codec_reg_read_file,
219 .write = codec_reg_write_file,
Arnd Bergmann6038f372010-08-15 18:52:59 +0200220 .llseek = default_llseek,
Mark Brown2624d5f2009-11-03 21:56:13 +0000221};
222
223static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
224{
Jarkko Nikulad6ce4cf2010-11-05 20:35:20 +0200225 struct dentry *debugfs_card_root = codec->card->debugfs_card_root;
226
227 codec->debugfs_codec_root = debugfs_create_dir(codec->name,
228 debugfs_card_root);
Mark Brown2624d5f2009-11-03 21:56:13 +0000229 if (!codec->debugfs_codec_root) {
230 printk(KERN_WARNING
231 "ASoC: Failed to create codec debugfs directory\n");
232 return;
233 }
234
235 codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
236 codec->debugfs_codec_root,
237 codec, &codec_reg_fops);
238 if (!codec->debugfs_reg)
239 printk(KERN_WARNING
240 "ASoC: Failed to create codec register debugfs file\n");
241
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200242 codec->dapm.debugfs_dapm = debugfs_create_dir("dapm",
Mark Brown2624d5f2009-11-03 21:56:13 +0000243 codec->debugfs_codec_root);
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200244 if (!codec->dapm.debugfs_dapm)
Mark Brown2624d5f2009-11-03 21:56:13 +0000245 printk(KERN_WARNING
246 "Failed to create DAPM debugfs directory\n");
247
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200248 snd_soc_dapm_debugfs_init(&codec->dapm);
Mark Brown2624d5f2009-11-03 21:56:13 +0000249}
250
251static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
252{
253 debugfs_remove_recursive(codec->debugfs_codec_root);
254}
255
Mark Brownc3c5a192010-09-15 18:15:14 +0100256static ssize_t codec_list_read_file(struct file *file, char __user *user_buf,
257 size_t count, loff_t *ppos)
258{
259 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
Mark Brown2b194f9d2010-10-13 10:52:16 +0100260 ssize_t len, ret = 0;
Mark Brownc3c5a192010-09-15 18:15:14 +0100261 struct snd_soc_codec *codec;
262
263 if (!buf)
264 return -ENOMEM;
265
Mark Brown2b194f9d2010-10-13 10:52:16 +0100266 list_for_each_entry(codec, &codec_list, list) {
267 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
268 codec->name);
269 if (len >= 0)
270 ret += len;
271 if (ret > PAGE_SIZE) {
272 ret = PAGE_SIZE;
273 break;
274 }
275 }
Mark Brownc3c5a192010-09-15 18:15:14 +0100276
277 if (ret >= 0)
278 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
279
280 kfree(buf);
281
282 return ret;
283}
284
285static const struct file_operations codec_list_fops = {
286 .read = codec_list_read_file,
287 .llseek = default_llseek,/* read accesses f_pos */
288};
289
Mark Brownf3208782010-09-15 18:19:07 +0100290static ssize_t dai_list_read_file(struct file *file, char __user *user_buf,
291 size_t count, loff_t *ppos)
292{
293 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
Mark Brown2b194f9d2010-10-13 10:52:16 +0100294 ssize_t len, ret = 0;
Mark Brownf3208782010-09-15 18:19:07 +0100295 struct snd_soc_dai *dai;
296
297 if (!buf)
298 return -ENOMEM;
299
Mark Brown2b194f9d2010-10-13 10:52:16 +0100300 list_for_each_entry(dai, &dai_list, list) {
301 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n", dai->name);
302 if (len >= 0)
303 ret += len;
304 if (ret > PAGE_SIZE) {
305 ret = PAGE_SIZE;
306 break;
307 }
308 }
Mark Brownf3208782010-09-15 18:19:07 +0100309
Mark Brown2b194f9d2010-10-13 10:52:16 +0100310 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
Mark Brownf3208782010-09-15 18:19:07 +0100311
312 kfree(buf);
313
314 return ret;
315}
316
317static const struct file_operations dai_list_fops = {
318 .read = dai_list_read_file,
319 .llseek = default_llseek,/* read accesses f_pos */
320};
321
Mark Brown19c7ac22010-09-15 18:22:40 +0100322static ssize_t platform_list_read_file(struct file *file,
323 char __user *user_buf,
324 size_t count, loff_t *ppos)
325{
326 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
Mark Brown2b194f9d2010-10-13 10:52:16 +0100327 ssize_t len, ret = 0;
Mark Brown19c7ac22010-09-15 18:22:40 +0100328 struct snd_soc_platform *platform;
329
330 if (!buf)
331 return -ENOMEM;
332
Mark Brown2b194f9d2010-10-13 10:52:16 +0100333 list_for_each_entry(platform, &platform_list, list) {
334 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
335 platform->name);
336 if (len >= 0)
337 ret += len;
338 if (ret > PAGE_SIZE) {
339 ret = PAGE_SIZE;
340 break;
341 }
342 }
Mark Brown19c7ac22010-09-15 18:22:40 +0100343
Mark Brown2b194f9d2010-10-13 10:52:16 +0100344 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
Mark Brown19c7ac22010-09-15 18:22:40 +0100345
346 kfree(buf);
347
348 return ret;
349}
350
351static const struct file_operations platform_list_fops = {
352 .read = platform_list_read_file,
353 .llseek = default_llseek,/* read accesses f_pos */
354};
355
Jarkko Nikulaa6052152010-11-05 20:35:19 +0200356static void soc_init_card_debugfs(struct snd_soc_card *card)
357{
358 card->debugfs_card_root = debugfs_create_dir(card->name,
359 debugfs_root);
Jarkko Nikula3a45b862010-11-05 20:35:21 +0200360 if (!card->debugfs_card_root) {
Jarkko Nikulaa6052152010-11-05 20:35:19 +0200361 dev_warn(card->dev,
362 "ASoC: Failed to create codec debugfs directory\n");
Jarkko Nikula3a45b862010-11-05 20:35:21 +0200363 return;
364 }
365
366 card->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0644,
367 card->debugfs_card_root,
368 &card->pop_time);
369 if (!card->debugfs_pop_time)
370 dev_warn(card->dev,
371 "Failed to create pop time debugfs file\n");
Jarkko Nikulaa6052152010-11-05 20:35:19 +0200372}
373
374static void soc_cleanup_card_debugfs(struct snd_soc_card *card)
375{
376 debugfs_remove_recursive(card->debugfs_card_root);
377}
378
Mark Brown2624d5f2009-11-03 21:56:13 +0000379#else
380
381static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
382{
383}
384
385static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
386{
387}
Axel Linb95fccb2010-11-09 17:06:44 +0800388
389static inline void soc_init_card_debugfs(struct snd_soc_card *card)
390{
391}
392
393static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card)
394{
395}
Mark Brown2624d5f2009-11-03 21:56:13 +0000396#endif
397
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200398#ifdef CONFIG_SND_SOC_AC97_BUS
399/* unregister ac97 codec */
400static int soc_ac97_dev_unregister(struct snd_soc_codec *codec)
401{
402 if (codec->ac97->dev.bus)
403 device_unregister(&codec->ac97->dev);
404 return 0;
405}
406
407/* stop no dev release warning */
408static void soc_ac97_device_release(struct device *dev){}
409
410/* register ac97 codec to bus */
411static int soc_ac97_dev_register(struct snd_soc_codec *codec)
412{
413 int err;
414
415 codec->ac97->dev.bus = &ac97_bus_type;
Mark Brown4ac5c612009-04-01 19:35:01 +0100416 codec->ac97->dev.parent = codec->card->dev;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200417 codec->ac97->dev.release = soc_ac97_device_release;
418
Kay Sieversbb072bf2008-11-02 03:50:35 +0100419 dev_set_name(&codec->ac97->dev, "%d-%d:%s",
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000420 codec->card->snd_card->number, 0, codec->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200421 err = device_register(&codec->ac97->dev);
422 if (err < 0) {
423 snd_printk(KERN_ERR "Can't register ac97 bus\n");
424 codec->ac97->dev.bus = NULL;
425 return err;
426 }
427 return 0;
428}
429#endif
430
Mark Brown06f409d2009-04-07 18:10:13 +0100431static int soc_pcm_apply_symmetry(struct snd_pcm_substream *substream)
432{
433 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000434 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
435 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Mark Brown06f409d2009-04-07 18:10:13 +0100436 int ret;
437
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000438 if (codec_dai->driver->symmetric_rates || cpu_dai->driver->symmetric_rates ||
439 rtd->dai_link->symmetric_rates) {
440 dev_dbg(&rtd->dev, "Symmetry forces %dHz rate\n",
441 rtd->rate);
Mark Brown06f409d2009-04-07 18:10:13 +0100442
443 ret = snd_pcm_hw_constraint_minmax(substream->runtime,
444 SNDRV_PCM_HW_PARAM_RATE,
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000445 rtd->rate,
446 rtd->rate);
Mark Brown06f409d2009-04-07 18:10:13 +0100447 if (ret < 0) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000448 dev_err(&rtd->dev,
Mark Brown06f409d2009-04-07 18:10:13 +0100449 "Unable to apply rate symmetry constraint: %d\n", ret);
450 return ret;
451 }
452 }
453
454 return 0;
455}
456
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200457/*
458 * Called by ALSA when a PCM substream is opened, the runtime->hw record is
459 * then initialized and any private data can be allocated. This also calls
460 * startup for the cpu DAI, platform, machine and codec DAI.
461 */
462static int soc_pcm_open(struct snd_pcm_substream *substream)
463{
464 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200465 struct snd_pcm_runtime *runtime = substream->runtime;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000466 struct snd_soc_platform *platform = rtd->platform;
467 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
468 struct snd_soc_dai *codec_dai = rtd->codec_dai;
469 struct snd_soc_dai_driver *cpu_dai_drv = cpu_dai->driver;
470 struct snd_soc_dai_driver *codec_dai_drv = codec_dai->driver;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200471 int ret = 0;
472
473 mutex_lock(&pcm_mutex);
474
475 /* startup the audio subsystem */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000476 if (cpu_dai->driver->ops->startup) {
477 ret = cpu_dai->driver->ops->startup(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200478 if (ret < 0) {
479 printk(KERN_ERR "asoc: can't open interface %s\n",
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100480 cpu_dai->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200481 goto out;
482 }
483 }
484
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000485 if (platform->driver->ops->open) {
486 ret = platform->driver->ops->open(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200487 if (ret < 0) {
488 printk(KERN_ERR "asoc: can't open platform %s\n", platform->name);
489 goto platform_err;
490 }
491 }
492
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000493 if (codec_dai->driver->ops->startup) {
494 ret = codec_dai->driver->ops->startup(substream, codec_dai);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100495 if (ret < 0) {
496 printk(KERN_ERR "asoc: can't open codec %s\n",
497 codec_dai->name);
498 goto codec_dai_err;
499 }
500 }
501
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000502 if (rtd->dai_link->ops && rtd->dai_link->ops->startup) {
503 ret = rtd->dai_link->ops->startup(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200504 if (ret < 0) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000505 printk(KERN_ERR "asoc: %s startup failed\n", rtd->dai_link->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200506 goto machine_err;
507 }
508 }
509
Mark Browna00f90f2010-12-02 16:24:24 +0000510 /* Check that the codec and cpu DAIs are compatible */
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200511 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
512 runtime->hw.rate_min =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000513 max(codec_dai_drv->playback.rate_min,
514 cpu_dai_drv->playback.rate_min);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200515 runtime->hw.rate_max =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000516 min(codec_dai_drv->playback.rate_max,
517 cpu_dai_drv->playback.rate_max);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200518 runtime->hw.channels_min =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000519 max(codec_dai_drv->playback.channels_min,
520 cpu_dai_drv->playback.channels_min);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200521 runtime->hw.channels_max =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000522 min(codec_dai_drv->playback.channels_max,
523 cpu_dai_drv->playback.channels_max);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100524 runtime->hw.formats =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000525 codec_dai_drv->playback.formats & cpu_dai_drv->playback.formats;
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100526 runtime->hw.rates =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000527 codec_dai_drv->playback.rates & cpu_dai_drv->playback.rates;
528 if (codec_dai_drv->playback.rates
Jassi Brard9ad6292010-03-12 13:38:52 +0900529 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000530 runtime->hw.rates |= cpu_dai_drv->playback.rates;
531 if (cpu_dai_drv->playback.rates
Jassi Brard9ad6292010-03-12 13:38:52 +0900532 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000533 runtime->hw.rates |= codec_dai_drv->playback.rates;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200534 } else {
535 runtime->hw.rate_min =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000536 max(codec_dai_drv->capture.rate_min,
537 cpu_dai_drv->capture.rate_min);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200538 runtime->hw.rate_max =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000539 min(codec_dai_drv->capture.rate_max,
540 cpu_dai_drv->capture.rate_max);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200541 runtime->hw.channels_min =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000542 max(codec_dai_drv->capture.channels_min,
543 cpu_dai_drv->capture.channels_min);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200544 runtime->hw.channels_max =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000545 min(codec_dai_drv->capture.channels_max,
546 cpu_dai_drv->capture.channels_max);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100547 runtime->hw.formats =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000548 codec_dai_drv->capture.formats & cpu_dai_drv->capture.formats;
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100549 runtime->hw.rates =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000550 codec_dai_drv->capture.rates & cpu_dai_drv->capture.rates;
551 if (codec_dai_drv->capture.rates
Jassi Brard9ad6292010-03-12 13:38:52 +0900552 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000553 runtime->hw.rates |= cpu_dai_drv->capture.rates;
554 if (cpu_dai_drv->capture.rates
Jassi Brard9ad6292010-03-12 13:38:52 +0900555 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000556 runtime->hw.rates |= codec_dai_drv->capture.rates;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200557 }
558
559 snd_pcm_limit_hw_rates(runtime);
560 if (!runtime->hw.rates) {
561 printk(KERN_ERR "asoc: %s <-> %s No matching rates\n",
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100562 codec_dai->name, cpu_dai->name);
Jassi Brarbb1c0472010-02-25 11:24:53 +0900563 goto config_err;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200564 }
565 if (!runtime->hw.formats) {
566 printk(KERN_ERR "asoc: %s <-> %s No matching formats\n",
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100567 codec_dai->name, cpu_dai->name);
Jassi Brarbb1c0472010-02-25 11:24:53 +0900568 goto config_err;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200569 }
570 if (!runtime->hw.channels_min || !runtime->hw.channels_max) {
571 printk(KERN_ERR "asoc: %s <-> %s No matching channels\n",
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000572 codec_dai->name, cpu_dai->name);
Jassi Brarbb1c0472010-02-25 11:24:53 +0900573 goto config_err;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200574 }
575
Mark Brown06f409d2009-04-07 18:10:13 +0100576 /* Symmetry only applies if we've already got an active stream. */
577 if (cpu_dai->active || codec_dai->active) {
578 ret = soc_pcm_apply_symmetry(substream);
579 if (ret != 0)
Jassi Brarbb1c0472010-02-25 11:24:53 +0900580 goto config_err;
Mark Brown06f409d2009-04-07 18:10:13 +0100581 }
582
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000583 pr_debug("asoc: %s <-> %s info:\n",
584 codec_dai->name, cpu_dai->name);
Mark Brownf24368c2008-10-21 21:45:08 +0100585 pr_debug("asoc: rate mask 0x%x\n", runtime->hw.rates);
586 pr_debug("asoc: min ch %d max ch %d\n", runtime->hw.channels_min,
587 runtime->hw.channels_max);
588 pr_debug("asoc: min rate %d max rate %d\n", runtime->hw.rate_min,
589 runtime->hw.rate_max);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200590
Jassi Brar14dc5732010-02-26 09:12:32 +0900591 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000592 cpu_dai->playback_active++;
593 codec_dai->playback_active++;
Jassi Brar14dc5732010-02-26 09:12:32 +0900594 } else {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000595 cpu_dai->capture_active++;
596 codec_dai->capture_active++;
Jassi Brar14dc5732010-02-26 09:12:32 +0900597 }
598 cpu_dai->active++;
599 codec_dai->active++;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000600 rtd->codec->active++;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200601 mutex_unlock(&pcm_mutex);
602 return 0;
603
Jassi Brarbb1c0472010-02-25 11:24:53 +0900604config_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000605 if (rtd->dai_link->ops && rtd->dai_link->ops->shutdown)
606 rtd->dai_link->ops->shutdown(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200607
Jassi Brarbb1c0472010-02-25 11:24:53 +0900608machine_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000609 if (codec_dai->driver->ops->shutdown)
610 codec_dai->driver->ops->shutdown(substream, codec_dai);
Jassi Brarbb1c0472010-02-25 11:24:53 +0900611
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100612codec_dai_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000613 if (platform->driver->ops->close)
614 platform->driver->ops->close(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200615
616platform_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000617 if (cpu_dai->driver->ops->shutdown)
618 cpu_dai->driver->ops->shutdown(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200619out:
620 mutex_unlock(&pcm_mutex);
621 return ret;
622}
623
624/*
Robert P. J. Day3a4fa0a2007-10-19 23:10:43 +0200625 * Power down the audio subsystem pmdown_time msecs after close is called.
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200626 * This is to ensure there are no pops or clicks in between any music tracks
627 * due to DAPM power cycling.
628 */
Andrew Morton4484bb22006-12-15 09:30:07 +0100629static void close_delayed_work(struct work_struct *work)
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200630{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000631 struct snd_soc_pcm_runtime *rtd =
632 container_of(work, struct snd_soc_pcm_runtime, delayed_work.work);
633 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200634
635 mutex_lock(&pcm_mutex);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200636
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000637 pr_debug("pop wq checking: %s status: %s waiting: %s\n",
638 codec_dai->driver->playback.stream_name,
639 codec_dai->playback_active ? "active" : "inactive",
640 codec_dai->pop_wait ? "yes" : "no");
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200641
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000642 /* are we waiting on this codec DAI stream */
643 if (codec_dai->pop_wait == 1) {
644 codec_dai->pop_wait = 0;
645 snd_soc_dapm_stream_event(rtd,
646 codec_dai->driver->playback.stream_name,
647 SND_SOC_DAPM_STREAM_STOP);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200648 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000649
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200650 mutex_unlock(&pcm_mutex);
651}
652
653/*
654 * Called by ALSA when a PCM substream is closed. Private data can be
655 * freed here. The cpu DAI, codec DAI, machine and platform are also
656 * shutdown.
657 */
658static int soc_codec_close(struct snd_pcm_substream *substream)
659{
660 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000661 struct snd_soc_platform *platform = rtd->platform;
662 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
663 struct snd_soc_dai *codec_dai = rtd->codec_dai;
664 struct snd_soc_codec *codec = rtd->codec;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200665
666 mutex_lock(&pcm_mutex);
667
Jassi Brar14dc5732010-02-26 09:12:32 +0900668 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000669 cpu_dai->playback_active--;
670 codec_dai->playback_active--;
Jassi Brar14dc5732010-02-26 09:12:32 +0900671 } else {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000672 cpu_dai->capture_active--;
673 codec_dai->capture_active--;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200674 }
Jassi Brar14dc5732010-02-26 09:12:32 +0900675
676 cpu_dai->active--;
677 codec_dai->active--;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200678 codec->active--;
679
Mark Brown6010b2d2008-09-06 18:33:24 +0100680 /* Muting the DAC suppresses artifacts caused during digital
681 * shutdown, for example from stopping clocks.
682 */
683 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
684 snd_soc_dai_digital_mute(codec_dai, 1);
685
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000686 if (cpu_dai->driver->ops->shutdown)
687 cpu_dai->driver->ops->shutdown(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200688
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000689 if (codec_dai->driver->ops->shutdown)
690 codec_dai->driver->ops->shutdown(substream, codec_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200691
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000692 if (rtd->dai_link->ops && rtd->dai_link->ops->shutdown)
693 rtd->dai_link->ops->shutdown(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200694
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000695 if (platform->driver->ops->close)
696 platform->driver->ops->close(substream);
697 cpu_dai->runtime = NULL;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200698
699 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
700 /* start delayed pop wq here for playback streams */
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100701 codec_dai->pop_wait = 1;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000702 schedule_delayed_work(&rtd->delayed_work,
703 msecs_to_jiffies(rtd->pmdown_time));
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200704 } else {
705 /* capture streams can be powered down now */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000706 snd_soc_dapm_stream_event(rtd,
707 codec_dai->driver->capture.stream_name,
Liam Girdwood0b4d2212008-01-10 14:36:20 +0100708 SND_SOC_DAPM_STREAM_STOP);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200709 }
710
711 mutex_unlock(&pcm_mutex);
712 return 0;
713}
714
715/*
716 * Called by ALSA when the PCM substream is prepared, can set format, sample
717 * rate, etc. This function is non atomic and can be called multiple times,
718 * it can refer to the runtime info.
719 */
720static int soc_pcm_prepare(struct snd_pcm_substream *substream)
721{
722 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000723 struct snd_soc_platform *platform = rtd->platform;
724 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
725 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200726 int ret = 0;
727
728 mutex_lock(&pcm_mutex);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100729
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000730 if (rtd->dai_link->ops && rtd->dai_link->ops->prepare) {
731 ret = rtd->dai_link->ops->prepare(substream);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100732 if (ret < 0) {
733 printk(KERN_ERR "asoc: machine prepare error\n");
734 goto out;
735 }
736 }
737
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000738 if (platform->driver->ops->prepare) {
739 ret = platform->driver->ops->prepare(substream);
Liam Girdwooda71a4682006-10-19 20:35:56 +0200740 if (ret < 0) {
741 printk(KERN_ERR "asoc: platform prepare error\n");
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200742 goto out;
Liam Girdwooda71a4682006-10-19 20:35:56 +0200743 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200744 }
745
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000746 if (codec_dai->driver->ops->prepare) {
747 ret = codec_dai->driver->ops->prepare(substream, codec_dai);
Liam Girdwooda71a4682006-10-19 20:35:56 +0200748 if (ret < 0) {
749 printk(KERN_ERR "asoc: codec DAI prepare error\n");
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200750 goto out;
Liam Girdwooda71a4682006-10-19 20:35:56 +0200751 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200752 }
753
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000754 if (cpu_dai->driver->ops->prepare) {
755 ret = cpu_dai->driver->ops->prepare(substream, cpu_dai);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100756 if (ret < 0) {
757 printk(KERN_ERR "asoc: cpu DAI prepare error\n");
758 goto out;
759 }
760 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200761
Mark Brownd45f6212008-10-14 13:58:36 +0100762 /* cancel any delayed stream shutdown that is pending */
763 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
764 codec_dai->pop_wait) {
765 codec_dai->pop_wait = 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000766 cancel_delayed_work(&rtd->delayed_work);
Mark Brownd45f6212008-10-14 13:58:36 +0100767 }
768
Mark Brown452c5ea2009-05-17 21:41:23 +0100769 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000770 snd_soc_dapm_stream_event(rtd,
771 codec_dai->driver->playback.stream_name,
Mark Brown452c5ea2009-05-17 21:41:23 +0100772 SND_SOC_DAPM_STREAM_START);
773 else
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000774 snd_soc_dapm_stream_event(rtd,
775 codec_dai->driver->capture.stream_name,
Mark Brown452c5ea2009-05-17 21:41:23 +0100776 SND_SOC_DAPM_STREAM_START);
Mark Brownd45f6212008-10-14 13:58:36 +0100777
Mark Brown452c5ea2009-05-17 21:41:23 +0100778 snd_soc_dai_digital_mute(codec_dai, 0);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200779
780out:
781 mutex_unlock(&pcm_mutex);
782 return ret;
783}
784
785/*
786 * Called by ALSA when the hardware params are set by application. This
787 * function can also be called multiple times and can allocate buffers
788 * (using snd_pcm_lib_* ). It's non-atomic.
789 */
790static int soc_pcm_hw_params(struct snd_pcm_substream *substream,
791 struct snd_pcm_hw_params *params)
792{
793 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000794 struct snd_soc_platform *platform = rtd->platform;
795 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
796 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200797 int ret = 0;
798
799 mutex_lock(&pcm_mutex);
800
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000801 if (rtd->dai_link->ops && rtd->dai_link->ops->hw_params) {
802 ret = rtd->dai_link->ops->hw_params(substream, params);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200803 if (ret < 0) {
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100804 printk(KERN_ERR "asoc: machine hw_params failed\n");
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200805 goto out;
806 }
807 }
808
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000809 if (codec_dai->driver->ops->hw_params) {
810 ret = codec_dai->driver->ops->hw_params(substream, params, codec_dai);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100811 if (ret < 0) {
812 printk(KERN_ERR "asoc: can't set codec %s hw params\n",
813 codec_dai->name);
814 goto codec_err;
815 }
816 }
817
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000818 if (cpu_dai->driver->ops->hw_params) {
819 ret = cpu_dai->driver->ops->hw_params(substream, params, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200820 if (ret < 0) {
Mark Brown3ff3f642008-05-19 12:32:25 +0200821 printk(KERN_ERR "asoc: interface %s hw params failed\n",
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100822 cpu_dai->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200823 goto interface_err;
824 }
825 }
826
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000827 if (platform->driver->ops->hw_params) {
828 ret = platform->driver->ops->hw_params(substream, params);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200829 if (ret < 0) {
Mark Brown3ff3f642008-05-19 12:32:25 +0200830 printk(KERN_ERR "asoc: platform %s hw params failed\n",
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200831 platform->name);
832 goto platform_err;
833 }
834 }
835
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000836 rtd->rate = params_rate(params);
Mark Brown06f409d2009-04-07 18:10:13 +0100837
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200838out:
839 mutex_unlock(&pcm_mutex);
840 return ret;
841
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200842platform_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000843 if (cpu_dai->driver->ops->hw_free)
844 cpu_dai->driver->ops->hw_free(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200845
846interface_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000847 if (codec_dai->driver->ops->hw_free)
848 codec_dai->driver->ops->hw_free(substream, codec_dai);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100849
850codec_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000851 if (rtd->dai_link->ops && rtd->dai_link->ops->hw_free)
852 rtd->dai_link->ops->hw_free(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200853
854 mutex_unlock(&pcm_mutex);
855 return ret;
856}
857
858/*
Mark Browna00f90f2010-12-02 16:24:24 +0000859 * Frees resources allocated by hw_params, can be called multiple times
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200860 */
861static int soc_pcm_hw_free(struct snd_pcm_substream *substream)
862{
863 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000864 struct snd_soc_platform *platform = rtd->platform;
865 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
866 struct snd_soc_dai *codec_dai = rtd->codec_dai;
867 struct snd_soc_codec *codec = rtd->codec;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200868
869 mutex_lock(&pcm_mutex);
870
871 /* apply codec digital mute */
Liam Girdwood8c6529d2008-07-08 13:19:13 +0100872 if (!codec->active)
873 snd_soc_dai_digital_mute(codec_dai, 1);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200874
875 /* free any machine hw params */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000876 if (rtd->dai_link->ops && rtd->dai_link->ops->hw_free)
877 rtd->dai_link->ops->hw_free(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200878
879 /* free any DMA resources */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000880 if (platform->driver->ops->hw_free)
881 platform->driver->ops->hw_free(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200882
Mark Browna00f90f2010-12-02 16:24:24 +0000883 /* now free hw params for the DAIs */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000884 if (codec_dai->driver->ops->hw_free)
885 codec_dai->driver->ops->hw_free(substream, codec_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200886
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000887 if (cpu_dai->driver->ops->hw_free)
888 cpu_dai->driver->ops->hw_free(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200889
890 mutex_unlock(&pcm_mutex);
891 return 0;
892}
893
894static int soc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
895{
896 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000897 struct snd_soc_platform *platform = rtd->platform;
898 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
899 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200900 int ret;
901
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000902 if (codec_dai->driver->ops->trigger) {
903 ret = codec_dai->driver->ops->trigger(substream, cmd, codec_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200904 if (ret < 0)
905 return ret;
906 }
907
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000908 if (platform->driver->ops->trigger) {
909 ret = platform->driver->ops->trigger(substream, cmd);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200910 if (ret < 0)
911 return ret;
912 }
913
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000914 if (cpu_dai->driver->ops->trigger) {
915 ret = cpu_dai->driver->ops->trigger(substream, cmd, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200916 if (ret < 0)
917 return ret;
918 }
919 return 0;
920}
921
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200922/*
923 * soc level wrapper for pointer callback
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200924 * If cpu_dai, codec_dai, platform driver has the delay callback, than
925 * the runtime->delay will be updated accordingly.
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200926 */
927static snd_pcm_uframes_t soc_pcm_pointer(struct snd_pcm_substream *substream)
928{
929 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000930 struct snd_soc_platform *platform = rtd->platform;
931 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
932 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200933 struct snd_pcm_runtime *runtime = substream->runtime;
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200934 snd_pcm_uframes_t offset = 0;
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200935 snd_pcm_sframes_t delay = 0;
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200936
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000937 if (platform->driver->ops->pointer)
938 offset = platform->driver->ops->pointer(substream);
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200939
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000940 if (cpu_dai->driver->ops->delay)
941 delay += cpu_dai->driver->ops->delay(substream, cpu_dai);
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200942
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000943 if (codec_dai->driver->ops->delay)
944 delay += codec_dai->driver->ops->delay(substream, codec_dai);
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200945
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000946 if (platform->driver->delay)
947 delay += platform->driver->delay(substream, codec_dai);
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200948
949 runtime->delay = delay;
950
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200951 return offset;
952}
953
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200954/* ASoC PCM operations */
955static struct snd_pcm_ops soc_pcm_ops = {
956 .open = soc_pcm_open,
957 .close = soc_codec_close,
958 .hw_params = soc_pcm_hw_params,
959 .hw_free = soc_pcm_hw_free,
960 .prepare = soc_pcm_prepare,
961 .trigger = soc_pcm_trigger,
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200962 .pointer = soc_pcm_pointer,
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200963};
964
965#ifdef CONFIG_PM
966/* powers down audio subsystem for suspend */
Mark Brown416356f2009-06-30 19:05:15 +0100967static int soc_suspend(struct device *dev)
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200968{
Mark Brown416356f2009-06-30 19:05:15 +0100969 struct platform_device *pdev = to_platform_device(dev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000970 struct snd_soc_card *card = platform_get_drvdata(pdev);
Jarkko Nikula2eea3922010-11-25 17:47:38 +0200971 struct snd_soc_codec *codec;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200972 int i;
973
Daniel Macke3509ff2009-06-03 17:44:49 +0200974 /* If the initialization of this soc device failed, there is no codec
975 * associated with it. Just bail out in this case.
976 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000977 if (list_empty(&card->codec_dev_list))
Daniel Macke3509ff2009-06-03 17:44:49 +0200978 return 0;
979
Andy Green6ed25972008-06-13 16:24:05 +0100980 /* Due to the resume being scheduled into a workqueue we could
981 * suspend before that's finished - wait for it to complete.
982 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000983 snd_power_lock(card->snd_card);
984 snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0);
985 snd_power_unlock(card->snd_card);
Andy Green6ed25972008-06-13 16:24:05 +0100986
987 /* we're going to block userspace touching us until resume completes */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000988 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
Andy Green6ed25972008-06-13 16:24:05 +0100989
Mark Browna00f90f2010-12-02 16:24:24 +0000990 /* mute any active DACs */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000991 for (i = 0; i < card->num_rtd; i++) {
992 struct snd_soc_dai *dai = card->rtd[i].codec_dai;
993 struct snd_soc_dai_driver *drv = dai->driver;
Mark Brown3efab7d2010-05-09 13:25:43 +0100994
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000995 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +0100996 continue;
997
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000998 if (drv->ops->digital_mute && dai->playback_active)
999 drv->ops->digital_mute(dai, 1);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001000 }
1001
Liam Girdwood4ccab3e2008-01-10 14:39:01 +01001002 /* suspend all pcms */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001003 for (i = 0; i < card->num_rtd; i++) {
1004 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001005 continue;
1006
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001007 snd_pcm_suspend_all(card->rtd[i].pcm);
Mark Brown3efab7d2010-05-09 13:25:43 +01001008 }
Liam Girdwood4ccab3e2008-01-10 14:39:01 +01001009
Mark Brown87506542008-11-18 20:50:34 +00001010 if (card->suspend_pre)
Mark Brown416356f2009-06-30 19:05:15 +01001011 card->suspend_pre(pdev, PMSG_SUSPEND);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001012
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001013 for (i = 0; i < card->num_rtd; i++) {
1014 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1015 struct snd_soc_platform *platform = card->rtd[i].platform;
Mark Brown3efab7d2010-05-09 13:25:43 +01001016
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001017 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001018 continue;
1019
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001020 if (cpu_dai->driver->suspend && !cpu_dai->driver->ac97_control)
1021 cpu_dai->driver->suspend(cpu_dai);
1022 if (platform->driver->suspend && !platform->suspended) {
1023 platform->driver->suspend(cpu_dai);
1024 platform->suspended = 1;
Mark Brown1547aba2010-05-07 21:11:40 +01001025 }
1026 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001027
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001028 /* close any waiting streams and save state */
1029 for (i = 0; i < card->num_rtd; i++) {
Tejun Heo5b84ba22010-12-11 17:51:26 +01001030 flush_delayed_work_sync(&card->rtd[i].delayed_work);
Liam Girdwoodce6120c2010-11-05 15:53:46 +02001031 card->rtd[i].codec->dapm.suspend_bias_level = card->rtd[i].codec->dapm.bias_level;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001032 }
Mark Brown3efab7d2010-05-09 13:25:43 +01001033
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001034 for (i = 0; i < card->num_rtd; i++) {
1035 struct snd_soc_dai_driver *driver = card->rtd[i].codec_dai->driver;
1036
1037 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001038 continue;
1039
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001040 if (driver->playback.stream_name != NULL)
1041 snd_soc_dapm_stream_event(&card->rtd[i], driver->playback.stream_name,
1042 SND_SOC_DAPM_STREAM_SUSPEND);
1043
1044 if (driver->capture.stream_name != NULL)
1045 snd_soc_dapm_stream_event(&card->rtd[i], driver->capture.stream_name,
1046 SND_SOC_DAPM_STREAM_SUSPEND);
1047 }
1048
1049 /* suspend all CODECs */
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001050 list_for_each_entry(codec, &card->codec_dev_list, card_list) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001051 /* If there are paths active then the CODEC will be held with
1052 * bias _ON and should not be suspended. */
1053 if (!codec->suspended && codec->driver->suspend) {
Liam Girdwoodce6120c2010-11-05 15:53:46 +02001054 switch (codec->dapm.bias_level) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001055 case SND_SOC_BIAS_STANDBY:
1056 case SND_SOC_BIAS_OFF:
1057 codec->driver->suspend(codec, PMSG_SUSPEND);
1058 codec->suspended = 1;
1059 break;
1060 default:
1061 dev_dbg(codec->dev, "CODEC is on over suspend\n");
1062 break;
1063 }
1064 }
1065 }
1066
1067 for (i = 0; i < card->num_rtd; i++) {
1068 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1069
1070 if (card->rtd[i].dai_link->ignore_suspend)
1071 continue;
1072
1073 if (cpu_dai->driver->suspend && cpu_dai->driver->ac97_control)
1074 cpu_dai->driver->suspend(cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001075 }
1076
Mark Brown87506542008-11-18 20:50:34 +00001077 if (card->suspend_post)
Mark Brown416356f2009-06-30 19:05:15 +01001078 card->suspend_post(pdev, PMSG_SUSPEND);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001079
1080 return 0;
1081}
1082
Andy Green6ed25972008-06-13 16:24:05 +01001083/* deferred resume work, so resume can complete before we finished
1084 * setting our codec back up, which can be very slow on I2C
1085 */
1086static void soc_resume_deferred(struct work_struct *work)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001087{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001088 struct snd_soc_card *card =
1089 container_of(work, struct snd_soc_card, deferred_resume_work);
1090 struct platform_device *pdev = to_platform_device(card->dev);
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001091 struct snd_soc_codec *codec;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001092 int i;
1093
Andy Green6ed25972008-06-13 16:24:05 +01001094 /* our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
1095 * so userspace apps are blocked from touching us
1096 */
1097
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001098 dev_dbg(card->dev, "starting resume work\n");
Andy Green6ed25972008-06-13 16:24:05 +01001099
Mark Brown99497882010-05-07 20:24:05 +01001100 /* Bring us up into D2 so that DAPM starts enabling things */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001101 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
Mark Brown99497882010-05-07 20:24:05 +01001102
Mark Brown87506542008-11-18 20:50:34 +00001103 if (card->resume_pre)
1104 card->resume_pre(pdev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001105
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001106 /* resume AC97 DAIs */
1107 for (i = 0; i < card->num_rtd; i++) {
1108 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
Mark Brown3efab7d2010-05-09 13:25:43 +01001109
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001110 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001111 continue;
1112
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001113 if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control)
1114 cpu_dai->driver->resume(cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001115 }
1116
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001117 list_for_each_entry(codec, &card->codec_dev_list, card_list) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001118 /* If the CODEC was idle over suspend then it will have been
1119 * left with bias OFF or STANDBY and suspended so we must now
1120 * resume. Otherwise the suspend was suppressed.
1121 */
1122 if (codec->driver->resume && codec->suspended) {
Liam Girdwoodce6120c2010-11-05 15:53:46 +02001123 switch (codec->dapm.bias_level) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001124 case SND_SOC_BIAS_STANDBY:
1125 case SND_SOC_BIAS_OFF:
1126 codec->driver->resume(codec);
1127 codec->suspended = 0;
1128 break;
1129 default:
1130 dev_dbg(codec->dev, "CODEC was on over suspend\n");
1131 break;
1132 }
Mark Brown1547aba2010-05-07 21:11:40 +01001133 }
1134 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001135
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001136 for (i = 0; i < card->num_rtd; i++) {
1137 struct snd_soc_dai_driver *driver = card->rtd[i].codec_dai->driver;
Mark Brown3efab7d2010-05-09 13:25:43 +01001138
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001139 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001140 continue;
1141
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001142 if (driver->playback.stream_name != NULL)
1143 snd_soc_dapm_stream_event(&card->rtd[i], driver->playback.stream_name,
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001144 SND_SOC_DAPM_STREAM_RESUME);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001145
1146 if (driver->capture.stream_name != NULL)
1147 snd_soc_dapm_stream_event(&card->rtd[i], driver->capture.stream_name,
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001148 SND_SOC_DAPM_STREAM_RESUME);
1149 }
1150
Mark Brown3ff3f642008-05-19 12:32:25 +02001151 /* unmute any active DACs */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001152 for (i = 0; i < card->num_rtd; i++) {
1153 struct snd_soc_dai *dai = card->rtd[i].codec_dai;
1154 struct snd_soc_dai_driver *drv = dai->driver;
Mark Brown3efab7d2010-05-09 13:25:43 +01001155
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001156 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001157 continue;
1158
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001159 if (drv->ops->digital_mute && dai->playback_active)
1160 drv->ops->digital_mute(dai, 0);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001161 }
1162
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001163 for (i = 0; i < card->num_rtd; i++) {
1164 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1165 struct snd_soc_platform *platform = card->rtd[i].platform;
Mark Brown3efab7d2010-05-09 13:25:43 +01001166
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001167 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001168 continue;
1169
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001170 if (cpu_dai->driver->resume && !cpu_dai->driver->ac97_control)
1171 cpu_dai->driver->resume(cpu_dai);
1172 if (platform->driver->resume && platform->suspended) {
1173 platform->driver->resume(cpu_dai);
1174 platform->suspended = 0;
1175 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001176 }
1177
Mark Brown87506542008-11-18 20:50:34 +00001178 if (card->resume_post)
1179 card->resume_post(pdev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001180
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001181 dev_dbg(card->dev, "resume work completed\n");
Andy Green6ed25972008-06-13 16:24:05 +01001182
1183 /* userspace can access us now we are back as we were before */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001184 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
Andy Green6ed25972008-06-13 16:24:05 +01001185}
1186
1187/* powers up audio subsystem after a suspend */
Mark Brown416356f2009-06-30 19:05:15 +01001188static int soc_resume(struct device *dev)
Andy Green6ed25972008-06-13 16:24:05 +01001189{
Mark Brown416356f2009-06-30 19:05:15 +01001190 struct platform_device *pdev = to_platform_device(dev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001191 struct snd_soc_card *card = platform_get_drvdata(pdev);
1192 int i;
Peter Ujfalusib9dd94a2010-02-22 13:27:13 +02001193
Mark Brown64ab9ba2009-03-31 11:27:03 +01001194 /* AC97 devices might have other drivers hanging off them so
1195 * need to resume immediately. Other drivers don't have that
1196 * problem and may take a substantial amount of time to resume
1197 * due to I/O costs and anti-pop so handle them out of line.
1198 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001199 for (i = 0; i < card->num_rtd; i++) {
1200 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1201 if (cpu_dai->driver->ac97_control) {
1202 dev_dbg(dev, "Resuming AC97 immediately\n");
1203 soc_resume_deferred(&card->deferred_resume_work);
1204 } else {
1205 dev_dbg(dev, "Scheduling resume work\n");
1206 if (!schedule_work(&card->deferred_resume_work))
1207 dev_err(dev, "resume work item may be lost\n");
1208 }
Mark Brown64ab9ba2009-03-31 11:27:03 +01001209 }
Andy Green6ed25972008-06-13 16:24:05 +01001210
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001211 return 0;
1212}
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001213#else
1214#define soc_suspend NULL
1215#define soc_resume NULL
1216#endif
1217
Barry Song02a06d32009-10-16 18:13:38 +08001218static struct snd_soc_dai_ops null_dai_ops = {
1219};
1220
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001221static int soc_bind_dai_link(struct snd_soc_card *card, int num)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001222{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001223 struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1224 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
Mark Brownfe3e78e2009-11-03 22:13:13 +00001225 struct snd_soc_codec *codec;
Mark Brown435c5e22008-12-04 15:32:53 +00001226 struct snd_soc_platform *platform;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001227 struct snd_soc_dai *codec_dai, *cpu_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001228
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001229 if (rtd->complete)
1230 return 1;
1231 dev_dbg(card->dev, "binding %s at idx %d\n", dai_link->name, num);
Mark Brown63084192008-12-02 15:08:03 +00001232
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001233 /* do we already have the CPU DAI for this link ? */
1234 if (rtd->cpu_dai) {
1235 goto find_codec;
1236 }
1237 /* no, then find CPU DAI from registered DAIs*/
1238 list_for_each_entry(cpu_dai, &dai_list, list) {
1239 if (!strcmp(cpu_dai->name, dai_link->cpu_dai_name)) {
1240
1241 if (!try_module_get(cpu_dai->dev->driver->owner))
1242 return -ENODEV;
1243
1244 rtd->cpu_dai = cpu_dai;
1245 goto find_codec;
Mark Brown435c5e22008-12-04 15:32:53 +00001246 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001247 }
1248 dev_dbg(card->dev, "CPU DAI %s not registered\n",
1249 dai_link->cpu_dai_name);
1250
1251find_codec:
1252 /* do we already have the CODEC for this link ? */
1253 if (rtd->codec) {
1254 goto find_platform;
Mark Brownc5af3a22008-11-28 13:29:45 +00001255 }
1256
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001257 /* no, then find CODEC from registered CODECs*/
1258 list_for_each_entry(codec, &codec_list, list) {
1259 if (!strcmp(codec->name, dai_link->codec_name)) {
1260 rtd->codec = codec;
Mark Brown6b05eda2008-12-08 19:26:48 +00001261
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001262 if (!try_module_get(codec->dev->driver->owner))
1263 return -ENODEV;
Mark Brown435c5e22008-12-04 15:32:53 +00001264
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001265 /* CODEC found, so find CODEC DAI from registered DAIs from this CODEC*/
1266 list_for_each_entry(codec_dai, &dai_list, list) {
1267 if (codec->dev == codec_dai->dev &&
1268 !strcmp(codec_dai->name, dai_link->codec_dai_name)) {
1269 rtd->codec_dai = codec_dai;
1270 goto find_platform;
Mark Brown6b05eda2008-12-08 19:26:48 +00001271 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001272 }
1273 dev_dbg(card->dev, "CODEC DAI %s not registered\n",
1274 dai_link->codec_dai_name);
1275
1276 goto find_platform;
1277 }
1278 }
1279 dev_dbg(card->dev, "CODEC %s not registered\n",
1280 dai_link->codec_name);
1281
1282find_platform:
1283 /* do we already have the CODEC DAI for this link ? */
1284 if (rtd->platform) {
1285 goto out;
1286 }
1287 /* no, then find CPU DAI from registered DAIs*/
1288 list_for_each_entry(platform, &platform_list, list) {
1289 if (!strcmp(platform->name, dai_link->platform_name)) {
1290
1291 if (!try_module_get(platform->dev->driver->owner))
1292 return -ENODEV;
1293
1294 rtd->platform = platform;
1295 goto out;
1296 }
1297 }
1298
1299 dev_dbg(card->dev, "platform %s not registered\n",
1300 dai_link->platform_name);
1301 return 0;
1302
1303out:
1304 /* mark rtd as complete if we found all 4 of our client devices */
1305 if (rtd->codec && rtd->codec_dai && rtd->platform && rtd->cpu_dai) {
1306 rtd->complete = 1;
1307 card->num_rtd++;
1308 }
1309 return 1;
1310}
1311
Jarkko Nikula589c3562010-12-06 16:27:07 +02001312static void soc_remove_codec(struct snd_soc_codec *codec)
1313{
1314 int err;
1315
1316 if (codec->driver->remove) {
1317 err = codec->driver->remove(codec);
1318 if (err < 0)
1319 dev_err(codec->dev,
1320 "asoc: failed to remove %s: %d\n",
1321 codec->name, err);
1322 }
1323
1324 /* Make sure all DAPM widgets are freed */
1325 snd_soc_dapm_free(&codec->dapm);
1326
1327 soc_cleanup_codec_debugfs(codec);
1328 codec->probed = 0;
1329 list_del(&codec->card_list);
1330 module_put(codec->dev->driver->owner);
1331}
1332
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001333static void soc_remove_dai_link(struct snd_soc_card *card, int num)
1334{
1335 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1336 struct snd_soc_codec *codec = rtd->codec;
1337 struct snd_soc_platform *platform = rtd->platform;
1338 struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
1339 int err;
1340
1341 /* unregister the rtd device */
1342 if (rtd->dev_registered) {
1343 device_remove_file(&rtd->dev, &dev_attr_pmdown_time);
Jarkko Nikula589c3562010-12-06 16:27:07 +02001344 device_remove_file(&rtd->dev, &dev_attr_codec_reg);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001345 device_unregister(&rtd->dev);
1346 rtd->dev_registered = 0;
1347 }
1348
1349 /* remove the CODEC DAI */
1350 if (codec_dai && codec_dai->probed) {
1351 if (codec_dai->driver->remove) {
1352 err = codec_dai->driver->remove(codec_dai);
1353 if (err < 0)
1354 printk(KERN_ERR "asoc: failed to remove %s\n", codec_dai->name);
1355 }
1356 codec_dai->probed = 0;
1357 list_del(&codec_dai->card_list);
1358 }
1359
1360 /* remove the platform */
1361 if (platform && platform->probed) {
1362 if (platform->driver->remove) {
1363 err = platform->driver->remove(platform);
1364 if (err < 0)
1365 printk(KERN_ERR "asoc: failed to remove %s\n", platform->name);
1366 }
1367 platform->probed = 0;
1368 list_del(&platform->card_list);
1369 module_put(platform->dev->driver->owner);
1370 }
1371
1372 /* remove the CODEC */
Jarkko Nikula589c3562010-12-06 16:27:07 +02001373 if (codec && codec->probed)
1374 soc_remove_codec(codec);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001375
1376 /* remove the cpu_dai */
1377 if (cpu_dai && cpu_dai->probed) {
1378 if (cpu_dai->driver->remove) {
1379 err = cpu_dai->driver->remove(cpu_dai);
1380 if (err < 0)
1381 printk(KERN_ERR "asoc: failed to remove %s\n", cpu_dai->name);
1382 }
1383 cpu_dai->probed = 0;
1384 list_del(&cpu_dai->card_list);
1385 module_put(cpu_dai->dev->driver->owner);
1386 }
1387}
1388
Jarkko Nikulaead9b912010-11-13 20:40:44 +02001389static void soc_set_name_prefix(struct snd_soc_card *card,
1390 struct snd_soc_codec *codec)
1391{
1392 int i;
1393
Dimitris Papastamosff819b82010-12-02 14:53:03 +00001394 if (card->codec_conf == NULL)
Jarkko Nikulaead9b912010-11-13 20:40:44 +02001395 return;
1396
Dimitris Papastamosff819b82010-12-02 14:53:03 +00001397 for (i = 0; i < card->num_configs; i++) {
1398 struct snd_soc_codec_conf *map = &card->codec_conf[i];
Jarkko Nikulaead9b912010-11-13 20:40:44 +02001399 if (map->dev_name && !strcmp(codec->name, map->dev_name)) {
1400 codec->name_prefix = map->name_prefix;
1401 break;
1402 }
1403 }
1404}
1405
Jarkko Nikula589c3562010-12-06 16:27:07 +02001406static int soc_probe_codec(struct snd_soc_card *card,
1407 struct snd_soc_codec *codec)
1408{
1409 int ret = 0;
1410
1411 codec->card = card;
1412 codec->dapm.card = card;
1413 soc_set_name_prefix(card, codec);
1414
1415 if (codec->driver->probe) {
1416 ret = codec->driver->probe(codec);
1417 if (ret < 0) {
1418 dev_err(codec->dev,
1419 "asoc: failed to probe CODEC %s: %d\n",
1420 codec->name, ret);
1421 return ret;
1422 }
1423 }
1424
1425 soc_init_codec_debugfs(codec);
1426
1427 /* mark codec as probed and add to card codec list */
1428 codec->probed = 1;
1429 list_add(&codec->card_list, &card->codec_dev_list);
1430
1431 return ret;
1432}
1433
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001434static void rtd_release(struct device *dev) {}
1435
Jarkko Nikula589c3562010-12-06 16:27:07 +02001436static int soc_post_component_init(struct snd_soc_card *card,
1437 struct snd_soc_codec *codec,
1438 int num, int dailess)
1439{
1440 struct snd_soc_dai_link *dai_link = NULL;
1441 struct snd_soc_aux_dev *aux_dev = NULL;
1442 struct snd_soc_pcm_runtime *rtd;
1443 const char *temp, *name;
1444 int ret = 0;
1445
1446 if (!dailess) {
1447 dai_link = &card->dai_link[num];
1448 rtd = &card->rtd[num];
1449 name = dai_link->name;
1450 } else {
1451 aux_dev = &card->aux_dev[num];
1452 rtd = &card->rtd_aux[num];
1453 name = aux_dev->name;
1454 }
1455
1456 /* machine controls, routes and widgets are not prefixed */
1457 temp = codec->name_prefix;
1458 codec->name_prefix = NULL;
1459
1460 /* do machine specific initialization */
1461 if (!dailess && dai_link->init)
1462 ret = dai_link->init(rtd);
1463 else if (dailess && aux_dev->init)
1464 ret = aux_dev->init(&codec->dapm);
1465 if (ret < 0) {
1466 dev_err(card->dev, "asoc: failed to init %s: %d\n", name, ret);
1467 return ret;
1468 }
1469 codec->name_prefix = temp;
1470
1471 /* Make sure all DAPM widgets are instantiated */
1472 snd_soc_dapm_new_widgets(&codec->dapm);
1473 snd_soc_dapm_sync(&codec->dapm);
1474
1475 /* register the rtd device */
1476 rtd->codec = codec;
1477 rtd->card = card;
1478 rtd->dev.parent = card->dev;
1479 rtd->dev.release = rtd_release;
1480 rtd->dev.init_name = name;
1481 ret = device_register(&rtd->dev);
1482 if (ret < 0) {
1483 dev_err(card->dev,
1484 "asoc: failed to register runtime device: %d\n", ret);
1485 return ret;
1486 }
1487 rtd->dev_registered = 1;
1488
1489 /* add DAPM sysfs entries for this codec */
1490 ret = snd_soc_dapm_sys_add(&rtd->dev);
1491 if (ret < 0)
1492 dev_err(codec->dev,
1493 "asoc: failed to add codec dapm sysfs entries: %d\n",
1494 ret);
1495
1496 /* add codec sysfs entries */
1497 ret = device_create_file(&rtd->dev, &dev_attr_codec_reg);
1498 if (ret < 0)
1499 dev_err(codec->dev,
1500 "asoc: failed to add codec sysfs files: %d\n", ret);
1501
1502 return 0;
1503}
1504
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001505static int soc_probe_dai_link(struct snd_soc_card *card, int num)
1506{
1507 struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1508 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1509 struct snd_soc_codec *codec = rtd->codec;
1510 struct snd_soc_platform *platform = rtd->platform;
1511 struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
1512 int ret;
1513
1514 dev_dbg(card->dev, "probe %s dai link %d\n", card->name, num);
1515
1516 /* config components */
1517 codec_dai->codec = codec;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001518 cpu_dai->platform = platform;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001519 codec_dai->card = card;
1520 cpu_dai->card = card;
1521
1522 /* set default power off timeout */
1523 rtd->pmdown_time = pmdown_time;
1524
1525 /* probe the cpu_dai */
1526 if (!cpu_dai->probed) {
1527 if (cpu_dai->driver->probe) {
1528 ret = cpu_dai->driver->probe(cpu_dai);
1529 if (ret < 0) {
1530 printk(KERN_ERR "asoc: failed to probe CPU DAI %s\n",
1531 cpu_dai->name);
1532 return ret;
1533 }
1534 }
1535 cpu_dai->probed = 1;
1536 /* mark cpu_dai as probed and add to card cpu_dai list */
1537 list_add(&cpu_dai->card_list, &card->dai_dev_list);
1538 }
1539
1540 /* probe the CODEC */
1541 if (!codec->probed) {
Jarkko Nikula589c3562010-12-06 16:27:07 +02001542 ret = soc_probe_codec(card, codec);
1543 if (ret < 0)
1544 return ret;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001545 }
1546
1547 /* probe the platform */
1548 if (!platform->probed) {
1549 if (platform->driver->probe) {
1550 ret = platform->driver->probe(platform);
1551 if (ret < 0) {
1552 printk(KERN_ERR "asoc: failed to probe platform %s\n",
1553 platform->name);
1554 return ret;
1555 }
1556 }
1557 /* mark platform as probed and add to card platform list */
1558 platform->probed = 1;
1559 list_add(&platform->card_list, &card->platform_dev_list);
1560 }
1561
1562 /* probe the CODEC DAI */
1563 if (!codec_dai->probed) {
1564 if (codec_dai->driver->probe) {
1565 ret = codec_dai->driver->probe(codec_dai);
1566 if (ret < 0) {
1567 printk(KERN_ERR "asoc: failed to probe CODEC DAI %s\n",
1568 codec_dai->name);
1569 return ret;
Mark Brown6b05eda2008-12-08 19:26:48 +00001570 }
1571 }
1572
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001573 /* mark cpu_dai as probed and add to card cpu_dai list */
1574 codec_dai->probed = 1;
1575 list_add(&codec_dai->card_list, &card->dai_dev_list);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001576 }
1577
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001578 /* DAPM dai link stream work */
1579 INIT_DELAYED_WORK(&rtd->delayed_work, close_delayed_work);
1580
Jarkko Nikula589c3562010-12-06 16:27:07 +02001581 ret = soc_post_component_init(card, codec, num, 0);
1582 if (ret)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001583 return ret;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001584
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001585 ret = device_create_file(&rtd->dev, &dev_attr_pmdown_time);
1586 if (ret < 0)
1587 printk(KERN_WARNING "asoc: failed to add pmdown_time sysfs\n");
1588
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001589 /* create the pcm */
1590 ret = soc_new_pcm(rtd, num);
1591 if (ret < 0) {
1592 printk(KERN_ERR "asoc: can't create pcm %s\n", dai_link->stream_name);
1593 return ret;
1594 }
1595
1596 /* add platform data for AC97 devices */
1597 if (rtd->codec_dai->driver->ac97_control)
1598 snd_ac97_dev_add_pdata(codec->ac97, rtd->cpu_dai->ac97_pdata);
1599
1600 return 0;
1601}
1602
1603#ifdef CONFIG_SND_SOC_AC97_BUS
1604static int soc_register_ac97_dai_link(struct snd_soc_pcm_runtime *rtd)
1605{
1606 int ret;
1607
1608 /* Only instantiate AC97 if not already done by the adaptor
1609 * for the generic AC97 subsystem.
1610 */
1611 if (rtd->codec_dai->driver->ac97_control && !rtd->codec->ac97_registered) {
Mika Westerberg0562f782010-10-13 11:30:32 +03001612 /*
1613 * It is possible that the AC97 device is already registered to
1614 * the device subsystem. This happens when the device is created
1615 * via snd_ac97_mixer(). Currently only SoC codec that does so
1616 * is the generic AC97 glue but others migh emerge.
1617 *
1618 * In those cases we don't try to register the device again.
1619 */
1620 if (!rtd->codec->ac97_created)
1621 return 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001622
1623 ret = soc_ac97_dev_register(rtd->codec);
1624 if (ret < 0) {
1625 printk(KERN_ERR "asoc: AC97 device register failed\n");
1626 return ret;
1627 }
1628
1629 rtd->codec->ac97_registered = 1;
1630 }
1631 return 0;
1632}
1633
1634static void soc_unregister_ac97_dai_link(struct snd_soc_codec *codec)
1635{
1636 if (codec->ac97_registered) {
1637 soc_ac97_dev_unregister(codec);
1638 codec->ac97_registered = 0;
1639 }
1640}
1641#endif
1642
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001643static int soc_probe_aux_dev(struct snd_soc_card *card, int num)
1644{
1645 struct snd_soc_aux_dev *aux_dev = &card->aux_dev[num];
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001646 struct snd_soc_codec *codec;
Jarkko Nikula676ad982010-12-03 09:18:22 +02001647 int ret = -ENODEV;
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001648
1649 /* find CODEC from registered CODECs*/
1650 list_for_each_entry(codec, &codec_list, list) {
1651 if (!strcmp(codec->name, aux_dev->codec_name)) {
1652 if (codec->probed) {
1653 dev_err(codec->dev,
1654 "asoc: codec already probed");
1655 ret = -EBUSY;
1656 goto out;
1657 }
Jarkko Nikula676ad982010-12-03 09:18:22 +02001658 goto found;
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001659 }
1660 }
Jarkko Nikula676ad982010-12-03 09:18:22 +02001661 /* codec not found */
1662 dev_err(card->dev, "asoc: codec %s not found", aux_dev->codec_name);
1663 goto out;
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001664
Jarkko Nikula676ad982010-12-03 09:18:22 +02001665found:
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001666 if (!try_module_get(codec->dev->driver->owner))
1667 return -ENODEV;
1668
Jarkko Nikula589c3562010-12-06 16:27:07 +02001669 ret = soc_probe_codec(card, codec);
1670 if (ret < 0)
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001671 return ret;
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001672
Jarkko Nikula589c3562010-12-06 16:27:07 +02001673 ret = soc_post_component_init(card, codec, num, 1);
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001674
1675out:
1676 return ret;
1677}
1678
1679static void soc_remove_aux_dev(struct snd_soc_card *card, int num)
1680{
1681 struct snd_soc_pcm_runtime *rtd = &card->rtd_aux[num];
1682 struct snd_soc_codec *codec = rtd->codec;
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001683
1684 /* unregister the rtd device */
1685 if (rtd->dev_registered) {
Jarkko Nikula589c3562010-12-06 16:27:07 +02001686 device_remove_file(&rtd->dev, &dev_attr_codec_reg);
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001687 device_unregister(&rtd->dev);
1688 rtd->dev_registered = 0;
1689 }
1690
Jarkko Nikula589c3562010-12-06 16:27:07 +02001691 if (codec && codec->probed)
1692 soc_remove_codec(codec);
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001693}
1694
Dimitris Papastamosfdf0f542010-12-02 16:11:06 +00001695static int snd_soc_init_codec_cache(struct snd_soc_codec *codec,
1696 enum snd_soc_compress_type compress_type)
1697{
1698 int ret;
1699
1700 if (codec->cache_init)
1701 return 0;
1702
1703 /* override the compress_type if necessary */
1704 if (compress_type && codec->compress_type != compress_type)
1705 codec->compress_type = compress_type;
Dimitris Papastamosfdf0f542010-12-02 16:11:06 +00001706 ret = snd_soc_cache_init(codec);
1707 if (ret < 0) {
1708 dev_err(codec->dev, "Failed to set cache compression type: %d\n",
1709 ret);
1710 return ret;
1711 }
1712 codec->cache_init = 1;
1713 return 0;
1714}
1715
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001716static void snd_soc_instantiate_card(struct snd_soc_card *card)
1717{
1718 struct platform_device *pdev = to_platform_device(card->dev);
Dimitris Papastamosfdf0f542010-12-02 16:11:06 +00001719 struct snd_soc_codec *codec;
1720 struct snd_soc_codec_conf *codec_conf;
1721 enum snd_soc_compress_type compress_type;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001722 int ret, i;
1723
1724 mutex_lock(&card->mutex);
1725
1726 if (card->instantiated) {
1727 mutex_unlock(&card->mutex);
1728 return;
1729 }
1730
1731 /* bind DAIs */
1732 for (i = 0; i < card->num_links; i++)
1733 soc_bind_dai_link(card, i);
1734
1735 /* bind completed ? */
1736 if (card->num_rtd != card->num_links) {
1737 mutex_unlock(&card->mutex);
1738 return;
1739 }
1740
Dimitris Papastamosfdf0f542010-12-02 16:11:06 +00001741 /* initialize the register cache for each available codec */
1742 list_for_each_entry(codec, &codec_list, list) {
1743 if (codec->cache_init)
1744 continue;
1745 /* check to see if we need to override the compress_type */
1746 for (i = 0; i < card->num_configs; ++i) {
1747 codec_conf = &card->codec_conf[i];
1748 if (!strcmp(codec->name, codec_conf->dev_name)) {
1749 compress_type = codec_conf->compress_type;
1750 if (compress_type && compress_type
1751 != codec->compress_type)
1752 break;
1753 }
1754 }
1755 if (i == card->num_configs) {
1756 /* no need to override the compress_type so
1757 * go ahead and do the standard thing */
1758 ret = snd_soc_init_codec_cache(codec, 0);
1759 if (ret < 0) {
1760 mutex_unlock(&card->mutex);
1761 return;
1762 }
1763 continue;
1764 }
1765 /* override the compress_type with the one supplied in
1766 * the machine driver */
1767 ret = snd_soc_init_codec_cache(codec, compress_type);
1768 if (ret < 0) {
1769 mutex_unlock(&card->mutex);
1770 return;
1771 }
1772 }
1773
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001774 /* card bind complete so register a sound card */
1775 ret = snd_card_create(SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
1776 card->owner, 0, &card->snd_card);
1777 if (ret < 0) {
1778 printk(KERN_ERR "asoc: can't create sound card for card %s\n",
1779 card->name);
1780 mutex_unlock(&card->mutex);
1781 return;
1782 }
1783 card->snd_card->dev = card->dev;
1784
Randy Dunlap1301a962008-06-17 19:19:34 +01001785#ifdef CONFIG_PM
Andy Green6ed25972008-06-13 16:24:05 +01001786 /* deferred resume work */
Mark Brown63084192008-12-02 15:08:03 +00001787 INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
Randy Dunlap1301a962008-06-17 19:19:34 +01001788#endif
Andy Green6ed25972008-06-13 16:24:05 +01001789
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001790 /* initialise the sound card only once */
1791 if (card->probe) {
1792 ret = card->probe(pdev);
1793 if (ret < 0)
1794 goto card_probe_error;
1795 }
1796
Mark Brownfe3e78e2009-11-03 22:13:13 +00001797 for (i = 0; i < card->num_links; i++) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001798 ret = soc_probe_dai_link(card, i);
1799 if (ret < 0) {
Mark Brown321de0d2010-09-21 15:09:37 +01001800 pr_err("asoc: failed to instantiate card %s: %d\n",
1801 card->name, ret);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001802 goto probe_dai_err;
1803 }
1804 }
1805
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001806 for (i = 0; i < card->num_aux_devs; i++) {
1807 ret = soc_probe_aux_dev(card, i);
1808 if (ret < 0) {
1809 pr_err("asoc: failed to add auxiliary devices %s: %d\n",
1810 card->name, ret);
1811 goto probe_aux_dev_err;
1812 }
1813 }
1814
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001815 snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname),
1816 "%s", card->name);
1817 snprintf(card->snd_card->longname, sizeof(card->snd_card->longname),
1818 "%s", card->name);
1819
1820 ret = snd_card_register(card->snd_card);
1821 if (ret < 0) {
1822 printk(KERN_ERR "asoc: failed to register soundcard for %s\n", card->name);
Axel Lin6b3ed782010-12-07 16:12:29 +08001823 goto probe_aux_dev_err;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001824 }
1825
1826#ifdef CONFIG_SND_SOC_AC97_BUS
1827 /* register any AC97 codecs */
1828 for (i = 0; i < card->num_rtd; i++) {
Axel Lin6b3ed782010-12-07 16:12:29 +08001829 ret = soc_register_ac97_dai_link(&card->rtd[i]);
1830 if (ret < 0) {
1831 printk(KERN_ERR "asoc: failed to register AC97 %s\n", card->name);
1832 while (--i >= 0)
Mark Brown7d8316d2010-12-13 17:03:27 +00001833 soc_unregister_ac97_dai_link(card->rtd[i].codec);
Axel Lin6b3ed782010-12-07 16:12:29 +08001834 goto probe_aux_dev_err;
Mark Brownfe3e78e2009-11-03 22:13:13 +00001835 }
Axel Lin6b3ed782010-12-07 16:12:29 +08001836 }
Mark Brownfe3e78e2009-11-03 22:13:13 +00001837#endif
1838
Mark Brown435c5e22008-12-04 15:32:53 +00001839 card->instantiated = 1;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001840 mutex_unlock(&card->mutex);
Mark Brown435c5e22008-12-04 15:32:53 +00001841 return;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001842
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001843probe_aux_dev_err:
1844 for (i = 0; i < card->num_aux_devs; i++)
1845 soc_remove_aux_dev(card, i);
1846
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001847probe_dai_err:
1848 for (i = 0; i < card->num_links; i++)
1849 soc_remove_dai_link(card, i);
Mark Brownfe3e78e2009-11-03 22:13:13 +00001850
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001851card_probe_error:
Mark Brown87506542008-11-18 20:50:34 +00001852 if (card->remove)
1853 card->remove(pdev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001854
1855 snd_card_free(card->snd_card);
1856
1857 mutex_unlock(&card->mutex);
Mark Brown435c5e22008-12-04 15:32:53 +00001858}
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001859
Mark Brown435c5e22008-12-04 15:32:53 +00001860/*
Uwe Kleine-König421f91d2010-06-11 12:17:00 +02001861 * Attempt to initialise any uninitialised cards. Must be called with
Mark Brown435c5e22008-12-04 15:32:53 +00001862 * client_mutex.
1863 */
1864static void snd_soc_instantiate_cards(void)
1865{
1866 struct snd_soc_card *card;
1867 list_for_each_entry(card, &card_list, list)
1868 snd_soc_instantiate_card(card);
1869}
1870
1871/* probes a new socdev */
1872static int soc_probe(struct platform_device *pdev)
1873{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001874 struct snd_soc_card *card = platform_get_drvdata(pdev);
Mark Brown435c5e22008-12-04 15:32:53 +00001875 int ret = 0;
Mark Brown435c5e22008-12-04 15:32:53 +00001876
1877 /* Bodge while we unpick instantiation */
1878 card->dev = &pdev->dev;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001879 INIT_LIST_HEAD(&card->dai_dev_list);
1880 INIT_LIST_HEAD(&card->codec_dev_list);
1881 INIT_LIST_HEAD(&card->platform_dev_list);
Jarkko Nikula8ddab3f2010-12-14 12:18:30 +02001882 INIT_LIST_HEAD(&card->paths);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001883
Jarkko Nikulaa6052152010-11-05 20:35:19 +02001884 soc_init_card_debugfs(card);
1885
Mark Brown435c5e22008-12-04 15:32:53 +00001886 ret = snd_soc_register_card(card);
1887 if (ret != 0) {
1888 dev_err(&pdev->dev, "Failed to register card\n");
1889 return ret;
1890 }
1891
1892 return 0;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001893}
1894
1895/* removes a socdev */
1896static int soc_remove(struct platform_device *pdev)
1897{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001898 struct snd_soc_card *card = platform_get_drvdata(pdev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001899 int i;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001900
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001901 if (card->instantiated) {
Mike Rapoport914dc182009-05-11 13:04:55 +03001902
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001903 /* make sure any delayed work runs */
1904 for (i = 0; i < card->num_rtd; i++) {
1905 struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
Tejun Heo5b84ba22010-12-11 17:51:26 +01001906 flush_delayed_work_sync(&rtd->delayed_work);
Guennadi Liakhovetskib2dfa622010-03-18 08:23:33 +01001907 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001908
Jarkko Nikula2eea3922010-11-25 17:47:38 +02001909 /* remove auxiliary devices */
1910 for (i = 0; i < card->num_aux_devs; i++)
1911 soc_remove_aux_dev(card, i);
1912
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001913 /* remove and free each DAI */
1914 for (i = 0; i < card->num_rtd; i++)
1915 soc_remove_dai_link(card, i);
1916
Jarkko Nikulaa6052152010-11-05 20:35:19 +02001917 soc_cleanup_card_debugfs(card);
1918
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001919 /* remove the card */
Guennadi Liakhovetskib2dfa622010-03-18 08:23:33 +01001920 if (card->remove)
1921 card->remove(pdev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001922
1923 kfree(card->rtd);
1924 snd_card_free(card->snd_card);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001925 }
Mark Brownc5af3a22008-11-28 13:29:45 +00001926 snd_soc_unregister_card(card);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001927 return 0;
1928}
1929
Mark Brown416356f2009-06-30 19:05:15 +01001930static int soc_poweroff(struct device *dev)
Mark Brown51737472009-06-22 13:16:51 +01001931{
Mark Brown416356f2009-06-30 19:05:15 +01001932 struct platform_device *pdev = to_platform_device(dev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001933 struct snd_soc_card *card = platform_get_drvdata(pdev);
1934 int i;
Mark Brown51737472009-06-22 13:16:51 +01001935
1936 if (!card->instantiated)
Mark Brown416356f2009-06-30 19:05:15 +01001937 return 0;
Mark Brown51737472009-06-22 13:16:51 +01001938
1939 /* Flush out pmdown_time work - we actually do want to run it
1940 * now, we're shutting down so no imminent restart. */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001941 for (i = 0; i < card->num_rtd; i++) {
1942 struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
Tejun Heo5b84ba22010-12-11 17:51:26 +01001943 flush_delayed_work_sync(&rtd->delayed_work);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001944 }
Mark Brown51737472009-06-22 13:16:51 +01001945
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001946 snd_soc_dapm_shutdown(card);
Mark Brown416356f2009-06-30 19:05:15 +01001947
1948 return 0;
Mark Brown51737472009-06-22 13:16:51 +01001949}
1950
Alexey Dobriyan47145212009-12-14 18:00:08 -08001951static const struct dev_pm_ops soc_pm_ops = {
Mark Brown416356f2009-06-30 19:05:15 +01001952 .suspend = soc_suspend,
1953 .resume = soc_resume,
1954 .poweroff = soc_poweroff,
1955};
1956
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001957/* ASoC platform driver */
1958static struct platform_driver soc_driver = {
1959 .driver = {
1960 .name = "soc-audio",
Kay Sievers8b45a202008-04-14 13:33:36 +02001961 .owner = THIS_MODULE,
Mark Brown416356f2009-06-30 19:05:15 +01001962 .pm = &soc_pm_ops,
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001963 },
1964 .probe = soc_probe,
1965 .remove = soc_remove,
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001966};
1967
1968/* create a new pcm */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001969static int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001970{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001971 struct snd_soc_codec *codec = rtd->codec;
1972 struct snd_soc_platform *platform = rtd->platform;
1973 struct snd_soc_dai *codec_dai = rtd->codec_dai;
1974 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001975 struct snd_pcm *pcm;
1976 char new_name[64];
1977 int ret = 0, playback = 0, capture = 0;
1978
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001979 /* check client and interface hw capabilities */
Mark Brown40ca1142009-12-24 13:44:28 +00001980 snprintf(new_name, sizeof(new_name), "%s %s-%d",
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001981 rtd->dai_link->stream_name, codec_dai->name, num);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001982
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001983 if (codec_dai->driver->playback.channels_min)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001984 playback = 1;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001985 if (codec_dai->driver->capture.channels_min)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001986 capture = 1;
1987
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001988 dev_dbg(rtd->card->dev, "registered pcm #%d %s\n",num,new_name);
1989 ret = snd_pcm_new(rtd->card->snd_card, new_name,
1990 num, playback, capture, &pcm);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001991 if (ret < 0) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001992 printk(KERN_ERR "asoc: can't create pcm for codec %s\n", codec->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001993 return ret;
1994 }
1995
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001996 rtd->pcm = pcm;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001997 pcm->private_data = rtd;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001998 soc_pcm_ops.mmap = platform->driver->ops->mmap;
1999 soc_pcm_ops.pointer = platform->driver->ops->pointer;
2000 soc_pcm_ops.ioctl = platform->driver->ops->ioctl;
2001 soc_pcm_ops.copy = platform->driver->ops->copy;
2002 soc_pcm_ops.silence = platform->driver->ops->silence;
2003 soc_pcm_ops.ack = platform->driver->ops->ack;
2004 soc_pcm_ops.page = platform->driver->ops->page;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002005
2006 if (playback)
2007 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &soc_pcm_ops);
2008
2009 if (capture)
2010 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &soc_pcm_ops);
2011
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002012 ret = platform->driver->pcm_new(rtd->card->snd_card, codec_dai, pcm);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002013 if (ret < 0) {
2014 printk(KERN_ERR "asoc: platform pcm constructor failed\n");
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002015 return ret;
2016 }
2017
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002018 pcm->private_free = platform->driver->pcm_free;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002019 printk(KERN_INFO "asoc: %s <-> %s mapping ok\n", codec_dai->name,
2020 cpu_dai->name);
2021 return ret;
2022}
2023
Mark Brown096e49d2009-07-05 15:12:22 +01002024/**
2025 * snd_soc_codec_volatile_register: Report if a register is volatile.
2026 *
2027 * @codec: CODEC to query.
2028 * @reg: Register to query.
2029 *
2030 * Boolean function indiciating if a CODEC register is volatile.
2031 */
2032int snd_soc_codec_volatile_register(struct snd_soc_codec *codec, int reg)
2033{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002034 if (codec->driver->volatile_register)
2035 return codec->driver->volatile_register(reg);
Mark Brown096e49d2009-07-05 15:12:22 +01002036 else
2037 return 0;
2038}
2039EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register);
2040
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002041/**
2042 * snd_soc_new_ac97_codec - initailise AC97 device
2043 * @codec: audio codec
2044 * @ops: AC97 bus operations
2045 * @num: AC97 codec number
2046 *
2047 * Initialises AC97 codec resources for use by ad-hoc devices only.
2048 */
2049int snd_soc_new_ac97_codec(struct snd_soc_codec *codec,
2050 struct snd_ac97_bus_ops *ops, int num)
2051{
2052 mutex_lock(&codec->mutex);
2053
2054 codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL);
2055 if (codec->ac97 == NULL) {
2056 mutex_unlock(&codec->mutex);
2057 return -ENOMEM;
2058 }
2059
2060 codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL);
2061 if (codec->ac97->bus == NULL) {
2062 kfree(codec->ac97);
2063 codec->ac97 = NULL;
2064 mutex_unlock(&codec->mutex);
2065 return -ENOMEM;
2066 }
2067
2068 codec->ac97->bus->ops = ops;
2069 codec->ac97->num = num;
Mika Westerberg0562f782010-10-13 11:30:32 +03002070
2071 /*
2072 * Mark the AC97 device to be created by us. This way we ensure that the
2073 * device will be registered with the device subsystem later on.
2074 */
2075 codec->ac97_created = 1;
2076
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002077 mutex_unlock(&codec->mutex);
2078 return 0;
2079}
2080EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec);
2081
2082/**
2083 * snd_soc_free_ac97_codec - free AC97 codec device
2084 * @codec: audio codec
2085 *
2086 * Frees AC97 codec device resources.
2087 */
2088void snd_soc_free_ac97_codec(struct snd_soc_codec *codec)
2089{
2090 mutex_lock(&codec->mutex);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002091#ifdef CONFIG_SND_SOC_AC97_BUS
2092 soc_unregister_ac97_dai_link(codec);
2093#endif
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002094 kfree(codec->ac97->bus);
2095 kfree(codec->ac97);
2096 codec->ac97 = NULL;
Mika Westerberg0562f782010-10-13 11:30:32 +03002097 codec->ac97_created = 0;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002098 mutex_unlock(&codec->mutex);
2099}
2100EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec);
2101
Mark Brownc3753702010-11-01 15:41:57 -04002102unsigned int snd_soc_read(struct snd_soc_codec *codec, unsigned int reg)
2103{
2104 unsigned int ret;
2105
Mark Brownc3acec22010-12-02 16:15:29 +00002106 ret = codec->read(codec, reg);
Mark Brownc3753702010-11-01 15:41:57 -04002107 dev_dbg(codec->dev, "read %x => %x\n", reg, ret);
Mark Browna8b1d342010-11-03 18:05:58 -04002108 trace_snd_soc_reg_read(codec, reg, ret);
Mark Brownc3753702010-11-01 15:41:57 -04002109
2110 return ret;
2111}
2112EXPORT_SYMBOL_GPL(snd_soc_read);
2113
2114unsigned int snd_soc_write(struct snd_soc_codec *codec,
2115 unsigned int reg, unsigned int val)
2116{
2117 dev_dbg(codec->dev, "write %x = %x\n", reg, val);
Mark Browna8b1d342010-11-03 18:05:58 -04002118 trace_snd_soc_reg_write(codec, reg, val);
Mark Brownc3acec22010-12-02 16:15:29 +00002119 return codec->write(codec, reg, val);
Mark Brownc3753702010-11-01 15:41:57 -04002120}
2121EXPORT_SYMBOL_GPL(snd_soc_write);
2122
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002123/**
2124 * snd_soc_update_bits - update codec register bits
2125 * @codec: audio codec
2126 * @reg: codec register
2127 * @mask: register mask
2128 * @value: new value
2129 *
2130 * Writes new register value.
2131 *
2132 * Returns 1 for change else 0.
2133 */
2134int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg,
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002135 unsigned int mask, unsigned int value)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002136{
2137 int change;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002138 unsigned int old, new;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002139
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002140 old = snd_soc_read(codec, reg);
2141 new = (old & ~mask) | value;
2142 change = old != new;
2143 if (change)
2144 snd_soc_write(codec, reg, new);
2145
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002146 return change;
2147}
2148EXPORT_SYMBOL_GPL(snd_soc_update_bits);
2149
2150/**
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002151 * snd_soc_update_bits_locked - update codec register bits
2152 * @codec: audio codec
2153 * @reg: codec register
2154 * @mask: register mask
2155 * @value: new value
2156 *
2157 * Writes new register value, and takes the codec mutex.
2158 *
2159 * Returns 1 for change else 0.
2160 */
Mark Browndd1b3d52009-12-04 14:22:03 +00002161int snd_soc_update_bits_locked(struct snd_soc_codec *codec,
2162 unsigned short reg, unsigned int mask,
2163 unsigned int value)
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002164{
2165 int change;
2166
2167 mutex_lock(&codec->mutex);
2168 change = snd_soc_update_bits(codec, reg, mask, value);
2169 mutex_unlock(&codec->mutex);
2170
2171 return change;
2172}
Mark Browndd1b3d52009-12-04 14:22:03 +00002173EXPORT_SYMBOL_GPL(snd_soc_update_bits_locked);
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002174
2175/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002176 * snd_soc_test_bits - test register for change
2177 * @codec: audio codec
2178 * @reg: codec register
2179 * @mask: register mask
2180 * @value: new value
2181 *
2182 * Tests a register with a new value and checks if the new value is
2183 * different from the old value.
2184 *
2185 * Returns 1 for change else 0.
2186 */
2187int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg,
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002188 unsigned int mask, unsigned int value)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002189{
2190 int change;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002191 unsigned int old, new;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002192
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002193 old = snd_soc_read(codec, reg);
2194 new = (old & ~mask) | value;
2195 change = old != new;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002196
2197 return change;
2198}
2199EXPORT_SYMBOL_GPL(snd_soc_test_bits);
2200
2201/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002202 * snd_soc_set_runtime_hwparams - set the runtime hardware parameters
2203 * @substream: the pcm substream
2204 * @hw: the hardware parameters
2205 *
2206 * Sets the substream runtime hardware parameters.
2207 */
2208int snd_soc_set_runtime_hwparams(struct snd_pcm_substream *substream,
2209 const struct snd_pcm_hardware *hw)
2210{
2211 struct snd_pcm_runtime *runtime = substream->runtime;
2212 runtime->hw.info = hw->info;
2213 runtime->hw.formats = hw->formats;
2214 runtime->hw.period_bytes_min = hw->period_bytes_min;
2215 runtime->hw.period_bytes_max = hw->period_bytes_max;
2216 runtime->hw.periods_min = hw->periods_min;
2217 runtime->hw.periods_max = hw->periods_max;
2218 runtime->hw.buffer_bytes_max = hw->buffer_bytes_max;
2219 runtime->hw.fifo_size = hw->fifo_size;
2220 return 0;
2221}
2222EXPORT_SYMBOL_GPL(snd_soc_set_runtime_hwparams);
2223
2224/**
2225 * snd_soc_cnew - create new control
2226 * @_template: control template
2227 * @data: control private data
Mark Brownac11a2b2009-01-01 12:18:17 +00002228 * @long_name: control long name
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002229 *
2230 * Create a new mixer control from a template control.
2231 *
2232 * Returns 0 for success, else error.
2233 */
2234struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
2235 void *data, char *long_name)
2236{
2237 struct snd_kcontrol_new template;
2238
2239 memcpy(&template, _template, sizeof(template));
2240 if (long_name)
2241 template.name = long_name;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002242 template.index = 0;
2243
2244 return snd_ctl_new1(&template, data);
2245}
2246EXPORT_SYMBOL_GPL(snd_soc_cnew);
2247
2248/**
Ian Molton3e8e1952009-01-09 00:23:21 +00002249 * snd_soc_add_controls - add an array of controls to a codec.
2250 * Convienience function to add a list of controls. Many codecs were
2251 * duplicating this code.
2252 *
2253 * @codec: codec to add controls to
2254 * @controls: array of controls to add
2255 * @num_controls: number of elements in the array
2256 *
2257 * Return 0 for success, else error.
2258 */
2259int snd_soc_add_controls(struct snd_soc_codec *codec,
2260 const struct snd_kcontrol_new *controls, int num_controls)
2261{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002262 struct snd_card *card = codec->card->snd_card;
Jarkko Nikulaead9b912010-11-13 20:40:44 +02002263 char prefixed_name[44], *name;
Ian Molton3e8e1952009-01-09 00:23:21 +00002264 int err, i;
2265
2266 for (i = 0; i < num_controls; i++) {
2267 const struct snd_kcontrol_new *control = &controls[i];
Jarkko Nikulaead9b912010-11-13 20:40:44 +02002268 if (codec->name_prefix) {
2269 snprintf(prefixed_name, sizeof(prefixed_name), "%s %s",
2270 codec->name_prefix, control->name);
2271 name = prefixed_name;
2272 } else {
2273 name = control->name;
2274 }
2275 err = snd_ctl_add(card, snd_soc_cnew(control, codec, name));
Ian Molton3e8e1952009-01-09 00:23:21 +00002276 if (err < 0) {
Mark Brown082100d2010-09-20 19:03:28 +01002277 dev_err(codec->dev, "%s: Failed to add %s: %d\n",
Jarkko Nikulaead9b912010-11-13 20:40:44 +02002278 codec->name, name, err);
Ian Molton3e8e1952009-01-09 00:23:21 +00002279 return err;
2280 }
2281 }
2282
2283 return 0;
2284}
2285EXPORT_SYMBOL_GPL(snd_soc_add_controls);
2286
2287/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002288 * snd_soc_info_enum_double - enumerated double mixer info callback
2289 * @kcontrol: mixer control
2290 * @uinfo: control element information
2291 *
2292 * Callback to provide information about a double enumerated
2293 * mixer control.
2294 *
2295 * Returns 0 for success.
2296 */
2297int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol,
2298 struct snd_ctl_elem_info *uinfo)
2299{
2300 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2301
2302 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2303 uinfo->count = e->shift_l == e->shift_r ? 1 : 2;
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002304 uinfo->value.enumerated.items = e->max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002305
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002306 if (uinfo->value.enumerated.item > e->max - 1)
2307 uinfo->value.enumerated.item = e->max - 1;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002308 strcpy(uinfo->value.enumerated.name,
2309 e->texts[uinfo->value.enumerated.item]);
2310 return 0;
2311}
2312EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
2313
2314/**
2315 * snd_soc_get_enum_double - enumerated double mixer get callback
2316 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002317 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002318 *
2319 * Callback to get the value of a double enumerated mixer.
2320 *
2321 * Returns 0 for success.
2322 */
2323int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol,
2324 struct snd_ctl_elem_value *ucontrol)
2325{
2326 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2327 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002328 unsigned int val, bitmask;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002329
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002330 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002331 ;
2332 val = snd_soc_read(codec, e->reg);
Mark Brown3ff3f642008-05-19 12:32:25 +02002333 ucontrol->value.enumerated.item[0]
2334 = (val >> e->shift_l) & (bitmask - 1);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002335 if (e->shift_l != e->shift_r)
2336 ucontrol->value.enumerated.item[1] =
2337 (val >> e->shift_r) & (bitmask - 1);
2338
2339 return 0;
2340}
2341EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
2342
2343/**
2344 * snd_soc_put_enum_double - enumerated double mixer put callback
2345 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002346 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002347 *
2348 * Callback to set the value of a double enumerated mixer.
2349 *
2350 * Returns 0 for success.
2351 */
2352int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol,
2353 struct snd_ctl_elem_value *ucontrol)
2354{
2355 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2356 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002357 unsigned int val;
2358 unsigned int mask, bitmask;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002359
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002360 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002361 ;
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002362 if (ucontrol->value.enumerated.item[0] > e->max - 1)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002363 return -EINVAL;
2364 val = ucontrol->value.enumerated.item[0] << e->shift_l;
2365 mask = (bitmask - 1) << e->shift_l;
2366 if (e->shift_l != e->shift_r) {
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002367 if (ucontrol->value.enumerated.item[1] > e->max - 1)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002368 return -EINVAL;
2369 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
2370 mask |= (bitmask - 1) << e->shift_r;
2371 }
2372
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002373 return snd_soc_update_bits_locked(codec, e->reg, mask, val);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002374}
2375EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
2376
2377/**
Peter Ujfalusi2e72f8e2009-01-05 09:54:57 +02002378 * snd_soc_get_value_enum_double - semi enumerated double mixer get callback
2379 * @kcontrol: mixer control
2380 * @ucontrol: control element information
2381 *
2382 * Callback to get the value of a double semi enumerated mixer.
2383 *
2384 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2385 * used for handling bitfield coded enumeration for example.
2386 *
2387 * Returns 0 for success.
2388 */
2389int snd_soc_get_value_enum_double(struct snd_kcontrol *kcontrol,
2390 struct snd_ctl_elem_value *ucontrol)
2391{
2392 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Peter Ujfalusi74155552009-01-08 13:34:29 +02002393 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002394 unsigned int reg_val, val, mux;
Peter Ujfalusi2e72f8e2009-01-05 09:54:57 +02002395
2396 reg_val = snd_soc_read(codec, e->reg);
2397 val = (reg_val >> e->shift_l) & e->mask;
2398 for (mux = 0; mux < e->max; mux++) {
2399 if (val == e->values[mux])
2400 break;
2401 }
2402 ucontrol->value.enumerated.item[0] = mux;
2403 if (e->shift_l != e->shift_r) {
2404 val = (reg_val >> e->shift_r) & e->mask;
2405 for (mux = 0; mux < e->max; mux++) {
2406 if (val == e->values[mux])
2407 break;
2408 }
2409 ucontrol->value.enumerated.item[1] = mux;
2410 }
2411
2412 return 0;
2413}
2414EXPORT_SYMBOL_GPL(snd_soc_get_value_enum_double);
2415
2416/**
2417 * snd_soc_put_value_enum_double - semi enumerated double mixer put callback
2418 * @kcontrol: mixer control
2419 * @ucontrol: control element information
2420 *
2421 * Callback to set the value of a double semi enumerated mixer.
2422 *
2423 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2424 * used for handling bitfield coded enumeration for example.
2425 *
2426 * Returns 0 for success.
2427 */
2428int snd_soc_put_value_enum_double(struct snd_kcontrol *kcontrol,
2429 struct snd_ctl_elem_value *ucontrol)
2430{
2431 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Peter Ujfalusi74155552009-01-08 13:34:29 +02002432 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002433 unsigned int val;
2434 unsigned int mask;
Peter Ujfalusi2e72f8e2009-01-05 09:54:57 +02002435
2436 if (ucontrol->value.enumerated.item[0] > e->max - 1)
2437 return -EINVAL;
2438 val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
2439 mask = e->mask << e->shift_l;
2440 if (e->shift_l != e->shift_r) {
2441 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2442 return -EINVAL;
2443 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
2444 mask |= e->mask << e->shift_r;
2445 }
2446
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002447 return snd_soc_update_bits_locked(codec, e->reg, mask, val);
Peter Ujfalusi2e72f8e2009-01-05 09:54:57 +02002448}
2449EXPORT_SYMBOL_GPL(snd_soc_put_value_enum_double);
2450
2451/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002452 * snd_soc_info_enum_ext - external enumerated single mixer info callback
2453 * @kcontrol: mixer control
2454 * @uinfo: control element information
2455 *
2456 * Callback to provide information about an external enumerated
2457 * single mixer.
2458 *
2459 * Returns 0 for success.
2460 */
2461int snd_soc_info_enum_ext(struct snd_kcontrol *kcontrol,
2462 struct snd_ctl_elem_info *uinfo)
2463{
2464 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2465
2466 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2467 uinfo->count = 1;
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002468 uinfo->value.enumerated.items = e->max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002469
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002470 if (uinfo->value.enumerated.item > e->max - 1)
2471 uinfo->value.enumerated.item = e->max - 1;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002472 strcpy(uinfo->value.enumerated.name,
2473 e->texts[uinfo->value.enumerated.item]);
2474 return 0;
2475}
2476EXPORT_SYMBOL_GPL(snd_soc_info_enum_ext);
2477
2478/**
2479 * snd_soc_info_volsw_ext - external single mixer info callback
2480 * @kcontrol: mixer control
2481 * @uinfo: control element information
2482 *
2483 * Callback to provide information about a single external mixer control.
2484 *
2485 * Returns 0 for success.
2486 */
2487int snd_soc_info_volsw_ext(struct snd_kcontrol *kcontrol,
2488 struct snd_ctl_elem_info *uinfo)
2489{
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002490 int max = kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002491
Mark Brownfd5dfad2009-04-15 21:37:46 +01002492 if (max == 1 && !strstr(kcontrol->id.name, " Volume"))
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002493 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2494 else
2495 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2496
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002497 uinfo->count = 1;
2498 uinfo->value.integer.min = 0;
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002499 uinfo->value.integer.max = max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002500 return 0;
2501}
2502EXPORT_SYMBOL_GPL(snd_soc_info_volsw_ext);
2503
2504/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002505 * snd_soc_info_volsw - single mixer info callback
2506 * @kcontrol: mixer control
2507 * @uinfo: control element information
2508 *
2509 * Callback to provide information about a single mixer control.
2510 *
2511 * Returns 0 for success.
2512 */
2513int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
2514 struct snd_ctl_elem_info *uinfo)
2515{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002516 struct soc_mixer_control *mc =
2517 (struct soc_mixer_control *)kcontrol->private_value;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002518 int platform_max;
Mark Brown762b8df2008-10-30 12:37:08 +00002519 unsigned int shift = mc->shift;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002520 unsigned int rshift = mc->rshift;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002521
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002522 if (!mc->platform_max)
2523 mc->platform_max = mc->max;
2524 platform_max = mc->platform_max;
2525
2526 if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002527 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2528 else
2529 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2530
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002531 uinfo->count = shift == rshift ? 1 : 2;
2532 uinfo->value.integer.min = 0;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002533 uinfo->value.integer.max = platform_max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002534 return 0;
2535}
2536EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
2537
2538/**
2539 * snd_soc_get_volsw - single mixer get callback
2540 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002541 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002542 *
2543 * Callback to get the value of a single mixer control.
2544 *
2545 * Returns 0 for success.
2546 */
2547int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
2548 struct snd_ctl_elem_value *ucontrol)
2549{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002550 struct soc_mixer_control *mc =
2551 (struct soc_mixer_control *)kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002552 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002553 unsigned int reg = mc->reg;
2554 unsigned int shift = mc->shift;
2555 unsigned int rshift = mc->rshift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002556 int max = mc->max;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002557 unsigned int mask = (1 << fls(max)) - 1;
2558 unsigned int invert = mc->invert;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002559
2560 ucontrol->value.integer.value[0] =
2561 (snd_soc_read(codec, reg) >> shift) & mask;
2562 if (shift != rshift)
2563 ucontrol->value.integer.value[1] =
2564 (snd_soc_read(codec, reg) >> rshift) & mask;
2565 if (invert) {
2566 ucontrol->value.integer.value[0] =
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002567 max - ucontrol->value.integer.value[0];
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002568 if (shift != rshift)
2569 ucontrol->value.integer.value[1] =
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002570 max - ucontrol->value.integer.value[1];
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002571 }
2572
2573 return 0;
2574}
2575EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
2576
2577/**
2578 * snd_soc_put_volsw - single mixer put callback
2579 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002580 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002581 *
2582 * Callback to set the value of a single mixer control.
2583 *
2584 * Returns 0 for success.
2585 */
2586int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
2587 struct snd_ctl_elem_value *ucontrol)
2588{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002589 struct soc_mixer_control *mc =
2590 (struct soc_mixer_control *)kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002591 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002592 unsigned int reg = mc->reg;
2593 unsigned int shift = mc->shift;
2594 unsigned int rshift = mc->rshift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002595 int max = mc->max;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002596 unsigned int mask = (1 << fls(max)) - 1;
2597 unsigned int invert = mc->invert;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002598 unsigned int val, val2, val_mask;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002599
2600 val = (ucontrol->value.integer.value[0] & mask);
2601 if (invert)
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002602 val = max - val;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002603 val_mask = mask << shift;
2604 val = val << shift;
2605 if (shift != rshift) {
2606 val2 = (ucontrol->value.integer.value[1] & mask);
2607 if (invert)
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002608 val2 = max - val2;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002609 val_mask |= mask << rshift;
2610 val |= val2 << rshift;
2611 }
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002612 return snd_soc_update_bits_locked(codec, reg, val_mask, val);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002613}
2614EXPORT_SYMBOL_GPL(snd_soc_put_volsw);
2615
2616/**
2617 * snd_soc_info_volsw_2r - double mixer info callback
2618 * @kcontrol: mixer control
2619 * @uinfo: control element information
2620 *
2621 * Callback to provide information about a double mixer control that
2622 * spans 2 codec registers.
2623 *
2624 * Returns 0 for success.
2625 */
2626int snd_soc_info_volsw_2r(struct snd_kcontrol *kcontrol,
2627 struct snd_ctl_elem_info *uinfo)
2628{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002629 struct soc_mixer_control *mc =
2630 (struct soc_mixer_control *)kcontrol->private_value;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002631 int platform_max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002632
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002633 if (!mc->platform_max)
2634 mc->platform_max = mc->max;
2635 platform_max = mc->platform_max;
2636
2637 if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002638 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2639 else
2640 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2641
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002642 uinfo->count = 2;
2643 uinfo->value.integer.min = 0;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002644 uinfo->value.integer.max = platform_max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002645 return 0;
2646}
2647EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r);
2648
2649/**
2650 * snd_soc_get_volsw_2r - double mixer get callback
2651 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002652 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002653 *
2654 * Callback to get the value of a double mixer control that spans 2 registers.
2655 *
2656 * Returns 0 for success.
2657 */
2658int snd_soc_get_volsw_2r(struct snd_kcontrol *kcontrol,
2659 struct snd_ctl_elem_value *ucontrol)
2660{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002661 struct soc_mixer_control *mc =
2662 (struct soc_mixer_control *)kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002663 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002664 unsigned int reg = mc->reg;
2665 unsigned int reg2 = mc->rreg;
2666 unsigned int shift = mc->shift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002667 int max = mc->max;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002668 unsigned int mask = (1 << fls(max)) - 1;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002669 unsigned int invert = mc->invert;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002670
2671 ucontrol->value.integer.value[0] =
2672 (snd_soc_read(codec, reg) >> shift) & mask;
2673 ucontrol->value.integer.value[1] =
2674 (snd_soc_read(codec, reg2) >> shift) & mask;
2675 if (invert) {
2676 ucontrol->value.integer.value[0] =
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002677 max - ucontrol->value.integer.value[0];
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002678 ucontrol->value.integer.value[1] =
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002679 max - ucontrol->value.integer.value[1];
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002680 }
2681
2682 return 0;
2683}
2684EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r);
2685
2686/**
2687 * snd_soc_put_volsw_2r - double mixer set callback
2688 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002689 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002690 *
2691 * Callback to set the value of a double mixer control that spans 2 registers.
2692 *
2693 * Returns 0 for success.
2694 */
2695int snd_soc_put_volsw_2r(struct snd_kcontrol *kcontrol,
2696 struct snd_ctl_elem_value *ucontrol)
2697{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002698 struct soc_mixer_control *mc =
2699 (struct soc_mixer_control *)kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002700 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002701 unsigned int reg = mc->reg;
2702 unsigned int reg2 = mc->rreg;
2703 unsigned int shift = mc->shift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002704 int max = mc->max;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002705 unsigned int mask = (1 << fls(max)) - 1;
2706 unsigned int invert = mc->invert;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002707 int err;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002708 unsigned int val, val2, val_mask;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002709
2710 val_mask = mask << shift;
2711 val = (ucontrol->value.integer.value[0] & mask);
2712 val2 = (ucontrol->value.integer.value[1] & mask);
2713
2714 if (invert) {
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002715 val = max - val;
2716 val2 = max - val2;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002717 }
2718
2719 val = val << shift;
2720 val2 = val2 << shift;
2721
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002722 err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
Mark Brown3ff3f642008-05-19 12:32:25 +02002723 if (err < 0)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002724 return err;
2725
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002726 err = snd_soc_update_bits_locked(codec, reg2, val_mask, val2);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002727 return err;
2728}
2729EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r);
2730
Mark Browne13ac2e2008-05-28 17:58:05 +01002731/**
2732 * snd_soc_info_volsw_s8 - signed mixer info callback
2733 * @kcontrol: mixer control
2734 * @uinfo: control element information
2735 *
2736 * Callback to provide information about a signed mixer control.
2737 *
2738 * Returns 0 for success.
2739 */
2740int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol,
2741 struct snd_ctl_elem_info *uinfo)
2742{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002743 struct soc_mixer_control *mc =
2744 (struct soc_mixer_control *)kcontrol->private_value;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002745 int platform_max;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002746 int min = mc->min;
Mark Browne13ac2e2008-05-28 17:58:05 +01002747
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002748 if (!mc->platform_max)
2749 mc->platform_max = mc->max;
2750 platform_max = mc->platform_max;
2751
Mark Browne13ac2e2008-05-28 17:58:05 +01002752 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2753 uinfo->count = 2;
2754 uinfo->value.integer.min = 0;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002755 uinfo->value.integer.max = platform_max - min;
Mark Browne13ac2e2008-05-28 17:58:05 +01002756 return 0;
2757}
2758EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8);
2759
2760/**
2761 * snd_soc_get_volsw_s8 - signed mixer get callback
2762 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002763 * @ucontrol: control element information
Mark Browne13ac2e2008-05-28 17:58:05 +01002764 *
2765 * Callback to get the value of a signed mixer control.
2766 *
2767 * Returns 0 for success.
2768 */
2769int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol,
2770 struct snd_ctl_elem_value *ucontrol)
2771{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002772 struct soc_mixer_control *mc =
2773 (struct soc_mixer_control *)kcontrol->private_value;
Mark Browne13ac2e2008-05-28 17:58:05 +01002774 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002775 unsigned int reg = mc->reg;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002776 int min = mc->min;
Mark Browne13ac2e2008-05-28 17:58:05 +01002777 int val = snd_soc_read(codec, reg);
2778
2779 ucontrol->value.integer.value[0] =
2780 ((signed char)(val & 0xff))-min;
2781 ucontrol->value.integer.value[1] =
2782 ((signed char)((val >> 8) & 0xff))-min;
2783 return 0;
2784}
2785EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8);
2786
2787/**
2788 * snd_soc_put_volsw_sgn - signed mixer put callback
2789 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002790 * @ucontrol: control element information
Mark Browne13ac2e2008-05-28 17:58:05 +01002791 *
2792 * Callback to set the value of a signed mixer control.
2793 *
2794 * Returns 0 for success.
2795 */
2796int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol,
2797 struct snd_ctl_elem_value *ucontrol)
2798{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002799 struct soc_mixer_control *mc =
2800 (struct soc_mixer_control *)kcontrol->private_value;
Mark Browne13ac2e2008-05-28 17:58:05 +01002801 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002802 unsigned int reg = mc->reg;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002803 int min = mc->min;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002804 unsigned int val;
Mark Browne13ac2e2008-05-28 17:58:05 +01002805
2806 val = (ucontrol->value.integer.value[0]+min) & 0xff;
2807 val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8;
2808
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002809 return snd_soc_update_bits_locked(codec, reg, 0xffff, val);
Mark Browne13ac2e2008-05-28 17:58:05 +01002810}
2811EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8);
2812
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002813/**
Peter Ujfalusi637d3842010-05-07 14:05:49 +03002814 * snd_soc_limit_volume - Set new limit to an existing volume control.
2815 *
2816 * @codec: where to look for the control
2817 * @name: Name of the control
2818 * @max: new maximum limit
2819 *
2820 * Return 0 for success, else error.
2821 */
2822int snd_soc_limit_volume(struct snd_soc_codec *codec,
2823 const char *name, int max)
2824{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002825 struct snd_card *card = codec->card->snd_card;
Peter Ujfalusi637d3842010-05-07 14:05:49 +03002826 struct snd_kcontrol *kctl;
2827 struct soc_mixer_control *mc;
2828 int found = 0;
2829 int ret = -EINVAL;
2830
2831 /* Sanity check for name and max */
2832 if (unlikely(!name || max <= 0))
2833 return -EINVAL;
2834
2835 list_for_each_entry(kctl, &card->controls, list) {
2836 if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) {
2837 found = 1;
2838 break;
2839 }
2840 }
2841 if (found) {
2842 mc = (struct soc_mixer_control *)kctl->private_value;
2843 if (max <= mc->max) {
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002844 mc->platform_max = max;
Peter Ujfalusi637d3842010-05-07 14:05:49 +03002845 ret = 0;
2846 }
2847 }
2848 return ret;
2849}
2850EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
2851
2852/**
apatard@mandriva.comb6f4bb32010-05-15 17:30:01 +02002853 * snd_soc_info_volsw_2r_sx - double with tlv and variable data size
2854 * mixer info callback
2855 * @kcontrol: mixer control
2856 * @uinfo: control element information
2857 *
2858 * Returns 0 for success.
2859 */
2860int snd_soc_info_volsw_2r_sx(struct snd_kcontrol *kcontrol,
2861 struct snd_ctl_elem_info *uinfo)
2862{
2863 struct soc_mixer_control *mc =
2864 (struct soc_mixer_control *)kcontrol->private_value;
2865 int max = mc->max;
2866 int min = mc->min;
2867
2868 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2869 uinfo->count = 2;
2870 uinfo->value.integer.min = 0;
2871 uinfo->value.integer.max = max-min;
2872
2873 return 0;
2874}
2875EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r_sx);
2876
2877/**
2878 * snd_soc_get_volsw_2r_sx - double with tlv and variable data size
2879 * mixer get callback
2880 * @kcontrol: mixer control
2881 * @uinfo: control element information
2882 *
2883 * Returns 0 for success.
2884 */
2885int snd_soc_get_volsw_2r_sx(struct snd_kcontrol *kcontrol,
2886 struct snd_ctl_elem_value *ucontrol)
2887{
2888 struct soc_mixer_control *mc =
2889 (struct soc_mixer_control *)kcontrol->private_value;
2890 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2891 unsigned int mask = (1<<mc->shift)-1;
2892 int min = mc->min;
2893 int val = snd_soc_read(codec, mc->reg) & mask;
2894 int valr = snd_soc_read(codec, mc->rreg) & mask;
2895
Stuart Longland20630c72010-06-18 12:56:10 +10002896 ucontrol->value.integer.value[0] = ((val & 0xff)-min) & mask;
2897 ucontrol->value.integer.value[1] = ((valr & 0xff)-min) & mask;
apatard@mandriva.comb6f4bb32010-05-15 17:30:01 +02002898 return 0;
2899}
2900EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r_sx);
2901
2902/**
2903 * snd_soc_put_volsw_2r_sx - double with tlv and variable data size
2904 * mixer put callback
2905 * @kcontrol: mixer control
2906 * @uinfo: control element information
2907 *
2908 * Returns 0 for success.
2909 */
2910int snd_soc_put_volsw_2r_sx(struct snd_kcontrol *kcontrol,
2911 struct snd_ctl_elem_value *ucontrol)
2912{
2913 struct soc_mixer_control *mc =
2914 (struct soc_mixer_control *)kcontrol->private_value;
2915 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2916 unsigned int mask = (1<<mc->shift)-1;
2917 int min = mc->min;
2918 int ret;
2919 unsigned int val, valr, oval, ovalr;
2920
2921 val = ((ucontrol->value.integer.value[0]+min) & 0xff);
2922 val &= mask;
2923 valr = ((ucontrol->value.integer.value[1]+min) & 0xff);
2924 valr &= mask;
2925
2926 oval = snd_soc_read(codec, mc->reg) & mask;
2927 ovalr = snd_soc_read(codec, mc->rreg) & mask;
2928
2929 ret = 0;
2930 if (oval != val) {
2931 ret = snd_soc_write(codec, mc->reg, val);
2932 if (ret < 0)
Mark Brownf1df5ae2010-06-15 15:14:31 +01002933 return ret;
apatard@mandriva.comb6f4bb32010-05-15 17:30:01 +02002934 }
2935 if (ovalr != valr) {
2936 ret = snd_soc_write(codec, mc->rreg, valr);
2937 if (ret < 0)
Mark Brownf1df5ae2010-06-15 15:14:31 +01002938 return ret;
apatard@mandriva.comb6f4bb32010-05-15 17:30:01 +02002939 }
2940
2941 return 0;
2942}
2943EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r_sx);
2944
2945/**
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002946 * snd_soc_dai_set_sysclk - configure DAI system or master clock.
2947 * @dai: DAI
2948 * @clk_id: DAI specific clock ID
2949 * @freq: new clock frequency in Hz
2950 * @dir: new clock direction - input/output.
2951 *
2952 * Configures the DAI master (MCLK) or system (SYSCLK) clocking.
2953 */
2954int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
2955 unsigned int freq, int dir)
2956{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002957 if (dai->driver && dai->driver->ops->set_sysclk)
2958 return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002959 else
2960 return -EINVAL;
2961}
2962EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
2963
2964/**
2965 * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
2966 * @dai: DAI
Mark Brownac11a2b2009-01-01 12:18:17 +00002967 * @div_id: DAI specific clock divider ID
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002968 * @div: new clock divisor.
2969 *
2970 * Configures the clock dividers. This is used to derive the best DAI bit and
2971 * frame clocks from the system or master clock. It's best to set the DAI bit
2972 * and frame clocks as low as possible to save system power.
2973 */
2974int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
2975 int div_id, int div)
2976{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002977 if (dai->driver && dai->driver->ops->set_clkdiv)
2978 return dai->driver->ops->set_clkdiv(dai, div_id, div);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002979 else
2980 return -EINVAL;
2981}
2982EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv);
2983
2984/**
2985 * snd_soc_dai_set_pll - configure DAI PLL.
2986 * @dai: DAI
2987 * @pll_id: DAI specific PLL ID
Mark Brown85488032009-09-05 18:52:16 +01002988 * @source: DAI specific source for the PLL
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002989 * @freq_in: PLL input clock frequency in Hz
2990 * @freq_out: requested PLL output clock frequency in Hz
2991 *
2992 * Configures and enables PLL to generate output clock based on input clock.
2993 */
Mark Brown85488032009-09-05 18:52:16 +01002994int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
2995 unsigned int freq_in, unsigned int freq_out)
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002996{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002997 if (dai->driver && dai->driver->ops->set_pll)
2998 return dai->driver->ops->set_pll(dai, pll_id, source,
Mark Brown85488032009-09-05 18:52:16 +01002999 freq_in, freq_out);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01003000 else
3001 return -EINVAL;
3002}
3003EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
3004
3005/**
3006 * snd_soc_dai_set_fmt - configure DAI hardware audio format.
3007 * @dai: DAI
Liam Girdwood8c6529d2008-07-08 13:19:13 +01003008 * @fmt: SND_SOC_DAIFMT_ format value.
3009 *
3010 * Configures the DAI hardware format and clocking.
3011 */
3012int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
3013{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003014 if (dai->driver && dai->driver->ops->set_fmt)
3015 return dai->driver->ops->set_fmt(dai, fmt);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01003016 else
3017 return -EINVAL;
3018}
3019EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
3020
3021/**
3022 * snd_soc_dai_set_tdm_slot - configure DAI TDM.
3023 * @dai: DAI
Daniel Ribeiroa5479e32009-06-15 21:44:31 -03003024 * @tx_mask: bitmask representing active TX slots.
3025 * @rx_mask: bitmask representing active RX slots.
Liam Girdwood8c6529d2008-07-08 13:19:13 +01003026 * @slots: Number of slots in use.
Daniel Ribeiroa5479e32009-06-15 21:44:31 -03003027 * @slot_width: Width in bits for each slot.
Liam Girdwood8c6529d2008-07-08 13:19:13 +01003028 *
3029 * Configures a DAI for TDM operation. Both mask and slots are codec and DAI
3030 * specific.
3031 */
3032int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
Daniel Ribeiroa5479e32009-06-15 21:44:31 -03003033 unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
Liam Girdwood8c6529d2008-07-08 13:19:13 +01003034{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003035 if (dai->driver && dai->driver->ops->set_tdm_slot)
3036 return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask,
Daniel Ribeiroa5479e32009-06-15 21:44:31 -03003037 slots, slot_width);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01003038 else
3039 return -EINVAL;
3040}
3041EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
3042
3043/**
Barry Song472df3c2009-09-12 01:16:29 +08003044 * snd_soc_dai_set_channel_map - configure DAI audio channel map
3045 * @dai: DAI
3046 * @tx_num: how many TX channels
3047 * @tx_slot: pointer to an array which imply the TX slot number channel
3048 * 0~num-1 uses
3049 * @rx_num: how many RX channels
3050 * @rx_slot: pointer to an array which imply the RX slot number channel
3051 * 0~num-1 uses
3052 *
3053 * configure the relationship between channel number and TDM slot number.
3054 */
3055int snd_soc_dai_set_channel_map(struct snd_soc_dai *dai,
3056 unsigned int tx_num, unsigned int *tx_slot,
3057 unsigned int rx_num, unsigned int *rx_slot)
3058{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003059 if (dai->driver && dai->driver->ops->set_channel_map)
3060 return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot,
Barry Song472df3c2009-09-12 01:16:29 +08003061 rx_num, rx_slot);
3062 else
3063 return -EINVAL;
3064}
3065EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map);
3066
3067/**
Liam Girdwood8c6529d2008-07-08 13:19:13 +01003068 * snd_soc_dai_set_tristate - configure DAI system or master clock.
3069 * @dai: DAI
3070 * @tristate: tristate enable
3071 *
3072 * Tristates the DAI so that others can use it.
3073 */
3074int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
3075{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003076 if (dai->driver && dai->driver->ops->set_tristate)
3077 return dai->driver->ops->set_tristate(dai, tristate);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01003078 else
3079 return -EINVAL;
3080}
3081EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate);
3082
3083/**
3084 * snd_soc_dai_digital_mute - configure DAI system or master clock.
3085 * @dai: DAI
3086 * @mute: mute enable
3087 *
3088 * Mutes the DAI DAC.
3089 */
3090int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute)
3091{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003092 if (dai->driver && dai->driver->ops->digital_mute)
3093 return dai->driver->ops->digital_mute(dai, mute);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01003094 else
3095 return -EINVAL;
3096}
3097EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
3098
Mark Brownc5af3a22008-11-28 13:29:45 +00003099/**
3100 * snd_soc_register_card - Register a card with the ASoC core
3101 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003102 * @card: Card to register
Mark Brownc5af3a22008-11-28 13:29:45 +00003103 *
3104 * Note that currently this is an internal only function: it will be
3105 * exposed to machine drivers after further backporting of ASoC v2
3106 * registration APIs.
3107 */
3108static int snd_soc_register_card(struct snd_soc_card *card)
3109{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003110 int i;
3111
Mark Brownc5af3a22008-11-28 13:29:45 +00003112 if (!card->name || !card->dev)
3113 return -EINVAL;
3114
Jarkko Nikula2eea3922010-11-25 17:47:38 +02003115 card->rtd = kzalloc(sizeof(struct snd_soc_pcm_runtime) *
3116 (card->num_links + card->num_aux_devs),
3117 GFP_KERNEL);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003118 if (card->rtd == NULL)
3119 return -ENOMEM;
Jarkko Nikula2eea3922010-11-25 17:47:38 +02003120 card->rtd_aux = &card->rtd[card->num_links];
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003121
3122 for (i = 0; i < card->num_links; i++)
3123 card->rtd[i].dai_link = &card->dai_link[i];
3124
Mark Brownc5af3a22008-11-28 13:29:45 +00003125 INIT_LIST_HEAD(&card->list);
3126 card->instantiated = 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003127 mutex_init(&card->mutex);
Mark Brownc5af3a22008-11-28 13:29:45 +00003128
3129 mutex_lock(&client_mutex);
3130 list_add(&card->list, &card_list);
Mark Brown435c5e22008-12-04 15:32:53 +00003131 snd_soc_instantiate_cards();
Mark Brownc5af3a22008-11-28 13:29:45 +00003132 mutex_unlock(&client_mutex);
3133
3134 dev_dbg(card->dev, "Registered card '%s'\n", card->name);
3135
3136 return 0;
3137}
3138
3139/**
3140 * snd_soc_unregister_card - Unregister a card with the ASoC core
3141 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003142 * @card: Card to unregister
Mark Brownc5af3a22008-11-28 13:29:45 +00003143 *
3144 * Note that currently this is an internal only function: it will be
3145 * exposed to machine drivers after further backporting of ASoC v2
3146 * registration APIs.
3147 */
3148static int snd_soc_unregister_card(struct snd_soc_card *card)
3149{
3150 mutex_lock(&client_mutex);
3151 list_del(&card->list);
3152 mutex_unlock(&client_mutex);
Mark Brownc5af3a22008-11-28 13:29:45 +00003153 dev_dbg(card->dev, "Unregistered card '%s'\n", card->name);
3154
3155 return 0;
3156}
3157
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003158/*
3159 * Simplify DAI link configuration by removing ".-1" from device names
3160 * and sanitizing names.
3161 */
Dimitris Papastamos0b9a2142010-12-06 15:49:20 +00003162static char *fmt_single_name(struct device *dev, int *id)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003163{
3164 char *found, name[NAME_SIZE];
3165 int id1, id2;
3166
3167 if (dev_name(dev) == NULL)
3168 return NULL;
3169
Dimitris Papastamos58818a72010-12-06 15:42:17 +00003170 strlcpy(name, dev_name(dev), NAME_SIZE);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003171
3172 /* are we a "%s.%d" name (platform and SPI components) */
3173 found = strstr(name, dev->driver->name);
3174 if (found) {
3175 /* get ID */
3176 if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) {
3177
3178 /* discard ID from name if ID == -1 */
3179 if (*id == -1)
3180 found[strlen(dev->driver->name)] = '\0';
3181 }
3182
3183 } else {
3184 /* I2C component devices are named "bus-addr" */
3185 if (sscanf(name, "%x-%x", &id1, &id2) == 2) {
3186 char tmp[NAME_SIZE];
3187
3188 /* create unique ID number from I2C addr and bus */
Jarkko Nikula05899442010-10-19 11:10:45 +03003189 *id = ((id1 & 0xffff) << 16) + id2;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003190
3191 /* sanitize component name for DAI link creation */
3192 snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name);
Dimitris Papastamos58818a72010-12-06 15:42:17 +00003193 strlcpy(name, tmp, NAME_SIZE);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003194 } else
3195 *id = 0;
3196 }
3197
3198 return kstrdup(name, GFP_KERNEL);
3199}
3200
3201/*
3202 * Simplify DAI link naming for single devices with multiple DAIs by removing
3203 * any ".-1" and using the DAI name (instead of device name).
3204 */
3205static inline char *fmt_multiple_name(struct device *dev,
3206 struct snd_soc_dai_driver *dai_drv)
3207{
3208 if (dai_drv->name == NULL) {
3209 printk(KERN_ERR "asoc: error - multiple DAI %s registered with no name\n",
3210 dev_name(dev));
3211 return NULL;
3212 }
3213
3214 return kstrdup(dai_drv->name, GFP_KERNEL);
3215}
3216
Mark Brown91151712008-11-30 23:31:24 +00003217/**
3218 * snd_soc_register_dai - Register a DAI with the ASoC core
3219 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003220 * @dai: DAI to register
Mark Brown91151712008-11-30 23:31:24 +00003221 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003222int snd_soc_register_dai(struct device *dev,
3223 struct snd_soc_dai_driver *dai_drv)
Mark Brown91151712008-11-30 23:31:24 +00003224{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003225 struct snd_soc_dai *dai;
Mark Brown91151712008-11-30 23:31:24 +00003226
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003227 dev_dbg(dev, "dai register %s\n", dev_name(dev));
Mark Brown91151712008-11-30 23:31:24 +00003228
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003229 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
3230 if (dai == NULL)
3231 return -ENOMEM;
Eric Miao6335d052009-03-03 09:41:00 +08003232
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003233 /* create DAI component name */
3234 dai->name = fmt_single_name(dev, &dai->id);
3235 if (dai->name == NULL) {
3236 kfree(dai);
3237 return -ENOMEM;
3238 }
3239
3240 dai->dev = dev;
3241 dai->driver = dai_drv;
3242 if (!dai->driver->ops)
3243 dai->driver->ops = &null_dai_ops;
Mark Brown91151712008-11-30 23:31:24 +00003244
3245 mutex_lock(&client_mutex);
3246 list_add(&dai->list, &dai_list);
Mark Brown435c5e22008-12-04 15:32:53 +00003247 snd_soc_instantiate_cards();
Mark Brown91151712008-11-30 23:31:24 +00003248 mutex_unlock(&client_mutex);
3249
3250 pr_debug("Registered DAI '%s'\n", dai->name);
3251
3252 return 0;
3253}
3254EXPORT_SYMBOL_GPL(snd_soc_register_dai);
3255
3256/**
3257 * snd_soc_unregister_dai - Unregister a DAI from the ASoC core
3258 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003259 * @dai: DAI to unregister
Mark Brown91151712008-11-30 23:31:24 +00003260 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003261void snd_soc_unregister_dai(struct device *dev)
Mark Brown91151712008-11-30 23:31:24 +00003262{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003263 struct snd_soc_dai *dai;
3264
3265 list_for_each_entry(dai, &dai_list, list) {
3266 if (dev == dai->dev)
3267 goto found;
3268 }
3269 return;
3270
3271found:
Mark Brown91151712008-11-30 23:31:24 +00003272 mutex_lock(&client_mutex);
3273 list_del(&dai->list);
3274 mutex_unlock(&client_mutex);
3275
3276 pr_debug("Unregistered DAI '%s'\n", dai->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003277 kfree(dai->name);
3278 kfree(dai);
Mark Brown91151712008-11-30 23:31:24 +00003279}
3280EXPORT_SYMBOL_GPL(snd_soc_unregister_dai);
3281
3282/**
3283 * snd_soc_register_dais - Register multiple DAIs with the ASoC core
3284 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003285 * @dai: Array of DAIs to register
3286 * @count: Number of DAIs
Mark Brown91151712008-11-30 23:31:24 +00003287 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003288int snd_soc_register_dais(struct device *dev,
3289 struct snd_soc_dai_driver *dai_drv, size_t count)
Mark Brown91151712008-11-30 23:31:24 +00003290{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003291 struct snd_soc_dai *dai;
3292 int i, ret = 0;
3293
Liam Girdwood720ffa42010-08-18 00:30:30 +01003294 dev_dbg(dev, "dai register %s #%Zu\n", dev_name(dev), count);
Mark Brown91151712008-11-30 23:31:24 +00003295
3296 for (i = 0; i < count; i++) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003297
3298 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
Axel Linc46e0072010-11-03 15:04:45 +08003299 if (dai == NULL) {
3300 ret = -ENOMEM;
3301 goto err;
3302 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003303
3304 /* create DAI component name */
3305 dai->name = fmt_multiple_name(dev, &dai_drv[i]);
3306 if (dai->name == NULL) {
3307 kfree(dai);
3308 ret = -EINVAL;
Mark Brown91151712008-11-30 23:31:24 +00003309 goto err;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003310 }
3311
3312 dai->dev = dev;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003313 dai->driver = &dai_drv[i];
Mark Brown0f9141c2010-10-12 15:43:21 +01003314 if (dai->driver->id)
3315 dai->id = dai->driver->id;
3316 else
3317 dai->id = i;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003318 if (!dai->driver->ops)
3319 dai->driver->ops = &null_dai_ops;
3320
3321 mutex_lock(&client_mutex);
3322 list_add(&dai->list, &dai_list);
3323 mutex_unlock(&client_mutex);
3324
3325 pr_debug("Registered DAI '%s'\n", dai->name);
Mark Brown91151712008-11-30 23:31:24 +00003326 }
3327
Axel Lin1dcb4f32010-12-06 16:48:03 +08003328 mutex_lock(&client_mutex);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003329 snd_soc_instantiate_cards();
Axel Lin1dcb4f32010-12-06 16:48:03 +08003330 mutex_unlock(&client_mutex);
Mark Brown91151712008-11-30 23:31:24 +00003331 return 0;
3332
3333err:
3334 for (i--; i >= 0; i--)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003335 snd_soc_unregister_dai(dev);
Mark Brown91151712008-11-30 23:31:24 +00003336
3337 return ret;
3338}
3339EXPORT_SYMBOL_GPL(snd_soc_register_dais);
3340
3341/**
3342 * snd_soc_unregister_dais - Unregister multiple DAIs from the ASoC core
3343 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003344 * @dai: Array of DAIs to unregister
3345 * @count: Number of DAIs
Mark Brown91151712008-11-30 23:31:24 +00003346 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003347void snd_soc_unregister_dais(struct device *dev, size_t count)
Mark Brown91151712008-11-30 23:31:24 +00003348{
3349 int i;
3350
3351 for (i = 0; i < count; i++)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003352 snd_soc_unregister_dai(dev);
Mark Brown91151712008-11-30 23:31:24 +00003353}
3354EXPORT_SYMBOL_GPL(snd_soc_unregister_dais);
3355
Mark Brown12a48a8c2008-12-03 19:40:30 +00003356/**
3357 * snd_soc_register_platform - Register a platform with the ASoC core
3358 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003359 * @platform: platform to register
Mark Brown12a48a8c2008-12-03 19:40:30 +00003360 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003361int snd_soc_register_platform(struct device *dev,
3362 struct snd_soc_platform_driver *platform_drv)
Mark Brown12a48a8c2008-12-03 19:40:30 +00003363{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003364 struct snd_soc_platform *platform;
Mark Brown12a48a8c2008-12-03 19:40:30 +00003365
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003366 dev_dbg(dev, "platform register %s\n", dev_name(dev));
3367
3368 platform = kzalloc(sizeof(struct snd_soc_platform), GFP_KERNEL);
3369 if (platform == NULL)
3370 return -ENOMEM;
3371
3372 /* create platform component name */
3373 platform->name = fmt_single_name(dev, &platform->id);
3374 if (platform->name == NULL) {
3375 kfree(platform);
3376 return -ENOMEM;
3377 }
3378
3379 platform->dev = dev;
3380 platform->driver = platform_drv;
Mark Brown12a48a8c2008-12-03 19:40:30 +00003381
3382 mutex_lock(&client_mutex);
3383 list_add(&platform->list, &platform_list);
Mark Brown435c5e22008-12-04 15:32:53 +00003384 snd_soc_instantiate_cards();
Mark Brown12a48a8c2008-12-03 19:40:30 +00003385 mutex_unlock(&client_mutex);
3386
3387 pr_debug("Registered platform '%s'\n", platform->name);
3388
3389 return 0;
3390}
3391EXPORT_SYMBOL_GPL(snd_soc_register_platform);
3392
3393/**
3394 * snd_soc_unregister_platform - Unregister a platform from the ASoC core
3395 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003396 * @platform: platform to unregister
Mark Brown12a48a8c2008-12-03 19:40:30 +00003397 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003398void snd_soc_unregister_platform(struct device *dev)
Mark Brown12a48a8c2008-12-03 19:40:30 +00003399{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003400 struct snd_soc_platform *platform;
3401
3402 list_for_each_entry(platform, &platform_list, list) {
3403 if (dev == platform->dev)
3404 goto found;
3405 }
3406 return;
3407
3408found:
Mark Brown12a48a8c2008-12-03 19:40:30 +00003409 mutex_lock(&client_mutex);
3410 list_del(&platform->list);
3411 mutex_unlock(&client_mutex);
3412
3413 pr_debug("Unregistered platform '%s'\n", platform->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003414 kfree(platform->name);
3415 kfree(platform);
Mark Brown12a48a8c2008-12-03 19:40:30 +00003416}
3417EXPORT_SYMBOL_GPL(snd_soc_unregister_platform);
3418
Mark Brown151ab222009-05-09 16:22:58 +01003419static u64 codec_format_map[] = {
3420 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE,
3421 SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE,
3422 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_BE,
3423 SNDRV_PCM_FMTBIT_U24_LE | SNDRV_PCM_FMTBIT_U24_BE,
3424 SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE,
3425 SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE,
3426 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
3427 SNDRV_PCM_FMTBIT_U24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
3428 SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S20_3BE,
3429 SNDRV_PCM_FMTBIT_U20_3LE | SNDRV_PCM_FMTBIT_U20_3BE,
3430 SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S18_3BE,
3431 SNDRV_PCM_FMTBIT_U18_3LE | SNDRV_PCM_FMTBIT_U18_3BE,
3432 SNDRV_PCM_FMTBIT_FLOAT_LE | SNDRV_PCM_FMTBIT_FLOAT_BE,
3433 SNDRV_PCM_FMTBIT_FLOAT64_LE | SNDRV_PCM_FMTBIT_FLOAT64_BE,
3434 SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE
3435 | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE,
3436};
3437
3438/* Fix up the DAI formats for endianness: codecs don't actually see
3439 * the endianness of the data but we're using the CPU format
3440 * definitions which do need to include endianness so we ensure that
3441 * codec DAIs always have both big and little endian variants set.
3442 */
3443static void fixup_codec_formats(struct snd_soc_pcm_stream *stream)
3444{
3445 int i;
3446
3447 for (i = 0; i < ARRAY_SIZE(codec_format_map); i++)
3448 if (stream->formats & codec_format_map[i])
3449 stream->formats |= codec_format_map[i];
3450}
3451
Mark Brown0d0cf002008-12-10 14:32:45 +00003452/**
3453 * snd_soc_register_codec - Register a codec with the ASoC core
3454 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003455 * @codec: codec to register
Mark Brown0d0cf002008-12-10 14:32:45 +00003456 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003457int snd_soc_register_codec(struct device *dev,
Mark Brown001ae4c2010-12-02 16:21:08 +00003458 const struct snd_soc_codec_driver *codec_drv,
3459 struct snd_soc_dai_driver *dai_drv,
3460 int num_dai)
Mark Brown0d0cf002008-12-10 14:32:45 +00003461{
Dimitris Papastamos3335ddc2010-12-02 16:11:05 +00003462 size_t reg_size;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003463 struct snd_soc_codec *codec;
3464 int ret, i;
Mark Brown151ab222009-05-09 16:22:58 +01003465
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003466 dev_dbg(dev, "codec register %s\n", dev_name(dev));
Mark Brown0d0cf002008-12-10 14:32:45 +00003467
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003468 codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
3469 if (codec == NULL)
3470 return -ENOMEM;
Mark Brown0d0cf002008-12-10 14:32:45 +00003471
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003472 /* create CODEC component name */
3473 codec->name = fmt_single_name(dev, &codec->id);
3474 if (codec->name == NULL) {
3475 kfree(codec);
3476 return -ENOMEM;
Mark Brown151ab222009-05-09 16:22:58 +01003477 }
3478
Dimitris Papastamos23bbce32010-12-02 14:53:01 +00003479 if (codec_drv->compress_type)
3480 codec->compress_type = codec_drv->compress_type;
3481 else
3482 codec->compress_type = SND_SOC_FLAT_COMPRESSION;
3483
Liam Girdwoodce6120c2010-11-05 15:53:46 +02003484 INIT_LIST_HEAD(&codec->dapm.widgets);
Mark Brownc3acec22010-12-02 16:15:29 +00003485 codec->write = codec_drv->write;
3486 codec->read = codec_drv->read;
Liam Girdwoodce6120c2010-11-05 15:53:46 +02003487 codec->dapm.bias_level = SND_SOC_BIAS_OFF;
3488 codec->dapm.dev = dev;
3489 codec->dapm.codec = codec;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003490 codec->dev = dev;
3491 codec->driver = codec_drv;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003492 codec->num_dai = num_dai;
3493 mutex_init(&codec->mutex);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003494
Dimitris Papastamos7a30a3d2010-11-11 10:04:57 +00003495 /* allocate CODEC register cache */
3496 if (codec_drv->reg_cache_size && codec_drv->reg_word_size) {
Dimitris Papastamos3335ddc2010-12-02 16:11:05 +00003497 reg_size = codec_drv->reg_cache_size * codec_drv->reg_word_size;
3498 /* it is necessary to make a copy of the default register cache
3499 * because in the case of using a compression type that requires
3500 * the default register cache to be marked as __devinitconst the
3501 * kernel might have freed the array by the time we initialize
3502 * the cache.
3503 */
3504 codec->reg_def_copy = kmemdup(codec_drv->reg_cache_default,
3505 reg_size, GFP_KERNEL);
3506 if (!codec->reg_def_copy) {
3507 ret = -ENOMEM;
Dimitris Papastamosfdf0f542010-12-02 16:11:06 +00003508 goto fail;
Dimitris Papastamos7a30a3d2010-11-11 10:04:57 +00003509 }
3510 }
3511
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003512 for (i = 0; i < num_dai; i++) {
3513 fixup_codec_formats(&dai_drv[i].playback);
3514 fixup_codec_formats(&dai_drv[i].capture);
3515 }
3516
Mark Brown26b01cc2010-08-18 20:20:55 +01003517 /* register any DAIs */
3518 if (num_dai) {
3519 ret = snd_soc_register_dais(dev, dai_drv, num_dai);
3520 if (ret < 0)
Dimitris Papastamosfdf0f542010-12-02 16:11:06 +00003521 goto fail;
Mark Brown26b01cc2010-08-18 20:20:55 +01003522 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003523
Mark Brown0d0cf002008-12-10 14:32:45 +00003524 mutex_lock(&client_mutex);
3525 list_add(&codec->list, &codec_list);
3526 snd_soc_instantiate_cards();
3527 mutex_unlock(&client_mutex);
3528
3529 pr_debug("Registered codec '%s'\n", codec->name);
Mark Brown0d0cf002008-12-10 14:32:45 +00003530 return 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003531
Dimitris Papastamosfdf0f542010-12-02 16:11:06 +00003532fail:
Dimitris Papastamos3335ddc2010-12-02 16:11:05 +00003533 kfree(codec->reg_def_copy);
3534 codec->reg_def_copy = NULL;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003535 kfree(codec->name);
3536 kfree(codec);
3537 return ret;
Mark Brown0d0cf002008-12-10 14:32:45 +00003538}
3539EXPORT_SYMBOL_GPL(snd_soc_register_codec);
3540
3541/**
3542 * snd_soc_unregister_codec - Unregister a codec from the ASoC core
3543 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003544 * @codec: codec to unregister
Mark Brown0d0cf002008-12-10 14:32:45 +00003545 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003546void snd_soc_unregister_codec(struct device *dev)
Mark Brown0d0cf002008-12-10 14:32:45 +00003547{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003548 struct snd_soc_codec *codec;
3549 int i;
3550
3551 list_for_each_entry(codec, &codec_list, list) {
3552 if (dev == codec->dev)
3553 goto found;
3554 }
3555 return;
3556
3557found:
Mark Brown26b01cc2010-08-18 20:20:55 +01003558 if (codec->num_dai)
3559 for (i = 0; i < codec->num_dai; i++)
3560 snd_soc_unregister_dai(dev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003561
Mark Brown0d0cf002008-12-10 14:32:45 +00003562 mutex_lock(&client_mutex);
3563 list_del(&codec->list);
3564 mutex_unlock(&client_mutex);
3565
3566 pr_debug("Unregistered codec '%s'\n", codec->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003567
Dimitris Papastamos7a30a3d2010-11-11 10:04:57 +00003568 snd_soc_cache_exit(codec);
Dimitris Papastamos3335ddc2010-12-02 16:11:05 +00003569 kfree(codec->reg_def_copy);
Dimitris Papastamos1aafcd42010-10-21 13:19:45 +01003570 kfree(codec->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003571 kfree(codec);
Mark Brown0d0cf002008-12-10 14:32:45 +00003572}
3573EXPORT_SYMBOL_GPL(snd_soc_unregister_codec);
3574
Takashi Iwaic9b3a402008-12-10 07:47:22 +01003575static int __init snd_soc_init(void)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003576{
Mark Brown384c89e2008-12-03 17:34:03 +00003577#ifdef CONFIG_DEBUG_FS
3578 debugfs_root = debugfs_create_dir("asoc", NULL);
3579 if (IS_ERR(debugfs_root) || !debugfs_root) {
3580 printk(KERN_WARNING
3581 "ASoC: Failed to create debugfs directory\n");
3582 debugfs_root = NULL;
3583 }
Mark Brownc3c5a192010-09-15 18:15:14 +01003584
3585 if (!debugfs_create_file("codecs", 0444, debugfs_root, NULL,
3586 &codec_list_fops))
3587 pr_warn("ASoC: Failed to create CODEC list debugfs file\n");
3588
Mark Brownf3208782010-09-15 18:19:07 +01003589 if (!debugfs_create_file("dais", 0444, debugfs_root, NULL,
3590 &dai_list_fops))
3591 pr_warn("ASoC: Failed to create DAI list debugfs file\n");
Mark Brown19c7ac22010-09-15 18:22:40 +01003592
3593 if (!debugfs_create_file("platforms", 0444, debugfs_root, NULL,
3594 &platform_list_fops))
3595 pr_warn("ASoC: Failed to create platform list debugfs file\n");
Mark Brown384c89e2008-12-03 17:34:03 +00003596#endif
3597
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003598 return platform_driver_register(&soc_driver);
3599}
Mark Brown4abe8e12010-10-12 17:41:03 +01003600module_init(snd_soc_init);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003601
Mark Brown7d8c16a2008-11-30 22:11:24 +00003602static void __exit snd_soc_exit(void)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003603{
Mark Brown384c89e2008-12-03 17:34:03 +00003604#ifdef CONFIG_DEBUG_FS
3605 debugfs_remove_recursive(debugfs_root);
3606#endif
Mark Brown3ff3f642008-05-19 12:32:25 +02003607 platform_driver_unregister(&soc_driver);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003608}
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003609module_exit(snd_soc_exit);
3610
3611/* Module information */
Liam Girdwoodd3311242008-10-12 13:17:36 +01003612MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003613MODULE_DESCRIPTION("ALSA SoC Core");
3614MODULE_LICENSE("GPL");
Kay Sievers8b45a202008-04-14 13:33:36 +02003615MODULE_ALIAS("platform:soc-audio");