Commit 8f159d72 authored by Grant Likely's avatar Grant Likely Committed by Mark Brown

ASoC/mpc5200: Track DMA position by period number instead of bytes

All DMA blocks are lined up to period boundaries, but the DMA
handling code tracks bytes instead.  This patch reworks the code
to track the period index into the DMA buffer instead of the
physical address pointer.  Doing so makes the code simpler and
easier to understand.
Signed-off-by: default avatarGrant Likely <grant.likely@secretlab.ca>
Acked-by: default avatarLiam Girdwood <lrg@slimlogic.co.uk>
Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
parent 4cae37fa
...@@ -58,13 +58,11 @@ static void psc_dma_bcom_enqueue_next_buffer(struct psc_dma_stream *s) ...@@ -58,13 +58,11 @@ static void psc_dma_bcom_enqueue_next_buffer(struct psc_dma_stream *s)
/* Prepare and enqueue the next buffer descriptor */ /* Prepare and enqueue the next buffer descriptor */
bd = bcom_prepare_next_buffer(s->bcom_task); bd = bcom_prepare_next_buffer(s->bcom_task);
bd->status = s->period_bytes; bd->status = s->period_bytes;
bd->data[0] = s->period_next_pt; bd->data[0] = s->runtime->dma_addr + (s->period_next * s->period_bytes);
bcom_submit_next_buffer(s->bcom_task, NULL); bcom_submit_next_buffer(s->bcom_task, NULL);
/* Update for next period */ /* Update for next period */
s->period_next_pt += s->period_bytes; s->period_next = (s->period_next + 1) % s->runtime->periods;
if (s->period_next_pt >= s->period_end)
s->period_next_pt = s->period_start;
} }
static void psc_dma_bcom_enqueue_tx(struct psc_dma_stream *s) static void psc_dma_bcom_enqueue_tx(struct psc_dma_stream *s)
...@@ -79,7 +77,7 @@ static void psc_dma_bcom_enqueue_tx(struct psc_dma_stream *s) ...@@ -79,7 +77,7 @@ static void psc_dma_bcom_enqueue_tx(struct psc_dma_stream *s)
if (bcom_queue_full(s->bcom_task)) if (bcom_queue_full(s->bcom_task))
return; return;
s->appl_ptr += s->period_size; s->appl_ptr += s->runtime->period_size;
psc_dma_bcom_enqueue_next_buffer(s); psc_dma_bcom_enqueue_next_buffer(s);
} }
...@@ -91,7 +89,7 @@ static void psc_dma_bcom_enqueue_tx(struct psc_dma_stream *s) ...@@ -91,7 +89,7 @@ static void psc_dma_bcom_enqueue_tx(struct psc_dma_stream *s)
if (bcom_queue_full(s->bcom_task)) if (bcom_queue_full(s->bcom_task))
return; return;
s->appl_ptr += s->period_size; s->appl_ptr += s->runtime->period_size;
psc_dma_bcom_enqueue_next_buffer(s); psc_dma_bcom_enqueue_next_buffer(s);
} }
...@@ -108,9 +106,7 @@ static irqreturn_t psc_dma_bcom_irq_tx(int irq, void *_psc_dma_stream) ...@@ -108,9 +106,7 @@ static irqreturn_t psc_dma_bcom_irq_tx(int irq, void *_psc_dma_stream)
while (bcom_buffer_done(s->bcom_task)) { while (bcom_buffer_done(s->bcom_task)) {
bcom_retrieve_buffer(s->bcom_task, NULL, NULL); bcom_retrieve_buffer(s->bcom_task, NULL, NULL);
s->period_current_pt += s->period_bytes; s->period_current = (s->period_current+1) % s->runtime->periods;
if (s->period_current_pt >= s->period_end)
s->period_current_pt = s->period_start;
} }
psc_dma_bcom_enqueue_tx(s); psc_dma_bcom_enqueue_tx(s);
spin_unlock(&s->psc_dma->lock); spin_unlock(&s->psc_dma->lock);
...@@ -133,9 +129,7 @@ static irqreturn_t psc_dma_bcom_irq_rx(int irq, void *_psc_dma_stream) ...@@ -133,9 +129,7 @@ static irqreturn_t psc_dma_bcom_irq_rx(int irq, void *_psc_dma_stream)
while (bcom_buffer_done(s->bcom_task)) { while (bcom_buffer_done(s->bcom_task)) {
bcom_retrieve_buffer(s->bcom_task, NULL, NULL); bcom_retrieve_buffer(s->bcom_task, NULL, NULL);
s->period_current_pt += s->period_bytes; s->period_current = (s->period_current+1) % s->runtime->periods;
if (s->period_current_pt >= s->period_end)
s->period_current_pt = s->period_start;
psc_dma_bcom_enqueue_next_buffer(s); psc_dma_bcom_enqueue_next_buffer(s);
} }
...@@ -185,12 +179,8 @@ static int psc_dma_trigger(struct snd_pcm_substream *substream, int cmd) ...@@ -185,12 +179,8 @@ static int psc_dma_trigger(struct snd_pcm_substream *substream, int cmd)
case SNDRV_PCM_TRIGGER_START: case SNDRV_PCM_TRIGGER_START:
s->period_bytes = frames_to_bytes(runtime, s->period_bytes = frames_to_bytes(runtime,
runtime->period_size); runtime->period_size);
s->period_start = virt_to_phys(runtime->dma_area); s->period_next = 0;
s->period_end = s->period_start + s->period_current = 0;
(s->period_bytes * runtime->periods);
s->period_next_pt = s->period_start;
s->period_current_pt = s->period_start;
s->period_size = runtime->period_size;
s->active = 1; s->active = 1;
/* track appl_ptr so that we have a better chance of detecting /* track appl_ptr so that we have a better chance of detecting
...@@ -343,7 +333,7 @@ psc_dma_pointer(struct snd_pcm_substream *substream) ...@@ -343,7 +333,7 @@ psc_dma_pointer(struct snd_pcm_substream *substream)
else else
s = &psc_dma->playback; s = &psc_dma->playback;
count = s->period_current_pt - s->period_start; count = s->period_current * s->period_bytes;
return bytes_to_frames(substream->runtime, count); return bytes_to_frames(substream->runtime, count);
} }
......
...@@ -13,7 +13,6 @@ ...@@ -13,7 +13,6 @@
* @psc_dma: pointer back to parent psc_dma data structure * @psc_dma: pointer back to parent psc_dma data structure
* @bcom_task: bestcomm task structure * @bcom_task: bestcomm task structure
* @irq: irq number for bestcomm task * @irq: irq number for bestcomm task
* @period_start: physical address of start of DMA region
* @period_end: physical address of end of DMA region * @period_end: physical address of end of DMA region
* @period_next_pt: physical address of next DMA buffer to enqueue * @period_next_pt: physical address of next DMA buffer to enqueue
* @period_bytes: size of DMA period in bytes * @period_bytes: size of DMA period in bytes
...@@ -27,12 +26,9 @@ struct psc_dma_stream { ...@@ -27,12 +26,9 @@ struct psc_dma_stream {
struct bcom_task *bcom_task; struct bcom_task *bcom_task;
int irq; int irq;
struct snd_pcm_substream *stream; struct snd_pcm_substream *stream;
dma_addr_t period_start; int period_next;
dma_addr_t period_end; int period_current;
dma_addr_t period_next_pt;
dma_addr_t period_current_pt;
int period_bytes; int period_bytes;
int period_size;
}; };
/** /**
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment