Commit 180346ed authored by Kuninori Morimoto's avatar Kuninori Morimoto Committed by Mark Brown

ASoC: fsi: add .start_stop handler to fsi_stream_handler

Signed-off-by: default avatarKuninori Morimoto <kuninori.morimoto.gx@renesas.com>
Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
parent 938e2a8d
...@@ -203,6 +203,8 @@ struct fsi_stream_handler { ...@@ -203,6 +203,8 @@ struct fsi_stream_handler {
int (*probe)(struct fsi_priv *fsi, struct fsi_stream *io); int (*probe)(struct fsi_priv *fsi, struct fsi_stream *io);
int (*transfer)(struct fsi_priv *fsi, struct fsi_stream *io); int (*transfer)(struct fsi_priv *fsi, struct fsi_stream *io);
int (*remove)(struct fsi_priv *fsi, struct fsi_stream *io); int (*remove)(struct fsi_priv *fsi, struct fsi_stream *io);
void (*start_stop)(struct fsi_priv *fsi, struct fsi_stream *io,
int enable);
}; };
#define fsi_stream_handler_call(io, func, args...) \ #define fsi_stream_handler_call(io, func, args...) \
(!(io) ? -ENODEV : \ (!(io) ? -ENODEV : \
...@@ -513,6 +515,12 @@ static int fsi_stream_transfer(struct fsi_stream *io) ...@@ -513,6 +515,12 @@ static int fsi_stream_transfer(struct fsi_stream *io)
return fsi_stream_handler_call(io, transfer, fsi, io); return fsi_stream_handler_call(io, transfer, fsi, io);
} }
#define fsi_stream_start(fsi, io)\
fsi_stream_handler_call(io, start_stop, fsi, io, 1)
#define fsi_stream_stop(fsi, io)\
fsi_stream_handler_call(io, start_stop, fsi, io, 0)
static int fsi_stream_probe(struct fsi_priv *fsi) static int fsi_stream_probe(struct fsi_priv *fsi)
{ {
struct fsi_stream *io; struct fsi_stream *io;
...@@ -691,24 +699,6 @@ static int fsi_set_master_clk(struct device *dev, struct fsi_priv *fsi, ...@@ -691,24 +699,6 @@ static int fsi_set_master_clk(struct device *dev, struct fsi_priv *fsi,
return ret; return ret;
} }
#define fsi_port_start(f, i) __fsi_port_clk_ctrl(f, i, 1)
#define fsi_port_stop(f, i) __fsi_port_clk_ctrl(f, i, 0)
static void __fsi_port_clk_ctrl(struct fsi_priv *fsi, struct fsi_stream *io,
int enable)
{
struct fsi_master *master = fsi_get_master(fsi);
u32 clk = fsi_is_port_a(fsi) ? CRA : CRB;
if (enable)
fsi_irq_enable(fsi, io);
else
fsi_irq_disable(fsi, io);
if (fsi_is_clk_master(fsi))
fsi_master_mask_set(master, CLK_RST, clk, (enable) ? clk : 0);
}
/* /*
* pio data transfer handler * pio data transfer handler
*/ */
...@@ -845,12 +835,29 @@ static int fsi_pio_push(struct fsi_priv *fsi, struct fsi_stream *io) ...@@ -845,12 +835,29 @@ static int fsi_pio_push(struct fsi_priv *fsi, struct fsi_stream *io)
samples); samples);
} }
static void fsi_pio_start_stop(struct fsi_priv *fsi, struct fsi_stream *io,
int enable)
{
struct fsi_master *master = fsi_get_master(fsi);
u32 clk = fsi_is_port_a(fsi) ? CRA : CRB;
if (enable)
fsi_irq_enable(fsi, io);
else
fsi_irq_disable(fsi, io);
if (fsi_is_clk_master(fsi))
fsi_master_mask_set(master, CLK_RST, clk, (enable) ? clk : 0);
}
static struct fsi_stream_handler fsi_pio_push_handler = { static struct fsi_stream_handler fsi_pio_push_handler = {
.transfer = fsi_pio_push, .transfer = fsi_pio_push,
.start_stop = fsi_pio_start_stop,
}; };
static struct fsi_stream_handler fsi_pio_pop_handler = { static struct fsi_stream_handler fsi_pio_pop_handler = {
.transfer = fsi_pio_pop, .transfer = fsi_pio_pop,
.start_stop = fsi_pio_start_stop,
}; };
static irqreturn_t fsi_interrupt(int irq, void *data) static irqreturn_t fsi_interrupt(int irq, void *data)
...@@ -1033,10 +1040,10 @@ static int fsi_dai_trigger(struct snd_pcm_substream *substream, int cmd, ...@@ -1033,10 +1040,10 @@ static int fsi_dai_trigger(struct snd_pcm_substream *substream, int cmd,
fsi_stream_init(fsi, io, substream); fsi_stream_init(fsi, io, substream);
ret = fsi_stream_transfer(io); ret = fsi_stream_transfer(io);
if (0 == ret) if (0 == ret)
fsi_port_start(fsi, io); fsi_stream_start(fsi, io);
break; break;
case SNDRV_PCM_TRIGGER_STOP: case SNDRV_PCM_TRIGGER_STOP:
fsi_port_stop(fsi, io); fsi_stream_stop(fsi, io);
fsi_stream_quit(fsi, io); fsi_stream_quit(fsi, io);
break; break;
} }
...@@ -1436,7 +1443,7 @@ static void __fsi_suspend(struct fsi_priv *fsi, ...@@ -1436,7 +1443,7 @@ static void __fsi_suspend(struct fsi_priv *fsi,
if (!fsi_stream_is_working(fsi, io)) if (!fsi_stream_is_working(fsi, io))
return; return;
fsi_port_stop(fsi, io); fsi_stream_stop(fsi, io);
fsi_hw_shutdown(fsi, dev); fsi_hw_shutdown(fsi, dev);
} }
...@@ -1452,7 +1459,7 @@ static void __fsi_resume(struct fsi_priv *fsi, ...@@ -1452,7 +1459,7 @@ static void __fsi_resume(struct fsi_priv *fsi,
if (fsi_is_clk_master(fsi) && fsi->rate) if (fsi_is_clk_master(fsi) && fsi->rate)
fsi_set_master_clk(dev, fsi, fsi->rate, 1); fsi_set_master_clk(dev, fsi, fsi->rate, 1);
fsi_port_start(fsi, io); fsi_stream_start(fsi, io);
} }
static int fsi_suspend(struct device *dev) static int fsi_suspend(struct device *dev)
......
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