ASoC: wm8904: fix DSP mode B configuration
[pandora-kernel.git] / sound / soc / soc-utils.c
1 /*
2  * soc-util.c  --  ALSA SoC Audio Layer utility functions
3  *
4  * Copyright 2009 Wolfson Microelectronics PLC.
5  *
6  * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
7  *         Liam Girdwood <lrg@slimlogic.co.uk>
8  *         
9  *
10  *  This program is free software; you can redistribute  it and/or modify it
11  *  under  the terms of  the GNU General  Public License as published by the
12  *  Free Software Foundation;  either version 2 of the  License, or (at your
13  *  option) any later version.
14  */
15
16 #include <linux/platform_device.h>
17 #include <linux/export.h>
18 #include <sound/core.h>
19 #include <sound/pcm.h>
20 #include <sound/pcm_params.h>
21 #include <sound/soc.h>
22
23 int snd_soc_calc_frame_size(int sample_size, int channels, int tdm_slots)
24 {
25         return sample_size * channels * tdm_slots;
26 }
27 EXPORT_SYMBOL_GPL(snd_soc_calc_frame_size);
28
29 int snd_soc_params_to_frame_size(struct snd_pcm_hw_params *params)
30 {
31         int sample_size;
32
33         sample_size = snd_pcm_format_width(params_format(params));
34         if (sample_size < 0)
35                 return sample_size;
36
37         return snd_soc_calc_frame_size(sample_size, params_channels(params),
38                                        1);
39 }
40 EXPORT_SYMBOL_GPL(snd_soc_params_to_frame_size);
41
42 int snd_soc_calc_bclk(int fs, int sample_size, int channels, int tdm_slots)
43 {
44         return fs * snd_soc_calc_frame_size(sample_size, channels, tdm_slots);
45 }
46 EXPORT_SYMBOL_GPL(snd_soc_calc_bclk);
47
48 int snd_soc_params_to_bclk(struct snd_pcm_hw_params *params)
49 {
50         int ret;
51
52         ret = snd_soc_params_to_frame_size(params);
53
54         if (ret > 0)
55                 return ret * params_rate(params);
56         else
57                 return ret;
58 }
59 EXPORT_SYMBOL_GPL(snd_soc_params_to_bclk);
60
61 static const struct snd_pcm_hardware dummy_dma_hardware = {
62         .formats                = 0xffffffff,
63         .channels_min           = 1,
64         .channels_max           = UINT_MAX,
65
66         /* Random values to keep userspace happy when checking constraints */
67         .info                   = SNDRV_PCM_INFO_INTERLEAVED |
68                                   SNDRV_PCM_INFO_BLOCK_TRANSFER,
69         .buffer_bytes_max       = 128*1024,
70         .period_bytes_min       = PAGE_SIZE,
71         .period_bytes_max       = PAGE_SIZE*2,
72         .periods_min            = 2,
73         .periods_max            = 128,
74 };
75
76 static int dummy_dma_open(struct snd_pcm_substream *substream)
77 {
78         struct snd_soc_pcm_runtime *rtd = substream->private_data;
79
80         /* BE's dont need dummy params */
81         if (!rtd->dai_link->no_pcm)
82                 snd_soc_set_runtime_hwparams(substream, &dummy_dma_hardware);
83
84         return 0;
85 }
86
87 static struct snd_pcm_ops dummy_dma_ops = {
88         .open           = dummy_dma_open,
89         .ioctl          = snd_pcm_lib_ioctl,
90 };
91
92 static struct snd_soc_platform_driver dummy_platform = {
93         .ops = &dummy_dma_ops,
94 };
95
96 static struct snd_soc_codec_driver dummy_codec;
97
98 #define STUB_RATES      SNDRV_PCM_RATE_8000_192000
99 #define STUB_FORMATS    (SNDRV_PCM_FMTBIT_S8 | \
100                         SNDRV_PCM_FMTBIT_U8 | \
101                         SNDRV_PCM_FMTBIT_S16_LE | \
102                         SNDRV_PCM_FMTBIT_U16_LE | \
103                         SNDRV_PCM_FMTBIT_S24_LE | \
104                         SNDRV_PCM_FMTBIT_U24_LE | \
105                         SNDRV_PCM_FMTBIT_S32_LE | \
106                         SNDRV_PCM_FMTBIT_U32_LE | \
107                         SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE)
108 static struct snd_soc_dai_driver dummy_dai = {
109         .name = "snd-soc-dummy-dai",
110         .playback = {
111                 .stream_name    = "Playback",
112                 .channels_min   = 1,
113                 .channels_max   = 384,
114                 .rates          = STUB_RATES,
115                 .formats        = STUB_FORMATS,
116         },
117         .capture = {
118                 .stream_name    = "Capture",
119                 .channels_min   = 1,
120                 .channels_max   = 384,
121                 .rates = STUB_RATES,
122                 .formats = STUB_FORMATS,
123          },
124 };
125
126 static int snd_soc_dummy_probe(struct platform_device *pdev)
127 {
128         int ret;
129
130         ret = snd_soc_register_codec(&pdev->dev, &dummy_codec, &dummy_dai, 1);
131         if (ret < 0)
132                 return ret;
133
134         ret = snd_soc_register_platform(&pdev->dev, &dummy_platform);
135         if (ret < 0) {
136                 snd_soc_unregister_codec(&pdev->dev);
137                 return ret;
138         }
139
140         return ret;
141 }
142
143 static int snd_soc_dummy_remove(struct platform_device *pdev)
144 {
145         snd_soc_unregister_platform(&pdev->dev);
146         snd_soc_unregister_codec(&pdev->dev);
147
148         return 0;
149 }
150
151 static struct platform_driver soc_dummy_driver = {
152         .driver = {
153                 .name = "snd-soc-dummy",
154                 .owner = THIS_MODULE,
155         },
156         .probe = snd_soc_dummy_probe,
157         .remove = snd_soc_dummy_remove,
158 };
159
160 static struct platform_device *soc_dummy_dev;
161
162 int __init snd_soc_util_init(void)
163 {
164         int ret;
165
166         soc_dummy_dev =
167                 platform_device_register_simple("snd-soc-dummy", -1, NULL, 0);
168         if (IS_ERR(soc_dummy_dev))
169                 return PTR_ERR(soc_dummy_dev);
170
171         ret = platform_driver_register(&soc_dummy_driver);
172         if (ret != 0)
173                 platform_device_unregister(soc_dummy_dev);
174
175         return ret;
176 }
177
178 void __exit snd_soc_util_exit(void)
179 {
180         platform_device_unregister(soc_dummy_dev);
181         platform_driver_unregister(&soc_dummy_driver);
182 }