Message ID | 7fd26c605d5cfa422d0fc37a7b790fb9a837d7e3.1309368631.git.nicolas.ferre@atmel.com |
---|---|
State | New |
Headers | show |
On Wed, Jun 29, 2011 at 08:00:18PM +0200, Nicolas Ferre wrote: > +static const struct snd_pcm_hardware atmel_pcm_dma_hardware = { > + .info = SNDRV_PCM_INFO_MMAP | > + SNDRV_PCM_INFO_MMAP_VALID | The naming here looks a bit undescriptive but I'm not sure what a better name would be - obviously both DMA controllers are DMA controllers. It feels like it would be more sensible to just write a separate DMA driver as I'm not sure how much code actually ends up being shared here but it looks pretty small from the diff... > +static bool filter(struct dma_chan *chan, void *slave) > +{ > + struct at_dma_slave *sl = slave; > + Odd whitespace here. > +static int atmel_pcm_dma_alloc(struct snd_pcm_substream *substream, > + struct snd_pcm_hw_params *params) > +{ > + struct snd_pcm_runtime *runtime = substream->runtime; > + struct atmel_runtime_data *prtd = runtime->private_data; > + struct ssc_device *ssc = prtd->params->ssc; > + struct at_dma_slave *sdata = NULL; > + > + if (ssc->pdev) > + sdata = ssc->pdev->dev.platform_data; Why wouldn't we have a device, and why is there a separate copy of the device? > + if (!prtd->dma_chan) { > + pr_err("atmel-pcm: " > + "DMA channel not available, unable to use SSC-audio\n"); > + return -EBUSY; dev_err() and don't split strings over lines. > + switch (prtd->params->data_xfer_size) { > + case 1: > + buswidth = DMA_SLAVE_BUSWIDTH_1_BYTE; > + break; > + case 2: > + buswidth = DMA_SLAVE_BUSWIDTH_2_BYTES; > + break; > + case 4: > + buswidth = DMA_SLAVE_BUSWIDTH_4_BYTES; > + break; > + default: > + return; > + } It strikes me that this mapping of bytes to DMA_SLAVE_ is likely to be quite common and might be nice as a helper in dmaengine. I'd also expect to see something complain (even if just with BUG()) if we hit the default case.
On Wed, 2011-06-29 at 20:00 +0200, Nicolas Ferre wrote: > Change xfer_size name to apply to PDC and DMA aswell. > Specify overrun bit in interrupt mask. > Add dmaengine specific routines and replace PDC ones in > pcm_ops if appropriate. > Uses cyclic DMA API for queuing samples. > > Signed-off-by: Nicolas Ferre <nicolas.ferre@atmel.com> > Signed-off-by: Uwe Kleine-König <u.kleine-koenig@pengutronix.de> > --- > sound/soc/atmel/atmel-pcm.c | 382 +++++++++++++++++++++++++++++++++++--- > sound/soc/atmel/atmel-pcm.h | 4 +- > sound/soc/atmel/atmel_ssc_dai.c | 33 ++-- > 3 files changed, 373 insertions(+), 46 deletions(-) > > diff --git a/sound/soc/atmel/atmel-pcm.c b/sound/soc/atmel/atmel-pcm.c > index 51dde4e..fee6696 100644 > --- a/sound/soc/atmel/atmel-pcm.c > +++ b/sound/soc/atmel/atmel-pcm.c > @@ -37,6 +37,7 @@ > #include <linux/slab.h> > #include <linux/dma-mapping.h> > #include <linux/atmel_pdc.h> > +#include <linux/dmaengine.h> > #include <linux/atmel-ssc.h> > > #include <sound/core.h> > @@ -44,6 +45,8 @@ > #include <sound/pcm_params.h> > #include <sound/soc.h> > > +#include <mach/at_hdmac.h> > + > #include "atmel-pcm.h" > > > @@ -53,7 +56,7 @@ > /* TODO: These values were taken from the AT91 platform driver, check > * them against real values for AT32 > */ > -static const struct snd_pcm_hardware atmel_pcm_hardware = { > +static const struct snd_pcm_hardware atmel_pcm_pdc_hardware = { > .info = SNDRV_PCM_INFO_MMAP | > SNDRV_PCM_INFO_MMAP_VALID | > SNDRV_PCM_INFO_INTERLEAVED | > @@ -66,6 +69,22 @@ static const struct snd_pcm_hardware atmel_pcm_hardware = { > .buffer_bytes_max = 32 * 1024, > }; > > +static const struct snd_pcm_hardware atmel_pcm_dma_hardware = { > + .info = SNDRV_PCM_INFO_MMAP | > + SNDRV_PCM_INFO_MMAP_VALID | > + SNDRV_PCM_INFO_INTERLEAVED | > + SNDRV_PCM_INFO_RESUME | > + SNDRV_PCM_INFO_PAUSE, > + .formats = SNDRV_PCM_FMTBIT_S16_LE, > + .period_bytes_min = 256, /* not too low to absorb DMA programming overhead */ > + .period_bytes_max = 2 * 0xffff, /* if 2 bytes format */ > + .periods_min = 8, > + .periods_max = 1024, /* no limit */ > + .buffer_bytes_max = 64 * 1024, /* 64KiB */ > +}; > + > +static const struct snd_pcm_hardware *atmel_pcm_hardware; > + > > /*--------------------------------------------------------------------------*\ > * Data types > @@ -77,12 +96,19 @@ struct atmel_runtime_data { > size_t period_size; > > dma_addr_t period_ptr; /* physical address of next period */ > + int periods; /* period index of period_ptr */ > > /* PDC register save */ > u32 pdc_xpr_save; > u32 pdc_xcr_save; > u32 pdc_xnpr_save; > u32 pdc_xncr_save; > + > + /* dmaengine data */ > + struct at_dma_slave atslave; > + struct dma_async_tx_descriptor *desc; > + dma_cookie_t cookie; > + struct dma_chan *dma_chan; > }; > > > @@ -94,7 +120,7 @@ static int atmel_pcm_preallocate_dma_buffer(struct snd_pcm *pcm, > { > struct snd_pcm_substream *substream = pcm->streams[stream].substream; > struct snd_dma_buffer *buf = &substream->dma_buffer; > - size_t size = atmel_pcm_hardware.buffer_bytes_max; > + size_t size = atmel_pcm_hardware->buffer_bytes_max; > > buf->dev.type = SNDRV_DMA_TYPE_DEV; > buf->dev.dev = pcm->card->dev; > @@ -116,7 +142,7 @@ static int atmel_pcm_preallocate_dma_buffer(struct snd_pcm *pcm, > /*--------------------------------------------------------------------------*\ > * ISR > \*--------------------------------------------------------------------------*/ > -static void atmel_pcm_dma_irq(u32 ssc_sr, > +static void atmel_pcm_pdc_irq(u32 ssc_sr, > struct snd_pcm_substream *substream) > { > struct atmel_runtime_data *prtd = substream->runtime->private_data; > @@ -142,7 +168,7 @@ static void atmel_pcm_dma_irq(u32 ssc_sr, > ssc_writex(params->ssc->regs, params->pdc->xpr, > prtd->period_ptr); > ssc_writex(params->ssc->regs, params->pdc->xcr, > - prtd->period_size / params->pdc_xfer_size); > + prtd->period_size / params->data_xfer_size); > ssc_writex(params->ssc->regs, ATMEL_PDC_PTCR, > params->mask->pdc_enable); > } > @@ -156,12 +182,163 @@ static void atmel_pcm_dma_irq(u32 ssc_sr, > ssc_writex(params->ssc->regs, params->pdc->xnpr, > prtd->period_ptr); > ssc_writex(params->ssc->regs, params->pdc->xncr, > - prtd->period_size / params->pdc_xfer_size); > + prtd->period_size / params->data_xfer_size); > } > > snd_pcm_period_elapsed(substream); > } > > +/** > + * atmel_pcm_dma_irq: SSC interrupt handler for DMAENGINE enabled SSC > + * > + * We use DMAENGINE to send/receive data to/from SSC so this ISR is only to > + * check if any overrun occured. > + */ > +static void atmel_pcm_dma_irq(u32 ssc_sr, > + struct snd_pcm_substream *substream) > +{ > + struct atmel_runtime_data *prtd = substream->runtime->private_data; > + struct atmel_pcm_dma_params *params = prtd->params; > + > + if (ssc_sr & params->mask->ssc_error) { > + if (snd_pcm_running(substream)) > + pr_warning("atmel-pcm: buffer %s on %s" > + " (SSC_SR=%#x)\n", > + substream->stream == SNDRV_PCM_STREAM_PLAYBACK > + ? "underrun" : "overrun", > + params->name, ssc_sr); > + > + /* stop RX and capture stream: will be enabled again at restart */ > + ssc_writex(params->ssc->regs, SSC_CR, params->mask->ssc_disable); > + snd_pcm_stop(substream, SNDRV_PCM_STATE_XRUN); > + > + /* now drain RHR and read status to remove xrun condition */ > + ssc_readx(params->ssc->regs, SSC_RHR); > + ssc_readx(params->ssc->regs, SSC_SR); > + } > +} > + > +/*--------------------------------------------------------------------------*\ > + * DMAENGINE operations > +\*--------------------------------------------------------------------------*/ > +static bool filter(struct dma_chan *chan, void *slave) > +{ > + struct at_dma_slave *sl = slave; > + > + if (sl->dma_dev == chan->device->dev) { > + chan->private = sl; Nope you dont want to do that, pls use dmaengine_slave_config() API for setting this > + return true; > + } else { > + return false; > + } > +} > + > +static int atmel_pcm_dma_alloc(struct snd_pcm_substream *substream, > + struct snd_pcm_hw_params *params) > +{ > + struct snd_pcm_runtime *runtime = substream->runtime; > + struct atmel_runtime_data *prtd = runtime->private_data; > + struct ssc_device *ssc = prtd->params->ssc; > + struct at_dma_slave *sdata = NULL; > + > + if (ssc->pdev) > + sdata = ssc->pdev->dev.platform_data; > + > + if (sdata && sdata->dma_dev) { > + dma_cap_mask_t mask; > + > + /* setup DMA addresses */ > + sdata->rx_reg = (dma_addr_t)ssc->phybase + SSC_RHR; > + sdata->tx_reg = (dma_addr_t)ssc->phybase + SSC_THR; > + > + /* Try to grab a DMA channel */ > + dma_cap_zero(mask); > + dma_cap_set(DMA_CYCLIC, mask); > + prtd->dma_chan = dma_request_channel(mask, filter, sdata); > + } > + if (!prtd->dma_chan) { > + pr_err("atmel-pcm: " > + "DMA channel not available, unable to use SSC-audio\n"); > + return -EBUSY; > + } > + > + return 0; > +} > + > +static void audio_dma_irq(void *data) > +{ > + struct snd_pcm_substream *substream = (struct snd_pcm_substream *)data; > + struct snd_pcm_runtime *runtime = substream->runtime; > + struct atmel_runtime_data *prtd = runtime->private_data; > + > + prtd->period_ptr += prtd->period_size; > + if (prtd->period_ptr >= prtd->dma_buffer_end) > + prtd->period_ptr = prtd->dma_buffer; > + > + snd_pcm_period_elapsed(substream); > +} > + > +static void atmel_pcm_dma_slave_config(struct snd_pcm_substream *substream) > +{ > + struct snd_pcm_runtime *runtime = substream->runtime; > + struct atmel_runtime_data *prtd = runtime->private_data; > + struct dma_chan *chan = prtd->dma_chan; > + struct dma_slave_config slave_config; > + enum dma_slave_buswidth buswidth; > + > + switch (prtd->params->data_xfer_size) { > + case 1: > + buswidth = DMA_SLAVE_BUSWIDTH_1_BYTE; > + break; > + case 2: > + buswidth = DMA_SLAVE_BUSWIDTH_2_BYTES; > + break; > + case 4: > + buswidth = DMA_SLAVE_BUSWIDTH_4_BYTES; > + break; > + default: > + return; > + } > + > + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { > + slave_config.direction = DMA_TO_DEVICE; > + slave_config.dst_addr_width = buswidth; > + } else { > + slave_config.direction = DMA_FROM_DEVICE; > + slave_config.src_addr_width = buswidth; > + } > + > + dmaengine_slave_config(chan, &slave_config); okay, you seem to be doing right thing, then why are you setting the chan->slave pointer?? > +} > + > +static int atmel_pcm_dma_prep(struct snd_pcm_substream *substream) > +{ > + struct snd_pcm_runtime *runtime = substream->runtime; > + struct atmel_runtime_data *prtd = runtime->private_data; > + struct dma_chan *chan = prtd->dma_chan; > + > + if (prtd->desc) > + /* already been there: redo the prep job */ > + dmaengine_terminate_all(chan); > + > + /* setup dma configuration */ > + atmel_pcm_dma_slave_config(substream); Nope, this is channel config. As long as you retain the channel you shouldn't be required to set this again. > + > + prtd->desc = chan->device->device_prep_dma_cyclic(chan, prtd->dma_buffer, > + prtd->period_size * prtd->periods, > + prtd->period_size, > + substream->stream == SNDRV_PCM_STREAM_PLAYBACK ? > + DMA_TO_DEVICE : DMA_FROM_DEVICE); > + if (!prtd->desc) { > + dev_err(&chan->dev->device, "cannot prepare slave dma\n"); > + return -EINVAL; > + } > + > + prtd->desc->callback = audio_dma_irq; > + prtd->desc->callback_param = substream; > + > + return 0; > +} > > /*--------------------------------------------------------------------------*\ > * PCM operations > @@ -172,6 +349,7 @@ static int atmel_pcm_hw_params(struct snd_pcm_substream *substream, > struct snd_pcm_runtime *runtime = substream->runtime; > struct atmel_runtime_data *prtd = runtime->private_data; > struct snd_soc_pcm_runtime *rtd = substream->private_data; > + int ret; > > /* this may get called several times by oss emulation > * with different params */ > @@ -180,15 +358,35 @@ static int atmel_pcm_hw_params(struct snd_pcm_substream *substream, > runtime->dma_bytes = params_buffer_bytes(params); > > prtd->params = snd_soc_dai_get_dma_data(rtd->cpu_dai, substream); > - prtd->params->dma_intr_handler = atmel_pcm_dma_irq; > > prtd->dma_buffer = runtime->dma_addr; > prtd->dma_buffer_end = runtime->dma_addr + runtime->dma_bytes; > prtd->period_size = params_period_bytes(params); > + prtd->periods = params_periods(params); > + > + if (ssc_use_dmaengine()) { > + if (prtd->dma_chan == NULL) { > + ret = atmel_pcm_dma_alloc(substream, params); > + if (ret) > + return ret; > + } > + ret = atmel_pcm_dma_prep(substream); > + if (ret) { > + dma_release_channel(prtd->dma_chan); > + prtd->dma_chan = NULL; > + return ret; > + } > + > + prtd->params->dma_intr_handler = atmel_pcm_dma_irq; > + } else { > + prtd->params->dma_intr_handler = atmel_pcm_pdc_irq; > + } > > pr_debug("atmel-pcm: " > - "hw_params: DMA for %s initialized " > + "hw_params: %s%s for %s initialized " > "(dma_bytes=%u, period_size=%u)\n", > + prtd->dma_chan ? "DMA " : "PDC", > + prtd->dma_chan ? dma_chan_name(prtd->dma_chan): "", > prtd->params->name, > runtime->dma_bytes, > prtd->period_size); > @@ -201,15 +399,30 @@ static int atmel_pcm_hw_free(struct snd_pcm_substream *substream) > struct atmel_pcm_dma_params *params = prtd->params; > > if (params != NULL) { > - ssc_writex(params->ssc->regs, SSC_PDC_PTCR, > - params->mask->pdc_disable); > + if (ssc_use_dmaengine()) { > + struct dma_chan *chan = prtd->dma_chan; > + > + if (chan) { > + dmaengine_terminate_all(chan); > + prtd->cookie = 0; > + prtd->desc = NULL; > + dma_release_channel(chan); > + prtd->dma_chan = NULL; > + } > + } else { > + ssc_writex(params->ssc->regs, SSC_PDC_PTCR, > + params->mask->pdc_disable); > + } > prtd->params->dma_intr_handler = NULL; > } > > return 0; > } > > -static int atmel_pcm_prepare(struct snd_pcm_substream *substream) > +/*--------------------------------------------------------------------------*\ > + * PCM callbacks using PDC > +\*--------------------------------------------------------------------------*/ > +static int atmel_pcm_pdc_prepare(struct snd_pcm_substream *substream) > { > struct atmel_runtime_data *prtd = substream->runtime->private_data; > struct atmel_pcm_dma_params *params = prtd->params; > @@ -221,7 +434,7 @@ static int atmel_pcm_prepare(struct snd_pcm_substream *substream) > return 0; > } > > -static int atmel_pcm_trigger(struct snd_pcm_substream *substream, > +static int atmel_pcm_pdc_trigger(struct snd_pcm_substream *substream, > int cmd) > { > struct snd_pcm_runtime *rtd = substream->runtime; > @@ -240,13 +453,13 @@ static int atmel_pcm_trigger(struct snd_pcm_substream *substream, > ssc_writex(params->ssc->regs, params->pdc->xpr, > prtd->period_ptr); > ssc_writex(params->ssc->regs, params->pdc->xcr, > - prtd->period_size / params->pdc_xfer_size); > + prtd->period_size / params->data_xfer_size); > > prtd->period_ptr += prtd->period_size; > ssc_writex(params->ssc->regs, params->pdc->xnpr, > prtd->period_ptr); > ssc_writex(params->ssc->regs, params->pdc->xncr, > - prtd->period_size / params->pdc_xfer_size); > + prtd->period_size / params->data_xfer_size); > > pr_debug("atmel-pcm: trigger: " > "period_ptr=%lx, xpr=%u, " > @@ -264,7 +477,7 @@ static int atmel_pcm_trigger(struct snd_pcm_substream *substream, > > pr_debug("sr=%u imr=%u\n", > ssc_readx(params->ssc->regs, SSC_SR), > - ssc_readx(params->ssc->regs, SSC_IER)); > + ssc_readx(params->ssc->regs, SSC_IMR)); > break; /* SNDRV_PCM_TRIGGER_START */ > > case SNDRV_PCM_TRIGGER_STOP: > @@ -287,7 +500,7 @@ static int atmel_pcm_trigger(struct snd_pcm_substream *substream, > return ret; > } > > -static snd_pcm_uframes_t atmel_pcm_pointer( > +static snd_pcm_uframes_t atmel_pcm_pdc_pointer( > struct snd_pcm_substream *substream) > { > struct snd_pcm_runtime *runtime = substream->runtime; > @@ -305,13 +518,107 @@ static snd_pcm_uframes_t atmel_pcm_pointer( > return x; > } > > +/*--------------------------------------------------------------------------*\ > + * PCM callbacks using DMAENGINE > +\*--------------------------------------------------------------------------*/ > +static int atmel_pcm_dma_prepare(struct snd_pcm_substream *substream) > +{ > + struct atmel_runtime_data *prtd = substream->runtime->private_data; > + struct atmel_pcm_dma_params *params = prtd->params; > + > + ssc_writex(params->ssc->regs, SSC_IDR, params->mask->ssc_error); > + return 0; > +} > + > +static int atmel_pcm_dma_trigger(struct snd_pcm_substream *substream, > + int cmd) > +{ > + struct snd_pcm_runtime *rtd = substream->runtime; > + struct atmel_runtime_data *prtd = rtd->private_data; > + struct atmel_pcm_dma_params *params = prtd->params; > + dma_cookie_t cookie; > + int ret = 0; > + > + pr_debug("atmel-pcm: trigger %d: buffer_size = %ld," > + " dma_area = %p, dma_bytes = %u\n", > + cmd, rtd->buffer_size, rtd->dma_area, rtd->dma_bytes); > + > + switch (cmd) { > + case SNDRV_PCM_TRIGGER_START: > + > + if (prtd->cookie < DMA_MIN_COOKIE) { > + cookie = dmaengine_submit(prtd->desc); submit and issue_pending as well... > + if (dma_submit_error(cookie)) { > + ret = -EINVAL; > + break; > + } > + prtd->cookie = cookie; > + prtd->period_ptr = prtd->dma_buffer; > + } > + > + > + pr_debug("atmel-pcm: trigger: start sr=0x%08x imr=0x%08u\n", > + ssc_readx(params->ssc->regs, SSC_SR), > + ssc_readx(params->ssc->regs, SSC_IMR)); > + > + /* fallback */ > + case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: > + case SNDRV_PCM_TRIGGER_RESUME: > + dmaengine_resume(prtd->dma_chan); > + > + /* It not already done or comming from xrun state */ > + ssc_readx(params->ssc->regs, SSC_SR); > + ssc_writex(params->ssc->regs, SSC_IER, params->mask->ssc_error); > + ssc_writex(params->ssc->regs, SSC_CR, params->mask->ssc_enable); > + > + break; > + case SNDRV_PCM_TRIGGER_STOP: > + pr_debug("atmel-pcm: trigger: stop cmd = %d\n", cmd); > + > + ssc_writex(params->ssc->regs, SSC_IDR, params->mask->ssc_error); > + > + /* fallback */ > + case SNDRV_PCM_TRIGGER_PAUSE_PUSH: > + case SNDRV_PCM_TRIGGER_SUSPEND: > + dmaengine_pause(prtd->dma_chan); > + break; > + default: > + ret = -EINVAL; > + } > + > + return ret; > +} > + > +static snd_pcm_uframes_t atmel_pcm_dma_pointer( > + struct snd_pcm_substream *substream) > +{ > + struct snd_pcm_runtime *runtime = substream->runtime; > + struct atmel_runtime_data *prtd = runtime->private_data; > + snd_pcm_uframes_t x; > + > + dev_vdbg(substream->pcm->card->dev, "%s: 0x%08x %ld\n", > + __func__, prtd->period_ptr, > + bytes_to_frames(runtime, prtd->period_ptr - prtd->dma_buffer)); > + > + x = bytes_to_frames(runtime, prtd->period_ptr - prtd->dma_buffer); > + > + if (x >= runtime->buffer_size) > + x = 0; > + > + return x; > +} > + > + > +/*--------------------------------------------------------------------------*\ > + * PCM open/close/mmap > +\*--------------------------------------------------------------------------*/ > static int atmel_pcm_open(struct snd_pcm_substream *substream) > { > struct snd_pcm_runtime *runtime = substream->runtime; > struct atmel_runtime_data *prtd; > int ret = 0; > > - snd_soc_set_runtime_hwparams(substream, &atmel_pcm_hardware); > + snd_soc_set_runtime_hwparams(substream, atmel_pcm_hardware); > > /* ensure that buffer size is a multiple of period size */ > ret = snd_pcm_hw_constraint_integer(runtime, > @@ -352,9 +659,9 @@ static struct snd_pcm_ops atmel_pcm_ops = { > .ioctl = snd_pcm_lib_ioctl, > .hw_params = atmel_pcm_hw_params, > .hw_free = atmel_pcm_hw_free, > - .prepare = atmel_pcm_prepare, > - .trigger = atmel_pcm_trigger, > - .pointer = atmel_pcm_pointer, > + .prepare = atmel_pcm_pdc_prepare, > + .trigger = atmel_pcm_pdc_trigger, > + .pointer = atmel_pcm_pdc_pointer, > .mmap = atmel_pcm_mmap, > }; > > @@ -426,14 +733,16 @@ static int atmel_pcm_suspend(struct snd_soc_dai *dai) > prtd = runtime->private_data; > params = prtd->params; > > - /* disable the PDC and save the PDC registers */ > + if (!ssc_use_dmaengine()) { > + /* disable the PDC and save the PDC registers */ > > - ssc_writel(params->ssc->regs, PDC_PTCR, params->mask->pdc_disable); > + ssc_writel(params->ssc->regs, PDC_PTCR, params->mask->pdc_disable); > > - prtd->pdc_xpr_save = ssc_readx(params->ssc->regs, params->pdc->xpr); > - prtd->pdc_xcr_save = ssc_readx(params->ssc->regs, params->pdc->xcr); > - prtd->pdc_xnpr_save = ssc_readx(params->ssc->regs, params->pdc->xnpr); > - prtd->pdc_xncr_save = ssc_readx(params->ssc->regs, params->pdc->xncr); > + prtd->pdc_xpr_save = ssc_readx(params->ssc->regs, params->pdc->xpr); > + prtd->pdc_xcr_save = ssc_readx(params->ssc->regs, params->pdc->xcr); > + prtd->pdc_xnpr_save = ssc_readx(params->ssc->regs, params->pdc->xnpr); > + prtd->pdc_xncr_save = ssc_readx(params->ssc->regs, params->pdc->xncr); > + } > > return 0; > } > @@ -450,13 +759,15 @@ static int atmel_pcm_resume(struct snd_soc_dai *dai) > prtd = runtime->private_data; > params = prtd->params; > > - /* restore the PDC registers and enable the PDC */ > - ssc_writex(params->ssc->regs, params->pdc->xpr, prtd->pdc_xpr_save); > - ssc_writex(params->ssc->regs, params->pdc->xcr, prtd->pdc_xcr_save); > - ssc_writex(params->ssc->regs, params->pdc->xnpr, prtd->pdc_xnpr_save); > - ssc_writex(params->ssc->regs, params->pdc->xncr, prtd->pdc_xncr_save); > + if (!ssc_use_dmaengine()) { > + /* restore the PDC registers and enable the PDC */ > + ssc_writex(params->ssc->regs, params->pdc->xpr, prtd->pdc_xpr_save); > + ssc_writex(params->ssc->regs, params->pdc->xcr, prtd->pdc_xcr_save); > + ssc_writex(params->ssc->regs, params->pdc->xnpr, prtd->pdc_xnpr_save); > + ssc_writex(params->ssc->regs, params->pdc->xncr, prtd->pdc_xncr_save); > > - ssc_writel(params->ssc->regs, PDC_PTCR, params->mask->pdc_enable); > + ssc_writel(params->ssc->regs, PDC_PTCR, params->mask->pdc_enable); > + } > return 0; > } > #else > @@ -495,6 +806,15 @@ static struct platform_driver atmel_pcm_driver = { > > static int __init snd_atmel_pcm_init(void) > { > + if (ssc_use_dmaengine()) { > + atmel_pcm_ops.prepare = atmel_pcm_dma_prepare; > + atmel_pcm_ops.trigger = atmel_pcm_dma_trigger; > + atmel_pcm_ops.pointer = atmel_pcm_dma_pointer; > + > + atmel_pcm_hardware = &atmel_pcm_dma_hardware; > + } else { > + atmel_pcm_hardware = &atmel_pcm_pdc_hardware; > + } > return platform_driver_register(&atmel_pcm_driver); > } > module_init(snd_atmel_pcm_init); > diff --git a/sound/soc/atmel/atmel-pcm.h b/sound/soc/atmel/atmel-pcm.h > index 5e0a95e..b007376 100644 > --- a/sound/soc/atmel/atmel-pcm.h > +++ b/sound/soc/atmel/atmel-pcm.h > @@ -50,6 +50,7 @@ struct atmel_pdc_regs { > struct atmel_ssc_mask { > u32 ssc_enable; /* SSC recv/trans enable */ > u32 ssc_disable; /* SSC recv/trans disable */ > + u32 ssc_error; /* SSC error conditions */ > u32 ssc_endx; /* SSC ENDTX or ENDRX */ > u32 ssc_endbuf; /* SSC TXBUFE or RXBUFF */ > u32 pdc_enable; /* PDC recv/trans enable */ > @@ -66,7 +67,8 @@ struct atmel_ssc_mask { > */ > struct atmel_pcm_dma_params { > char *name; /* stream identifier */ > - int pdc_xfer_size; /* PDC counter increment in bytes */ > + int data_xfer_size; /* PDC counter increment in bytes, > + DMA data transfer size in bytes */ > struct ssc_device *ssc; /* SSC device for stream */ > struct atmel_pdc_regs *pdc; /* PDC receive or transmit registers */ > struct atmel_ssc_mask *mask; /* SSC & PDC status bits */ > diff --git a/sound/soc/atmel/atmel_ssc_dai.c b/sound/soc/atmel/atmel_ssc_dai.c > index a7a7bbc..9412fc3 100644 > --- a/sound/soc/atmel/atmel_ssc_dai.c > +++ b/sound/soc/atmel/atmel_ssc_dai.c > @@ -48,7 +48,8 @@ > #include "atmel_ssc_dai.h" > > > -#if defined(CONFIG_ARCH_AT91SAM9260) || defined(CONFIG_ARCH_AT91SAM9G20) > +#if defined(CONFIG_ARCH_AT91SAM9260) || defined(CONFIG_ARCH_AT91SAM9G20) \ > + || defined(CONFIG_ARCH_AT91SAM9X5) > #define NUM_SSC_DEVICES 1 > #else > #define NUM_SSC_DEVICES 3 > @@ -86,6 +87,7 @@ static struct atmel_ssc_mask ssc_tx_mask = { > static struct atmel_ssc_mask ssc_rx_mask = { > .ssc_enable = SSC_BIT(CR_RXEN), > .ssc_disable = SSC_BIT(CR_RXDIS), > + .ssc_error = SSC_BIT(SR_OVRUN), > .ssc_endx = SSC_BIT(SR_ENDRX), > .ssc_endbuf = SSC_BIT(SR_RXBUFF), > .pdc_enable = ATMEL_PDC_RXTEN, > @@ -183,7 +185,8 @@ static irqreturn_t atmel_ssc_interrupt(int irq, void *dev_id) > if ((dma_params != NULL) && > (dma_params->dma_intr_handler != NULL)) { > ssc_substream_mask = (dma_params->mask->ssc_endx | > - dma_params->mask->ssc_endbuf); > + dma_params->mask->ssc_endbuf | > + dma_params->mask->ssc_error); > if (ssc_sr & ssc_substream_mask) { > dma_params->dma_intr_handler(ssc_sr, > dma_params-> > @@ -376,19 +379,19 @@ static int atmel_ssc_hw_params(struct snd_pcm_substream *substream, > switch (params_format(params)) { > case SNDRV_PCM_FORMAT_S8: > bits = 8; > - dma_params->pdc_xfer_size = 1; > + dma_params->data_xfer_size = 1; > break; > case SNDRV_PCM_FORMAT_S16_LE: > bits = 16; > - dma_params->pdc_xfer_size = 2; > + dma_params->data_xfer_size = 2; > break; > case SNDRV_PCM_FORMAT_S24_LE: > bits = 24; > - dma_params->pdc_xfer_size = 4; > + dma_params->data_xfer_size = 4; > break; > case SNDRV_PCM_FORMAT_S32_LE: > bits = 32; > - dma_params->pdc_xfer_size = 4; > + dma_params->data_xfer_size = 4; > break; > default: > printk(KERN_WARNING "atmel_ssc_dai: unsupported PCM format"); > @@ -561,15 +564,17 @@ static int atmel_ssc_hw_params(struct snd_pcm_substream *substream, > /* Reset the SSC and its PDC registers */ > ssc_writel(ssc_p->ssc->regs, CR, SSC_BIT(CR_SWRST)); > > - ssc_writel(ssc_p->ssc->regs, PDC_RPR, 0); > - ssc_writel(ssc_p->ssc->regs, PDC_RCR, 0); > - ssc_writel(ssc_p->ssc->regs, PDC_RNPR, 0); > - ssc_writel(ssc_p->ssc->regs, PDC_RNCR, 0); > + if (!ssc_use_dmaengine()) { > + ssc_writel(ssc_p->ssc->regs, PDC_RPR, 0); > + ssc_writel(ssc_p->ssc->regs, PDC_RCR, 0); > + ssc_writel(ssc_p->ssc->regs, PDC_RNPR, 0); > + ssc_writel(ssc_p->ssc->regs, PDC_RNCR, 0); > > - ssc_writel(ssc_p->ssc->regs, PDC_TPR, 0); > - ssc_writel(ssc_p->ssc->regs, PDC_TCR, 0); > - ssc_writel(ssc_p->ssc->regs, PDC_TNPR, 0); > - ssc_writel(ssc_p->ssc->regs, PDC_TNCR, 0); > + ssc_writel(ssc_p->ssc->regs, PDC_TPR, 0); > + ssc_writel(ssc_p->ssc->regs, PDC_TCR, 0); > + ssc_writel(ssc_p->ssc->regs, PDC_TNPR, 0); > + ssc_writel(ssc_p->ssc->regs, PDC_TNCR, 0); > + } > > ret = request_irq(ssc_p->ssc->irq, atmel_ssc_interrupt, 0, > ssc_p->name, ssc_p);
diff --git a/sound/soc/atmel/atmel-pcm.c b/sound/soc/atmel/atmel-pcm.c index 51dde4e..fee6696 100644 --- a/sound/soc/atmel/atmel-pcm.c +++ b/sound/soc/atmel/atmel-pcm.c @@ -37,6 +37,7 @@ #include <linux/slab.h> #include <linux/dma-mapping.h> #include <linux/atmel_pdc.h> +#include <linux/dmaengine.h> #include <linux/atmel-ssc.h> #include <sound/core.h> @@ -44,6 +45,8 @@ #include <sound/pcm_params.h> #include <sound/soc.h> +#include <mach/at_hdmac.h> + #include "atmel-pcm.h" @@ -53,7 +56,7 @@ /* TODO: These values were taken from the AT91 platform driver, check * them against real values for AT32 */ -static const struct snd_pcm_hardware atmel_pcm_hardware = { +static const struct snd_pcm_hardware atmel_pcm_pdc_hardware = { .info = SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_MMAP_VALID | SNDRV_PCM_INFO_INTERLEAVED | @@ -66,6 +69,22 @@ static const struct snd_pcm_hardware atmel_pcm_hardware = { .buffer_bytes_max = 32 * 1024, }; +static const struct snd_pcm_hardware atmel_pcm_dma_hardware = { + .info = SNDRV_PCM_INFO_MMAP | + SNDRV_PCM_INFO_MMAP_VALID | + SNDRV_PCM_INFO_INTERLEAVED | + SNDRV_PCM_INFO_RESUME | + SNDRV_PCM_INFO_PAUSE, + .formats = SNDRV_PCM_FMTBIT_S16_LE, + .period_bytes_min = 256, /* not too low to absorb DMA programming overhead */ + .period_bytes_max = 2 * 0xffff, /* if 2 bytes format */ + .periods_min = 8, + .periods_max = 1024, /* no limit */ + .buffer_bytes_max = 64 * 1024, /* 64KiB */ +}; + +static const struct snd_pcm_hardware *atmel_pcm_hardware; + /*--------------------------------------------------------------------------*\ * Data types @@ -77,12 +96,19 @@ struct atmel_runtime_data { size_t period_size; dma_addr_t period_ptr; /* physical address of next period */ + int periods; /* period index of period_ptr */ /* PDC register save */ u32 pdc_xpr_save; u32 pdc_xcr_save; u32 pdc_xnpr_save; u32 pdc_xncr_save; + + /* dmaengine data */ + struct at_dma_slave atslave; + struct dma_async_tx_descriptor *desc; + dma_cookie_t cookie; + struct dma_chan *dma_chan; }; @@ -94,7 +120,7 @@ static int atmel_pcm_preallocate_dma_buffer(struct snd_pcm *pcm, { struct snd_pcm_substream *substream = pcm->streams[stream].substream; struct snd_dma_buffer *buf = &substream->dma_buffer; - size_t size = atmel_pcm_hardware.buffer_bytes_max; + size_t size = atmel_pcm_hardware->buffer_bytes_max; buf->dev.type = SNDRV_DMA_TYPE_DEV; buf->dev.dev = pcm->card->dev; @@ -116,7 +142,7 @@ static int atmel_pcm_preallocate_dma_buffer(struct snd_pcm *pcm, /*--------------------------------------------------------------------------*\ * ISR \*--------------------------------------------------------------------------*/ -static void atmel_pcm_dma_irq(u32 ssc_sr, +static void atmel_pcm_pdc_irq(u32 ssc_sr, struct snd_pcm_substream *substream) { struct atmel_runtime_data *prtd = substream->runtime->private_data; @@ -142,7 +168,7 @@ static void atmel_pcm_dma_irq(u32 ssc_sr, ssc_writex(params->ssc->regs, params->pdc->xpr, prtd->period_ptr); ssc_writex(params->ssc->regs, params->pdc->xcr, - prtd->period_size / params->pdc_xfer_size); + prtd->period_size / params->data_xfer_size); ssc_writex(params->ssc->regs, ATMEL_PDC_PTCR, params->mask->pdc_enable); } @@ -156,12 +182,163 @@ static void atmel_pcm_dma_irq(u32 ssc_sr, ssc_writex(params->ssc->regs, params->pdc->xnpr, prtd->period_ptr); ssc_writex(params->ssc->regs, params->pdc->xncr, - prtd->period_size / params->pdc_xfer_size); + prtd->period_size / params->data_xfer_size); } snd_pcm_period_elapsed(substream); } +/** + * atmel_pcm_dma_irq: SSC interrupt handler for DMAENGINE enabled SSC + * + * We use DMAENGINE to send/receive data to/from SSC so this ISR is only to + * check if any overrun occured. + */ +static void atmel_pcm_dma_irq(u32 ssc_sr, + struct snd_pcm_substream *substream) +{ + struct atmel_runtime_data *prtd = substream->runtime->private_data; + struct atmel_pcm_dma_params *params = prtd->params; + + if (ssc_sr & params->mask->ssc_error) { + if (snd_pcm_running(substream)) + pr_warning("atmel-pcm: buffer %s on %s" + " (SSC_SR=%#x)\n", + substream->stream == SNDRV_PCM_STREAM_PLAYBACK + ? "underrun" : "overrun", + params->name, ssc_sr); + + /* stop RX and capture stream: will be enabled again at restart */ + ssc_writex(params->ssc->regs, SSC_CR, params->mask->ssc_disable); + snd_pcm_stop(substream, SNDRV_PCM_STATE_XRUN); + + /* now drain RHR and read status to remove xrun condition */ + ssc_readx(params->ssc->regs, SSC_RHR); + ssc_readx(params->ssc->regs, SSC_SR); + } +} + +/*--------------------------------------------------------------------------*\ + * DMAENGINE operations +\*--------------------------------------------------------------------------*/ +static bool filter(struct dma_chan *chan, void *slave) +{ + struct at_dma_slave *sl = slave; + + if (sl->dma_dev == chan->device->dev) { + chan->private = sl; + return true; + } else { + return false; + } +} + +static int atmel_pcm_dma_alloc(struct snd_pcm_substream *substream, + struct snd_pcm_hw_params *params) +{ + struct snd_pcm_runtime *runtime = substream->runtime; + struct atmel_runtime_data *prtd = runtime->private_data; + struct ssc_device *ssc = prtd->params->ssc; + struct at_dma_slave *sdata = NULL; + + if (ssc->pdev) + sdata = ssc->pdev->dev.platform_data; + + if (sdata && sdata->dma_dev) { + dma_cap_mask_t mask; + + /* setup DMA addresses */ + sdata->rx_reg = (dma_addr_t)ssc->phybase + SSC_RHR; + sdata->tx_reg = (dma_addr_t)ssc->phybase + SSC_THR; + + /* Try to grab a DMA channel */ + dma_cap_zero(mask); + dma_cap_set(DMA_CYCLIC, mask); + prtd->dma_chan = dma_request_channel(mask, filter, sdata); + } + if (!prtd->dma_chan) { + pr_err("atmel-pcm: " + "DMA channel not available, unable to use SSC-audio\n"); + return -EBUSY; + } + + return 0; +} + +static void audio_dma_irq(void *data) +{ + struct snd_pcm_substream *substream = (struct snd_pcm_substream *)data; + struct snd_pcm_runtime *runtime = substream->runtime; + struct atmel_runtime_data *prtd = runtime->private_data; + + prtd->period_ptr += prtd->period_size; + if (prtd->period_ptr >= prtd->dma_buffer_end) + prtd->period_ptr = prtd->dma_buffer; + + snd_pcm_period_elapsed(substream); +} + +static void atmel_pcm_dma_slave_config(struct snd_pcm_substream *substream) +{ + struct snd_pcm_runtime *runtime = substream->runtime; + struct atmel_runtime_data *prtd = runtime->private_data; + struct dma_chan *chan = prtd->dma_chan; + struct dma_slave_config slave_config; + enum dma_slave_buswidth buswidth; + + switch (prtd->params->data_xfer_size) { + case 1: + buswidth = DMA_SLAVE_BUSWIDTH_1_BYTE; + break; + case 2: + buswidth = DMA_SLAVE_BUSWIDTH_2_BYTES; + break; + case 4: + buswidth = DMA_SLAVE_BUSWIDTH_4_BYTES; + break; + default: + return; + } + + if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { + slave_config.direction = DMA_TO_DEVICE; + slave_config.dst_addr_width = buswidth; + } else { + slave_config.direction = DMA_FROM_DEVICE; + slave_config.src_addr_width = buswidth; + } + + dmaengine_slave_config(chan, &slave_config); +} + +static int atmel_pcm_dma_prep(struct snd_pcm_substream *substream) +{ + struct snd_pcm_runtime *runtime = substream->runtime; + struct atmel_runtime_data *prtd = runtime->private_data; + struct dma_chan *chan = prtd->dma_chan; + + if (prtd->desc) + /* already been there: redo the prep job */ + dmaengine_terminate_all(chan); + + /* setup dma configuration */ + atmel_pcm_dma_slave_config(substream); + + prtd->desc = chan->device->device_prep_dma_cyclic(chan, prtd->dma_buffer, + prtd->period_size * prtd->periods, + prtd->period_size, + substream->stream == SNDRV_PCM_STREAM_PLAYBACK ? + DMA_TO_DEVICE : DMA_FROM_DEVICE); + if (!prtd->desc) { + dev_err(&chan->dev->device, "cannot prepare slave dma\n"); + return -EINVAL; + } + + prtd->desc->callback = audio_dma_irq; + prtd->desc->callback_param = substream; + + return 0; +} /*--------------------------------------------------------------------------*\ * PCM operations @@ -172,6 +349,7 @@ static int atmel_pcm_hw_params(struct snd_pcm_substream *substream, struct snd_pcm_runtime *runtime = substream->runtime; struct atmel_runtime_data *prtd = runtime->private_data; struct snd_soc_pcm_runtime *rtd = substream->private_data; + int ret; /* this may get called several times by oss emulation * with different params */ @@ -180,15 +358,35 @@ static int atmel_pcm_hw_params(struct snd_pcm_substream *substream, runtime->dma_bytes = params_buffer_bytes(params); prtd->params = snd_soc_dai_get_dma_data(rtd->cpu_dai, substream); - prtd->params->dma_intr_handler = atmel_pcm_dma_irq; prtd->dma_buffer = runtime->dma_addr; prtd->dma_buffer_end = runtime->dma_addr + runtime->dma_bytes; prtd->period_size = params_period_bytes(params); + prtd->periods = params_periods(params); + + if (ssc_use_dmaengine()) { + if (prtd->dma_chan == NULL) { + ret = atmel_pcm_dma_alloc(substream, params); + if (ret) + return ret; + } + ret = atmel_pcm_dma_prep(substream); + if (ret) { + dma_release_channel(prtd->dma_chan); + prtd->dma_chan = NULL; + return ret; + } + + prtd->params->dma_intr_handler = atmel_pcm_dma_irq; + } else { + prtd->params->dma_intr_handler = atmel_pcm_pdc_irq; + } pr_debug("atmel-pcm: " - "hw_params: DMA for %s initialized " + "hw_params: %s%s for %s initialized " "(dma_bytes=%u, period_size=%u)\n", + prtd->dma_chan ? "DMA " : "PDC", + prtd->dma_chan ? dma_chan_name(prtd->dma_chan): "", prtd->params->name, runtime->dma_bytes, prtd->period_size); @@ -201,15 +399,30 @@ static int atmel_pcm_hw_free(struct snd_pcm_substream *substream) struct atmel_pcm_dma_params *params = prtd->params; if (params != NULL) { - ssc_writex(params->ssc->regs, SSC_PDC_PTCR, - params->mask->pdc_disable); + if (ssc_use_dmaengine()) { + struct dma_chan *chan = prtd->dma_chan; + + if (chan) { + dmaengine_terminate_all(chan); + prtd->cookie = 0; + prtd->desc = NULL; + dma_release_channel(chan); + prtd->dma_chan = NULL; + } + } else { + ssc_writex(params->ssc->regs, SSC_PDC_PTCR, + params->mask->pdc_disable); + } prtd->params->dma_intr_handler = NULL; } return 0; } -static int atmel_pcm_prepare(struct snd_pcm_substream *substream) +/*--------------------------------------------------------------------------*\ + * PCM callbacks using PDC +\*--------------------------------------------------------------------------*/ +static int atmel_pcm_pdc_prepare(struct snd_pcm_substream *substream) { struct atmel_runtime_data *prtd = substream->runtime->private_data; struct atmel_pcm_dma_params *params = prtd->params; @@ -221,7 +434,7 @@ static int atmel_pcm_prepare(struct snd_pcm_substream *substream) return 0; } -static int atmel_pcm_trigger(struct snd_pcm_substream *substream, +static int atmel_pcm_pdc_trigger(struct snd_pcm_substream *substream, int cmd) { struct snd_pcm_runtime *rtd = substream->runtime; @@ -240,13 +453,13 @@ static int atmel_pcm_trigger(struct snd_pcm_substream *substream, ssc_writex(params->ssc->regs, params->pdc->xpr, prtd->period_ptr); ssc_writex(params->ssc->regs, params->pdc->xcr, - prtd->period_size / params->pdc_xfer_size); + prtd->period_size / params->data_xfer_size); prtd->period_ptr += prtd->period_size; ssc_writex(params->ssc->regs, params->pdc->xnpr, prtd->period_ptr); ssc_writex(params->ssc->regs, params->pdc->xncr, - prtd->period_size / params->pdc_xfer_size); + prtd->period_size / params->data_xfer_size); pr_debug("atmel-pcm: trigger: " "period_ptr=%lx, xpr=%u, " @@ -264,7 +477,7 @@ static int atmel_pcm_trigger(struct snd_pcm_substream *substream, pr_debug("sr=%u imr=%u\n", ssc_readx(params->ssc->regs, SSC_SR), - ssc_readx(params->ssc->regs, SSC_IER)); + ssc_readx(params->ssc->regs, SSC_IMR)); break; /* SNDRV_PCM_TRIGGER_START */ case SNDRV_PCM_TRIGGER_STOP: @@ -287,7 +500,7 @@ static int atmel_pcm_trigger(struct snd_pcm_substream *substream, return ret; } -static snd_pcm_uframes_t atmel_pcm_pointer( +static snd_pcm_uframes_t atmel_pcm_pdc_pointer( struct snd_pcm_substream *substream) { struct snd_pcm_runtime *runtime = substream->runtime; @@ -305,13 +518,107 @@ static snd_pcm_uframes_t atmel_pcm_pointer( return x; } +/*--------------------------------------------------------------------------*\ + * PCM callbacks using DMAENGINE +\*--------------------------------------------------------------------------*/ +static int atmel_pcm_dma_prepare(struct snd_pcm_substream *substream) +{ + struct atmel_runtime_data *prtd = substream->runtime->private_data; + struct atmel_pcm_dma_params *params = prtd->params; + + ssc_writex(params->ssc->regs, SSC_IDR, params->mask->ssc_error); + return 0; +} + +static int atmel_pcm_dma_trigger(struct snd_pcm_substream *substream, + int cmd) +{ + struct snd_pcm_runtime *rtd = substream->runtime; + struct atmel_runtime_data *prtd = rtd->private_data; + struct atmel_pcm_dma_params *params = prtd->params; + dma_cookie_t cookie; + int ret = 0; + + pr_debug("atmel-pcm: trigger %d: buffer_size = %ld," + " dma_area = %p, dma_bytes = %u\n", + cmd, rtd->buffer_size, rtd->dma_area, rtd->dma_bytes); + + switch (cmd) { + case SNDRV_PCM_TRIGGER_START: + + if (prtd->cookie < DMA_MIN_COOKIE) { + cookie = dmaengine_submit(prtd->desc); + if (dma_submit_error(cookie)) { + ret = -EINVAL; + break; + } + prtd->cookie = cookie; + prtd->period_ptr = prtd->dma_buffer; + } + + + pr_debug("atmel-pcm: trigger: start sr=0x%08x imr=0x%08u\n", + ssc_readx(params->ssc->regs, SSC_SR), + ssc_readx(params->ssc->regs, SSC_IMR)); + + /* fallback */ + case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: + case SNDRV_PCM_TRIGGER_RESUME: + dmaengine_resume(prtd->dma_chan); + + /* It not already done or comming from xrun state */ + ssc_readx(params->ssc->regs, SSC_SR); + ssc_writex(params->ssc->regs, SSC_IER, params->mask->ssc_error); + ssc_writex(params->ssc->regs, SSC_CR, params->mask->ssc_enable); + + break; + case SNDRV_PCM_TRIGGER_STOP: + pr_debug("atmel-pcm: trigger: stop cmd = %d\n", cmd); + + ssc_writex(params->ssc->regs, SSC_IDR, params->mask->ssc_error); + + /* fallback */ + case SNDRV_PCM_TRIGGER_PAUSE_PUSH: + case SNDRV_PCM_TRIGGER_SUSPEND: + dmaengine_pause(prtd->dma_chan); + break; + default: + ret = -EINVAL; + } + + return ret; +} + +static snd_pcm_uframes_t atmel_pcm_dma_pointer( + struct snd_pcm_substream *substream) +{ + struct snd_pcm_runtime *runtime = substream->runtime; + struct atmel_runtime_data *prtd = runtime->private_data; + snd_pcm_uframes_t x; + + dev_vdbg(substream->pcm->card->dev, "%s: 0x%08x %ld\n", + __func__, prtd->period_ptr, + bytes_to_frames(runtime, prtd->period_ptr - prtd->dma_buffer)); + + x = bytes_to_frames(runtime, prtd->period_ptr - prtd->dma_buffer); + + if (x >= runtime->buffer_size) + x = 0; + + return x; +} + + +/*--------------------------------------------------------------------------*\ + * PCM open/close/mmap +\*--------------------------------------------------------------------------*/ static int atmel_pcm_open(struct snd_pcm_substream *substream) { struct snd_pcm_runtime *runtime = substream->runtime; struct atmel_runtime_data *prtd; int ret = 0; - snd_soc_set_runtime_hwparams(substream, &atmel_pcm_hardware); + snd_soc_set_runtime_hwparams(substream, atmel_pcm_hardware); /* ensure that buffer size is a multiple of period size */ ret = snd_pcm_hw_constraint_integer(runtime, @@ -352,9 +659,9 @@ static struct snd_pcm_ops atmel_pcm_ops = { .ioctl = snd_pcm_lib_ioctl, .hw_params = atmel_pcm_hw_params, .hw_free = atmel_pcm_hw_free, - .prepare = atmel_pcm_prepare, - .trigger = atmel_pcm_trigger, - .pointer = atmel_pcm_pointer, + .prepare = atmel_pcm_pdc_prepare, + .trigger = atmel_pcm_pdc_trigger, + .pointer = atmel_pcm_pdc_pointer, .mmap = atmel_pcm_mmap, }; @@ -426,14 +733,16 @@ static int atmel_pcm_suspend(struct snd_soc_dai *dai) prtd = runtime->private_data; params = prtd->params; - /* disable the PDC and save the PDC registers */ + if (!ssc_use_dmaengine()) { + /* disable the PDC and save the PDC registers */ - ssc_writel(params->ssc->regs, PDC_PTCR, params->mask->pdc_disable); + ssc_writel(params->ssc->regs, PDC_PTCR, params->mask->pdc_disable); - prtd->pdc_xpr_save = ssc_readx(params->ssc->regs, params->pdc->xpr); - prtd->pdc_xcr_save = ssc_readx(params->ssc->regs, params->pdc->xcr); - prtd->pdc_xnpr_save = ssc_readx(params->ssc->regs, params->pdc->xnpr); - prtd->pdc_xncr_save = ssc_readx(params->ssc->regs, params->pdc->xncr); + prtd->pdc_xpr_save = ssc_readx(params->ssc->regs, params->pdc->xpr); + prtd->pdc_xcr_save = ssc_readx(params->ssc->regs, params->pdc->xcr); + prtd->pdc_xnpr_save = ssc_readx(params->ssc->regs, params->pdc->xnpr); + prtd->pdc_xncr_save = ssc_readx(params->ssc->regs, params->pdc->xncr); + } return 0; } @@ -450,13 +759,15 @@ static int atmel_pcm_resume(struct snd_soc_dai *dai) prtd = runtime->private_data; params = prtd->params; - /* restore the PDC registers and enable the PDC */ - ssc_writex(params->ssc->regs, params->pdc->xpr, prtd->pdc_xpr_save); - ssc_writex(params->ssc->regs, params->pdc->xcr, prtd->pdc_xcr_save); - ssc_writex(params->ssc->regs, params->pdc->xnpr, prtd->pdc_xnpr_save); - ssc_writex(params->ssc->regs, params->pdc->xncr, prtd->pdc_xncr_save); + if (!ssc_use_dmaengine()) { + /* restore the PDC registers and enable the PDC */ + ssc_writex(params->ssc->regs, params->pdc->xpr, prtd->pdc_xpr_save); + ssc_writex(params->ssc->regs, params->pdc->xcr, prtd->pdc_xcr_save); + ssc_writex(params->ssc->regs, params->pdc->xnpr, prtd->pdc_xnpr_save); + ssc_writex(params->ssc->regs, params->pdc->xncr, prtd->pdc_xncr_save); - ssc_writel(params->ssc->regs, PDC_PTCR, params->mask->pdc_enable); + ssc_writel(params->ssc->regs, PDC_PTCR, params->mask->pdc_enable); + } return 0; } #else @@ -495,6 +806,15 @@ static struct platform_driver atmel_pcm_driver = { static int __init snd_atmel_pcm_init(void) { + if (ssc_use_dmaengine()) { + atmel_pcm_ops.prepare = atmel_pcm_dma_prepare; + atmel_pcm_ops.trigger = atmel_pcm_dma_trigger; + atmel_pcm_ops.pointer = atmel_pcm_dma_pointer; + + atmel_pcm_hardware = &atmel_pcm_dma_hardware; + } else { + atmel_pcm_hardware = &atmel_pcm_pdc_hardware; + } return platform_driver_register(&atmel_pcm_driver); } module_init(snd_atmel_pcm_init); diff --git a/sound/soc/atmel/atmel-pcm.h b/sound/soc/atmel/atmel-pcm.h index 5e0a95e..b007376 100644 --- a/sound/soc/atmel/atmel-pcm.h +++ b/sound/soc/atmel/atmel-pcm.h @@ -50,6 +50,7 @@ struct atmel_pdc_regs { struct atmel_ssc_mask { u32 ssc_enable; /* SSC recv/trans enable */ u32 ssc_disable; /* SSC recv/trans disable */ + u32 ssc_error; /* SSC error conditions */ u32 ssc_endx; /* SSC ENDTX or ENDRX */ u32 ssc_endbuf; /* SSC TXBUFE or RXBUFF */ u32 pdc_enable; /* PDC recv/trans enable */ @@ -66,7 +67,8 @@ struct atmel_ssc_mask { */ struct atmel_pcm_dma_params { char *name; /* stream identifier */ - int pdc_xfer_size; /* PDC counter increment in bytes */ + int data_xfer_size; /* PDC counter increment in bytes, + DMA data transfer size in bytes */ struct ssc_device *ssc; /* SSC device for stream */ struct atmel_pdc_regs *pdc; /* PDC receive or transmit registers */ struct atmel_ssc_mask *mask; /* SSC & PDC status bits */ diff --git a/sound/soc/atmel/atmel_ssc_dai.c b/sound/soc/atmel/atmel_ssc_dai.c index a7a7bbc..9412fc3 100644 --- a/sound/soc/atmel/atmel_ssc_dai.c +++ b/sound/soc/atmel/atmel_ssc_dai.c @@ -48,7 +48,8 @@ #include "atmel_ssc_dai.h" -#if defined(CONFIG_ARCH_AT91SAM9260) || defined(CONFIG_ARCH_AT91SAM9G20) +#if defined(CONFIG_ARCH_AT91SAM9260) || defined(CONFIG_ARCH_AT91SAM9G20) \ + || defined(CONFIG_ARCH_AT91SAM9X5) #define NUM_SSC_DEVICES 1 #else #define NUM_SSC_DEVICES 3 @@ -86,6 +87,7 @@ static struct atmel_ssc_mask ssc_tx_mask = { static struct atmel_ssc_mask ssc_rx_mask = { .ssc_enable = SSC_BIT(CR_RXEN), .ssc_disable = SSC_BIT(CR_RXDIS), + .ssc_error = SSC_BIT(SR_OVRUN), .ssc_endx = SSC_BIT(SR_ENDRX), .ssc_endbuf = SSC_BIT(SR_RXBUFF), .pdc_enable = ATMEL_PDC_RXTEN, @@ -183,7 +185,8 @@ static irqreturn_t atmel_ssc_interrupt(int irq, void *dev_id) if ((dma_params != NULL) && (dma_params->dma_intr_handler != NULL)) { ssc_substream_mask = (dma_params->mask->ssc_endx | - dma_params->mask->ssc_endbuf); + dma_params->mask->ssc_endbuf | + dma_params->mask->ssc_error); if (ssc_sr & ssc_substream_mask) { dma_params->dma_intr_handler(ssc_sr, dma_params-> @@ -376,19 +379,19 @@ static int atmel_ssc_hw_params(struct snd_pcm_substream *substream, switch (params_format(params)) { case SNDRV_PCM_FORMAT_S8: bits = 8; - dma_params->pdc_xfer_size = 1; + dma_params->data_xfer_size = 1; break; case SNDRV_PCM_FORMAT_S16_LE: bits = 16; - dma_params->pdc_xfer_size = 2; + dma_params->data_xfer_size = 2; break; case SNDRV_PCM_FORMAT_S24_LE: bits = 24; - dma_params->pdc_xfer_size = 4; + dma_params->data_xfer_size = 4; break; case SNDRV_PCM_FORMAT_S32_LE: bits = 32; - dma_params->pdc_xfer_size = 4; + dma_params->data_xfer_size = 4; break; default: printk(KERN_WARNING "atmel_ssc_dai: unsupported PCM format"); @@ -561,15 +564,17 @@ static int atmel_ssc_hw_params(struct snd_pcm_substream *substream, /* Reset the SSC and its PDC registers */ ssc_writel(ssc_p->ssc->regs, CR, SSC_BIT(CR_SWRST)); - ssc_writel(ssc_p->ssc->regs, PDC_RPR, 0); - ssc_writel(ssc_p->ssc->regs, PDC_RCR, 0); - ssc_writel(ssc_p->ssc->regs, PDC_RNPR, 0); - ssc_writel(ssc_p->ssc->regs, PDC_RNCR, 0); + if (!ssc_use_dmaengine()) { + ssc_writel(ssc_p->ssc->regs, PDC_RPR, 0); + ssc_writel(ssc_p->ssc->regs, PDC_RCR, 0); + ssc_writel(ssc_p->ssc->regs, PDC_RNPR, 0); + ssc_writel(ssc_p->ssc->regs, PDC_RNCR, 0); - ssc_writel(ssc_p->ssc->regs, PDC_TPR, 0); - ssc_writel(ssc_p->ssc->regs, PDC_TCR, 0); - ssc_writel(ssc_p->ssc->regs, PDC_TNPR, 0); - ssc_writel(ssc_p->ssc->regs, PDC_TNCR, 0); + ssc_writel(ssc_p->ssc->regs, PDC_TPR, 0); + ssc_writel(ssc_p->ssc->regs, PDC_TCR, 0); + ssc_writel(ssc_p->ssc->regs, PDC_TNPR, 0); + ssc_writel(ssc_p->ssc->regs, PDC_TNCR, 0); + } ret = request_irq(ssc_p->ssc->irq, atmel_ssc_interrupt, 0, ssc_p->name, ssc_p);