Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / 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         /* Random values to keep userspace happy when checking constraints */
63         .info                   = SNDRV_PCM_INFO_INTERLEAVED |
64                                   SNDRV_PCM_INFO_BLOCK_TRANSFER,
65         .buffer_bytes_max       = 128*1024,
66         .period_bytes_min       = PAGE_SIZE,
67         .period_bytes_max       = PAGE_SIZE*2,
68         .periods_min            = 2,
69         .periods_max            = 128,
70 };
71
72 static int dummy_dma_open(struct snd_pcm_substream *substream)
73 {
74         struct snd_soc_pcm_runtime *rtd = substream->private_data;
75
76         /* BE's dont need dummy params */
77         if (!rtd->dai_link->no_pcm)
78                 snd_soc_set_runtime_hwparams(substream, &dummy_dma_hardware);
79
80         return 0;
81 }
82
83 static struct snd_pcm_ops dummy_dma_ops = {
84         .open           = dummy_dma_open,
85         .ioctl          = snd_pcm_lib_ioctl,
86 };
87
88 static struct snd_soc_platform_driver dummy_platform = {
89         .ops = &dummy_dma_ops,
90 };
91
92 static struct snd_soc_codec_driver dummy_codec;
93
94 #define STUB_RATES      SNDRV_PCM_RATE_8000_192000
95 #define STUB_FORMATS    (SNDRV_PCM_FMTBIT_S8 | \
96                         SNDRV_PCM_FMTBIT_U8 | \
97                         SNDRV_PCM_FMTBIT_S16_LE | \
98                         SNDRV_PCM_FMTBIT_U16_LE | \
99                         SNDRV_PCM_FMTBIT_S24_LE | \
100                         SNDRV_PCM_FMTBIT_U24_LE | \
101                         SNDRV_PCM_FMTBIT_S32_LE | \
102                         SNDRV_PCM_FMTBIT_U32_LE | \
103                         SNDRV_PCM_FMTBIT_IEC958_SUBFRAME_LE)
104 static struct snd_soc_dai_driver dummy_dai = {
105         .name = "snd-soc-dummy-dai",
106         .playback = {
107                 .stream_name    = "Playback",
108                 .channels_min   = 1,
109                 .channels_max   = 384,
110                 .rates          = STUB_RATES,
111                 .formats        = STUB_FORMATS,
112         },
113         .capture = {
114                 .stream_name    = "Capture",
115                 .channels_min   = 1,
116                 .channels_max   = 384,
117                 .rates = STUB_RATES,
118                 .formats = STUB_FORMATS,
119          },
120 };
121
122 int snd_soc_dai_is_dummy(struct snd_soc_dai *dai)
123 {
124         if (dai->driver == &dummy_dai)
125                 return 1;
126         return 0;
127 }
128
129 static int snd_soc_dummy_probe(struct platform_device *pdev)
130 {
131         int ret;
132
133         ret = snd_soc_register_codec(&pdev->dev, &dummy_codec, &dummy_dai, 1);
134         if (ret < 0)
135                 return ret;
136
137         ret = snd_soc_register_platform(&pdev->dev, &dummy_platform);
138         if (ret < 0) {
139                 snd_soc_unregister_codec(&pdev->dev);
140                 return ret;
141         }
142
143         return ret;
144 }
145
146 static int snd_soc_dummy_remove(struct platform_device *pdev)
147 {
148         snd_soc_unregister_platform(&pdev->dev);
149         snd_soc_unregister_codec(&pdev->dev);
150
151         return 0;
152 }
153
154 static struct platform_driver soc_dummy_driver = {
155         .driver = {
156                 .name = "snd-soc-dummy",
157         },
158         .probe = snd_soc_dummy_probe,
159         .remove = snd_soc_dummy_remove,
160 };
161
162 static struct platform_device *soc_dummy_dev;
163
164 int __init snd_soc_util_init(void)
165 {
166         int ret;
167
168         soc_dummy_dev =
169                 platform_device_register_simple("snd-soc-dummy", -1, NULL, 0);
170         if (IS_ERR(soc_dummy_dev))
171                 return PTR_ERR(soc_dummy_dev);
172
173         ret = platform_driver_register(&soc_dummy_driver);
174         if (ret != 0)
175                 platform_device_unregister(soc_dummy_dev);
176
177         return ret;
178 }
179
180 void __exit snd_soc_util_exit(void)
181 {
182         platform_device_unregister(soc_dummy_dev);
183         platform_driver_unregister(&soc_dummy_driver);
184 }