Merge commit 'v2.6.37-rc1' into for-2.6.37
[pandora-kernel.git] / sound / soc / soc-core.c
1 /*
2  * soc-core.c  --  ALSA SoC Audio Layer
3  *
4  * Copyright 2005 Wolfson Microelectronics PLC.
5  * Copyright 2005 Openedhand Ltd.
6  * Copyright (C) 2010 Slimlogic Ltd.
7  * Copyright (C) 2010 Texas Instruments Inc.
8  *
9  * Author: Liam Girdwood <lrg@slimlogic.co.uk>
10  *         with code, comments and ideas from :-
11  *         Richard Purdie <richard@openedhand.com>
12  *
13  *  This program is free software; you can redistribute  it and/or modify it
14  *  under  the terms of  the GNU General  Public License as published by the
15  *  Free Software Foundation;  either version 2 of the  License, or (at your
16  *  option) any later version.
17  *
18  *  TODO:
19  *   o Add hw rules to enforce rates, etc.
20  *   o More testing with other codecs/machines.
21  *   o Add more codecs and platforms to ensure good API coverage.
22  *   o Support TDM on PCM and I2S
23  */
24
25 #include <linux/module.h>
26 #include <linux/moduleparam.h>
27 #include <linux/init.h>
28 #include <linux/delay.h>
29 #include <linux/pm.h>
30 #include <linux/bitops.h>
31 #include <linux/debugfs.h>
32 #include <linux/platform_device.h>
33 #include <linux/slab.h>
34 #include <sound/ac97_codec.h>
35 #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
42 #define NAME_SIZE       32
43
44 static DEFINE_MUTEX(pcm_mutex);
45 static DECLARE_WAIT_QUEUE_HEAD(soc_pm_waitq);
46
47 #ifdef CONFIG_DEBUG_FS
48 static struct dentry *debugfs_root;
49 #endif
50
51 static DEFINE_MUTEX(client_mutex);
52 static LIST_HEAD(card_list);
53 static LIST_HEAD(dai_list);
54 static LIST_HEAD(platform_list);
55 static LIST_HEAD(codec_list);
56
57 static int snd_soc_register_card(struct snd_soc_card *card);
58 static int snd_soc_unregister_card(struct snd_soc_card *card);
59 static int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num);
60
61 /*
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  */
66 static int pmdown_time = 5000;
67 module_param(pmdown_time, int, 0);
68 MODULE_PARM_DESC(pmdown_time, "DAPM stream powerdown time (msecs)");
69
70 /*
71  * This function forces any delayed work to be queued and run.
72  */
73 static 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
89 /* codec register dump */
90 static ssize_t soc_codec_reg_show(struct snd_soc_codec *codec, char *buf)
91 {
92         int ret, i, step = 1, count = 0;
93
94         if (!codec->driver->reg_cache_size)
95                 return 0;
96
97         if (codec->driver->reg_cache_step)
98                 step = codec->driver->reg_cache_step;
99
100         count += sprintf(buf, "%s registers\n", codec->name);
101         for (i = 0; i < codec->driver->reg_cache_size; i += step) {
102                 if (codec->driver->readable_register && !codec->driver->readable_register(i))
103                         continue;
104
105                 count += sprintf(buf + count, "%2x: ", i);
106                 if (count >= PAGE_SIZE - 1)
107                         break;
108
109                 if (codec->driver->display_register) {
110                         count += codec->driver->display_register(codec, buf + count,
111                                                          PAGE_SIZE - count, i);
112                 } 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                          */
117                         ret = codec->driver->read(codec, i);
118                         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                 }
127
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 }
142 static ssize_t codec_reg_show(struct device *dev,
143         struct device_attribute *attr, char *buf)
144 {
145         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);
149 }
150
151 static DEVICE_ATTR(codec_reg, 0444, codec_reg_show, NULL);
152
153 static ssize_t pmdown_time_show(struct device *dev,
154                                 struct device_attribute *attr, char *buf)
155 {
156         struct snd_soc_pcm_runtime *rtd =
157                         container_of(dev, struct snd_soc_pcm_runtime, dev);
158
159         return sprintf(buf, "%ld\n", rtd->pmdown_time);
160 }
161
162 static ssize_t pmdown_time_set(struct device *dev,
163                                struct device_attribute *attr,
164                                const char *buf, size_t count)
165 {
166         struct snd_soc_pcm_runtime *rtd =
167                         container_of(dev, struct snd_soc_pcm_runtime, dev);
168         int ret;
169
170         ret = strict_strtol(buf, 10, &rtd->pmdown_time);
171         if (ret)
172                 return ret;
173
174         return count;
175 }
176
177 static DEVICE_ATTR(pmdown_time, 0644, pmdown_time_show, pmdown_time_set);
178
179 #ifdef CONFIG_DEBUG_FS
180 static int codec_reg_open_file(struct inode *inode, struct file *file)
181 {
182         file->private_data = inode->i_private;
183         return 0;
184 }
185
186 static 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
201 static 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
216         if (codec->driver->reg_cache_step)
217                 step = codec->driver->reg_cache_step;
218
219         while (*start == ' ')
220                 start++;
221         reg = simple_strtoul(start, &start, 16);
222         if ((reg >= codec->driver->reg_cache_size) || (reg % step))
223                 return -EINVAL;
224         while (*start == ' ')
225                 start++;
226         if (strict_strtoul(start, 16, &value))
227                 return -EINVAL;
228         codec->driver->write(codec, reg, value);
229         return buf_size;
230 }
231
232 static 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,
236         .llseek = default_llseek,
237 };
238
239 static void soc_init_codec_debugfs(struct snd_soc_codec *codec)
240 {
241         codec->debugfs_codec_root = debugfs_create_dir(codec->name ,
242                                                        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
256         codec->debugfs_pop_time = debugfs_create_u32("dapm_pop_time", 0644,
257                                                      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
272 static void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
273 {
274         debugfs_remove_recursive(codec->debugfs_codec_root);
275 }
276
277 static 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);
281         ssize_t len, ret = 0;
282         struct snd_soc_codec *codec;
283
284         if (!buf)
285                 return -ENOMEM;
286
287         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         }
297
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
306 static const struct file_operations codec_list_fops = {
307         .read = codec_list_read_file,
308         .llseek = default_llseek,/* read accesses f_pos */
309 };
310
311 static 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);
315         ssize_t len, ret = 0;
316         struct snd_soc_dai *dai;
317
318         if (!buf)
319                 return -ENOMEM;
320
321         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         }
330
331         ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
332
333         kfree(buf);
334
335         return ret;
336 }
337
338 static const struct file_operations dai_list_fops = {
339         .read = dai_list_read_file,
340         .llseek = default_llseek,/* read accesses f_pos */
341 };
342
343 static 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);
348         ssize_t len, ret = 0;
349         struct snd_soc_platform *platform;
350
351         if (!buf)
352                 return -ENOMEM;
353
354         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         }
364
365         ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
366
367         kfree(buf);
368
369         return ret;
370 }
371
372 static const struct file_operations platform_list_fops = {
373         .read = platform_list_read_file,
374         .llseek = default_llseek,/* read accesses f_pos */
375 };
376
377 #else
378
379 static inline void soc_init_codec_debugfs(struct snd_soc_codec *codec)
380 {
381 }
382
383 static inline void soc_cleanup_codec_debugfs(struct snd_soc_codec *codec)
384 {
385 }
386 #endif
387
388 #ifdef CONFIG_SND_SOC_AC97_BUS
389 /* unregister ac97 codec */
390 static 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 */
398 static void soc_ac97_device_release(struct device *dev){}
399
400 /* register ac97 codec to bus */
401 static int soc_ac97_dev_register(struct snd_soc_codec *codec)
402 {
403         int err;
404
405         codec->ac97->dev.bus = &ac97_bus_type;
406         codec->ac97->dev.parent = codec->card->dev;
407         codec->ac97->dev.release = soc_ac97_device_release;
408
409         dev_set_name(&codec->ac97->dev, "%d-%d:%s",
410                      codec->card->snd_card->number, 0, codec->name);
411         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
421 static int soc_pcm_apply_symmetry(struct snd_pcm_substream *substream)
422 {
423         struct snd_soc_pcm_runtime *rtd = substream->private_data;
424         struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
425         struct snd_soc_dai *codec_dai = rtd->codec_dai;
426         int ret;
427
428         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);
432
433                 ret = snd_pcm_hw_constraint_minmax(substream->runtime,
434                                                    SNDRV_PCM_HW_PARAM_RATE,
435                                                    rtd->rate,
436                                                    rtd->rate);
437                 if (ret < 0) {
438                         dev_err(&rtd->dev,
439                                 "Unable to apply rate symmetry constraint: %d\n", ret);
440                         return ret;
441                 }
442         }
443
444         return 0;
445 }
446
447 /*
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  */
452 static int soc_pcm_open(struct snd_pcm_substream *substream)
453 {
454         struct snd_soc_pcm_runtime *rtd = substream->private_data;
455         struct snd_pcm_runtime *runtime = substream->runtime;
456         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;
461         int ret = 0;
462
463         mutex_lock(&pcm_mutex);
464
465         /* startup the audio subsystem */
466         if (cpu_dai->driver->ops->startup) {
467                 ret = cpu_dai->driver->ops->startup(substream, cpu_dai);
468                 if (ret < 0) {
469                         printk(KERN_ERR "asoc: can't open interface %s\n",
470                                 cpu_dai->name);
471                         goto out;
472                 }
473         }
474
475         if (platform->driver->ops->open) {
476                 ret = platform->driver->ops->open(substream);
477                 if (ret < 0) {
478                         printk(KERN_ERR "asoc: can't open platform %s\n", platform->name);
479                         goto platform_err;
480                 }
481         }
482
483         if (codec_dai->driver->ops->startup) {
484                 ret = codec_dai->driver->ops->startup(substream, codec_dai);
485                 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
492         if (rtd->dai_link->ops && rtd->dai_link->ops->startup) {
493                 ret = rtd->dai_link->ops->startup(substream);
494                 if (ret < 0) {
495                         printk(KERN_ERR "asoc: %s startup failed\n", rtd->dai_link->name);
496                         goto machine_err;
497                 }
498         }
499
500         /* Check that the codec and cpu DAI's are compatible */
501         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
502                 runtime->hw.rate_min =
503                         max(codec_dai_drv->playback.rate_min,
504                             cpu_dai_drv->playback.rate_min);
505                 runtime->hw.rate_max =
506                         min(codec_dai_drv->playback.rate_max,
507                             cpu_dai_drv->playback.rate_max);
508                 runtime->hw.channels_min =
509                         max(codec_dai_drv->playback.channels_min,
510                                 cpu_dai_drv->playback.channels_min);
511                 runtime->hw.channels_max =
512                         min(codec_dai_drv->playback.channels_max,
513                                 cpu_dai_drv->playback.channels_max);
514                 runtime->hw.formats =
515                         codec_dai_drv->playback.formats & cpu_dai_drv->playback.formats;
516                 runtime->hw.rates =
517                         codec_dai_drv->playback.rates & cpu_dai_drv->playback.rates;
518                 if (codec_dai_drv->playback.rates
519                            & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
520                         runtime->hw.rates |= cpu_dai_drv->playback.rates;
521                 if (cpu_dai_drv->playback.rates
522                            & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
523                         runtime->hw.rates |= codec_dai_drv->playback.rates;
524         } else {
525                 runtime->hw.rate_min =
526                         max(codec_dai_drv->capture.rate_min,
527                             cpu_dai_drv->capture.rate_min);
528                 runtime->hw.rate_max =
529                         min(codec_dai_drv->capture.rate_max,
530                             cpu_dai_drv->capture.rate_max);
531                 runtime->hw.channels_min =
532                         max(codec_dai_drv->capture.channels_min,
533                                 cpu_dai_drv->capture.channels_min);
534                 runtime->hw.channels_max =
535                         min(codec_dai_drv->capture.channels_max,
536                                 cpu_dai_drv->capture.channels_max);
537                 runtime->hw.formats =
538                         codec_dai_drv->capture.formats & cpu_dai_drv->capture.formats;
539                 runtime->hw.rates =
540                         codec_dai_drv->capture.rates & cpu_dai_drv->capture.rates;
541                 if (codec_dai_drv->capture.rates
542                            & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
543                         runtime->hw.rates |= cpu_dai_drv->capture.rates;
544                 if (cpu_dai_drv->capture.rates
545                            & (SNDRV_PCM_RATE_KNOT | SNDRV_PCM_RATE_CONTINUOUS))
546                         runtime->hw.rates |= codec_dai_drv->capture.rates;
547         }
548
549         snd_pcm_limit_hw_rates(runtime);
550         if (!runtime->hw.rates) {
551                 printk(KERN_ERR "asoc: %s <-> %s No matching rates\n",
552                         codec_dai->name, cpu_dai->name);
553                 goto config_err;
554         }
555         if (!runtime->hw.formats) {
556                 printk(KERN_ERR "asoc: %s <-> %s No matching formats\n",
557                         codec_dai->name, cpu_dai->name);
558                 goto config_err;
559         }
560         if (!runtime->hw.channels_min || !runtime->hw.channels_max) {
561                 printk(KERN_ERR "asoc: %s <-> %s No matching channels\n",
562                                 codec_dai->name, cpu_dai->name);
563                 goto config_err;
564         }
565
566         /* 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)
570                         goto config_err;
571         }
572
573         pr_debug("asoc: %s <-> %s info:\n",
574                         codec_dai->name, cpu_dai->name);
575         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);
580
581         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
582                 cpu_dai->playback_active++;
583                 codec_dai->playback_active++;
584         } else {
585                 cpu_dai->capture_active++;
586                 codec_dai->capture_active++;
587         }
588         cpu_dai->active++;
589         codec_dai->active++;
590         rtd->codec->active++;
591         mutex_unlock(&pcm_mutex);
592         return 0;
593
594 config_err:
595         if (rtd->dai_link->ops && rtd->dai_link->ops->shutdown)
596                 rtd->dai_link->ops->shutdown(substream);
597
598 machine_err:
599         if (codec_dai->driver->ops->shutdown)
600                 codec_dai->driver->ops->shutdown(substream, codec_dai);
601
602 codec_dai_err:
603         if (platform->driver->ops->close)
604                 platform->driver->ops->close(substream);
605
606 platform_err:
607         if (cpu_dai->driver->ops->shutdown)
608                 cpu_dai->driver->ops->shutdown(substream, cpu_dai);
609 out:
610         mutex_unlock(&pcm_mutex);
611         return ret;
612 }
613
614 /*
615  * Power down the audio subsystem pmdown_time msecs after close is called.
616  * This is to ensure there are no pops or clicks in between any music tracks
617  * due to DAPM power cycling.
618  */
619 static void close_delayed_work(struct work_struct *work)
620 {
621         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;
624
625         mutex_lock(&pcm_mutex);
626
627         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");
631
632         /* 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);
638         }
639
640         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  */
648 static int soc_codec_close(struct snd_pcm_substream *substream)
649 {
650         struct snd_soc_pcm_runtime *rtd = substream->private_data;
651         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;
655
656         mutex_lock(&pcm_mutex);
657
658         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
659                 cpu_dai->playback_active--;
660                 codec_dai->playback_active--;
661         } else {
662                 cpu_dai->capture_active--;
663                 codec_dai->capture_active--;
664         }
665
666         cpu_dai->active--;
667         codec_dai->active--;
668         codec->active--;
669
670         /* 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
676         if (cpu_dai->driver->ops->shutdown)
677                 cpu_dai->driver->ops->shutdown(substream, cpu_dai);
678
679         if (codec_dai->driver->ops->shutdown)
680                 codec_dai->driver->ops->shutdown(substream, codec_dai);
681
682         if (rtd->dai_link->ops && rtd->dai_link->ops->shutdown)
683                 rtd->dai_link->ops->shutdown(substream);
684
685         if (platform->driver->ops->close)
686                 platform->driver->ops->close(substream);
687         cpu_dai->runtime = NULL;
688
689         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
690                 /* start delayed pop wq here for playback streams */
691                 codec_dai->pop_wait = 1;
692                 schedule_delayed_work(&rtd->delayed_work,
693                         msecs_to_jiffies(rtd->pmdown_time));
694         } else {
695                 /* capture streams can be powered down now */
696                 snd_soc_dapm_stream_event(rtd,
697                         codec_dai->driver->capture.stream_name,
698                         SND_SOC_DAPM_STREAM_STOP);
699         }
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  */
710 static int soc_pcm_prepare(struct snd_pcm_substream *substream)
711 {
712         struct snd_soc_pcm_runtime *rtd = substream->private_data;
713         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;
716         int ret = 0;
717
718         mutex_lock(&pcm_mutex);
719
720         if (rtd->dai_link->ops && rtd->dai_link->ops->prepare) {
721                 ret = rtd->dai_link->ops->prepare(substream);
722                 if (ret < 0) {
723                         printk(KERN_ERR "asoc: machine prepare error\n");
724                         goto out;
725                 }
726         }
727
728         if (platform->driver->ops->prepare) {
729                 ret = platform->driver->ops->prepare(substream);
730                 if (ret < 0) {
731                         printk(KERN_ERR "asoc: platform prepare error\n");
732                         goto out;
733                 }
734         }
735
736         if (codec_dai->driver->ops->prepare) {
737                 ret = codec_dai->driver->ops->prepare(substream, codec_dai);
738                 if (ret < 0) {
739                         printk(KERN_ERR "asoc: codec DAI prepare error\n");
740                         goto out;
741                 }
742         }
743
744         if (cpu_dai->driver->ops->prepare) {
745                 ret = cpu_dai->driver->ops->prepare(substream, cpu_dai);
746                 if (ret < 0) {
747                         printk(KERN_ERR "asoc: cpu DAI prepare error\n");
748                         goto out;
749                 }
750         }
751
752         /* 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;
756                 cancel_delayed_work(&rtd->delayed_work);
757         }
758
759         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
760                 snd_soc_dapm_stream_event(rtd,
761                                           codec_dai->driver->playback.stream_name,
762                                           SND_SOC_DAPM_STREAM_START);
763         else
764                 snd_soc_dapm_stream_event(rtd,
765                                           codec_dai->driver->capture.stream_name,
766                                           SND_SOC_DAPM_STREAM_START);
767
768         snd_soc_dai_digital_mute(codec_dai, 0);
769
770 out:
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  */
780 static 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;
784         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;
787         int ret = 0;
788
789         mutex_lock(&pcm_mutex);
790
791         if (rtd->dai_link->ops && rtd->dai_link->ops->hw_params) {
792                 ret = rtd->dai_link->ops->hw_params(substream, params);
793                 if (ret < 0) {
794                         printk(KERN_ERR "asoc: machine hw_params failed\n");
795                         goto out;
796                 }
797         }
798
799         if (codec_dai->driver->ops->hw_params) {
800                 ret = codec_dai->driver->ops->hw_params(substream, params, codec_dai);
801                 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
808         if (cpu_dai->driver->ops->hw_params) {
809                 ret = cpu_dai->driver->ops->hw_params(substream, params, cpu_dai);
810                 if (ret < 0) {
811                         printk(KERN_ERR "asoc: interface %s hw params failed\n",
812                                 cpu_dai->name);
813                         goto interface_err;
814                 }
815         }
816
817         if (platform->driver->ops->hw_params) {
818                 ret = platform->driver->ops->hw_params(substream, params);
819                 if (ret < 0) {
820                         printk(KERN_ERR "asoc: platform %s hw params failed\n",
821                                 platform->name);
822                         goto platform_err;
823                 }
824         }
825
826         rtd->rate = params_rate(params);
827
828 out:
829         mutex_unlock(&pcm_mutex);
830         return ret;
831
832 platform_err:
833         if (cpu_dai->driver->ops->hw_free)
834                 cpu_dai->driver->ops->hw_free(substream, cpu_dai);
835
836 interface_err:
837         if (codec_dai->driver->ops->hw_free)
838                 codec_dai->driver->ops->hw_free(substream, codec_dai);
839
840 codec_err:
841         if (rtd->dai_link->ops && rtd->dai_link->ops->hw_free)
842                 rtd->dai_link->ops->hw_free(substream);
843
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  */
851 static int soc_pcm_hw_free(struct snd_pcm_substream *substream)
852 {
853         struct snd_soc_pcm_runtime *rtd = substream->private_data;
854         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;
858
859         mutex_lock(&pcm_mutex);
860
861         /* apply codec digital mute */
862         if (!codec->active)
863                 snd_soc_dai_digital_mute(codec_dai, 1);
864
865         /* free any machine hw params */
866         if (rtd->dai_link->ops && rtd->dai_link->ops->hw_free)
867                 rtd->dai_link->ops->hw_free(substream);
868
869         /* free any DMA resources */
870         if (platform->driver->ops->hw_free)
871                 platform->driver->ops->hw_free(substream);
872
873         /* now free hw params for the DAI's  */
874         if (codec_dai->driver->ops->hw_free)
875                 codec_dai->driver->ops->hw_free(substream, codec_dai);
876
877         if (cpu_dai->driver->ops->hw_free)
878                 cpu_dai->driver->ops->hw_free(substream, cpu_dai);
879
880         mutex_unlock(&pcm_mutex);
881         return 0;
882 }
883
884 static int soc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
885 {
886         struct snd_soc_pcm_runtime *rtd = substream->private_data;
887         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;
890         int ret;
891
892         if (codec_dai->driver->ops->trigger) {
893                 ret = codec_dai->driver->ops->trigger(substream, cmd, codec_dai);
894                 if (ret < 0)
895                         return ret;
896         }
897
898         if (platform->driver->ops->trigger) {
899                 ret = platform->driver->ops->trigger(substream, cmd);
900                 if (ret < 0)
901                         return ret;
902         }
903
904         if (cpu_dai->driver->ops->trigger) {
905                 ret = cpu_dai->driver->ops->trigger(substream, cmd, cpu_dai);
906                 if (ret < 0)
907                         return ret;
908         }
909         return 0;
910 }
911
912 /*
913  * soc level wrapper for pointer callback
914  * If cpu_dai, codec_dai, platform driver has the delay callback, than
915  * the runtime->delay will be updated accordingly.
916  */
917 static snd_pcm_uframes_t soc_pcm_pointer(struct snd_pcm_substream *substream)
918 {
919         struct snd_soc_pcm_runtime *rtd = substream->private_data;
920         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;
923         struct snd_pcm_runtime *runtime = substream->runtime;
924         snd_pcm_uframes_t offset = 0;
925         snd_pcm_sframes_t delay = 0;
926
927         if (platform->driver->ops->pointer)
928                 offset = platform->driver->ops->pointer(substream);
929
930         if (cpu_dai->driver->ops->delay)
931                 delay += cpu_dai->driver->ops->delay(substream, cpu_dai);
932
933         if (codec_dai->driver->ops->delay)
934                 delay += codec_dai->driver->ops->delay(substream, codec_dai);
935
936         if (platform->driver->delay)
937                 delay += platform->driver->delay(substream, codec_dai);
938
939         runtime->delay = delay;
940
941         return offset;
942 }
943
944 /* ASoC PCM operations */
945 static 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,
952         .pointer        = soc_pcm_pointer,
953 };
954
955 #ifdef CONFIG_PM
956 /* powers down audio subsystem for suspend */
957 static int soc_suspend(struct device *dev)
958 {
959         struct platform_device *pdev = to_platform_device(dev);
960         struct snd_soc_card *card = platform_get_drvdata(pdev);
961         int i;
962
963         /* If the initialization of this soc device failed, there is no codec
964          * associated with it. Just bail out in this case.
965          */
966         if (list_empty(&card->codec_dev_list))
967                 return 0;
968
969         /* Due to the resume being scheduled into a workqueue we could
970         * suspend before that's finished - wait for it to complete.
971          */
972         snd_power_lock(card->snd_card);
973         snd_power_wait(card->snd_card, SNDRV_CTL_POWER_D0);
974         snd_power_unlock(card->snd_card);
975
976         /* we're going to block userspace touching us until resume completes */
977         snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D3hot);
978
979         /* mute any active DAC's */
980         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;
983
984                 if (card->rtd[i].dai_link->ignore_suspend)
985                         continue;
986
987                 if (drv->ops->digital_mute && dai->playback_active)
988                         drv->ops->digital_mute(dai, 1);
989         }
990
991         /* suspend all pcms */
992         for (i = 0; i < card->num_rtd; i++) {
993                 if (card->rtd[i].dai_link->ignore_suspend)
994                         continue;
995
996                 snd_pcm_suspend_all(card->rtd[i].pcm);
997         }
998
999         if (card->suspend_pre)
1000                 card->suspend_pre(pdev, PMSG_SUSPEND);
1001
1002         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;
1005
1006                 if (card->rtd[i].dai_link->ignore_suspend)
1007                         continue;
1008
1009                 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;
1014                 }
1015         }
1016
1017         /* 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         }
1022
1023         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)
1027                         continue;
1028
1029                 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);
1065         }
1066
1067         if (card->suspend_post)
1068                 card->suspend_post(pdev, PMSG_SUSPEND);
1069
1070         return 0;
1071 }
1072
1073 /* deferred resume work, so resume can complete before we finished
1074  * setting our codec back up, which can be very slow on I2C
1075  */
1076 static void soc_resume_deferred(struct work_struct *work)
1077 {
1078         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);
1081         int i;
1082
1083         /* our power state is still SNDRV_CTL_POWER_D3hot from suspend time,
1084          * so userspace apps are blocked from touching us
1085          */
1086
1087         dev_dbg(card->dev, "starting resume work\n");
1088
1089         /* Bring us up into D2 so that DAPM starts enabling things */
1090         snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D2);
1091
1092         if (card->resume_pre)
1093                 card->resume_pre(pdev);
1094
1095         /* resume AC97 DAIs */
1096         for (i = 0; i < card->num_rtd; i++) {
1097                 struct snd_soc_dai *cpu_dai = card->rtd[i].cpu_dai;
1098
1099                 if (card->rtd[i].dai_link->ignore_suspend)
1100                         continue;
1101
1102                 if (cpu_dai->driver->resume && cpu_dai->driver->ac97_control)
1103                         cpu_dai->driver->resume(cpu_dai);
1104         }
1105
1106         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                         }
1123                 }
1124         }
1125
1126         for (i = 0; i < card->num_rtd; i++) {
1127                 struct snd_soc_dai_driver *driver = card->rtd[i].codec_dai->driver;
1128
1129                 if (card->rtd[i].dai_link->ignore_suspend)
1130                         continue;
1131
1132                 if (driver->playback.stream_name != NULL)
1133                         snd_soc_dapm_stream_event(&card->rtd[i], driver->playback.stream_name,
1134                                 SND_SOC_DAPM_STREAM_RESUME);
1135
1136                 if (driver->capture.stream_name != NULL)
1137                         snd_soc_dapm_stream_event(&card->rtd[i], driver->capture.stream_name,
1138                                 SND_SOC_DAPM_STREAM_RESUME);
1139         }
1140
1141         /* unmute any active DACs */
1142         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;
1145
1146                 if (card->rtd[i].dai_link->ignore_suspend)
1147                         continue;
1148
1149                 if (drv->ops->digital_mute && dai->playback_active)
1150                         drv->ops->digital_mute(dai, 0);
1151         }
1152
1153         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;
1156
1157                 if (card->rtd[i].dai_link->ignore_suspend)
1158                         continue;
1159
1160                 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                 }
1166         }
1167
1168         if (card->resume_post)
1169                 card->resume_post(pdev);
1170
1171         dev_dbg(card->dev, "resume work completed\n");
1172
1173         /* userspace can access us now we are back as we were before */
1174         snd_power_change_state(card->snd_card, SNDRV_CTL_POWER_D0);
1175 }
1176
1177 /* powers up audio subsystem after a suspend */
1178 static int soc_resume(struct device *dev)
1179 {
1180         struct platform_device *pdev = to_platform_device(dev);
1181         struct snd_soc_card *card = platform_get_drvdata(pdev);
1182         int i;
1183
1184         /* 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          */
1189         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                 }
1199         }
1200
1201         return 0;
1202 }
1203 #else
1204 #define soc_suspend     NULL
1205 #define soc_resume      NULL
1206 #endif
1207
1208 static struct snd_soc_dai_ops null_dai_ops = {
1209 };
1210
1211 static int soc_bind_dai_link(struct snd_soc_card *card, int num)
1212 {
1213         struct snd_soc_dai_link *dai_link = &card->dai_link[num];
1214         struct snd_soc_pcm_runtime *rtd = &card->rtd[num];
1215         struct snd_soc_codec *codec;
1216         struct snd_soc_platform *platform;
1217         struct snd_soc_dai *codec_dai, *cpu_dai;
1218
1219         if (rtd->complete)
1220                 return 1;
1221         dev_dbg(card->dev, "binding %s at idx %d\n", dai_link->name, num);
1222
1223         /* 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;
1236                 }
1237         }
1238         dev_dbg(card->dev, "CPU DAI %s not registered\n",
1239                         dai_link->cpu_dai_name);
1240
1241 find_codec:
1242         /* do we already have the CODEC for this link ? */
1243         if (rtd->codec) {
1244                 goto find_platform;
1245         }
1246
1247         /* 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;
1251
1252                         if (!try_module_get(codec->dev->driver->owner))
1253                                 return -ENODEV;
1254
1255                         /* 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;
1261                                 }
1262                         }
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
1272 find_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
1293 out:
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
1302 static 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
1371 static void rtd_release(struct device *dev) {}
1372
1373 static 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                 }
1421
1422                 soc_init_codec_debugfs(codec);
1423
1424                 /* 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;
1452                         }
1453                 }
1454
1455                 /* 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);
1458         }
1459
1460         /* 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;
1469                 }
1470         }
1471
1472         /* Make sure all DAPM widgets are instantiated */
1473         snd_soc_dapm_new_widgets(codec);
1474         snd_soc_dapm_sync(codec);
1475
1476         /* register the rtd device */
1477         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;
1483         }
1484
1485         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
1500         /* 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
1515 static 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) {
1523                 /*
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;
1533
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
1545 static 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
1554 static 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
1587 #ifdef CONFIG_PM
1588         /* deferred resume work */
1589         INIT_WORK(&card->deferred_resume_work, soc_resume_deferred);
1590 #endif
1591
1592         /* 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
1599         for (i = 0; i < card->num_links; i++) {
1600                 ret = soc_probe_dai_link(card, i);
1601                 if (ret < 0) {
1602                         pr_err("asoc: failed to instantiate card %s: %d\n",
1603                                card->name, ret);
1604                         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]);
1623                         if (ret < 0) {
1624                                 printk(KERN_ERR "asoc: failed to register AC97 %s\n", card->name);
1625                                 goto probe_dai_err;
1626                         }
1627                 }
1628 #endif
1629
1630         card->instantiated = 1;
1631         mutex_unlock(&card->mutex);
1632         return;
1633
1634 probe_dai_err:
1635         for (i = 0; i < card->num_links; i++)
1636                 soc_remove_dai_link(card, i);
1637
1638 card_probe_error:
1639         if (card->remove)
1640                 card->remove(pdev);
1641
1642         snd_card_free(card->snd_card);
1643
1644         mutex_unlock(&card->mutex);
1645 }
1646
1647 /*
1648  * Attempt to initialise any uninitialised cards.  Must be called with
1649  * client_mutex.
1650  */
1651 static 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 */
1659 static int soc_probe(struct platform_device *pdev)
1660 {
1661         struct snd_soc_card *card = platform_get_drvdata(pdev);
1662         int ret = 0;
1663
1664         /* Bodge while we unpick instantiation */
1665         card->dev = &pdev->dev;
1666         INIT_LIST_HEAD(&card->dai_dev_list);
1667         INIT_LIST_HEAD(&card->codec_dev_list);
1668         INIT_LIST_HEAD(&card->platform_dev_list);
1669
1670         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;
1677 }
1678
1679 /* removes a socdev */
1680 static int soc_remove(struct platform_device *pdev)
1681 {
1682         struct snd_soc_card *card = platform_get_drvdata(pdev);
1683         int i;
1684
1685                 if (card->instantiated) {
1686
1687                 /* 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);
1691                 }
1692
1693                 /* 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 */
1698                 if (card->remove)
1699                         card->remove(pdev);
1700
1701                 kfree(card->rtd);
1702                 snd_card_free(card->snd_card);
1703         }
1704         snd_soc_unregister_card(card);
1705         return 0;
1706 }
1707
1708 static int soc_poweroff(struct device *dev)
1709 {
1710         struct platform_device *pdev = to_platform_device(dev);
1711         struct snd_soc_card *card = platform_get_drvdata(pdev);
1712         int i;
1713
1714         if (!card->instantiated)
1715                 return 0;
1716
1717         /* Flush out pmdown_time work - we actually do want to run it
1718          * now, we're shutting down so no imminent restart. */
1719         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         }
1723
1724         snd_soc_dapm_shutdown(card);
1725
1726         return 0;
1727 }
1728
1729 static const struct dev_pm_ops soc_pm_ops = {
1730         .suspend = soc_suspend,
1731         .resume = soc_resume,
1732         .poweroff = soc_poweroff,
1733 };
1734
1735 /* ASoC platform driver */
1736 static struct platform_driver soc_driver = {
1737         .driver         = {
1738                 .name           = "soc-audio",
1739                 .owner          = THIS_MODULE,
1740                 .pm             = &soc_pm_ops,
1741         },
1742         .probe          = soc_probe,
1743         .remove         = soc_remove,
1744 };
1745
1746 /* create a new pcm */
1747 static int soc_new_pcm(struct snd_soc_pcm_runtime *rtd, int num)
1748 {
1749         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;
1753         struct snd_pcm *pcm;
1754         char new_name[64];
1755         int ret = 0, playback = 0, capture = 0;
1756
1757         /* check client and interface hw capabilities */
1758         snprintf(new_name, sizeof(new_name), "%s %s-%d",
1759                         rtd->dai_link->stream_name, codec_dai->name, num);
1760
1761         if (codec_dai->driver->playback.channels_min)
1762                 playback = 1;
1763         if (codec_dai->driver->capture.channels_min)
1764                 capture = 1;
1765
1766         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);
1769         if (ret < 0) {
1770                 printk(KERN_ERR "asoc: can't create pcm for codec %s\n", codec->name);
1771                 return ret;
1772         }
1773
1774         rtd->pcm = pcm;
1775         pcm->private_data = rtd;
1776         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;
1783
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
1790         ret = platform->driver->pcm_new(rtd->card->snd_card, codec_dai, pcm);
1791         if (ret < 0) {
1792                 printk(KERN_ERR "asoc: platform pcm constructor failed\n");
1793                 return ret;
1794         }
1795
1796         pcm->private_free = platform->driver->pcm_free;
1797         printk(KERN_INFO "asoc: %s <-> %s mapping ok\n", codec_dai->name,
1798                 cpu_dai->name);
1799         return ret;
1800 }
1801
1802 /**
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  */
1810 int snd_soc_codec_volatile_register(struct snd_soc_codec *codec, int reg)
1811 {
1812         if (codec->driver->volatile_register)
1813                 return codec->driver->volatile_register(reg);
1814         else
1815                 return 0;
1816 }
1817 EXPORT_SYMBOL_GPL(snd_soc_codec_volatile_register);
1818
1819 /**
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  */
1827 int 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;
1848
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
1855         mutex_unlock(&codec->mutex);
1856         return 0;
1857 }
1858 EXPORT_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  */
1866 void snd_soc_free_ac97_codec(struct snd_soc_codec *codec)
1867 {
1868         mutex_lock(&codec->mutex);
1869 #ifdef CONFIG_SND_SOC_AC97_BUS
1870         soc_unregister_ac97_dai_link(codec);
1871 #endif
1872         kfree(codec->ac97->bus);
1873         kfree(codec->ac97);
1874         codec->ac97 = NULL;
1875         codec->ac97_created = 0;
1876         mutex_unlock(&codec->mutex);
1877 }
1878 EXPORT_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  */
1891 int snd_soc_update_bits(struct snd_soc_codec *codec, unsigned short reg,
1892                                 unsigned int mask, unsigned int value)
1893 {
1894         int change;
1895         unsigned int old, new;
1896
1897         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
1903         return change;
1904 }
1905 EXPORT_SYMBOL_GPL(snd_soc_update_bits);
1906
1907 /**
1908  * 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  */
1918 int snd_soc_update_bits_locked(struct snd_soc_codec *codec,
1919                                unsigned short reg, unsigned int mask,
1920                                unsigned int value)
1921 {
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 }
1930 EXPORT_SYMBOL_GPL(snd_soc_update_bits_locked);
1931
1932 /**
1933  * 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  */
1944 int snd_soc_test_bits(struct snd_soc_codec *codec, unsigned short reg,
1945                                 unsigned int mask, unsigned int value)
1946 {
1947         int change;
1948         unsigned int old, new;
1949
1950         old = snd_soc_read(codec, reg);
1951         new = (old & ~mask) | value;
1952         change = old != new;
1953
1954         return change;
1955 }
1956 EXPORT_SYMBOL_GPL(snd_soc_test_bits);
1957
1958 /**
1959  * 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  */
1965 int 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 }
1979 EXPORT_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
1985  * @long_name: control long name
1986  *
1987  * Create a new mixer control from a template control.
1988  *
1989  * Returns 0 for success, else error.
1990  */
1991 struct 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;
1999         template.index = 0;
2000
2001         return snd_ctl_new1(&template, data);
2002 }
2003 EXPORT_SYMBOL_GPL(snd_soc_cnew);
2004
2005 /**
2006  * 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  */
2016 int snd_soc_add_controls(struct snd_soc_codec *codec,
2017         const struct snd_kcontrol_new *controls, int num_controls)
2018 {
2019         struct snd_card *card = codec->card->snd_card;
2020         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) {
2026                         dev_err(codec->dev, "%s: Failed to add %s: %d\n",
2027                                 codec->name, control->name, err);
2028                         return err;
2029                 }
2030         }
2031
2032         return 0;
2033 }
2034 EXPORT_SYMBOL_GPL(snd_soc_add_controls);
2035
2036 /**
2037  * 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  */
2046 int 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;
2053         uinfo->value.enumerated.items = e->max;
2054
2055         if (uinfo->value.enumerated.item > e->max - 1)
2056                 uinfo->value.enumerated.item = e->max - 1;
2057         strcpy(uinfo->value.enumerated.name,
2058                 e->texts[uinfo->value.enumerated.item]);
2059         return 0;
2060 }
2061 EXPORT_SYMBOL_GPL(snd_soc_info_enum_double);
2062
2063 /**
2064  * snd_soc_get_enum_double - enumerated double mixer get callback
2065  * @kcontrol: mixer control
2066  * @ucontrol: control element information
2067  *
2068  * Callback to get the value of a double enumerated mixer.
2069  *
2070  * Returns 0 for success.
2071  */
2072 int 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;
2077         unsigned int val, bitmask;
2078
2079         for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2080                 ;
2081         val = snd_soc_read(codec, e->reg);
2082         ucontrol->value.enumerated.item[0]
2083                 = (val >> e->shift_l) & (bitmask - 1);
2084         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 }
2090 EXPORT_SYMBOL_GPL(snd_soc_get_enum_double);
2091
2092 /**
2093  * snd_soc_put_enum_double - enumerated double mixer put callback
2094  * @kcontrol: mixer control
2095  * @ucontrol: control element information
2096  *
2097  * Callback to set the value of a double enumerated mixer.
2098  *
2099  * Returns 0 for success.
2100  */
2101 int 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;
2106         unsigned int val;
2107         unsigned int mask, bitmask;
2108
2109         for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
2110                 ;
2111         if (ucontrol->value.enumerated.item[0] > e->max - 1)
2112                 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) {
2116                 if (ucontrol->value.enumerated.item[1] > e->max - 1)
2117                         return -EINVAL;
2118                 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
2119                 mask |= (bitmask - 1) << e->shift_r;
2120         }
2121
2122         return snd_soc_update_bits_locked(codec, e->reg, mask, val);
2123 }
2124 EXPORT_SYMBOL_GPL(snd_soc_put_enum_double);
2125
2126 /**
2127  * 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  */
2138 int 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);
2142         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2143         unsigned int reg_val, val, mux;
2144
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 }
2163 EXPORT_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  */
2177 int 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);
2181         struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
2182         unsigned int val;
2183         unsigned int mask;
2184
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
2196         return snd_soc_update_bits_locked(codec, e->reg, mask, val);
2197 }
2198 EXPORT_SYMBOL_GPL(snd_soc_put_value_enum_double);
2199
2200 /**
2201  * 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  */
2210 int 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;
2217         uinfo->value.enumerated.items = e->max;
2218
2219         if (uinfo->value.enumerated.item > e->max - 1)
2220                 uinfo->value.enumerated.item = e->max - 1;
2221         strcpy(uinfo->value.enumerated.name,
2222                 e->texts[uinfo->value.enumerated.item]);
2223         return 0;
2224 }
2225 EXPORT_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  */
2236 int snd_soc_info_volsw_ext(struct snd_kcontrol *kcontrol,
2237         struct snd_ctl_elem_info *uinfo)
2238 {
2239         int max = kcontrol->private_value;
2240
2241         if (max == 1 && !strstr(kcontrol->id.name, " Volume"))
2242                 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2243         else
2244                 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2245
2246         uinfo->count = 1;
2247         uinfo->value.integer.min = 0;
2248         uinfo->value.integer.max = max;
2249         return 0;
2250 }
2251 EXPORT_SYMBOL_GPL(snd_soc_info_volsw_ext);
2252
2253 /**
2254  * 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  */
2262 int snd_soc_info_volsw(struct snd_kcontrol *kcontrol,
2263         struct snd_ctl_elem_info *uinfo)
2264 {
2265         struct soc_mixer_control *mc =
2266                 (struct soc_mixer_control *)kcontrol->private_value;
2267         int platform_max;
2268         unsigned int shift = mc->shift;
2269         unsigned int rshift = mc->rshift;
2270
2271         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"))
2276                 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2277         else
2278                 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2279
2280         uinfo->count = shift == rshift ? 1 : 2;
2281         uinfo->value.integer.min = 0;
2282         uinfo->value.integer.max = platform_max;
2283         return 0;
2284 }
2285 EXPORT_SYMBOL_GPL(snd_soc_info_volsw);
2286
2287 /**
2288  * snd_soc_get_volsw - single mixer get callback
2289  * @kcontrol: mixer control
2290  * @ucontrol: control element information
2291  *
2292  * Callback to get the value of a single mixer control.
2293  *
2294  * Returns 0 for success.
2295  */
2296 int snd_soc_get_volsw(struct snd_kcontrol *kcontrol,
2297         struct snd_ctl_elem_value *ucontrol)
2298 {
2299         struct soc_mixer_control *mc =
2300                 (struct soc_mixer_control *)kcontrol->private_value;
2301         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2302         unsigned int reg = mc->reg;
2303         unsigned int shift = mc->shift;
2304         unsigned int rshift = mc->rshift;
2305         int max = mc->max;
2306         unsigned int mask = (1 << fls(max)) - 1;
2307         unsigned int invert = mc->invert;
2308
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] =
2316                         max - ucontrol->value.integer.value[0];
2317                 if (shift != rshift)
2318                         ucontrol->value.integer.value[1] =
2319                                 max - ucontrol->value.integer.value[1];
2320         }
2321
2322         return 0;
2323 }
2324 EXPORT_SYMBOL_GPL(snd_soc_get_volsw);
2325
2326 /**
2327  * snd_soc_put_volsw - single mixer put callback
2328  * @kcontrol: mixer control
2329  * @ucontrol: control element information
2330  *
2331  * Callback to set the value of a single mixer control.
2332  *
2333  * Returns 0 for success.
2334  */
2335 int snd_soc_put_volsw(struct snd_kcontrol *kcontrol,
2336         struct snd_ctl_elem_value *ucontrol)
2337 {
2338         struct soc_mixer_control *mc =
2339                 (struct soc_mixer_control *)kcontrol->private_value;
2340         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2341         unsigned int reg = mc->reg;
2342         unsigned int shift = mc->shift;
2343         unsigned int rshift = mc->rshift;
2344         int max = mc->max;
2345         unsigned int mask = (1 << fls(max)) - 1;
2346         unsigned int invert = mc->invert;
2347         unsigned int val, val2, val_mask;
2348
2349         val = (ucontrol->value.integer.value[0] & mask);
2350         if (invert)
2351                 val = max - val;
2352         val_mask = mask << shift;
2353         val = val << shift;
2354         if (shift != rshift) {
2355                 val2 = (ucontrol->value.integer.value[1] & mask);
2356                 if (invert)
2357                         val2 = max - val2;
2358                 val_mask |= mask << rshift;
2359                 val |= val2 << rshift;
2360         }
2361         return snd_soc_update_bits_locked(codec, reg, val_mask, val);
2362 }
2363 EXPORT_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  */
2375 int snd_soc_info_volsw_2r(struct snd_kcontrol *kcontrol,
2376         struct snd_ctl_elem_info *uinfo)
2377 {
2378         struct soc_mixer_control *mc =
2379                 (struct soc_mixer_control *)kcontrol->private_value;
2380         int platform_max;
2381
2382         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"))
2387                 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
2388         else
2389                 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2390
2391         uinfo->count = 2;
2392         uinfo->value.integer.min = 0;
2393         uinfo->value.integer.max = platform_max;
2394         return 0;
2395 }
2396 EXPORT_SYMBOL_GPL(snd_soc_info_volsw_2r);
2397
2398 /**
2399  * snd_soc_get_volsw_2r - double mixer get callback
2400  * @kcontrol: mixer control
2401  * @ucontrol: control element information
2402  *
2403  * Callback to get the value of a double mixer control that spans 2 registers.
2404  *
2405  * Returns 0 for success.
2406  */
2407 int snd_soc_get_volsw_2r(struct snd_kcontrol *kcontrol,
2408         struct snd_ctl_elem_value *ucontrol)
2409 {
2410         struct soc_mixer_control *mc =
2411                 (struct soc_mixer_control *)kcontrol->private_value;
2412         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2413         unsigned int reg = mc->reg;
2414         unsigned int reg2 = mc->rreg;
2415         unsigned int shift = mc->shift;
2416         int max = mc->max;
2417         unsigned int mask = (1 << fls(max)) - 1;
2418         unsigned int invert = mc->invert;
2419
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] =
2426                         max - ucontrol->value.integer.value[0];
2427                 ucontrol->value.integer.value[1] =
2428                         max - ucontrol->value.integer.value[1];
2429         }
2430
2431         return 0;
2432 }
2433 EXPORT_SYMBOL_GPL(snd_soc_get_volsw_2r);
2434
2435 /**
2436  * snd_soc_put_volsw_2r - double mixer set callback
2437  * @kcontrol: mixer control
2438  * @ucontrol: control element information
2439  *
2440  * Callback to set the value of a double mixer control that spans 2 registers.
2441  *
2442  * Returns 0 for success.
2443  */
2444 int snd_soc_put_volsw_2r(struct snd_kcontrol *kcontrol,
2445         struct snd_ctl_elem_value *ucontrol)
2446 {
2447         struct soc_mixer_control *mc =
2448                 (struct soc_mixer_control *)kcontrol->private_value;
2449         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2450         unsigned int reg = mc->reg;
2451         unsigned int reg2 = mc->rreg;
2452         unsigned int shift = mc->shift;
2453         int max = mc->max;
2454         unsigned int mask = (1 << fls(max)) - 1;
2455         unsigned int invert = mc->invert;
2456         int err;
2457         unsigned int val, val2, val_mask;
2458
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) {
2464                 val = max - val;
2465                 val2 = max - val2;
2466         }
2467
2468         val = val << shift;
2469         val2 = val2 << shift;
2470
2471         err = snd_soc_update_bits_locked(codec, reg, val_mask, val);
2472         if (err < 0)
2473                 return err;
2474
2475         err = snd_soc_update_bits_locked(codec, reg2, val_mask, val2);
2476         return err;
2477 }
2478 EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r);
2479
2480 /**
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  */
2489 int snd_soc_info_volsw_s8(struct snd_kcontrol *kcontrol,
2490         struct snd_ctl_elem_info *uinfo)
2491 {
2492         struct soc_mixer_control *mc =
2493                 (struct soc_mixer_control *)kcontrol->private_value;
2494         int platform_max;
2495         int min = mc->min;
2496
2497         if (!mc->platform_max)
2498                 mc->platform_max = mc->max;
2499         platform_max = mc->platform_max;
2500
2501         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2502         uinfo->count = 2;
2503         uinfo->value.integer.min = 0;
2504         uinfo->value.integer.max = platform_max - min;
2505         return 0;
2506 }
2507 EXPORT_SYMBOL_GPL(snd_soc_info_volsw_s8);
2508
2509 /**
2510  * snd_soc_get_volsw_s8 - signed mixer get callback
2511  * @kcontrol: mixer control
2512  * @ucontrol: control element information
2513  *
2514  * Callback to get the value of a signed mixer control.
2515  *
2516  * Returns 0 for success.
2517  */
2518 int snd_soc_get_volsw_s8(struct snd_kcontrol *kcontrol,
2519         struct snd_ctl_elem_value *ucontrol)
2520 {
2521         struct soc_mixer_control *mc =
2522                 (struct soc_mixer_control *)kcontrol->private_value;
2523         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2524         unsigned int reg = mc->reg;
2525         int min = mc->min;
2526         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 }
2534 EXPORT_SYMBOL_GPL(snd_soc_get_volsw_s8);
2535
2536 /**
2537  * snd_soc_put_volsw_sgn - signed mixer put callback
2538  * @kcontrol: mixer control
2539  * @ucontrol: control element information
2540  *
2541  * Callback to set the value of a signed mixer control.
2542  *
2543  * Returns 0 for success.
2544  */
2545 int snd_soc_put_volsw_s8(struct snd_kcontrol *kcontrol,
2546         struct snd_ctl_elem_value *ucontrol)
2547 {
2548         struct soc_mixer_control *mc =
2549                 (struct soc_mixer_control *)kcontrol->private_value;
2550         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2551         unsigned int reg = mc->reg;
2552         int min = mc->min;
2553         unsigned int val;
2554
2555         val = (ucontrol->value.integer.value[0]+min) & 0xff;
2556         val |= ((ucontrol->value.integer.value[1]+min) & 0xff) << 8;
2557
2558         return snd_soc_update_bits_locked(codec, reg, 0xffff, val);
2559 }
2560 EXPORT_SYMBOL_GPL(snd_soc_put_volsw_s8);
2561
2562 /**
2563  * 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  */
2571 int snd_soc_limit_volume(struct snd_soc_codec *codec,
2572         const char *name, int max)
2573 {
2574         struct snd_card *card = codec->card->snd_card;
2575         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) {
2593                         mc->platform_max = max;
2594                         ret = 0;
2595                 }
2596         }
2597         return ret;
2598 }
2599 EXPORT_SYMBOL_GPL(snd_soc_limit_volume);
2600
2601 /**
2602  * 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  */
2609 int 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 }
2624 EXPORT_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  */
2634 int 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
2645         ucontrol->value.integer.value[0] = ((val & 0xff)-min) & mask;
2646         ucontrol->value.integer.value[1] = ((valr & 0xff)-min) & mask;
2647         return 0;
2648 }
2649 EXPORT_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  */
2659 int 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)
2682                         return ret;
2683         }
2684         if (ovalr != valr) {
2685                 ret = snd_soc_write(codec, mc->rreg, valr);
2686                 if (ret < 0)
2687                         return ret;
2688         }
2689
2690         return 0;
2691 }
2692 EXPORT_SYMBOL_GPL(snd_soc_put_volsw_2r_sx);
2693
2694 /**
2695  * 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  */
2703 int snd_soc_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id,
2704         unsigned int freq, int dir)
2705 {
2706         if (dai->driver && dai->driver->ops->set_sysclk)
2707                 return dai->driver->ops->set_sysclk(dai, clk_id, freq, dir);
2708         else
2709                 return -EINVAL;
2710 }
2711 EXPORT_SYMBOL_GPL(snd_soc_dai_set_sysclk);
2712
2713 /**
2714  * snd_soc_dai_set_clkdiv - configure DAI clock dividers.
2715  * @dai: DAI
2716  * @div_id: DAI specific clock divider ID
2717  * @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  */
2723 int snd_soc_dai_set_clkdiv(struct snd_soc_dai *dai,
2724         int div_id, int div)
2725 {
2726         if (dai->driver && dai->driver->ops->set_clkdiv)
2727                 return dai->driver->ops->set_clkdiv(dai, div_id, div);
2728         else
2729                 return -EINVAL;
2730 }
2731 EXPORT_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
2737  * @source: DAI specific source for the PLL
2738  * @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  */
2743 int snd_soc_dai_set_pll(struct snd_soc_dai *dai, int pll_id, int source,
2744         unsigned int freq_in, unsigned int freq_out)
2745 {
2746         if (dai->driver && dai->driver->ops->set_pll)
2747                 return dai->driver->ops->set_pll(dai, pll_id, source,
2748                                          freq_in, freq_out);
2749         else
2750                 return -EINVAL;
2751 }
2752 EXPORT_SYMBOL_GPL(snd_soc_dai_set_pll);
2753
2754 /**
2755  * snd_soc_dai_set_fmt - configure DAI hardware audio format.
2756  * @dai: DAI
2757  * @fmt: SND_SOC_DAIFMT_ format value.
2758  *
2759  * Configures the DAI hardware format and clocking.
2760  */
2761 int snd_soc_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
2762 {
2763         if (dai->driver && dai->driver->ops->set_fmt)
2764                 return dai->driver->ops->set_fmt(dai, fmt);
2765         else
2766                 return -EINVAL;
2767 }
2768 EXPORT_SYMBOL_GPL(snd_soc_dai_set_fmt);
2769
2770 /**
2771  * snd_soc_dai_set_tdm_slot - configure DAI TDM.
2772  * @dai: DAI
2773  * @tx_mask: bitmask representing active TX slots.
2774  * @rx_mask: bitmask representing active RX slots.
2775  * @slots: Number of slots in use.
2776  * @slot_width: Width in bits for each slot.
2777  *
2778  * Configures a DAI for TDM operation. Both mask and slots are codec and DAI
2779  * specific.
2780  */
2781 int snd_soc_dai_set_tdm_slot(struct snd_soc_dai *dai,
2782         unsigned int tx_mask, unsigned int rx_mask, int slots, int slot_width)
2783 {
2784         if (dai->driver && dai->driver->ops->set_tdm_slot)
2785                 return dai->driver->ops->set_tdm_slot(dai, tx_mask, rx_mask,
2786                                 slots, slot_width);
2787         else
2788                 return -EINVAL;
2789 }
2790 EXPORT_SYMBOL_GPL(snd_soc_dai_set_tdm_slot);
2791
2792 /**
2793  * 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  */
2804 int 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 {
2808         if (dai->driver && dai->driver->ops->set_channel_map)
2809                 return dai->driver->ops->set_channel_map(dai, tx_num, tx_slot,
2810                         rx_num, rx_slot);
2811         else
2812                 return -EINVAL;
2813 }
2814 EXPORT_SYMBOL_GPL(snd_soc_dai_set_channel_map);
2815
2816 /**
2817  * 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  */
2823 int snd_soc_dai_set_tristate(struct snd_soc_dai *dai, int tristate)
2824 {
2825         if (dai->driver && dai->driver->ops->set_tristate)
2826                 return dai->driver->ops->set_tristate(dai, tristate);
2827         else
2828                 return -EINVAL;
2829 }
2830 EXPORT_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  */
2839 int snd_soc_dai_digital_mute(struct snd_soc_dai *dai, int mute)
2840 {
2841         if (dai->driver && dai->driver->ops->digital_mute)
2842                 return dai->driver->ops->digital_mute(dai, mute);
2843         else
2844                 return -EINVAL;
2845 }
2846 EXPORT_SYMBOL_GPL(snd_soc_dai_digital_mute);
2847
2848 /**
2849  * snd_soc_register_card - Register a card with the ASoC core
2850  *
2851  * @card: Card to register
2852  *
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  */
2857 static int snd_soc_register_card(struct snd_soc_card *card)
2858 {
2859         int i;
2860
2861         if (!card->name || !card->dev)
2862                 return -EINVAL;
2863
2864         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
2872         INIT_LIST_HEAD(&card->list);
2873         card->instantiated = 0;
2874         mutex_init(&card->mutex);
2875
2876         mutex_lock(&client_mutex);
2877         list_add(&card->list, &card_list);
2878         snd_soc_instantiate_cards();
2879         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  *
2889  * @card: Card to unregister
2890  *
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  */
2895 static 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);
2900         dev_dbg(card->dev, "Unregistered card '%s'\n", card->name);
2901
2902         return 0;
2903 }
2904
2905 /*
2906  * Simplify DAI link configuration by removing ".-1" from device names
2907  * and sanitizing names.
2908  */
2909 static 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 */
2936                         *id = ((id1 & 0xffff) << 16) + id2;
2937
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  */
2952 static 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
2964 /**
2965  * snd_soc_register_dai - Register a DAI with the ASoC core
2966  *
2967  * @dai: DAI to register
2968  */
2969 int snd_soc_register_dai(struct device *dev,
2970                 struct snd_soc_dai_driver *dai_drv)
2971 {
2972         struct snd_soc_dai *dai;
2973
2974         dev_dbg(dev, "dai register %s\n", dev_name(dev));
2975
2976         dai = kzalloc(sizeof(struct snd_soc_dai), GFP_KERNEL);
2977         if (dai == NULL)
2978                         return -ENOMEM;
2979
2980         /* 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;
2991
2992         mutex_lock(&client_mutex);
2993         list_add(&dai->list, &dai_list);
2994         snd_soc_instantiate_cards();
2995         mutex_unlock(&client_mutex);
2996
2997         pr_debug("Registered DAI '%s'\n", dai->name);
2998
2999         return 0;
3000 }
3001 EXPORT_SYMBOL_GPL(snd_soc_register_dai);
3002
3003 /**
3004  * snd_soc_unregister_dai - Unregister a DAI from the ASoC core
3005  *
3006  * @dai: DAI to unregister
3007  */
3008 void snd_soc_unregister_dai(struct device *dev)
3009 {
3010         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
3018 found:
3019         mutex_lock(&client_mutex);
3020         list_del(&dai->list);
3021         mutex_unlock(&client_mutex);
3022
3023         pr_debug("Unregistered DAI '%s'\n", dai->name);
3024         kfree(dai->name);
3025         kfree(dai);
3026 }
3027 EXPORT_SYMBOL_GPL(snd_soc_unregister_dai);
3028
3029 /**
3030  * snd_soc_register_dais - Register multiple DAIs with the ASoC core
3031  *
3032  * @dai: Array of DAIs to register
3033  * @count: Number of DAIs
3034  */
3035 int snd_soc_register_dais(struct device *dev,
3036                 struct snd_soc_dai_driver *dai_drv, size_t count)
3037 {
3038         struct snd_soc_dai *dai;
3039         int i, ret = 0;
3040
3041         dev_dbg(dev, "dai register %s #%Zu\n", dev_name(dev), count);
3042
3043         for (i = 0; i < count; i++) {
3044
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;
3054                         goto err;
3055                 }
3056
3057                 dai->dev = dev;
3058                 dai->driver = &dai_drv[i];
3059                 if (dai->driver->id)
3060                         dai->id = dai->driver->id;
3061                 else
3062                         dai->id = i;
3063                 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);
3071         }
3072
3073         snd_soc_instantiate_cards();
3074         return 0;
3075
3076 err:
3077         for (i--; i >= 0; i--)
3078                 snd_soc_unregister_dai(dev);
3079
3080         return ret;
3081 }
3082 EXPORT_SYMBOL_GPL(snd_soc_register_dais);
3083
3084 /**
3085  * snd_soc_unregister_dais - Unregister multiple DAIs from the ASoC core
3086  *
3087  * @dai: Array of DAIs to unregister
3088  * @count: Number of DAIs
3089  */
3090 void snd_soc_unregister_dais(struct device *dev, size_t count)
3091 {
3092         int i;
3093
3094         for (i = 0; i < count; i++)
3095                 snd_soc_unregister_dai(dev);
3096 }
3097 EXPORT_SYMBOL_GPL(snd_soc_unregister_dais);
3098
3099 /**
3100  * snd_soc_register_platform - Register a platform with the ASoC core
3101  *
3102  * @platform: platform to register
3103  */
3104 int snd_soc_register_platform(struct device *dev,
3105                 struct snd_soc_platform_driver *platform_drv)
3106 {
3107         struct snd_soc_platform *platform;
3108
3109         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;
3124
3125         mutex_lock(&client_mutex);
3126         list_add(&platform->list, &platform_list);
3127         snd_soc_instantiate_cards();
3128         mutex_unlock(&client_mutex);
3129
3130         pr_debug("Registered platform '%s'\n", platform->name);
3131
3132         return 0;
3133 }
3134 EXPORT_SYMBOL_GPL(snd_soc_register_platform);
3135
3136 /**
3137  * snd_soc_unregister_platform - Unregister a platform from the ASoC core
3138  *
3139  * @platform: platform to unregister
3140  */
3141 void snd_soc_unregister_platform(struct device *dev)
3142 {
3143         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
3151 found:
3152         mutex_lock(&client_mutex);
3153         list_del(&platform->list);
3154         mutex_unlock(&client_mutex);
3155
3156         pr_debug("Unregistered platform '%s'\n", platform->name);
3157         kfree(platform->name);
3158         kfree(platform);
3159 }
3160 EXPORT_SYMBOL_GPL(snd_soc_unregister_platform);
3161
3162 static 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  */
3186 static 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
3195 /**
3196  * snd_soc_register_codec - Register a codec with the ASoC core
3197  *
3198  * @codec: codec to register
3199  */
3200 int 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)
3203 {
3204         struct snd_soc_codec *codec;
3205         int ret, i;
3206
3207         dev_dbg(dev, "codec register %s\n", dev_name(dev));
3208
3209         codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
3210         if (codec == NULL)
3211                 return -ENOMEM;
3212
3213         /* create CODEC component name */
3214         codec->name = fmt_single_name(dev, &codec->id);
3215         if (codec->name == NULL) {
3216                 kfree(codec);
3217                 return -ENOMEM;
3218         }
3219
3220         /* 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
3250         /* register any DAIs */
3251         if (num_dai) {
3252                 ret = snd_soc_register_dais(dev, dai_drv, num_dai);
3253                 if (ret < 0)
3254                         goto error;
3255         }
3256
3257         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);
3263         return 0;
3264
3265 error:
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;
3274 }