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; 6189dd0842SJon Smirl bd->data[0] = s->period_next_pt; 6289dd0842SJon Smirl bcom_submit_next_buffer(s->bcom_task, NULL); 6389dd0842SJon Smirl 6489dd0842SJon Smirl /* Update for next period */ 6589dd0842SJon Smirl s->period_next_pt += s->period_bytes; 6689dd0842SJon Smirl if (s->period_next_pt >= s->period_end) 6789dd0842SJon Smirl s->period_next_pt = s->period_start; 6889dd0842SJon Smirl } 6989dd0842SJon Smirl 70dbcc3475SJon Smirl static void psc_dma_bcom_enqueue_tx(struct psc_dma_stream *s) 71dbcc3475SJon Smirl { 72dbcc3475SJon Smirl while (s->appl_ptr < s->runtime->control->appl_ptr) { 73dbcc3475SJon Smirl 74dbcc3475SJon Smirl if (bcom_queue_full(s->bcom_task)) 75dbcc3475SJon Smirl return; 76dbcc3475SJon Smirl 77dbcc3475SJon Smirl s->appl_ptr += s->period_size; 78dbcc3475SJon Smirl 79dbcc3475SJon Smirl psc_dma_bcom_enqueue_next_buffer(s); 80dbcc3475SJon Smirl } 81dbcc3475SJon Smirl } 82dbcc3475SJon Smirl 8389dd0842SJon Smirl /* Bestcomm DMA irq handler */ 84dbcc3475SJon Smirl static irqreturn_t psc_dma_bcom_irq_tx(int irq, void *_psc_dma_stream) 8589dd0842SJon Smirl { 86cebe7767SJon Smirl struct psc_dma_stream *s = _psc_dma_stream; 8789dd0842SJon Smirl 88dbcc3475SJon Smirl spin_lock(&s->psc_dma->lock); 8989dd0842SJon Smirl /* For each finished period, dequeue the completed period buffer 9089dd0842SJon Smirl * and enqueue a new one in it's place. */ 9189dd0842SJon Smirl while (bcom_buffer_done(s->bcom_task)) { 9289dd0842SJon Smirl bcom_retrieve_buffer(s->bcom_task, NULL, NULL); 93dbcc3475SJon Smirl 9489dd0842SJon Smirl s->period_current_pt += s->period_bytes; 9589dd0842SJon Smirl if (s->period_current_pt >= s->period_end) 9689dd0842SJon Smirl s->period_current_pt = s->period_start; 9789dd0842SJon Smirl } 98dbcc3475SJon Smirl psc_dma_bcom_enqueue_tx(s); 99dbcc3475SJon Smirl spin_unlock(&s->psc_dma->lock); 10089dd0842SJon Smirl 10189dd0842SJon Smirl /* If the stream is active, then also inform the PCM middle layer 10289dd0842SJon Smirl * of the period finished event. */ 10389dd0842SJon Smirl if (s->active) 10489dd0842SJon Smirl snd_pcm_period_elapsed(s->stream); 10589dd0842SJon Smirl 10689dd0842SJon Smirl return IRQ_HANDLED; 10789dd0842SJon Smirl } 10889dd0842SJon Smirl 109dbcc3475SJon Smirl static irqreturn_t psc_dma_bcom_irq_rx(int irq, void *_psc_dma_stream) 11089dd0842SJon Smirl { 111dbcc3475SJon Smirl struct psc_dma_stream *s = _psc_dma_stream; 11289dd0842SJon Smirl 113dbcc3475SJon Smirl spin_lock(&s->psc_dma->lock); 114dbcc3475SJon Smirl /* For each finished period, dequeue the completed period buffer 115dbcc3475SJon Smirl * and enqueue a new one in it's place. */ 116dbcc3475SJon Smirl while (bcom_buffer_done(s->bcom_task)) { 117dbcc3475SJon Smirl bcom_retrieve_buffer(s->bcom_task, NULL, NULL); 11889dd0842SJon Smirl 119dbcc3475SJon Smirl s->period_current_pt += s->period_bytes; 120dbcc3475SJon Smirl if (s->period_current_pt >= s->period_end) 121dbcc3475SJon Smirl s->period_current_pt = s->period_start; 122dbcc3475SJon Smirl 123dbcc3475SJon Smirl psc_dma_bcom_enqueue_next_buffer(s); 12489dd0842SJon Smirl } 125dbcc3475SJon Smirl spin_unlock(&s->psc_dma->lock); 126dbcc3475SJon Smirl 127dbcc3475SJon Smirl /* If the stream is active, then also inform the PCM middle layer 128dbcc3475SJon Smirl * of the period finished event. */ 129dbcc3475SJon Smirl if (s->active) 130dbcc3475SJon Smirl snd_pcm_period_elapsed(s->stream); 131dbcc3475SJon Smirl 132dbcc3475SJon Smirl return IRQ_HANDLED; 13389dd0842SJon Smirl } 13489dd0842SJon Smirl 135dbcc3475SJon Smirl static int psc_dma_hw_free(struct snd_pcm_substream *substream) 13689dd0842SJon Smirl { 13789dd0842SJon Smirl snd_pcm_set_runtime_buffer(substream, NULL); 13889dd0842SJon Smirl return 0; 13989dd0842SJon Smirl } 14089dd0842SJon Smirl 14189dd0842SJon Smirl /** 142cebe7767SJon Smirl * psc_dma_trigger: start and stop the DMA transfer. 14389dd0842SJon Smirl * 14489dd0842SJon Smirl * This function is called by ALSA to start, stop, pause, and resume the DMA 14589dd0842SJon Smirl * transfer of data. 14689dd0842SJon Smirl */ 147dbcc3475SJon Smirl static int psc_dma_trigger(struct snd_pcm_substream *substream, int cmd) 14889dd0842SJon Smirl { 14989dd0842SJon Smirl struct snd_soc_pcm_runtime *rtd = substream->private_data; 150cebe7767SJon Smirl struct psc_dma *psc_dma = rtd->dai->cpu_dai->private_data; 15189dd0842SJon Smirl struct snd_pcm_runtime *runtime = substream->runtime; 152cebe7767SJon Smirl struct psc_dma_stream *s; 153cebe7767SJon Smirl struct mpc52xx_psc __iomem *regs = psc_dma->psc_regs; 15489dd0842SJon Smirl u16 imr; 15589dd0842SJon Smirl unsigned long flags; 156dbcc3475SJon Smirl int i; 15789dd0842SJon Smirl 15889dd0842SJon Smirl if (substream->pstr->stream == SNDRV_PCM_STREAM_CAPTURE) 159cebe7767SJon Smirl s = &psc_dma->capture; 16089dd0842SJon Smirl else 161cebe7767SJon Smirl s = &psc_dma->playback; 16289dd0842SJon Smirl 163cebe7767SJon Smirl dev_dbg(psc_dma->dev, "psc_dma_trigger(substream=%p, cmd=%i)" 16489dd0842SJon Smirl " stream_id=%i\n", 16589dd0842SJon Smirl substream, cmd, substream->pstr->stream); 16689dd0842SJon Smirl 16789dd0842SJon Smirl switch (cmd) { 16889dd0842SJon Smirl case SNDRV_PCM_TRIGGER_START: 16989dd0842SJon Smirl s->period_bytes = frames_to_bytes(runtime, 17089dd0842SJon Smirl runtime->period_size); 17189dd0842SJon Smirl s->period_start = virt_to_phys(runtime->dma_area); 17289dd0842SJon Smirl s->period_end = s->period_start + 17389dd0842SJon Smirl (s->period_bytes * runtime->periods); 17489dd0842SJon Smirl s->period_next_pt = s->period_start; 17589dd0842SJon Smirl s->period_current_pt = s->period_start; 176dbcc3475SJon Smirl s->period_size = runtime->period_size; 17789dd0842SJon Smirl s->active = 1; 17889dd0842SJon Smirl 179dbcc3475SJon Smirl /* track appl_ptr so that we have a better chance of detecting 180dbcc3475SJon Smirl * end of stream and not over running it. 181dbcc3475SJon Smirl */ 182dbcc3475SJon Smirl s->runtime = runtime; 183dbcc3475SJon Smirl s->appl_ptr = s->runtime->control->appl_ptr - 184dbcc3475SJon Smirl (runtime->period_size * runtime->periods); 185dbcc3475SJon Smirl 186dbcc3475SJon Smirl /* Fill up the bestcomm bd queue and enable DMA. 187dbcc3475SJon Smirl * This will begin filling the PSC's fifo. 188dbcc3475SJon Smirl */ 189dbcc3475SJon Smirl spin_lock_irqsave(&psc_dma->lock, flags); 190dbcc3475SJon Smirl 19189dd0842SJon Smirl if (substream->pstr->stream == SNDRV_PCM_STREAM_CAPTURE) { 192dbcc3475SJon Smirl bcom_gen_bd_rx_reset(s->bcom_task); 193dbcc3475SJon Smirl for (i = 0; i < runtime->periods; i++) 194dbcc3475SJon Smirl if (!bcom_queue_full(s->bcom_task)) 195dbcc3475SJon Smirl psc_dma_bcom_enqueue_next_buffer(s); 19689dd0842SJon Smirl } else { 197dbcc3475SJon Smirl bcom_gen_bd_tx_reset(s->bcom_task); 198dbcc3475SJon Smirl psc_dma_bcom_enqueue_tx(s); 19989dd0842SJon Smirl } 20089dd0842SJon Smirl 20189dd0842SJon Smirl bcom_enable(s->bcom_task); 202cebe7767SJon Smirl spin_unlock_irqrestore(&psc_dma->lock, flags); 20389dd0842SJon Smirl 204dbcc3475SJon Smirl out_8(®s->command, MPC52xx_PSC_RST_ERR_STAT); 205dbcc3475SJon Smirl 20689dd0842SJon Smirl break; 20789dd0842SJon Smirl 20889dd0842SJon Smirl case SNDRV_PCM_TRIGGER_STOP: 20989dd0842SJon Smirl s->active = 0; 21089dd0842SJon Smirl 211dbcc3475SJon Smirl spin_lock_irqsave(&psc_dma->lock, flags); 21289dd0842SJon Smirl bcom_disable(s->bcom_task); 213dbcc3475SJon Smirl if (substream->pstr->stream == SNDRV_PCM_STREAM_CAPTURE) 214dbcc3475SJon Smirl bcom_gen_bd_rx_reset(s->bcom_task); 215dbcc3475SJon Smirl else 216dbcc3475SJon Smirl bcom_gen_bd_tx_reset(s->bcom_task); 217dbcc3475SJon Smirl spin_unlock_irqrestore(&psc_dma->lock, flags); 21889dd0842SJon Smirl 21989dd0842SJon Smirl break; 22089dd0842SJon Smirl 22189dd0842SJon Smirl default: 222cebe7767SJon Smirl dev_dbg(psc_dma->dev, "invalid command\n"); 22389dd0842SJon Smirl return -EINVAL; 22489dd0842SJon Smirl } 22589dd0842SJon Smirl 22689dd0842SJon Smirl /* Update interrupt enable settings */ 22789dd0842SJon Smirl imr = 0; 228cebe7767SJon Smirl if (psc_dma->playback.active) 22989dd0842SJon Smirl imr |= MPC52xx_PSC_IMR_TXEMP; 230cebe7767SJon Smirl if (psc_dma->capture.active) 23189dd0842SJon Smirl imr |= MPC52xx_PSC_IMR_ORERR; 232dbcc3475SJon Smirl out_be16(®s->isr_imr.imr, psc_dma->imr | imr); 23389dd0842SJon Smirl 23489dd0842SJon Smirl return 0; 23589dd0842SJon Smirl } 23689dd0842SJon Smirl 23789dd0842SJon Smirl 23889dd0842SJon Smirl /* --------------------------------------------------------------------- 23989dd0842SJon Smirl * The PSC DMA 'ASoC platform' driver 24089dd0842SJon Smirl * 24189dd0842SJon Smirl * Can be referenced by an 'ASoC machine' driver 24289dd0842SJon Smirl * This driver only deals with the audio bus; it doesn't have any 24389dd0842SJon Smirl * interaction with the attached codec 24489dd0842SJon Smirl */ 24589dd0842SJon Smirl 246dbcc3475SJon Smirl static const struct snd_pcm_hardware psc_dma_hardware = { 24789dd0842SJon Smirl .info = SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID | 24889dd0842SJon Smirl SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_BLOCK_TRANSFER | 24989dd0842SJon Smirl SNDRV_PCM_INFO_BATCH, 25089dd0842SJon Smirl .formats = SNDRV_PCM_FMTBIT_S8 | SNDRV_PCM_FMTBIT_S16_BE | 25189dd0842SJon Smirl SNDRV_PCM_FMTBIT_S24_BE | SNDRV_PCM_FMTBIT_S32_BE, 25289dd0842SJon Smirl .rate_min = 8000, 25389dd0842SJon Smirl .rate_max = 48000, 254dbcc3475SJon Smirl .channels_min = 1, 25589dd0842SJon Smirl .channels_max = 2, 25689dd0842SJon Smirl .period_bytes_max = 1024 * 1024, 25789dd0842SJon Smirl .period_bytes_min = 32, 25889dd0842SJon Smirl .periods_min = 2, 25989dd0842SJon Smirl .periods_max = 256, 26089dd0842SJon Smirl .buffer_bytes_max = 2 * 1024 * 1024, 261dbcc3475SJon Smirl .fifo_size = 512, 26289dd0842SJon Smirl }; 26389dd0842SJon Smirl 264dbcc3475SJon Smirl static int psc_dma_open(struct snd_pcm_substream *substream) 26589dd0842SJon Smirl { 266dbcc3475SJon Smirl struct snd_pcm_runtime *runtime = substream->runtime; 26789dd0842SJon Smirl struct snd_soc_pcm_runtime *rtd = substream->private_data; 268cebe7767SJon Smirl struct psc_dma *psc_dma = rtd->dai->cpu_dai->private_data; 269cebe7767SJon Smirl struct psc_dma_stream *s; 270dbcc3475SJon Smirl int rc; 27189dd0842SJon Smirl 272dbcc3475SJon Smirl dev_dbg(psc_dma->dev, "psc_dma_open(substream=%p)\n", substream); 27389dd0842SJon Smirl 27489dd0842SJon Smirl if (substream->pstr->stream == SNDRV_PCM_STREAM_CAPTURE) 275cebe7767SJon Smirl s = &psc_dma->capture; 27689dd0842SJon Smirl else 277cebe7767SJon Smirl s = &psc_dma->playback; 27889dd0842SJon Smirl 279dbcc3475SJon Smirl snd_soc_set_runtime_hwparams(substream, &psc_dma_hardware); 280dbcc3475SJon Smirl 281dbcc3475SJon Smirl rc = snd_pcm_hw_constraint_integer(runtime, 282dbcc3475SJon Smirl SNDRV_PCM_HW_PARAM_PERIODS); 283dbcc3475SJon Smirl if (rc < 0) { 284dbcc3475SJon Smirl dev_err(substream->pcm->card->dev, "invalid buffer size\n"); 285dbcc3475SJon Smirl return rc; 286dbcc3475SJon Smirl } 28789dd0842SJon Smirl 28889dd0842SJon Smirl s->stream = substream; 28989dd0842SJon Smirl return 0; 29089dd0842SJon Smirl } 29189dd0842SJon Smirl 292dbcc3475SJon Smirl static int psc_dma_close(struct snd_pcm_substream *substream) 29389dd0842SJon Smirl { 29489dd0842SJon Smirl struct snd_soc_pcm_runtime *rtd = substream->private_data; 295cebe7767SJon Smirl struct psc_dma *psc_dma = rtd->dai->cpu_dai->private_data; 296cebe7767SJon Smirl struct psc_dma_stream *s; 29789dd0842SJon Smirl 298dbcc3475SJon Smirl dev_dbg(psc_dma->dev, "psc_dma_close(substream=%p)\n", substream); 29989dd0842SJon Smirl 30089dd0842SJon Smirl if (substream->pstr->stream == SNDRV_PCM_STREAM_CAPTURE) 301cebe7767SJon Smirl s = &psc_dma->capture; 30289dd0842SJon Smirl else 303cebe7767SJon Smirl s = &psc_dma->playback; 30489dd0842SJon Smirl 305dbcc3475SJon Smirl if (!psc_dma->playback.active && 306dbcc3475SJon Smirl !psc_dma->capture.active) { 307dbcc3475SJon Smirl 308dbcc3475SJon Smirl /* Disable all interrupts and reset the PSC */ 309dbcc3475SJon Smirl out_be16(&psc_dma->psc_regs->isr_imr.imr, psc_dma->imr); 310dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->command, 4 << 4); /* reset error */ 311dbcc3475SJon Smirl } 31289dd0842SJon Smirl s->stream = NULL; 31389dd0842SJon Smirl return 0; 31489dd0842SJon Smirl } 31589dd0842SJon Smirl 31689dd0842SJon Smirl static snd_pcm_uframes_t 317dbcc3475SJon Smirl psc_dma_pointer(struct snd_pcm_substream *substream) 31889dd0842SJon Smirl { 31989dd0842SJon Smirl struct snd_soc_pcm_runtime *rtd = substream->private_data; 320cebe7767SJon Smirl struct psc_dma *psc_dma = rtd->dai->cpu_dai->private_data; 321cebe7767SJon Smirl struct psc_dma_stream *s; 32289dd0842SJon Smirl dma_addr_t count; 32389dd0842SJon Smirl 32489dd0842SJon Smirl if (substream->pstr->stream == SNDRV_PCM_STREAM_CAPTURE) 325cebe7767SJon Smirl s = &psc_dma->capture; 32689dd0842SJon Smirl else 327cebe7767SJon Smirl s = &psc_dma->playback; 32889dd0842SJon Smirl 32989dd0842SJon Smirl count = s->period_current_pt - s->period_start; 33089dd0842SJon Smirl 33189dd0842SJon Smirl return bytes_to_frames(substream->runtime, count); 33289dd0842SJon Smirl } 33389dd0842SJon Smirl 334dbcc3475SJon Smirl static int 335dbcc3475SJon Smirl psc_dma_hw_params(struct snd_pcm_substream *substream, 336dbcc3475SJon Smirl struct snd_pcm_hw_params *params) 337dbcc3475SJon Smirl { 338dbcc3475SJon Smirl snd_pcm_set_runtime_buffer(substream, &substream->dma_buffer); 339dbcc3475SJon Smirl 340dbcc3475SJon Smirl return 0; 341dbcc3475SJon Smirl } 342dbcc3475SJon Smirl 343dbcc3475SJon Smirl static struct snd_pcm_ops psc_dma_ops = { 344dbcc3475SJon Smirl .open = psc_dma_open, 345dbcc3475SJon Smirl .close = psc_dma_close, 346dbcc3475SJon Smirl .hw_free = psc_dma_hw_free, 34789dd0842SJon Smirl .ioctl = snd_pcm_lib_ioctl, 348dbcc3475SJon Smirl .pointer = psc_dma_pointer, 349dbcc3475SJon Smirl .trigger = psc_dma_trigger, 350dbcc3475SJon Smirl .hw_params = psc_dma_hw_params, 35189dd0842SJon Smirl }; 35289dd0842SJon Smirl 353dbcc3475SJon Smirl static u64 psc_dma_dmamask = 0xffffffff; 354dbcc3475SJon Smirl static int psc_dma_new(struct snd_card *card, struct snd_soc_dai *dai, 35589dd0842SJon Smirl struct snd_pcm *pcm) 35689dd0842SJon Smirl { 35789dd0842SJon Smirl struct snd_soc_pcm_runtime *rtd = pcm->private_data; 358dbcc3475SJon Smirl struct psc_dma *psc_dma = rtd->dai->cpu_dai->private_data; 359dbcc3475SJon Smirl size_t size = psc_dma_hardware.buffer_bytes_max; 36089dd0842SJon Smirl int rc = 0; 36189dd0842SJon Smirl 362dbcc3475SJon Smirl dev_dbg(rtd->socdev->dev, "psc_dma_new(card=%p, dai=%p, pcm=%p)\n", 36389dd0842SJon Smirl card, dai, pcm); 36489dd0842SJon Smirl 36589dd0842SJon Smirl if (!card->dev->dma_mask) 366dbcc3475SJon Smirl card->dev->dma_mask = &psc_dma_dmamask; 36789dd0842SJon Smirl if (!card->dev->coherent_dma_mask) 36889dd0842SJon Smirl card->dev->coherent_dma_mask = 0xffffffff; 36989dd0842SJon Smirl 37089dd0842SJon Smirl if (pcm->streams[0].substream) { 371dbcc3475SJon Smirl rc = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, pcm->card->dev, 372dbcc3475SJon Smirl size, &pcm->streams[0].substream->dma_buffer); 37389dd0842SJon Smirl if (rc) 37489dd0842SJon Smirl goto playback_alloc_err; 37589dd0842SJon Smirl } 37689dd0842SJon Smirl 37789dd0842SJon Smirl if (pcm->streams[1].substream) { 378dbcc3475SJon Smirl rc = snd_dma_alloc_pages(SNDRV_DMA_TYPE_DEV, pcm->card->dev, 379dbcc3475SJon Smirl size, &pcm->streams[1].substream->dma_buffer); 38089dd0842SJon Smirl if (rc) 38189dd0842SJon Smirl goto capture_alloc_err; 38289dd0842SJon Smirl } 38389dd0842SJon Smirl 384dbcc3475SJon Smirl if (rtd->socdev->card->codec->ac97) 385dbcc3475SJon Smirl rtd->socdev->card->codec->ac97->private_data = psc_dma; 386dbcc3475SJon Smirl 38789dd0842SJon Smirl return 0; 38889dd0842SJon Smirl 38989dd0842SJon Smirl capture_alloc_err: 39089dd0842SJon Smirl if (pcm->streams[0].substream) 39189dd0842SJon Smirl snd_dma_free_pages(&pcm->streams[0].substream->dma_buffer); 392dbcc3475SJon Smirl 39389dd0842SJon Smirl playback_alloc_err: 39489dd0842SJon Smirl dev_err(card->dev, "Cannot allocate buffer(s)\n"); 395dbcc3475SJon Smirl 39689dd0842SJon Smirl return -ENOMEM; 39789dd0842SJon Smirl } 39889dd0842SJon Smirl 399dbcc3475SJon Smirl static void psc_dma_free(struct snd_pcm *pcm) 40089dd0842SJon Smirl { 40189dd0842SJon Smirl struct snd_soc_pcm_runtime *rtd = pcm->private_data; 40289dd0842SJon Smirl struct snd_pcm_substream *substream; 40389dd0842SJon Smirl int stream; 40489dd0842SJon Smirl 405dbcc3475SJon Smirl dev_dbg(rtd->socdev->dev, "psc_dma_free(pcm=%p)\n", pcm); 40689dd0842SJon Smirl 40789dd0842SJon Smirl for (stream = 0; stream < 2; stream++) { 40889dd0842SJon Smirl substream = pcm->streams[stream].substream; 40989dd0842SJon Smirl if (substream) { 41089dd0842SJon Smirl snd_dma_free_pages(&substream->dma_buffer); 41189dd0842SJon Smirl substream->dma_buffer.area = NULL; 41289dd0842SJon Smirl substream->dma_buffer.addr = 0; 41389dd0842SJon Smirl } 41489dd0842SJon Smirl } 41589dd0842SJon Smirl } 41689dd0842SJon Smirl 417dbcc3475SJon Smirl struct snd_soc_platform mpc5200_audio_dma_platform = { 41889dd0842SJon Smirl .name = "mpc5200-psc-audio", 419dbcc3475SJon Smirl .pcm_ops = &psc_dma_ops, 420dbcc3475SJon Smirl .pcm_new = &psc_dma_new, 421dbcc3475SJon Smirl .pcm_free = &psc_dma_free, 42289dd0842SJon Smirl }; 423dbcc3475SJon Smirl EXPORT_SYMBOL_GPL(mpc5200_audio_dma_platform); 42489dd0842SJon Smirl 425dbcc3475SJon Smirl int mpc5200_audio_dma_create(struct of_device *op) 426dbcc3475SJon Smirl { 427dbcc3475SJon Smirl phys_addr_t fifo; 428dbcc3475SJon Smirl struct psc_dma *psc_dma; 429dbcc3475SJon Smirl struct resource res; 430dbcc3475SJon Smirl int size, irq, rc; 431dbcc3475SJon Smirl const __be32 *prop; 432dbcc3475SJon Smirl void __iomem *regs; 433dbcc3475SJon Smirl 434dbcc3475SJon Smirl /* Fetch the registers and IRQ of the PSC */ 435dbcc3475SJon Smirl irq = irq_of_parse_and_map(op->node, 0); 436dbcc3475SJon Smirl if (of_address_to_resource(op->node, 0, &res)) { 437dbcc3475SJon Smirl dev_err(&op->dev, "Missing reg property\n"); 438dbcc3475SJon Smirl return -ENODEV; 439dbcc3475SJon Smirl } 440dbcc3475SJon Smirl regs = ioremap(res.start, 1 + res.end - res.start); 441dbcc3475SJon Smirl if (!regs) { 442dbcc3475SJon Smirl dev_err(&op->dev, "Could not map registers\n"); 443dbcc3475SJon Smirl return -ENODEV; 444dbcc3475SJon Smirl } 445dbcc3475SJon Smirl 446dbcc3475SJon Smirl /* Allocate and initialize the driver private data */ 447dbcc3475SJon Smirl psc_dma = kzalloc(sizeof *psc_dma, GFP_KERNEL); 448dbcc3475SJon Smirl if (!psc_dma) { 449dbcc3475SJon Smirl iounmap(regs); 450dbcc3475SJon Smirl return -ENOMEM; 451dbcc3475SJon Smirl } 452dbcc3475SJon Smirl 453dbcc3475SJon Smirl /* Get the PSC ID */ 454dbcc3475SJon Smirl prop = of_get_property(op->node, "cell-index", &size); 455dbcc3475SJon Smirl if (!prop || size < sizeof *prop) 456dbcc3475SJon Smirl return -ENODEV; 457dbcc3475SJon Smirl 458dbcc3475SJon Smirl spin_lock_init(&psc_dma->lock); 4590827d6baSGrant Likely mutex_init(&psc_dma->mutex); 460dbcc3475SJon Smirl psc_dma->id = be32_to_cpu(*prop); 461dbcc3475SJon Smirl psc_dma->irq = irq; 462dbcc3475SJon Smirl psc_dma->psc_regs = regs; 463dbcc3475SJon Smirl psc_dma->fifo_regs = regs + sizeof *psc_dma->psc_regs; 464dbcc3475SJon Smirl psc_dma->dev = &op->dev; 465dbcc3475SJon Smirl psc_dma->playback.psc_dma = psc_dma; 466dbcc3475SJon Smirl psc_dma->capture.psc_dma = psc_dma; 467dbcc3475SJon Smirl snprintf(psc_dma->name, sizeof psc_dma->name, "PSC%u", psc_dma->id); 468dbcc3475SJon Smirl 469dbcc3475SJon Smirl /* Find the address of the fifo data registers and setup the 470dbcc3475SJon Smirl * DMA tasks */ 471dbcc3475SJon Smirl fifo = res.start + offsetof(struct mpc52xx_psc, buffer.buffer_32); 472dbcc3475SJon Smirl psc_dma->capture.bcom_task = 473dbcc3475SJon Smirl bcom_psc_gen_bd_rx_init(psc_dma->id, 10, fifo, 512); 474dbcc3475SJon Smirl psc_dma->playback.bcom_task = 475dbcc3475SJon Smirl bcom_psc_gen_bd_tx_init(psc_dma->id, 10, fifo); 476dbcc3475SJon Smirl if (!psc_dma->capture.bcom_task || 477dbcc3475SJon Smirl !psc_dma->playback.bcom_task) { 478dbcc3475SJon Smirl dev_err(&op->dev, "Could not allocate bestcomm tasks\n"); 479dbcc3475SJon Smirl iounmap(regs); 480dbcc3475SJon Smirl kfree(psc_dma); 481dbcc3475SJon Smirl return -ENODEV; 482dbcc3475SJon Smirl } 483dbcc3475SJon Smirl 484dbcc3475SJon Smirl /* Disable all interrupts and reset the PSC */ 485dbcc3475SJon Smirl out_be16(&psc_dma->psc_regs->isr_imr.imr, psc_dma->imr); 486dbcc3475SJon Smirl /* reset receiver */ 487dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->command, MPC52xx_PSC_RST_RX); 488dbcc3475SJon Smirl /* reset transmitter */ 489dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->command, MPC52xx_PSC_RST_TX); 490dbcc3475SJon Smirl /* reset error */ 491dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->command, MPC52xx_PSC_RST_ERR_STAT); 492dbcc3475SJon Smirl /* reset mode */ 493dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->command, MPC52xx_PSC_SEL_MODE_REG_1); 494dbcc3475SJon Smirl 495dbcc3475SJon Smirl /* Set up mode register; 496dbcc3475SJon Smirl * First write: RxRdy (FIFO Alarm) generates rx FIFO irq 497dbcc3475SJon Smirl * Second write: register Normal mode for non loopback 498dbcc3475SJon Smirl */ 499dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->mode, 0); 500dbcc3475SJon Smirl out_8(&psc_dma->psc_regs->mode, 0); 501dbcc3475SJon Smirl 502dbcc3475SJon Smirl /* Set the TX and RX fifo alarm thresholds */ 503dbcc3475SJon Smirl out_be16(&psc_dma->fifo_regs->rfalarm, 0x100); 504dbcc3475SJon Smirl out_8(&psc_dma->fifo_regs->rfcntl, 0x4); 505dbcc3475SJon Smirl out_be16(&psc_dma->fifo_regs->tfalarm, 0x100); 506dbcc3475SJon Smirl out_8(&psc_dma->fifo_regs->tfcntl, 0x7); 507dbcc3475SJon Smirl 508dbcc3475SJon Smirl /* Lookup the IRQ numbers */ 509dbcc3475SJon Smirl psc_dma->playback.irq = 510dbcc3475SJon Smirl bcom_get_task_irq(psc_dma->playback.bcom_task); 511dbcc3475SJon Smirl psc_dma->capture.irq = 512dbcc3475SJon Smirl bcom_get_task_irq(psc_dma->capture.bcom_task); 513dbcc3475SJon Smirl 514dbcc3475SJon Smirl rc = request_irq(psc_dma->irq, &psc_dma_status_irq, IRQF_SHARED, 515dbcc3475SJon Smirl "psc-dma-status", psc_dma); 516dbcc3475SJon Smirl rc |= request_irq(psc_dma->capture.irq, 517dbcc3475SJon Smirl &psc_dma_bcom_irq_rx, IRQF_SHARED, 518dbcc3475SJon Smirl "psc-dma-capture", &psc_dma->capture); 519dbcc3475SJon Smirl rc |= request_irq(psc_dma->playback.irq, 520dbcc3475SJon Smirl &psc_dma_bcom_irq_tx, IRQF_SHARED, 521dbcc3475SJon Smirl "psc-dma-playback", &psc_dma->playback); 522dbcc3475SJon Smirl if (rc) { 523dbcc3475SJon Smirl free_irq(psc_dma->irq, psc_dma); 524dbcc3475SJon Smirl free_irq(psc_dma->capture.irq, 525dbcc3475SJon Smirl &psc_dma->capture); 526dbcc3475SJon Smirl free_irq(psc_dma->playback.irq, 527dbcc3475SJon Smirl &psc_dma->playback); 528dbcc3475SJon Smirl return -ENODEV; 529dbcc3475SJon Smirl } 530dbcc3475SJon Smirl 531dbcc3475SJon Smirl /* Save what we've done so it can be found again later */ 532dbcc3475SJon Smirl dev_set_drvdata(&op->dev, psc_dma); 533dbcc3475SJon Smirl 534dbcc3475SJon Smirl /* Tell the ASoC OF helpers about it */ 535dbcc3475SJon Smirl return snd_soc_register_platform(&mpc5200_audio_dma_platform); 536dbcc3475SJon Smirl } 537dbcc3475SJon Smirl EXPORT_SYMBOL_GPL(mpc5200_audio_dma_create); 538dbcc3475SJon Smirl 539dbcc3475SJon Smirl int mpc5200_audio_dma_destroy(struct of_device *op) 540dbcc3475SJon Smirl { 541dbcc3475SJon Smirl struct psc_dma *psc_dma = dev_get_drvdata(&op->dev); 542dbcc3475SJon Smirl 543dbcc3475SJon Smirl dev_dbg(&op->dev, "mpc5200_audio_dma_destroy()\n"); 544dbcc3475SJon Smirl 545dbcc3475SJon Smirl snd_soc_unregister_platform(&mpc5200_audio_dma_platform); 546dbcc3475SJon Smirl 547dbcc3475SJon Smirl bcom_gen_bd_rx_release(psc_dma->capture.bcom_task); 548dbcc3475SJon Smirl bcom_gen_bd_tx_release(psc_dma->playback.bcom_task); 549dbcc3475SJon Smirl 550dbcc3475SJon Smirl /* Release irqs */ 551dbcc3475SJon Smirl free_irq(psc_dma->irq, psc_dma); 552dbcc3475SJon Smirl free_irq(psc_dma->capture.irq, &psc_dma->capture); 553dbcc3475SJon Smirl free_irq(psc_dma->playback.irq, &psc_dma->playback); 554dbcc3475SJon Smirl 555dbcc3475SJon Smirl iounmap(psc_dma->psc_regs); 556dbcc3475SJon Smirl kfree(psc_dma); 557dbcc3475SJon Smirl dev_set_drvdata(&op->dev, NULL); 558dbcc3475SJon Smirl 559dbcc3475SJon Smirl return 0; 560dbcc3475SJon Smirl } 561dbcc3475SJon Smirl EXPORT_SYMBOL_GPL(mpc5200_audio_dma_destroy); 562dbcc3475SJon Smirl 563dbcc3475SJon Smirl MODULE_AUTHOR("Grant Likely <grant.likely@secretlab.ca>"); 564dbcc3475SJon Smirl MODULE_DESCRIPTION("Freescale MPC5200 PSC in DMA mode ASoC Driver"); 565dbcc3475SJon Smirl MODULE_LICENSE("GPL"); 566