blob: 614a8b30d87bdefdb99414f06d1d74438e60cd18 [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>
39#include <sound/soc-dapm.h>
40#include <sound/initval.h>
41
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000042#define NAME_SIZE 32
43
Frank Mandarinodb2a4162006-10-06 18:31:09 +020044static DEFINE_MUTEX(pcm_mutex);
Frank Mandarinodb2a4162006-10-06 18:31:09 +020045static DECLARE_WAIT_QUEUE_HEAD(soc_pm_waitq);
46
Mark Brown384c89e2008-12-03 17:34:03 +000047#ifdef CONFIG_DEBUG_FS
48static struct dentry *debugfs_root;
49#endif
50
Mark Brownc5af3a22008-11-28 13:29:45 +000051static DEFINE_MUTEX(client_mutex);
52static LIST_HEAD(card_list);
Mark Brown91151712008-11-30 23:31:24 +000053static LIST_HEAD(dai_list);
Mark Brown12a48a8c2008-12-03 19:40:30 +000054static LIST_HEAD(platform_list);
Mark Brown0d0cf002008-12-10 14:32:45 +000055static LIST_HEAD(codec_list);
Mark Brownc5af3a22008-11-28 13:29:45 +000056
57static int snd_soc_register_card(struct snd_soc_card *card);
58static int snd_soc_unregister_card(struct snd_soc_card *card);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000059static int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num);
Mark Brownc5af3a22008-11-28 13:29:45 +000060
Frank Mandarinodb2a4162006-10-06 18:31:09 +020061/*
62 * This is a timeout to do a DAPM powerdown after a stream is closed().
63 * It can be used to eliminate pops between different playback streams, e.g.
64 * between two audio tracks.
65 */
66static int pmdown_time = 5000;
67module_param(pmdown_time, int, 0);
68MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
69
Liam Girdwood965ac422007-01-31 14:14:57 +010070/*
71 * This function forces any delayed work to be queued and run.
72 */
73static int run_delayed_work(struct delayed_work *dwork)
74{
75 int ret;
76
77 /* cancel any work waiting to be queued. */
78 ret = cancel_delayed_work(dwork);
79
80 /* if there was any work waiting then we run it now and
81 * wait for it's completion */
82 if (ret) {
83 schedule_delayed_work(dwork, 0);
84 flush_scheduled_work();
85 }
86 return ret;
87}
88
Mark Brown2624d5f2009-11-03 21:56:13 +000089/* codec register dump */
90static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf)
91{
Mark Brown5164d742010-07-14 16:14:33 +010092 int ret, i, step = 1, count = 0;
Mark Brown2624d5f2009-11-03 21:56:13 +000093
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000094 if (!codec->driver->reg_cache_size)
Mark Brown2624d5f2009-11-03 21:56:13 +000095 return 0;
96
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +000097 if (codec->driver->reg_cache_step)
98 step = codec->driver->reg_cache_step;
Mark Brown2624d5f2009-11-03 21:56:13 +000099
100 count += sprintf(buf, "%s registers\n", codec->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000101 for (i = 0; i < codec->driver->reg_cache_size; i += step) {
102 if (codec->driver->readable_register && !codec->driver->readable_register(i))
Mark Brown2624d5f2009-11-03 21:56:13 +0000103 continue;
104
105 count += sprintf(buf + count, "%2x: ", i);
106 if (count >= PAGE_SIZE - 1)
107 break;
108
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000109 if (codec->driver->display_register) {
110 count += codec->driver->display_register(codec, buf + count,
Mark Brown2624d5f2009-11-03 21:56:13 +0000111 PAGE_SIZE - count, i);
Mark Brown5164d742010-07-14 16:14:33 +0100112 } else {
113 /* If the read fails it's almost certainly due to
114 * the register being volatile and the device being
115 * powered off.
116 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000117 ret = codec->driver->read(codec, i);
Mark Brown5164d742010-07-14 16:14:33 +0100118 if (ret >= 0)
119 count += snprintf(buf + count,
120 PAGE_SIZE - count,
121 "%4x", ret);
122 else
123 count += snprintf(buf + count,
124 PAGE_SIZE - count,
125 "<no data: %d>", ret);
126 }
Mark Brown2624d5f2009-11-03 21:56:13 +0000127
128 if (count >= PAGE_SIZE - 1)
129 break;
130
131 count += snprintf(buf + count, PAGE_SIZE - count, "\n");
132 if (count >= PAGE_SIZE - 1)
133 break;
134 }
135
136 /* Truncate count; min() would cause a warning */
137 if (count >= PAGE_SIZE)
138 count = PAGE_SIZE - 1;
139
140 return count;
141}
142static ssize_t codec_reg_show(struct device *dev,
143 struct device_attribute *attr, char *buf)
144{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000145 struct snd_soc_pcm_runtime *rtd =
146 container_of(dev, struct snd_soc_pcm_runtime, dev);
147
148 return soc_codec_reg_show(rtd->codec, buf);
Mark Brown2624d5f2009-11-03 21:56:13 +0000149}
150
151static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
152
Mark Browndbe21402010-02-12 11:37:24 +0000153static ssize_t pmdown_time_show(struct device *dev,
154 struct device_attribute *attr, char *buf)
155{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000156 struct snd_soc_pcm_runtime *rtd =
157 container_of(dev, struct snd_soc_pcm_runtime, dev);
Mark Browndbe21402010-02-12 11:37:24 +0000158
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000159 return sprintf(buf, "%ld\n", rtd->pmdown_time);
Mark Browndbe21402010-02-12 11:37:24 +0000160}
161
162static ssize_t pmdown_time_set(struct device *dev,
163 struct device_attribute *attr,
164 const char *buf, size_t count)
165{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000166 struct snd_soc_pcm_runtime *rtd =
167 container_of(dev, struct snd_soc_pcm_runtime, dev);
Mark Brownc593b522010-10-27 20:11:17 -0700168 int ret;
Mark Browndbe21402010-02-12 11:37:24 +0000169
Mark Brownc593b522010-10-27 20:11:17 -0700170 ret = strict_strtol(buf, 10, &rtd->pmdown_time);
171 if (ret)
172 return ret;
Mark Browndbe21402010-02-12 11:37:24 +0000173
174 return count;
175}
176
177static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set);
178
Mark Brown2624d5f2009-11-03 21:56:13 +0000179#ifdef CONFIG_DEBUG_FS
180static int codec_reg_open_file(struct inode *inode, struct file *file)
181{
182 file->private_data = inode->i_private;
183 return 0;
184}
185
186static ssize_t codec_reg_read_file(struct file *file, char __user *user_buf,
187 size_t count, loff_t *ppos)
188{
189 ssize_t ret;
190 struct snd_soc_codec *codec = file->private_data;
191 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
192 if (!buf)
193 return -ENOMEM;
194 ret = soc_codec_reg_show(codec, buf);
195 if (ret >= 0)
196 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
197 kfree(buf);
198 return ret;
199}
200
201static ssize_t codec_reg_write_file(struct file *file,
202 const char __user *user_buf, size_t count, loff_t *ppos)
203{
204 char buf[32];
205 int buf_size;
206 char *start = buf;
207 unsigned long reg, value;
208 int step = 1;
209 struct snd_soc_codec *codec = file->private_data;
210
211 buf_size = min(count, (sizeof(buf)-1));
212 if (copy_from_user(buf, user_buf, buf_size))
213 return -EFAULT;
214 buf[buf_size] = 0;
215
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000216 if (codec->driver->reg_cache_step)
217 step = codec->driver->reg_cache_step;
Mark Brown2624d5f2009-11-03 21:56:13 +0000218
219 while (*start == ' ')
220 start++;
221 reg = simple_strtoul(start, &start, 16);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000222 if ((reg >= codec->driver->reg_cache_size) || (reg % step))
Mark Brown2624d5f2009-11-03 21:56:13 +0000223 return -EINVAL;
224 while (*start == ' ')
225 start++;
226 if (strict_strtoul(start, 16, &value))
227 return -EINVAL;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000228 codec->driver->write(codec, reg, value);
Mark Brown2624d5f2009-11-03 21:56:13 +0000229 return buf_size;
230}
231
232static const struct file_operations codec_reg_fops = {
233 .open = codec_reg_open_file,
234 .read = codec_reg_read_file,
235 .write = codec_reg_write_file,
Arnd Bergmann6038f372010-08-15 18:52:59 +0200236 .llseek = default_llseek,
Mark Brown2624d5f2009-11-03 21:56:13 +0000237};
238
239static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
240{
Mark Brown6ba6c9c2010-08-12 15:49:52 +0100241 codec->debugfs_codec_root = debugfs_create_dir(codec->name ,
Mark Brown2624d5f2009-11-03 21:56:13 +0000242 debugfs_root);
243 if (!codec->debugfs_codec_root) {
244 printk(KERN_WARNING
245 "ASoC: Failed to create codec debugfs directory\n");
246 return;
247 }
248
249 codec->debugfs_reg = debugfs_create_file("codec_reg", 0644,
250 codec->debugfs_codec_root,
251 codec, &codec_reg_fops);
252 if (!codec->debugfs_reg)
253 printk(KERN_WARNING
254 "ASoC: Failed to create codec register debugfs file\n");
255
Axel Lin708fafb2010-08-27 10:34:27 +0800256 codec->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0644,
Mark Brown2624d5f2009-11-03 21:56:13 +0000257 codec->debugfs_codec_root,
258 &codec->pop_time);
259 if (!codec->debugfs_pop_time)
260 printk(KERN_WARNING
261 "Failed to create pop time debugfs file\n");
262
263 codec->debugfs_dapm = debugfs_create_dir("dapm",
264 codec->debugfs_codec_root);
265 if (!codec->debugfs_dapm)
266 printk(KERN_WARNING
267 "Failed to create DAPM debugfs directory\n");
268
269 snd_soc_dapm_debugfs_init(codec);
270}
271
272static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
273{
274 debugfs_remove_recursive(codec->debugfs_codec_root);
275}
276
Mark Brownc3c5a192010-09-15 18:15:14 +0100277static ssize_t codec_list_read_file(struct file *file, char __user *user_buf,
278 size_t count, loff_t *ppos)
279{
280 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
Mark Brown2b194f9d2010-10-13 10:52:16 +0100281 ssize_t len, ret = 0;
Mark Brownc3c5a192010-09-15 18:15:14 +0100282 struct snd_soc_codec *codec;
283
284 if (!buf)
285 return -ENOMEM;
286
Mark Brown2b194f9d2010-10-13 10:52:16 +0100287 list_for_each_entry(codec, &codec_list, list) {
288 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
289 codec->name);
290 if (len >= 0)
291 ret += len;
292 if (ret > PAGE_SIZE) {
293 ret = PAGE_SIZE;
294 break;
295 }
296 }
Mark Brownc3c5a192010-09-15 18:15:14 +0100297
298 if (ret >= 0)
299 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
300
301 kfree(buf);
302
303 return ret;
304}
305
306static const struct file_operations codec_list_fops = {
307 .read = codec_list_read_file,
308 .llseek = default_llseek,/* read accesses f_pos */
309};
310
Mark Brownf3208782010-09-15 18:19:07 +0100311static ssize_t dai_list_read_file(struct file *file, char __user *user_buf,
312 size_t count, loff_t *ppos)
313{
314 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
Mark Brown2b194f9d2010-10-13 10:52:16 +0100315 ssize_t len, ret = 0;
Mark Brownf3208782010-09-15 18:19:07 +0100316 struct snd_soc_dai *dai;
317
318 if (!buf)
319 return -ENOMEM;
320
Mark Brown2b194f9d2010-10-13 10:52:16 +0100321 list_for_each_entry(dai, &dai_list, list) {
322 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n", dai->name);
323 if (len >= 0)
324 ret += len;
325 if (ret > PAGE_SIZE) {
326 ret = PAGE_SIZE;
327 break;
328 }
329 }
Mark Brownf3208782010-09-15 18:19:07 +0100330
Mark Brown2b194f9d2010-10-13 10:52:16 +0100331 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
Mark Brownf3208782010-09-15 18:19:07 +0100332
333 kfree(buf);
334
335 return ret;
336}
337
338static const struct file_operations dai_list_fops = {
339 .read = dai_list_read_file,
340 .llseek = default_llseek,/* read accesses f_pos */
341};
342
Mark Brown19c7ac22010-09-15 18:22:40 +0100343static ssize_t platform_list_read_file(struct file *file,
344 char __user *user_buf,
345 size_t count, loff_t *ppos)
346{
347 char *buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
Mark Brown2b194f9d2010-10-13 10:52:16 +0100348 ssize_t len, ret = 0;
Mark Brown19c7ac22010-09-15 18:22:40 +0100349 struct snd_soc_platform *platform;
350
351 if (!buf)
352 return -ENOMEM;
353
Mark Brown2b194f9d2010-10-13 10:52:16 +0100354 list_for_each_entry(platform, &platform_list, list) {
355 len = snprintf(buf + ret, PAGE_SIZE - ret, "%s\n",
356 platform->name);
357 if (len >= 0)
358 ret += len;
359 if (ret > PAGE_SIZE) {
360 ret = PAGE_SIZE;
361 break;
362 }
363 }
Mark Brown19c7ac22010-09-15 18:22:40 +0100364
Mark Brown2b194f9d2010-10-13 10:52:16 +0100365 ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
Mark Brown19c7ac22010-09-15 18:22:40 +0100366
367 kfree(buf);
368
369 return ret;
370}
371
372static const struct file_operations platform_list_fops = {
373 .read = platform_list_read_file,
374 .llseek = default_llseek,/* read accesses f_pos */
375};
376
Mark Brown2624d5f2009-11-03 21:56:13 +0000377#else
378
379static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
380{
381}
382
383static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
384{
385}
386#endif
387
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200388#ifdef CONFIG_SND_SOC_AC97_BUS
389/* unregister ac97 codec */
390static int soc_ac97_dev_unregister(struct snd_soc_codec *codec)
391{
392 if (codec->ac97->dev.bus)
393 device_unregister(&codec->ac97->dev);
394 return 0;
395}
396
397/* stop no dev release warning */
398static void soc_ac97_device_release(struct device *dev){}
399
400/* register ac97 codec to bus */
401static int soc_ac97_dev_register(struct snd_soc_codec *codec)
402{
403 int err;
404
405 codec->ac97->dev.bus = &ac97_bus_type;
Mark Brown4ac5c612009-04-01 19:35:01 +0100406 codec->ac97->dev.parent = codec->card->dev;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200407 codec->ac97->dev.release = soc_ac97_device_release;
408
Kay Sieversbb072bf2008-11-02 03:50:35 +0100409 dev_set_name(&codec->ac97->dev, "%d-%d:%s",
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000410 codec->card->snd_card->number, 0, codec->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200411 err = device_register(&codec->ac97->dev);
412 if (err < 0) {
413 snd_printk(KERN_ERR "Can't register ac97 bus\n");
414 codec->ac97->dev.bus = NULL;
415 return err;
416 }
417 return 0;
418}
419#endif
420
Mark Brown06f409d2009-04-07 18:10:13 +0100421static int soc_pcm_apply_symmetry(struct snd_pcm_substream *substream)
422{
423 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000424 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
425 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Mark Brown06f409d2009-04-07 18:10:13 +0100426 int ret;
427
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000428 if (codec_dai->driver->symmetric_rates || cpu_dai->driver->symmetric_rates ||
429 rtd->dai_link->symmetric_rates) {
430 dev_dbg(&rtd->dev, "Symmetry forces %dHz rate\n",
431 rtd->rate);
Mark Brown06f409d2009-04-07 18:10:13 +0100432
433 ret = snd_pcm_hw_constraint_minmax(substream->runtime,
434 SNDRV_PCM_HW_PARAM_RATE,
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000435 rtd->rate,
436 rtd->rate);
Mark Brown06f409d2009-04-07 18:10:13 +0100437 if (ret < 0) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000438 dev_err(&rtd->dev,
Mark Brown06f409d2009-04-07 18:10:13 +0100439 "Unable to apply rate symmetry constraint: %d\n", ret);
440 return ret;
441 }
442 }
443
444 return 0;
445}
446
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200447/*
448 * Called by ALSA when a PCM substream is opened, the runtime->hw record is
449 * then initialized and any private data can be allocated. This also calls
450 * startup for the cpu DAI, platform, machine and codec DAI.
451 */
452static int soc_pcm_open(struct snd_pcm_substream *substream)
453{
454 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200455 struct snd_pcm_runtime *runtime = substream->runtime;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000456 struct snd_soc_platform *platform = rtd->platform;
457 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
458 struct snd_soc_dai *codec_dai = rtd->codec_dai;
459 struct snd_soc_dai_driver *cpu_dai_drv = cpu_dai->driver;
460 struct snd_soc_dai_driver *codec_dai_drv = codec_dai->driver;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200461 int ret = 0;
462
463 mutex_lock(&pcm_mutex);
464
465 /* startup the audio subsystem */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000466 if (cpu_dai->driver->ops->startup) {
467 ret = cpu_dai->driver->ops->startup(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200468 if (ret < 0) {
469 printk(KERN_ERR "asoc: can't open interface %s\n",
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100470 cpu_dai->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200471 goto out;
472 }
473 }
474
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000475 if (platform->driver->ops->open) {
476 ret = platform->driver->ops->open(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200477 if (ret < 0) {
478 printk(KERN_ERR "asoc: can't open platform %s\n", platform->name);
479 goto platform_err;
480 }
481 }
482
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000483 if (codec_dai->driver->ops->startup) {
484 ret = codec_dai->driver->ops->startup(substream, codec_dai);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100485 if (ret < 0) {
486 printk(KERN_ERR "asoc: can't open codec %s\n",
487 codec_dai->name);
488 goto codec_dai_err;
489 }
490 }
491
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000492 if (rtd->dai_link->ops && rtd->dai_link->ops->startup) {
493 ret = rtd->dai_link->ops->startup(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200494 if (ret < 0) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000495 printk(KERN_ERR "asoc: %s startup failed\n", rtd->dai_link->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200496 goto machine_err;
497 }
498 }
499
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200500 /* Check that the codec and cpu DAI's are compatible */
501 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
502 runtime->hw.rate_min =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000503 max(codec_dai_drv->playback.rate_min,
504 cpu_dai_drv->playback.rate_min);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200505 runtime->hw.rate_max =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000506 min(codec_dai_drv->playback.rate_max,
507 cpu_dai_drv->playback.rate_max);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200508 runtime->hw.channels_min =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000509 max(codec_dai_drv->playback.channels_min,
510 cpu_dai_drv->playback.channels_min);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200511 runtime->hw.channels_max =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000512 min(codec_dai_drv->playback.channels_max,
513 cpu_dai_drv->playback.channels_max);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100514 runtime->hw.formats =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000515 codec_dai_drv->playback.formats & cpu_dai_drv->playback.formats;
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100516 runtime->hw.rates =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000517 codec_dai_drv->playback.rates & cpu_dai_drv->playback.rates;
518 if (codec_dai_drv->playback.rates
Jassi Brard9ad6292010-03-12 13:38:52 +0900519 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000520 runtime->hw.rates |= cpu_dai_drv->playback.rates;
521 if (cpu_dai_drv->playback.rates
Jassi Brard9ad6292010-03-12 13:38:52 +0900522 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000523 runtime->hw.rates |= codec_dai_drv->playback.rates;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200524 } else {
525 runtime->hw.rate_min =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000526 max(codec_dai_drv->capture.rate_min,
527 cpu_dai_drv->capture.rate_min);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200528 runtime->hw.rate_max =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000529 min(codec_dai_drv->capture.rate_max,
530 cpu_dai_drv->capture.rate_max);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200531 runtime->hw.channels_min =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000532 max(codec_dai_drv->capture.channels_min,
533 cpu_dai_drv->capture.channels_min);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200534 runtime->hw.channels_max =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000535 min(codec_dai_drv->capture.channels_max,
536 cpu_dai_drv->capture.channels_max);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100537 runtime->hw.formats =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000538 codec_dai_drv->capture.formats & cpu_dai_drv->capture.formats;
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100539 runtime->hw.rates =
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000540 codec_dai_drv->capture.rates & cpu_dai_drv->capture.rates;
541 if (codec_dai_drv->capture.rates
Jassi Brard9ad6292010-03-12 13:38:52 +0900542 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000543 runtime->hw.rates |= cpu_dai_drv->capture.rates;
544 if (cpu_dai_drv->capture.rates
Jassi Brard9ad6292010-03-12 13:38:52 +0900545 & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000546 runtime->hw.rates |= codec_dai_drv->capture.rates;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200547 }
548
549 snd_pcm_limit_hw_rates(runtime);
550 if (!runtime->hw.rates) {
551 printk(KERN_ERR "asoc: %s <-> %s No matching rates\n",
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100552 codec_dai->name, cpu_dai->name);
Jassi Brarbb1c0472010-02-25 11:24:53 +0900553 goto config_err;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200554 }
555 if (!runtime->hw.formats) {
556 printk(KERN_ERR "asoc: %s <-> %s No matching formats\n",
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100557 codec_dai->name, cpu_dai->name);
Jassi Brarbb1c0472010-02-25 11:24:53 +0900558 goto config_err;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200559 }
560 if (!runtime->hw.channels_min || !runtime->hw.channels_max) {
561 printk(KERN_ERR "asoc: %s <-> %s No matching channels\n",
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000562 codec_dai->name, cpu_dai->name);
Jassi Brarbb1c0472010-02-25 11:24:53 +0900563 goto config_err;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200564 }
565
Mark Brown06f409d2009-04-07 18:10:13 +0100566 /* Symmetry only applies if we've already got an active stream. */
567 if (cpu_dai->active || codec_dai->active) {
568 ret = soc_pcm_apply_symmetry(substream);
569 if (ret != 0)
Jassi Brarbb1c0472010-02-25 11:24:53 +0900570 goto config_err;
Mark Brown06f409d2009-04-07 18:10:13 +0100571 }
572
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000573 pr_debug("asoc: %s <-> %s info:\n",
574 codec_dai->name, cpu_dai->name);
Mark Brownf24368c2008-10-21 21:45:08 +0100575 pr_debug("asoc: rate mask 0x%x\n", runtime->hw.rates);
576 pr_debug("asoc: min ch %d max ch %d\n", runtime->hw.channels_min,
577 runtime->hw.channels_max);
578 pr_debug("asoc: min rate %d max rate %d\n", runtime->hw.rate_min,
579 runtime->hw.rate_max);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200580
Jassi Brar14dc5732010-02-26 09:12:32 +0900581 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000582 cpu_dai->playback_active++;
583 codec_dai->playback_active++;
Jassi Brar14dc5732010-02-26 09:12:32 +0900584 } else {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000585 cpu_dai->capture_active++;
586 codec_dai->capture_active++;
Jassi Brar14dc5732010-02-26 09:12:32 +0900587 }
588 cpu_dai->active++;
589 codec_dai->active++;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000590 rtd->codec->active++;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200591 mutex_unlock(&pcm_mutex);
592 return 0;
593
Jassi Brarbb1c0472010-02-25 11:24:53 +0900594config_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000595 if (rtd->dai_link->ops && rtd->dai_link->ops->shutdown)
596 rtd->dai_link->ops->shutdown(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200597
Jassi Brarbb1c0472010-02-25 11:24:53 +0900598machine_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000599 if (codec_dai->driver->ops->shutdown)
600 codec_dai->driver->ops->shutdown(substream, codec_dai);
Jassi Brarbb1c0472010-02-25 11:24:53 +0900601
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100602codec_dai_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000603 if (platform->driver->ops->close)
604 platform->driver->ops->close(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200605
606platform_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000607 if (cpu_dai->driver->ops->shutdown)
608 cpu_dai->driver->ops->shutdown(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200609out:
610 mutex_unlock(&pcm_mutex);
611 return ret;
612}
613
614/*
Robert P. J. Day3a4fa0a2007-10-19 23:10:43 +0200615 * Power down the audio subsystem pmdown_time msecs after close is called.
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200616 * This is to ensure there are no pops or clicks in between any music tracks
617 * due to DAPM power cycling.
618 */
Andrew Morton4484bb22006-12-15 09:30:07 +0100619static void close_delayed_work(struct work_struct *work)
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200620{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000621 struct snd_soc_pcm_runtime *rtd =
622 container_of(work, struct snd_soc_pcm_runtime, delayed_work.work);
623 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200624
625 mutex_lock(&pcm_mutex);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200626
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000627 pr_debug("pop wq checking: %s status: %s waiting: %s\n",
628 codec_dai->driver->playback.stream_name,
629 codec_dai->playback_active ? "active" : "inactive",
630 codec_dai->pop_wait ? "yes" : "no");
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200631
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000632 /* are we waiting on this codec DAI stream */
633 if (codec_dai->pop_wait == 1) {
634 codec_dai->pop_wait = 0;
635 snd_soc_dapm_stream_event(rtd,
636 codec_dai->driver->playback.stream_name,
637 SND_SOC_DAPM_STREAM_STOP);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200638 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000639
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200640 mutex_unlock(&pcm_mutex);
641}
642
643/*
644 * Called by ALSA when a PCM substream is closed. Private data can be
645 * freed here. The cpu DAI, codec DAI, machine and platform are also
646 * shutdown.
647 */
648static int soc_codec_close(struct snd_pcm_substream *substream)
649{
650 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000651 struct snd_soc_platform *platform = rtd->platform;
652 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
653 struct snd_soc_dai *codec_dai = rtd->codec_dai;
654 struct snd_soc_codec *codec = rtd->codec;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200655
656 mutex_lock(&pcm_mutex);
657
Jassi Brar14dc5732010-02-26 09:12:32 +0900658 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000659 cpu_dai->playback_active--;
660 codec_dai->playback_active--;
Jassi Brar14dc5732010-02-26 09:12:32 +0900661 } else {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000662 cpu_dai->capture_active--;
663 codec_dai->capture_active--;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200664 }
Jassi Brar14dc5732010-02-26 09:12:32 +0900665
666 cpu_dai->active--;
667 codec_dai->active--;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200668 codec->active--;
669
Mark Brown6010b2d2008-09-06 18:33:24 +0100670 /* Muting the DAC suppresses artifacts caused during digital
671 * shutdown, for example from stopping clocks.
672 */
673 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
674 snd_soc_dai_digital_mute(codec_dai, 1);
675
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000676 if (cpu_dai->driver->ops->shutdown)
677 cpu_dai->driver->ops->shutdown(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200678
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000679 if (codec_dai->driver->ops->shutdown)
680 codec_dai->driver->ops->shutdown(substream, codec_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200681
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000682 if (rtd->dai_link->ops && rtd->dai_link->ops->shutdown)
683 rtd->dai_link->ops->shutdown(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200684
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000685 if (platform->driver->ops->close)
686 platform->driver->ops->close(substream);
687 cpu_dai->runtime = NULL;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200688
689 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
690 /* start delayed pop wq here for playback streams */
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100691 codec_dai->pop_wait = 1;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000692 schedule_delayed_work(&rtd->delayed_work,
693 msecs_to_jiffies(rtd->pmdown_time));
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200694 } else {
695 /* capture streams can be powered down now */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000696 snd_soc_dapm_stream_event(rtd,
697 codec_dai->driver->capture.stream_name,
Liam Girdwood0b4d2212008-01-10 14:36:20 +0100698 SND_SOC_DAPM_STREAM_STOP);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200699 }
700
701 mutex_unlock(&pcm_mutex);
702 return 0;
703}
704
705/*
706 * Called by ALSA when the PCM substream is prepared, can set format, sample
707 * rate, etc. This function is non atomic and can be called multiple times,
708 * it can refer to the runtime info.
709 */
710static int soc_pcm_prepare(struct snd_pcm_substream *substream)
711{
712 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000713 struct snd_soc_platform *platform = rtd->platform;
714 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
715 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200716 int ret = 0;
717
718 mutex_lock(&pcm_mutex);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100719
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000720 if (rtd->dai_link->ops && rtd->dai_link->ops->prepare) {
721 ret = rtd->dai_link->ops->prepare(substream);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100722 if (ret < 0) {
723 printk(KERN_ERR "asoc: machine prepare error\n");
724 goto out;
725 }
726 }
727
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000728 if (platform->driver->ops->prepare) {
729 ret = platform->driver->ops->prepare(substream);
Liam Girdwooda71a4682006-10-19 20:35:56 +0200730 if (ret < 0) {
731 printk(KERN_ERR "asoc: platform prepare error\n");
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200732 goto out;
Liam Girdwooda71a4682006-10-19 20:35:56 +0200733 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200734 }
735
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000736 if (codec_dai->driver->ops->prepare) {
737 ret = codec_dai->driver->ops->prepare(substream, codec_dai);
Liam Girdwooda71a4682006-10-19 20:35:56 +0200738 if (ret < 0) {
739 printk(KERN_ERR "asoc: codec DAI prepare error\n");
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200740 goto out;
Liam Girdwooda71a4682006-10-19 20:35:56 +0200741 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200742 }
743
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000744 if (cpu_dai->driver->ops->prepare) {
745 ret = cpu_dai->driver->ops->prepare(substream, cpu_dai);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100746 if (ret < 0) {
747 printk(KERN_ERR "asoc: cpu DAI prepare error\n");
748 goto out;
749 }
750 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200751
Mark Brownd45f6212008-10-14 13:58:36 +0100752 /* cancel any delayed stream shutdown that is pending */
753 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK &&
754 codec_dai->pop_wait) {
755 codec_dai->pop_wait = 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000756 cancel_delayed_work(&rtd->delayed_work);
Mark Brownd45f6212008-10-14 13:58:36 +0100757 }
758
Mark Brown452c5ea2009-05-17 21:41:23 +0100759 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000760 snd_soc_dapm_stream_event(rtd,
761 codec_dai->driver->playback.stream_name,
Mark Brown452c5ea2009-05-17 21:41:23 +0100762 SND_SOC_DAPM_STREAM_START);
763 else
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000764 snd_soc_dapm_stream_event(rtd,
765 codec_dai->driver->capture.stream_name,
Mark Brown452c5ea2009-05-17 21:41:23 +0100766 SND_SOC_DAPM_STREAM_START);
Mark Brownd45f6212008-10-14 13:58:36 +0100767
Mark Brown452c5ea2009-05-17 21:41:23 +0100768 snd_soc_dai_digital_mute(codec_dai, 0);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200769
770out:
771 mutex_unlock(&pcm_mutex);
772 return ret;
773}
774
775/*
776 * Called by ALSA when the hardware params are set by application. This
777 * function can also be called multiple times and can allocate buffers
778 * (using snd_pcm_lib_* ). It's non-atomic.
779 */
780static int soc_pcm_hw_params(struct snd_pcm_substream *substream,
781 struct snd_pcm_hw_params *params)
782{
783 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000784 struct snd_soc_platform *platform = rtd->platform;
785 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
786 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200787 int ret = 0;
788
789 mutex_lock(&pcm_mutex);
790
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000791 if (rtd->dai_link->ops && rtd->dai_link->ops->hw_params) {
792 ret = rtd->dai_link->ops->hw_params(substream, params);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200793 if (ret < 0) {
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100794 printk(KERN_ERR "asoc: machine hw_params failed\n");
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200795 goto out;
796 }
797 }
798
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000799 if (codec_dai->driver->ops->hw_params) {
800 ret = codec_dai->driver->ops->hw_params(substream, params, codec_dai);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100801 if (ret < 0) {
802 printk(KERN_ERR "asoc: can't set codec %s hw params\n",
803 codec_dai->name);
804 goto codec_err;
805 }
806 }
807
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000808 if (cpu_dai->driver->ops->hw_params) {
809 ret = cpu_dai->driver->ops->hw_params(substream, params, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200810 if (ret < 0) {
Mark Brown3ff3f642008-05-19 12:32:25 +0200811 printk(KERN_ERR "asoc: interface %s hw params failed\n",
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100812 cpu_dai->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200813 goto interface_err;
814 }
815 }
816
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000817 if (platform->driver->ops->hw_params) {
818 ret = platform->driver->ops->hw_params(substream, params);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200819 if (ret < 0) {
Mark Brown3ff3f642008-05-19 12:32:25 +0200820 printk(KERN_ERR "asoc: platform %s hw params failed\n",
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200821 platform->name);
822 goto platform_err;
823 }
824 }
825
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000826 rtd->rate = params_rate(params);
Mark Brown06f409d2009-04-07 18:10:13 +0100827
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200828out:
829 mutex_unlock(&pcm_mutex);
830 return ret;
831
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200832platform_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000833 if (cpu_dai->driver->ops->hw_free)
834 cpu_dai->driver->ops->hw_free(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200835
836interface_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000837 if (codec_dai->driver->ops->hw_free)
838 codec_dai->driver->ops->hw_free(substream, codec_dai);
Liam Girdwoodcb666e52007-02-02 17:13:49 +0100839
840codec_err:
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000841 if (rtd->dai_link->ops && rtd->dai_link->ops->hw_free)
842 rtd->dai_link->ops->hw_free(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200843
844 mutex_unlock(&pcm_mutex);
845 return ret;
846}
847
848/*
849 * Free's resources allocated by hw_params, can be called multiple times
850 */
851static int soc_pcm_hw_free(struct snd_pcm_substream *substream)
852{
853 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000854 struct snd_soc_platform *platform = rtd->platform;
855 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
856 struct snd_soc_dai *codec_dai = rtd->codec_dai;
857 struct snd_soc_codec *codec = rtd->codec;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200858
859 mutex_lock(&pcm_mutex);
860
861 /* apply codec digital mute */
Liam Girdwood8c6529d2008-07-08 13:19:13 +0100862 if (!codec->active)
863 snd_soc_dai_digital_mute(codec_dai, 1);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200864
865 /* free any machine hw params */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000866 if (rtd->dai_link->ops && rtd->dai_link->ops->hw_free)
867 rtd->dai_link->ops->hw_free(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200868
869 /* free any DMA resources */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000870 if (platform->driver->ops->hw_free)
871 platform->driver->ops->hw_free(substream);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200872
873 /* now free hw params for the DAI's */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000874 if (codec_dai->driver->ops->hw_free)
875 codec_dai->driver->ops->hw_free(substream, codec_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200876
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000877 if (cpu_dai->driver->ops->hw_free)
878 cpu_dai->driver->ops->hw_free(substream, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200879
880 mutex_unlock(&pcm_mutex);
881 return 0;
882}
883
884static int soc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
885{
886 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000887 struct snd_soc_platform *platform = rtd->platform;
888 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
889 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200890 int ret;
891
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000892 if (codec_dai->driver->ops->trigger) {
893 ret = codec_dai->driver->ops->trigger(substream, cmd, codec_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200894 if (ret < 0)
895 return ret;
896 }
897
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000898 if (platform->driver->ops->trigger) {
899 ret = platform->driver->ops->trigger(substream, cmd);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200900 if (ret < 0)
901 return ret;
902 }
903
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000904 if (cpu_dai->driver->ops->trigger) {
905 ret = cpu_dai->driver->ops->trigger(substream, cmd, cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200906 if (ret < 0)
907 return ret;
908 }
909 return 0;
910}
911
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200912/*
913 * soc level wrapper for pointer callback
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200914 * If cpu_dai, codec_dai, platform driver has the delay callback, than
915 * the runtime->delay will be updated accordingly.
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200916 */
917static snd_pcm_uframes_t soc_pcm_pointer(struct snd_pcm_substream *substream)
918{
919 struct snd_soc_pcm_runtime *rtd = substream->private_data;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000920 struct snd_soc_platform *platform = rtd->platform;
921 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
922 struct snd_soc_dai *codec_dai = rtd->codec_dai;
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200923 struct snd_pcm_runtime *runtime = substream->runtime;
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200924 snd_pcm_uframes_t offset = 0;
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200925 snd_pcm_sframes_t delay = 0;
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200926
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000927 if (platform->driver->ops->pointer)
928 offset = platform->driver->ops->pointer(substream);
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200929
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000930 if (cpu_dai->driver->ops->delay)
931 delay += cpu_dai->driver->ops->delay(substream, cpu_dai);
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200932
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000933 if (codec_dai->driver->ops->delay)
934 delay += codec_dai->driver->ops->delay(substream, codec_dai);
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200935
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000936 if (platform->driver->delay)
937 delay += platform->driver->delay(substream, codec_dai);
Peter Ujfalusi258020d2010-03-03 15:08:07 +0200938
939 runtime->delay = delay;
940
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200941 return offset;
942}
943
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200944/* ASoC PCM operations */
945static struct snd_pcm_ops soc_pcm_ops = {
946 .open = soc_pcm_open,
947 .close = soc_codec_close,
948 .hw_params = soc_pcm_hw_params,
949 .hw_free = soc_pcm_hw_free,
950 .prepare = soc_pcm_prepare,
951 .trigger = soc_pcm_trigger,
Peter Ujfalusi377b6f62010-03-03 15:08:06 +0200952 .pointer = soc_pcm_pointer,
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200953};
954
955#ifdef CONFIG_PM
956/* powers down audio subsystem for suspend */
Mark Brown416356f2009-06-30 19:05:15 +0100957static int soc_suspend(struct device *dev)
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200958{
Mark Brown416356f2009-06-30 19:05:15 +0100959 struct platform_device *pdev = to_platform_device(dev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000960 struct snd_soc_card *card = platform_get_drvdata(pdev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200961 int i;
962
Daniel Macke3509ff2009-06-03 17:44:49 +0200963 /* If the initialization of this soc device failed, there is no codec
964 * associated with it. Just bail out in this case.
965 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000966 if (list_empty(&card->codec_dev_list))
Daniel Macke3509ff2009-06-03 17:44:49 +0200967 return 0;
968
Andy Green6ed25972008-06-13 16:24:05 +0100969 /* Due to the resume being scheduled into a workqueue we could
970 * suspend before that's finished - wait for it to complete.
971 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000972 snd_power_lock(card->snd_card);
973 snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0);
974 snd_power_unlock(card->snd_card);
Andy Green6ed25972008-06-13 16:24:05 +0100975
976 /* we're going to block userspace touching us until resume completes */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000977 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
Andy Green6ed25972008-06-13 16:24:05 +0100978
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200979 /* mute any active DAC's */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000980 for (i = 0; i < card->num_rtd; i++) {
981 struct snd_soc_dai *dai = card->rtd[i].codec_dai;
982 struct snd_soc_dai_driver *drv = dai->driver;
Mark Brown3efab7d2010-05-09 13:25:43 +0100983
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000984 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +0100985 continue;
986
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000987 if (drv->ops->digital_mute && dai->playback_active)
988 drv->ops->digital_mute(dai, 1);
Frank Mandarinodb2a4162006-10-06 18:31:09 +0200989 }
990
Liam Girdwood4ccab3e2008-01-10 14:39:01 +0100991 /* suspend all pcms */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000992 for (i = 0; i < card->num_rtd; i++) {
993 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +0100994 continue;
995
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +0000996 snd_pcm_suspend_all(card->rtd[i].pcm);
Mark Brown3efab7d2010-05-09 13:25:43 +0100997 }
Liam Girdwood4ccab3e2008-01-10 14:39:01 +0100998
Mark Brown87506542008-11-18 20:50:34 +0000999 if (card->suspend_pre)
Mark Brown416356f2009-06-30 19:05:15 +01001000 card->suspend_pre(pdev, PMSG_SUSPEND);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001001
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001002 for (i = 0; i < card->num_rtd; i++) {
1003 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1004 struct snd_soc_platform *platform = card->rtd[i].platform;
Mark Brown3efab7d2010-05-09 13:25:43 +01001005
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001006 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001007 continue;
1008
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001009 if (cpu_dai->driver->suspend && !cpu_dai->driver->ac97_control)
1010 cpu_dai->driver->suspend(cpu_dai);
1011 if (platform->driver->suspend && !platform->suspended) {
1012 platform->driver->suspend(cpu_dai);
1013 platform->suspended = 1;
Mark Brown1547aba2010-05-07 21:11:40 +01001014 }
1015 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001016
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001017 /* close any waiting streams and save state */
1018 for (i = 0; i < card->num_rtd; i++) {
1019 run_delayed_work(&card->rtd[i].delayed_work);
1020 card->rtd[i].codec->suspend_bias_level = card->rtd[i].codec->bias_level;
1021 }
Mark Brown3efab7d2010-05-09 13:25:43 +01001022
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001023 for (i = 0; i < card->num_rtd; i++) {
1024 struct snd_soc_dai_driver *driver = card->rtd[i].codec_dai->driver;
1025
1026 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001027 continue;
1028
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001029 if (driver->playback.stream_name != NULL)
1030 snd_soc_dapm_stream_event(&card->rtd[i], driver->playback.stream_name,
1031 SND_SOC_DAPM_STREAM_SUSPEND);
1032
1033 if (driver->capture.stream_name != NULL)
1034 snd_soc_dapm_stream_event(&card->rtd[i], driver->capture.stream_name,
1035 SND_SOC_DAPM_STREAM_SUSPEND);
1036 }
1037
1038 /* suspend all CODECs */
1039 for (i = 0; i < card->num_rtd; i++) {
1040 struct snd_soc_codec *codec = card->rtd[i].codec;
1041 /* If there are paths active then the CODEC will be held with
1042 * bias _ON and should not be suspended. */
1043 if (!codec->suspended && codec->driver->suspend) {
1044 switch (codec->bias_level) {
1045 case SND_SOC_BIAS_STANDBY:
1046 case SND_SOC_BIAS_OFF:
1047 codec->driver->suspend(codec, PMSG_SUSPEND);
1048 codec->suspended = 1;
1049 break;
1050 default:
1051 dev_dbg(codec->dev, "CODEC is on over suspend\n");
1052 break;
1053 }
1054 }
1055 }
1056
1057 for (i = 0; i < card->num_rtd; i++) {
1058 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1059
1060 if (card->rtd[i].dai_link->ignore_suspend)
1061 continue;
1062
1063 if (cpu_dai->driver->suspend && cpu_dai->driver->ac97_control)
1064 cpu_dai->driver->suspend(cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001065 }
1066
Mark Brown87506542008-11-18 20:50:34 +00001067 if (card->suspend_post)
Mark Brown416356f2009-06-30 19:05:15 +01001068 card->suspend_post(pdev, PMSG_SUSPEND);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001069
1070 return 0;
1071}
1072
Andy Green6ed25972008-06-13 16:24:05 +01001073/* deferred resume work, so resume can complete before we finished
1074 * setting our codec back up, which can be very slow on I2C
1075 */
1076static void soc_resume_deferred(struct work_struct *work)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001077{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001078 struct snd_soc_card *card =
1079 container_of(work, struct snd_soc_card, deferred_resume_work);
1080 struct platform_device *pdev = to_platform_device(card->dev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001081 int i;
1082
Andy Green6ed25972008-06-13 16:24:05 +01001083 /* our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
1084 * so userspace apps are blocked from touching us
1085 */
1086
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001087 dev_dbg(card->dev, "starting resume work\n");
Andy Green6ed25972008-06-13 16:24:05 +01001088
Mark Brown99497882010-05-07 20:24:05 +01001089 /* Bring us up into D2 so that DAPM starts enabling things */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001090 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
Mark Brown99497882010-05-07 20:24:05 +01001091
Mark Brown87506542008-11-18 20:50:34 +00001092 if (card->resume_pre)
1093 card->resume_pre(pdev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001094
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001095 /* resume AC97 DAIs */
1096 for (i = 0; i < card->num_rtd; i++) {
1097 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
Mark Brown3efab7d2010-05-09 13:25:43 +01001098
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001099 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001100 continue;
1101
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001102 if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control)
1103 cpu_dai->driver->resume(cpu_dai);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001104 }
1105
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001106 for (i = 0; i < card->num_rtd; i++) {
1107 struct snd_soc_codec *codec = card->rtd[i].codec;
1108 /* If the CODEC was idle over suspend then it will have been
1109 * left with bias OFF or STANDBY and suspended so we must now
1110 * resume. Otherwise the suspend was suppressed.
1111 */
1112 if (codec->driver->resume && codec->suspended) {
1113 switch (codec->bias_level) {
1114 case SND_SOC_BIAS_STANDBY:
1115 case SND_SOC_BIAS_OFF:
1116 codec->driver->resume(codec);
1117 codec->suspended = 0;
1118 break;
1119 default:
1120 dev_dbg(codec->dev, "CODEC was on over suspend\n");
1121 break;
1122 }
Mark Brown1547aba2010-05-07 21:11:40 +01001123 }
1124 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001125
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001126 for (i = 0; i < card->num_rtd; i++) {
1127 struct snd_soc_dai_driver *driver = card->rtd[i].codec_dai->driver;
Mark Brown3efab7d2010-05-09 13:25:43 +01001128
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001129 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001130 continue;
1131
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001132 if (driver->playback.stream_name != NULL)
1133 snd_soc_dapm_stream_event(&card->rtd[i], driver->playback.stream_name,
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001134 SND_SOC_DAPM_STREAM_RESUME);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001135
1136 if (driver->capture.stream_name != NULL)
1137 snd_soc_dapm_stream_event(&card->rtd[i], driver->capture.stream_name,
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001138 SND_SOC_DAPM_STREAM_RESUME);
1139 }
1140
Mark Brown3ff3f642008-05-19 12:32:25 +02001141 /* unmute any active DACs */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001142 for (i = 0; i < card->num_rtd; i++) {
1143 struct snd_soc_dai *dai = card->rtd[i].codec_dai;
1144 struct snd_soc_dai_driver *drv = dai->driver;
Mark Brown3efab7d2010-05-09 13:25:43 +01001145
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001146 if (card->rtd[i].dai_link->ignore_suspend)
Mark Brown3efab7d2010-05-09 13:25:43 +01001147 continue;
1148
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001149 if (drv->ops->digital_mute && dai->playback_active)
1150 drv->ops->digital_mute(dai, 0);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001151 }
1152
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001153 for (i = 0; i < card->num_rtd; i++) {
1154 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1155 struct snd_soc_platform *platform = card->rtd[i].platform;
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 (cpu_dai->driver->resume && !cpu_dai->driver->ac97_control)
1161 cpu_dai->driver->resume(cpu_dai);
1162 if (platform->driver->resume && platform->suspended) {
1163 platform->driver->resume(cpu_dai);
1164 platform->suspended = 0;
1165 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001166 }
1167
Mark Brown87506542008-11-18 20:50:34 +00001168 if (card->resume_post)
1169 card->resume_post(pdev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001170
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001171 dev_dbg(card->dev, "resume work completed\n");
Andy Green6ed25972008-06-13 16:24:05 +01001172
1173 /* userspace can access us now we are back as we were before */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001174 snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
Andy Green6ed25972008-06-13 16:24:05 +01001175}
1176
1177/* powers up audio subsystem after a suspend */
Mark Brown416356f2009-06-30 19:05:15 +01001178static int soc_resume(struct device *dev)
Andy Green6ed25972008-06-13 16:24:05 +01001179{
Mark Brown416356f2009-06-30 19:05:15 +01001180 struct platform_device *pdev = to_platform_device(dev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001181 struct snd_soc_card *card = platform_get_drvdata(pdev);
1182 int i;
Peter Ujfalusib9dd94a2010-02-22 13:27:13 +02001183
Mark Brown64ab9ba2009-03-31 11:27:03 +01001184 /* AC97 devices might have other drivers hanging off them so
1185 * need to resume immediately. Other drivers don't have that
1186 * problem and may take a substantial amount of time to resume
1187 * due to I/O costs and anti-pop so handle them out of line.
1188 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001189 for (i = 0; i < card->num_rtd; i++) {
1190 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1191 if (cpu_dai->driver->ac97_control) {
1192 dev_dbg(dev, "Resuming AC97 immediately\n");
1193 soc_resume_deferred(&card->deferred_resume_work);
1194 } else {
1195 dev_dbg(dev, "Scheduling resume work\n");
1196 if (!schedule_work(&card->deferred_resume_work))
1197 dev_err(dev, "resume work item may be lost\n");
1198 }
Mark Brown64ab9ba2009-03-31 11:27:03 +01001199 }
Andy Green6ed25972008-06-13 16:24:05 +01001200
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001201 return 0;
1202}
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001203#else
1204#define soc_suspend NULL
1205#define soc_resume NULL
1206#endif
1207
Barry Song02a06d32009-10-16 18:13:38 +08001208static struct snd_soc_dai_ops null_dai_ops = {
1209};
1210
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001211static int soc_bind_dai_link(struct snd_soc_card *card, int num)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001212{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001213 struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1214 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
Mark Brownfe3e78e2009-11-03 22:13:13 +00001215 struct snd_soc_codec *codec;
Mark Brown435c5e22008-12-04 15:32:53 +00001216 struct snd_soc_platform *platform;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001217 struct snd_soc_dai *codec_dai, *cpu_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001218
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001219 if (rtd->complete)
1220 return 1;
1221 dev_dbg(card->dev, "binding %s at idx %d\n", dai_link->name, num);
Mark Brown63084192008-12-02 15:08:03 +00001222
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001223 /* do we already have the CPU DAI for this link ? */
1224 if (rtd->cpu_dai) {
1225 goto find_codec;
1226 }
1227 /* no, then find CPU DAI from registered DAIs*/
1228 list_for_each_entry(cpu_dai, &dai_list, list) {
1229 if (!strcmp(cpu_dai->name, dai_link->cpu_dai_name)) {
1230
1231 if (!try_module_get(cpu_dai->dev->driver->owner))
1232 return -ENODEV;
1233
1234 rtd->cpu_dai = cpu_dai;
1235 goto find_codec;
Mark Brown435c5e22008-12-04 15:32:53 +00001236 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001237 }
1238 dev_dbg(card->dev, "CPU DAI %s not registered\n",
1239 dai_link->cpu_dai_name);
1240
1241find_codec:
1242 /* do we already have the CODEC for this link ? */
1243 if (rtd->codec) {
1244 goto find_platform;
Mark Brownc5af3a22008-11-28 13:29:45 +00001245 }
1246
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001247 /* no, then find CODEC from registered CODECs*/
1248 list_for_each_entry(codec, &codec_list, list) {
1249 if (!strcmp(codec->name, dai_link->codec_name)) {
1250 rtd->codec = codec;
Mark Brown6b05eda2008-12-08 19:26:48 +00001251
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001252 if (!try_module_get(codec->dev->driver->owner))
1253 return -ENODEV;
Mark Brown435c5e22008-12-04 15:32:53 +00001254
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001255 /* CODEC found, so find CODEC DAI from registered DAIs from this CODEC*/
1256 list_for_each_entry(codec_dai, &dai_list, list) {
1257 if (codec->dev == codec_dai->dev &&
1258 !strcmp(codec_dai->name, dai_link->codec_dai_name)) {
1259 rtd->codec_dai = codec_dai;
1260 goto find_platform;
Mark Brown6b05eda2008-12-08 19:26:48 +00001261 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001262 }
1263 dev_dbg(card->dev, "CODEC DAI %s not registered\n",
1264 dai_link->codec_dai_name);
1265
1266 goto find_platform;
1267 }
1268 }
1269 dev_dbg(card->dev, "CODEC %s not registered\n",
1270 dai_link->codec_name);
1271
1272find_platform:
1273 /* do we already have the CODEC DAI for this link ? */
1274 if (rtd->platform) {
1275 goto out;
1276 }
1277 /* no, then find CPU DAI from registered DAIs*/
1278 list_for_each_entry(platform, &platform_list, list) {
1279 if (!strcmp(platform->name, dai_link->platform_name)) {
1280
1281 if (!try_module_get(platform->dev->driver->owner))
1282 return -ENODEV;
1283
1284 rtd->platform = platform;
1285 goto out;
1286 }
1287 }
1288
1289 dev_dbg(card->dev, "platform %s not registered\n",
1290 dai_link->platform_name);
1291 return 0;
1292
1293out:
1294 /* mark rtd as complete if we found all 4 of our client devices */
1295 if (rtd->codec && rtd->codec_dai && rtd->platform && rtd->cpu_dai) {
1296 rtd->complete = 1;
1297 card->num_rtd++;
1298 }
1299 return 1;
1300}
1301
1302static void soc_remove_dai_link(struct snd_soc_card *card, int num)
1303{
1304 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1305 struct snd_soc_codec *codec = rtd->codec;
1306 struct snd_soc_platform *platform = rtd->platform;
1307 struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
1308 int err;
1309
1310 /* unregister the rtd device */
1311 if (rtd->dev_registered) {
1312 device_remove_file(&rtd->dev, &dev_attr_pmdown_time);
1313 device_unregister(&rtd->dev);
1314 rtd->dev_registered = 0;
1315 }
1316
1317 /* remove the CODEC DAI */
1318 if (codec_dai && codec_dai->probed) {
1319 if (codec_dai->driver->remove) {
1320 err = codec_dai->driver->remove(codec_dai);
1321 if (err < 0)
1322 printk(KERN_ERR "asoc: failed to remove %s\n", codec_dai->name);
1323 }
1324 codec_dai->probed = 0;
1325 list_del(&codec_dai->card_list);
1326 }
1327
1328 /* remove the platform */
1329 if (platform && platform->probed) {
1330 if (platform->driver->remove) {
1331 err = platform->driver->remove(platform);
1332 if (err < 0)
1333 printk(KERN_ERR "asoc: failed to remove %s\n", platform->name);
1334 }
1335 platform->probed = 0;
1336 list_del(&platform->card_list);
1337 module_put(platform->dev->driver->owner);
1338 }
1339
1340 /* remove the CODEC */
1341 if (codec && codec->probed) {
1342 if (codec->driver->remove) {
1343 err = codec->driver->remove(codec);
1344 if (err < 0)
1345 printk(KERN_ERR "asoc: failed to remove %s\n", codec->name);
1346 }
1347
1348 /* Make sure all DAPM widgets are freed */
1349 snd_soc_dapm_free(codec);
1350
1351 soc_cleanup_codec_debugfs(codec);
1352 device_remove_file(&rtd->dev, &dev_attr_codec_reg);
1353 codec->probed = 0;
1354 list_del(&codec->card_list);
1355 module_put(codec->dev->driver->owner);
1356 }
1357
1358 /* remove the cpu_dai */
1359 if (cpu_dai && cpu_dai->probed) {
1360 if (cpu_dai->driver->remove) {
1361 err = cpu_dai->driver->remove(cpu_dai);
1362 if (err < 0)
1363 printk(KERN_ERR "asoc: failed to remove %s\n", cpu_dai->name);
1364 }
1365 cpu_dai->probed = 0;
1366 list_del(&cpu_dai->card_list);
1367 module_put(cpu_dai->dev->driver->owner);
1368 }
1369}
1370
1371static void rtd_release(struct device *dev) {}
1372
1373static int soc_probe_dai_link(struct snd_soc_card *card, int num)
1374{
1375 struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1376 struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1377 struct snd_soc_codec *codec = rtd->codec;
1378 struct snd_soc_platform *platform = rtd->platform;
1379 struct snd_soc_dai *codec_dai = rtd->codec_dai, *cpu_dai = rtd->cpu_dai;
1380 int ret;
1381
1382 dev_dbg(card->dev, "probe %s dai link %d\n", card->name, num);
1383
1384 /* config components */
1385 codec_dai->codec = codec;
1386 codec->card = card;
1387 cpu_dai->platform = platform;
1388 rtd->card = card;
1389 rtd->dev.parent = card->dev;
1390 codec_dai->card = card;
1391 cpu_dai->card = card;
1392
1393 /* set default power off timeout */
1394 rtd->pmdown_time = pmdown_time;
1395
1396 /* probe the cpu_dai */
1397 if (!cpu_dai->probed) {
1398 if (cpu_dai->driver->probe) {
1399 ret = cpu_dai->driver->probe(cpu_dai);
1400 if (ret < 0) {
1401 printk(KERN_ERR "asoc: failed to probe CPU DAI %s\n",
1402 cpu_dai->name);
1403 return ret;
1404 }
1405 }
1406 cpu_dai->probed = 1;
1407 /* mark cpu_dai as probed and add to card cpu_dai list */
1408 list_add(&cpu_dai->card_list, &card->dai_dev_list);
1409 }
1410
1411 /* probe the CODEC */
1412 if (!codec->probed) {
1413 if (codec->driver->probe) {
1414 ret = codec->driver->probe(codec);
1415 if (ret < 0) {
1416 printk(KERN_ERR "asoc: failed to probe CODEC %s\n",
1417 codec->name);
1418 return ret;
1419 }
1420 }
Mark Brown13cb61f2010-08-12 15:44:04 +01001421
1422 soc_init_codec_debugfs(codec);
1423
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001424 /* mark codec as probed and add to card codec list */
1425 codec->probed = 1;
1426 list_add(&codec->card_list, &card->codec_dev_list);
1427 }
1428
1429 /* probe the platform */
1430 if (!platform->probed) {
1431 if (platform->driver->probe) {
1432 ret = platform->driver->probe(platform);
1433 if (ret < 0) {
1434 printk(KERN_ERR "asoc: failed to probe platform %s\n",
1435 platform->name);
1436 return ret;
1437 }
1438 }
1439 /* mark platform as probed and add to card platform list */
1440 platform->probed = 1;
1441 list_add(&platform->card_list, &card->platform_dev_list);
1442 }
1443
1444 /* probe the CODEC DAI */
1445 if (!codec_dai->probed) {
1446 if (codec_dai->driver->probe) {
1447 ret = codec_dai->driver->probe(codec_dai);
1448 if (ret < 0) {
1449 printk(KERN_ERR "asoc: failed to probe CODEC DAI %s\n",
1450 codec_dai->name);
1451 return ret;
Mark Brown6b05eda2008-12-08 19:26:48 +00001452 }
1453 }
1454
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001455 /* mark cpu_dai as probed and add to card cpu_dai list */
1456 codec_dai->probed = 1;
1457 list_add(&codec_dai->card_list, &card->dai_dev_list);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001458 }
1459
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001460 /* DAPM dai link stream work */
1461 INIT_DELAYED_WORK(&rtd->delayed_work, close_delayed_work);
1462
1463 /* now that all clients have probed, initialise the DAI link */
1464 if (dai_link->init) {
1465 ret = dai_link->init(rtd);
1466 if (ret < 0) {
1467 printk(KERN_ERR "asoc: failed to init %s\n", dai_link->stream_name);
1468 return ret;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001469 }
1470 }
1471
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001472 /* Make sure all DAPM widgets are instantiated */
1473 snd_soc_dapm_new_widgets(codec);
1474 snd_soc_dapm_sync(codec);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001475
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001476 /* register the rtd device */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001477 rtd->dev.release = rtd_release;
1478 rtd->dev.init_name = dai_link->name;
1479 ret = device_register(&rtd->dev);
1480 if (ret < 0) {
1481 printk(KERN_ERR "asoc: failed to register DAI runtime device %d\n", ret);
1482 return ret;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001483 }
1484
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001485 rtd->dev_registered = 1;
1486 ret = device_create_file(&rtd->dev, &dev_attr_pmdown_time);
1487 if (ret < 0)
1488 printk(KERN_WARNING "asoc: failed to add pmdown_time sysfs\n");
1489
1490 /* add DAPM sysfs entries for this codec */
1491 ret = snd_soc_dapm_sys_add(&rtd->dev);
1492 if (ret < 0)
1493 printk(KERN_WARNING "asoc: failed to add codec dapm sysfs entries\n");
1494
1495 /* add codec sysfs entries */
1496 ret = device_create_file(&rtd->dev, &dev_attr_codec_reg);
1497 if (ret < 0)
1498 printk(KERN_WARNING "asoc: failed to add codec sysfs files\n");
1499
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001500 /* create the pcm */
1501 ret = soc_new_pcm(rtd, num);
1502 if (ret < 0) {
1503 printk(KERN_ERR "asoc: can't create pcm %s\n", dai_link->stream_name);
1504 return ret;
1505 }
1506
1507 /* add platform data for AC97 devices */
1508 if (rtd->codec_dai->driver->ac97_control)
1509 snd_ac97_dev_add_pdata(codec->ac97, rtd->cpu_dai->ac97_pdata);
1510
1511 return 0;
1512}
1513
1514#ifdef CONFIG_SND_SOC_AC97_BUS
1515static int soc_register_ac97_dai_link(struct snd_soc_pcm_runtime *rtd)
1516{
1517 int ret;
1518
1519 /* Only instantiate AC97 if not already done by the adaptor
1520 * for the generic AC97 subsystem.
1521 */
1522 if (rtd->codec_dai->driver->ac97_control && !rtd->codec->ac97_registered) {
Mika Westerberg0562f782010-10-13 11:30:32 +03001523 /*
1524 * It is possible that the AC97 device is already registered to
1525 * the device subsystem. This happens when the device is created
1526 * via snd_ac97_mixer(). Currently only SoC codec that does so
1527 * is the generic AC97 glue but others migh emerge.
1528 *
1529 * In those cases we don't try to register the device again.
1530 */
1531 if (!rtd->codec->ac97_created)
1532 return 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001533
1534 ret = soc_ac97_dev_register(rtd->codec);
1535 if (ret < 0) {
1536 printk(KERN_ERR "asoc: AC97 device register failed\n");
1537 return ret;
1538 }
1539
1540 rtd->codec->ac97_registered = 1;
1541 }
1542 return 0;
1543}
1544
1545static void soc_unregister_ac97_dai_link(struct snd_soc_codec *codec)
1546{
1547 if (codec->ac97_registered) {
1548 soc_ac97_dev_unregister(codec);
1549 codec->ac97_registered = 0;
1550 }
1551}
1552#endif
1553
1554static void snd_soc_instantiate_card(struct snd_soc_card *card)
1555{
1556 struct platform_device *pdev = to_platform_device(card->dev);
1557 int ret, i;
1558
1559 mutex_lock(&card->mutex);
1560
1561 if (card->instantiated) {
1562 mutex_unlock(&card->mutex);
1563 return;
1564 }
1565
1566 /* bind DAIs */
1567 for (i = 0; i < card->num_links; i++)
1568 soc_bind_dai_link(card, i);
1569
1570 /* bind completed ? */
1571 if (card->num_rtd != card->num_links) {
1572 mutex_unlock(&card->mutex);
1573 return;
1574 }
1575
1576 /* card bind complete so register a sound card */
1577 ret = snd_card_create(SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
1578 card->owner, 0, &card->snd_card);
1579 if (ret < 0) {
1580 printk(KERN_ERR "asoc: can't create sound card for card %s\n",
1581 card->name);
1582 mutex_unlock(&card->mutex);
1583 return;
1584 }
1585 card->snd_card->dev = card->dev;
1586
Randy Dunlap1301a962008-06-17 19:19:34 +01001587#ifdef CONFIG_PM
Andy Green6ed25972008-06-13 16:24:05 +01001588 /* deferred resume work */
Mark Brown63084192008-12-02 15:08:03 +00001589 INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
Randy Dunlap1301a962008-06-17 19:19:34 +01001590#endif
Andy Green6ed25972008-06-13 16:24:05 +01001591
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001592 /* initialise the sound card only once */
1593 if (card->probe) {
1594 ret = card->probe(pdev);
1595 if (ret < 0)
1596 goto card_probe_error;
1597 }
1598
Mark Brownfe3e78e2009-11-03 22:13:13 +00001599 for (i = 0; i < card->num_links; i++) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001600 ret = soc_probe_dai_link(card, i);
1601 if (ret < 0) {
Mark Brown321de0d2010-09-21 15:09:37 +01001602 pr_err("asoc: failed to instantiate card %s: %d\n",
1603 card->name, ret);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001604 goto probe_dai_err;
1605 }
1606 }
1607
1608 snprintf(card->snd_card->shortname, sizeof(card->snd_card->shortname),
1609 "%s", card->name);
1610 snprintf(card->snd_card->longname, sizeof(card->snd_card->longname),
1611 "%s", card->name);
1612
1613 ret = snd_card_register(card->snd_card);
1614 if (ret < 0) {
1615 printk(KERN_ERR "asoc: failed to register soundcard for %s\n", card->name);
1616 goto probe_dai_err;
1617 }
1618
1619#ifdef CONFIG_SND_SOC_AC97_BUS
1620 /* register any AC97 codecs */
1621 for (i = 0; i < card->num_rtd; i++) {
1622 ret = soc_register_ac97_dai_link(&card->rtd[i]);
Mark Brownfe3e78e2009-11-03 22:13:13 +00001623 if (ret < 0) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001624 printk(KERN_ERR "asoc: failed to register AC97 %s\n", card->name);
1625 goto probe_dai_err;
Mark Brownfe3e78e2009-11-03 22:13:13 +00001626 }
1627 }
Mark Brownfe3e78e2009-11-03 22:13:13 +00001628#endif
1629
Mark Brown435c5e22008-12-04 15:32:53 +00001630 card->instantiated = 1;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001631 mutex_unlock(&card->mutex);
Mark Brown435c5e22008-12-04 15:32:53 +00001632 return;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001633
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001634probe_dai_err:
1635 for (i = 0; i < card->num_links; i++)
1636 soc_remove_dai_link(card, i);
Mark Brownfe3e78e2009-11-03 22:13:13 +00001637
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001638card_probe_error:
Mark Brown87506542008-11-18 20:50:34 +00001639 if (card->remove)
1640 card->remove(pdev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001641
1642 snd_card_free(card->snd_card);
1643
1644 mutex_unlock(&card->mutex);
Mark Brown435c5e22008-12-04 15:32:53 +00001645}
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001646
Mark Brown435c5e22008-12-04 15:32:53 +00001647/*
Uwe Kleine-König421f91d2010-06-11 12:17:00 +02001648 * Attempt to initialise any uninitialised cards. Must be called with
Mark Brown435c5e22008-12-04 15:32:53 +00001649 * client_mutex.
1650 */
1651static void snd_soc_instantiate_cards(void)
1652{
1653 struct snd_soc_card *card;
1654 list_for_each_entry(card, &card_list, list)
1655 snd_soc_instantiate_card(card);
1656}
1657
1658/* probes a new socdev */
1659static int soc_probe(struct platform_device *pdev)
1660{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001661 struct snd_soc_card *card = platform_get_drvdata(pdev);
Mark Brown435c5e22008-12-04 15:32:53 +00001662 int ret = 0;
Mark Brown435c5e22008-12-04 15:32:53 +00001663
1664 /* Bodge while we unpick instantiation */
1665 card->dev = &pdev->dev;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001666 INIT_LIST_HEAD(&card->dai_dev_list);
1667 INIT_LIST_HEAD(&card->codec_dev_list);
1668 INIT_LIST_HEAD(&card->platform_dev_list);
1669
Mark Brown435c5e22008-12-04 15:32:53 +00001670 ret = snd_soc_register_card(card);
1671 if (ret != 0) {
1672 dev_err(&pdev->dev, "Failed to register card\n");
1673 return ret;
1674 }
1675
1676 return 0;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001677}
1678
1679/* removes a socdev */
1680static int soc_remove(struct platform_device *pdev)
1681{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001682 struct snd_soc_card *card = platform_get_drvdata(pdev);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001683 int i;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001684
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001685 if (card->instantiated) {
Mike Rapoport914dc182009-05-11 13:04:55 +03001686
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001687 /* make sure any delayed work runs */
1688 for (i = 0; i < card->num_rtd; i++) {
1689 struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
1690 run_delayed_work(&rtd->delayed_work);
Guennadi Liakhovetskib2dfa622010-03-18 08:23:33 +01001691 }
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001692
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001693 /* remove and free each DAI */
1694 for (i = 0; i < card->num_rtd; i++)
1695 soc_remove_dai_link(card, i);
1696
1697 /* remove the card */
Guennadi Liakhovetskib2dfa622010-03-18 08:23:33 +01001698 if (card->remove)
1699 card->remove(pdev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001700
1701 kfree(card->rtd);
1702 snd_card_free(card->snd_card);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001703 }
Mark Brownc5af3a22008-11-28 13:29:45 +00001704 snd_soc_unregister_card(card);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001705 return 0;
1706}
1707
Mark Brown416356f2009-06-30 19:05:15 +01001708static int soc_poweroff(struct device *dev)
Mark Brown51737472009-06-22 13:16:51 +01001709{
Mark Brown416356f2009-06-30 19:05:15 +01001710 struct platform_device *pdev = to_platform_device(dev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001711 struct snd_soc_card *card = platform_get_drvdata(pdev);
1712 int i;
Mark Brown51737472009-06-22 13:16:51 +01001713
1714 if (!card->instantiated)
Mark Brown416356f2009-06-30 19:05:15 +01001715 return 0;
Mark Brown51737472009-06-22 13:16:51 +01001716
1717 /* Flush out pmdown_time work - we actually do want to run it
1718 * now, we're shutting down so no imminent restart. */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001719 for (i = 0; i < card->num_rtd; i++) {
1720 struct snd_soc_pcm_runtime *rtd = &card->rtd[i];
1721 run_delayed_work(&rtd->delayed_work);
1722 }
Mark Brown51737472009-06-22 13:16:51 +01001723
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001724 snd_soc_dapm_shutdown(card);
Mark Brown416356f2009-06-30 19:05:15 +01001725
1726 return 0;
Mark Brown51737472009-06-22 13:16:51 +01001727}
1728
Alexey Dobriyan47145212009-12-14 18:00:08 -08001729static const struct dev_pm_ops soc_pm_ops = {
Mark Brown416356f2009-06-30 19:05:15 +01001730 .suspend = soc_suspend,
1731 .resume = soc_resume,
1732 .poweroff = soc_poweroff,
1733};
1734
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001735/* ASoC platform driver */
1736static struct platform_driver soc_driver = {
1737 .driver = {
1738 .name = "soc-audio",
Kay Sievers8b45a202008-04-14 13:33:36 +02001739 .owner = THIS_MODULE,
Mark Brown416356f2009-06-30 19:05:15 +01001740 .pm = &soc_pm_ops,
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001741 },
1742 .probe = soc_probe,
1743 .remove = soc_remove,
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001744};
1745
1746/* create a new pcm */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001747static int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001748{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001749 struct snd_soc_codec *codec = rtd->codec;
1750 struct snd_soc_platform *platform = rtd->platform;
1751 struct snd_soc_dai *codec_dai = rtd->codec_dai;
1752 struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001753 struct snd_pcm *pcm;
1754 char new_name[64];
1755 int ret = 0, playback = 0, capture = 0;
1756
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001757 /* check client and interface hw capabilities */
Mark Brown40ca1142009-12-24 13:44:28 +00001758 snprintf(new_name, sizeof(new_name), "%s %s-%d",
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001759 rtd->dai_link->stream_name, codec_dai->name, num);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001760
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001761 if (codec_dai->driver->playback.channels_min)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001762 playback = 1;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001763 if (codec_dai->driver->capture.channels_min)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001764 capture = 1;
1765
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001766 dev_dbg(rtd->card->dev, "registered pcm #%d %s\n",num,new_name);
1767 ret = snd_pcm_new(rtd->card->snd_card, new_name,
1768 num, playback, capture, &pcm);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001769 if (ret < 0) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001770 printk(KERN_ERR "asoc: can't create pcm for codec %s\n", codec->name);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001771 return ret;
1772 }
1773
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001774 rtd->pcm = pcm;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001775 pcm->private_data = rtd;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001776 soc_pcm_ops.mmap = platform->driver->ops->mmap;
1777 soc_pcm_ops.pointer = platform->driver->ops->pointer;
1778 soc_pcm_ops.ioctl = platform->driver->ops->ioctl;
1779 soc_pcm_ops.copy = platform->driver->ops->copy;
1780 soc_pcm_ops.silence = platform->driver->ops->silence;
1781 soc_pcm_ops.ack = platform->driver->ops->ack;
1782 soc_pcm_ops.page = platform->driver->ops->page;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001783
1784 if (playback)
1785 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &soc_pcm_ops);
1786
1787 if (capture)
1788 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &soc_pcm_ops);
1789
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001790 ret = platform->driver->pcm_new(rtd->card->snd_card, codec_dai, pcm);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001791 if (ret < 0) {
1792 printk(KERN_ERR "asoc: platform pcm constructor failed\n");
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001793 return ret;
1794 }
1795
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001796 pcm->private_free = platform->driver->pcm_free;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001797 printk(KERN_INFO "asoc: %s <-> %s mapping ok\n", codec_dai->name,
1798 cpu_dai->name);
1799 return ret;
1800}
1801
Mark Brown096e49d2009-07-05 15:12:22 +01001802/**
1803 * snd_soc_codec_volatile_register: Report if a register is volatile.
1804 *
1805 * @codec: CODEC to query.
1806 * @reg: Register to query.
1807 *
1808 * Boolean function indiciating if a CODEC register is volatile.
1809 */
1810int snd_soc_codec_volatile_register(struct snd_soc_codec *codec, int reg)
1811{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001812 if (codec->driver->volatile_register)
1813 return codec->driver->volatile_register(reg);
Mark Brown096e49d2009-07-05 15:12:22 +01001814 else
1815 return 0;
1816}
1817EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register);
1818
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001819/**
1820 * snd_soc_new_ac97_codec - initailise AC97 device
1821 * @codec: audio codec
1822 * @ops: AC97 bus operations
1823 * @num: AC97 codec number
1824 *
1825 * Initialises AC97 codec resources for use by ad-hoc devices only.
1826 */
1827int snd_soc_new_ac97_codec(struct snd_soc_codec *codec,
1828 struct snd_ac97_bus_ops *ops, int num)
1829{
1830 mutex_lock(&codec->mutex);
1831
1832 codec->ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL);
1833 if (codec->ac97 == NULL) {
1834 mutex_unlock(&codec->mutex);
1835 return -ENOMEM;
1836 }
1837
1838 codec->ac97->bus = kzalloc(sizeof(struct snd_ac97_bus), GFP_KERNEL);
1839 if (codec->ac97->bus == NULL) {
1840 kfree(codec->ac97);
1841 codec->ac97 = NULL;
1842 mutex_unlock(&codec->mutex);
1843 return -ENOMEM;
1844 }
1845
1846 codec->ac97->bus->ops = ops;
1847 codec->ac97->num = num;
Mika Westerberg0562f782010-10-13 11:30:32 +03001848
1849 /*
1850 * Mark the AC97 device to be created by us. This way we ensure that the
1851 * device will be registered with the device subsystem later on.
1852 */
1853 codec->ac97_created = 1;
1854
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001855 mutex_unlock(&codec->mutex);
1856 return 0;
1857}
1858EXPORT_SYMBOL_GPL(snd_soc_new_ac97_codec);
1859
1860/**
1861 * snd_soc_free_ac97_codec - free AC97 codec device
1862 * @codec: audio codec
1863 *
1864 * Frees AC97 codec device resources.
1865 */
1866void snd_soc_free_ac97_codec(struct snd_soc_codec *codec)
1867{
1868 mutex_lock(&codec->mutex);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00001869#ifdef CONFIG_SND_SOC_AC97_BUS
1870 soc_unregister_ac97_dai_link(codec);
1871#endif
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001872 kfree(codec->ac97->bus);
1873 kfree(codec->ac97);
1874 codec->ac97 = NULL;
Mika Westerberg0562f782010-10-13 11:30:32 +03001875 codec->ac97_created = 0;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001876 mutex_unlock(&codec->mutex);
1877}
1878EXPORT_SYMBOL_GPL(snd_soc_free_ac97_codec);
1879
1880/**
1881 * snd_soc_update_bits - update codec register bits
1882 * @codec: audio codec
1883 * @reg: codec register
1884 * @mask: register mask
1885 * @value: new value
1886 *
1887 * Writes new register value.
1888 *
1889 * Returns 1 for change else 0.
1890 */
1891int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg,
Daniel Ribeiro46f58222009-06-07 02:49:11 -03001892 unsigned int mask, unsigned int value)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001893{
1894 int change;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03001895 unsigned int old, new;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001896
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001897 old = snd_soc_read(codec, reg);
1898 new = (old & ~mask) | value;
1899 change = old != new;
1900 if (change)
1901 snd_soc_write(codec, reg, new);
1902
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001903 return change;
1904}
1905EXPORT_SYMBOL_GPL(snd_soc_update_bits);
1906
1907/**
Eero Nurkkala6c508c62009-10-30 13:34:03 +02001908 * snd_soc_update_bits_locked - update codec register bits
1909 * @codec: audio codec
1910 * @reg: codec register
1911 * @mask: register mask
1912 * @value: new value
1913 *
1914 * Writes new register value, and takes the codec mutex.
1915 *
1916 * Returns 1 for change else 0.
1917 */
Mark Browndd1b3d52009-12-04 14:22:03 +00001918int snd_soc_update_bits_locked(struct snd_soc_codec *codec,
1919 unsigned short reg, unsigned int mask,
1920 unsigned int value)
Eero Nurkkala6c508c62009-10-30 13:34:03 +02001921{
1922 int change;
1923
1924 mutex_lock(&codec->mutex);
1925 change = snd_soc_update_bits(codec, reg, mask, value);
1926 mutex_unlock(&codec->mutex);
1927
1928 return change;
1929}
Mark Browndd1b3d52009-12-04 14:22:03 +00001930EXPORT_SYMBOL_GPL(snd_soc_update_bits_locked);
Eero Nurkkala6c508c62009-10-30 13:34:03 +02001931
1932/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001933 * snd_soc_test_bits - test register for change
1934 * @codec: audio codec
1935 * @reg: codec register
1936 * @mask: register mask
1937 * @value: new value
1938 *
1939 * Tests a register with a new value and checks if the new value is
1940 * different from the old value.
1941 *
1942 * Returns 1 for change else 0.
1943 */
1944int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg,
Daniel Ribeiro46f58222009-06-07 02:49:11 -03001945 unsigned int mask, unsigned int value)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001946{
1947 int change;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03001948 unsigned int old, new;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001949
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001950 old = snd_soc_read(codec, reg);
1951 new = (old & ~mask) | value;
1952 change = old != new;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001953
1954 return change;
1955}
1956EXPORT_SYMBOL_GPL(snd_soc_test_bits);
1957
1958/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001959 * snd_soc_set_runtime_hwparams - set the runtime hardware parameters
1960 * @substream: the pcm substream
1961 * @hw: the hardware parameters
1962 *
1963 * Sets the substream runtime hardware parameters.
1964 */
1965int snd_soc_set_runtime_hwparams(struct snd_pcm_substream *substream,
1966 const struct snd_pcm_hardware *hw)
1967{
1968 struct snd_pcm_runtime *runtime = substream->runtime;
1969 runtime->hw.info = hw->info;
1970 runtime->hw.formats = hw->formats;
1971 runtime->hw.period_bytes_min = hw->period_bytes_min;
1972 runtime->hw.period_bytes_max = hw->period_bytes_max;
1973 runtime->hw.periods_min = hw->periods_min;
1974 runtime->hw.periods_max = hw->periods_max;
1975 runtime->hw.buffer_bytes_max = hw->buffer_bytes_max;
1976 runtime->hw.fifo_size = hw->fifo_size;
1977 return 0;
1978}
1979EXPORT_SYMBOL_GPL(snd_soc_set_runtime_hwparams);
1980
1981/**
1982 * snd_soc_cnew - create new control
1983 * @_template: control template
1984 * @data: control private data
Mark Brownac11a2b2009-01-01 12:18:17 +00001985 * @long_name: control long name
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001986 *
1987 * Create a new mixer control from a template control.
1988 *
1989 * Returns 0 for success, else error.
1990 */
1991struct snd_kcontrol *snd_soc_cnew(const struct snd_kcontrol_new *_template,
1992 void *data, char *long_name)
1993{
1994 struct snd_kcontrol_new template;
1995
1996 memcpy(&template, _template, sizeof(template));
1997 if (long_name)
1998 template.name = long_name;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02001999 template.index = 0;
2000
2001 return snd_ctl_new1(&template, data);
2002}
2003EXPORT_SYMBOL_GPL(snd_soc_cnew);
2004
2005/**
Ian Molton3e8e1952009-01-09 00:23:21 +00002006 * snd_soc_add_controls - add an array of controls to a codec.
2007 * Convienience function to add a list of controls. Many codecs were
2008 * duplicating this code.
2009 *
2010 * @codec: codec to add controls to
2011 * @controls: array of controls to add
2012 * @num_controls: number of elements in the array
2013 *
2014 * Return 0 for success, else error.
2015 */
2016int snd_soc_add_controls(struct snd_soc_codec *codec,
2017 const struct snd_kcontrol_new *controls, int num_controls)
2018{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002019 struct snd_card *card = codec->card->snd_card;
Ian Molton3e8e1952009-01-09 00:23:21 +00002020 int err, i;
2021
2022 for (i = 0; i < num_controls; i++) {
2023 const struct snd_kcontrol_new *control = &controls[i];
2024 err = snd_ctl_add(card, snd_soc_cnew(control, codec, NULL));
2025 if (err < 0) {
Mark Brown082100d2010-09-20 19:03:28 +01002026 dev_err(codec->dev, "%s: Failed to add %s: %d\n",
2027 codec->name, control->name, err);
Ian Molton3e8e1952009-01-09 00:23:21 +00002028 return err;
2029 }
2030 }
2031
2032 return 0;
2033}
2034EXPORT_SYMBOL_GPL(snd_soc_add_controls);
2035
2036/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002037 * snd_soc_info_enum_double - enumerated double mixer info callback
2038 * @kcontrol: mixer control
2039 * @uinfo: control element information
2040 *
2041 * Callback to provide information about a double enumerated
2042 * mixer control.
2043 *
2044 * Returns 0 for success.
2045 */
2046int snd_soc_info_enum_double(struct snd_kcontrol *kcontrol,
2047 struct snd_ctl_elem_info *uinfo)
2048{
2049 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2050
2051 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2052 uinfo->count = e->shift_l == e->shift_r ? 1 : 2;
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002053 uinfo->value.enumerated.items = e->max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002054
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002055 if (uinfo->value.enumerated.item > e->max - 1)
2056 uinfo->value.enumerated.item = e->max - 1;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002057 strcpy(uinfo->value.enumerated.name,
2058 e->texts[uinfo->value.enumerated.item]);
2059 return 0;
2060}
2061EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
2062
2063/**
2064 * snd_soc_get_enum_double - enumerated double mixer get callback
2065 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002066 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002067 *
2068 * Callback to get the value of a double enumerated mixer.
2069 *
2070 * Returns 0 for success.
2071 */
2072int snd_soc_get_enum_double(struct snd_kcontrol *kcontrol,
2073 struct snd_ctl_elem_value *ucontrol)
2074{
2075 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2076 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002077 unsigned int val, bitmask;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002078
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002079 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002080 ;
2081 val = snd_soc_read(codec, e->reg);
Mark Brown3ff3f642008-05-19 12:32:25 +02002082 ucontrol->value.enumerated.item[0]
2083 = (val >> e->shift_l) & (bitmask - 1);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002084 if (e->shift_l != e->shift_r)
2085 ucontrol->value.enumerated.item[1] =
2086 (val >> e->shift_r) & (bitmask - 1);
2087
2088 return 0;
2089}
2090EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
2091
2092/**
2093 * snd_soc_put_enum_double - enumerated double mixer put callback
2094 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002095 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002096 *
2097 * Callback to set the value of a double enumerated mixer.
2098 *
2099 * Returns 0 for success.
2100 */
2101int snd_soc_put_enum_double(struct snd_kcontrol *kcontrol,
2102 struct snd_ctl_elem_value *ucontrol)
2103{
2104 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2105 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002106 unsigned int val;
2107 unsigned int mask, bitmask;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002108
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002109 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002110 ;
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002111 if (ucontrol->value.enumerated.item[0] > e->max - 1)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002112 return -EINVAL;
2113 val = ucontrol->value.enumerated.item[0] << e->shift_l;
2114 mask = (bitmask - 1) << e->shift_l;
2115 if (e->shift_l != e->shift_r) {
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002116 if (ucontrol->value.enumerated.item[1] > e->max - 1)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002117 return -EINVAL;
2118 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
2119 mask |= (bitmask - 1) << e->shift_r;
2120 }
2121
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002122 return snd_soc_update_bits_locked(codec, e->reg, mask, val);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002123}
2124EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
2125
2126/**
Peter Ujfalusi2e72f8e2009-01-05 09:54:57 +02002127 * snd_soc_get_value_enum_double - semi enumerated double mixer get callback
2128 * @kcontrol: mixer control
2129 * @ucontrol: control element information
2130 *
2131 * Callback to get the value of a double semi enumerated mixer.
2132 *
2133 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2134 * used for handling bitfield coded enumeration for example.
2135 *
2136 * Returns 0 for success.
2137 */
2138int snd_soc_get_value_enum_double(struct snd_kcontrol *kcontrol,
2139 struct snd_ctl_elem_value *ucontrol)
2140{
2141 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Peter Ujfalusi74155552009-01-08 13:34:29 +02002142 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002143 unsigned int reg_val, val, mux;
Peter Ujfalusi2e72f8e2009-01-05 09:54:57 +02002144
2145 reg_val = snd_soc_read(codec, e->reg);
2146 val = (reg_val >> e->shift_l) & e->mask;
2147 for (mux = 0; mux < e->max; mux++) {
2148 if (val == e->values[mux])
2149 break;
2150 }
2151 ucontrol->value.enumerated.item[0] = mux;
2152 if (e->shift_l != e->shift_r) {
2153 val = (reg_val >> e->shift_r) & e->mask;
2154 for (mux = 0; mux < e->max; mux++) {
2155 if (val == e->values[mux])
2156 break;
2157 }
2158 ucontrol->value.enumerated.item[1] = mux;
2159 }
2160
2161 return 0;
2162}
2163EXPORT_SYMBOL_GPL(snd_soc_get_value_enum_double);
2164
2165/**
2166 * snd_soc_put_value_enum_double - semi enumerated double mixer put callback
2167 * @kcontrol: mixer control
2168 * @ucontrol: control element information
2169 *
2170 * Callback to set the value of a double semi enumerated mixer.
2171 *
2172 * Semi enumerated mixer: the enumerated items are referred as values. Can be
2173 * used for handling bitfield coded enumeration for example.
2174 *
2175 * Returns 0 for success.
2176 */
2177int snd_soc_put_value_enum_double(struct snd_kcontrol *kcontrol,
2178 struct snd_ctl_elem_value *ucontrol)
2179{
2180 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Peter Ujfalusi74155552009-01-08 13:34:29 +02002181 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002182 unsigned int val;
2183 unsigned int mask;
Peter Ujfalusi2e72f8e2009-01-05 09:54:57 +02002184
2185 if (ucontrol->value.enumerated.item[0] > e->max - 1)
2186 return -EINVAL;
2187 val = e->values[ucontrol->value.enumerated.item[0]] << e->shift_l;
2188 mask = e->mask << e->shift_l;
2189 if (e->shift_l != e->shift_r) {
2190 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2191 return -EINVAL;
2192 val |= e->values[ucontrol->value.enumerated.item[1]] << e->shift_r;
2193 mask |= e->mask << e->shift_r;
2194 }
2195
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002196 return snd_soc_update_bits_locked(codec, e->reg, mask, val);
Peter Ujfalusi2e72f8e2009-01-05 09:54:57 +02002197}
2198EXPORT_SYMBOL_GPL(snd_soc_put_value_enum_double);
2199
2200/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002201 * snd_soc_info_enum_ext - external enumerated single mixer info callback
2202 * @kcontrol: mixer control
2203 * @uinfo: control element information
2204 *
2205 * Callback to provide information about an external enumerated
2206 * single mixer.
2207 *
2208 * Returns 0 for success.
2209 */
2210int snd_soc_info_enum_ext(struct snd_kcontrol *kcontrol,
2211 struct snd_ctl_elem_info *uinfo)
2212{
2213 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2214
2215 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
2216 uinfo->count = 1;
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002217 uinfo->value.enumerated.items = e->max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002218
Jon Smirlf8ba0b72008-07-29 11:42:27 +01002219 if (uinfo->value.enumerated.item > e->max - 1)
2220 uinfo->value.enumerated.item = e->max - 1;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002221 strcpy(uinfo->value.enumerated.name,
2222 e->texts[uinfo->value.enumerated.item]);
2223 return 0;
2224}
2225EXPORT_SYMBOL_GPL(snd_soc_info_enum_ext);
2226
2227/**
2228 * snd_soc_info_volsw_ext - external single mixer info callback
2229 * @kcontrol: mixer control
2230 * @uinfo: control element information
2231 *
2232 * Callback to provide information about a single external mixer control.
2233 *
2234 * Returns 0 for success.
2235 */
2236int snd_soc_info_volsw_ext(struct snd_kcontrol *kcontrol,
2237 struct snd_ctl_elem_info *uinfo)
2238{
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002239 int max = kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002240
Mark Brownfd5dfad2009-04-15 21:37:46 +01002241 if (max == 1 && !strstr(kcontrol->id.name, " Volume"))
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002242 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2243 else
2244 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2245
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002246 uinfo->count = 1;
2247 uinfo->value.integer.min = 0;
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002248 uinfo->value.integer.max = max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002249 return 0;
2250}
2251EXPORT_SYMBOL_GPL(snd_soc_info_volsw_ext);
2252
2253/**
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002254 * snd_soc_info_volsw - single mixer info callback
2255 * @kcontrol: mixer control
2256 * @uinfo: control element information
2257 *
2258 * Callback to provide information about a single mixer control.
2259 *
2260 * Returns 0 for success.
2261 */
2262int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
2263 struct snd_ctl_elem_info *uinfo)
2264{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002265 struct soc_mixer_control *mc =
2266 (struct soc_mixer_control *)kcontrol->private_value;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002267 int platform_max;
Mark Brown762b8df2008-10-30 12:37:08 +00002268 unsigned int shift = mc->shift;
Jon Smirl815ecf82008-07-29 10:22:24 -04002269 unsigned int rshift = mc->rshift;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002270
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002271 if (!mc->platform_max)
2272 mc->platform_max = mc->max;
2273 platform_max = mc->platform_max;
2274
2275 if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002276 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2277 else
2278 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2279
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002280 uinfo->count = shift == rshift ? 1 : 2;
2281 uinfo->value.integer.min = 0;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002282 uinfo->value.integer.max = platform_max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002283 return 0;
2284}
2285EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
2286
2287/**
2288 * snd_soc_get_volsw - single mixer get callback
2289 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002290 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002291 *
2292 * Callback to get the value of a single mixer control.
2293 *
2294 * Returns 0 for success.
2295 */
2296int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
2297 struct snd_ctl_elem_value *ucontrol)
2298{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002299 struct soc_mixer_control *mc =
2300 (struct soc_mixer_control *)kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002301 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf82008-07-29 10:22:24 -04002302 unsigned int reg = mc->reg;
2303 unsigned int shift = mc->shift;
2304 unsigned int rshift = mc->rshift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002305 int max = mc->max;
Jon Smirl815ecf82008-07-29 10:22:24 -04002306 unsigned int mask = (1 << fls(max)) - 1;
2307 unsigned int invert = mc->invert;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002308
2309 ucontrol->value.integer.value[0] =
2310 (snd_soc_read(codec, reg) >> shift) & mask;
2311 if (shift != rshift)
2312 ucontrol->value.integer.value[1] =
2313 (snd_soc_read(codec, reg) >> rshift) & mask;
2314 if (invert) {
2315 ucontrol->value.integer.value[0] =
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002316 max - ucontrol->value.integer.value[0];
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002317 if (shift != rshift)
2318 ucontrol->value.integer.value[1] =
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002319 max - ucontrol->value.integer.value[1];
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002320 }
2321
2322 return 0;
2323}
2324EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
2325
2326/**
2327 * snd_soc_put_volsw - single mixer put callback
2328 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002329 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002330 *
2331 * Callback to set the value of a single mixer control.
2332 *
2333 * Returns 0 for success.
2334 */
2335int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
2336 struct snd_ctl_elem_value *ucontrol)
2337{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002338 struct soc_mixer_control *mc =
2339 (struct soc_mixer_control *)kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002340 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf82008-07-29 10:22:24 -04002341 unsigned int reg = mc->reg;
2342 unsigned int shift = mc->shift;
2343 unsigned int rshift = mc->rshift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002344 int max = mc->max;
Jon Smirl815ecf82008-07-29 10:22:24 -04002345 unsigned int mask = (1 << fls(max)) - 1;
2346 unsigned int invert = mc->invert;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002347 unsigned int val, val2, val_mask;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002348
2349 val = (ucontrol->value.integer.value[0] & mask);
2350 if (invert)
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002351 val = max - val;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002352 val_mask = mask << shift;
2353 val = val << shift;
2354 if (shift != rshift) {
2355 val2 = (ucontrol->value.integer.value[1] & mask);
2356 if (invert)
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002357 val2 = max - val2;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002358 val_mask |= mask << rshift;
2359 val |= val2 << rshift;
2360 }
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002361 return snd_soc_update_bits_locked(codec, reg, val_mask, val);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002362}
2363EXPORT_SYMBOL_GPL(snd_soc_put_volsw);
2364
2365/**
2366 * snd_soc_info_volsw_2r - double mixer info callback
2367 * @kcontrol: mixer control
2368 * @uinfo: control element information
2369 *
2370 * Callback to provide information about a double mixer control that
2371 * spans 2 codec registers.
2372 *
2373 * Returns 0 for success.
2374 */
2375int snd_soc_info_volsw_2r(struct snd_kcontrol *kcontrol,
2376 struct snd_ctl_elem_info *uinfo)
2377{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002378 struct soc_mixer_control *mc =
2379 (struct soc_mixer_control *)kcontrol->private_value;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002380 int platform_max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002381
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002382 if (!mc->platform_max)
2383 mc->platform_max = mc->max;
2384 platform_max = mc->platform_max;
2385
2386 if (platform_max == 1 && !strstr(kcontrol->id.name, " Volume"))
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002387 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2388 else
2389 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2390
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002391 uinfo->count = 2;
2392 uinfo->value.integer.min = 0;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002393 uinfo->value.integer.max = platform_max;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002394 return 0;
2395}
2396EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r);
2397
2398/**
2399 * snd_soc_get_volsw_2r - double mixer get callback
2400 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002401 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002402 *
2403 * Callback to get the value of a double mixer control that spans 2 registers.
2404 *
2405 * Returns 0 for success.
2406 */
2407int snd_soc_get_volsw_2r(struct snd_kcontrol *kcontrol,
2408 struct snd_ctl_elem_value *ucontrol)
2409{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002410 struct soc_mixer_control *mc =
2411 (struct soc_mixer_control *)kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002412 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf82008-07-29 10:22:24 -04002413 unsigned int reg = mc->reg;
2414 unsigned int reg2 = mc->rreg;
2415 unsigned int shift = mc->shift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002416 int max = mc->max;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002417 unsigned int mask = (1 << fls(max)) - 1;
Jon Smirl815ecf82008-07-29 10:22:24 -04002418 unsigned int invert = mc->invert;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002419
2420 ucontrol->value.integer.value[0] =
2421 (snd_soc_read(codec, reg) >> shift) & mask;
2422 ucontrol->value.integer.value[1] =
2423 (snd_soc_read(codec, reg2) >> shift) & mask;
2424 if (invert) {
2425 ucontrol->value.integer.value[0] =
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002426 max - ucontrol->value.integer.value[0];
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002427 ucontrol->value.integer.value[1] =
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002428 max - ucontrol->value.integer.value[1];
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002429 }
2430
2431 return 0;
2432}
2433EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r);
2434
2435/**
2436 * snd_soc_put_volsw_2r - double mixer set callback
2437 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002438 * @ucontrol: control element information
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002439 *
2440 * Callback to set the value of a double mixer control that spans 2 registers.
2441 *
2442 * Returns 0 for success.
2443 */
2444int snd_soc_put_volsw_2r(struct snd_kcontrol *kcontrol,
2445 struct snd_ctl_elem_value *ucontrol)
2446{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002447 struct soc_mixer_control *mc =
2448 (struct soc_mixer_control *)kcontrol->private_value;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002449 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf82008-07-29 10:22:24 -04002450 unsigned int reg = mc->reg;
2451 unsigned int reg2 = mc->rreg;
2452 unsigned int shift = mc->shift;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002453 int max = mc->max;
Jon Smirl815ecf82008-07-29 10:22:24 -04002454 unsigned int mask = (1 << fls(max)) - 1;
2455 unsigned int invert = mc->invert;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002456 int err;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002457 unsigned int val, val2, val_mask;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002458
2459 val_mask = mask << shift;
2460 val = (ucontrol->value.integer.value[0] & mask);
2461 val2 = (ucontrol->value.integer.value[1] & mask);
2462
2463 if (invert) {
Philipp Zabela7a4ac82008-01-10 14:37:42 +01002464 val = max - val;
2465 val2 = max - val2;
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002466 }
2467
2468 val = val << shift;
2469 val2 = val2 << shift;
2470
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002471 err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
Mark Brown3ff3f642008-05-19 12:32:25 +02002472 if (err < 0)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002473 return err;
2474
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002475 err = snd_soc_update_bits_locked(codec, reg2, val_mask, val2);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02002476 return err;
2477}
2478EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r);
2479
Mark Browne13ac2e2008-05-28 17:58:05 +01002480/**
2481 * snd_soc_info_volsw_s8 - signed mixer info callback
2482 * @kcontrol: mixer control
2483 * @uinfo: control element information
2484 *
2485 * Callback to provide information about a signed mixer control.
2486 *
2487 * Returns 0 for success.
2488 */
2489int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol,
2490 struct snd_ctl_elem_info *uinfo)
2491{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002492 struct soc_mixer_control *mc =
2493 (struct soc_mixer_control *)kcontrol->private_value;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002494 int platform_max;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002495 int min = mc->min;
Mark Browne13ac2e2008-05-28 17:58:05 +01002496
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002497 if (!mc->platform_max)
2498 mc->platform_max = mc->max;
2499 platform_max = mc->platform_max;
2500
Mark Browne13ac2e2008-05-28 17:58:05 +01002501 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2502 uinfo->count = 2;
2503 uinfo->value.integer.min = 0;
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002504 uinfo->value.integer.max = platform_max - min;
Mark Browne13ac2e2008-05-28 17:58:05 +01002505 return 0;
2506}
2507EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8);
2508
2509/**
2510 * snd_soc_get_volsw_s8 - signed mixer get callback
2511 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002512 * @ucontrol: control element information
Mark Browne13ac2e2008-05-28 17:58:05 +01002513 *
2514 * Callback to get the value of a signed mixer control.
2515 *
2516 * Returns 0 for success.
2517 */
2518int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol,
2519 struct snd_ctl_elem_value *ucontrol)
2520{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002521 struct soc_mixer_control *mc =
2522 (struct soc_mixer_control *)kcontrol->private_value;
Mark Browne13ac2e2008-05-28 17:58:05 +01002523 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf82008-07-29 10:22:24 -04002524 unsigned int reg = mc->reg;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002525 int min = mc->min;
Mark Browne13ac2e2008-05-28 17:58:05 +01002526 int val = snd_soc_read(codec, reg);
2527
2528 ucontrol->value.integer.value[0] =
2529 ((signed char)(val & 0xff))-min;
2530 ucontrol->value.integer.value[1] =
2531 ((signed char)((val >> 8) & 0xff))-min;
2532 return 0;
2533}
2534EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8);
2535
2536/**
2537 * snd_soc_put_volsw_sgn - signed mixer put callback
2538 * @kcontrol: mixer control
Mark Brownac11a2b2009-01-01 12:18:17 +00002539 * @ucontrol: control element information
Mark Browne13ac2e2008-05-28 17:58:05 +01002540 *
2541 * Callback to set the value of a signed mixer control.
2542 *
2543 * Returns 0 for success.
2544 */
2545int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol,
2546 struct snd_ctl_elem_value *ucontrol)
2547{
Jon Smirl4eaa9812008-07-29 11:42:26 +01002548 struct soc_mixer_control *mc =
2549 (struct soc_mixer_control *)kcontrol->private_value;
Mark Browne13ac2e2008-05-28 17:58:05 +01002550 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
Jon Smirl815ecf82008-07-29 10:22:24 -04002551 unsigned int reg = mc->reg;
Jon Smirl4eaa9812008-07-29 11:42:26 +01002552 int min = mc->min;
Daniel Ribeiro46f58222009-06-07 02:49:11 -03002553 unsigned int val;
Mark Browne13ac2e2008-05-28 17:58:05 +01002554
2555 val = (ucontrol->value.integer.value[0]+min) & 0xff;
2556 val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8;
2557
Eero Nurkkala6c508c62009-10-30 13:34:03 +02002558 return snd_soc_update_bits_locked(codec, reg, 0xffff, val);
Mark Browne13ac2e2008-05-28 17:58:05 +01002559}
2560EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8);
2561
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002562/**
Peter Ujfalusi637d3842010-05-07 14:05:49 +03002563 * snd_soc_limit_volume - Set new limit to an existing volume control.
2564 *
2565 * @codec: where to look for the control
2566 * @name: Name of the control
2567 * @max: new maximum limit
2568 *
2569 * Return 0 for success, else error.
2570 */
2571int snd_soc_limit_volume(struct snd_soc_codec *codec,
2572 const char *name, int max)
2573{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002574 struct snd_card *card = codec->card->snd_card;
Peter Ujfalusi637d3842010-05-07 14:05:49 +03002575 struct snd_kcontrol *kctl;
2576 struct soc_mixer_control *mc;
2577 int found = 0;
2578 int ret = -EINVAL;
2579
2580 /* Sanity check for name and max */
2581 if (unlikely(!name || max <= 0))
2582 return -EINVAL;
2583
2584 list_for_each_entry(kctl, &card->controls, list) {
2585 if (!strncmp(kctl->id.name, name, sizeof(kctl->id.name))) {
2586 found = 1;
2587 break;
2588 }
2589 }
2590 if (found) {
2591 mc = (struct soc_mixer_control *)kctl->private_value;
2592 if (max <= mc->max) {
Peter Ujfalusid11bb4a2010-05-10 14:39:24 +03002593 mc->platform_max = max;
Peter Ujfalusi637d3842010-05-07 14:05:49 +03002594 ret = 0;
2595 }
2596 }
2597 return ret;
2598}
2599EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
2600
2601/**
apatard@mandriva.comb6f4bb32010-05-15 17:30:01 +02002602 * snd_soc_info_volsw_2r_sx - double with tlv and variable data size
2603 * mixer info callback
2604 * @kcontrol: mixer control
2605 * @uinfo: control element information
2606 *
2607 * Returns 0 for success.
2608 */
2609int snd_soc_info_volsw_2r_sx(struct snd_kcontrol *kcontrol,
2610 struct snd_ctl_elem_info *uinfo)
2611{
2612 struct soc_mixer_control *mc =
2613 (struct soc_mixer_control *)kcontrol->private_value;
2614 int max = mc->max;
2615 int min = mc->min;
2616
2617 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2618 uinfo->count = 2;
2619 uinfo->value.integer.min = 0;
2620 uinfo->value.integer.max = max-min;
2621
2622 return 0;
2623}
2624EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r_sx);
2625
2626/**
2627 * snd_soc_get_volsw_2r_sx - double with tlv and variable data size
2628 * mixer get callback
2629 * @kcontrol: mixer control
2630 * @uinfo: control element information
2631 *
2632 * Returns 0 for success.
2633 */
2634int snd_soc_get_volsw_2r_sx(struct snd_kcontrol *kcontrol,
2635 struct snd_ctl_elem_value *ucontrol)
2636{
2637 struct soc_mixer_control *mc =
2638 (struct soc_mixer_control *)kcontrol->private_value;
2639 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2640 unsigned int mask = (1<<mc->shift)-1;
2641 int min = mc->min;
2642 int val = snd_soc_read(codec, mc->reg) & mask;
2643 int valr = snd_soc_read(codec, mc->rreg) & mask;
2644
Stuart Longland20630c72010-06-18 12:56:10 +10002645 ucontrol->value.integer.value[0] = ((val & 0xff)-min) & mask;
2646 ucontrol->value.integer.value[1] = ((valr & 0xff)-min) & mask;
apatard@mandriva.comb6f4bb32010-05-15 17:30:01 +02002647 return 0;
2648}
2649EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r_sx);
2650
2651/**
2652 * snd_soc_put_volsw_2r_sx - double with tlv and variable data size
2653 * mixer put callback
2654 * @kcontrol: mixer control
2655 * @uinfo: control element information
2656 *
2657 * Returns 0 for success.
2658 */
2659int snd_soc_put_volsw_2r_sx(struct snd_kcontrol *kcontrol,
2660 struct snd_ctl_elem_value *ucontrol)
2661{
2662 struct soc_mixer_control *mc =
2663 (struct soc_mixer_control *)kcontrol->private_value;
2664 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2665 unsigned int mask = (1<<mc->shift)-1;
2666 int min = mc->min;
2667 int ret;
2668 unsigned int val, valr, oval, ovalr;
2669
2670 val = ((ucontrol->value.integer.value[0]+min) & 0xff);
2671 val &= mask;
2672 valr = ((ucontrol->value.integer.value[1]+min) & 0xff);
2673 valr &= mask;
2674
2675 oval = snd_soc_read(codec, mc->reg) & mask;
2676 ovalr = snd_soc_read(codec, mc->rreg) & mask;
2677
2678 ret = 0;
2679 if (oval != val) {
2680 ret = snd_soc_write(codec, mc->reg, val);
2681 if (ret < 0)
Mark Brownf1df5ae2010-06-15 15:14:31 +01002682 return ret;
apatard@mandriva.comb6f4bb32010-05-15 17:30:01 +02002683 }
2684 if (ovalr != valr) {
2685 ret = snd_soc_write(codec, mc->rreg, valr);
2686 if (ret < 0)
Mark Brownf1df5ae2010-06-15 15:14:31 +01002687 return ret;
apatard@mandriva.comb6f4bb32010-05-15 17:30:01 +02002688 }
2689
2690 return 0;
2691}
2692EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r_sx);
2693
2694/**
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002695 * snd_soc_dai_set_sysclk - configure DAI system or master clock.
2696 * @dai: DAI
2697 * @clk_id: DAI specific clock ID
2698 * @freq: new clock frequency in Hz
2699 * @dir: new clock direction - input/output.
2700 *
2701 * Configures the DAI master (MCLK) or system (SYSCLK) clocking.
2702 */
2703int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
2704 unsigned int freq, int dir)
2705{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002706 if (dai->driver && dai->driver->ops->set_sysclk)
2707 return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002708 else
2709 return -EINVAL;
2710}
2711EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
2712
2713/**
2714 * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
2715 * @dai: DAI
Mark Brownac11a2b2009-01-01 12:18:17 +00002716 * @div_id: DAI specific clock divider ID
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002717 * @div: new clock divisor.
2718 *
2719 * Configures the clock dividers. This is used to derive the best DAI bit and
2720 * frame clocks from the system or master clock. It's best to set the DAI bit
2721 * and frame clocks as low as possible to save system power.
2722 */
2723int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
2724 int div_id, int div)
2725{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002726 if (dai->driver && dai->driver->ops->set_clkdiv)
2727 return dai->driver->ops->set_clkdiv(dai, div_id, div);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002728 else
2729 return -EINVAL;
2730}
2731EXPORT_SYMBOL_GPL(snd_soc_dai_set_clkdiv);
2732
2733/**
2734 * snd_soc_dai_set_pll - configure DAI PLL.
2735 * @dai: DAI
2736 * @pll_id: DAI specific PLL ID
Mark Brown85488032009-09-05 18:52:16 +01002737 * @source: DAI specific source for the PLL
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002738 * @freq_in: PLL input clock frequency in Hz
2739 * @freq_out: requested PLL output clock frequency in Hz
2740 *
2741 * Configures and enables PLL to generate output clock based on input clock.
2742 */
Mark Brown85488032009-09-05 18:52:16 +01002743int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
2744 unsigned int freq_in, unsigned int freq_out)
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002745{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002746 if (dai->driver && dai->driver->ops->set_pll)
2747 return dai->driver->ops->set_pll(dai, pll_id, source,
Mark Brown85488032009-09-05 18:52:16 +01002748 freq_in, freq_out);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002749 else
2750 return -EINVAL;
2751}
2752EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
2753
2754/**
2755 * snd_soc_dai_set_fmt - configure DAI hardware audio format.
2756 * @dai: DAI
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002757 * @fmt: SND_SOC_DAIFMT_ format value.
2758 *
2759 * Configures the DAI hardware format and clocking.
2760 */
2761int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
2762{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002763 if (dai->driver && dai->driver->ops->set_fmt)
2764 return dai->driver->ops->set_fmt(dai, fmt);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002765 else
2766 return -EINVAL;
2767}
2768EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
2769
2770/**
2771 * snd_soc_dai_set_tdm_slot - configure DAI TDM.
2772 * @dai: DAI
Daniel Ribeiroa5479e32009-06-15 21:44:31 -03002773 * @tx_mask: bitmask representing active TX slots.
2774 * @rx_mask: bitmask representing active RX slots.
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002775 * @slots: Number of slots in use.
Daniel Ribeiroa5479e32009-06-15 21:44:31 -03002776 * @slot_width: Width in bits for each slot.
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002777 *
2778 * Configures a DAI for TDM operation. Both mask and slots are codec and DAI
2779 * specific.
2780 */
2781int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
Daniel Ribeiroa5479e32009-06-15 21:44:31 -03002782 unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002783{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002784 if (dai->driver && dai->driver->ops->set_tdm_slot)
2785 return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask,
Daniel Ribeiroa5479e32009-06-15 21:44:31 -03002786 slots, slot_width);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002787 else
2788 return -EINVAL;
2789}
2790EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
2791
2792/**
Barry Song472df3c2009-09-12 01:16:29 +08002793 * snd_soc_dai_set_channel_map - configure DAI audio channel map
2794 * @dai: DAI
2795 * @tx_num: how many TX channels
2796 * @tx_slot: pointer to an array which imply the TX slot number channel
2797 * 0~num-1 uses
2798 * @rx_num: how many RX channels
2799 * @rx_slot: pointer to an array which imply the RX slot number channel
2800 * 0~num-1 uses
2801 *
2802 * configure the relationship between channel number and TDM slot number.
2803 */
2804int snd_soc_dai_set_channel_map(struct snd_soc_dai *dai,
2805 unsigned int tx_num, unsigned int *tx_slot,
2806 unsigned int rx_num, unsigned int *rx_slot)
2807{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002808 if (dai->driver && dai->driver->ops->set_channel_map)
2809 return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot,
Barry Song472df3c2009-09-12 01:16:29 +08002810 rx_num, rx_slot);
2811 else
2812 return -EINVAL;
2813}
2814EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map);
2815
2816/**
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002817 * snd_soc_dai_set_tristate - configure DAI system or master clock.
2818 * @dai: DAI
2819 * @tristate: tristate enable
2820 *
2821 * Tristates the DAI so that others can use it.
2822 */
2823int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
2824{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002825 if (dai->driver && dai->driver->ops->set_tristate)
2826 return dai->driver->ops->set_tristate(dai, tristate);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002827 else
2828 return -EINVAL;
2829}
2830EXPORT_SYMBOL_GPL(snd_soc_dai_set_tristate);
2831
2832/**
2833 * snd_soc_dai_digital_mute - configure DAI system or master clock.
2834 * @dai: DAI
2835 * @mute: mute enable
2836 *
2837 * Mutes the DAI DAC.
2838 */
2839int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute)
2840{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002841 if (dai->driver && dai->driver->ops->digital_mute)
2842 return dai->driver->ops->digital_mute(dai, mute);
Liam Girdwood8c6529d2008-07-08 13:19:13 +01002843 else
2844 return -EINVAL;
2845}
2846EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
2847
Mark Brownc5af3a22008-11-28 13:29:45 +00002848/**
2849 * snd_soc_register_card - Register a card with the ASoC core
2850 *
Mark Brownac11a2b2009-01-01 12:18:17 +00002851 * @card: Card to register
Mark Brownc5af3a22008-11-28 13:29:45 +00002852 *
2853 * Note that currently this is an internal only function: it will be
2854 * exposed to machine drivers after further backporting of ASoC v2
2855 * registration APIs.
2856 */
2857static int snd_soc_register_card(struct snd_soc_card *card)
2858{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002859 int i;
2860
Mark Brownc5af3a22008-11-28 13:29:45 +00002861 if (!card->name || !card->dev)
2862 return -EINVAL;
2863
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002864 card->rtd = kzalloc(sizeof(struct snd_soc_pcm_runtime) * card->num_links,
2865 GFP_KERNEL);
2866 if (card->rtd == NULL)
2867 return -ENOMEM;
2868
2869 for (i = 0; i < card->num_links; i++)
2870 card->rtd[i].dai_link = &card->dai_link[i];
2871
Mark Brownc5af3a22008-11-28 13:29:45 +00002872 INIT_LIST_HEAD(&card->list);
2873 card->instantiated = 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002874 mutex_init(&card->mutex);
Mark Brownc5af3a22008-11-28 13:29:45 +00002875
2876 mutex_lock(&client_mutex);
2877 list_add(&card->list, &card_list);
Mark Brown435c5e22008-12-04 15:32:53 +00002878 snd_soc_instantiate_cards();
Mark Brownc5af3a22008-11-28 13:29:45 +00002879 mutex_unlock(&client_mutex);
2880
2881 dev_dbg(card->dev, "Registered card '%s'\n", card->name);
2882
2883 return 0;
2884}
2885
2886/**
2887 * snd_soc_unregister_card - Unregister a card with the ASoC core
2888 *
Mark Brownac11a2b2009-01-01 12:18:17 +00002889 * @card: Card to unregister
Mark Brownc5af3a22008-11-28 13:29:45 +00002890 *
2891 * Note that currently this is an internal only function: it will be
2892 * exposed to machine drivers after further backporting of ASoC v2
2893 * registration APIs.
2894 */
2895static int snd_soc_unregister_card(struct snd_soc_card *card)
2896{
2897 mutex_lock(&client_mutex);
2898 list_del(&card->list);
2899 mutex_unlock(&client_mutex);
Mark Brownc5af3a22008-11-28 13:29:45 +00002900 dev_dbg(card->dev, "Unregistered card '%s'\n", card->name);
2901
2902 return 0;
2903}
2904
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002905/*
2906 * Simplify DAI link configuration by removing ".-1" from device names
2907 * and sanitizing names.
2908 */
2909static inline char *fmt_single_name(struct device *dev, int *id)
2910{
2911 char *found, name[NAME_SIZE];
2912 int id1, id2;
2913
2914 if (dev_name(dev) == NULL)
2915 return NULL;
2916
2917 strncpy(name, dev_name(dev), NAME_SIZE);
2918
2919 /* are we a "%s.%d" name (platform and SPI components) */
2920 found = strstr(name, dev->driver->name);
2921 if (found) {
2922 /* get ID */
2923 if (sscanf(&found[strlen(dev->driver->name)], ".%d", id) == 1) {
2924
2925 /* discard ID from name if ID == -1 */
2926 if (*id == -1)
2927 found[strlen(dev->driver->name)] = '\0';
2928 }
2929
2930 } else {
2931 /* I2C component devices are named "bus-addr" */
2932 if (sscanf(name, "%x-%x", &id1, &id2) == 2) {
2933 char tmp[NAME_SIZE];
2934
2935 /* create unique ID number from I2C addr and bus */
Jarkko Nikula05899442010-10-19 11:10:45 +03002936 *id = ((id1 & 0xffff) << 16) + id2;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002937
2938 /* sanitize component name for DAI link creation */
2939 snprintf(tmp, NAME_SIZE, "%s.%s", dev->driver->name, name);
2940 strncpy(name, tmp, NAME_SIZE);
2941 } else
2942 *id = 0;
2943 }
2944
2945 return kstrdup(name, GFP_KERNEL);
2946}
2947
2948/*
2949 * Simplify DAI link naming for single devices with multiple DAIs by removing
2950 * any ".-1" and using the DAI name (instead of device name).
2951 */
2952static inline char *fmt_multiple_name(struct device *dev,
2953 struct snd_soc_dai_driver *dai_drv)
2954{
2955 if (dai_drv->name == NULL) {
2956 printk(KERN_ERR "asoc: error - multiple DAI %s registered with no name\n",
2957 dev_name(dev));
2958 return NULL;
2959 }
2960
2961 return kstrdup(dai_drv->name, GFP_KERNEL);
2962}
2963
Mark Brown91151712008-11-30 23:31:24 +00002964/**
2965 * snd_soc_register_dai - Register a DAI with the ASoC core
2966 *
Mark Brownac11a2b2009-01-01 12:18:17 +00002967 * @dai: DAI to register
Mark Brown91151712008-11-30 23:31:24 +00002968 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002969int snd_soc_register_dai(struct device *dev,
2970 struct snd_soc_dai_driver *dai_drv)
Mark Brown91151712008-11-30 23:31:24 +00002971{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002972 struct snd_soc_dai *dai;
Mark Brown91151712008-11-30 23:31:24 +00002973
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002974 dev_dbg(dev, "dai register %s\n", dev_name(dev));
Mark Brown91151712008-11-30 23:31:24 +00002975
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002976 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
2977 if (dai == NULL)
2978 return -ENOMEM;
Eric Miao6335d052009-03-03 09:41:00 +08002979
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00002980 /* create DAI component name */
2981 dai->name = fmt_single_name(dev, &dai->id);
2982 if (dai->name == NULL) {
2983 kfree(dai);
2984 return -ENOMEM;
2985 }
2986
2987 dai->dev = dev;
2988 dai->driver = dai_drv;
2989 if (!dai->driver->ops)
2990 dai->driver->ops = &null_dai_ops;
Mark Brown91151712008-11-30 23:31:24 +00002991
2992 mutex_lock(&client_mutex);
2993 list_add(&dai->list, &dai_list);
Mark Brown435c5e22008-12-04 15:32:53 +00002994 snd_soc_instantiate_cards();
Mark Brown91151712008-11-30 23:31:24 +00002995 mutex_unlock(&client_mutex);
2996
2997 pr_debug("Registered DAI '%s'\n", dai->name);
2998
2999 return 0;
3000}
3001EXPORT_SYMBOL_GPL(snd_soc_register_dai);
3002
3003/**
3004 * snd_soc_unregister_dai - Unregister a DAI from the ASoC core
3005 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003006 * @dai: DAI to unregister
Mark Brown91151712008-11-30 23:31:24 +00003007 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003008void snd_soc_unregister_dai(struct device *dev)
Mark Brown91151712008-11-30 23:31:24 +00003009{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003010 struct snd_soc_dai *dai;
3011
3012 list_for_each_entry(dai, &dai_list, list) {
3013 if (dev == dai->dev)
3014 goto found;
3015 }
3016 return;
3017
3018found:
Mark Brown91151712008-11-30 23:31:24 +00003019 mutex_lock(&client_mutex);
3020 list_del(&dai->list);
3021 mutex_unlock(&client_mutex);
3022
3023 pr_debug("Unregistered DAI '%s'\n", dai->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003024 kfree(dai->name);
3025 kfree(dai);
Mark Brown91151712008-11-30 23:31:24 +00003026}
3027EXPORT_SYMBOL_GPL(snd_soc_unregister_dai);
3028
3029/**
3030 * snd_soc_register_dais - Register multiple DAIs with the ASoC core
3031 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003032 * @dai: Array of DAIs to register
3033 * @count: Number of DAIs
Mark Brown91151712008-11-30 23:31:24 +00003034 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003035int snd_soc_register_dais(struct device *dev,
3036 struct snd_soc_dai_driver *dai_drv, size_t count)
Mark Brown91151712008-11-30 23:31:24 +00003037{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003038 struct snd_soc_dai *dai;
3039 int i, ret = 0;
3040
Liam Girdwood720ffa42010-08-18 00:30:30 +01003041 dev_dbg(dev, "dai register %s #%Zu\n", dev_name(dev), count);
Mark Brown91151712008-11-30 23:31:24 +00003042
3043 for (i = 0; i < count; i++) {
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003044
3045 dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
3046 if (dai == NULL)
3047 return -ENOMEM;
3048
3049 /* create DAI component name */
3050 dai->name = fmt_multiple_name(dev, &dai_drv[i]);
3051 if (dai->name == NULL) {
3052 kfree(dai);
3053 ret = -EINVAL;
Mark Brown91151712008-11-30 23:31:24 +00003054 goto err;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003055 }
3056
3057 dai->dev = dev;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003058 dai->driver = &dai_drv[i];
Mark Brown0f9141c2010-10-12 15:43:21 +01003059 if (dai->driver->id)
3060 dai->id = dai->driver->id;
3061 else
3062 dai->id = i;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003063 if (!dai->driver->ops)
3064 dai->driver->ops = &null_dai_ops;
3065
3066 mutex_lock(&client_mutex);
3067 list_add(&dai->list, &dai_list);
3068 mutex_unlock(&client_mutex);
3069
3070 pr_debug("Registered DAI '%s'\n", dai->name);
Mark Brown91151712008-11-30 23:31:24 +00003071 }
3072
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003073 snd_soc_instantiate_cards();
Mark Brown91151712008-11-30 23:31:24 +00003074 return 0;
3075
3076err:
3077 for (i--; i >= 0; i--)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003078 snd_soc_unregister_dai(dev);
Mark Brown91151712008-11-30 23:31:24 +00003079
3080 return ret;
3081}
3082EXPORT_SYMBOL_GPL(snd_soc_register_dais);
3083
3084/**
3085 * snd_soc_unregister_dais - Unregister multiple DAIs from the ASoC core
3086 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003087 * @dai: Array of DAIs to unregister
3088 * @count: Number of DAIs
Mark Brown91151712008-11-30 23:31:24 +00003089 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003090void snd_soc_unregister_dais(struct device *dev, size_t count)
Mark Brown91151712008-11-30 23:31:24 +00003091{
3092 int i;
3093
3094 for (i = 0; i < count; i++)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003095 snd_soc_unregister_dai(dev);
Mark Brown91151712008-11-30 23:31:24 +00003096}
3097EXPORT_SYMBOL_GPL(snd_soc_unregister_dais);
3098
Mark Brown12a48a8c2008-12-03 19:40:30 +00003099/**
3100 * snd_soc_register_platform - Register a platform with the ASoC core
3101 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003102 * @platform: platform to register
Mark Brown12a48a8c2008-12-03 19:40:30 +00003103 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003104int snd_soc_register_platform(struct device *dev,
3105 struct snd_soc_platform_driver *platform_drv)
Mark Brown12a48a8c2008-12-03 19:40:30 +00003106{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003107 struct snd_soc_platform *platform;
Mark Brown12a48a8c2008-12-03 19:40:30 +00003108
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003109 dev_dbg(dev, "platform register %s\n", dev_name(dev));
3110
3111 platform = kzalloc(sizeof(struct snd_soc_platform), GFP_KERNEL);
3112 if (platform == NULL)
3113 return -ENOMEM;
3114
3115 /* create platform component name */
3116 platform->name = fmt_single_name(dev, &platform->id);
3117 if (platform->name == NULL) {
3118 kfree(platform);
3119 return -ENOMEM;
3120 }
3121
3122 platform->dev = dev;
3123 platform->driver = platform_drv;
Mark Brown12a48a8c2008-12-03 19:40:30 +00003124
3125 mutex_lock(&client_mutex);
3126 list_add(&platform->list, &platform_list);
Mark Brown435c5e22008-12-04 15:32:53 +00003127 snd_soc_instantiate_cards();
Mark Brown12a48a8c2008-12-03 19:40:30 +00003128 mutex_unlock(&client_mutex);
3129
3130 pr_debug("Registered platform '%s'\n", platform->name);
3131
3132 return 0;
3133}
3134EXPORT_SYMBOL_GPL(snd_soc_register_platform);
3135
3136/**
3137 * snd_soc_unregister_platform - Unregister a platform from the ASoC core
3138 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003139 * @platform: platform to unregister
Mark Brown12a48a8c2008-12-03 19:40:30 +00003140 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003141void snd_soc_unregister_platform(struct device *dev)
Mark Brown12a48a8c2008-12-03 19:40:30 +00003142{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003143 struct snd_soc_platform *platform;
3144
3145 list_for_each_entry(platform, &platform_list, list) {
3146 if (dev == platform->dev)
3147 goto found;
3148 }
3149 return;
3150
3151found:
Mark Brown12a48a8c2008-12-03 19:40:30 +00003152 mutex_lock(&client_mutex);
3153 list_del(&platform->list);
3154 mutex_unlock(&client_mutex);
3155
3156 pr_debug("Unregistered platform '%s'\n", platform->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003157 kfree(platform->name);
3158 kfree(platform);
Mark Brown12a48a8c2008-12-03 19:40:30 +00003159}
3160EXPORT_SYMBOL_GPL(snd_soc_unregister_platform);
3161
Mark Brown151ab222009-05-09 16:22:58 +01003162static u64 codec_format_map[] = {
3163 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE,
3164 SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE,
3165 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S24_BE,
3166 SNDRV_PCM_FMTBIT_U24_LE | SNDRV_PCM_FMTBIT_U24_BE,
3167 SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE,
3168 SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE,
3169 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
3170 SNDRV_PCM_FMTBIT_U24_3LE | SNDRV_PCM_FMTBIT_U24_3BE,
3171 SNDRV_PCM_FMTBIT_S20_3LE | SNDRV_PCM_FMTBIT_S20_3BE,
3172 SNDRV_PCM_FMTBIT_U20_3LE | SNDRV_PCM_FMTBIT_U20_3BE,
3173 SNDRV_PCM_FMTBIT_S18_3LE | SNDRV_PCM_FMTBIT_S18_3BE,
3174 SNDRV_PCM_FMTBIT_U18_3LE | SNDRV_PCM_FMTBIT_U18_3BE,
3175 SNDRV_PCM_FMTBIT_FLOAT_LE | SNDRV_PCM_FMTBIT_FLOAT_BE,
3176 SNDRV_PCM_FMTBIT_FLOAT64_LE | SNDRV_PCM_FMTBIT_FLOAT64_BE,
3177 SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE
3178 | SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_BE,
3179};
3180
3181/* Fix up the DAI formats for endianness: codecs don't actually see
3182 * the endianness of the data but we're using the CPU format
3183 * definitions which do need to include endianness so we ensure that
3184 * codec DAIs always have both big and little endian variants set.
3185 */
3186static void fixup_codec_formats(struct snd_soc_pcm_stream *stream)
3187{
3188 int i;
3189
3190 for (i = 0; i < ARRAY_SIZE(codec_format_map); i++)
3191 if (stream->formats & codec_format_map[i])
3192 stream->formats |= codec_format_map[i];
3193}
3194
Mark Brown0d0cf002008-12-10 14:32:45 +00003195/**
3196 * snd_soc_register_codec - Register a codec with the ASoC core
3197 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003198 * @codec: codec to register
Mark Brown0d0cf002008-12-10 14:32:45 +00003199 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003200int snd_soc_register_codec(struct device *dev,
3201 struct snd_soc_codec_driver *codec_drv,
3202 struct snd_soc_dai_driver *dai_drv, int num_dai)
Mark Brown0d0cf002008-12-10 14:32:45 +00003203{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003204 struct snd_soc_codec *codec;
3205 int ret, i;
Mark Brown151ab222009-05-09 16:22:58 +01003206
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003207 dev_dbg(dev, "codec register %s\n", dev_name(dev));
Mark Brown0d0cf002008-12-10 14:32:45 +00003208
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003209 codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
3210 if (codec == NULL)
3211 return -ENOMEM;
Mark Brown0d0cf002008-12-10 14:32:45 +00003212
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003213 /* create CODEC component name */
3214 codec->name = fmt_single_name(dev, &codec->id);
3215 if (codec->name == NULL) {
3216 kfree(codec);
3217 return -ENOMEM;
Mark Brown151ab222009-05-09 16:22:58 +01003218 }
3219
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003220 /* allocate CODEC register cache */
3221 if (codec_drv->reg_cache_size && codec_drv->reg_word_size) {
3222
3223 if (codec_drv->reg_cache_default)
3224 codec->reg_cache = kmemdup(codec_drv->reg_cache_default,
3225 codec_drv->reg_cache_size * codec_drv->reg_word_size, GFP_KERNEL);
3226 else
3227 codec->reg_cache = kzalloc(codec_drv->reg_cache_size *
3228 codec_drv->reg_word_size, GFP_KERNEL);
3229
3230 if (codec->reg_cache == NULL) {
3231 kfree(codec->name);
3232 kfree(codec);
3233 return -ENOMEM;
3234 }
3235 }
3236
3237 codec->dev = dev;
3238 codec->driver = codec_drv;
3239 codec->bias_level = SND_SOC_BIAS_OFF;
3240 codec->num_dai = num_dai;
3241 mutex_init(&codec->mutex);
3242 INIT_LIST_HEAD(&codec->dapm_widgets);
3243 INIT_LIST_HEAD(&codec->dapm_paths);
3244
3245 for (i = 0; i < num_dai; i++) {
3246 fixup_codec_formats(&dai_drv[i].playback);
3247 fixup_codec_formats(&dai_drv[i].capture);
3248 }
3249
Mark Brown26b01cc2010-08-18 20:20:55 +01003250 /* register any DAIs */
3251 if (num_dai) {
3252 ret = snd_soc_register_dais(dev, dai_drv, num_dai);
3253 if (ret < 0)
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003254 goto error;
Mark Brown26b01cc2010-08-18 20:20:55 +01003255 }
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003256
Mark Brown0d0cf002008-12-10 14:32:45 +00003257 mutex_lock(&client_mutex);
3258 list_add(&codec->list, &codec_list);
3259 snd_soc_instantiate_cards();
3260 mutex_unlock(&client_mutex);
3261
3262 pr_debug("Registered codec '%s'\n", codec->name);
Mark Brown0d0cf002008-12-10 14:32:45 +00003263 return 0;
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003264
3265error:
3266 for (i--; i >= 0; i--)
3267 snd_soc_unregister_dai(dev);
3268
3269 if (codec->reg_cache)
3270 kfree(codec->reg_cache);
3271 kfree(codec->name);
3272 kfree(codec);
3273 return ret;
Mark Brown0d0cf002008-12-10 14:32:45 +00003274}
3275EXPORT_SYMBOL_GPL(snd_soc_register_codec);
3276
3277/**
3278 * snd_soc_unregister_codec - Unregister a codec from the ASoC core
3279 *
Mark Brownac11a2b2009-01-01 12:18:17 +00003280 * @codec: codec to unregister
Mark Brown0d0cf002008-12-10 14:32:45 +00003281 */
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003282void snd_soc_unregister_codec(struct device *dev)
Mark Brown0d0cf002008-12-10 14:32:45 +00003283{
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003284 struct snd_soc_codec *codec;
3285 int i;
3286
3287 list_for_each_entry(codec, &codec_list, list) {
3288 if (dev == codec->dev)
3289 goto found;
3290 }
3291 return;
3292
3293found:
Mark Brown26b01cc2010-08-18 20:20:55 +01003294 if (codec->num_dai)
3295 for (i = 0; i < codec->num_dai; i++)
3296 snd_soc_unregister_dai(dev);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003297
Mark Brown0d0cf002008-12-10 14:32:45 +00003298 mutex_lock(&client_mutex);
3299 list_del(&codec->list);
3300 mutex_unlock(&client_mutex);
3301
3302 pr_debug("Unregistered codec '%s'\n", codec->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003303
3304 if (codec->reg_cache)
3305 kfree(codec->reg_cache);
Dimitris Papastamos1aafcd42010-10-21 13:19:45 +01003306 kfree(codec->name);
Liam Girdwoodf0fba2a2010-03-17 20:15:21 +00003307 kfree(codec);
Mark Brown0d0cf002008-12-10 14:32:45 +00003308}
3309EXPORT_SYMBOL_GPL(snd_soc_unregister_codec);
3310
Takashi Iwaic9b3a402008-12-10 07:47:22 +01003311static int __init snd_soc_init(void)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003312{
Mark Brown384c89e2008-12-03 17:34:03 +00003313#ifdef CONFIG_DEBUG_FS
3314 debugfs_root = debugfs_create_dir("asoc", NULL);
3315 if (IS_ERR(debugfs_root) || !debugfs_root) {
3316 printk(KERN_WARNING
3317 "ASoC: Failed to create debugfs directory\n");
3318 debugfs_root = NULL;
3319 }
Mark Brownc3c5a192010-09-15 18:15:14 +01003320
3321 if (!debugfs_create_file("codecs", 0444, debugfs_root, NULL,
3322 &codec_list_fops))
3323 pr_warn("ASoC: Failed to create CODEC list debugfs file\n");
3324
Mark Brownf3208782010-09-15 18:19:07 +01003325 if (!debugfs_create_file("dais", 0444, debugfs_root, NULL,
3326 &dai_list_fops))
3327 pr_warn("ASoC: Failed to create DAI list debugfs file\n");
Mark Brown19c7ac22010-09-15 18:22:40 +01003328
3329 if (!debugfs_create_file("platforms", 0444, debugfs_root, NULL,
3330 &platform_list_fops))
3331 pr_warn("ASoC: Failed to create platform list debugfs file\n");
Mark Brown384c89e2008-12-03 17:34:03 +00003332#endif
3333
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003334 return platform_driver_register(&soc_driver);
3335}
Mark Brown4abe8e12010-10-12 17:41:03 +01003336module_init(snd_soc_init);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003337
Mark Brown7d8c16a2008-11-30 22:11:24 +00003338static void __exit snd_soc_exit(void)
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003339{
Mark Brown384c89e2008-12-03 17:34:03 +00003340#ifdef CONFIG_DEBUG_FS
3341 debugfs_remove_recursive(debugfs_root);
3342#endif
Mark Brown3ff3f642008-05-19 12:32:25 +02003343 platform_driver_unregister(&soc_driver);
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003344}
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003345module_exit(snd_soc_exit);
3346
3347/* Module information */
Liam Girdwoodd3311242008-10-12 13:17:36 +01003348MODULE_AUTHOR("Liam Girdwood, lrg@slimlogic.co.uk");
Frank Mandarinodb2a4162006-10-06 18:31:09 +02003349MODULE_DESCRIPTION("ALSA SoC Core");
3350MODULE_LICENSE("GPL");
Kay Sievers8b45a202008-04-14 13:33:36 +02003351MODULE_ALIAS("platform:soc-audio");