Commit | Line | Data |
---|---|---|
8380222e SH |
1 | /* |
2 | * imx-pcm-dma-mx2.c -- ALSA Soc Audio Layer | |
3 | * | |
4 | * Copyright 2009 Sascha Hauer <s.hauer@pengutronix.de> | |
5 | * | |
6 | * This code is based on code copyrighted by Freescale, | |
7 | * Liam Girdwood, Javier Martin and probably others. | |
8 | * | |
9 | * This program is free software; you can redistribute it and/or modify it | |
10 | * under the terms of the GNU General Public License as published by the | |
11 | * Free Software Foundation; either version 2 of the License, or (at your | |
12 | * option) any later version. | |
13 | */ | |
14 | #include <linux/clk.h> | |
15 | #include <linux/delay.h> | |
16 | #include <linux/device.h> | |
17 | #include <linux/dma-mapping.h> | |
18 | #include <linux/init.h> | |
19 | #include <linux/interrupt.h> | |
20 | #include <linux/module.h> | |
21 | #include <linux/platform_device.h> | |
5a0e3ad6 | 22 | #include <linux/slab.h> |
bf974a0d | 23 | #include <linux/dmaengine.h> |
8380222e SH |
24 | |
25 | #include <sound/core.h> | |
26 | #include <sound/initval.h> | |
27 | #include <sound/pcm.h> | |
28 | #include <sound/pcm_params.h> | |
29 | #include <sound/soc.h> | |
30 | ||
bf974a0d | 31 | #include <mach/dma.h> |
8380222e SH |
32 | |
33 | #include "imx-ssi.h" | |
34 | ||
35 | struct imx_pcm_runtime_data { | |
bf974a0d | 36 | int period_bytes; |
8380222e | 37 | int periods; |
8380222e | 38 | int dma; |
8380222e SH |
39 | unsigned long offset; |
40 | unsigned long size; | |
8380222e SH |
41 | void *buf; |
42 | int period_time; | |
bf974a0d SH |
43 | struct dma_async_tx_descriptor *desc; |
44 | struct dma_chan *dma_chan; | |
45 | struct imx_dma_data dma_data; | |
8380222e SH |
46 | }; |
47 | ||
bf974a0d | 48 | static void audio_dma_irq(void *data) |
8380222e | 49 | { |
bf974a0d | 50 | struct snd_pcm_substream *substream = (struct snd_pcm_substream *)data; |
8380222e SH |
51 | struct snd_pcm_runtime *runtime = substream->runtime; |
52 | struct imx_pcm_runtime_data *iprtd = runtime->private_data; | |
53 | ||
bf974a0d SH |
54 | iprtd->offset += iprtd->period_bytes; |
55 | iprtd->offset %= iprtd->period_bytes * iprtd->periods; | |
8380222e | 56 | |
bf974a0d | 57 | snd_pcm_period_elapsed(substream); |
8380222e SH |
58 | } |
59 | ||
bf974a0d | 60 | static bool filter(struct dma_chan *chan, void *param) |
8380222e | 61 | { |
bf974a0d | 62 | struct imx_pcm_runtime_data *iprtd = param; |
8380222e | 63 | |
bf974a0d SH |
64 | if (!imx_dma_is_general_purpose(chan)) |
65 | return false; | |
8380222e | 66 | |
bf974a0d | 67 | chan->private = &iprtd->dma_data; |
671999cb | 68 | |
bf974a0d | 69 | return true; |
8380222e SH |
70 | } |
71 | ||
bf974a0d SH |
72 | static int imx_ssi_dma_alloc(struct snd_pcm_substream *substream, |
73 | struct snd_pcm_hw_params *params) | |
8380222e SH |
74 | { |
75 | struct snd_soc_pcm_runtime *rtd = substream->private_data; | |
5f712b2b | 76 | struct imx_pcm_dma_params *dma_params; |
8380222e SH |
77 | struct snd_pcm_runtime *runtime = substream->runtime; |
78 | struct imx_pcm_runtime_data *iprtd = runtime->private_data; | |
bf974a0d SH |
79 | struct dma_slave_config slave_config; |
80 | dma_cap_mask_t mask; | |
81 | enum dma_slave_buswidth buswidth; | |
8380222e SH |
82 | int ret; |
83 | ||
f0fba2ad | 84 | dma_params = snd_soc_dai_get_dma_data(rtd->cpu_dai, substream); |
5f712b2b | 85 | |
bf974a0d SH |
86 | iprtd->dma_data.peripheral_type = IMX_DMATYPE_SSI; |
87 | iprtd->dma_data.priority = DMA_PRIO_HIGH; | |
88 | iprtd->dma_data.dma_request = dma_params->dma; | |
8380222e | 89 | |
bf974a0d SH |
90 | /* Try to grab a DMA channel */ |
91 | dma_cap_zero(mask); | |
92 | dma_cap_set(DMA_SLAVE, mask); | |
93 | iprtd->dma_chan = dma_request_channel(mask, filter, iprtd); | |
94 | if (!iprtd->dma_chan) | |
95 | return -EINVAL; | |
8380222e | 96 | |
bf974a0d SH |
97 | switch (params_format(params)) { |
98 | case SNDRV_PCM_FORMAT_S16_LE: | |
99 | buswidth = DMA_SLAVE_BUSWIDTH_2_BYTES; | |
100 | break; | |
101 | case SNDRV_PCM_FORMAT_S20_3LE: | |
102 | case SNDRV_PCM_FORMAT_S24_LE: | |
103 | buswidth = DMA_SLAVE_BUSWIDTH_4_BYTES; | |
104 | break; | |
105 | default: | |
106 | return 0; | |
8380222e SH |
107 | } |
108 | ||
bf974a0d SH |
109 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { |
110 | slave_config.direction = DMA_TO_DEVICE; | |
111 | slave_config.dst_addr = dma_params->dma_addr; | |
112 | slave_config.dst_addr_width = buswidth; | |
6584cb88 | 113 | slave_config.dst_maxburst = dma_params->burstsize; |
bf974a0d SH |
114 | } else { |
115 | slave_config.direction = DMA_FROM_DEVICE; | |
116 | slave_config.src_addr = dma_params->dma_addr; | |
117 | slave_config.src_addr_width = buswidth; | |
6584cb88 | 118 | slave_config.src_maxburst = dma_params->burstsize; |
8380222e SH |
119 | } |
120 | ||
bf974a0d SH |
121 | ret = dmaengine_slave_config(iprtd->dma_chan, &slave_config); |
122 | if (ret) | |
123 | return ret; | |
8380222e SH |
124 | |
125 | return 0; | |
8380222e SH |
126 | } |
127 | ||
128 | static int snd_imx_pcm_hw_params(struct snd_pcm_substream *substream, | |
129 | struct snd_pcm_hw_params *params) | |
130 | { | |
bf974a0d | 131 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
8380222e SH |
132 | struct snd_pcm_runtime *runtime = substream->runtime; |
133 | struct imx_pcm_runtime_data *iprtd = runtime->private_data; | |
8380222e | 134 | unsigned long dma_addr; |
bf974a0d SH |
135 | struct dma_chan *chan; |
136 | struct imx_pcm_dma_params *dma_params; | |
137 | int ret; | |
8380222e | 138 | |
bf974a0d SH |
139 | dma_params = snd_soc_dai_get_dma_data(rtd->cpu_dai, substream); |
140 | ret = imx_ssi_dma_alloc(substream, params); | |
141 | if (ret) | |
142 | return ret; | |
143 | chan = iprtd->dma_chan; | |
8380222e SH |
144 | |
145 | iprtd->size = params_buffer_bytes(params); | |
146 | iprtd->periods = params_periods(params); | |
bf974a0d | 147 | iprtd->period_bytes = params_period_bytes(params); |
8380222e SH |
148 | iprtd->offset = 0; |
149 | iprtd->period_time = HZ / (params_rate(params) / | |
150 | params_period_size(params)); | |
151 | ||
152 | snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer); | |
153 | ||
8380222e SH |
154 | dma_addr = runtime->dma_addr; |
155 | ||
bf974a0d SH |
156 | iprtd->buf = (unsigned int *)substream->dma_buffer.area; |
157 | ||
158 | iprtd->desc = chan->device->device_prep_dma_cyclic(chan, dma_addr, | |
159 | iprtd->period_bytes * iprtd->periods, | |
160 | iprtd->period_bytes, | |
161 | substream->stream == SNDRV_PCM_STREAM_PLAYBACK ? | |
162 | DMA_TO_DEVICE : DMA_FROM_DEVICE); | |
163 | if (!iprtd->desc) { | |
164 | dev_err(&chan->dev->device, "cannot prepare slave dma\n"); | |
165 | return -EINVAL; | |
8380222e SH |
166 | } |
167 | ||
bf974a0d SH |
168 | iprtd->desc->callback = audio_dma_irq; |
169 | iprtd->desc->callback_param = substream; | |
170 | ||
8380222e SH |
171 | return 0; |
172 | } | |
173 | ||
174 | static int snd_imx_pcm_hw_free(struct snd_pcm_substream *substream) | |
175 | { | |
176 | struct snd_pcm_runtime *runtime = substream->runtime; | |
177 | struct imx_pcm_runtime_data *iprtd = runtime->private_data; | |
178 | ||
bf974a0d SH |
179 | if (iprtd->dma_chan) { |
180 | dma_release_channel(iprtd->dma_chan); | |
181 | iprtd->dma_chan = NULL; | |
8380222e SH |
182 | } |
183 | ||
8380222e SH |
184 | return 0; |
185 | } | |
186 | ||
187 | static int snd_imx_pcm_prepare(struct snd_pcm_substream *substream) | |
188 | { | |
8380222e | 189 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
5f712b2b | 190 | struct imx_pcm_dma_params *dma_params; |
8380222e | 191 | |
f0fba2ad | 192 | dma_params = snd_soc_dai_get_dma_data(rtd->cpu_dai, substream); |
5f712b2b | 193 | |
8380222e SH |
194 | return 0; |
195 | } | |
196 | ||
197 | static int snd_imx_pcm_trigger(struct snd_pcm_substream *substream, int cmd) | |
198 | { | |
199 | struct snd_pcm_runtime *runtime = substream->runtime; | |
200 | struct imx_pcm_runtime_data *iprtd = runtime->private_data; | |
201 | ||
202 | switch (cmd) { | |
203 | case SNDRV_PCM_TRIGGER_START: | |
204 | case SNDRV_PCM_TRIGGER_RESUME: | |
205 | case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: | |
bf974a0d | 206 | dmaengine_submit(iprtd->desc); |
8380222e SH |
207 | |
208 | break; | |
209 | ||
210 | case SNDRV_PCM_TRIGGER_STOP: | |
211 | case SNDRV_PCM_TRIGGER_SUSPEND: | |
212 | case SNDRV_PCM_TRIGGER_PAUSE_PUSH: | |
bf974a0d | 213 | dmaengine_terminate_all(iprtd->dma_chan); |
8380222e SH |
214 | |
215 | break; | |
216 | default: | |
217 | return -EINVAL; | |
218 | } | |
219 | ||
220 | return 0; | |
221 | } | |
222 | ||
223 | static snd_pcm_uframes_t snd_imx_pcm_pointer(struct snd_pcm_substream *substream) | |
224 | { | |
225 | struct snd_pcm_runtime *runtime = substream->runtime; | |
226 | struct imx_pcm_runtime_data *iprtd = runtime->private_data; | |
227 | ||
bf974a0d SH |
228 | pr_debug("%s: %ld %ld\n", __func__, iprtd->offset, |
229 | bytes_to_frames(substream->runtime, iprtd->offset)); | |
230 | ||
8380222e SH |
231 | return bytes_to_frames(substream->runtime, iprtd->offset); |
232 | } | |
233 | ||
234 | static struct snd_pcm_hardware snd_imx_hardware = { | |
235 | .info = SNDRV_PCM_INFO_INTERLEAVED | | |
236 | SNDRV_PCM_INFO_BLOCK_TRANSFER | | |
237 | SNDRV_PCM_INFO_MMAP | | |
238 | SNDRV_PCM_INFO_MMAP_VALID | | |
239 | SNDRV_PCM_INFO_PAUSE | | |
240 | SNDRV_PCM_INFO_RESUME, | |
241 | .formats = SNDRV_PCM_FMTBIT_S16_LE, | |
242 | .rate_min = 8000, | |
243 | .channels_min = 2, | |
244 | .channels_max = 2, | |
245 | .buffer_bytes_max = IMX_SSI_DMABUF_SIZE, | |
246 | .period_bytes_min = 128, | |
bf974a0d | 247 | .period_bytes_max = 65535, /* Limited by SDMA engine */ |
8380222e SH |
248 | .periods_min = 2, |
249 | .periods_max = 255, | |
250 | .fifo_size = 0, | |
251 | }; | |
252 | ||
253 | static int snd_imx_open(struct snd_pcm_substream *substream) | |
254 | { | |
255 | struct snd_pcm_runtime *runtime = substream->runtime; | |
256 | struct imx_pcm_runtime_data *iprtd; | |
257 | int ret; | |
258 | ||
259 | iprtd = kzalloc(sizeof(*iprtd), GFP_KERNEL); | |
51b6dfb6 KV |
260 | if (iprtd == NULL) |
261 | return -ENOMEM; | |
8380222e SH |
262 | runtime->private_data = iprtd; |
263 | ||
264 | ret = snd_pcm_hw_constraint_integer(substream->runtime, | |
265 | SNDRV_PCM_HW_PARAM_PERIODS); | |
51b6dfb6 KV |
266 | if (ret < 0) { |
267 | kfree(iprtd); | |
8380222e | 268 | return ret; |
51b6dfb6 | 269 | } |
8380222e SH |
270 | |
271 | snd_soc_set_runtime_hwparams(substream, &snd_imx_hardware); | |
bf974a0d SH |
272 | |
273 | return 0; | |
274 | } | |
275 | ||
276 | static int snd_imx_close(struct snd_pcm_substream *substream) | |
277 | { | |
278 | struct snd_pcm_runtime *runtime = substream->runtime; | |
279 | struct imx_pcm_runtime_data *iprtd = runtime->private_data; | |
280 | ||
281 | kfree(iprtd); | |
282 | ||
8380222e SH |
283 | return 0; |
284 | } | |
285 | ||
286 | static struct snd_pcm_ops imx_pcm_ops = { | |
287 | .open = snd_imx_open, | |
bf974a0d | 288 | .close = snd_imx_close, |
8380222e SH |
289 | .ioctl = snd_pcm_lib_ioctl, |
290 | .hw_params = snd_imx_pcm_hw_params, | |
291 | .hw_free = snd_imx_pcm_hw_free, | |
292 | .prepare = snd_imx_pcm_prepare, | |
293 | .trigger = snd_imx_pcm_trigger, | |
294 | .pointer = snd_imx_pcm_pointer, | |
295 | .mmap = snd_imx_pcm_mmap, | |
296 | }; | |
297 | ||
f0fba2ad LG |
298 | static struct snd_soc_platform_driver imx_soc_platform_mx2 = { |
299 | .ops = &imx_pcm_ops, | |
8380222e SH |
300 | .pcm_new = imx_pcm_new, |
301 | .pcm_free = imx_pcm_free, | |
302 | }; | |
303 | ||
f0fba2ad | 304 | static int __devinit imx_soc_platform_probe(struct platform_device *pdev) |
8380222e | 305 | { |
2c4cf17a WS |
306 | struct imx_ssi *ssi = platform_get_drvdata(pdev); |
307 | ||
308 | ssi->dma_params_tx.burstsize = 6; | |
309 | ssi->dma_params_rx.burstsize = 4; | |
310 | ||
f0fba2ad LG |
311 | return snd_soc_register_platform(&pdev->dev, &imx_soc_platform_mx2); |
312 | } | |
313 | ||
314 | static int __devexit imx_soc_platform_remove(struct platform_device *pdev) | |
315 | { | |
316 | snd_soc_unregister_platform(&pdev->dev); | |
317 | return 0; | |
318 | } | |
319 | ||
320 | static struct platform_driver imx_pcm_driver = { | |
321 | .driver = { | |
322 | .name = "imx-pcm-audio", | |
323 | .owner = THIS_MODULE, | |
324 | }, | |
f0fba2ad LG |
325 | .probe = imx_soc_platform_probe, |
326 | .remove = __devexit_p(imx_soc_platform_remove), | |
327 | }; | |
328 | ||
329 | static int __init snd_imx_pcm_init(void) | |
330 | { | |
331 | return platform_driver_register(&imx_pcm_driver); | |
332 | } | |
333 | module_init(snd_imx_pcm_init); | |
334 | ||
335 | static void __exit snd_imx_pcm_exit(void) | |
336 | { | |
337 | platform_driver_unregister(&imx_pcm_driver); | |
8380222e | 338 | } |
f0fba2ad | 339 | module_exit(snd_imx_pcm_exit); |
96dcabb9 APR |
340 | MODULE_LICENSE("GPL"); |
341 | MODULE_ALIAS("platform:imx-pcm-audio"); |