189dd0842SJon Smirl /* 289dd0842SJon Smirl * Freescale MPC5200 PSC DMA 389dd0842SJon Smirl * ALSA SoC Platform driver 489dd0842SJon Smirl * 589dd0842SJon Smirl * Copyright (C) 2008 Secret Lab Technologies Ltd. 6dbcc3475SJon Smirl * Copyright (C) 2009 Jon Smirl, Digispeaker 789dd0842SJon Smirl */ 889dd0842SJon Smirl 989dd0842SJon Smirl #include <linux/module.h> 1089dd0842SJon Smirl #include <linux/of_device.h> 1189dd0842SJon Smirl 1289dd0842SJon Smirl #include <sound/soc.h> 1389dd0842SJon Smirl 1489dd0842SJon Smirl #include <sysdev/bestcomm/bestcomm.h> 1589dd0842SJon Smirl #include <sysdev/bestcomm/gen_bd.h> 1689dd0842SJon Smirl #include <asm/mpc52xx_psc.h> 1789dd0842SJon Smirl 1889dd0842SJon Smirl #include "mpc5200_dma.h" 1989dd0842SJon Smirl 2089dd0842SJon Smirl /* 2189dd0842SJon Smirl * Interrupt handlers 2289dd0842SJon Smirl */ 23cebe7767SJon Smirl static irqreturn_t psc_dma_status_irq(int irq, void *_psc_dma) 2489dd0842SJon Smirl { 25cebe7767SJon Smirl struct psc_dma *psc_dma = _psc_dma; 26cebe7767SJon Smirl struct mpc52xx_psc __iomem *regs = psc_dma->psc_regs; 2789dd0842SJon Smirl u16 isr; 2889dd0842SJon Smirl 2989dd0842SJon Smirl isr = in_be16(®s->mpc52xx_psc_isr); 3089dd0842SJon Smirl 3189dd0842SJon Smirl /* Playback underrun error */ 32cebe7767SJon Smirl if (psc_dma->playback.active && (isr & MPC52xx_PSC_IMR_TXEMP)) 33cebe7767SJon Smirl psc_dma->stats.underrun_count++; 3489dd0842SJon Smirl 3589dd0842SJon Smirl /* Capture overrun error */ 36cebe7767SJon Smirl if (psc_dma->capture.active && (isr & MPC52xx_PSC_IMR_ORERR)) 37cebe7767SJon Smirl psc_dma->stats.overrun_count++; 3889dd0842SJon Smirl 39dbcc3475SJon Smirl out_8(®s->command, MPC52xx_PSC_RST_ERR_STAT); 4089dd0842SJon Smirl 4189dd0842SJon Smirl return IRQ_HANDLED; 4289dd0842SJon Smirl } 4389dd0842SJon Smirl 4489dd0842SJon Smirl /** 45cebe7767SJon Smirl * psc_dma_bcom_enqueue_next_buffer - Enqueue another audio buffer 4689dd0842SJon Smirl * @s: pointer to stream private data structure 4789dd0842SJon Smirl * 4889dd0842SJon Smirl * Enqueues another audio period buffer into the bestcomm queue. 4989dd0842SJon Smirl * 5089dd0842SJon Smirl * Note: The routine must only be called when there is space available in 5189dd0842SJon Smirl * the queue. Otherwise the enqueue will fail and the audio ring buffer 5289dd0842SJon Smirl * will get out of sync 5389dd0842SJon Smirl */ 54cebe7767SJon Smirl static void psc_dma_bcom_enqueue_next_buffer(struct psc_dma_stream *s) 5589dd0842SJon Smirl { 5689dd0842SJon Smirl struct bcom_bd *bd; 5789dd0842SJon Smirl 5889dd0842SJon Smirl /* Prepare and enqueue the next buffer descriptor */ 5989dd0842SJon Smirl bd = bcom_prepare_next_buffer(s->bcom_task); 6089dd0842SJon Smirl bd->status = s->period_bytes; 618f159d72SGrant Likely bd->data[0] = s->runtime->dma_addr + (s->period_next * s->period_bytes); 6289dd0842SJon Smirl bcom_submit_next_buffer(s->bcom_task, NULL); 6389dd0842SJon Smirl 6489dd0842SJon Smirl /* Update for next period */ 658f159d72SGrant Likely s->period_next = (s->period_next + 1) % s->runtime->periods; 6689dd0842SJon Smirl } 6789dd0842SJon Smirl 68dbcc3475SJon Smirl static void psc_dma_bcom_enqueue_tx(struct psc_dma_stream *s) 69dbcc3475SJon Smirl { 70b0a2712fSJohn Bonesio if (s->appl_ptr > s->runtime->control->appl_ptr) { 71b0a2712fSJohn Bonesio /* 72b0a2712fSJohn Bonesio * In this case s->runtime->control->appl_ptr has wrapped around. 73b0a2712fSJohn Bonesio * Play the data to the end of the boundary, then wrap our own 74b0a2712fSJohn Bonesio * appl_ptr back around. 75b0a2712fSJohn Bonesio */ 76b0a2712fSJohn Bonesio while (s->appl_ptr < s->runtime->boundary) { 77b0a2712fSJohn Bonesio if (bcom_queue_full(s->bcom_task)) 78b0a2712fSJohn Bonesio return; 79b0a2712fSJohn Bonesio 808f159d72SGrant Likely s->appl_ptr += s->runtime->period_size; 81b0a2712fSJohn Bonesio 82b0a2712fSJohn Bonesio psc_dma_bcom_enqueue_next_buffer(s); 83b0a2712fSJohn Bonesio } 84b0a2712fSJohn Bonesio s->appl_ptr -= s->runtime->boundary; 85b0a2712fSJohn Bonesio } 86b0a2712fSJohn Bonesio 87dbcc3475SJon Smirl while (s->appl_ptr < s->runtime->control->appl_ptr) { 88dbcc3475SJon Smirl 89dbcc3475SJon Smirl if (bcom_queue_full(s->bcom_task)) 90dbcc3475SJon Smirl return; 91dbcc3475SJon Smirl 928f159d72SGrant Likely s->appl_ptr += s->runtime->period_size; 93dbcc3475SJon Smirl 94dbcc3475SJon Smirl psc_dma_bcom_enqueue_next_buffer(s); 95dbcc3475SJon Smirl } 96dbcc3475SJon Smirl } 97dbcc3475SJon Smirl 9889dd0842SJon Smirl /* Bestcomm DMA irq handler */ 99dbcc3475SJon Smirl static irqreturn_t psc_dma_bcom_irq_tx(int irq, void *_psc_dma_stream) 10089dd0842SJon Smirl { 101cebe7767SJon Smirl struct psc_dma_stream *s = _psc_dma_stream; 10289dd0842SJon Smirl 103dbcc3475SJon Smirl spin_lock(&s->psc_dma->lock); 10489dd0842SJon Smirl /* For each finished period, dequeue the completed period buffer 10589dd0842SJon Smirl * and enqueue a new one in it's place. */ 10689dd0842SJon Smirl while (bcom_buffer_done(s->bcom_task)) { 10789dd0842SJon Smirl bcom_retrieve_buffer(s->bcom_task, NULL, NULL); 108dbcc3475SJon Smirl 1098f159d72SGrant Likely s->period_current = (s->period_current+1) % s->runtime->periods; 11089dd0842SJon Smirl } 111dbcc3475SJon Smirl psc_dma_bcom_enqueue_tx(s); 112dbcc3475SJon Smirl spin_unlock(&s->psc_dma->lock); 11389dd0842SJon Smirl 11489dd0842SJon Smirl /* If the stream is active, then also inform the PCM middle layer 11589dd0842SJon Smirl * of the period finished event. */ 11689dd0842SJon Smirl if (s->active) 11789dd0842SJon Smirl snd_pcm_period_elapsed(s->stream); 11889dd0842SJon Smirl 11989dd0842SJon Smirl return IRQ_HANDLED; 12089dd0842SJon Smirl } 12189dd0842SJon Smirl 122dbcc3475SJon Smirl static irqreturn_t psc_dma_bcom_irq_rx(int irq, void *_psc_dma_stream) 12389dd0842SJon Smirl { 124dbcc3475SJon Smirl struct psc_dma_stream *s = _psc_dma_stream; 12589dd0842SJon Smirl 126dbcc3475SJon Smirl spin_lock(&s->psc_dma->lock); 127dbcc3475SJon Smirl /* For each finished period, dequeue the completed period buffer 128dbcc3475SJon Smirl * and enqueue a new one in it's place. */ 129dbcc3475SJon Smirl while (bcom_buffer_done(s->bcom_task)) { 130dbcc3475SJon Smirl bcom_retrieve_buffer(s->bcom_task, NULL, NULL); 13189dd0842SJon Smirl 1328f159d72SGrant Likely s->period_current = (s->period_current+1) % s->runtime->periods; 133dbcc3475SJon Smirl 134dbcc3475SJon Smirl psc_dma_bcom_enqueue_next_buffer(s); 13589dd0842SJon Smirl } 136dbcc3475SJon Smirl spin_unlock(&s->psc_dma->lock); 137dbcc3475SJon Smirl 138dbcc3475SJon Smirl /* If the stream is active, then also inform the PCM middle layer 139dbcc3475SJon Smirl * of the period finished event. */ 140dbcc3475SJon Smirl if (s->active) 141dbcc3475SJon Smirl snd_pcm_period_elapsed(s->stream); 142dbcc3475SJon Smirl 143dbcc3475SJon Smirl return IRQ_HANDLED; 14489dd0842SJon Smirl } 14589dd0842SJon Smirl 146dbcc3475SJon Smirl static int psc_dma_hw_free(struct snd_pcm_substream *substream) 14789dd0842SJon Smirl { 14889dd0842SJon Smirl snd_pcm_set_runtime_buffer(substream, NULL); 14989dd0842SJon Smirl return 0; 15089dd0842SJon Smirl } 15189dd0842SJon Smirl 15289dd0842SJon Smirl /** 153cebe7767SJon Smirl * psc_dma_trigger: start and stop the DMA transfer. 15489dd0842SJon Smirl * 15589dd0842SJon Smirl * This function is called by ALSA to start, stop, pause, and resume the DMA 15689dd0842SJon Smirl * transfer of data. 15789dd0842SJon Smirl */ 158dbcc3475SJon Smirl static int psc_dma_trigger(struct snd_pcm_substream *substream, int cmd) 15989dd0842SJon Smirl { 16089dd0842SJon Smirl struct snd_soc_pcm_runtime *rtd = substream->private_data; 161cebe7767SJon Smirl struct psc_dma *psc_dma = rtd->dai->cpu_dai->private_data; 16289dd0842SJon Smirl struct snd_pcm_runtime *runtime = substream->runtime; 163cebe7767SJon Smirl struct psc_dma_stream *s; 164cebe7767SJon Smirl struct mpc52xx_psc __iomem *regs = psc_dma->psc_regs; 16589dd0842SJon Smirl u16 imr; 16689dd0842SJon Smirl unsigned long flags; 167dbcc3475SJon Smirl int i; 16889dd0842SJon Smirl 16989dd0842SJon Smirl if (substream->pstr->stream == SNDRV_PCM_STREAM_CAPTURE) 170cebe7767SJon Smirl s = &psc_dma->capture; 17189dd0842SJon Smirl else 172cebe7767SJon Smirl s = &psc_dma->playback; 17389dd0842SJon Smirl 174cebe7767SJon Smirl dev_dbg(psc_dma->dev, "psc_dma_trigger(substream=%p, cmd=%i)" 17589dd0842SJon Smirl " stream_id=%i\n", 17689dd0842SJon Smirl substream, cmd, substream->pstr->stream); 17789dd0842SJon Smirl 17889dd0842SJon Smirl switch (cmd) { 17989dd0842SJon Smirl case SNDRV_PCM_TRIGGER_START: 18089dd0842SJon Smirl s->period_bytes = frames_to_bytes(runtime, 18189dd0842SJon Smirl runtime->period_size); 1828f159d72SGrant Likely s->period_next = 0; 1838f159d72SGrant Likely s->period_current = 0; 18489dd0842SJon Smirl s->active = 1; 18589dd0842SJon Smirl 186dbcc3475SJon Smirl /* track appl_ptr so that we have a better chance of detecting 187dbcc3475SJon Smirl * end of stream and not over running it. 188dbcc3475SJon Smirl */ 189dbcc3475SJon Smirl s->runtime = runtime; 190dbcc3475SJon Smirl s->appl_ptr = s->runtime->control->appl_ptr - 191dbcc3475SJon Smirl (runtime->period_size * runtime->periods); 192dbcc3475SJon Smirl 193dbcc3475SJon Smirl /* Fill up the bestcomm bd queue and enable DMA. 194dbcc3475SJon Smirl * This will begin filling the PSC's fifo. 195dbcc3475SJon Smirl */ 196dbcc3475SJon Smirl spin_lock_irqsave(&psc_dma->lock, flags); 197dbcc3475SJon Smirl 19889dd0842SJon Smirl if (substream->pstr->stream == SNDRV_PCM_STREAM_CAPTURE) { 199dbcc3475SJon Smirl bcom_gen_bd_rx_reset(s->bcom_task); 200dbcc3475SJon Smirl for (i = 0; i < runtime->periods; i++) 201dbcc3475SJon Smirl if (!bcom_queue_full(s->bcom_task)) 202dbcc3475SJon Smirl psc_dma_bcom_enqueue_next_buffer(s); 20389dd0842SJon Smirl } else { 204dbcc3475SJon Smirl bcom_gen_bd_tx_reset(s->bcom_task); 205dbcc3475SJon Smirl psc_dma_bcom_enqueue_tx(s); 20689dd0842SJon Smirl } 20789dd0842SJon Smirl 20889dd0842SJon Smirl bcom_enable(s->bcom_task); 209cebe7767SJon Smirl spin_unlock_irqrestore(&psc_dma->lock, flags); 21089dd0842SJon Smirl 211dbcc3475SJon Smirl out_8(®s->command, MPC52xx_PSC_RST_ERR_STAT); 212dbcc3475SJon Smirl 21389dd0842SJon Smirl break; 21489dd0842SJon Smirl 21589dd0842SJon Smirl case SNDRV_PCM_TRIGGER_STOP: 21689dd0842SJon Smirl s->active = 0; 21789dd0842SJon Smirl 218dbcc3475SJon Smirl spin_lock_irqsave(&psc_dma->lock, flags); 21989dd0842SJon Smirl bcom_disable(s->bcom_task); 220dbcc3475SJon Smirl if (substream->pstr->stream == SNDRV_PCM_STREAM_CAPTURE) 221dbcc3475SJon Smirl bcom_gen_bd_rx_reset(s->bcom_task); 222dbcc3475SJon Smirl else 223dbcc3475SJon Smirl bcom_gen_bd_tx_reset(s->bcom_task); 224dbcc3475SJon Smirl spin_unlock_irqrestore(&psc_dma->lock, flags); 22589dd0842SJon Smirl 22689dd0842SJon Smirl break; 22789dd0842SJon Smirl 22889dd0842SJon Smirl default: 229cebe7767SJon Smirl dev_dbg(psc_dma->dev, "invalid command\n"); 23089dd0842SJon Smirl return -EINVAL; 23189dd0842SJon Smirl } 23289dd0842SJon Smirl 23389dd0842SJon Smirl /* Update interrupt enable settings */ 23489dd0842SJon Smirl imr = 0; 235cebe7767SJon Smirl if (psc_dma->playback.active) 23689dd0842SJon Smirl imr |= MPC52xx_PSC_IMR_TXEMP; 237cebe7767SJon Smirl if (psc_dma->capture.active) 23889dd0842SJon Smirl imr |= MPC52xx_PSC_IMR_ORERR; 239dbcc3475SJon Smirl out_be16(®s->isr_imr.imr, psc_dma->imr | imr); 24089dd0842SJon Smirl 24189dd0842SJon Smirl return 0; 24289dd0842SJon Smirl } 24389dd0842SJon Smirl 24489dd0842SJon Smirl 24589dd0842SJon Smirl /* --------------------------------------------------------------------- 24689dd0842SJon Smirl * The PSC DMA 'ASoC platform' driver 24789dd0842SJon Smirl * 24889dd0842SJon Smirl * Can be referenced by an 'ASoC machine' driver 24989dd0842SJon Smirl * This driver only deals with the audio bus; it doesn't have any 25089dd0842SJon Smirl * interaction with the attached codec 25189dd0842SJon Smirl */ 25289dd0842SJon Smirl 253dbcc3475SJon Smirl static const struct snd_pcm_hardware psc_dma_hardware = { 25489dd0842SJon Smirl .info = SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID | 25589dd0842SJon Smirl SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_BLOCK_TRANSFER | 25689dd0842SJon Smirl SNDRV_PCM_INFO_BATCH, 25789dd0842SJon Smirl .formats = SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_S16_BE | 25889dd0842SJon Smirl SNDRV_PCM_FMTBIT_S24_BE | SNDRV_PCM_FMTBIT_S32_BE, 25989dd0842SJon Smirl .rate_min = 8000, 26089dd0842SJon Smirl .rate_max = 48000, 261dbcc3475SJon Smirl .channels_min = 1, 26289dd0842SJon Smirl .channels_max = 2, 26389dd0842SJon Smirl .period_bytes_max = 1024 * 1024, 26489dd0842SJon Smirl .period_bytes_min = 32, 26589dd0842SJon Smirl .periods_min = 2, 26689dd0842SJon Smirl .periods_max = 256, 26789dd0842SJon Smirl .buffer_bytes_max = 2 * 1024 * 1024, 268dbcc3475SJon Smirl .fifo_size = 512, 26989dd0842SJon Smirl }; 27089dd0842SJon Smirl 271dbcc3475SJon Smirl static int psc_dma_open(struct snd_pcm_substream *substream) 27289dd0842SJon Smirl { 273dbcc3475SJon Smirl struct snd_pcm_runtime *runtime = substream->runtime; 27489dd0842SJon Smirl struct snd_soc_pcm_runtime *rtd = substream->private_data; 275cebe7767SJon Smirl struct psc_dma *psc_dma = rtd->dai->cpu_dai->private_data; 276cebe7767SJon Smirl struct psc_dma_stream *s; 277dbcc3475SJon Smirl int rc; 27889dd0842SJon Smirl 279dbcc3475SJon Smirl dev_dbg(psc_dma->dev, "psc_dma_open(substream=%p)\n", substream); 28089dd0842SJon Smirl 28189dd0842SJon Smirl if (substream->pstr->stream == SNDRV_PCM_STREAM_CAPTURE) 282cebe7767SJon Smirl s = &psc_dma->capture; 28389dd0842SJon Smirl else 284cebe7767SJon Smirl s = &psc_dma->playback; 28589dd0842SJon Smirl 286dbcc3475SJon Smirl snd_soc_set_runtime_hwparams(substream, &psc_dma_hardware); 287dbcc3475SJon Smirl 288dbcc3475SJon Smirl rc = snd_pcm_hw_constraint_integer(runtime, 289dbcc3475SJon Smirl SNDRV_PCM_HW_PARAM_PERIODS); 290dbcc3475SJon Smirl if (rc < 0) { 291dbcc3475SJon Smirl dev_err(substream->pcm->card->dev, "invalid buffer size\n"); 292dbcc3475SJon Smirl return rc; 293dbcc3475SJon Smirl } 29489dd0842SJon Smirl 29589dd0842SJon Smirl s->stream = substream; 29689dd0842SJon Smirl return 0; 29789dd0842SJon Smirl } 29889dd0842SJon Smirl 299dbcc3475SJon Smirl static int psc_dma_close(struct snd_pcm_substream *substream) 30089dd0842SJon Smirl { 30189dd0842SJon Smirl struct snd_soc_pcm_runtime *rtd = substream->private_data; 302cebe7767SJon Smirl struct psc_dma *psc_dma = rtd->dai->cpu_dai->private_data; 303cebe7767SJon Smirl struct psc_dma_stream *s; 30489dd0842SJon Smirl 305dbcc3475SJon Smirl dev_dbg(psc_dma->dev, "psc_dma_close(substream=%p)\n", substream); 30689dd0842SJon Smirl 30789dd0842SJon Smirl if (substream->pstr->stream == SNDRV_PCM_STREAM_CAPTURE) 308cebe7767SJon Smirl s = &psc_dma->capture; 30989dd0842SJon Smirl else 310cebe7767SJon Smirl s = &psc_dma->playback; 31189dd0842SJon Smirl 312dbcc3475SJon Smirl if (!psc_dma->playback.active && 313dbcc3475SJon Smirl !psc_dma->capture.active) { 314dbcc3475SJon Smirl 315dbcc3475SJon Smirl /* Disable all interrupts and reset the PSC */ 316dbcc3475SJon Smirl out_be16(&psc_dma->psc_regs->isr_imr.imr, psc_dma->imr); 317dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->command, 4 << 4); /* reset error */ 318dbcc3475SJon Smirl } 31989dd0842SJon Smirl s->stream = NULL; 32089dd0842SJon Smirl return 0; 32189dd0842SJon Smirl } 32289dd0842SJon Smirl 32389dd0842SJon Smirl static snd_pcm_uframes_t 324dbcc3475SJon Smirl psc_dma_pointer(struct snd_pcm_substream *substream) 32589dd0842SJon Smirl { 32689dd0842SJon Smirl struct snd_soc_pcm_runtime *rtd = substream->private_data; 327cebe7767SJon Smirl struct psc_dma *psc_dma = rtd->dai->cpu_dai->private_data; 328cebe7767SJon Smirl struct psc_dma_stream *s; 32989dd0842SJon Smirl dma_addr_t count; 33089dd0842SJon Smirl 33189dd0842SJon Smirl if (substream->pstr->stream == SNDRV_PCM_STREAM_CAPTURE) 332cebe7767SJon Smirl s = &psc_dma->capture; 33389dd0842SJon Smirl else 334cebe7767SJon Smirl s = &psc_dma->playback; 33589dd0842SJon Smirl 3368f159d72SGrant Likely count = s->period_current * s->period_bytes; 33789dd0842SJon Smirl 33889dd0842SJon Smirl return bytes_to_frames(substream->runtime, count); 33989dd0842SJon Smirl } 34089dd0842SJon Smirl 341dbcc3475SJon Smirl static int 342dbcc3475SJon Smirl psc_dma_hw_params(struct snd_pcm_substream *substream, 343dbcc3475SJon Smirl struct snd_pcm_hw_params *params) 344dbcc3475SJon Smirl { 345dbcc3475SJon Smirl snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer); 346dbcc3475SJon Smirl 347dbcc3475SJon Smirl return 0; 348dbcc3475SJon Smirl } 349dbcc3475SJon Smirl 350dbcc3475SJon Smirl static struct snd_pcm_ops psc_dma_ops = { 351dbcc3475SJon Smirl .open = psc_dma_open, 352dbcc3475SJon Smirl .close = psc_dma_close, 353dbcc3475SJon Smirl .hw_free = psc_dma_hw_free, 35489dd0842SJon Smirl .ioctl = snd_pcm_lib_ioctl, 355dbcc3475SJon Smirl .pointer = psc_dma_pointer, 356dbcc3475SJon Smirl .trigger = psc_dma_trigger, 357dbcc3475SJon Smirl .hw_params = psc_dma_hw_params, 35889dd0842SJon Smirl }; 35989dd0842SJon Smirl 360dbcc3475SJon Smirl static u64 psc_dma_dmamask = 0xffffffff; 361dbcc3475SJon Smirl static int psc_dma_new(struct snd_card *card, struct snd_soc_dai *dai, 36289dd0842SJon Smirl struct snd_pcm *pcm) 36389dd0842SJon Smirl { 36489dd0842SJon Smirl struct snd_soc_pcm_runtime *rtd = pcm->private_data; 365dbcc3475SJon Smirl struct psc_dma *psc_dma = rtd->dai->cpu_dai->private_data; 366dbcc3475SJon Smirl size_t size = psc_dma_hardware.buffer_bytes_max; 36789dd0842SJon Smirl int rc = 0; 36889dd0842SJon Smirl 369dbcc3475SJon Smirl dev_dbg(rtd->socdev->dev, "psc_dma_new(card=%p, dai=%p, pcm=%p)\n", 37089dd0842SJon Smirl card, dai, pcm); 37189dd0842SJon Smirl 37289dd0842SJon Smirl if (!card->dev->dma_mask) 373dbcc3475SJon Smirl card->dev->dma_mask = &psc_dma_dmamask; 37489dd0842SJon Smirl if (!card->dev->coherent_dma_mask) 37589dd0842SJon Smirl card->dev->coherent_dma_mask = 0xffffffff; 37689dd0842SJon Smirl 37789dd0842SJon Smirl if (pcm->streams[0].substream) { 378dbcc3475SJon Smirl rc = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, pcm->card->dev, 379dbcc3475SJon Smirl size, &pcm->streams[0].substream->dma_buffer); 38089dd0842SJon Smirl if (rc) 38189dd0842SJon Smirl goto playback_alloc_err; 38289dd0842SJon Smirl } 38389dd0842SJon Smirl 38489dd0842SJon Smirl if (pcm->streams[1].substream) { 385dbcc3475SJon Smirl rc = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, pcm->card->dev, 386dbcc3475SJon Smirl size, &pcm->streams[1].substream->dma_buffer); 38789dd0842SJon Smirl if (rc) 38889dd0842SJon Smirl goto capture_alloc_err; 38989dd0842SJon Smirl } 39089dd0842SJon Smirl 391dbcc3475SJon Smirl if (rtd->socdev->card->codec->ac97) 392dbcc3475SJon Smirl rtd->socdev->card->codec->ac97->private_data = psc_dma; 393dbcc3475SJon Smirl 39489dd0842SJon Smirl return 0; 39589dd0842SJon Smirl 39689dd0842SJon Smirl capture_alloc_err: 39789dd0842SJon Smirl if (pcm->streams[0].substream) 39889dd0842SJon Smirl snd_dma_free_pages(&pcm->streams[0].substream->dma_buffer); 399dbcc3475SJon Smirl 40089dd0842SJon Smirl playback_alloc_err: 40189dd0842SJon Smirl dev_err(card->dev, "Cannot allocate buffer(s)\n"); 402dbcc3475SJon Smirl 40389dd0842SJon Smirl return -ENOMEM; 40489dd0842SJon Smirl } 40589dd0842SJon Smirl 406dbcc3475SJon Smirl static void psc_dma_free(struct snd_pcm *pcm) 40789dd0842SJon Smirl { 40889dd0842SJon Smirl struct snd_soc_pcm_runtime *rtd = pcm->private_data; 40989dd0842SJon Smirl struct snd_pcm_substream *substream; 41089dd0842SJon Smirl int stream; 41189dd0842SJon Smirl 412dbcc3475SJon Smirl dev_dbg(rtd->socdev->dev, "psc_dma_free(pcm=%p)\n", pcm); 41389dd0842SJon Smirl 41489dd0842SJon Smirl for (stream = 0; stream < 2; stream++) { 41589dd0842SJon Smirl substream = pcm->streams[stream].substream; 41689dd0842SJon Smirl if (substream) { 41789dd0842SJon Smirl snd_dma_free_pages(&substream->dma_buffer); 41889dd0842SJon Smirl substream->dma_buffer.area = NULL; 41989dd0842SJon Smirl substream->dma_buffer.addr = 0; 42089dd0842SJon Smirl } 42189dd0842SJon Smirl } 42289dd0842SJon Smirl } 42389dd0842SJon Smirl 424dbcc3475SJon Smirl struct snd_soc_platform mpc5200_audio_dma_platform = { 42589dd0842SJon Smirl .name = "mpc5200-psc-audio", 426dbcc3475SJon Smirl .pcm_ops = &psc_dma_ops, 427dbcc3475SJon Smirl .pcm_new = &psc_dma_new, 428dbcc3475SJon Smirl .pcm_free = &psc_dma_free, 42989dd0842SJon Smirl }; 430dbcc3475SJon Smirl EXPORT_SYMBOL_GPL(mpc5200_audio_dma_platform); 43189dd0842SJon Smirl 432dbcc3475SJon Smirl int mpc5200_audio_dma_create(struct of_device *op) 433dbcc3475SJon Smirl { 434dbcc3475SJon Smirl phys_addr_t fifo; 435dbcc3475SJon Smirl struct psc_dma *psc_dma; 436dbcc3475SJon Smirl struct resource res; 437dbcc3475SJon Smirl int size, irq, rc; 438dbcc3475SJon Smirl const __be32 *prop; 439dbcc3475SJon Smirl void __iomem *regs; 44033d7f778SJulia Lawall int ret; 441dbcc3475SJon Smirl 442dbcc3475SJon Smirl /* Fetch the registers and IRQ of the PSC */ 443dbcc3475SJon Smirl irq = irq_of_parse_and_map(op->node, 0); 444dbcc3475SJon Smirl if (of_address_to_resource(op->node, 0, &res)) { 445dbcc3475SJon Smirl dev_err(&op->dev, "Missing reg property\n"); 446dbcc3475SJon Smirl return -ENODEV; 447dbcc3475SJon Smirl } 448dbcc3475SJon Smirl regs = ioremap(res.start, 1 + res.end - res.start); 449dbcc3475SJon Smirl if (!regs) { 450dbcc3475SJon Smirl dev_err(&op->dev, "Could not map registers\n"); 451dbcc3475SJon Smirl return -ENODEV; 452dbcc3475SJon Smirl } 453dbcc3475SJon Smirl 454dbcc3475SJon Smirl /* Allocate and initialize the driver private data */ 455dbcc3475SJon Smirl psc_dma = kzalloc(sizeof *psc_dma, GFP_KERNEL); 456dbcc3475SJon Smirl if (!psc_dma) { 45733d7f778SJulia Lawall ret = -ENOMEM; 45833d7f778SJulia Lawall goto out_unmap; 459dbcc3475SJon Smirl } 460dbcc3475SJon Smirl 461dbcc3475SJon Smirl /* Get the PSC ID */ 462dbcc3475SJon Smirl prop = of_get_property(op->node, "cell-index", &size); 46333d7f778SJulia Lawall if (!prop || size < sizeof *prop) { 46433d7f778SJulia Lawall ret = -ENODEV; 46533d7f778SJulia Lawall goto out_free; 46633d7f778SJulia Lawall } 467dbcc3475SJon Smirl 468dbcc3475SJon Smirl spin_lock_init(&psc_dma->lock); 4690827d6baSGrant Likely mutex_init(&psc_dma->mutex); 470dbcc3475SJon Smirl psc_dma->id = be32_to_cpu(*prop); 471dbcc3475SJon Smirl psc_dma->irq = irq; 472dbcc3475SJon Smirl psc_dma->psc_regs = regs; 473dbcc3475SJon Smirl psc_dma->fifo_regs = regs + sizeof *psc_dma->psc_regs; 474dbcc3475SJon Smirl psc_dma->dev = &op->dev; 475dbcc3475SJon Smirl psc_dma->playback.psc_dma = psc_dma; 476dbcc3475SJon Smirl psc_dma->capture.psc_dma = psc_dma; 477dbcc3475SJon Smirl snprintf(psc_dma->name, sizeof psc_dma->name, "PSC%u", psc_dma->id); 478dbcc3475SJon Smirl 479dbcc3475SJon Smirl /* Find the address of the fifo data registers and setup the 480dbcc3475SJon Smirl * DMA tasks */ 481dbcc3475SJon Smirl fifo = res.start + offsetof(struct mpc52xx_psc, buffer.buffer_32); 482dbcc3475SJon Smirl psc_dma->capture.bcom_task = 483dbcc3475SJon Smirl bcom_psc_gen_bd_rx_init(psc_dma->id, 10, fifo, 512); 484dbcc3475SJon Smirl psc_dma->playback.bcom_task = 485dbcc3475SJon Smirl bcom_psc_gen_bd_tx_init(psc_dma->id, 10, fifo); 486dbcc3475SJon Smirl if (!psc_dma->capture.bcom_task || 487dbcc3475SJon Smirl !psc_dma->playback.bcom_task) { 488dbcc3475SJon Smirl dev_err(&op->dev, "Could not allocate bestcomm tasks\n"); 48933d7f778SJulia Lawall ret = -ENODEV; 49033d7f778SJulia Lawall goto out_free; 491dbcc3475SJon Smirl } 492dbcc3475SJon Smirl 493dbcc3475SJon Smirl /* Disable all interrupts and reset the PSC */ 494dbcc3475SJon Smirl out_be16(&psc_dma->psc_regs->isr_imr.imr, psc_dma->imr); 495dbcc3475SJon Smirl /* reset receiver */ 496dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->command, MPC52xx_PSC_RST_RX); 497dbcc3475SJon Smirl /* reset transmitter */ 498dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->command, MPC52xx_PSC_RST_TX); 499dbcc3475SJon Smirl /* reset error */ 500dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->command, MPC52xx_PSC_RST_ERR_STAT); 501dbcc3475SJon Smirl /* reset mode */ 502dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->command, MPC52xx_PSC_SEL_MODE_REG_1); 503dbcc3475SJon Smirl 504dbcc3475SJon Smirl /* Set up mode register; 505dbcc3475SJon Smirl * First write: RxRdy (FIFO Alarm) generates rx FIFO irq 506dbcc3475SJon Smirl * Second write: register Normal mode for non loopback 507dbcc3475SJon Smirl */ 508dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->mode, 0); 509dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->mode, 0); 510dbcc3475SJon Smirl 511dbcc3475SJon Smirl /* Set the TX and RX fifo alarm thresholds */ 512dbcc3475SJon Smirl out_be16(&psc_dma->fifo_regs->rfalarm, 0x100); 513dbcc3475SJon Smirl out_8(&psc_dma->fifo_regs->rfcntl, 0x4); 514dbcc3475SJon Smirl out_be16(&psc_dma->fifo_regs->tfalarm, 0x100); 515dbcc3475SJon Smirl out_8(&psc_dma->fifo_regs->tfcntl, 0x7); 516dbcc3475SJon Smirl 517dbcc3475SJon Smirl /* Lookup the IRQ numbers */ 518dbcc3475SJon Smirl psc_dma->playback.irq = 519dbcc3475SJon Smirl bcom_get_task_irq(psc_dma->playback.bcom_task); 520dbcc3475SJon Smirl psc_dma->capture.irq = 521dbcc3475SJon Smirl bcom_get_task_irq(psc_dma->capture.bcom_task); 522dbcc3475SJon Smirl 523dbcc3475SJon Smirl rc = request_irq(psc_dma->irq, &psc_dma_status_irq, IRQF_SHARED, 524dbcc3475SJon Smirl "psc-dma-status", psc_dma); 525dbcc3475SJon Smirl rc |= request_irq(psc_dma->capture.irq, 526dbcc3475SJon Smirl &psc_dma_bcom_irq_rx, IRQF_SHARED, 527dbcc3475SJon Smirl "psc-dma-capture", &psc_dma->capture); 528dbcc3475SJon Smirl rc |= request_irq(psc_dma->playback.irq, 529dbcc3475SJon Smirl &psc_dma_bcom_irq_tx, IRQF_SHARED, 530dbcc3475SJon Smirl "psc-dma-playback", &psc_dma->playback); 531dbcc3475SJon Smirl if (rc) { 53233d7f778SJulia Lawall ret = -ENODEV; 53333d7f778SJulia Lawall goto out_irq; 534dbcc3475SJon Smirl } 535dbcc3475SJon Smirl 536dbcc3475SJon Smirl /* Save what we've done so it can be found again later */ 537dbcc3475SJon Smirl dev_set_drvdata(&op->dev, psc_dma); 538dbcc3475SJon Smirl 539dbcc3475SJon Smirl /* Tell the ASoC OF helpers about it */ 540dbcc3475SJon Smirl return snd_soc_register_platform(&mpc5200_audio_dma_platform); 54133d7f778SJulia Lawall out_irq: 54233d7f778SJulia Lawall free_irq(psc_dma->irq, psc_dma); 54333d7f778SJulia Lawall free_irq(psc_dma->capture.irq, &psc_dma->capture); 54433d7f778SJulia Lawall free_irq(psc_dma->playback.irq, &psc_dma->playback); 54533d7f778SJulia Lawall out_free: 54633d7f778SJulia Lawall kfree(psc_dma); 54733d7f778SJulia Lawall out_unmap: 54833d7f778SJulia Lawall iounmap(regs); 54933d7f778SJulia Lawall return ret; 550dbcc3475SJon Smirl } 551dbcc3475SJon Smirl EXPORT_SYMBOL_GPL(mpc5200_audio_dma_create); 552dbcc3475SJon Smirl 553dbcc3475SJon Smirl int mpc5200_audio_dma_destroy(struct of_device *op) 554dbcc3475SJon Smirl { 555dbcc3475SJon Smirl struct psc_dma *psc_dma = dev_get_drvdata(&op->dev); 556dbcc3475SJon Smirl 557dbcc3475SJon Smirl dev_dbg(&op->dev, "mpc5200_audio_dma_destroy()\n"); 558dbcc3475SJon Smirl 559dbcc3475SJon Smirl snd_soc_unregister_platform(&mpc5200_audio_dma_platform); 560dbcc3475SJon Smirl 561dbcc3475SJon Smirl bcom_gen_bd_rx_release(psc_dma->capture.bcom_task); 562dbcc3475SJon Smirl bcom_gen_bd_tx_release(psc_dma->playback.bcom_task); 563dbcc3475SJon Smirl 564dbcc3475SJon Smirl /* Release irqs */ 565dbcc3475SJon Smirl free_irq(psc_dma->irq, psc_dma); 566dbcc3475SJon Smirl free_irq(psc_dma->capture.irq, &psc_dma->capture); 567dbcc3475SJon Smirl free_irq(psc_dma->playback.irq, &psc_dma->playback); 568dbcc3475SJon Smirl 569dbcc3475SJon Smirl iounmap(psc_dma->psc_regs); 570dbcc3475SJon Smirl kfree(psc_dma); 571dbcc3475SJon Smirl dev_set_drvdata(&op->dev, NULL); 572dbcc3475SJon Smirl 573dbcc3475SJon Smirl return 0; 574dbcc3475SJon Smirl } 575dbcc3475SJon Smirl EXPORT_SYMBOL_GPL(mpc5200_audio_dma_destroy); 576dbcc3475SJon Smirl 577dbcc3475SJon Smirl MODULE_AUTHOR("Grant Likely <grant.likely@secretlab.ca>"); 578dbcc3475SJon Smirl MODULE_DESCRIPTION("Freescale MPC5200 PSC in DMA mode ASoC Driver"); 579dbcc3475SJon Smirl MODULE_LICENSE("GPL"); 580