xref: /openbmc/linux/sound/soc/au1x/dbdma2.c (revision 4800cd83)
1 /*
2  * Au12x0/Au1550 PSC ALSA ASoC audio support.
3  *
4  * (c) 2007-2008 MSC Vertriebsges.m.b.H.,
5  *	Manuel Lauss <manuel.lauss@gmail.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  *
11  * DMA glue for Au1x-PSC audio.
12  *
13  */
14 
15 
16 #include <linux/module.h>
17 #include <linux/init.h>
18 #include <linux/platform_device.h>
19 #include <linux/slab.h>
20 #include <linux/dma-mapping.h>
21 
22 #include <sound/core.h>
23 #include <sound/pcm.h>
24 #include <sound/pcm_params.h>
25 #include <sound/soc.h>
26 
27 #include <asm/mach-au1x00/au1000.h>
28 #include <asm/mach-au1x00/au1xxx_dbdma.h>
29 #include <asm/mach-au1x00/au1xxx_psc.h>
30 
31 #include "psc.h"
32 
33 /*#define PCM_DEBUG*/
34 
35 #define MSG(x...)	printk(KERN_INFO "au1xpsc_pcm: " x)
36 #ifdef PCM_DEBUG
37 #define DBG		MSG
38 #else
39 #define DBG(x...)	do {} while (0)
40 #endif
41 
42 struct au1xpsc_audio_dmadata {
43 	/* DDMA control data */
44 	unsigned int ddma_id;		/* DDMA direction ID for this PSC */
45 	u32 ddma_chan;			/* DDMA context */
46 
47 	/* PCM context (for irq handlers) */
48 	struct snd_pcm_substream *substream;
49 	unsigned long curr_period;	/* current segment DDMA is working on */
50 	unsigned long q_period;		/* queue period(s) */
51 	dma_addr_t dma_area;		/* address of queued DMA area */
52 	dma_addr_t dma_area_s;		/* start address of DMA area */
53 	unsigned long pos;		/* current byte position being played */
54 	unsigned long periods;		/* number of SG segments in total */
55 	unsigned long period_bytes;	/* size in bytes of one SG segment */
56 
57 	/* runtime data */
58 	int msbits;
59 };
60 
61 /*
62  * These settings are somewhat okay, at least on my machine audio plays
63  * almost skip-free. Especially the 64kB buffer seems to help a LOT.
64  */
65 #define AU1XPSC_PERIOD_MIN_BYTES	1024
66 #define AU1XPSC_BUFFER_MIN_BYTES	65536
67 
68 #define AU1XPSC_PCM_FMTS					\
69 	(SNDRV_PCM_FMTBIT_S8     | SNDRV_PCM_FMTBIT_U8 |	\
70 	 SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S16_BE |	\
71 	 SNDRV_PCM_FMTBIT_U16_LE | SNDRV_PCM_FMTBIT_U16_BE |	\
72 	 SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S32_BE |	\
73 	 SNDRV_PCM_FMTBIT_U32_LE | SNDRV_PCM_FMTBIT_U32_BE |	\
74 	 0)
75 
76 /* PCM hardware DMA capabilities - platform specific */
77 static const struct snd_pcm_hardware au1xpsc_pcm_hardware = {
78 	.info		  = SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID |
79 			    SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_BATCH,
80 	.formats	  = AU1XPSC_PCM_FMTS,
81 	.period_bytes_min = AU1XPSC_PERIOD_MIN_BYTES,
82 	.period_bytes_max = 4096 * 1024 - 1,
83 	.periods_min	  = 2,
84 	.periods_max	  = 4096,	/* 2 to as-much-as-you-like */
85 	.buffer_bytes_max = 4096 * 1024 - 1,
86 	.fifo_size	  = 16,		/* fifo entries of AC97/I2S PSC */
87 };
88 
89 static void au1x_pcm_queue_tx(struct au1xpsc_audio_dmadata *cd)
90 {
91 	au1xxx_dbdma_put_source(cd->ddma_chan, cd->dma_area,
92 				cd->period_bytes, DDMA_FLAGS_IE);
93 
94 	/* update next-to-queue period */
95 	++cd->q_period;
96 	cd->dma_area += cd->period_bytes;
97 	if (cd->q_period >= cd->periods) {
98 		cd->q_period = 0;
99 		cd->dma_area = cd->dma_area_s;
100 	}
101 }
102 
103 static void au1x_pcm_queue_rx(struct au1xpsc_audio_dmadata *cd)
104 {
105 	au1xxx_dbdma_put_dest(cd->ddma_chan, cd->dma_area,
106 			      cd->period_bytes, DDMA_FLAGS_IE);
107 
108 	/* update next-to-queue period */
109 	++cd->q_period;
110 	cd->dma_area += cd->period_bytes;
111 	if (cd->q_period >= cd->periods) {
112 		cd->q_period = 0;
113 		cd->dma_area = cd->dma_area_s;
114 	}
115 }
116 
117 static void au1x_pcm_dmatx_cb(int irq, void *dev_id)
118 {
119 	struct au1xpsc_audio_dmadata *cd = dev_id;
120 
121 	cd->pos += cd->period_bytes;
122 	if (++cd->curr_period >= cd->periods) {
123 		cd->pos = 0;
124 		cd->curr_period = 0;
125 	}
126 	snd_pcm_period_elapsed(cd->substream);
127 	au1x_pcm_queue_tx(cd);
128 }
129 
130 static void au1x_pcm_dmarx_cb(int irq, void *dev_id)
131 {
132 	struct au1xpsc_audio_dmadata *cd = dev_id;
133 
134 	cd->pos += cd->period_bytes;
135 	if (++cd->curr_period >= cd->periods) {
136 		cd->pos = 0;
137 		cd->curr_period = 0;
138 	}
139 	snd_pcm_period_elapsed(cd->substream);
140 	au1x_pcm_queue_rx(cd);
141 }
142 
143 static void au1x_pcm_dbdma_free(struct au1xpsc_audio_dmadata *pcd)
144 {
145 	if (pcd->ddma_chan) {
146 		au1xxx_dbdma_stop(pcd->ddma_chan);
147 		au1xxx_dbdma_reset(pcd->ddma_chan);
148 		au1xxx_dbdma_chan_free(pcd->ddma_chan);
149 		pcd->ddma_chan = 0;
150 		pcd->msbits = 0;
151 	}
152 }
153 
154 /* in case of missing DMA ring or changed TX-source / RX-dest bit widths,
155  * allocate (or reallocate) a 2-descriptor DMA ring with bit depth according
156  * to ALSA-supplied sample depth.  This is due to limitations in the dbdma api
157  * (cannot adjust source/dest widths of already allocated descriptor ring).
158  */
159 static int au1x_pcm_dbdma_realloc(struct au1xpsc_audio_dmadata *pcd,
160 				 int stype, int msbits)
161 {
162 	/* DMA only in 8/16/32 bit widths */
163 	if (msbits == 24)
164 		msbits = 32;
165 
166 	/* check current config: correct bits and descriptors allocated? */
167 	if ((pcd->ddma_chan) && (msbits == pcd->msbits))
168 		goto out;	/* all ok! */
169 
170 	au1x_pcm_dbdma_free(pcd);
171 
172 	if (stype == PCM_RX)
173 		pcd->ddma_chan = au1xxx_dbdma_chan_alloc(pcd->ddma_id,
174 					DSCR_CMD0_ALWAYS,
175 					au1x_pcm_dmarx_cb, (void *)pcd);
176 	else
177 		pcd->ddma_chan = au1xxx_dbdma_chan_alloc(DSCR_CMD0_ALWAYS,
178 					pcd->ddma_id,
179 					au1x_pcm_dmatx_cb, (void *)pcd);
180 
181 	if (!pcd->ddma_chan)
182 		return -ENOMEM;
183 
184 	au1xxx_dbdma_set_devwidth(pcd->ddma_chan, msbits);
185 	au1xxx_dbdma_ring_alloc(pcd->ddma_chan, 2);
186 
187 	pcd->msbits = msbits;
188 
189 	au1xxx_dbdma_stop(pcd->ddma_chan);
190 	au1xxx_dbdma_reset(pcd->ddma_chan);
191 
192 out:
193 	return 0;
194 }
195 
196 static inline struct au1xpsc_audio_dmadata *to_dmadata(struct snd_pcm_substream *ss)
197 {
198 	struct snd_soc_pcm_runtime *rtd = ss->private_data;
199 	struct au1xpsc_audio_dmadata *pcd =
200 				snd_soc_platform_get_drvdata(rtd->platform);
201 	return &pcd[SUBSTREAM_TYPE(ss)];
202 }
203 
204 static int au1xpsc_pcm_hw_params(struct snd_pcm_substream *substream,
205 				 struct snd_pcm_hw_params *params)
206 {
207 	struct snd_pcm_runtime *runtime = substream->runtime;
208 	struct au1xpsc_audio_dmadata *pcd;
209 	int stype, ret;
210 
211 	ret = snd_pcm_lib_malloc_pages(substream, params_buffer_bytes(params));
212 	if (ret < 0)
213 		goto out;
214 
215 	stype = SUBSTREAM_TYPE(substream);
216 	pcd = to_dmadata(substream);
217 
218 	DBG("runtime->dma_area = 0x%08lx dma_addr_t = 0x%08lx dma_size = %d "
219 	    "runtime->min_align %d\n",
220 		(unsigned long)runtime->dma_area,
221 		(unsigned long)runtime->dma_addr, runtime->dma_bytes,
222 		runtime->min_align);
223 
224 	DBG("bits %d  frags %d  frag_bytes %d  is_rx %d\n", params->msbits,
225 		params_periods(params), params_period_bytes(params), stype);
226 
227 	ret = au1x_pcm_dbdma_realloc(pcd, stype, params->msbits);
228 	if (ret) {
229 		MSG("DDMA channel (re)alloc failed!\n");
230 		goto out;
231 	}
232 
233 	pcd->substream = substream;
234 	pcd->period_bytes = params_period_bytes(params);
235 	pcd->periods = params_periods(params);
236 	pcd->dma_area_s = pcd->dma_area = runtime->dma_addr;
237 	pcd->q_period = 0;
238 	pcd->curr_period = 0;
239 	pcd->pos = 0;
240 
241 	ret = 0;
242 out:
243 	return ret;
244 }
245 
246 static int au1xpsc_pcm_hw_free(struct snd_pcm_substream *substream)
247 {
248 	snd_pcm_lib_free_pages(substream);
249 	return 0;
250 }
251 
252 static int au1xpsc_pcm_prepare(struct snd_pcm_substream *substream)
253 {
254 	struct au1xpsc_audio_dmadata *pcd = to_dmadata(substream);
255 
256 	au1xxx_dbdma_reset(pcd->ddma_chan);
257 
258 	if (SUBSTREAM_TYPE(substream) == PCM_RX) {
259 		au1x_pcm_queue_rx(pcd);
260 		au1x_pcm_queue_rx(pcd);
261 	} else {
262 		au1x_pcm_queue_tx(pcd);
263 		au1x_pcm_queue_tx(pcd);
264 	}
265 
266 	return 0;
267 }
268 
269 static int au1xpsc_pcm_trigger(struct snd_pcm_substream *substream, int cmd)
270 {
271 	u32 c = to_dmadata(substream)->ddma_chan;
272 
273 	switch (cmd) {
274 	case SNDRV_PCM_TRIGGER_START:
275 	case SNDRV_PCM_TRIGGER_RESUME:
276 		au1xxx_dbdma_start(c);
277 		break;
278 	case SNDRV_PCM_TRIGGER_STOP:
279 	case SNDRV_PCM_TRIGGER_SUSPEND:
280 		au1xxx_dbdma_stop(c);
281 		break;
282 	default:
283 		return -EINVAL;
284 	}
285 	return 0;
286 }
287 
288 static snd_pcm_uframes_t
289 au1xpsc_pcm_pointer(struct snd_pcm_substream *substream)
290 {
291 	return bytes_to_frames(substream->runtime, to_dmadata(substream)->pos);
292 }
293 
294 static int au1xpsc_pcm_open(struct snd_pcm_substream *substream)
295 {
296 	snd_soc_set_runtime_hwparams(substream, &au1xpsc_pcm_hardware);
297 	return 0;
298 }
299 
300 static int au1xpsc_pcm_close(struct snd_pcm_substream *substream)
301 {
302 	au1x_pcm_dbdma_free(to_dmadata(substream));
303 	return 0;
304 }
305 
306 static struct snd_pcm_ops au1xpsc_pcm_ops = {
307 	.open		= au1xpsc_pcm_open,
308 	.close		= au1xpsc_pcm_close,
309 	.ioctl		= snd_pcm_lib_ioctl,
310 	.hw_params	= au1xpsc_pcm_hw_params,
311 	.hw_free	= au1xpsc_pcm_hw_free,
312 	.prepare	= au1xpsc_pcm_prepare,
313 	.trigger	= au1xpsc_pcm_trigger,
314 	.pointer	= au1xpsc_pcm_pointer,
315 };
316 
317 static void au1xpsc_pcm_free_dma_buffers(struct snd_pcm *pcm)
318 {
319 	snd_pcm_lib_preallocate_free_for_all(pcm);
320 }
321 
322 static int au1xpsc_pcm_new(struct snd_card *card,
323 			   struct snd_soc_dai *dai,
324 			   struct snd_pcm *pcm)
325 {
326 	snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
327 		card->dev, AU1XPSC_BUFFER_MIN_BYTES, (4096 * 1024) - 1);
328 
329 	return 0;
330 }
331 
332 /* au1xpsc audio platform */
333 struct snd_soc_platform_driver au1xpsc_soc_platform = {
334 	.ops		= &au1xpsc_pcm_ops,
335 	.pcm_new	= au1xpsc_pcm_new,
336 	.pcm_free	= au1xpsc_pcm_free_dma_buffers,
337 };
338 
339 static int __devinit au1xpsc_pcm_drvprobe(struct platform_device *pdev)
340 {
341 	struct au1xpsc_audio_dmadata *dmadata;
342 	struct resource *r;
343 	int ret;
344 
345 	dmadata = kzalloc(2 * sizeof(struct au1xpsc_audio_dmadata), GFP_KERNEL);
346 	if (!dmadata)
347 		return -ENOMEM;
348 
349 	r = platform_get_resource(pdev, IORESOURCE_DMA, 0);
350 	if (!r) {
351 		ret = -ENODEV;
352 		goto out1;
353 	}
354 	dmadata[PCM_TX].ddma_id = r->start;
355 
356 	/* RX DMA */
357 	r = platform_get_resource(pdev, IORESOURCE_DMA, 1);
358 	if (!r) {
359 		ret = -ENODEV;
360 		goto out1;
361 	}
362 	dmadata[PCM_RX].ddma_id = r->start;
363 
364 	platform_set_drvdata(pdev, dmadata);
365 
366 	ret = snd_soc_register_platform(&pdev->dev, &au1xpsc_soc_platform);
367 	if (!ret)
368 		return ret;
369 
370 out1:
371 	kfree(dmadata);
372 	return ret;
373 }
374 
375 static int __devexit au1xpsc_pcm_drvremove(struct platform_device *pdev)
376 {
377 	struct au1xpsc_audio_dmadata *dmadata = platform_get_drvdata(pdev);
378 
379 	snd_soc_unregister_platform(&pdev->dev);
380 	kfree(dmadata);
381 
382 	return 0;
383 }
384 
385 static struct platform_driver au1xpsc_pcm_driver = {
386 	.driver	= {
387 		.name	= "au1xpsc-pcm",
388 		.owner	= THIS_MODULE,
389 	},
390 	.probe		= au1xpsc_pcm_drvprobe,
391 	.remove		= __devexit_p(au1xpsc_pcm_drvremove),
392 };
393 
394 static int __init au1xpsc_audio_dbdma_load(void)
395 {
396 	return platform_driver_register(&au1xpsc_pcm_driver);
397 }
398 
399 static void __exit au1xpsc_audio_dbdma_unload(void)
400 {
401 	platform_driver_unregister(&au1xpsc_pcm_driver);
402 }
403 
404 module_init(au1xpsc_audio_dbdma_load);
405 module_exit(au1xpsc_audio_dbdma_unload);
406 
407 
408 struct platform_device *au1xpsc_pcm_add(struct platform_device *pdev)
409 {
410 	struct resource *res, *r;
411 	struct platform_device *pd;
412 	int id[2];
413 	int ret;
414 
415 	r = platform_get_resource(pdev, IORESOURCE_DMA, 0);
416 	if (!r)
417 		return NULL;
418 	id[0] = r->start;
419 
420 	r = platform_get_resource(pdev, IORESOURCE_DMA, 1);
421 	if (!r)
422 		return NULL;
423 	id[1] = r->start;
424 
425 	res = kzalloc(sizeof(struct resource) * 2, GFP_KERNEL);
426 	if (!res)
427 		return NULL;
428 
429 	res[0].start = res[0].end = id[0];
430 	res[1].start = res[1].end = id[1];
431 	res[0].flags = res[1].flags = IORESOURCE_DMA;
432 
433 	pd = platform_device_alloc("au1xpsc-pcm", pdev->id);
434 	if (!pd)
435 		goto out;
436 
437 	pd->resource = res;
438 	pd->num_resources = 2;
439 
440 	ret = platform_device_add(pd);
441 	if (!ret)
442 		return pd;
443 
444 	platform_device_put(pd);
445 out:
446 	kfree(res);
447 	return NULL;
448 }
449 EXPORT_SYMBOL_GPL(au1xpsc_pcm_add);
450 
451 void au1xpsc_pcm_destroy(struct platform_device *dmapd)
452 {
453 	if (dmapd)
454 		platform_device_unregister(dmapd);
455 }
456 EXPORT_SYMBOL_GPL(au1xpsc_pcm_destroy);
457 
458 MODULE_LICENSE("GPL");
459 MODULE_DESCRIPTION("Au12x0/Au1550 PSC Audio DMA driver");
460 MODULE_AUTHOR("Manuel Lauss");
461