Commit 95b0cf05 authored by Kuninori Morimoto's avatar Kuninori Morimoto Committed by Mark Brown

ASoC: fsi: modify fsi_pio_get_area() parameter and using position

This patch modify fsi_pio_get_area() parameter to use
struct fsi_stream, and used it on fsi_fifo_data_ctrl().
This is just prepare cleanup for DMAEngine support.
Signed-off-by: default avatarKuninori Morimoto <kuninori.morimoto.gx@renesas.com>
Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
parent 8c415295
...@@ -477,58 +477,46 @@ static void fsi_stream_quit(struct fsi_priv *fsi, int is_play) ...@@ -477,58 +477,46 @@ static void fsi_stream_quit(struct fsi_priv *fsi, int is_play)
* pio function * pio function
*/ */
static u8 *fsi_pio_get_area(struct fsi_priv *fsi, int stream) static u8 *fsi_pio_get_area(struct fsi_priv *fsi, struct fsi_stream *io)
{ {
int is_play = fsi_stream_is_play(stream);
struct fsi_stream *io = fsi_stream_get(fsi, is_play);
struct snd_pcm_runtime *runtime = io->substream->runtime; struct snd_pcm_runtime *runtime = io->substream->runtime;
return runtime->dma_area + return runtime->dma_area +
samples_to_bytes(runtime, io->buff_sample_pos); samples_to_bytes(runtime, io->buff_sample_pos);
} }
static void fsi_pio_push16(struct fsi_priv *fsi, int num) static void fsi_pio_push16(struct fsi_priv *fsi, u8 *_buf, int num)
{ {
u16 *start; u16 *start = (u16 *)_buf;
int i; int i;
start = (u16 *)fsi_pio_get_area(fsi, SNDRV_PCM_STREAM_PLAYBACK);
for (i = 0; i < num; i++) for (i = 0; i < num; i++)
fsi_reg_write(fsi, DODT, ((u32)*(start + i) << 8)); fsi_reg_write(fsi, DODT, ((u32)*(start + i) << 8));
} }
static void fsi_pio_pop16(struct fsi_priv *fsi, int num) static void fsi_pio_pop16(struct fsi_priv *fsi, u8 *_buf, int num)
{ {
u16 *start; u16 *start = (u16 *)_buf;
int i; int i;
start = (u16 *)fsi_pio_get_area(fsi, SNDRV_PCM_STREAM_CAPTURE);
for (i = 0; i < num; i++) for (i = 0; i < num; i++)
*(start + i) = (u16)(fsi_reg_read(fsi, DIDT) >> 8); *(start + i) = (u16)(fsi_reg_read(fsi, DIDT) >> 8);
} }
static void fsi_pio_push32(struct fsi_priv *fsi, int num) static void fsi_pio_push32(struct fsi_priv *fsi, u8 *_buf, int num)
{ {
u32 *start; u32 *start = (u32 *)_buf;
int i; int i;
start = (u32 *)fsi_pio_get_area(fsi, SNDRV_PCM_STREAM_PLAYBACK);
for (i = 0; i < num; i++) for (i = 0; i < num; i++)
fsi_reg_write(fsi, DODT, *(start + i)); fsi_reg_write(fsi, DODT, *(start + i));
} }
static void fsi_pio_pop32(struct fsi_priv *fsi, int num) static void fsi_pio_pop32(struct fsi_priv *fsi, u8 *_buf, int num)
{ {
u32 *start; u32 *start = (u32 *)_buf;
int i; int i;
start = (u32 *)fsi_pio_get_area(fsi, SNDRV_PCM_STREAM_CAPTURE);
for (i = 0; i < num; i++) for (i = 0; i < num; i++)
*(start + i) = fsi_reg_read(fsi, DIDT); *(start + i) = fsi_reg_read(fsi, DIDT);
} }
...@@ -693,12 +681,13 @@ static void __fsi_port_clk_ctrl(struct fsi_priv *fsi, int is_play, int enable) ...@@ -693,12 +681,13 @@ static void __fsi_port_clk_ctrl(struct fsi_priv *fsi, int is_play, int enable)
* ctrl function * ctrl function
*/ */
static int fsi_fifo_data_ctrl(struct fsi_priv *fsi, struct fsi_stream *io, static int fsi_fifo_data_ctrl(struct fsi_priv *fsi, struct fsi_stream *io,
void (*run16)(struct fsi_priv *fsi, int size), void (*run16)(struct fsi_priv *fsi, u8 *buf, int samples),
void (*run32)(struct fsi_priv *fsi, int size), void (*run32)(struct fsi_priv *fsi, u8 *buf, int samples),
int samples) int samples)
{ {
struct snd_pcm_runtime *runtime; struct snd_pcm_runtime *runtime;
struct snd_pcm_substream *substream; struct snd_pcm_substream *substream;
u8 *buf;
int over_period; int over_period;
if (!fsi || if (!fsi ||
...@@ -723,12 +712,14 @@ static int fsi_fifo_data_ctrl(struct fsi_priv *fsi, struct fsi_stream *io, ...@@ -723,12 +712,14 @@ static int fsi_fifo_data_ctrl(struct fsi_priv *fsi, struct fsi_stream *io,
io->buff_sample_pos = 0; io->buff_sample_pos = 0;
} }
buf = fsi_pio_get_area(fsi, io);
switch (io->sample_width) { switch (io->sample_width) {
case 2: case 2:
run16(fsi, samples); run16(fsi, buf, samples);
break; break;
case 4: case 4:
run32(fsi, samples); run32(fsi, buf, samples);
break; break;
default: default:
return -EINVAL; return -EINVAL;
......
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