1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include <linux/dma-mapping.h>
26#include <linux/slab.h>
27#include <linux/module.h>
28#include <linux/omap-dma.h>
29#include <sound/core.h>
30#include <sound/pcm.h>
31#include <sound/pcm_params.h>
32#include <sound/dmaengine_pcm.h>
33#include <sound/soc.h>
34
35#ifdef CONFIG_ARCH_OMAP1
36#define pcm_omap1510() cpu_is_omap1510()
37#else
38#define pcm_omap1510() 0
39#endif
40
41static const struct snd_pcm_hardware omap_pcm_hardware = {
42 .info = SNDRV_PCM_INFO_MMAP |
43 SNDRV_PCM_INFO_MMAP_VALID |
44 SNDRV_PCM_INFO_INTERLEAVED |
45 SNDRV_PCM_INFO_PAUSE |
46 SNDRV_PCM_INFO_RESUME |
47 SNDRV_PCM_INFO_NO_PERIOD_WAKEUP,
48 .formats = SNDRV_PCM_FMTBIT_S16_LE |
49 SNDRV_PCM_FMTBIT_S32_LE,
50 .period_bytes_min = 32,
51 .period_bytes_max = 64 * 1024,
52 .periods_min = 2,
53 .periods_max = 255,
54 .buffer_bytes_max = 128 * 1024,
55};
56
57
58static int omap_pcm_hw_params(struct snd_pcm_substream *substream,
59 struct snd_pcm_hw_params *params)
60{
61 struct snd_pcm_runtime *runtime = substream->runtime;
62 struct snd_soc_pcm_runtime *rtd = substream->private_data;
63 struct omap_pcm_dma_data *dma_data;
64 struct dma_slave_config config;
65 struct dma_chan *chan;
66 int err = 0;
67
68 dma_data = snd_soc_dai_get_dma_data(rtd->cpu_dai, substream);
69
70
71
72 if (!dma_data)
73 return 0;
74
75 snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);
76 runtime->dma_bytes = params_buffer_bytes(params);
77
78 chan = snd_dmaengine_pcm_get_chan(substream);
79 if (!chan)
80 return -EINVAL;
81
82
83 err = snd_hwparams_to_dma_slave_config(substream, params, &config);
84 if (err)
85 return err;
86
87 snd_dmaengine_pcm_set_config_from_dai_data(substream,
88 snd_soc_dai_get_dma_data(rtd->cpu_dai, substream),
89 &config);
90
91 return dmaengine_slave_config(chan, &config);
92}
93
94static int omap_pcm_hw_free(struct snd_pcm_substream *substream)
95{
96 snd_pcm_set_runtime_buffer(substream, NULL);
97 return 0;
98}
99
100static snd_pcm_uframes_t omap_pcm_pointer(struct snd_pcm_substream *substream)
101{
102 snd_pcm_uframes_t offset;
103
104 if (pcm_omap1510())
105 offset = snd_dmaengine_pcm_pointer_no_residue(substream);
106 else
107 offset = snd_dmaengine_pcm_pointer(substream);
108
109 return offset;
110}
111
112static int omap_pcm_open(struct snd_pcm_substream *substream)
113{
114 struct snd_soc_pcm_runtime *rtd = substream->private_data;
115 struct snd_dmaengine_dai_dma_data *dma_data;
116 int ret;
117
118 snd_soc_set_runtime_hwparams(substream, &omap_pcm_hardware);
119
120 dma_data = snd_soc_dai_get_dma_data(rtd->cpu_dai, substream);
121
122
123 if (rtd->cpu_dai->dev->of_node) {
124 struct dma_chan *chan;
125
126 chan = dma_request_slave_channel(rtd->cpu_dai->dev,
127 dma_data->filter_data);
128 ret = snd_dmaengine_pcm_open(substream, chan);
129 } else {
130 ret = snd_dmaengine_pcm_open_request_chan(substream,
131 omap_dma_filter_fn,
132 dma_data->filter_data);
133 }
134 return ret;
135}
136
137static int omap_pcm_mmap(struct snd_pcm_substream *substream,
138 struct vm_area_struct *vma)
139{
140 struct snd_pcm_runtime *runtime = substream->runtime;
141
142 return dma_mmap_writecombine(substream->pcm->card->dev, vma,
143 runtime->dma_area,
144 runtime->dma_addr,
145 runtime->dma_bytes);
146}
147
148static struct snd_pcm_ops omap_pcm_ops = {
149 .open = omap_pcm_open,
150 .close = snd_dmaengine_pcm_close_release_chan,
151 .ioctl = snd_pcm_lib_ioctl,
152 .hw_params = omap_pcm_hw_params,
153 .hw_free = omap_pcm_hw_free,
154 .trigger = snd_dmaengine_pcm_trigger,
155 .pointer = omap_pcm_pointer,
156 .mmap = omap_pcm_mmap,
157};
158
159static u64 omap_pcm_dmamask = DMA_BIT_MASK(64);
160
161static int omap_pcm_preallocate_dma_buffer(struct snd_pcm *pcm,
162 int stream)
163{
164 struct snd_pcm_substream *substream = pcm->streams[stream].substream;
165 struct snd_dma_buffer *buf = &substream->dma_buffer;
166 size_t size = omap_pcm_hardware.buffer_bytes_max;
167
168 buf->dev.type = SNDRV_DMA_TYPE_DEV;
169 buf->dev.dev = pcm->card->dev;
170 buf->private_data = NULL;
171 buf->area = dma_alloc_writecombine(pcm->card->dev, size,
172 &buf->addr, GFP_KERNEL);
173 if (!buf->area)
174 return -ENOMEM;
175
176 buf->bytes = size;
177 return 0;
178}
179
180static void omap_pcm_free_dma_buffers(struct snd_pcm *pcm)
181{
182 struct snd_pcm_substream *substream;
183 struct snd_dma_buffer *buf;
184 int stream;
185
186 for (stream = 0; stream < 2; stream++) {
187 substream = pcm->streams[stream].substream;
188 if (!substream)
189 continue;
190
191 buf = &substream->dma_buffer;
192 if (!buf->area)
193 continue;
194
195 dma_free_writecombine(pcm->card->dev, buf->bytes,
196 buf->area, buf->addr);
197 buf->area = NULL;
198 }
199}
200
201static int omap_pcm_new(struct snd_soc_pcm_runtime *rtd)
202{
203 struct snd_card *card = rtd->card->snd_card;
204 struct snd_pcm *pcm = rtd->pcm;
205 int ret = 0;
206
207 if (!card->dev->dma_mask)
208 card->dev->dma_mask = &omap_pcm_dmamask;
209 if (!card->dev->coherent_dma_mask)
210 card->dev->coherent_dma_mask = DMA_BIT_MASK(64);
211
212 if (pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream) {
213 ret = omap_pcm_preallocate_dma_buffer(pcm,
214 SNDRV_PCM_STREAM_PLAYBACK);
215 if (ret)
216 goto out;
217 }
218
219 if (pcm->streams[SNDRV_PCM_STREAM_CAPTURE].substream) {
220 ret = omap_pcm_preallocate_dma_buffer(pcm,
221 SNDRV_PCM_STREAM_CAPTURE);
222 if (ret)
223 goto out;
224 }
225
226out:
227
228 if (ret)
229 omap_pcm_free_dma_buffers(pcm);
230
231 return ret;
232}
233
234static struct snd_soc_platform_driver omap_soc_platform = {
235 .ops = &omap_pcm_ops,
236 .pcm_new = omap_pcm_new,
237 .pcm_free = omap_pcm_free_dma_buffers,
238};
239
240static int omap_pcm_probe(struct platform_device *pdev)
241{
242 return snd_soc_register_platform(&pdev->dev,
243 &omap_soc_platform);
244}
245
246static int omap_pcm_remove(struct platform_device *pdev)
247{
248 snd_soc_unregister_platform(&pdev->dev);
249 return 0;
250}
251
252static struct platform_driver omap_pcm_driver = {
253 .driver = {
254 .name = "omap-pcm-audio",
255 .owner = THIS_MODULE,
256 },
257
258 .probe = omap_pcm_probe,
259 .remove = omap_pcm_remove,
260};
261
262module_platform_driver(omap_pcm_driver);
263
264MODULE_AUTHOR("Jarkko Nikula <jarkko.nikula@bitmer.com>");
265MODULE_DESCRIPTION("OMAP PCM DMA module");
266MODULE_LICENSE("GPL");
267MODULE_ALIAS("platform:omap-pcm-audio");
268