blob: c8d8dde7f4dde22db733245e7e6a0a6f0cb8befb [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>
36#include <sound/pcm.h>
37#include <sound/pcm_params.h>
38#include <sound/soc.h>
Frank Mandarinodb2a4162006-10-06 18:31:09 +020039#include <sound/initval.h>
40
Mark Browna8b1d342010-11-03 18:05:58 -040041#define CREATE_TRACE_POINTS
42#include <trace/events/asoc.h>
43
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000044#define NAME_SIZE 32
45
Frank Mandarinodb2a4162006-10-06 18:31:09 +020046static DEFINE_MUTEX(pcm_mutex);
Frank Mandarinodb2a4162006-10-06 18:31:09 +020047static DECLARE_WAIT_QUEUE_HEAD(soc_pm_waitq);
48
Mark Brown384c89e2008-12-03 17:34:03 +000049#ifdef CONFIG_DEBUG_FS
50static struct dentry *debugfs_root;
51#endif
52
Mark Brownc5af3a22008-11-28 13:29:45 +000053static DEFINE_MUTEX(client_mutex);
54static LIST_HEAD(card_list);
Mark Brown91151712008-11-30 23:31:24 +000055static LIST_HEAD(dai_list);
Mark Brown12a48a8c2008-12-03 19:40:30 +000056static LIST_HEAD(platform_list);
Mark Brown0d0cf002008-12-10 14:32:45 +000057static LIST_HEAD(codec_list);
Mark Brownc5af3a22008-11-28 13:29:45 +000058
59static int snd_soc_register_card(struct snd_soc_card *card);
60static int snd_soc_unregister_card(struct snd_soc_card *card);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000061static int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num);
Mark Brownc5af3a22008-11-28 13:29:45 +000062
Frank Mandarinodb2a4162006-10-06 18:31:09 +020063/*
64 * This is a timeout to do a DAPM powerdown after a stream is closed().
65 * It can be used to eliminate pops between different playback streams, e.g.
66 * between two audio tracks.
67 */
68static int pmdown_time = 5000;
69module_param(pmdown_time, int, 0);
70MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
71
Liam Girdwood965ac422007-01-31 14:14:57 +010072/*
73 * This function forces any delayed work to be queued and run.
74 */
75static int run_delayed_work(struct delayed_work *dwork)
76{
77 int ret;
78
79 /* cancel any work waiting to be queued. */
80 ret = cancel_delayed_work(dwork);
81
82 /* if there was any work waiting then we run it now and
83 * wait for it's completion */
84 if (ret) {
85 schedule_delayed_work(dwork, 0);
86 flush_scheduled_work();
87 }
88 return ret;
89}
90
Mark Brown2624d5f2009-11-03 21:56:13 +000091/* codec register dump */
92static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf)
93{
Mark Brown5164d742010-07-14 16:14:33 +010094 int ret, i, step = 1, count = 0;
Mark Brown2624d5f2009-11-03 21:56:13 +000095
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000096 if (!codec->driver->reg_cache_size)
Mark Brown2624d5f2009-11-03 21:56:13 +000097 return 0;
98
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000099 if (codec->driver->reg_cache_step)
100 step = codec->driver->reg_cache_step;
Mark Brown2624d5f2009-11-03 21:56:13 +0000101
102 count += sprintf(buf, "%s registers\n", codec->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000103 for (i = 0; i < codec->driver->reg_cache_size; i += step) {
104 if (codec->driver->readable_register && !codec->driver->readable_register(i))
Mark Brown2624d5f2009-11-03 21:56:13 +0000105 continue;
106
107 count += sprintf(buf + count, "%2x: ", i);
108 if (count >= PAGE_SIZE - 1)
109 break;
110
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000111 if (codec->driver->display_register) {
112 count += codec->driver->display_register(codec, buf + count,
Mark Brown2624d5f2009-11-03 21:56:13 +0000113 PAGE_SIZE - count, i);
Mark Brown5164d742010-07-14 16:14:33 +0100114 } else {
115 /* If the read fails it's almost certainly due to
116 * the register being volatile and the device being
117 * powered off.
118 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000119 ret = codec->driver->read(codec, i);
Mark Brown5164d742010-07-14 16:14:33 +0100120 if (ret >= 0)
121 count += snprintf(buf + count,
122 PAGE_SIZE - count,
123 "%4x", ret);
124 else
125 count += snprintf(buf + count,
126 PAGE_SIZE - count,
127 "<no data: %d>", ret);
128 }
Mark Brown2624d5f2009-11-03 21:56:13 +0000129
130 if (count >= PAGE_SIZE - 1)
131 break;
132
133 count += snprintf(buf + count, PAGE_SIZE - count, "\n");
134 if (count >= PAGE_SIZE - 1)
135 break;
136 }
137
138 /* Truncate count; min() would cause a warning */
139 if (count >= PAGE_SIZE)
140 count = PAGE_SIZE - 1;
141
142 return count;
143}
144static ssize_t codec_reg_show(struct device *dev,
145 struct device_attribute *attr, char *buf)
146{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000147 struct snd_soc_pcm_runtime *rtd =
148 container_of(dev, struct snd_soc_pcm_runtime, dev);
149
150 return soc_codec_reg_show(rtd->codec, buf);
Mark Brown2624d5f2009-11-03 21:56:13 +0000151}
152
153static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
154
Mark Browndbe21402010-02-12 11:37:24 +0000155static ssize_t pmdown_time_show(struct device *dev,
156 struct device_attribute *attr, char *buf)
157{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000158 struct snd_soc_pcm_runtime *rtd =
159 container_of(dev, struct snd_soc_pcm_runtime, dev);
Mark Browndbe21402010-02-12 11:37:24 +0000160
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000161 return sprintf(buf, "%ld\n", rtd->pmdown_time);
Mark Browndbe21402010-02-12 11:37:24 +0000162}
163
164static ssize_t pmdown_time_set(struct device *dev,
165 struct device_attribute *attr,
166 const char *buf, size_t count)
167{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000168 struct snd_soc_pcm_runtime *rtd =
169 container_of(dev, struct snd_soc_pcm_runtime, dev);
Mark Brownc593b522010-10-27 20:11:17 -0700170 int ret;
Mark Browndbe21402010-02-12 11:37:24 +0000171
Mark Brownc593b522010-10-27 20:11:17 -0700172 ret = strict_strtol(buf, 10, &rtd->pmdown_time);
173 if (ret)
174 return ret;
Mark Browndbe21402010-02-12 11:37:24 +0000175
176 return count;
177}
178
179static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set);
180
Mark Brown2624d5f2009-11-03 21:56:13 +0000181#ifdef CONFIG_DEBUG_FS
182static int codec_reg_open_file(struct inode *inode, struct file *file)
183{
184 file->private_data = inode->i_private;
185 return 0;
186}
187
188static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
189 size_t count, loff_t *ppos)
190{
191 ssize_t ret;
192 struct snd_soc_codec *codec = file->private_data;
193 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
194 if (!buf)
195 return -ENOMEM;
196 ret = soc_codec_reg_show(codec, buf);
197 if (ret >= 0)
198 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
199 kfree(buf);
200 return ret;
201}
202
203static ssize_t codec_reg_write_file(struct file *file,
204 const char __user *user_buf, size_t count, loff_t *ppos)
205{
206 char buf[32];
207 int buf_size;
208 char *start = buf;
209 unsigned long reg, value;
210 int step = 1;
211 struct snd_soc_codec *codec = file->private_data;
212
213 buf_size = min(count, (sizeof(buf)-1));
214 if (copy_from_user(buf, user_buf, buf_size))
215 return -EFAULT;
216 buf[buf_size] = 0;
217
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000218 if (codec->driver->reg_cache_step)
219 step = codec->driver->reg_cache_step;
Mark Brown2624d5f2009-11-03 21:56:13 +0000220
221 while (*start == ' ')
222 start++;
223 reg = simple_strtoul(start, &start, 16);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000224 if ((reg >= codec->driver->reg_cache_size) || (reg % step))
Mark Brown2624d5f2009-11-03 21:56:13 +0000225 return -EINVAL;
226 while (*start == ' ')
227 start++;
228 if (strict_strtoul(start, 16, &value))
229 return -EINVAL;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000230 codec->driver->write(codec, reg, value);
Mark Brown2624d5f2009-11-03 21:56:13 +0000231 return buf_size;
232}
233
234static const struct file_operations codec_reg_fops = {
235 .open = codec_reg_open_file,
236 .read = codec_reg_read_file,
237 .write = codec_reg_write_file,
Arnd Bergmann6038f372010-08-15 18:52:59 +0200238 .llseek = default_llseek,
Mark Brown2624d5f2009-11-03 21:56:13 +0000239};
240
241static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
242{
Jarkko Nikulad6ce4cf2010-11-05 20:35:20 +0200243 struct dentry *debugfs_card_root = codec->card->debugfs_card_root;
244
245 codec->debugfs_codec_root = debugfs_create_dir(codec->name,
246 debugfs_card_root);
Mark Brown2624d5f2009-11-03 21:56:13 +0000247 if (!codec->debugfs_codec_root) {
248 printk(KERN_WARNING
249 "ASoC: Failed to create codec debugfs directory\n");
250 return;
251 }
252
253 codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
254 codec->debugfs_codec_root,
255 codec, &codec_reg_fops);
256 if (!codec->debugfs_reg)
257 printk(KERN_WARNING
258 "ASoC: Failed to create codec register debugfs file\n");
259
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200260 codec->dapm.debugfs_dapm = debugfs_create_dir("dapm",
Mark Brown2624d5f2009-11-03 21:56:13 +0000261 codec->debugfs_codec_root);
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200262 if (!codec->dapm.debugfs_dapm)
Mark Brown2624d5f2009-11-03 21:56:13 +0000263 printk(KERN_WARNING
264 "Failed to create DAPM debugfs directory\n");
265
Liam Girdwoodce6120c2010-11-05 15:53:46 +0200266 snd_soc_dapm_debugfs_init(&codec->dapm);
Mark Brown2624d5f2009-11-03 21:56:13 +0000267}
268
269static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
270{
271 debugfs_remove_recursive(codec->debugfs_codec_root);
272}
273
Mark Brownc3c5a192010-09-15 18:15:14 +0100274static ssize_t codec_list_read_file(struct file *file, char __user *user_buf,
275 size_t count, loff_t *ppos)
276{
277 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
Mark Brown2b194f9d2010-10-13 10:52:16 +0100278 ssize_t len, ret = 0;
Mark Brownc3c5a192010-09-15 18:15:14 +0100279 struct snd_soc_codec *codec;
280
281 if (!buf)
282 return -ENOMEM;
283
Mark Brown2b194f9d2010-10-13 10:52:16 +0100284 list_for_each_entry(codec, &codec_list, list) {
285 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
286 codec->name);
287 if (len >= 0)
288 ret += len;
289 if (ret > PAGE_SIZE) {
290 ret = PAGE_SIZE;
291 break;
292 }
293 }
Mark Brownc3c5a192010-09-15 18:15:14 +0100294
295 if (ret >= 0)
296 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
297
298 kfree(buf);
299
300 return ret;
301}
302
303static const struct file_operations codec_list_fops = {
304 .read = codec_list_read_file,
305 .llseek = default_llseek,/* read accesses f_pos */
306};
307
Mark Brownf3208782010-09-15 18:19:07 +0100308static ssize_t dai_list_read_file(struct file *file, char __user *user_buf,
309 size_t count, loff_t *ppos)
310{
311 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
Mark Brown2b194f9d2010-10-13 10:52:16 +0100312 ssize_t len, ret = 0;
Mark Brownf3208782010-09-15 18:19:07 +0100313 struct snd_soc_dai *dai;
314
315 if (!buf)
316 return -ENOMEM;
317
Mark Brown2b194f9d2010-10-13 10:52:16 +0100318 list_for_each_entry(dai, &dai_list, list) {
319 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n", dai->name);
320 if (len >= 0)
321 ret += len;
322 if (ret > PAGE_SIZE) {
323 ret = PAGE_SIZE;
324 break;
325 }
326 }
Mark Brownf3208782010-09-15 18:19:07 +0100327
Mark Brown2b194f9d2010-10-13 10:52:16 +0100328 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
Mark Brownf3208782010-09-15 18:19:07 +0100329
330 kfree(buf);
331
332 return ret;
333}
334
335static const struct file_operations dai_list_fops = {
336 .read = dai_list_read_file,
337 .llseek = default_llseek,/* read accesses f_pos */
338};
339
Mark Brown19c7ac22010-09-15 18:22:40 +0100340static ssize_t platform_list_read_file(struct file *file,
341 char __user *user_buf,
342 size_t count, loff_t *ppos)
343{
344 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
Mark Brown2b194f9d2010-10-13 10:52:16 +0100345 ssize_t len, ret = 0;
Mark Brown19c7ac22010-09-15 18:22:40 +0100346 struct snd_soc_platform *platform;
347
348 if (!buf)
349 return -ENOMEM;
350
Mark Brown2b194f9d2010-10-13 10:52:16 +0100351 list_for_each_entry(platform, &platform_list, list) {
352 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
353 platform->name);
354 if (len >= 0)
355 ret += len;
356 if (ret > PAGE_SIZE) {
357 ret = PAGE_SIZE;
358 break;
359 }
360 }
Mark Brown19c7ac22010-09-15 18:22:40 +0100361
Mark Brown2b194f9d2010-10-13 10:52:16 +0100362 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
Mark Brown19c7ac22010-09-15 18:22:40 +0100363
364 kfree(buf);
365
366 return ret;
367}
368
369static const struct file_operations platform_list_fops = {
370 .read = platform_list_read_file,
371 .llseek = default_llseek,/* read accesses f_pos */
372};
373
Jarkko Nikulaa6052152010-11-05 20:35:19 +0200374static void soc_init_card_debugfs(struct snd_soc_card *card)
375{
376 card->debugfs_card_root = debugfs_create_dir(card->name,
377 debugfs_root);
Jarkko Nikula3a45b862010-11-05 20:35:21 +0200378 if (!card->debugfs_card_root) {
Jarkko Nikulaa6052152010-11-05 20:35:19 +0200379 dev_warn(card->dev,
380 "ASoC: Failed to create codec debugfs directory\n");
Jarkko Nikula3a45b862010-11-05 20:35:21 +0200381 return;
382 }
383
384 card->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0644,
385 card->debugfs_card_root,
386 &card->pop_time);
387 if (!card->debugfs_pop_time)
388 dev_warn(card->dev,
389 "Failed to create pop time debugfs file\n");
Jarkko Nikulaa6052152010-11-05 20:35:19 +0200390}
391
392static void soc_cleanup_card_debugfs(struct snd_soc_card *card)
393{
394 debugfs_remove_recursive(card->debugfs_card_root);
395}
396
Mark Brown2624d5f2009-11-03 21:56:13 +0000397#else
398
399static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
400{
401}
402
403static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
404{
405}
Axel Linb95fccb2010-11-09 17:06:44 +0800406
407static inline void soc_init_card_debugfs(struct snd_soc_card *card)
408{
409}
410
411static inline void soc_cleanup_card_debugfs(struct snd_soc_card *card)
412{
413}
Mark Brown2624d5f2009-11-03 21:56:13 +0000414#endif
415
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200416#ifdef CONFIG_SND_SOC_AC97_BUS
417/* unregister ac97 codec */
418static int soc_ac97_dev_unregister(struct snd_soc_codec *codec)
419{
420 if (codec->ac97->dev.bus)
421 device_unregister(&codec->ac97->dev);
422 return 0;
423}
424
425/* stop no dev release warning */
426static void soc_ac97_device_release(struct device *dev){}
427
428/* register ac97 codec to bus */
429static int soc_ac97_dev_register(struct snd_soc_codec *codec)
430{
431 int err;
432
433 codec->ac97->dev.bus = &ac97_bus_type;
Mark Brown4ac5c612009-04-01 19:35:01 +0100434 codec->ac97->dev.parent = codec->card->dev;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200435 codec->ac97->dev.release = soc_ac97_device_release;
436
Kay Sieversbb072bf2008-11-02 03:50:35 +0100437 dev_set_name(&codec->ac97->dev, "%d-%d:%s",
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000438 codec->card->snd_card->number, 0, codec->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200439 err = device_register(&codec->ac97->dev);
440 if (err < 0) {
441 snd_printk(KERN_ERR "Can't register ac97 bus\n");
442 codec->ac97->dev.bus = NULL;
443 return err;
444 }
445 return 0;
446}
447#endif
448
Mark Brown06f409d2009-04-07 18:10:13 +0100449static int soc_pcm_apply_symmetry(struct snd_pcm_substream *substream)
450{
451 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000452 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
453 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Mark Brown06f409d2009-04-07 18:10:13 +0100454 int ret;
455
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000456 if (codec_dai->driver->symmetric_rates || cpu_dai->driver->symmetric_rates ||
457 rtd->dai_link->symmetric_rates) {
458 dev_dbg(&rtd->dev, "Symmetry forces %dHz rate\n",
459 rtd->rate);
Mark Brown06f409d2009-04-07 18:10:13 +0100460
461 ret = snd_pcm_hw_constraint_minmax(substream->runtime,
462 SNDRV_PCM_HW_PARAM_RATE,
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000463 rtd->rate,
464 rtd->rate);
Mark Brown06f409d2009-04-07 18:10:13 +0100465 if (ret < 0) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000466 dev_err(&rtd->dev,
Mark Brown06f409d2009-04-07 18:10:13 +0100467 "Unable to apply rate symmetry constraint: %d\n", ret);
468 return ret;
469 }
470 }
471
472 return 0;
473}
474
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200475/*
476 * Called by ALSA when a PCM substream is opened, the runtime->hw record is
477 * then initialized and any private data can be allocated. This also calls
478 * startup for the cpu DAI, platform, machine and codec DAI.
479 */
480static int soc_pcm_open(struct snd_pcm_substream *substream)
481{
482 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200483 struct snd_pcm_runtime *runtime = substream->runtime;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000484 struct snd_soc_platform *platform = rtd->platform;
485 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
486 struct snd_soc_dai *codec_dai = rtd->codec_dai;
487 struct snd_soc_dai_driver *cpu_dai_drv = cpu_dai->driver;
488 struct snd_soc_dai_driver *codec_dai_drv = codec_dai->driver;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200489 int ret = 0;
490
491 mutex_lock(&pcm_mutex);
492
493 /* startup the audio subsystem */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000494 if (cpu_dai->driver->ops->startup) {
495 ret = cpu_dai->driver->ops->startup(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200496 if (ret < 0) {
497 printk(KERN_ERR "asoc: can't open interface %s\n",
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100498 cpu_dai->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200499 goto out;
500 }
501 }
502
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000503 if (platform->driver->ops->open) {
504 ret = platform->driver->ops->open(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200505 if (ret < 0) {
506 printk(KERN_ERR "asoc: can't open platform %s\n", platform->name);
507 goto platform_err;
508 }
509 }
510
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000511 if (codec_dai->driver->ops->startup) {
512 ret = codec_dai->driver->ops->startup(substream, codec_dai);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100513 if (ret < 0) {
514 printk(KERN_ERR "asoc: can't open codec %s\n",
515 codec_dai->name);
516 goto codec_dai_err;
517 }
518 }
519
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000520 if (rtd->dai_link->ops && rtd->dai_link->ops->startup) {
521 ret = rtd->dai_link->ops->startup(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200522 if (ret < 0) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000523 printk(KERN_ERR "asoc: %s startup failed\n", rtd->dai_link->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200524 goto machine_err;
525 }
526 }
527
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200528 /* Check that the codec and cpu DAI's are compatible */
529 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
530 runtime->hw.rate_min =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000531 max(codec_dai_drv->playback.rate_min,
532 cpu_dai_drv->playback.rate_min);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200533 runtime->hw.rate_max =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000534 min(codec_dai_drv->playback.rate_max,
535 cpu_dai_drv->playback.rate_max);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200536 runtime->hw.channels_min =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000537 max(codec_dai_drv->playback.channels_min,
538 cpu_dai_drv->playback.channels_min);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200539 runtime->hw.channels_max =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000540 min(codec_dai_drv->playback.channels_max,
541 cpu_dai_drv->playback.channels_max);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100542 runtime->hw.formats =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000543 codec_dai_drv->playback.formats & cpu_dai_drv->playback.formats;
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100544 runtime->hw.rates =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000545 codec_dai_drv->playback.rates & cpu_dai_drv->playback.rates;
546 if (codec_dai_drv->playback.rates
Jassi Brard9ad6292010-03-12 13:38:52 +0900547 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000548 runtime->hw.rates |= cpu_dai_drv->playback.rates;
549 if (cpu_dai_drv->playback.rates
Jassi Brard9ad6292010-03-12 13:38:52 +0900550 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000551 runtime->hw.rates |= codec_dai_drv->playback.rates;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200552 } else {
553 runtime->hw.rate_min =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000554 max(codec_dai_drv->capture.rate_min,
555 cpu_dai_drv->capture.rate_min);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200556 runtime->hw.rate_max =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000557 min(codec_dai_drv->capture.rate_max,
558 cpu_dai_drv->capture.rate_max);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200559 runtime->hw.channels_min =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000560 max(codec_dai_drv->capture.channels_min,
561 cpu_dai_drv->capture.channels_min);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200562 runtime->hw.channels_max =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000563 min(codec_dai_drv->capture.channels_max,
564 cpu_dai_drv->capture.channels_max);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100565 runtime->hw.formats =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000566 codec_dai_drv->capture.formats & cpu_dai_drv->capture.formats;
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100567 runtime->hw.rates =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000568 codec_dai_drv->capture.rates & cpu_dai_drv->capture.rates;
569 if (codec_dai_drv->capture.rates
Jassi Brard9ad6292010-03-12 13:38:52 +0900570 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000571 runtime->hw.rates |= cpu_dai_drv->capture.rates;
572 if (cpu_dai_drv->capture.rates
Jassi Brard9ad6292010-03-12 13:38:52 +0900573 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000574 runtime->hw.rates |= codec_dai_drv->capture.rates;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200575 }
576
577 snd_pcm_limit_hw_rates(runtime);
578 if (!runtime->hw.rates) {
579 printk(KERN_ERR "asoc: %s <-> %s No matching rates\n",
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100580 codec_dai->name, cpu_dai->name);
Jassi Brarbb1c0472010-02-25 11:24:53 +0900581 goto config_err;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200582 }
583 if (!runtime->hw.formats) {
584 printk(KERN_ERR "asoc: %s <-> %s No matching formats\n",
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100585 codec_dai->name, cpu_dai->name);
Jassi Brarbb1c0472010-02-25 11:24:53 +0900586 goto config_err;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200587 }
588 if (!runtime->hw.channels_min || !runtime->hw.channels_max) {
589 printk(KERN_ERR "asoc: %s <-> %s No matching channels\n",
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000590 codec_dai->name, cpu_dai->name);
Jassi Brarbb1c0472010-02-25 11:24:53 +0900591 goto config_err;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200592 }
593
Mark Brown06f409d2009-04-07 18:10:13 +0100594 /* Symmetry only applies if we've already got an active stream. */
595 if (cpu_dai->active || codec_dai->active) {
596 ret = soc_pcm_apply_symmetry(substream);
597 if (ret != 0)
Jassi Brarbb1c0472010-02-25 11:24:53 +0900598 goto config_err;
Mark Brown06f409d2009-04-07 18:10:13 +0100599 }
600
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000601 pr_debug("asoc: %s <-> %s info:\n",
602 codec_dai->name, cpu_dai->name);
Mark Brownf24368c2008-10-21 21:45:08 +0100603 pr_debug("asoc: rate mask 0x%x\n", runtime->hw.rates);
604 pr_debug("asoc: min ch %d max ch %d\n", runtime->hw.channels_min,
605 runtime->hw.channels_max);
606 pr_debug("asoc: min rate %d max rate %d\n", runtime->hw.rate_min,
607 runtime->hw.rate_max);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200608
Jassi Brar14dc5732010-02-26 09:12:32 +0900609 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000610 cpu_dai->playback_active++;
611 codec_dai->playback_active++;
Jassi Brar14dc5732010-02-26 09:12:32 +0900612 } else {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000613 cpu_dai->capture_active++;
614 codec_dai->capture_active++;
Jassi Brar14dc5732010-02-26 09:12:32 +0900615 }
616 cpu_dai->active++;
617 codec_dai->active++;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000618 rtd->codec->active++;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200619 mutex_unlock(&pcm_mutex);
620 return 0;
621
Jassi Brarbb1c0472010-02-25 11:24:53 +0900622config_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000623 if (rtd->dai_link->ops && rtd->dai_link->ops->shutdown)
624 rtd->dai_link->ops->shutdown(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200625
Jassi Brarbb1c0472010-02-25 11:24:53 +0900626machine_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000627 if (codec_dai->driver->ops->shutdown)
628 codec_dai->driver->ops->shutdown(substream, codec_dai);
Jassi Brarbb1c0472010-02-25 11:24:53 +0900629
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100630codec_dai_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000631 if (platform->driver->ops->close)
632 platform->driver->ops->close(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200633
634platform_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000635 if (cpu_dai->driver->ops->shutdown)
636 cpu_dai->driver->ops->shutdown(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200637out:
638 mutex_unlock(&pcm_mutex);
639 return ret;
640}
641
642/*
Robert P. J. Day3a4fa0a2007-10-19 23:10:43 +0200643 * Power down the audio subsystem pmdown_time msecs after close is called.
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200644 * This is to ensure there are no pops or clicks in between any music tracks
645 * due to DAPM power cycling.
646 */
Andrew Morton4484bb22006-12-15 09:30:07 +0100647static void close_delayed_work(struct work_struct *work)
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200648{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000649 struct snd_soc_pcm_runtime *rtd =
650 container_of(work, struct snd_soc_pcm_runtime, delayed_work.work);
651 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200652
653 mutex_lock(&pcm_mutex);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200654
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000655 pr_debug("pop wq checking: %s status: %s waiting: %s\n",
656 codec_dai->driver->playback.stream_name,
657 codec_dai->playback_active ? "active" : "inactive",
658 codec_dai->pop_wait ? "yes" : "no");
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200659
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000660 /* are we waiting on this codec DAI stream */
661 if (codec_dai->pop_wait == 1) {
662 codec_dai->pop_wait = 0;
663 snd_soc_dapm_stream_event(rtd,
664 codec_dai->driver->playback.stream_name,
665 SND_SOC_DAPM_STREAM_STOP);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200666 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000667
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200668 mutex_unlock(&pcm_mutex);
669}
670
671/*
672 * Called by ALSA when a PCM substream is closed. Private data can be
673 * freed here. The cpu DAI, codec DAI, machine and platform are also
674 * shutdown.
675 */
676static int soc_codec_close(struct snd_pcm_substream *substream)
677{
678 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000679 struct snd_soc_platform *platform = rtd->platform;
680 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
681 struct snd_soc_dai *codec_dai = rtd->codec_dai;
682 struct snd_soc_codec *codec = rtd->codec;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200683
684 mutex_lock(&pcm_mutex);
685
Jassi Brar14dc5732010-02-26 09:12:32 +0900686 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000687 cpu_dai->playback_active--;
688 codec_dai->playback_active--;
Jassi Brar14dc5732010-02-26 09:12:32 +0900689 } else {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000690 cpu_dai->capture_active--;
691 codec_dai->capture_active--;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200692 }
Jassi Brar14dc5732010-02-26 09:12:32 +0900693
694 cpu_dai->active--;
695 codec_dai->active--;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200696 codec->active--;
697
Mark Brown6010b2d2008-09-06 18:33:24 +0100698 /* Muting the DAC suppresses artifacts caused during digital
699 * shutdown, for example from stopping clocks.
700 */
701 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
702 snd_soc_dai_digital_mute(codec_dai, 1);
703
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000704 if (cpu_dai->driver->ops->shutdown)
705 cpu_dai->driver->ops->shutdown(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200706
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000707 if (codec_dai->driver->ops->shutdown)
708 codec_dai->driver->ops->shutdown(substream, codec_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200709
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000710 if (rtd->dai_link->ops && rtd->dai_link->ops->shutdown)
711 rtd->dai_link->ops->shutdown(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200712
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000713 if (platform->driver->ops->close)
714 platform->driver->ops->close(substream);
715 cpu_dai->runtime = NULL;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200716
717 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
718 /* start delayed pop wq here for playback streams */
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100719 codec_dai->pop_wait = 1;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000720 schedule_delayed_work(&rtd->delayed_work,
721 msecs_to_jiffies(rtd->pmdown_time));
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200722 } else {
723 /* capture streams can be powered down now */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000724 snd_soc_dapm_stream_event(rtd,
725 codec_dai->driver->capture.stream_name,
Liam Girdwood0b4d2212008-01-10 14:36:20 +0100726 SND_SOC_DAPM_STREAM_STOP);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200727 }
728
729 mutex_unlock(&pcm_mutex);
730 return 0;
731}
732
733/*
734 * Called by ALSA when the PCM substream is prepared, can set format, sample
735 * rate, etc. This function is non atomic and can be called multiple times,
736 * it can refer to the runtime info.
737 */
738static int soc_pcm_prepare(struct snd_pcm_substream *substream)
739{
740 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000741 struct snd_soc_platform *platform = rtd->platform;
742 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
743 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200744 int ret = 0;
745
746 mutex_lock(&pcm_mutex);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100747
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000748 if (rtd->dai_link->ops && rtd->dai_link->ops->prepare) {
749 ret = rtd->dai_link->ops->prepare(substream);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100750 if (ret < 0) {
751 printk(KERN_ERR "asoc: machine prepare error\n");
752 goto out;
753 }
754 }
755
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000756 if (platform->driver->ops->prepare) {
757 ret = platform->driver->ops->prepare(substream);
Liam Girdwooda71a4682006-10-19 20:35:56 +0200758 if (ret < 0) {
759 printk(KERN_ERR "asoc: platform prepare error\n");
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200760 goto out;
Liam Girdwooda71a4682006-10-19 20:35:56 +0200761 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200762 }
763
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000764 if (codec_dai->driver->ops->prepare) {
765 ret = codec_dai->driver->ops->prepare(substream, codec_dai);
Liam Girdwooda71a4682006-10-19 20:35:56 +0200766 if (ret < 0) {
767 printk(KERN_ERR "asoc: codec DAI prepare error\n");
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200768 goto out;
Liam Girdwooda71a4682006-10-19 20:35:56 +0200769 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200770 }
771
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000772 if (cpu_dai->driver->ops->prepare) {
773 ret = cpu_dai->driver->ops->prepare(substream, cpu_dai);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100774 if (ret < 0) {
775 printk(KERN_ERR "asoc: cpu DAI prepare error\n");
776 goto out;
777 }
778 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200779
Mark Brownd45f6212008-10-14 13:58:36 +0100780 /* cancel any delayed stream shutdown that is pending */
781 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
782 codec_dai->pop_wait) {
783 codec_dai->pop_wait = 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000784 cancel_delayed_work(&rtd->delayed_work);
Mark Brownd45f6212008-10-14 13:58:36 +0100785 }
786
Mark Brown452c5ea2009-05-17 21:41:23 +0100787 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000788 snd_soc_dapm_stream_event(rtd,
789 codec_dai->driver->playback.stream_name,
Mark Brown452c5ea2009-05-17 21:41:23 +0100790 SND_SOC_DAPM_STREAM_START);
791 else
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000792 snd_soc_dapm_stream_event(rtd,
793 codec_dai->driver->capture.stream_name,
Mark Brown452c5ea2009-05-17 21:41:23 +0100794 SND_SOC_DAPM_STREAM_START);
Mark Brownd45f6212008-10-14 13:58:36 +0100795
Mark Brown452c5ea2009-05-17 21:41:23 +0100796 snd_soc_dai_digital_mute(codec_dai, 0);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200797
798out:
799 mutex_unlock(&pcm_mutex);
800 return ret;
801}
802
803/*
804 * Called by ALSA when the hardware params are set by application. This
805 * function can also be called multiple times and can allocate buffers
806 * (using snd_pcm_lib_* ). It's non-atomic.
807 */
808static int soc_pcm_hw_params(struct snd_pcm_substream *substream,
809 struct snd_pcm_hw_params *params)
810{
811 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000812 struct snd_soc_platform *platform = rtd->platform;
813 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
814 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200815 int ret = 0;
816
817 mutex_lock(&pcm_mutex);
818
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000819 if (rtd->dai_link->ops && rtd->dai_link->ops->hw_params) {
820 ret = rtd->dai_link->ops->hw_params(substream, params);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200821 if (ret < 0) {
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100822 printk(KERN_ERR "asoc: machine hw_params failed\n");
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200823 goto out;
824 }
825 }
826
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000827 if (codec_dai->driver->ops->hw_params) {
828 ret = codec_dai->driver->ops->hw_params(substream, params, codec_dai);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100829 if (ret < 0) {
830 printk(KERN_ERR "asoc: can't set codec %s hw params\n",
831 codec_dai->name);
832 goto codec_err;
833 }
834 }
835
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000836 if (cpu_dai->driver->ops->hw_params) {
837 ret = cpu_dai->driver->ops->hw_params(substream, params, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200838 if (ret < 0) {
Mark Brown3ff3f642008-05-19 12:32:25 +0200839 printk(KERN_ERR "asoc: interface %s hw params failed\n",
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100840 cpu_dai->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200841 goto interface_err;
842 }
843 }
844
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000845 if (platform->driver->ops->hw_params) {
846 ret = platform->driver->ops->hw_params(substream, params);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200847 if (ret < 0) {
Mark Brown3ff3f642008-05-19 12:32:25 +0200848 printk(KERN_ERR "asoc: platform %s hw params failed\n",
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200849 platform->name);
850 goto platform_err;
851 }
852 }
853
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000854 rtd->rate = params_rate(params);
Mark Brown06f409d2009-04-07 18:10:13 +0100855
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200856out:
857 mutex_unlock(&pcm_mutex);
858 return ret;
859
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200860platform_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000861 if (cpu_dai->driver->ops->hw_free)
862 cpu_dai->driver->ops->hw_free(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200863
864interface_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000865 if (codec_dai->driver->ops->hw_free)
866 codec_dai->driver->ops->hw_free(substream, codec_dai);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100867
868codec_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000869 if (rtd->dai_link->ops && rtd->dai_link->ops->hw_free)
870 rtd->dai_link->ops->hw_free(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200871
872 mutex_unlock(&pcm_mutex);
873 return ret;
874}
875
876/*
877 * Free's resources allocated by hw_params, can be called multiple times
878 */
879static int soc_pcm_hw_free(struct snd_pcm_substream *substream)
880{
881 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000882 struct snd_soc_platform *platform = rtd->platform;
883 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
884 struct snd_soc_dai *codec_dai = rtd->codec_dai;
885 struct snd_soc_codec *codec = rtd->codec;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200886
887 mutex_lock(&pcm_mutex);
888
889 /* apply codec digital mute */
Liam Girdwood8c6529d2008-07-08 13:19:13 +0100890 if (!codec->active)
891 snd_soc_dai_digital_mute(codec_dai, 1);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200892
893 /* free any machine hw params */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000894 if (rtd->dai_link->ops && rtd->dai_link->ops->hw_free)
895 rtd->dai_link->ops->hw_free(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200896
897 /* free any DMA resources */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000898 if (platform->driver->ops->hw_free)
899 platform->driver->ops->hw_free(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200900
901 /* now free hw params for the DAI's */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000902 if (codec_dai->driver->ops->hw_free)
903 codec_dai->driver->ops->hw_free(substream, codec_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200904
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000905 if (cpu_dai->driver->ops->hw_free)
906 cpu_dai->driver->ops->hw_free(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200907
908 mutex_unlock(&pcm_mutex);
909 return 0;
910}
911
912static int soc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
913{
914 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000915 struct snd_soc_platform *platform = rtd->platform;
916 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
917 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200918 int ret;
919
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000920 if (codec_dai->driver->ops->trigger) {
921 ret = codec_dai->driver->ops->trigger(substream, cmd, codec_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200922 if (ret < 0)
923 return ret;
924 }
925
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000926 if (platform->driver->ops->trigger) {
927 ret = platform->driver->ops->trigger(substream, cmd);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200928 if (ret < 0)
929 return ret;
930 }
931
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000932 if (cpu_dai->driver->ops->trigger) {
933 ret = cpu_dai->driver->ops->trigger(substream, cmd, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200934 if (ret < 0)
935 return ret;
936 }
937 return 0;
938}
939
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200940/*
941 * soc level wrapper for pointer callback
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200942 * If cpu_dai, codec_dai, platform driver has the delay callback, than
943 * the runtime->delay will be updated accordingly.
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200944 */
945static snd_pcm_uframes_t soc_pcm_pointer(struct snd_pcm_substream *substream)
946{
947 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000948 struct snd_soc_platform *platform = rtd->platform;
949 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
950 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200951 struct snd_pcm_runtime *runtime = substream->runtime;
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200952 snd_pcm_uframes_t offset = 0;
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200953 snd_pcm_sframes_t delay = 0;
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200954
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000955 if (platform->driver->ops->pointer)
956 offset = platform->driver->ops->pointer(substream);
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200957
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000958 if (cpu_dai->driver->ops->delay)
959 delay += cpu_dai->driver->ops->delay(substream, cpu_dai);
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200960
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000961 if (codec_dai->driver->ops->delay)
962 delay += codec_dai->driver->ops->delay(substream, codec_dai);
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200963
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000964 if (platform->driver->delay)
965 delay += platform->driver->delay(substream, codec_dai);
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200966
967 runtime->delay = delay;
968
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200969 return offset;
970}
971
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200972/* ASoC PCM operations */
973static struct snd_pcm_ops soc_pcm_ops = {
974 .open = soc_pcm_open,
975 .close = soc_codec_close,
976 .hw_params = soc_pcm_hw_params,
977 .hw_free = soc_pcm_hw_free,
978 .prepare = soc_pcm_prepare,
979 .trigger = soc_pcm_trigger,
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200980 .pointer = soc_pcm_pointer,
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200981};
982
983#ifdef CONFIG_PM
984/* powers down audio subsystem for suspend */
Mark Brown416356f2009-06-30 19:05:15 +0100985static int soc_suspend(struct device *dev)
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200986{
Mark Brown416356f2009-06-30 19:05:15 +0100987 struct platform_device *pdev = to_platform_device(dev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000988 struct snd_soc_card *card = platform_get_drvdata(pdev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200989 int i;
990
Daniel Macke3509ff2009-06-03 17:44:49 +0200991 /* If the initialization of this soc device failed, there is no codec
992 * associated with it. Just bail out in this case.
993 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000994 if (list_empty(&card->codec_dev_list))
Daniel Macke3509ff2009-06-03 17:44:49 +0200995 return 0;
996
Andy Green6ed25972008-06-13 16:24:05 +0100997 /* Due to the resume being scheduled into a workqueue we could
998 * suspend before that's finished - wait for it to complete.
999 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001000 snd_power_lock(card->snd_card);
1001 snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0);
1002 snd_power_unlock(card->snd_card);
Andy Green6ed25972008-06-13 16:24:05 +01001003
1004 /* we're going to block userspace touching us until resume completes */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001005 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
Andy Green6ed25972008-06-13 16:24:05 +01001006
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001007 /* mute any active DAC's */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001008 for (i = 0; i < card->num_rtd; i++) {
1009 struct snd_soc_dai *dai = card->rtd[i].codec_dai;
1010 struct snd_soc_dai_driver *drv = dai->driver;
Mark Brown3efab7d2010-05-09 13:25:43 +01001011
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001012 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001013 continue;
1014
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001015 if (drv->ops->digital_mute && dai->playback_active)
1016 drv->ops->digital_mute(dai, 1);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001017 }
1018
Liam Girdwood4ccab3e2008-01-10 14:39:01 +01001019 /* suspend all pcms */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001020 for (i = 0; i < card->num_rtd; i++) {
1021 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001022 continue;
1023
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001024 snd_pcm_suspend_all(card->rtd[i].pcm);
Mark Brown3efab7d2010-05-09 13:25:43 +01001025 }
Liam Girdwood4ccab3e2008-01-10 14:39:01 +01001026
Mark Brown87506542008-11-18 20:50:34 +00001027 if (card->suspend_pre)
Mark Brown416356f2009-06-30 19:05:15 +01001028 card->suspend_pre(pdev, PMSG_SUSPEND);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001029
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001030 for (i = 0; i < card->num_rtd; i++) {
1031 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1032 struct snd_soc_platform *platform = card->rtd[i].platform;
Mark Brown3efab7d2010-05-09 13:25:43 +01001033
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001034 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001035 continue;
1036
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001037 if (cpu_dai->driver->suspend && !cpu_dai->driver->ac97_control)
1038 cpu_dai->driver->suspend(cpu_dai);
1039 if (platform->driver->suspend && !platform->suspended) {
1040 platform->driver->suspend(cpu_dai);
1041 platform->suspended = 1;
Mark Brown1547aba2010-05-07 21:11:40 +01001042 }
1043 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001044
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001045 /* close any waiting streams and save state */
1046 for (i = 0; i < card->num_rtd; i++) {
1047 run_delayed_work(&card->rtd[i].delayed_work);
Liam Girdwoodce6120c2010-11-05 15:53:46 +02001048 card->rtd[i].codec->dapm.suspend_bias_level = card->rtd[i].codec->dapm.bias_level;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001049 }
Mark Brown3efab7d2010-05-09 13:25:43 +01001050
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001051 for (i = 0; i < card->num_rtd; i++) {
1052 struct snd_soc_dai_driver *driver = card->rtd[i].codec_dai->driver;
1053
1054 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001055 continue;
1056
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001057 if (driver->playback.stream_name != NULL)
1058 snd_soc_dapm_stream_event(&card->rtd[i], driver->playback.stream_name,
1059 SND_SOC_DAPM_STREAM_SUSPEND);
1060
1061 if (driver->capture.stream_name != NULL)
1062 snd_soc_dapm_stream_event(&card->rtd[i], driver->capture.stream_name,
1063 SND_SOC_DAPM_STREAM_SUSPEND);
1064 }
1065
1066 /* suspend all CODECs */
1067 for (i = 0; i < card->num_rtd; i++) {
1068 struct snd_soc_codec *codec = card->rtd[i].codec;
1069 /* If there are paths active then the CODEC will be held with
1070 * bias _ON and should not be suspended. */
1071 if (!codec->suspended && codec->driver->suspend) {
Liam Girdwoodce6120c2010-11-05 15:53:46 +02001072 switch (codec->dapm.bias_level) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001073 case SND_SOC_BIAS_STANDBY:
1074 case SND_SOC_BIAS_OFF:
1075 codec->driver->suspend(codec, PMSG_SUSPEND);
1076 codec->suspended = 1;
1077 break;
1078 default:
1079 dev_dbg(codec->dev, "CODEC is on over suspend\n");
1080 break;
1081 }
1082 }
1083 }
1084
1085 for (i = 0; i < card->num_rtd; i++) {
1086 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1087
1088 if (card->rtd[i].dai_link->ignore_suspend)
1089 continue;
1090
1091 if (cpu_dai->driver->suspend && cpu_dai->driver->ac97_control)
1092 cpu_dai->driver->suspend(cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001093 }
1094
Mark Brown87506542008-11-18 20:50:34 +00001095 if (card->suspend_post)
Mark Brown416356f2009-06-30 19:05:15 +01001096 card->suspend_post(pdev, PMSG_SUSPEND);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001097
1098 return 0;
1099}
1100
Andy Green6ed25972008-06-13 16:24:05 +01001101/* deferred resume work, so resume can complete before we finished
1102 * setting our codec back up, which can be very slow on I2C
1103 */
1104static void soc_resume_deferred(struct work_struct *work)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001105{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001106 struct snd_soc_card *card =
1107 container_of(work, struct snd_soc_card, deferred_resume_work);
1108 struct platform_device *pdev = to_platform_device(card->dev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001109 int i;
1110
Andy Green6ed25972008-06-13 16:24:05 +01001111 /* our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
1112 * so userspace apps are blocked from touching us
1113 */
1114
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001115 dev_dbg(card->dev, "starting resume work\n");
Andy Green6ed25972008-06-13 16:24:05 +01001116
Mark Brown99497882010-05-07 20:24:05 +01001117 /* Bring us up into D2 so that DAPM starts enabling things */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001118 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
Mark Brown99497882010-05-07 20:24:05 +01001119
Mark Brown87506542008-11-18 20:50:34 +00001120 if (card->resume_pre)
1121 card->resume_pre(pdev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001122
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001123 /* resume AC97 DAIs */
1124 for (i = 0; i < card->num_rtd; i++) {
1125 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
Mark Brown3efab7d2010-05-09 13:25:43 +01001126
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001127 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001128 continue;
1129
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001130 if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control)
1131 cpu_dai->driver->resume(cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001132 }
1133
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001134 for (i = 0; i < card->num_rtd; i++) {
1135 struct snd_soc_codec *codec = card->rtd[i].codec;
1136 /* If the CODEC was idle over suspend then it will have been
1137 * left with bias OFF or STANDBY and suspended so we must now
1138 * resume. Otherwise the suspend was suppressed.
1139 */
1140 if (codec->driver->resume && codec->suspended) {
Liam Girdwoodce6120c2010-11-05 15:53:46 +02001141 switch (codec->dapm.bias_level) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001142 case SND_SOC_BIAS_STANDBY:
1143 case SND_SOC_BIAS_OFF:
1144 codec->driver->resume(codec);
1145 codec->suspended = 0;
1146 break;
1147 default:
1148 dev_dbg(codec->dev, "CODEC was on over suspend\n");
1149 break;
1150 }
Mark Brown1547aba2010-05-07 21:11:40 +01001151 }
1152 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001153
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001154 for (i = 0; i < card->num_rtd; i++) {
1155 struct snd_soc_dai_driver *driver = card->rtd[i].codec_dai->driver;
Mark Brown3efab7d2010-05-09 13:25:43 +01001156
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001157 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001158 continue;
1159
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001160 if (driver->playback.stream_name != NULL)
1161 snd_soc_dapm_stream_event(&card->rtd[i], driver->playback.stream_name,
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001162 SND_SOC_DAPM_STREAM_RESUME);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001163
1164 if (driver->capture.stream_name != NULL)
1165 snd_soc_dapm_stream_event(&card->rtd[i], driver->capture.stream_name,
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001166 SND_SOC_DAPM_STREAM_RESUME);
1167 }
1168
Mark Brown3ff3f642008-05-19 12:32:25 +02001169 /* unmute any active DACs */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001170 for (i = 0; i < card->num_rtd; i++) {
1171 struct snd_soc_dai *dai = card->rtd[i].codec_dai;
1172 struct snd_soc_dai_driver *drv = dai->driver;
Mark Brown3efab7d2010-05-09 13:25:43 +01001173
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001174 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001175 continue;
1176
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001177 if (drv->ops->digital_mute && dai->playback_active)
1178 drv->ops->digital_mute(dai, 0);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001179 }
1180
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001181 for (i = 0; i < card->num_rtd; i++) {
1182 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1183 struct snd_soc_platform *platform = card->rtd[i].platform;
Mark Brown3efab7d2010-05-09 13:25:43 +01001184
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001185 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001186 continue;
1187
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001188 if (cpu_dai->driver->resume && !cpu_dai->driver->ac97_control)
1189 cpu_dai->driver->resume(cpu_dai);
1190 if (platform->driver->resume && platform->suspended) {
1191 platform->driver->resume(cpu_dai);
1192 platform->suspended = 0;
1193 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001194 }
1195
Mark Brown87506542008-11-18 20:50:34 +00001196 if (card->resume_post)
1197 card->resume_post(pdev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001198
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001199 dev_dbg(card->dev, "resume work completed\n");
Andy Green6ed25972008-06-13 16:24:05 +01001200
1201 /* userspace can access us now we are back as we were before */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001202 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
Andy Green6ed25972008-06-13 16:24:05 +01001203}
1204
1205/* powers up audio subsystem after a suspend */
Mark Brown416356f2009-06-30 19:05:15 +01001206static int soc_resume(struct device *dev)
Andy Green6ed25972008-06-13 16:24:05 +01001207{
Mark Brown416356f2009-06-30 19:05:15 +01001208 struct platform_device *pdev = to_platform_device(dev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001209 struct snd_soc_card *card = platform_get_drvdata(pdev);
1210 int i;
Peter Ujfalusib9dd94a2010-02-22 13:27:13 +02001211
Mark Brown64ab9ba2009-03-31 11:27:03 +01001212 /* AC97 devices might have other drivers hanging off them so
1213 * need to resume immediately. Other drivers don't have that
1214 * problem and may take a substantial amount of time to resume
1215 * due to I/O costs and anti-pop so handle them out of line.
1216 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001217 for (i = 0; i < card->num_rtd; i++) {
1218 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1219 if (cpu_dai->driver->ac97_control) {
1220 dev_dbg(dev, "Resuming AC97 immediately\n");
1221 soc_resume_deferred(&card->deferred_resume_work);
1222 } else {
1223 dev_dbg(dev, "Scheduling resume work\n");
1224 if (!schedule_work(&card->deferred_resume_work))
1225 dev_err(dev, "resume work item may be lost\n");
1226 }
Mark Brown64ab9ba2009-03-31 11:27:03 +01001227 }
Andy Green6ed25972008-06-13 16:24:05 +01001228
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001229 return 0;
1230}
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001231#else
1232#define soc_suspend NULL
1233#define soc_resume NULL
1234#endif
1235
Barry Song02a06d32009-10-16 18:13:38 +08001236static struct snd_soc_dai_ops null_dai_ops = {
1237};
1238
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001239static int soc_bind_dai_link(struct snd_soc_card *card, int num)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001240{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001241 struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1242 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
Mark Brownfe3e78e2009-11-03 22:13:13 +00001243 struct snd_soc_codec *codec;
Mark Brown435c5e22008-12-04 15:32:53 +00001244 struct snd_soc_platform *platform;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001245 struct snd_soc_dai *codec_dai, *cpu_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001246
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001247 if (rtd->complete)
1248 return 1;
1249 dev_dbg(card->dev, "binding %s at idx %d\n", dai_link->name, num);
Mark Brown63084192008-12-02 15:08:03 +00001250
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001251 /* do we already have the CPU DAI for this link ? */
1252 if (rtd->cpu_dai) {
1253 goto find_codec;
1254 }
1255 /* no, then find CPU DAI from registered DAIs*/
1256 list_for_each_entry(cpu_dai, &dai_list, list) {
1257 if (!strcmp(cpu_dai->name, dai_link->cpu_dai_name)) {
1258
1259 if (!try_module_get(cpu_dai->dev->driver->owner))
1260 return -ENODEV;
1261
1262 rtd->cpu_dai = cpu_dai;
1263 goto find_codec;
Mark Brown435c5e22008-12-04 15:32:53 +00001264 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001265 }
1266 dev_dbg(card->dev, "CPU DAI %s not registered\n",
1267 dai_link->cpu_dai_name);
1268
1269find_codec:
1270 /* do we already have the CODEC for this link ? */
1271 if (rtd->codec) {
1272 goto find_platform;
Mark Brownc5af3a22008-11-28 13:29:45 +00001273 }
1274
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001275 /* no, then find CODEC from registered CODECs*/
1276 list_for_each_entry(codec, &codec_list, list) {
1277 if (!strcmp(codec->name, dai_link->codec_name)) {
1278 rtd->codec = codec;
Mark Brown6b05eda2008-12-08 19:26:48 +00001279
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001280 if (!try_module_get(codec->dev->driver->owner))
1281 return -ENODEV;
Mark Brown435c5e22008-12-04 15:32:53 +00001282
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001283 /* CODEC found, so find CODEC DAI from registered DAIs from this CODEC*/
1284 list_for_each_entry(codec_dai, &dai_list, list) {
1285 if (codec->dev == codec_dai->dev &&
1286 !strcmp(codec_dai->name, dai_link->codec_dai_name)) {
1287 rtd->codec_dai = codec_dai;
1288 goto find_platform;
Mark Brown6b05eda2008-12-08 19:26:48 +00001289 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001290 }
1291 dev_dbg(card->dev, "CODEC DAI %s not registered\n",
1292 dai_link->codec_dai_name);
1293
1294 goto find_platform;
1295 }
1296 }
1297 dev_dbg(card->dev, "CODEC %s not registered\n",
1298 dai_link->codec_name);
1299
1300find_platform:
1301 /* do we already have the CODEC DAI for this link ? */
1302 if (rtd->platform) {
1303 goto out;
1304 }
1305 /* no, then find CPU DAI from registered DAIs*/
1306 list_for_each_entry(platform, &platform_list, list) {
1307 if (!strcmp(platform->name, dai_link->platform_name)) {
1308
1309 if (!try_module_get(platform->dev->driver->owner))
1310 return -ENODEV;
1311
1312 rtd->platform = platform;
1313 goto out;
1314 }
1315 }
1316
1317 dev_dbg(card->dev, "platform %s not registered\n",
1318 dai_link->platform_name);
1319 return 0;
1320
1321out:
1322 /* mark rtd as complete if we found all 4 of our client devices */
1323 if (rtd->codec && rtd->codec_dai && rtd->platform && rtd->cpu_dai) {
1324 rtd->complete = 1;
1325 card->num_rtd++;
1326 }
1327 return 1;
1328}
1329
1330static void soc_remove_dai_link(struct snd_soc_card *card, int num)
1331{
1332 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1333 struct snd_soc_codec *codec = rtd->codec;
1334 struct snd_soc_platform *platform = rtd->platform;
1335 struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
1336 int err;
1337
1338 /* unregister the rtd device */
1339 if (rtd->dev_registered) {
1340 device_remove_file(&rtd->dev, &dev_attr_pmdown_time);
1341 device_unregister(&rtd->dev);
1342 rtd->dev_registered = 0;
1343 }
1344
1345 /* remove the CODEC DAI */
1346 if (codec_dai && codec_dai->probed) {
1347 if (codec_dai->driver->remove) {
1348 err = codec_dai->driver->remove(codec_dai);
1349 if (err < 0)
1350 printk(KERN_ERR "asoc: failed to remove %s\n", codec_dai->name);
1351 }
1352 codec_dai->probed = 0;
1353 list_del(&codec_dai->card_list);
1354 }
1355
1356 /* remove the platform */
1357 if (platform && platform->probed) {
1358 if (platform->driver->remove) {
1359 err = platform->driver->remove(platform);
1360 if (err < 0)
1361 printk(KERN_ERR "asoc: failed to remove %s\n", platform->name);
1362 }
1363 platform->probed = 0;
1364 list_del(&platform->card_list);
1365 module_put(platform->dev->driver->owner);
1366 }
1367
1368 /* remove the CODEC */
1369 if (codec && codec->probed) {
1370 if (codec->driver->remove) {
1371 err = codec->driver->remove(codec);
1372 if (err < 0)
1373 printk(KERN_ERR "asoc: failed to remove %s\n", codec->name);
1374 }
1375
1376 /* Make sure all DAPM widgets are freed */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02001377 snd_soc_dapm_free(&codec->dapm);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001378
1379 soc_cleanup_codec_debugfs(codec);
1380 device_remove_file(&rtd->dev, &dev_attr_codec_reg);
1381 codec->probed = 0;
1382 list_del(&codec->card_list);
1383 module_put(codec->dev->driver->owner);
1384 }
1385
1386 /* remove the cpu_dai */
1387 if (cpu_dai && cpu_dai->probed) {
1388 if (cpu_dai->driver->remove) {
1389 err = cpu_dai->driver->remove(cpu_dai);
1390 if (err < 0)
1391 printk(KERN_ERR "asoc: failed to remove %s\n", cpu_dai->name);
1392 }
1393 cpu_dai->probed = 0;
1394 list_del(&cpu_dai->card_list);
1395 module_put(cpu_dai->dev->driver->owner);
1396 }
1397}
1398
Jarkko Nikulaead9b912010-11-13 20:40:44 +02001399static void soc_set_name_prefix(struct snd_soc_card *card,
1400 struct snd_soc_codec *codec)
1401{
1402 int i;
1403
1404 if (card->prefix_map == NULL)
1405 return;
1406
1407 for (i = 0; i < card->num_prefixes; i++) {
1408 struct snd_soc_prefix_map *map = &card->prefix_map[i];
1409 if (map->dev_name && !strcmp(codec->name, map->dev_name)) {
1410 codec->name_prefix = map->name_prefix;
1411 break;
1412 }
1413 }
1414}
1415
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001416static void rtd_release(struct device *dev) {}
1417
1418static int soc_probe_dai_link(struct snd_soc_card *card, int num)
1419{
1420 struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1421 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1422 struct snd_soc_codec *codec = rtd->codec;
1423 struct snd_soc_platform *platform = rtd->platform;
1424 struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
Jarkko Nikulaead9b912010-11-13 20:40:44 +02001425 const char *temp;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001426 int ret;
1427
1428 dev_dbg(card->dev, "probe %s dai link %d\n", card->name, num);
1429
1430 /* config components */
1431 codec_dai->codec = codec;
1432 codec->card = card;
1433 cpu_dai->platform = platform;
1434 rtd->card = card;
1435 rtd->dev.parent = card->dev;
1436 codec_dai->card = card;
1437 cpu_dai->card = card;
1438
1439 /* set default power off timeout */
1440 rtd->pmdown_time = pmdown_time;
1441
1442 /* probe the cpu_dai */
1443 if (!cpu_dai->probed) {
1444 if (cpu_dai->driver->probe) {
1445 ret = cpu_dai->driver->probe(cpu_dai);
1446 if (ret < 0) {
1447 printk(KERN_ERR "asoc: failed to probe CPU DAI %s\n",
1448 cpu_dai->name);
1449 return ret;
1450 }
1451 }
1452 cpu_dai->probed = 1;
1453 /* mark cpu_dai as probed and add to card cpu_dai list */
1454 list_add(&cpu_dai->card_list, &card->dai_dev_list);
1455 }
1456
1457 /* probe the CODEC */
1458 if (!codec->probed) {
Jarkko Nikula3a45b862010-11-05 20:35:21 +02001459 codec->dapm.card = card;
Jarkko Nikulaead9b912010-11-13 20:40:44 +02001460 soc_set_name_prefix(card, codec);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001461 if (codec->driver->probe) {
1462 ret = codec->driver->probe(codec);
1463 if (ret < 0) {
1464 printk(KERN_ERR "asoc: failed to probe CODEC %s\n",
1465 codec->name);
1466 return ret;
1467 }
1468 }
Mark Brown13cb61f2010-08-12 15:44:04 +01001469
1470 soc_init_codec_debugfs(codec);
1471
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001472 /* mark codec as probed and add to card codec list */
1473 codec->probed = 1;
1474 list_add(&codec->card_list, &card->codec_dev_list);
1475 }
1476
1477 /* probe the platform */
1478 if (!platform->probed) {
1479 if (platform->driver->probe) {
1480 ret = platform->driver->probe(platform);
1481 if (ret < 0) {
1482 printk(KERN_ERR "asoc: failed to probe platform %s\n",
1483 platform->name);
1484 return ret;
1485 }
1486 }
1487 /* mark platform as probed and add to card platform list */
1488 platform->probed = 1;
1489 list_add(&platform->card_list, &card->platform_dev_list);
1490 }
1491
1492 /* probe the CODEC DAI */
1493 if (!codec_dai->probed) {
1494 if (codec_dai->driver->probe) {
1495 ret = codec_dai->driver->probe(codec_dai);
1496 if (ret < 0) {
1497 printk(KERN_ERR "asoc: failed to probe CODEC DAI %s\n",
1498 codec_dai->name);
1499 return ret;
Mark Brown6b05eda2008-12-08 19:26:48 +00001500 }
1501 }
1502
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001503 /* mark cpu_dai as probed and add to card cpu_dai list */
1504 codec_dai->probed = 1;
1505 list_add(&codec_dai->card_list, &card->dai_dev_list);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001506 }
1507
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001508 /* DAPM dai link stream work */
1509 INIT_DELAYED_WORK(&rtd->delayed_work, close_delayed_work);
1510
1511 /* now that all clients have probed, initialise the DAI link */
1512 if (dai_link->init) {
Jarkko Nikulaead9b912010-11-13 20:40:44 +02001513 /* machine controls, routes and widgets are not prefixed */
1514 temp = rtd->codec->name_prefix;
1515 rtd->codec->name_prefix = NULL;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001516 ret = dai_link->init(rtd);
1517 if (ret < 0) {
1518 printk(KERN_ERR "asoc: failed to init %s\n", dai_link->stream_name);
1519 return ret;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001520 }
Jarkko Nikulaead9b912010-11-13 20:40:44 +02001521 rtd->codec->name_prefix = temp;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001522 }
1523
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001524 /* Make sure all DAPM widgets are instantiated */
Liam Girdwoodce6120c2010-11-05 15:53:46 +02001525 snd_soc_dapm_new_widgets(&codec->dapm);
1526 snd_soc_dapm_sync(&codec->dapm);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001527
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001528 /* register the rtd device */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001529 rtd->dev.release = rtd_release;
1530 rtd->dev.init_name = dai_link->name;
1531 ret = device_register(&rtd->dev);
1532 if (ret < 0) {
1533 printk(KERN_ERR "asoc: failed to register DAI runtime device %d\n", ret);
1534 return ret;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001535 }
1536
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001537 rtd->dev_registered = 1;
1538 ret = device_create_file(&rtd->dev, &dev_attr_pmdown_time);
1539 if (ret < 0)
1540 printk(KERN_WARNING "asoc: failed to add pmdown_time sysfs\n");
1541
1542 /* add DAPM sysfs entries for this codec */
1543 ret = snd_soc_dapm_sys_add(&rtd->dev);
1544 if (ret < 0)
1545 printk(KERN_WARNING "asoc: failed to add codec dapm sysfs entries\n");
1546
1547 /* add codec sysfs entries */
1548 ret = device_create_file(&rtd->dev, &dev_attr_codec_reg);
1549 if (ret < 0)
1550 printk(KERN_WARNING "asoc: failed to add codec sysfs files\n");
1551
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001552 /* create the pcm */
1553 ret = soc_new_pcm(rtd, num);
1554 if (ret < 0) {
1555 printk(KERN_ERR "asoc: can't create pcm %s\n", dai_link->stream_name);
1556 return ret;
1557 }
1558
1559 /* add platform data for AC97 devices */
1560 if (rtd->codec_dai->driver->ac97_control)
1561 snd_ac97_dev_add_pdata(codec->ac97, rtd->cpu_dai->ac97_pdata);
1562
1563 return 0;
1564}
1565
1566#ifdef CONFIG_SND_SOC_AC97_BUS
1567static int soc_register_ac97_dai_link(struct snd_soc_pcm_runtime *rtd)
1568{
1569 int ret;
1570
1571 /* Only instantiate AC97 if not already done by the adaptor
1572 * for the generic AC97 subsystem.
1573 */
1574 if (rtd->codec_dai->driver->ac97_control && !rtd->codec->ac97_registered) {
Mika Westerberg0562f782010-10-13 11:30:32 +03001575 /*
1576 * It is possible that the AC97 device is already registered to
1577 * the device subsystem. This happens when the device is created
1578 * via snd_ac97_mixer(). Currently only SoC codec that does so
1579 * is the generic AC97 glue but others migh emerge.
1580 *
1581 * In those cases we don't try to register the device again.
1582 */
1583 if (!rtd->codec->ac97_created)
1584 return 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001585
1586 ret = soc_ac97_dev_register(rtd->codec);
1587 if (ret < 0) {
1588 printk(KERN_ERR "asoc: AC97 device register failed\n");
1589 return ret;
1590 }
1591
1592 rtd->codec->ac97_registered = 1;
1593 }
1594 return 0;
1595}
1596
1597static void soc_unregister_ac97_dai_link(struct snd_soc_codec *codec)
1598{
1599 if (codec->ac97_registered) {
1600 soc_ac97_dev_unregister(codec);
1601 codec->ac97_registered = 0;
1602 }
1603}
1604#endif
1605
1606static void snd_soc_instantiate_card(struct snd_soc_card *card)
1607{
1608 struct platform_device *pdev = to_platform_device(card->dev);
1609 int ret, i;
1610
1611 mutex_lock(&card->mutex);
1612
1613 if (card->instantiated) {
1614 mutex_unlock(&card->mutex);
1615 return;
1616 }
1617
1618 /* bind DAIs */
1619 for (i = 0; i < card->num_links; i++)
1620 soc_bind_dai_link(card, i);
1621
1622 /* bind completed ? */
1623 if (card->num_rtd != card->num_links) {
1624 mutex_unlock(&card->mutex);
1625 return;
1626 }
1627
1628 /* card bind complete so register a sound card */
1629 ret = snd_card_create(SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
1630 card->owner, 0, &card->snd_card);
1631 if (ret < 0) {
1632 printk(KERN_ERR "asoc: can't create sound card for card %s\n",
1633 card->name);
1634 mutex_unlock(&card->mutex);
1635 return;
1636 }
1637 card->snd_card->dev = card->dev;
1638
Randy Dunlap1301a962008-06-17 19:19:34 +01001639#ifdef CONFIG_PM
Andy Green6ed25972008-06-13 16:24:05 +01001640 /* deferred resume work */
Mark Brown63084192008-12-02 15:08:03 +00001641 INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
Randy Dunlap1301a962008-06-17 19:19:34 +01001642#endif
Andy Green6ed25972008-06-13 16:24:05 +01001643
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001644 /* initialise the sound card only once */
1645 if (card->probe) {
1646 ret = card->probe(pdev);
1647 if (ret < 0)
1648 goto card_probe_error;
1649 }
1650
Mark Brownfe3e78e2009-11-03 22:13:13 +00001651 for (i = 0; i < card->num_links; i++) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001652 ret = soc_probe_dai_link(card, i);
1653 if (ret < 0) {
Mark Brown321de0d2010-09-21 15:09:37 +01001654 pr_err("asoc: failed to instantiate card %s: %d\n",
1655 card->name, ret);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001656 goto probe_dai_err;
1657 }
1658 }
1659
1660 snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname),
1661 "%s", card->name);
1662 snprintf(card->snd_card->longname, sizeof(card->snd_card->longname),
1663 "%s", card->name);
1664
1665 ret = snd_card_register(card->snd_card);
1666 if (ret < 0) {
1667 printk(KERN_ERR "asoc: failed to register soundcard for %s\n", card->name);
1668 goto probe_dai_err;
1669 }
1670
1671#ifdef CONFIG_SND_SOC_AC97_BUS
1672 /* register any AC97 codecs */
1673 for (i = 0; i < card->num_rtd; i++) {
1674 ret = soc_register_ac97_dai_link(&card->rtd[i]);
Mark Brownfe3e78e2009-11-03 22:13:13 +00001675 if (ret < 0) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001676 printk(KERN_ERR "asoc: failed to register AC97 %s\n", card->name);
1677 goto probe_dai_err;
Mark Brownfe3e78e2009-11-03 22:13:13 +00001678 }
1679 }
Mark Brownfe3e78e2009-11-03 22:13:13 +00001680#endif
1681
Mark Brown435c5e22008-12-04 15:32:53 +00001682 card->instantiated = 1;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001683 mutex_unlock(&card->mutex);
Mark Brown435c5e22008-12-04 15:32:53 +00001684 return;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001685
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001686probe_dai_err:
1687 for (i = 0; i < card->num_links; i++)
1688 soc_remove_dai_link(card, i);
Mark Brownfe3e78e2009-11-03 22:13:13 +00001689
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001690card_probe_error:
Mark Brown87506542008-11-18 20:50:34 +00001691 if (card->remove)
1692 card->remove(pdev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001693
1694 snd_card_free(card->snd_card);
1695
1696 mutex_unlock(&card->mutex);
Mark Brown435c5e22008-12-04 15:32:53 +00001697}
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001698
Mark Brown435c5e22008-12-04 15:32:53 +00001699/*
Uwe Kleine-König421f91d2010-06-11 12:17:00 +02001700 * Attempt to initialise any uninitialised cards. Must be called with
Mark Brown435c5e22008-12-04 15:32:53 +00001701 * client_mutex.
1702 */
1703static void snd_soc_instantiate_cards(void)
1704{
1705 struct snd_soc_card *card;
1706 list_for_each_entry(card, &card_list, list)
1707 snd_soc_instantiate_card(card);
1708}
1709
1710/* probes a new socdev */
1711static int soc_probe(struct platform_device *pdev)
1712{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001713 struct snd_soc_card *card = platform_get_drvdata(pdev);
Mark Brown435c5e22008-12-04 15:32:53 +00001714 int ret = 0;
Mark Brown435c5e22008-12-04 15:32:53 +00001715
1716 /* Bodge while we unpick instantiation */
1717 card->dev = &pdev->dev;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001718 INIT_LIST_HEAD(&card->dai_dev_list);
1719 INIT_LIST_HEAD(&card->codec_dev_list);
1720 INIT_LIST_HEAD(&card->platform_dev_list);
1721
Jarkko Nikulaa6052152010-11-05 20:35:19 +02001722 soc_init_card_debugfs(card);
1723
Mark Brown435c5e22008-12-04 15:32:53 +00001724 ret = snd_soc_register_card(card);
1725 if (ret != 0) {
1726 dev_err(&pdev->dev, "Failed to register card\n");
1727 return ret;
1728 }
1729
1730 return 0;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001731}
1732
1733/* removes a socdev */
1734static int soc_remove(struct platform_device *pdev)
1735{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001736 struct snd_soc_card *card = platform_get_drvdata(pdev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001737 int i;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001738
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001739 if (card->instantiated) {
Mike Rapoport914dc182009-05-11 13:04:55 +03001740
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001741 /* make sure any delayed work runs */
1742 for (i = 0; i < card->num_rtd; i++) {
1743 struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
1744 run_delayed_work(&rtd->delayed_work);
Guennadi Liakhovetskib2dfa622010-03-18 08:23:33 +01001745 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001746
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001747 /* remove and free each DAI */
1748 for (i = 0; i < card->num_rtd; i++)
1749 soc_remove_dai_link(card, i);
1750
Jarkko Nikulaa6052152010-11-05 20:35:19 +02001751 soc_cleanup_card_debugfs(card);
1752
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001753 /* remove the card */
Guennadi Liakhovetskib2dfa622010-03-18 08:23:33 +01001754 if (card->remove)
1755 card->remove(pdev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001756
1757 kfree(card->rtd);
1758 snd_card_free(card->snd_card);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001759 }
Mark Brownc5af3a22008-11-28 13:29:45 +00001760 snd_soc_unregister_card(card);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001761 return 0;
1762}
1763
Mark Brown416356f2009-06-30 19:05:15 +01001764static int soc_poweroff(struct device *dev)
Mark Brown51737472009-06-22 13:16:51 +01001765{
Mark Brown416356f2009-06-30 19:05:15 +01001766 struct platform_device *pdev = to_platform_device(dev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001767 struct snd_soc_card *card = platform_get_drvdata(pdev);
1768 int i;
Mark Brown51737472009-06-22 13:16:51 +01001769
1770 if (!card->instantiated)
Mark Brown416356f2009-06-30 19:05:15 +01001771 return 0;
Mark Brown51737472009-06-22 13:16:51 +01001772
1773 /* Flush out pmdown_time work - we actually do want to run it
1774 * now, we're shutting down so no imminent restart. */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001775 for (i = 0; i < card->num_rtd; i++) {
1776 struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
1777 run_delayed_work(&rtd->delayed_work);
1778 }
Mark Brown51737472009-06-22 13:16:51 +01001779
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001780 snd_soc_dapm_shutdown(card);
Mark Brown416356f2009-06-30 19:05:15 +01001781
1782 return 0;
Mark Brown51737472009-06-22 13:16:51 +01001783}
1784
Alexey Dobriyan47145212009-12-14 18:00:08 -08001785static const struct dev_pm_ops soc_pm_ops = {
Mark Brown416356f2009-06-30 19:05:15 +01001786 .suspend = soc_suspend,
1787 .resume = soc_resume,
1788 .poweroff = soc_poweroff,
1789};
1790
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001791/* ASoC platform driver */
1792static struct platform_driver soc_driver = {
1793 .driver = {
1794 .name = "soc-audio",
Kay Sievers8b45a202008-04-14 13:33:36 +02001795 .owner = THIS_MODULE,
Mark Brown416356f2009-06-30 19:05:15 +01001796 .pm = &soc_pm_ops,
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001797 },
1798 .probe = soc_probe,
1799 .remove = soc_remove,
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001800};
1801
1802/* create a new pcm */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001803static int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001804{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001805 struct snd_soc_codec *codec = rtd->codec;
1806 struct snd_soc_platform *platform = rtd->platform;
1807 struct snd_soc_dai *codec_dai = rtd->codec_dai;
1808 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001809 struct snd_pcm *pcm;
1810 char new_name[64];
1811 int ret = 0, playback = 0, capture = 0;
1812
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001813 /* check client and interface hw capabilities */
Mark Brown40ca1142009-12-24 13:44:28 +00001814 snprintf(new_name, sizeof(new_name), "%s %s-%d",
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001815 rtd->dai_link->stream_name, codec_dai->name, num);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001816
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001817 if (codec_dai->driver->playback.channels_min)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001818 playback = 1;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001819 if (codec_dai->driver->capture.channels_min)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001820 capture = 1;
1821
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001822 dev_dbg(rtd->card->dev, "registered pcm #%d %s\n",num,new_name);
1823 ret = snd_pcm_new(rtd->card->snd_card, new_name,
1824 num, playback, capture, &pcm);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001825 if (ret < 0) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001826 printk(KERN_ERR "asoc: can't create pcm for codec %s\n", codec->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001827 return ret;
1828 }
1829
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001830 rtd->pcm = pcm;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001831 pcm->private_data = rtd;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001832 soc_pcm_ops.mmap = platform->driver->ops->mmap;
1833 soc_pcm_ops.pointer = platform->driver->ops->pointer;
1834 soc_pcm_ops.ioctl = platform->driver->ops->ioctl;
1835 soc_pcm_ops.copy = platform->driver->ops->copy;
1836 soc_pcm_ops.silence = platform->driver->ops->silence;
1837 soc_pcm_ops.ack = platform->driver->ops->ack;
1838 soc_pcm_ops.page = platform->driver->ops->page;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001839
1840 if (playback)
1841 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &soc_pcm_ops);
1842
1843 if (capture)
1844 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &soc_pcm_ops);
1845
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001846 ret = platform->driver->pcm_new(rtd->card->snd_card, codec_dai, pcm);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001847 if (ret < 0) {
1848 printk(KERN_ERR "asoc: platform pcm constructor failed\n");
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001849 return ret;
1850 }
1851
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001852 pcm->private_free = platform->driver->pcm_free;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001853 printk(KERN_INFO "asoc: %s <-> %s mapping ok\n", codec_dai->name,
1854 cpu_dai->name);
1855 return ret;
1856}
1857
Mark Brown096e49d2009-07-05 15:12:22 +01001858/**
1859 * snd_soc_codec_volatile_register: Report if a register is volatile.
1860 *
1861 * @codec: CODEC to query.
1862 * @reg: Register to query.
1863 *
1864 * Boolean function indiciating if a CODEC register is volatile.
1865 */
1866int snd_soc_codec_volatile_register(struct snd_soc_codec *codec, int reg)
1867{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001868 if (codec->driver->volatile_register)
1869 return codec->driver->volatile_register(reg);
Mark Brown096e49d2009-07-05 15:12:22 +01001870 else
1871 return 0;
1872}
1873EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register);
1874
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001875/**
1876 * snd_soc_new_ac97_codec - initailise AC97 device
1877 * @codec: audio codec
1878 * @ops: AC97 bus operations
1879 * @num: AC97 codec number
1880 *
1881 * Initialises AC97 codec resources for use by ad-hoc devices only.
1882 */
1883int snd_soc_new_ac97_codec(struct snd_soc_codec *codec,
1884 struct snd_ac97_bus_ops *ops, int num)
1885{
1886 mutex_lock(&codec->mutex);
1887
1888 codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL);
1889 if (codec->ac97 == NULL) {
1890 mutex_unlock(&codec->mutex);
1891 return -ENOMEM;
1892 }
1893
1894 codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL);
1895 if (codec->ac97->bus == NULL) {
1896 kfree(codec->ac97);
1897 codec->ac97 = NULL;
1898 mutex_unlock(&codec->mutex);
1899 return -ENOMEM;
1900 }
1901
1902 codec->ac97->bus->ops = ops;
1903 codec->ac97->num = num;
Mika Westerberg0562f782010-10-13 11:30:32 +03001904
1905 /*
1906 * Mark the AC97 device to be created by us. This way we ensure that the
1907 * device will be registered with the device subsystem later on.
1908 */
1909 codec->ac97_created = 1;
1910
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001911 mutex_unlock(&codec->mutex);
1912 return 0;
1913}
1914EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec);
1915
1916/**
1917 * snd_soc_free_ac97_codec - free AC97 codec device
1918 * @codec: audio codec
1919 *
1920 * Frees AC97 codec device resources.
1921 */
1922void snd_soc_free_ac97_codec(struct snd_soc_codec *codec)
1923{
1924 mutex_lock(&codec->mutex);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001925#ifdef CONFIG_SND_SOC_AC97_BUS
1926 soc_unregister_ac97_dai_link(codec);
1927#endif
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001928 kfree(codec->ac97->bus);
1929 kfree(codec->ac97);
1930 codec->ac97 = NULL;
Mika Westerberg0562f782010-10-13 11:30:32 +03001931 codec->ac97_created = 0;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001932 mutex_unlock(&codec->mutex);
1933}
1934EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec);
1935
Mark Brownc3753702010-11-01 15:41:57 -04001936unsigned int snd_soc_read(struct snd_soc_codec *codec, unsigned int reg)
1937{
1938 unsigned int ret;
1939
1940 ret = codec->driver->read(codec, reg);
1941 dev_dbg(codec->dev, "read %x => %x\n", reg, ret);
Mark Browna8b1d342010-11-03 18:05:58 -04001942 trace_snd_soc_reg_read(codec, reg, ret);
Mark Brownc3753702010-11-01 15:41:57 -04001943
1944 return ret;
1945}
1946EXPORT_SYMBOL_GPL(snd_soc_read);
1947
1948unsigned int snd_soc_write(struct snd_soc_codec *codec,
1949 unsigned int reg, unsigned int val)
1950{
1951 dev_dbg(codec->dev, "write %x = %x\n", reg, val);
Mark Browna8b1d342010-11-03 18:05:58 -04001952 trace_snd_soc_reg_write(codec, reg, val);
Mark Brownc3753702010-11-01 15:41:57 -04001953 return codec->driver->write(codec, reg, val);
1954}
1955EXPORT_SYMBOL_GPL(snd_soc_write);
1956
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001957/**
1958 * snd_soc_update_bits - update codec register bits
1959 * @codec: audio codec
1960 * @reg: codec register
1961 * @mask: register mask
1962 * @value: new value
1963 *
1964 * Writes new register value.
1965 *
1966 * Returns 1 for change else 0.
1967 */
1968int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg,
Daniel Ribeiro46f58222009-06-07 02:49:11 -03001969 unsigned int mask, unsigned int value)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001970{
1971 int change;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03001972 unsigned int old, new;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001973
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001974 old = snd_soc_read(codec, reg);
1975 new = (old & ~mask) | value;
1976 change = old != new;
1977 if (change)
1978 snd_soc_write(codec, reg, new);
1979
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001980 return change;
1981}
1982EXPORT_SYMBOL_GPL(snd_soc_update_bits);
1983
1984/**
Eero Nurkkala6c508c62009-10-30 13:34:03 +02001985 * snd_soc_update_bits_locked - update codec register bits
1986 * @codec: audio codec
1987 * @reg: codec register
1988 * @mask: register mask
1989 * @value: new value
1990 *
1991 * Writes new register value, and takes the codec mutex.
1992 *
1993 * Returns 1 for change else 0.
1994 */
Mark Browndd1b3d52009-12-04 14:22:03 +00001995int snd_soc_update_bits_locked(struct snd_soc_codec *codec,
1996 unsigned short reg, unsigned int mask,
1997 unsigned int value)
Eero Nurkkala6c508c62009-10-30 13:34:03 +02001998{
1999 int change;
2000
2001 mutex_lock(&codec->mutex);
2002 change = snd_soc_update_bits(codec, reg, mask, value);
2003 mutex_unlock(&codec->mutex);
2004
2005 return change;
2006}
Mark Browndd1b3d52009-12-04 14:22:03 +00002007EXPORT_SYMBOL_GPL(snd_soc_update_bits_locked);
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002008
2009/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002010 * snd_soc_test_bits - test register for change
2011 * @codec: audio codec
2012 * @reg: codec register
2013 * @mask: register mask
2014 * @value: new value
2015 *
2016 * Tests a register with a new value and checks if the new value is
2017 * different from the old value.
2018 *
2019 * Returns 1 for change else 0.
2020 */
2021int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg,
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002022 unsigned int mask, unsigned int value)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002023{
2024 int change;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002025 unsigned int old, new;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002026
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002027 old = snd_soc_read(codec, reg);
2028 new = (old & ~mask) | value;
2029 change = old != new;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002030
2031 return change;
2032}
2033EXPORT_SYMBOL_GPL(snd_soc_test_bits);
2034
2035/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002036 * snd_soc_set_runtime_hwparams - set the runtime hardware parameters
2037 * @substream: the pcm substream
2038 * @hw: the hardware parameters
2039 *
2040 * Sets the substream runtime hardware parameters.
2041 */
2042int snd_soc_set_runtime_hwparams(struct snd_pcm_substream *substream,
2043 const struct snd_pcm_hardware *hw)
2044{
2045 struct snd_pcm_runtime *runtime = substream->runtime;
2046 runtime->hw.info = hw->info;
2047 runtime->hw.formats = hw->formats;
2048 runtime->hw.period_bytes_min = hw->period_bytes_min;
2049 runtime->hw.period_bytes_max = hw->period_bytes_max;
2050 runtime->hw.periods_min = hw->periods_min;
2051 runtime->hw.periods_max = hw->periods_max;
2052 runtime->hw.buffer_bytes_max = hw->buffer_bytes_max;
2053 runtime->hw.fifo_size = hw->fifo_size;
2054 return 0;
2055}
2056EXPORT_SYMBOL_GPL(snd_soc_set_runtime_hwparams);
2057
2058/**
2059 * snd_soc_cnew - create new control
2060 * @_template: control template
2061 * @data: control private data
Mark Brownac11a2b2009-01-01 12:18:17 +00002062 * @long_name: control long name
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002063 *
2064 * Create a new mixer control from a template control.
2065 *
2066 * Returns 0 for success, else error.
2067 */
2068struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
2069 void *data, char *long_name)
2070{
2071 struct snd_kcontrol_new template;
2072
2073 memcpy(&template, _template, sizeof(template));
2074 if (long_name)
2075 template.name = long_name;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002076 template.index = 0;
2077
2078 return snd_ctl_new1(&template, data);
2079}
2080EXPORT_SYMBOL_GPL(snd_soc_cnew);
2081
2082/**
Ian Molton3e8e1952009-01-09 00:23:21 +00002083 * snd_soc_add_controls - add an array of controls to a codec.
2084 * Convienience function to add a list of controls. Many codecs were
2085 * duplicating this code.
2086 *
2087 * @codec: codec to add controls to
2088 * @controls: array of controls to add
2089 * @num_controls: number of elements in the array
2090 *
2091 * Return 0 for success, else error.
2092 */
2093int snd_soc_add_controls(struct snd_soc_codec *codec,
2094 const struct snd_kcontrol_new *controls, int num_controls)
2095{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002096 struct snd_card *card = codec->card->snd_card;
Jarkko Nikulaead9b912010-11-13 20:40:44 +02002097 char prefixed_name[44], *name;
Ian Molton3e8e1952009-01-09 00:23:21 +00002098 int err, i;
2099
2100 for (i = 0; i < num_controls; i++) {
2101 const struct snd_kcontrol_new *control = &controls[i];
Jarkko Nikulaead9b912010-11-13 20:40:44 +02002102 if (codec->name_prefix) {
2103 snprintf(prefixed_name, sizeof(prefixed_name), "%s %s",
2104 codec->name_prefix, control->name);
2105 name = prefixed_name;
2106 } else {
2107 name = control->name;
2108 }
2109 err = snd_ctl_add(card, snd_soc_cnew(control, codec, name));
Ian Molton3e8e1952009-01-09 00:23:21 +00002110 if (err < 0) {
Mark Brown082100d2010-09-20 19:03:28 +01002111 dev_err(codec->dev, "%s: Failed to add %s: %d\n",
Jarkko Nikulaead9b912010-11-13 20:40:44 +02002112 codec->name, name, err);
Ian Molton3e8e1952009-01-09 00:23:21 +00002113 return err;
2114 }
2115 }
2116
2117 return 0;
2118}
2119EXPORT_SYMBOL_GPL(snd_soc_add_controls);
2120
2121/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002122 * snd_soc_info_enum_double - enumerated double mixer info callback
2123 * @kcontrol: mixer control
2124 * @uinfo: control element information
2125 *
2126 * Callback to provide information about a double enumerated
2127 * mixer control.
2128 *
2129 * Returns 0 for success.
2130 */
2131int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol,
2132 struct snd_ctl_elem_info *uinfo)
2133{
2134 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2135
2136 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2137 uinfo->count = e->shift_l == e->shift_r ? 1 : 2;
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002138 uinfo->value.enumerated.items = e->max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002139
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002140 if (uinfo->value.enumerated.item > e->max - 1)
2141 uinfo->value.enumerated.item = e->max - 1;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002142 strcpy(uinfo->value.enumerated.name,
2143 e->texts[uinfo->value.enumerated.item]);
2144 return 0;
2145}
2146EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
2147
2148/**
2149 * snd_soc_get_enum_double - enumerated double mixer get callback
2150 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002151 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002152 *
2153 * Callback to get the value of a double enumerated mixer.
2154 *
2155 * Returns 0 for success.
2156 */
2157int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol,
2158 struct snd_ctl_elem_value *ucontrol)
2159{
2160 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2161 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002162 unsigned int val, bitmask;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002163
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002164 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002165 ;
2166 val = snd_soc_read(codec, e->reg);
Mark Brown3ff3f642008-05-19 12:32:25 +02002167 ucontrol->value.enumerated.item[0]
2168 = (val >> e->shift_l) & (bitmask - 1);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002169 if (e->shift_l != e->shift_r)
2170 ucontrol->value.enumerated.item[1] =
2171 (val >> e->shift_r) & (bitmask - 1);
2172
2173 return 0;
2174}
2175EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
2176
2177/**
2178 * snd_soc_put_enum_double - enumerated double mixer put callback
2179 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002180 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002181 *
2182 * Callback to set the value of a double enumerated mixer.
2183 *
2184 * Returns 0 for success.
2185 */
2186int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol,
2187 struct snd_ctl_elem_value *ucontrol)
2188{
2189 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2190 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002191 unsigned int val;
2192 unsigned int mask, bitmask;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002193
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002194 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002195 ;
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002196 if (ucontrol->value.enumerated.item[0] > e->max - 1)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002197 return -EINVAL;
2198 val = ucontrol->value.enumerated.item[0] << e->shift_l;
2199 mask = (bitmask - 1) << e->shift_l;
2200 if (e->shift_l != e->shift_r) {
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002201 if (ucontrol->value.enumerated.item[1] > e->max - 1)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002202 return -EINVAL;
2203 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
2204 mask |= (bitmask - 1) << e->shift_r;
2205 }
2206
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002207 return snd_soc_update_bits_locked(codec, e->reg, mask, val);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002208}
2209EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
2210
2211/**
Peter Ujfalusi2e72f8e2009-01-05 09:54:57 +02002212 * snd_soc_get_value_enum_double - semi enumerated double mixer get callback
2213 * @kcontrol: mixer control
2214 * @ucontrol: control element information
2215 *
2216 * Callback to get the value of a double semi enumerated mixer.
2217 *
2218 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2219 * used for handling bitfield coded enumeration for example.
2220 *
2221 * Returns 0 for success.
2222 */
2223int snd_soc_get_value_enum_double(struct snd_kcontrol *kcontrol,
2224 struct snd_ctl_elem_value *ucontrol)
2225{
2226 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Peter Ujfalusi74155552009-01-08 13:34:29 +02002227 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002228 unsigned int reg_val, val, mux;
Peter Ujfalusi2e72f8e2009-01-05 09:54:57 +02002229
2230 reg_val = snd_soc_read(codec, e->reg);
2231 val = (reg_val >> e->shift_l) & e->mask;
2232 for (mux = 0; mux < e->max; mux++) {
2233 if (val == e->values[mux])
2234 break;
2235 }
2236 ucontrol->value.enumerated.item[0] = mux;
2237 if (e->shift_l != e->shift_r) {
2238 val = (reg_val >> e->shift_r) & e->mask;
2239 for (mux = 0; mux < e->max; mux++) {
2240 if (val == e->values[mux])
2241 break;
2242 }
2243 ucontrol->value.enumerated.item[1] = mux;
2244 }
2245
2246 return 0;
2247}
2248EXPORT_SYMBOL_GPL(snd_soc_get_value_enum_double);
2249
2250/**
2251 * snd_soc_put_value_enum_double - semi enumerated double mixer put callback
2252 * @kcontrol: mixer control
2253 * @ucontrol: control element information
2254 *
2255 * Callback to set the value of a double semi enumerated mixer.
2256 *
2257 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2258 * used for handling bitfield coded enumeration for example.
2259 *
2260 * Returns 0 for success.
2261 */
2262int snd_soc_put_value_enum_double(struct snd_kcontrol *kcontrol,
2263 struct snd_ctl_elem_value *ucontrol)
2264{
2265 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Peter Ujfalusi74155552009-01-08 13:34:29 +02002266 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002267 unsigned int val;
2268 unsigned int mask;
Peter Ujfalusi2e72f8e2009-01-05 09:54:57 +02002269
2270 if (ucontrol->value.enumerated.item[0] > e->max - 1)
2271 return -EINVAL;
2272 val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
2273 mask = e->mask << e->shift_l;
2274 if (e->shift_l != e->shift_r) {
2275 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2276 return -EINVAL;
2277 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
2278 mask |= e->mask << e->shift_r;
2279 }
2280
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002281 return snd_soc_update_bits_locked(codec, e->reg, mask, val);
Peter Ujfalusi2e72f8e2009-01-05 09:54:57 +02002282}
2283EXPORT_SYMBOL_GPL(snd_soc_put_value_enum_double);
2284
2285/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002286 * snd_soc_info_enum_ext - external enumerated single mixer info callback
2287 * @kcontrol: mixer control
2288 * @uinfo: control element information
2289 *
2290 * Callback to provide information about an external enumerated
2291 * single mixer.
2292 *
2293 * Returns 0 for success.
2294 */
2295int snd_soc_info_enum_ext(struct snd_kcontrol *kcontrol,
2296 struct snd_ctl_elem_info *uinfo)
2297{
2298 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2299
2300 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2301 uinfo->count = 1;
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002302 uinfo->value.enumerated.items = e->max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002303
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002304 if (uinfo->value.enumerated.item > e->max - 1)
2305 uinfo->value.enumerated.item = e->max - 1;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002306 strcpy(uinfo->value.enumerated.name,
2307 e->texts[uinfo->value.enumerated.item]);
2308 return 0;
2309}
2310EXPORT_SYMBOL_GPL(snd_soc_info_enum_ext);
2311
2312/**
2313 * snd_soc_info_volsw_ext - external single mixer info callback
2314 * @kcontrol: mixer control
2315 * @uinfo: control element information
2316 *
2317 * Callback to provide information about a single external mixer control.
2318 *
2319 * Returns 0 for success.
2320 */
2321int snd_soc_info_volsw_ext(struct snd_kcontrol *kcontrol,
2322 struct snd_ctl_elem_info *uinfo)
2323{
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002324 int max = kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002325
Mark Brownfd5dfad2009-04-15 21:37:46 +01002326 if (max == 1 && !strstr(kcontrol->id.name, " Volume"))
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002327 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2328 else
2329 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2330
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002331 uinfo->count = 1;
2332 uinfo->value.integer.min = 0;
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002333 uinfo->value.integer.max = max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002334 return 0;
2335}
2336EXPORT_SYMBOL_GPL(snd_soc_info_volsw_ext);
2337
2338/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002339 * snd_soc_info_volsw - single mixer info callback
2340 * @kcontrol: mixer control
2341 * @uinfo: control element information
2342 *
2343 * Callback to provide information about a single mixer control.
2344 *
2345 * Returns 0 for success.
2346 */
2347int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
2348 struct snd_ctl_elem_info *uinfo)
2349{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002350 struct soc_mixer_control *mc =
2351 (struct soc_mixer_control *)kcontrol->private_value;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002352 int platform_max;
Mark Brown762b8df2008-10-30 12:37:08 +00002353 unsigned int shift = mc->shift;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002354 unsigned int rshift = mc->rshift;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002355
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002356 if (!mc->platform_max)
2357 mc->platform_max = mc->max;
2358 platform_max = mc->platform_max;
2359
2360 if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002361 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2362 else
2363 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2364
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002365 uinfo->count = shift == rshift ? 1 : 2;
2366 uinfo->value.integer.min = 0;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002367 uinfo->value.integer.max = platform_max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002368 return 0;
2369}
2370EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
2371
2372/**
2373 * snd_soc_get_volsw - single mixer get callback
2374 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002375 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002376 *
2377 * Callback to get the value of a single mixer control.
2378 *
2379 * Returns 0 for success.
2380 */
2381int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
2382 struct snd_ctl_elem_value *ucontrol)
2383{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002384 struct soc_mixer_control *mc =
2385 (struct soc_mixer_control *)kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002386 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002387 unsigned int reg = mc->reg;
2388 unsigned int shift = mc->shift;
2389 unsigned int rshift = mc->rshift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002390 int max = mc->max;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002391 unsigned int mask = (1 << fls(max)) - 1;
2392 unsigned int invert = mc->invert;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002393
2394 ucontrol->value.integer.value[0] =
2395 (snd_soc_read(codec, reg) >> shift) & mask;
2396 if (shift != rshift)
2397 ucontrol->value.integer.value[1] =
2398 (snd_soc_read(codec, reg) >> rshift) & mask;
2399 if (invert) {
2400 ucontrol->value.integer.value[0] =
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002401 max - ucontrol->value.integer.value[0];
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002402 if (shift != rshift)
2403 ucontrol->value.integer.value[1] =
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002404 max - ucontrol->value.integer.value[1];
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002405 }
2406
2407 return 0;
2408}
2409EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
2410
2411/**
2412 * snd_soc_put_volsw - single mixer put callback
2413 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002414 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002415 *
2416 * Callback to set the value of a single mixer control.
2417 *
2418 * Returns 0 for success.
2419 */
2420int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
2421 struct snd_ctl_elem_value *ucontrol)
2422{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002423 struct soc_mixer_control *mc =
2424 (struct soc_mixer_control *)kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002425 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002426 unsigned int reg = mc->reg;
2427 unsigned int shift = mc->shift;
2428 unsigned int rshift = mc->rshift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002429 int max = mc->max;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002430 unsigned int mask = (1 << fls(max)) - 1;
2431 unsigned int invert = mc->invert;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002432 unsigned int val, val2, val_mask;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002433
2434 val = (ucontrol->value.integer.value[0] & mask);
2435 if (invert)
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002436 val = max - val;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002437 val_mask = mask << shift;
2438 val = val << shift;
2439 if (shift != rshift) {
2440 val2 = (ucontrol->value.integer.value[1] & mask);
2441 if (invert)
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002442 val2 = max - val2;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002443 val_mask |= mask << rshift;
2444 val |= val2 << rshift;
2445 }
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002446 return snd_soc_update_bits_locked(codec, reg, val_mask, val);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002447}
2448EXPORT_SYMBOL_GPL(snd_soc_put_volsw);
2449
2450/**
2451 * snd_soc_info_volsw_2r - double mixer info callback
2452 * @kcontrol: mixer control
2453 * @uinfo: control element information
2454 *
2455 * Callback to provide information about a double mixer control that
2456 * spans 2 codec registers.
2457 *
2458 * Returns 0 for success.
2459 */
2460int snd_soc_info_volsw_2r(struct snd_kcontrol *kcontrol,
2461 struct snd_ctl_elem_info *uinfo)
2462{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002463 struct soc_mixer_control *mc =
2464 (struct soc_mixer_control *)kcontrol->private_value;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002465 int platform_max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002466
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002467 if (!mc->platform_max)
2468 mc->platform_max = mc->max;
2469 platform_max = mc->platform_max;
2470
2471 if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002472 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2473 else
2474 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2475
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002476 uinfo->count = 2;
2477 uinfo->value.integer.min = 0;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002478 uinfo->value.integer.max = platform_max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002479 return 0;
2480}
2481EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r);
2482
2483/**
2484 * snd_soc_get_volsw_2r - double mixer get callback
2485 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002486 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002487 *
2488 * Callback to get the value of a double mixer control that spans 2 registers.
2489 *
2490 * Returns 0 for success.
2491 */
2492int snd_soc_get_volsw_2r(struct snd_kcontrol *kcontrol,
2493 struct snd_ctl_elem_value *ucontrol)
2494{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002495 struct soc_mixer_control *mc =
2496 (struct soc_mixer_control *)kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002497 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002498 unsigned int reg = mc->reg;
2499 unsigned int reg2 = mc->rreg;
2500 unsigned int shift = mc->shift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002501 int max = mc->max;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002502 unsigned int mask = (1 << fls(max)) - 1;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002503 unsigned int invert = mc->invert;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002504
2505 ucontrol->value.integer.value[0] =
2506 (snd_soc_read(codec, reg) >> shift) & mask;
2507 ucontrol->value.integer.value[1] =
2508 (snd_soc_read(codec, reg2) >> shift) & mask;
2509 if (invert) {
2510 ucontrol->value.integer.value[0] =
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002511 max - ucontrol->value.integer.value[0];
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002512 ucontrol->value.integer.value[1] =
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002513 max - ucontrol->value.integer.value[1];
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002514 }
2515
2516 return 0;
2517}
2518EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r);
2519
2520/**
2521 * snd_soc_put_volsw_2r - double mixer set callback
2522 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002523 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002524 *
2525 * Callback to set the value of a double mixer control that spans 2 registers.
2526 *
2527 * Returns 0 for success.
2528 */
2529int snd_soc_put_volsw_2r(struct snd_kcontrol *kcontrol,
2530 struct snd_ctl_elem_value *ucontrol)
2531{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002532 struct soc_mixer_control *mc =
2533 (struct soc_mixer_control *)kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002534 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002535 unsigned int reg = mc->reg;
2536 unsigned int reg2 = mc->rreg;
2537 unsigned int shift = mc->shift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002538 int max = mc->max;
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002539 unsigned int mask = (1 << fls(max)) - 1;
2540 unsigned int invert = mc->invert;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002541 int err;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002542 unsigned int val, val2, val_mask;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002543
2544 val_mask = mask << shift;
2545 val = (ucontrol->value.integer.value[0] & mask);
2546 val2 = (ucontrol->value.integer.value[1] & mask);
2547
2548 if (invert) {
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002549 val = max - val;
2550 val2 = max - val2;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002551 }
2552
2553 val = val << shift;
2554 val2 = val2 << shift;
2555
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002556 err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
Mark Brown3ff3f642008-05-19 12:32:25 +02002557 if (err < 0)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002558 return err;
2559
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002560 err = snd_soc_update_bits_locked(codec, reg2, val_mask, val2);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002561 return err;
2562}
2563EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r);
2564
Mark Browne13ac2e2008-05-28 17:58:05 +01002565/**
2566 * snd_soc_info_volsw_s8 - signed mixer info callback
2567 * @kcontrol: mixer control
2568 * @uinfo: control element information
2569 *
2570 * Callback to provide information about a signed mixer control.
2571 *
2572 * Returns 0 for success.
2573 */
2574int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol,
2575 struct snd_ctl_elem_info *uinfo)
2576{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002577 struct soc_mixer_control *mc =
2578 (struct soc_mixer_control *)kcontrol->private_value;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002579 int platform_max;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002580 int min = mc->min;
Mark Browne13ac2e2008-05-28 17:58:05 +01002581
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002582 if (!mc->platform_max)
2583 mc->platform_max = mc->max;
2584 platform_max = mc->platform_max;
2585
Mark Browne13ac2e2008-05-28 17:58:05 +01002586 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2587 uinfo->count = 2;
2588 uinfo->value.integer.min = 0;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002589 uinfo->value.integer.max = platform_max - min;
Mark Browne13ac2e2008-05-28 17:58:05 +01002590 return 0;
2591}
2592EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8);
2593
2594/**
2595 * snd_soc_get_volsw_s8 - signed mixer get callback
2596 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002597 * @ucontrol: control element information
Mark Browne13ac2e2008-05-28 17:58:05 +01002598 *
2599 * Callback to get the value of a signed mixer control.
2600 *
2601 * Returns 0 for success.
2602 */
2603int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol,
2604 struct snd_ctl_elem_value *ucontrol)
2605{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002606 struct soc_mixer_control *mc =
2607 (struct soc_mixer_control *)kcontrol->private_value;
Mark Browne13ac2e2008-05-28 17:58:05 +01002608 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002609 unsigned int reg = mc->reg;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002610 int min = mc->min;
Mark Browne13ac2e2008-05-28 17:58:05 +01002611 int val = snd_soc_read(codec, reg);
2612
2613 ucontrol->value.integer.value[0] =
2614 ((signed char)(val & 0xff))-min;
2615 ucontrol->value.integer.value[1] =
2616 ((signed char)((val >> 8) & 0xff))-min;
2617 return 0;
2618}
2619EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8);
2620
2621/**
2622 * snd_soc_put_volsw_sgn - signed mixer put callback
2623 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002624 * @ucontrol: control element information
Mark Browne13ac2e2008-05-28 17:58:05 +01002625 *
2626 * Callback to set the value of a signed mixer control.
2627 *
2628 * Returns 0 for success.
2629 */
2630int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol,
2631 struct snd_ctl_elem_value *ucontrol)
2632{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002633 struct soc_mixer_control *mc =
2634 (struct soc_mixer_control *)kcontrol->private_value;
Mark Browne13ac2e2008-05-28 17:58:05 +01002635 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf8d2008-07-29 10:22:24 -04002636 unsigned int reg = mc->reg;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002637 int min = mc->min;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002638 unsigned int val;
Mark Browne13ac2e2008-05-28 17:58:05 +01002639
2640 val = (ucontrol->value.integer.value[0]+min) & 0xff;
2641 val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8;
2642
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002643 return snd_soc_update_bits_locked(codec, reg, 0xffff, val);
Mark Browne13ac2e2008-05-28 17:58:05 +01002644}
2645EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8);
2646
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002647/**
Peter Ujfalusi637d3842010-05-07 14:05:49 +03002648 * snd_soc_limit_volume - Set new limit to an existing volume control.
2649 *
2650 * @codec: where to look for the control
2651 * @name: Name of the control
2652 * @max: new maximum limit
2653 *
2654 * Return 0 for success, else error.
2655 */
2656int snd_soc_limit_volume(struct snd_soc_codec *codec,
2657 const char *name, int max)
2658{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002659 struct snd_card *card = codec->card->snd_card;
Peter Ujfalusi637d3842010-05-07 14:05:49 +03002660 struct snd_kcontrol *kctl;
2661 struct soc_mixer_control *mc;
2662 int found = 0;
2663 int ret = -EINVAL;
2664
2665 /* Sanity check for name and max */
2666 if (unlikely(!name || max <= 0))
2667 return -EINVAL;
2668
2669 list_for_each_entry(kctl, &card->controls, list) {
2670 if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) {
2671 found = 1;
2672 break;
2673 }
2674 }
2675 if (found) {
2676 mc = (struct soc_mixer_control *)kctl->private_value;
2677 if (max <= mc->max) {
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002678 mc->platform_max = max;
Peter Ujfalusi637d3842010-05-07 14:05:49 +03002679 ret = 0;
2680 }
2681 }
2682 return ret;
2683}
2684EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
2685
2686/**
apatard@mandriva.comb6f4bb32010-05-15 17:30:01 +02002687 * snd_soc_info_volsw_2r_sx - double with tlv and variable data size
2688 * mixer info callback
2689 * @kcontrol: mixer control
2690 * @uinfo: control element information
2691 *
2692 * Returns 0 for success.
2693 */
2694int snd_soc_info_volsw_2r_sx(struct snd_kcontrol *kcontrol,
2695 struct snd_ctl_elem_info *uinfo)
2696{
2697 struct soc_mixer_control *mc =
2698 (struct soc_mixer_control *)kcontrol->private_value;
2699 int max = mc->max;
2700 int min = mc->min;
2701
2702 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2703 uinfo->count = 2;
2704 uinfo->value.integer.min = 0;
2705 uinfo->value.integer.max = max-min;
2706
2707 return 0;
2708}
2709EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r_sx);
2710
2711/**
2712 * snd_soc_get_volsw_2r_sx - double with tlv and variable data size
2713 * mixer get callback
2714 * @kcontrol: mixer control
2715 * @uinfo: control element information
2716 *
2717 * Returns 0 for success.
2718 */
2719int snd_soc_get_volsw_2r_sx(struct snd_kcontrol *kcontrol,
2720 struct snd_ctl_elem_value *ucontrol)
2721{
2722 struct soc_mixer_control *mc =
2723 (struct soc_mixer_control *)kcontrol->private_value;
2724 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2725 unsigned int mask = (1<<mc->shift)-1;
2726 int min = mc->min;
2727 int val = snd_soc_read(codec, mc->reg) & mask;
2728 int valr = snd_soc_read(codec, mc->rreg) & mask;
2729
Stuart Longland20630c72010-06-18 12:56:10 +10002730 ucontrol->value.integer.value[0] = ((val & 0xff)-min) & mask;
2731 ucontrol->value.integer.value[1] = ((valr & 0xff)-min) & mask;
apatard@mandriva.comb6f4bb32010-05-15 17:30:01 +02002732 return 0;
2733}
2734EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r_sx);
2735
2736/**
2737 * snd_soc_put_volsw_2r_sx - double with tlv and variable data size
2738 * mixer put callback
2739 * @kcontrol: mixer control
2740 * @uinfo: control element information
2741 *
2742 * Returns 0 for success.
2743 */
2744int snd_soc_put_volsw_2r_sx(struct snd_kcontrol *kcontrol,
2745 struct snd_ctl_elem_value *ucontrol)
2746{
2747 struct soc_mixer_control *mc =
2748 (struct soc_mixer_control *)kcontrol->private_value;
2749 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2750 unsigned int mask = (1<<mc->shift)-1;
2751 int min = mc->min;
2752 int ret;
2753 unsigned int val, valr, oval, ovalr;
2754
2755 val = ((ucontrol->value.integer.value[0]+min) & 0xff);
2756 val &= mask;
2757 valr = ((ucontrol->value.integer.value[1]+min) & 0xff);
2758 valr &= mask;
2759
2760 oval = snd_soc_read(codec, mc->reg) & mask;
2761 ovalr = snd_soc_read(codec, mc->rreg) & mask;
2762
2763 ret = 0;
2764 if (oval != val) {
2765 ret = snd_soc_write(codec, mc->reg, val);
2766 if (ret < 0)
Mark Brownf1df5ae2010-06-15 15:14:31 +01002767 return ret;
apatard@mandriva.comb6f4bb32010-05-15 17:30:01 +02002768 }
2769 if (ovalr != valr) {
2770 ret = snd_soc_write(codec, mc->rreg, valr);
2771 if (ret < 0)
Mark Brownf1df5ae2010-06-15 15:14:31 +01002772 return ret;
apatard@mandriva.comb6f4bb32010-05-15 17:30:01 +02002773 }
2774
2775 return 0;
2776}
2777EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r_sx);
2778
2779/**
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002780 * snd_soc_dai_set_sysclk - configure DAI system or master clock.
2781 * @dai: DAI
2782 * @clk_id: DAI specific clock ID
2783 * @freq: new clock frequency in Hz
2784 * @dir: new clock direction - input/output.
2785 *
2786 * Configures the DAI master (MCLK) or system (SYSCLK) clocking.
2787 */
2788int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
2789 unsigned int freq, int dir)
2790{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002791 if (dai->driver && dai->driver->ops->set_sysclk)
2792 return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002793 else
2794 return -EINVAL;
2795}
2796EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
2797
2798/**
2799 * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
2800 * @dai: DAI
Mark Brownac11a2b2009-01-01 12:18:17 +00002801 * @div_id: DAI specific clock divider ID
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002802 * @div: new clock divisor.
2803 *
2804 * Configures the clock dividers. This is used to derive the best DAI bit and
2805 * frame clocks from the system or master clock. It's best to set the DAI bit
2806 * and frame clocks as low as possible to save system power.
2807 */
2808int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
2809 int div_id, int div)
2810{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002811 if (dai->driver && dai->driver->ops->set_clkdiv)
2812 return dai->driver->ops->set_clkdiv(dai, div_id, div);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002813 else
2814 return -EINVAL;
2815}
2816EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv);
2817
2818/**
2819 * snd_soc_dai_set_pll - configure DAI PLL.
2820 * @dai: DAI
2821 * @pll_id: DAI specific PLL ID
Mark Brown85488032009-09-05 18:52:16 +01002822 * @source: DAI specific source for the PLL
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002823 * @freq_in: PLL input clock frequency in Hz
2824 * @freq_out: requested PLL output clock frequency in Hz
2825 *
2826 * Configures and enables PLL to generate output clock based on input clock.
2827 */
Mark Brown85488032009-09-05 18:52:16 +01002828int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
2829 unsigned int freq_in, unsigned int freq_out)
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002830{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002831 if (dai->driver && dai->driver->ops->set_pll)
2832 return dai->driver->ops->set_pll(dai, pll_id, source,
Mark Brown85488032009-09-05 18:52:16 +01002833 freq_in, freq_out);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002834 else
2835 return -EINVAL;
2836}
2837EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
2838
2839/**
2840 * snd_soc_dai_set_fmt - configure DAI hardware audio format.
2841 * @dai: DAI
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002842 * @fmt: SND_SOC_DAIFMT_ format value.
2843 *
2844 * Configures the DAI hardware format and clocking.
2845 */
2846int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
2847{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002848 if (dai->driver && dai->driver->ops->set_fmt)
2849 return dai->driver->ops->set_fmt(dai, fmt);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002850 else
2851 return -EINVAL;
2852}
2853EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
2854
2855/**
2856 * snd_soc_dai_set_tdm_slot - configure DAI TDM.
2857 * @dai: DAI
Daniel Ribeiroa5479e32009-06-15 21:44:31 -03002858 * @tx_mask: bitmask representing active TX slots.
2859 * @rx_mask: bitmask representing active RX slots.
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002860 * @slots: Number of slots in use.
Daniel Ribeiroa5479e32009-06-15 21:44:31 -03002861 * @slot_width: Width in bits for each slot.
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002862 *
2863 * Configures a DAI for TDM operation. Both mask and slots are codec and DAI
2864 * specific.
2865 */
2866int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
Daniel Ribeiroa5479e32009-06-15 21:44:31 -03002867 unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002868{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002869 if (dai->driver && dai->driver->ops->set_tdm_slot)
2870 return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask,
Daniel Ribeiroa5479e32009-06-15 21:44:31 -03002871 slots, slot_width);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002872 else
2873 return -EINVAL;
2874}
2875EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
2876
2877/**
Barry Song472df3c2009-09-12 01:16:29 +08002878 * snd_soc_dai_set_channel_map - configure DAI audio channel map
2879 * @dai: DAI
2880 * @tx_num: how many TX channels
2881 * @tx_slot: pointer to an array which imply the TX slot number channel
2882 * 0~num-1 uses
2883 * @rx_num: how many RX channels
2884 * @rx_slot: pointer to an array which imply the RX slot number channel
2885 * 0~num-1 uses
2886 *
2887 * configure the relationship between channel number and TDM slot number.
2888 */
2889int snd_soc_dai_set_channel_map(struct snd_soc_dai *dai,
2890 unsigned int tx_num, unsigned int *tx_slot,
2891 unsigned int rx_num, unsigned int *rx_slot)
2892{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002893 if (dai->driver && dai->driver->ops->set_channel_map)
2894 return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot,
Barry Song472df3c2009-09-12 01:16:29 +08002895 rx_num, rx_slot);
2896 else
2897 return -EINVAL;
2898}
2899EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map);
2900
2901/**
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002902 * snd_soc_dai_set_tristate - configure DAI system or master clock.
2903 * @dai: DAI
2904 * @tristate: tristate enable
2905 *
2906 * Tristates the DAI so that others can use it.
2907 */
2908int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
2909{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002910 if (dai->driver && dai->driver->ops->set_tristate)
2911 return dai->driver->ops->set_tristate(dai, tristate);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002912 else
2913 return -EINVAL;
2914}
2915EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate);
2916
2917/**
2918 * snd_soc_dai_digital_mute - configure DAI system or master clock.
2919 * @dai: DAI
2920 * @mute: mute enable
2921 *
2922 * Mutes the DAI DAC.
2923 */
2924int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute)
2925{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002926 if (dai->driver && dai->driver->ops->digital_mute)
2927 return dai->driver->ops->digital_mute(dai, mute);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002928 else
2929 return -EINVAL;
2930}
2931EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
2932
Mark Brownc5af3a22008-11-28 13:29:45 +00002933/**
2934 * snd_soc_register_card - Register a card with the ASoC core
2935 *
Mark Brownac11a2b2009-01-01 12:18:17 +00002936 * @card: Card to register
Mark Brownc5af3a22008-11-28 13:29:45 +00002937 *
2938 * Note that currently this is an internal only function: it will be
2939 * exposed to machine drivers after further backporting of ASoC v2
2940 * registration APIs.
2941 */
2942static int snd_soc_register_card(struct snd_soc_card *card)
2943{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002944 int i;
2945
Mark Brownc5af3a22008-11-28 13:29:45 +00002946 if (!card->name || !card->dev)
2947 return -EINVAL;
2948
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002949 card->rtd = kzalloc(sizeof(struct snd_soc_pcm_runtime) * card->num_links,
2950 GFP_KERNEL);
2951 if (card->rtd == NULL)
2952 return -ENOMEM;
2953
2954 for (i = 0; i < card->num_links; i++)
2955 card->rtd[i].dai_link = &card->dai_link[i];
2956
Mark Brownc5af3a22008-11-28 13:29:45 +00002957 INIT_LIST_HEAD(&card->list);
2958 card->instantiated = 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002959 mutex_init(&card->mutex);
Mark Brownc5af3a22008-11-28 13:29:45 +00002960
2961 mutex_lock(&client_mutex);
2962 list_add(&card->list, &card_list);
Mark Brown435c5e22008-12-04 15:32:53 +00002963 snd_soc_instantiate_cards();
Mark Brownc5af3a22008-11-28 13:29:45 +00002964 mutex_unlock(&client_mutex);
2965
2966 dev_dbg(card->dev, "Registered card '%s'\n", card->name);
2967
2968 return 0;
2969}
2970
2971/**
2972 * snd_soc_unregister_card - Unregister a card with the ASoC core
2973 *
Mark Brownac11a2b2009-01-01 12:18:17 +00002974 * @card: Card to unregister
Mark Brownc5af3a22008-11-28 13:29:45 +00002975 *
2976 * Note that currently this is an internal only function: it will be
2977 * exposed to machine drivers after further backporting of ASoC v2
2978 * registration APIs.
2979 */
2980static int snd_soc_unregister_card(struct snd_soc_card *card)
2981{
2982 mutex_lock(&client_mutex);
2983 list_del(&card->list);
2984 mutex_unlock(&client_mutex);
Mark Brownc5af3a22008-11-28 13:29:45 +00002985 dev_dbg(card->dev, "Unregistered card '%s'\n", card->name);
2986
2987 return 0;
2988}
2989
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002990/*
2991 * Simplify DAI link configuration by removing ".-1" from device names
2992 * and sanitizing names.
2993 */
2994static inline char *fmt_single_name(struct device *dev, int *id)
2995{
2996 char *found, name[NAME_SIZE];
2997 int id1, id2;
2998
2999 if (dev_name(dev) == NULL)
3000 return NULL;
3001
3002 strncpy(name, dev_name(dev), NAME_SIZE);
3003
3004 /* are we a "%s.%d" name (platform and SPI components) */
3005 found = strstr(name, dev->driver->name);
3006 if (found) {
3007 /* get ID */
3008 if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) {
3009
3010 /* discard ID from name if ID == -1 */
3011 if (*id == -1)
3012 found[strlen(dev->driver->name)] = '\0';
3013 }
3014
3015 } else {
3016 /* I2C component devices are named "bus-addr" */
3017 if (sscanf(name, "%x-%x", &id1, &id2) == 2) {
3018 char tmp[NAME_SIZE];
3019
3020 /* create unique ID number from I2C addr and bus */
Jarkko Nikula05899442010-10-19 11:10:45 +03003021 *id = ((id1 & 0xffff) << 16) + id2;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003022
3023 /* sanitize component name for DAI link creation */
3024 snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name);
3025 strncpy(name, tmp, NAME_SIZE);
3026 } else
3027 *id = 0;
3028 }
3029
3030 return kstrdup(name, GFP_KERNEL);
3031}
3032
3033/*
3034 * Simplify DAI link naming for single devices with multiple DAIs by removing
3035 * any ".-1" and using the DAI name (instead of device name).
3036 */
3037static inline char *fmt_multiple_name(struct device *dev,
3038 struct snd_soc_dai_driver *dai_drv)
3039{
3040 if (dai_drv->name == NULL) {
3041 printk(KERN_ERR "asoc: error - multiple DAI %s registered with no name\n",
3042 dev_name(dev));
3043 return NULL;
3044 }
3045
3046 return kstrdup(dai_drv->name, GFP_KERNEL);
3047}
3048
Mark Brown91151712008-11-30 23:31:24 +00003049/**
3050 * snd_soc_register_dai - Register a DAI with the ASoC core
3051 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003052 * @dai: DAI to register
Mark Brown91151712008-11-30 23:31:24 +00003053 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003054int snd_soc_register_dai(struct device *dev,
3055 struct snd_soc_dai_driver *dai_drv)
Mark Brown91151712008-11-30 23:31:24 +00003056{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003057 struct snd_soc_dai *dai;
Mark Brown91151712008-11-30 23:31:24 +00003058
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003059 dev_dbg(dev, "dai register %s\n", dev_name(dev));
Mark Brown91151712008-11-30 23:31:24 +00003060
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003061 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
3062 if (dai == NULL)
3063 return -ENOMEM;
Eric Miao6335d052009-03-03 09:41:00 +08003064
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003065 /* create DAI component name */
3066 dai->name = fmt_single_name(dev, &dai->id);
3067 if (dai->name == NULL) {
3068 kfree(dai);
3069 return -ENOMEM;
3070 }
3071
3072 dai->dev = dev;
3073 dai->driver = dai_drv;
3074 if (!dai->driver->ops)
3075 dai->driver->ops = &null_dai_ops;
Mark Brown91151712008-11-30 23:31:24 +00003076
3077 mutex_lock(&client_mutex);
3078 list_add(&dai->list, &dai_list);
Mark Brown435c5e22008-12-04 15:32:53 +00003079 snd_soc_instantiate_cards();
Mark Brown91151712008-11-30 23:31:24 +00003080 mutex_unlock(&client_mutex);
3081
3082 pr_debug("Registered DAI '%s'\n", dai->name);
3083
3084 return 0;
3085}
3086EXPORT_SYMBOL_GPL(snd_soc_register_dai);
3087
3088/**
3089 * snd_soc_unregister_dai - Unregister a DAI from the ASoC core
3090 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003091 * @dai: DAI to unregister
Mark Brown91151712008-11-30 23:31:24 +00003092 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003093void snd_soc_unregister_dai(struct device *dev)
Mark Brown91151712008-11-30 23:31:24 +00003094{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003095 struct snd_soc_dai *dai;
3096
3097 list_for_each_entry(dai, &dai_list, list) {
3098 if (dev == dai->dev)
3099 goto found;
3100 }
3101 return;
3102
3103found:
Mark Brown91151712008-11-30 23:31:24 +00003104 mutex_lock(&client_mutex);
3105 list_del(&dai->list);
3106 mutex_unlock(&client_mutex);
3107
3108 pr_debug("Unregistered DAI '%s'\n", dai->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003109 kfree(dai->name);
3110 kfree(dai);
Mark Brown91151712008-11-30 23:31:24 +00003111}
3112EXPORT_SYMBOL_GPL(snd_soc_unregister_dai);
3113
3114/**
3115 * snd_soc_register_dais - Register multiple DAIs with the ASoC core
3116 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003117 * @dai: Array of DAIs to register
3118 * @count: Number of DAIs
Mark Brown91151712008-11-30 23:31:24 +00003119 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003120int snd_soc_register_dais(struct device *dev,
3121 struct snd_soc_dai_driver *dai_drv, size_t count)
Mark Brown91151712008-11-30 23:31:24 +00003122{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003123 struct snd_soc_dai *dai;
3124 int i, ret = 0;
3125
Liam Girdwood720ffa42010-08-18 00:30:30 +01003126 dev_dbg(dev, "dai register %s #%Zu\n", dev_name(dev), count);
Mark Brown91151712008-11-30 23:31:24 +00003127
3128 for (i = 0; i < count; i++) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003129
3130 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
Axel Linc46e0072010-11-03 15:04:45 +08003131 if (dai == NULL) {
3132 ret = -ENOMEM;
3133 goto err;
3134 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003135
3136 /* create DAI component name */
3137 dai->name = fmt_multiple_name(dev, &dai_drv[i]);
3138 if (dai->name == NULL) {
3139 kfree(dai);
3140 ret = -EINVAL;
Mark Brown91151712008-11-30 23:31:24 +00003141 goto err;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003142 }
3143
3144 dai->dev = dev;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003145 dai->driver = &dai_drv[i];
Mark Brown0f9141c2010-10-12 15:43:21 +01003146 if (dai->driver->id)
3147 dai->id = dai->driver->id;
3148 else
3149 dai->id = i;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003150 if (!dai->driver->ops)
3151 dai->driver->ops = &null_dai_ops;
3152
3153 mutex_lock(&client_mutex);
3154 list_add(&dai->list, &dai_list);
3155 mutex_unlock(&client_mutex);
3156
3157 pr_debug("Registered DAI '%s'\n", dai->name);
Mark Brown91151712008-11-30 23:31:24 +00003158 }
3159
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003160 snd_soc_instantiate_cards();
Mark Brown91151712008-11-30 23:31:24 +00003161 return 0;
3162
3163err:
3164 for (i--; i >= 0; i--)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003165 snd_soc_unregister_dai(dev);
Mark Brown91151712008-11-30 23:31:24 +00003166
3167 return ret;
3168}
3169EXPORT_SYMBOL_GPL(snd_soc_register_dais);
3170
3171/**
3172 * snd_soc_unregister_dais - Unregister multiple DAIs from the ASoC core
3173 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003174 * @dai: Array of DAIs to unregister
3175 * @count: Number of DAIs
Mark Brown91151712008-11-30 23:31:24 +00003176 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003177void snd_soc_unregister_dais(struct device *dev, size_t count)
Mark Brown91151712008-11-30 23:31:24 +00003178{
3179 int i;
3180
3181 for (i = 0; i < count; i++)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003182 snd_soc_unregister_dai(dev);
Mark Brown91151712008-11-30 23:31:24 +00003183}
3184EXPORT_SYMBOL_GPL(snd_soc_unregister_dais);
3185
Mark Brown12a48a8c2008-12-03 19:40:30 +00003186/**
3187 * snd_soc_register_platform - Register a platform with the ASoC core
3188 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003189 * @platform: platform to register
Mark Brown12a48a8c2008-12-03 19:40:30 +00003190 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003191int snd_soc_register_platform(struct device *dev,
3192 struct snd_soc_platform_driver *platform_drv)
Mark Brown12a48a8c2008-12-03 19:40:30 +00003193{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003194 struct snd_soc_platform *platform;
Mark Brown12a48a8c2008-12-03 19:40:30 +00003195
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003196 dev_dbg(dev, "platform register %s\n", dev_name(dev));
3197
3198 platform = kzalloc(sizeof(struct snd_soc_platform), GFP_KERNEL);
3199 if (platform == NULL)
3200 return -ENOMEM;
3201
3202 /* create platform component name */
3203 platform->name = fmt_single_name(dev, &platform->id);
3204 if (platform->name == NULL) {
3205 kfree(platform);
3206 return -ENOMEM;
3207 }
3208
3209 platform->dev = dev;
3210 platform->driver = platform_drv;
Mark Brown12a48a8c2008-12-03 19:40:30 +00003211
3212 mutex_lock(&client_mutex);
3213 list_add(&platform->list, &platform_list);
Mark Brown435c5e22008-12-04 15:32:53 +00003214 snd_soc_instantiate_cards();
Mark Brown12a48a8c2008-12-03 19:40:30 +00003215 mutex_unlock(&client_mutex);
3216
3217 pr_debug("Registered platform '%s'\n", platform->name);
3218
3219 return 0;
3220}
3221EXPORT_SYMBOL_GPL(snd_soc_register_platform);
3222
3223/**
3224 * snd_soc_unregister_platform - Unregister a platform from the ASoC core
3225 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003226 * @platform: platform to unregister
Mark Brown12a48a8c2008-12-03 19:40:30 +00003227 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003228void snd_soc_unregister_platform(struct device *dev)
Mark Brown12a48a8c2008-12-03 19:40:30 +00003229{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003230 struct snd_soc_platform *platform;
3231
3232 list_for_each_entry(platform, &platform_list, list) {
3233 if (dev == platform->dev)
3234 goto found;
3235 }
3236 return;
3237
3238found:
Mark Brown12a48a8c2008-12-03 19:40:30 +00003239 mutex_lock(&client_mutex);
3240 list_del(&platform->list);
3241 mutex_unlock(&client_mutex);
3242
3243 pr_debug("Unregistered platform '%s'\n", platform->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003244 kfree(platform->name);
3245 kfree(platform);
Mark Brown12a48a8c2008-12-03 19:40:30 +00003246}
3247EXPORT_SYMBOL_GPL(snd_soc_unregister_platform);
3248
Mark Brown151ab222009-05-09 16:22:58 +01003249static u64 codec_format_map[] = {
3250 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE,
3251 SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE,
3252 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_BE,
3253 SNDRV_PCM_FMTBIT_U24_LE | SNDRV_PCM_FMTBIT_U24_BE,
3254 SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE,
3255 SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE,
3256 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
3257 SNDRV_PCM_FMTBIT_U24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
3258 SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S20_3BE,
3259 SNDRV_PCM_FMTBIT_U20_3LE | SNDRV_PCM_FMTBIT_U20_3BE,
3260 SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S18_3BE,
3261 SNDRV_PCM_FMTBIT_U18_3LE | SNDRV_PCM_FMTBIT_U18_3BE,
3262 SNDRV_PCM_FMTBIT_FLOAT_LE | SNDRV_PCM_FMTBIT_FLOAT_BE,
3263 SNDRV_PCM_FMTBIT_FLOAT64_LE | SNDRV_PCM_FMTBIT_FLOAT64_BE,
3264 SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE
3265 | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE,
3266};
3267
3268/* Fix up the DAI formats for endianness: codecs don't actually see
3269 * the endianness of the data but we're using the CPU format
3270 * definitions which do need to include endianness so we ensure that
3271 * codec DAIs always have both big and little endian variants set.
3272 */
3273static void fixup_codec_formats(struct snd_soc_pcm_stream *stream)
3274{
3275 int i;
3276
3277 for (i = 0; i < ARRAY_SIZE(codec_format_map); i++)
3278 if (stream->formats & codec_format_map[i])
3279 stream->formats |= codec_format_map[i];
3280}
3281
Mark Brown0d0cf002008-12-10 14:32:45 +00003282/**
3283 * snd_soc_register_codec - Register a codec with the ASoC core
3284 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003285 * @codec: codec to register
Mark Brown0d0cf002008-12-10 14:32:45 +00003286 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003287int snd_soc_register_codec(struct device *dev,
3288 struct snd_soc_codec_driver *codec_drv,
3289 struct snd_soc_dai_driver *dai_drv, int num_dai)
Mark Brown0d0cf002008-12-10 14:32:45 +00003290{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003291 struct snd_soc_codec *codec;
3292 int ret, i;
Mark Brown151ab222009-05-09 16:22:58 +01003293
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003294 dev_dbg(dev, "codec register %s\n", dev_name(dev));
Mark Brown0d0cf002008-12-10 14:32:45 +00003295
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003296 codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
3297 if (codec == NULL)
3298 return -ENOMEM;
Mark Brown0d0cf002008-12-10 14:32:45 +00003299
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003300 /* create CODEC component name */
3301 codec->name = fmt_single_name(dev, &codec->id);
3302 if (codec->name == NULL) {
3303 kfree(codec);
3304 return -ENOMEM;
Mark Brown151ab222009-05-09 16:22:58 +01003305 }
3306
Liam Girdwoodce6120c2010-11-05 15:53:46 +02003307 INIT_LIST_HEAD(&codec->dapm.widgets);
3308 INIT_LIST_HEAD(&codec->dapm.paths);
3309 codec->dapm.bias_level = SND_SOC_BIAS_OFF;
3310 codec->dapm.dev = dev;
3311 codec->dapm.codec = codec;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003312 codec->dev = dev;
3313 codec->driver = codec_drv;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003314 codec->num_dai = num_dai;
3315 mutex_init(&codec->mutex);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003316
Dimitris Papastamos7a30a3d2010-11-11 10:04:57 +00003317 /* allocate CODEC register cache */
3318 if (codec_drv->reg_cache_size && codec_drv->reg_word_size) {
3319 ret = snd_soc_cache_init(codec);
3320 if (ret < 0) {
3321 dev_err(codec->dev, "Failed to set cache compression type: %d\n",
3322 ret);
3323 goto error_cache;
3324 }
3325 }
3326
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003327 for (i = 0; i < num_dai; i++) {
3328 fixup_codec_formats(&dai_drv[i].playback);
3329 fixup_codec_formats(&dai_drv[i].capture);
3330 }
3331
Mark Brown26b01cc2010-08-18 20:20:55 +01003332 /* register any DAIs */
3333 if (num_dai) {
3334 ret = snd_soc_register_dais(dev, dai_drv, num_dai);
3335 if (ret < 0)
Dimitris Papastamos7a30a3d2010-11-11 10:04:57 +00003336 goto error_dais;
Mark Brown26b01cc2010-08-18 20:20:55 +01003337 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003338
Mark Brown0d0cf002008-12-10 14:32:45 +00003339 mutex_lock(&client_mutex);
3340 list_add(&codec->list, &codec_list);
3341 snd_soc_instantiate_cards();
3342 mutex_unlock(&client_mutex);
3343
3344 pr_debug("Registered codec '%s'\n", codec->name);
Mark Brown0d0cf002008-12-10 14:32:45 +00003345 return 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003346
Dimitris Papastamos7a30a3d2010-11-11 10:04:57 +00003347error_dais:
3348 snd_soc_cache_exit(codec);
3349error_cache:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003350 kfree(codec->name);
3351 kfree(codec);
3352 return ret;
Mark Brown0d0cf002008-12-10 14:32:45 +00003353}
3354EXPORT_SYMBOL_GPL(snd_soc_register_codec);
3355
3356/**
3357 * snd_soc_unregister_codec - Unregister a codec from the ASoC core
3358 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003359 * @codec: codec to unregister
Mark Brown0d0cf002008-12-10 14:32:45 +00003360 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003361void snd_soc_unregister_codec(struct device *dev)
Mark Brown0d0cf002008-12-10 14:32:45 +00003362{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003363 struct snd_soc_codec *codec;
3364 int i;
3365
3366 list_for_each_entry(codec, &codec_list, list) {
3367 if (dev == codec->dev)
3368 goto found;
3369 }
3370 return;
3371
3372found:
Mark Brown26b01cc2010-08-18 20:20:55 +01003373 if (codec->num_dai)
3374 for (i = 0; i < codec->num_dai; i++)
3375 snd_soc_unregister_dai(dev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003376
Mark Brown0d0cf002008-12-10 14:32:45 +00003377 mutex_lock(&client_mutex);
3378 list_del(&codec->list);
3379 mutex_unlock(&client_mutex);
3380
3381 pr_debug("Unregistered codec '%s'\n", codec->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003382
Dimitris Papastamos7a30a3d2010-11-11 10:04:57 +00003383 snd_soc_cache_exit(codec);
Dimitris Papastamos1aafcd42010-10-21 13:19:45 +01003384 kfree(codec->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003385 kfree(codec);
Mark Brown0d0cf002008-12-10 14:32:45 +00003386}
3387EXPORT_SYMBOL_GPL(snd_soc_unregister_codec);
3388
Takashi Iwaic9b3a402008-12-10 07:47:22 +01003389static int __init snd_soc_init(void)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003390{
Mark Brown384c89e2008-12-03 17:34:03 +00003391#ifdef CONFIG_DEBUG_FS
3392 debugfs_root = debugfs_create_dir("asoc", NULL);
3393 if (IS_ERR(debugfs_root) || !debugfs_root) {
3394 printk(KERN_WARNING
3395 "ASoC: Failed to create debugfs directory\n");
3396 debugfs_root = NULL;
3397 }
Mark Brownc3c5a192010-09-15 18:15:14 +01003398
3399 if (!debugfs_create_file("codecs", 0444, debugfs_root, NULL,
3400 &codec_list_fops))
3401 pr_warn("ASoC: Failed to create CODEC list debugfs file\n");
3402
Mark Brownf3208782010-09-15 18:19:07 +01003403 if (!debugfs_create_file("dais", 0444, debugfs_root, NULL,
3404 &dai_list_fops))
3405 pr_warn("ASoC: Failed to create DAI list debugfs file\n");
Mark Brown19c7ac22010-09-15 18:22:40 +01003406
3407 if (!debugfs_create_file("platforms", 0444, debugfs_root, NULL,
3408 &platform_list_fops))
3409 pr_warn("ASoC: Failed to create platform list debugfs file\n");
Mark Brown384c89e2008-12-03 17:34:03 +00003410#endif
3411
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003412 return platform_driver_register(&soc_driver);
3413}
Mark Brown4abe8e12010-10-12 17:41:03 +01003414module_init(snd_soc_init);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003415
Mark Brown7d8c16a2008-11-30 22:11:24 +00003416static void __exit snd_soc_exit(void)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003417{
Mark Brown384c89e2008-12-03 17:34:03 +00003418#ifdef CONFIG_DEBUG_FS
3419 debugfs_remove_recursive(debugfs_root);
3420#endif
Mark Brown3ff3f642008-05-19 12:32:25 +02003421 platform_driver_unregister(&soc_driver);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003422}
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003423module_exit(snd_soc_exit);
3424
3425/* Module information */
Liam Girdwoodd3311242008-10-12 13:17:36 +01003426MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003427MODULE_DESCRIPTION("ALSA SoC Core");
3428MODULE_LICENSE("GPL");
Kay Sievers8b45a202008-04-14 13:33:36 +02003429MODULE_ALIAS("platform:soc-audio");