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