1 /* 2 * This program is free software; you can redistribute it and/or modify 3 * it under the terms of the GNU General Public License version 2 as 4 * published by the Free Software Foundation. 5 */ 6 7 #include <linux/slab.h> 8 #include <linux/module.h> 9 #include <linux/dma-mapping.h> 10 11 #include <sound/core.h> 12 #include <sound/pcm.h> 13 #include <sound/pcm_params.h> 14 #include <sound/pxa2xx-lib.h> 15 16 #include <mach/dma.h> 17 18 #include "pxa2xx-pcm.h" 19 20 static const struct snd_pcm_hardware pxa2xx_pcm_hardware = { 21 .info = SNDRV_PCM_INFO_MMAP | 22 SNDRV_PCM_INFO_MMAP_VALID | 23 SNDRV_PCM_INFO_INTERLEAVED | 24 SNDRV_PCM_INFO_PAUSE | 25 SNDRV_PCM_INFO_RESUME, 26 .formats = SNDRV_PCM_FMTBIT_S16_LE | 27 SNDRV_PCM_FMTBIT_S24_LE | 28 SNDRV_PCM_FMTBIT_S32_LE, 29 .period_bytes_min = 32, 30 .period_bytes_max = 8192 - 32, 31 .periods_min = 1, 32 .periods_max = PAGE_SIZE/sizeof(pxa_dma_desc), 33 .buffer_bytes_max = 128 * 1024, 34 .fifo_size = 32, 35 }; 36 37 int __pxa2xx_pcm_hw_params(struct snd_pcm_substream *substream, 38 struct snd_pcm_hw_params *params) 39 { 40 struct snd_pcm_runtime *runtime = substream->runtime; 41 struct pxa2xx_runtime_data *rtd = runtime->private_data; 42 size_t totsize = params_buffer_bytes(params); 43 size_t period = params_period_bytes(params); 44 pxa_dma_desc *dma_desc; 45 dma_addr_t dma_buff_phys, next_desc_phys; 46 47 snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer); 48 runtime->dma_bytes = totsize; 49 50 dma_desc = rtd->dma_desc_array; 51 next_desc_phys = rtd->dma_desc_array_phys; 52 dma_buff_phys = runtime->dma_addr; 53 do { 54 next_desc_phys += sizeof(pxa_dma_desc); 55 dma_desc->ddadr = next_desc_phys; 56 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 57 dma_desc->dsadr = dma_buff_phys; 58 dma_desc->dtadr = rtd->params->dev_addr; 59 } else { 60 dma_desc->dsadr = rtd->params->dev_addr; 61 dma_desc->dtadr = dma_buff_phys; 62 } 63 if (period > totsize) 64 period = totsize; 65 dma_desc->dcmd = rtd->params->dcmd | period | DCMD_ENDIRQEN; 66 dma_desc++; 67 dma_buff_phys += period; 68 } while (totsize -= period); 69 dma_desc[-1].ddadr = rtd->dma_desc_array_phys; 70 71 return 0; 72 } 73 EXPORT_SYMBOL(__pxa2xx_pcm_hw_params); 74 75 int __pxa2xx_pcm_hw_free(struct snd_pcm_substream *substream) 76 { 77 struct pxa2xx_runtime_data *rtd = substream->runtime->private_data; 78 79 if (rtd && rtd->params && rtd->params->drcmr) 80 *rtd->params->drcmr = 0; 81 82 snd_pcm_set_runtime_buffer(substream, NULL); 83 return 0; 84 } 85 EXPORT_SYMBOL(__pxa2xx_pcm_hw_free); 86 87 int pxa2xx_pcm_trigger(struct snd_pcm_substream *substream, int cmd) 88 { 89 struct pxa2xx_runtime_data *prtd = substream->runtime->private_data; 90 int ret = 0; 91 92 switch (cmd) { 93 case SNDRV_PCM_TRIGGER_START: 94 DDADR(prtd->dma_ch) = prtd->dma_desc_array_phys; 95 DCSR(prtd->dma_ch) = DCSR_RUN; 96 break; 97 98 case SNDRV_PCM_TRIGGER_STOP: 99 case SNDRV_PCM_TRIGGER_SUSPEND: 100 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 101 DCSR(prtd->dma_ch) &= ~DCSR_RUN; 102 break; 103 104 case SNDRV_PCM_TRIGGER_RESUME: 105 DCSR(prtd->dma_ch) |= DCSR_RUN; 106 break; 107 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 108 DDADR(prtd->dma_ch) = prtd->dma_desc_array_phys; 109 DCSR(prtd->dma_ch) |= DCSR_RUN; 110 break; 111 112 default: 113 ret = -EINVAL; 114 } 115 116 return ret; 117 } 118 EXPORT_SYMBOL(pxa2xx_pcm_trigger); 119 120 snd_pcm_uframes_t 121 pxa2xx_pcm_pointer(struct snd_pcm_substream *substream) 122 { 123 struct snd_pcm_runtime *runtime = substream->runtime; 124 struct pxa2xx_runtime_data *prtd = runtime->private_data; 125 126 dma_addr_t ptr = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) ? 127 DSADR(prtd->dma_ch) : DTADR(prtd->dma_ch); 128 snd_pcm_uframes_t x = bytes_to_frames(runtime, ptr - runtime->dma_addr); 129 130 if (x == runtime->buffer_size) 131 x = 0; 132 return x; 133 } 134 EXPORT_SYMBOL(pxa2xx_pcm_pointer); 135 136 int __pxa2xx_pcm_prepare(struct snd_pcm_substream *substream) 137 { 138 struct pxa2xx_runtime_data *prtd = substream->runtime->private_data; 139 140 if (!prtd || !prtd->params) 141 return 0; 142 143 if (prtd->dma_ch == -1) 144 return -EINVAL; 145 146 DCSR(prtd->dma_ch) &= ~DCSR_RUN; 147 DCSR(prtd->dma_ch) = 0; 148 DCMD(prtd->dma_ch) = 0; 149 *prtd->params->drcmr = prtd->dma_ch | DRCMR_MAPVLD; 150 151 return 0; 152 } 153 EXPORT_SYMBOL(__pxa2xx_pcm_prepare); 154 155 void pxa2xx_pcm_dma_irq(int dma_ch, void *dev_id) 156 { 157 struct snd_pcm_substream *substream = dev_id; 158 struct pxa2xx_runtime_data *rtd = substream->runtime->private_data; 159 int dcsr; 160 161 dcsr = DCSR(dma_ch); 162 DCSR(dma_ch) = dcsr & ~DCSR_STOPIRQEN; 163 164 if (dcsr & DCSR_ENDINTR) { 165 snd_pcm_period_elapsed(substream); 166 } else { 167 printk(KERN_ERR "%s: DMA error on channel %d (DCSR=%#x)\n", 168 rtd->params->name, dma_ch, dcsr); 169 snd_pcm_stream_lock(substream); 170 snd_pcm_stop(substream, SNDRV_PCM_STATE_XRUN); 171 snd_pcm_stream_unlock(substream); 172 } 173 } 174 EXPORT_SYMBOL(pxa2xx_pcm_dma_irq); 175 176 int __pxa2xx_pcm_open(struct snd_pcm_substream *substream) 177 { 178 struct snd_pcm_runtime *runtime = substream->runtime; 179 struct pxa2xx_runtime_data *rtd; 180 int ret; 181 182 runtime->hw = pxa2xx_pcm_hardware; 183 184 /* 185 * For mysterious reasons (and despite what the manual says) 186 * playback samples are lost if the DMA count is not a multiple 187 * of the DMA burst size. Let's add a rule to enforce that. 188 */ 189 ret = snd_pcm_hw_constraint_step(runtime, 0, 190 SNDRV_PCM_HW_PARAM_PERIOD_BYTES, 32); 191 if (ret) 192 goto out; 193 194 ret = snd_pcm_hw_constraint_step(runtime, 0, 195 SNDRV_PCM_HW_PARAM_BUFFER_BYTES, 32); 196 if (ret) 197 goto out; 198 199 ret = snd_pcm_hw_constraint_integer(runtime, 200 SNDRV_PCM_HW_PARAM_PERIODS); 201 if (ret < 0) 202 goto out; 203 204 ret = -ENOMEM; 205 rtd = kzalloc(sizeof(*rtd), GFP_KERNEL); 206 if (!rtd) 207 goto out; 208 rtd->dma_desc_array = 209 dma_alloc_writecombine(substream->pcm->card->dev, PAGE_SIZE, 210 &rtd->dma_desc_array_phys, GFP_KERNEL); 211 if (!rtd->dma_desc_array) 212 goto err1; 213 214 rtd->dma_ch = -1; 215 runtime->private_data = rtd; 216 return 0; 217 218 err1: 219 kfree(rtd); 220 out: 221 return ret; 222 } 223 EXPORT_SYMBOL(__pxa2xx_pcm_open); 224 225 int __pxa2xx_pcm_close(struct snd_pcm_substream *substream) 226 { 227 struct snd_pcm_runtime *runtime = substream->runtime; 228 struct pxa2xx_runtime_data *rtd = runtime->private_data; 229 230 dma_free_writecombine(substream->pcm->card->dev, PAGE_SIZE, 231 rtd->dma_desc_array, rtd->dma_desc_array_phys); 232 kfree(rtd); 233 return 0; 234 } 235 EXPORT_SYMBOL(__pxa2xx_pcm_close); 236 237 int pxa2xx_pcm_mmap(struct snd_pcm_substream *substream, 238 struct vm_area_struct *vma) 239 { 240 struct snd_pcm_runtime *runtime = substream->runtime; 241 return dma_mmap_writecombine(substream->pcm->card->dev, vma, 242 runtime->dma_area, 243 runtime->dma_addr, 244 runtime->dma_bytes); 245 } 246 EXPORT_SYMBOL(pxa2xx_pcm_mmap); 247 248 int pxa2xx_pcm_preallocate_dma_buffer(struct snd_pcm *pcm, int stream) 249 { 250 struct snd_pcm_substream *substream = pcm->streams[stream].substream; 251 struct snd_dma_buffer *buf = &substream->dma_buffer; 252 size_t size = pxa2xx_pcm_hardware.buffer_bytes_max; 253 buf->dev.type = SNDRV_DMA_TYPE_DEV; 254 buf->dev.dev = pcm->card->dev; 255 buf->private_data = NULL; 256 buf->area = dma_alloc_writecombine(pcm->card->dev, size, 257 &buf->addr, GFP_KERNEL); 258 if (!buf->area) 259 return -ENOMEM; 260 buf->bytes = size; 261 return 0; 262 } 263 EXPORT_SYMBOL(pxa2xx_pcm_preallocate_dma_buffer); 264 265 void pxa2xx_pcm_free_dma_buffers(struct snd_pcm *pcm) 266 { 267 struct snd_pcm_substream *substream; 268 struct snd_dma_buffer *buf; 269 int stream; 270 271 for (stream = 0; stream < 2; stream++) { 272 substream = pcm->streams[stream].substream; 273 if (!substream) 274 continue; 275 buf = &substream->dma_buffer; 276 if (!buf->area) 277 continue; 278 dma_free_writecombine(pcm->card->dev, buf->bytes, 279 buf->area, buf->addr); 280 buf->area = NULL; 281 } 282 } 283 EXPORT_SYMBOL(pxa2xx_pcm_free_dma_buffers); 284 285 MODULE_AUTHOR("Nicolas Pitre"); 286 MODULE_DESCRIPTION("Intel PXA2xx sound library"); 287 MODULE_LICENSE("GPL"); 288