[xburst] sound jz4740_pcm: Don't request dma channel mor then once.
[openwrt/svn-archive/archive.git] / target / linux / xburst / files-2.6.32 / sound / soc / jz4740 / jz4740-pcm.c
1 /*
2 * Copyright (C) 2010, Lars-Peter Clausen <lars@metafoo.de>
3 *
4 * This program is free software; you can redistribute it and/or modify it
5 * under the terms of the GNU General Public License as published by the
6 * Free Software Foundation; either version 2 of the License, or (at your
7 * option) any later version.
8 *
9 * You should have received a copy of the GNU General Public License along
10 * with this program; if not, write to the Free Software Foundation, Inc.,
11 * 675 Mass Ave, Cambridge, MA 02139, USA.
12 *
13 */
14
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/init.h>
18 #include <linux/interrupt.h>
19 #include <linux/dma-mapping.h>
20
21 #include <sound/core.h>
22 #include <sound/pcm.h>
23 #include <sound/pcm_params.h>
24 #include <sound/soc.h>
25
26 #include <asm/mach-jz4740/dma.h>
27 #include "jz4740-pcm.h"
28
29 struct jz4740_runtime_data {
30 unsigned int dma_period;
31 dma_addr_t dma_start;
32 dma_addr_t dma_pos;
33 dma_addr_t dma_end;
34
35 struct jz4740_dma_chan *dma;
36
37 dma_addr_t fifo_addr;
38 };
39
40 /* identify hardware playback capabilities */
41 static const struct snd_pcm_hardware jz4740_pcm_hardware = {
42 .info = SNDRV_PCM_INFO_MMAP |
43 SNDRV_PCM_INFO_MMAP_VALID |
44 SNDRV_PCM_INFO_INTERLEAVED |
45 SNDRV_PCM_INFO_BLOCK_TRANSFER,
46 .formats = SNDRV_PCM_FMTBIT_S16_LE |
47 SNDRV_PCM_FMTBIT_S8,
48 .rates = SNDRV_PCM_RATE_8000_48000,
49 .channels_min = 1,
50 .channels_max = 2,
51 .period_bytes_min = 32,
52 .period_bytes_max = 2 * PAGE_SIZE,
53 .periods_min = 2,
54 .periods_max = 128,
55 .buffer_bytes_max = 128 * 2 * PAGE_SIZE,
56 .fifo_size = 32,
57 };
58
59 static void jz4740_pcm_start_transfer(struct jz4740_runtime_data *prtd, int stream)
60 {
61 unsigned int count;
62
63 if (prtd->dma_pos + prtd->dma_period > prtd->dma_end)
64 count = prtd->dma_end - prtd->dma_pos;
65 else
66 count = prtd->dma_period;
67
68 jz4740_dma_disable(prtd->dma);
69
70 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
71 jz4740_dma_set_src_addr(prtd->dma, prtd->dma_pos);
72 jz4740_dma_set_dst_addr(prtd->dma, prtd->fifo_addr);
73 } else {
74 jz4740_dma_set_src_addr(prtd->dma, prtd->fifo_addr);
75 jz4740_dma_set_dst_addr(prtd->dma, prtd->dma_pos);
76 }
77
78 jz4740_dma_set_transfer_count(prtd->dma, count);
79
80 jz4740_dma_enable(prtd->dma);
81
82 prtd->dma_pos += prtd->dma_period;
83 if (prtd->dma_pos >= prtd->dma_end)
84 prtd->dma_pos = prtd->dma_start;
85 }
86
87 static void jz4740_pcm_dma_transfer_done(struct jz4740_dma_chan *dma, int err,
88 void *dev_id)
89 {
90 struct snd_pcm_substream *substream = dev_id;
91 struct snd_pcm_runtime *runtime = substream->runtime;
92 struct jz4740_runtime_data *prtd = runtime->private_data;
93
94 snd_pcm_period_elapsed(substream);
95
96 jz4740_pcm_start_transfer(prtd, substream->stream);
97 }
98
99 static int jz4740_pcm_hw_params(struct snd_pcm_substream *substream,
100 struct snd_pcm_hw_params *params)
101 {
102 struct snd_pcm_runtime *runtime = substream->runtime;
103 struct jz4740_runtime_data *prtd = runtime->private_data;
104 struct snd_soc_pcm_runtime *rtd = substream->private_data;
105 struct jz4740_pcm_config *config;
106
107 config = rtd->dai->cpu_dai->dma_data;
108 if (!prtd->dma) {
109 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
110 prtd->dma = jz4740_dma_request(substream, "PCM Playback");
111 else
112 prtd->dma = jz4740_dma_request(substream, "PCM Capture");
113 }
114
115 if (!prtd->dma)
116 return -EBUSY;
117
118 jz4740_dma_configure(prtd->dma, config->dma_config);
119 prtd->fifo_addr = config->fifo_addr;
120
121 jz4740_dma_set_complete_cb(prtd->dma, jz4740_pcm_dma_transfer_done);
122
123 snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);
124 runtime->dma_bytes = params_buffer_bytes(params);
125
126 prtd->dma_period = params_period_bytes(params);
127 prtd->dma_start = runtime->dma_addr;
128 prtd->dma_pos = prtd->dma_start;
129 prtd->dma_end = prtd->dma_start + runtime->dma_bytes;
130
131 return 0;
132 }
133
134 static int jz4740_pcm_hw_free(struct snd_pcm_substream *substream)
135 {
136 struct jz4740_runtime_data *prtd = substream->runtime->private_data;
137
138 snd_pcm_set_runtime_buffer(substream, NULL);
139 if (prtd->dma)
140 jz4740_dma_free(prtd->dma);
141
142 return 0;
143 }
144
145 static int jz4740_pcm_prepare(struct snd_pcm_substream *substream)
146 {
147 struct jz4740_runtime_data *prtd = substream->runtime->private_data;
148 int ret = 0;
149
150 if (!prtd->dma)
151 return 0;
152
153 prtd->dma_pos = prtd->dma_start;
154
155 return ret;
156 }
157
158 static int jz4740_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
159 {
160 struct snd_pcm_runtime *runtime = substream->runtime;
161 struct jz4740_runtime_data *prtd = runtime->private_data;
162
163 int ret = 0;
164
165 switch (cmd) {
166 case SNDRV_PCM_TRIGGER_START:
167 case SNDRV_PCM_TRIGGER_RESUME:
168 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
169 jz4740_pcm_start_transfer(prtd, substream->stream);
170 break;
171 case SNDRV_PCM_TRIGGER_STOP:
172 case SNDRV_PCM_TRIGGER_SUSPEND:
173 case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
174 jz4740_dma_disable(prtd->dma);
175 break;
176 default:
177 ret = -EINVAL;
178 }
179
180 return ret;
181 }
182
183 static snd_pcm_uframes_t jz4740_pcm_pointer(struct snd_pcm_substream *substream)
184 {
185 struct snd_pcm_runtime *runtime = substream->runtime;
186 struct jz4740_runtime_data *prtd = runtime->private_data;
187 unsigned long count, pos;
188 snd_pcm_uframes_t offset;
189 struct jz4740_dma_chan *dma = prtd->dma;
190
191 count = jz4740_dma_get_residue(dma);
192 if (prtd->dma_pos == prtd->dma_start)
193 pos = prtd->dma_end - prtd->dma_start - count;
194 else
195 pos = prtd->dma_pos - prtd->dma_start - count;
196
197 offset = bytes_to_frames(runtime, pos);
198 if (offset >= runtime->buffer_size)
199 offset = 0;
200
201 return offset;
202 }
203
204 static int jz4740_pcm_open(struct snd_pcm_substream *substream)
205 {
206 struct snd_pcm_runtime *runtime = substream->runtime;
207 struct jz4740_runtime_data *prtd;
208
209 snd_soc_set_runtime_hwparams(substream, &jz4740_pcm_hardware);
210 prtd = kzalloc(sizeof(struct jz4740_runtime_data), GFP_KERNEL);
211
212 if (prtd == NULL)
213 return -ENOMEM;
214
215 runtime->private_data = prtd;
216 return 0;
217 }
218
219 static int jz4740_pcm_close(struct snd_pcm_substream *substream)
220 {
221 struct snd_pcm_runtime *runtime = substream->runtime;
222 struct jz4740_runtime_data *prtd = runtime->private_data;
223
224 kfree(prtd);
225
226 return 0;
227 }
228
229 static int jz4740_pcm_mmap(struct snd_pcm_substream *substream,
230 struct vm_area_struct *vma)
231 {
232 return remap_pfn_range(vma, vma->vm_start,
233 substream->dma_buffer.addr >> PAGE_SHIFT,
234 vma->vm_end - vma->vm_start, vma->vm_page_prot);
235 }
236
237 static struct snd_pcm_ops jz4740_pcm_ops = {
238 .open = jz4740_pcm_open,
239 .close = jz4740_pcm_close,
240 .ioctl = snd_pcm_lib_ioctl,
241 .hw_params = jz4740_pcm_hw_params,
242 .hw_free = jz4740_pcm_hw_free,
243 .prepare = jz4740_pcm_prepare,
244 .trigger = jz4740_pcm_trigger,
245 .pointer = jz4740_pcm_pointer,
246 .mmap = jz4740_pcm_mmap,
247 };
248
249 static int jz4740_pcm_preallocate_dma_buffer(struct snd_pcm *pcm, int stream)
250 {
251 struct snd_pcm_substream *substream = pcm->streams[stream].substream;
252 struct snd_dma_buffer *buf = &substream->dma_buffer;
253 size_t size = jz4740_pcm_hardware.buffer_bytes_max;
254
255 buf->dev.type = SNDRV_DMA_TYPE_DEV;
256 buf->dev.dev = pcm->card->dev;
257 buf->private_data = NULL;
258
259 buf->area = dma_alloc_noncoherent(pcm->card->dev, size,
260 &buf->addr, GFP_KERNEL);
261 if (!buf->area)
262 return -ENOMEM;
263
264 buf->bytes = size;
265
266 return 0;
267 }
268
269 static void jz4740_pcm_free(struct snd_pcm *pcm)
270 {
271 struct snd_pcm_substream *substream;
272 struct snd_dma_buffer *buf;
273 int stream;
274
275 for (stream = 0; stream < 2; stream++) {
276 substream = pcm->streams[stream].substream;
277 if (!substream)
278 continue;
279
280 buf = &substream->dma_buffer;
281 if (!buf->area)
282 continue;
283
284 dma_free_noncoherent(pcm->card->dev, buf->bytes,
285 buf->area, buf->addr);
286 buf->area = NULL;
287 }
288 }
289
290 static u64 jz4740_pcm_dmamask = DMA_BIT_MASK(32);
291
292 int jz4740_pcm_new(struct snd_card *card, struct snd_soc_dai *dai,
293 struct snd_pcm *pcm)
294 {
295 int ret = 0;
296
297 if (!card->dev->dma_mask)
298 card->dev->dma_mask = &jz4740_pcm_dmamask;
299
300 if (!card->dev->coherent_dma_mask)
301 card->dev->coherent_dma_mask = DMA_BIT_MASK(32);
302
303 if (dai->playback.channels_min) {
304 ret = jz4740_pcm_preallocate_dma_buffer(pcm,
305 SNDRV_PCM_STREAM_PLAYBACK);
306 if (ret)
307 goto err;
308 }
309
310 if (dai->capture.channels_min) {
311 ret = jz4740_pcm_preallocate_dma_buffer(pcm,
312 SNDRV_PCM_STREAM_CAPTURE);
313 if (ret)
314 goto err;
315 }
316
317 err:
318 return ret;
319 }
320
321 struct snd_soc_platform jz4740_soc_platform = {
322 .name = "jz4740-pcm",
323 .pcm_ops = &jz4740_pcm_ops,
324 .pcm_new = jz4740_pcm_new,
325 .pcm_free = jz4740_pcm_free,
326 };
327 EXPORT_SYMBOL_GPL(jz4740_soc_platform);
328
329 static int __init jz4740_soc_platform_init(void)
330 {
331 return snd_soc_register_platform(&jz4740_soc_platform);
332 }
333 module_init(jz4740_soc_platform_init);
334
335 static void __exit jz4740_soc_platform_exit(void)
336 {
337 snd_soc_unregister_platform(&jz4740_soc_platform);
338 }
339 module_exit(jz4740_soc_platform_exit);
340
341 MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
342 MODULE_DESCRIPTION("Ingenic SoC JZ4740 PCM driver");
343 MODULE_LICENSE("GPL");