ALSA: ASoC: Fix error paths in N810 machine driver init and release clocks at exit
[linux-2.6] / sound / soc / omap / omap-pcm.c
1 /*
2  * omap-pcm.c  --  ALSA PCM interface for the OMAP SoC
3  *
4  * Copyright (C) 2008 Nokia Corporation
5  *
6  * Contact: Jarkko Nikula <jarkko.nikula@nokia.com>
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU General Public License
10  * version 2 as published by the Free Software Foundation.
11  *
12  * This program is distributed in the hope that it will be useful, but
13  * WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15  * General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program; if not, write to the Free Software
19  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
20  * 02110-1301 USA
21  *
22  */
23
24 #include <linux/dma-mapping.h>
25 #include <sound/core.h>
26 #include <sound/pcm.h>
27 #include <sound/pcm_params.h>
28 #include <sound/soc.h>
29
30 #include <mach/dma.h>
31 #include "omap-pcm.h"
32
33 static const struct snd_pcm_hardware omap_pcm_hardware = {
34         .info                   = SNDRV_PCM_INFO_MMAP |
35                                   SNDRV_PCM_INFO_MMAP_VALID |
36                                   SNDRV_PCM_INFO_INTERLEAVED |
37                                   SNDRV_PCM_INFO_PAUSE |
38                                   SNDRV_PCM_INFO_RESUME,
39         .formats                = SNDRV_PCM_FMTBIT_S16_LE,
40         .period_bytes_min       = 32,
41         .period_bytes_max       = 64 * 1024,
42         .periods_min            = 2,
43         .periods_max            = 255,
44         .buffer_bytes_max       = 128 * 1024,
45 };
46
47 struct omap_runtime_data {
48         spinlock_t                      lock;
49         struct omap_pcm_dma_data        *dma_data;
50         int                             dma_ch;
51         int                             period_index;
52 };
53
54 static void omap_pcm_dma_irq(int ch, u16 stat, void *data)
55 {
56         struct snd_pcm_substream *substream = data;
57         struct snd_pcm_runtime *runtime = substream->runtime;
58         struct omap_runtime_data *prtd = runtime->private_data;
59         unsigned long flags;
60
61         if (cpu_is_omap1510()) {
62                 /*
63                  * OMAP1510 doesn't support DMA chaining so have to restart
64                  * the transfer after all periods are transferred
65                  */
66                 spin_lock_irqsave(&prtd->lock, flags);
67                 if (prtd->period_index >= 0) {
68                         if (++prtd->period_index == runtime->periods) {
69                                 prtd->period_index = 0;
70                                 omap_start_dma(prtd->dma_ch);
71                         }
72                 }
73                 spin_unlock_irqrestore(&prtd->lock, flags);
74         }
75
76         snd_pcm_period_elapsed(substream);
77 }
78
79 /* this may get called several times by oss emulation */
80 static int omap_pcm_hw_params(struct snd_pcm_substream *substream,
81                               struct snd_pcm_hw_params *params)
82 {
83         struct snd_pcm_runtime *runtime = substream->runtime;
84         struct snd_soc_pcm_runtime *rtd = substream->private_data;
85         struct omap_runtime_data *prtd = runtime->private_data;
86         struct omap_pcm_dma_data *dma_data = rtd->dai->cpu_dai->dma_data;
87         int err = 0;
88
89         if (!dma_data)
90                 return -ENODEV;
91
92         snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer);
93         runtime->dma_bytes = params_buffer_bytes(params);
94
95         if (prtd->dma_data)
96                 return 0;
97         prtd->dma_data = dma_data;
98         err = omap_request_dma(dma_data->dma_req, dma_data->name,
99                                omap_pcm_dma_irq, substream, &prtd->dma_ch);
100         if (!cpu_is_omap1510()) {
101                 /*
102                  * Link channel with itself so DMA doesn't need any
103                  * reprogramming while looping the buffer
104                  */
105                 omap_dma_link_lch(prtd->dma_ch, prtd->dma_ch);
106         }
107
108         return err;
109 }
110
111 static int omap_pcm_hw_free(struct snd_pcm_substream *substream)
112 {
113         struct snd_pcm_runtime *runtime = substream->runtime;
114         struct omap_runtime_data *prtd = runtime->private_data;
115
116         if (prtd->dma_data == NULL)
117                 return 0;
118
119         if (!cpu_is_omap1510())
120                 omap_dma_unlink_lch(prtd->dma_ch, prtd->dma_ch);
121         omap_free_dma(prtd->dma_ch);
122         prtd->dma_data = NULL;
123
124         snd_pcm_set_runtime_buffer(substream, NULL);
125
126         return 0;
127 }
128
129 static int omap_pcm_prepare(struct snd_pcm_substream *substream)
130 {
131         struct snd_pcm_runtime *runtime = substream->runtime;
132         struct omap_runtime_data *prtd = runtime->private_data;
133         struct omap_pcm_dma_data *dma_data = prtd->dma_data;
134         struct omap_dma_channel_params dma_params;
135
136         memset(&dma_params, 0, sizeof(dma_params));
137         /*
138          * Note: Regardless of interface data formats supported by OMAP McBSP
139          * or EAC blocks, internal representation is always fixed 16-bit/sample
140          */
141         dma_params.data_type                    = OMAP_DMA_DATA_TYPE_S16;
142         dma_params.trigger                      = dma_data->dma_req;
143         dma_params.sync_mode                    = OMAP_DMA_SYNC_ELEMENT;
144         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
145                 dma_params.src_amode            = OMAP_DMA_AMODE_POST_INC;
146                 dma_params.dst_amode            = OMAP_DMA_AMODE_CONSTANT;
147                 dma_params.src_or_dst_synch     = OMAP_DMA_DST_SYNC;
148                 dma_params.src_start            = runtime->dma_addr;
149                 dma_params.dst_start            = dma_data->port_addr;
150         } else {
151                 dma_params.src_amode            = OMAP_DMA_AMODE_CONSTANT;
152                 dma_params.dst_amode            = OMAP_DMA_AMODE_POST_INC;
153                 dma_params.src_or_dst_synch     = OMAP_DMA_SRC_SYNC;
154                 dma_params.src_start            = dma_data->port_addr;
155                 dma_params.dst_start            = runtime->dma_addr;
156         }
157         /*
158          * Set DMA transfer frame size equal to ALSA period size and frame
159          * count as no. of ALSA periods. Then with DMA frame interrupt enabled,
160          * we can transfer the whole ALSA buffer with single DMA transfer but
161          * still can get an interrupt at each period bounary
162          */
163         dma_params.elem_count   = snd_pcm_lib_period_bytes(substream) / 2;
164         dma_params.frame_count  = runtime->periods;
165         omap_set_dma_params(prtd->dma_ch, &dma_params);
166
167         omap_enable_dma_irq(prtd->dma_ch, OMAP_DMA_FRAME_IRQ);
168
169         return 0;
170 }
171
172 static int omap_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
173 {
174         struct snd_pcm_runtime *runtime = substream->runtime;
175         struct omap_runtime_data *prtd = runtime->private_data;
176         int ret = 0;
177
178         spin_lock_irq(&prtd->lock);
179         switch (cmd) {
180         case SNDRV_PCM_TRIGGER_START:
181         case SNDRV_PCM_TRIGGER_RESUME:
182         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
183                 prtd->period_index = 0;
184                 omap_start_dma(prtd->dma_ch);
185                 break;
186
187         case SNDRV_PCM_TRIGGER_STOP:
188         case SNDRV_PCM_TRIGGER_SUSPEND:
189         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
190                 prtd->period_index = -1;
191                 omap_stop_dma(prtd->dma_ch);
192                 break;
193         default:
194                 ret = -EINVAL;
195         }
196         spin_unlock_irq(&prtd->lock);
197
198         return ret;
199 }
200
201 static snd_pcm_uframes_t omap_pcm_pointer(struct snd_pcm_substream *substream)
202 {
203         struct snd_pcm_runtime *runtime = substream->runtime;
204         struct omap_runtime_data *prtd = runtime->private_data;
205         dma_addr_t ptr;
206         snd_pcm_uframes_t offset;
207
208         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
209                 ptr = omap_get_dma_src_pos(prtd->dma_ch);
210         else
211                 ptr = omap_get_dma_dst_pos(prtd->dma_ch);
212
213         offset = bytes_to_frames(runtime, ptr - runtime->dma_addr);
214         if (offset >= runtime->buffer_size)
215                 offset = 0;
216
217         return offset;
218 }
219
220 static int omap_pcm_open(struct snd_pcm_substream *substream)
221 {
222         struct snd_pcm_runtime *runtime = substream->runtime;
223         struct omap_runtime_data *prtd;
224         int ret;
225
226         snd_soc_set_runtime_hwparams(substream, &omap_pcm_hardware);
227
228         /* Ensure that buffer size is a multiple of period size */
229         ret = snd_pcm_hw_constraint_integer(runtime,
230                                             SNDRV_PCM_HW_PARAM_PERIODS);
231         if (ret < 0)
232                 goto out;
233
234         prtd = kzalloc(sizeof(prtd), GFP_KERNEL);
235         if (prtd == NULL) {
236                 ret = -ENOMEM;
237                 goto out;
238         }
239         spin_lock_init(&prtd->lock);
240         runtime->private_data = prtd;
241
242 out:
243         return ret;
244 }
245
246 static int omap_pcm_close(struct snd_pcm_substream *substream)
247 {
248         struct snd_pcm_runtime *runtime = substream->runtime;
249
250         kfree(runtime->private_data);
251         return 0;
252 }
253
254 static int omap_pcm_mmap(struct snd_pcm_substream *substream,
255         struct vm_area_struct *vma)
256 {
257         struct snd_pcm_runtime *runtime = substream->runtime;
258
259         return dma_mmap_writecombine(substream->pcm->card->dev, vma,
260                                      runtime->dma_area,
261                                      runtime->dma_addr,
262                                      runtime->dma_bytes);
263 }
264
265 struct snd_pcm_ops omap_pcm_ops = {
266         .open           = omap_pcm_open,
267         .close          = omap_pcm_close,
268         .ioctl          = snd_pcm_lib_ioctl,
269         .hw_params      = omap_pcm_hw_params,
270         .hw_free        = omap_pcm_hw_free,
271         .prepare        = omap_pcm_prepare,
272         .trigger        = omap_pcm_trigger,
273         .pointer        = omap_pcm_pointer,
274         .mmap           = omap_pcm_mmap,
275 };
276
277 static u64 omap_pcm_dmamask = DMA_BIT_MASK(32);
278
279 static int omap_pcm_preallocate_dma_buffer(struct snd_pcm *pcm,
280         int stream)
281 {
282         struct snd_pcm_substream *substream = pcm->streams[stream].substream;
283         struct snd_dma_buffer *buf = &substream->dma_buffer;
284         size_t size = omap_pcm_hardware.buffer_bytes_max;
285
286         buf->dev.type = SNDRV_DMA_TYPE_DEV;
287         buf->dev.dev = pcm->card->dev;
288         buf->private_data = NULL;
289         buf->area = dma_alloc_writecombine(pcm->card->dev, size,
290                                            &buf->addr, GFP_KERNEL);
291         if (!buf->area)
292                 return -ENOMEM;
293
294         buf->bytes = size;
295         return 0;
296 }
297
298 static void omap_pcm_free_dma_buffers(struct snd_pcm *pcm)
299 {
300         struct snd_pcm_substream *substream;
301         struct snd_dma_buffer *buf;
302         int stream;
303
304         for (stream = 0; stream < 2; stream++) {
305                 substream = pcm->streams[stream].substream;
306                 if (!substream)
307                         continue;
308
309                 buf = &substream->dma_buffer;
310                 if (!buf->area)
311                         continue;
312
313                 dma_free_writecombine(pcm->card->dev, buf->bytes,
314                                       buf->area, buf->addr);
315                 buf->area = NULL;
316         }
317 }
318
319 int omap_pcm_new(struct snd_card *card, struct snd_soc_dai *dai,
320                  struct snd_pcm *pcm)
321 {
322         int ret = 0;
323
324         if (!card->dev->dma_mask)
325                 card->dev->dma_mask = &omap_pcm_dmamask;
326         if (!card->dev->coherent_dma_mask)
327                 card->dev->coherent_dma_mask = DMA_32BIT_MASK;
328
329         if (dai->playback.channels_min) {
330                 ret = omap_pcm_preallocate_dma_buffer(pcm,
331                         SNDRV_PCM_STREAM_PLAYBACK);
332                 if (ret)
333                         goto out;
334         }
335
336         if (dai->capture.channels_min) {
337                 ret = omap_pcm_preallocate_dma_buffer(pcm,
338                         SNDRV_PCM_STREAM_CAPTURE);
339                 if (ret)
340                         goto out;
341         }
342
343 out:
344         return ret;
345 }
346
347 struct snd_soc_platform omap_soc_platform = {
348         .name           = "omap-pcm-audio",
349         .pcm_ops        = &omap_pcm_ops,
350         .pcm_new        = omap_pcm_new,
351         .pcm_free       = omap_pcm_free_dma_buffers,
352 };
353 EXPORT_SYMBOL_GPL(omap_soc_platform);
354
355 MODULE_AUTHOR("Jarkko Nikula <jarkko.nikula@nokia.com>");
356 MODULE_DESCRIPTION("OMAP PCM DMA module");
357 MODULE_LICENSE("GPL");