Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/dtor/input
[linux-2.6] / sound / soc / pxa / pxa2xx-pcm.c
1 /*
2  * linux/sound/arm/pxa2xx-pcm.c -- ALSA PCM interface for the Intel PXA2xx chip
3  *
4  * Author:      Nicolas Pitre
5  * Created:     Nov 30, 2004
6  * Copyright:   (C) 2004 MontaVista Software, Inc.
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11  */
12
13 #include <linux/module.h>
14 #include <linux/init.h>
15 #include <linux/platform_device.h>
16 #include <linux/slab.h>
17 #include <linux/dma-mapping.h>
18
19 #include <sound/core.h>
20 #include <sound/pcm.h>
21 #include <sound/pcm_params.h>
22 #include <sound/soc.h>
23
24 #include <asm/dma.h>
25 #include <mach/hardware.h>
26 #include <mach/pxa-regs.h>
27 #include <mach/audio.h>
28
29 #include "pxa2xx-pcm.h"
30
31 static const struct snd_pcm_hardware pxa2xx_pcm_hardware = {
32         .info                   = SNDRV_PCM_INFO_MMAP |
33                                   SNDRV_PCM_INFO_MMAP_VALID |
34                                   SNDRV_PCM_INFO_INTERLEAVED |
35                                   SNDRV_PCM_INFO_PAUSE |
36                                   SNDRV_PCM_INFO_RESUME,
37         .formats                = SNDRV_PCM_FMTBIT_S16_LE |
38                                         SNDRV_PCM_FMTBIT_S24_LE |
39                                         SNDRV_PCM_FMTBIT_S32_LE,
40         .period_bytes_min       = 32,
41         .period_bytes_max       = 8192 - 32,
42         .periods_min            = 1,
43         .periods_max            = PAGE_SIZE/sizeof(pxa_dma_desc),
44         .buffer_bytes_max       = 128 * 1024,
45         .fifo_size              = 32,
46 };
47
48 struct pxa2xx_runtime_data {
49         int dma_ch;
50         struct pxa2xx_pcm_dma_params *params;
51         pxa_dma_desc *dma_desc_array;
52         dma_addr_t dma_desc_array_phys;
53 };
54
55 static void pxa2xx_pcm_dma_irq(int dma_ch, void *dev_id)
56 {
57         struct snd_pcm_substream *substream = dev_id;
58         struct pxa2xx_runtime_data *prtd = substream->runtime->private_data;
59         int dcsr;
60
61         dcsr = DCSR(dma_ch);
62         DCSR(dma_ch) = dcsr & ~DCSR_STOPIRQEN;
63
64         if (dcsr & DCSR_ENDINTR) {
65                 snd_pcm_period_elapsed(substream);
66         } else {
67                 printk(KERN_ERR "%s: DMA error on channel %d (DCSR=%#x)\n",
68                         prtd->params->name, dma_ch, dcsr);
69         }
70 }
71
72 static int pxa2xx_pcm_hw_params(struct snd_pcm_substream *substream,
73         struct snd_pcm_hw_params *params)
74 {
75         struct snd_pcm_runtime *runtime = substream->runtime;
76         struct pxa2xx_runtime_data *prtd = runtime->private_data;
77         struct snd_soc_pcm_runtime *rtd = substream->private_data;
78         struct pxa2xx_pcm_dma_params *dma = rtd->dai->cpu_dai->dma_data;
79         size_t totsize = params_buffer_bytes(params);
80         size_t period = params_period_bytes(params);
81         pxa_dma_desc *dma_desc;
82         dma_addr_t dma_buff_phys, next_desc_phys;
83         int ret;
84
85         /* return if this is a bufferless transfer e.g.
86          * codec <--> BT codec or GSM modem -- lg FIXME */
87         if (!dma)
88                 return 0;
89
90         /* this may get called several times by oss emulation
91          * with different params */
92         if (prtd->params == NULL) {
93                 prtd->params = dma;
94                 ret = pxa_request_dma(prtd->params->name, DMA_PRIO_LOW,
95                               pxa2xx_pcm_dma_irq, substream);
96                 if (ret < 0)
97                         return ret;
98                 prtd->dma_ch = ret;
99         } else if (prtd->params != dma) {
100                 pxa_free_dma(prtd->dma_ch);
101                 prtd->params = dma;
102                 ret = pxa_request_dma(prtd->params->name, DMA_PRIO_LOW,
103                               pxa2xx_pcm_dma_irq, substream);
104                 if (ret < 0)
105                         return ret;
106                 prtd->dma_ch = ret;
107         }
108
109         snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);
110         runtime->dma_bytes = totsize;
111
112         dma_desc = prtd->dma_desc_array;
113         next_desc_phys = prtd->dma_desc_array_phys;
114         dma_buff_phys = runtime->dma_addr;
115         do {
116                 next_desc_phys += sizeof(pxa_dma_desc);
117                 dma_desc->ddadr = next_desc_phys;
118                 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
119                         dma_desc->dsadr = dma_buff_phys;
120                         dma_desc->dtadr = prtd->params->dev_addr;
121                 } else {
122                         dma_desc->dsadr = prtd->params->dev_addr;
123                         dma_desc->dtadr = dma_buff_phys;
124                 }
125                 if (period > totsize)
126                         period = totsize;
127                 dma_desc->dcmd = prtd->params->dcmd | period | DCMD_ENDIRQEN;
128                 dma_desc++;
129                 dma_buff_phys += period;
130         } while (totsize -= period);
131         dma_desc[-1].ddadr = prtd->dma_desc_array_phys;
132
133         return 0;
134 }
135
136 static int pxa2xx_pcm_hw_free(struct snd_pcm_substream *substream)
137 {
138         struct pxa2xx_runtime_data *prtd = substream->runtime->private_data;
139
140         if (prtd && prtd->params)
141                 *prtd->params->drcmr = 0;
142
143         if (prtd->dma_ch) {
144                 snd_pcm_set_runtime_buffer(substream, NULL);
145                 pxa_free_dma(prtd->dma_ch);
146                 prtd->dma_ch = 0;
147         }
148
149         return 0;
150 }
151
152 static int pxa2xx_pcm_prepare(struct snd_pcm_substream *substream)
153 {
154         struct pxa2xx_runtime_data *prtd = substream->runtime->private_data;
155
156         DCSR(prtd->dma_ch) &= ~DCSR_RUN;
157         DCSR(prtd->dma_ch) = 0;
158         DCMD(prtd->dma_ch) = 0;
159         *prtd->params->drcmr = prtd->dma_ch | DRCMR_MAPVLD;
160
161         return 0;
162 }
163
164 static int pxa2xx_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
165 {
166         struct pxa2xx_runtime_data *prtd = substream->runtime->private_data;
167         int ret = 0;
168
169         switch (cmd) {
170         case SNDRV_PCM_TRIGGER_START:
171                 DDADR(prtd->dma_ch) = prtd->dma_desc_array_phys;
172                 DCSR(prtd->dma_ch) = DCSR_RUN;
173                 break;
174
175         case SNDRV_PCM_TRIGGER_STOP:
176         case SNDRV_PCM_TRIGGER_SUSPEND:
177         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
178                 DCSR(prtd->dma_ch) &= ~DCSR_RUN;
179                 break;
180
181         case SNDRV_PCM_TRIGGER_RESUME:
182                 DCSR(prtd->dma_ch) |= DCSR_RUN;
183                 break;
184         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
185                 DDADR(prtd->dma_ch) = prtd->dma_desc_array_phys;
186                 DCSR(prtd->dma_ch) |= DCSR_RUN;
187                 break;
188
189         default:
190                 ret = -EINVAL;
191         }
192
193         return ret;
194 }
195
196 static snd_pcm_uframes_t
197 pxa2xx_pcm_pointer(struct snd_pcm_substream *substream)
198 {
199         struct snd_pcm_runtime *runtime = substream->runtime;
200         struct pxa2xx_runtime_data *prtd = runtime->private_data;
201
202         dma_addr_t ptr = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) ?
203                          DSADR(prtd->dma_ch) : DTADR(prtd->dma_ch);
204         snd_pcm_uframes_t x = bytes_to_frames(runtime, ptr - runtime->dma_addr);
205
206         if (x == runtime->buffer_size)
207                 x = 0;
208         return x;
209 }
210
211 static int pxa2xx_pcm_open(struct snd_pcm_substream *substream)
212 {
213         struct snd_pcm_runtime *runtime = substream->runtime;
214         struct pxa2xx_runtime_data *prtd;
215         int ret;
216
217         snd_soc_set_runtime_hwparams(substream, &pxa2xx_pcm_hardware);
218
219         /*
220          * For mysterious reasons (and despite what the manual says)
221          * playback samples are lost if the DMA count is not a multiple
222          * of the DMA burst size.  Let's add a rule to enforce that.
223          */
224         ret = snd_pcm_hw_constraint_step(runtime, 0,
225                 SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 32);
226         if (ret)
227                 goto out;
228
229         ret = snd_pcm_hw_constraint_step(runtime, 0,
230                 SNDRV_PCM_HW_PARAM_BUFFER_BYTES, 32);
231         if (ret)
232                 goto out;
233
234         ret = snd_pcm_hw_constraint_integer(runtime, SNDRV_PCM_HW_PARAM_PERIODS);
235         if (ret < 0)
236                 goto out;
237
238         prtd = kzalloc(sizeof(struct pxa2xx_runtime_data), GFP_KERNEL);
239         if (prtd == NULL) {
240                 ret = -ENOMEM;
241                 goto out;
242         }
243
244         prtd->dma_desc_array =
245                 dma_alloc_writecombine(substream->pcm->card->dev, PAGE_SIZE,
246                                        &prtd->dma_desc_array_phys, GFP_KERNEL);
247         if (!prtd->dma_desc_array) {
248                 ret = -ENOMEM;
249                 goto err1;
250         }
251
252         runtime->private_data = prtd;
253         return 0;
254
255  err1:
256         kfree(prtd);
257  out:
258         return ret;
259 }
260
261 static int pxa2xx_pcm_close(struct snd_pcm_substream *substream)
262 {
263         struct snd_pcm_runtime *runtime = substream->runtime;
264         struct pxa2xx_runtime_data *prtd = runtime->private_data;
265
266         dma_free_writecombine(substream->pcm->card->dev, PAGE_SIZE,
267                               prtd->dma_desc_array, prtd->dma_desc_array_phys);
268         kfree(prtd);
269         return 0;
270 }
271
272 static int pxa2xx_pcm_mmap(struct snd_pcm_substream *substream,
273         struct vm_area_struct *vma)
274 {
275         struct snd_pcm_runtime *runtime = substream->runtime;
276         return dma_mmap_writecombine(substream->pcm->card->dev, vma,
277                                      runtime->dma_area,
278                                      runtime->dma_addr,
279                                      runtime->dma_bytes);
280 }
281
282 struct snd_pcm_ops pxa2xx_pcm_ops = {
283         .open           = pxa2xx_pcm_open,
284         .close          = pxa2xx_pcm_close,
285         .ioctl          = snd_pcm_lib_ioctl,
286         .hw_params      = pxa2xx_pcm_hw_params,
287         .hw_free        = pxa2xx_pcm_hw_free,
288         .prepare        = pxa2xx_pcm_prepare,
289         .trigger        = pxa2xx_pcm_trigger,
290         .pointer        = pxa2xx_pcm_pointer,
291         .mmap           = pxa2xx_pcm_mmap,
292 };
293
294 static int pxa2xx_pcm_preallocate_dma_buffer(struct snd_pcm *pcm, int stream)
295 {
296         struct snd_pcm_substream *substream = pcm->streams[stream].substream;
297         struct snd_dma_buffer *buf = &substream->dma_buffer;
298         size_t size = pxa2xx_pcm_hardware.buffer_bytes_max;
299         buf->dev.type = SNDRV_DMA_TYPE_DEV;
300         buf->dev.dev = pcm->card->dev;
301         buf->private_data = NULL;
302         buf->area = dma_alloc_writecombine(pcm->card->dev, size,
303                                            &buf->addr, GFP_KERNEL);
304         if (!buf->area)
305                 return -ENOMEM;
306         buf->bytes = size;
307         return 0;
308 }
309
310 static void pxa2xx_pcm_free_dma_buffers(struct snd_pcm *pcm)
311 {
312         struct snd_pcm_substream *substream;
313         struct snd_dma_buffer *buf;
314         int stream;
315
316         for (stream = 0; stream < 2; stream++) {
317                 substream = pcm->streams[stream].substream;
318                 if (!substream)
319                         continue;
320
321                 buf = &substream->dma_buffer;
322                 if (!buf->area)
323                         continue;
324
325                 dma_free_writecombine(pcm->card->dev, buf->bytes,
326                                       buf->area, buf->addr);
327                 buf->area = NULL;
328         }
329 }
330
331 static u64 pxa2xx_pcm_dmamask = DMA_32BIT_MASK;
332
333 int pxa2xx_pcm_new(struct snd_card *card, struct snd_soc_dai *dai,
334         struct snd_pcm *pcm)
335 {
336         int ret = 0;
337
338         if (!card->dev->dma_mask)
339                 card->dev->dma_mask = &pxa2xx_pcm_dmamask;
340         if (!card->dev->coherent_dma_mask)
341                 card->dev->coherent_dma_mask = DMA_32BIT_MASK;
342
343         if (dai->playback.channels_min) {
344                 ret = pxa2xx_pcm_preallocate_dma_buffer(pcm,
345                         SNDRV_PCM_STREAM_PLAYBACK);
346                 if (ret)
347                         goto out;
348         }
349
350         if (dai->capture.channels_min) {
351                 ret = pxa2xx_pcm_preallocate_dma_buffer(pcm,
352                         SNDRV_PCM_STREAM_CAPTURE);
353                 if (ret)
354                         goto out;
355         }
356  out:
357         return ret;
358 }
359
360 struct snd_soc_platform pxa2xx_soc_platform = {
361         .name           = "pxa2xx-audio",
362         .pcm_ops        = &pxa2xx_pcm_ops,
363         .pcm_new        = pxa2xx_pcm_new,
364         .pcm_free       = pxa2xx_pcm_free_dma_buffers,
365 };
366 EXPORT_SYMBOL_GPL(pxa2xx_soc_platform);
367
368 MODULE_AUTHOR("Nicolas Pitre");
369 MODULE_DESCRIPTION("Intel PXA2xx PCM DMA module");
370 MODULE_LICENSE("GPL");