ASoC: fsi: Add over/under run error settlement

Signed-off-by: Kuninori Morimoto <morimoto.kuninori@renesas.com>
Acked-by: Liam Girdwood <lrg@slimlogic.co.uk>
Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>

diff --git a/sound/soc/sh/fsi.c b/sound/soc/sh/fsi.c
index d078151e1de6fdcbe8adc6699fa64581b2712c9f..123cd6f45e0c093ca60a30df2beffbff5830539a 100644 (file)
--- a/sound/soc/sh/fsi.c
+++ b/sound/soc/sh/fsi.c
@@ -67,6 +67,7 @@
 /* DOFF_ST */
 #define ERR_OVER       0x00000010
 #define ERR_UNDER      0x00000001
+#define ST_ERR         (ERR_OVER | ERR_UNDER)
 
 /* CLK_RST */
 #define B_CLK          0x00000010
@@ -375,11 +376,12 @@ static int fsi_data_push(struct fsi_priv *fsi)
 {
        struct snd_pcm_runtime *runtime;
        struct snd_pcm_substream *substream = NULL;
+       u32 status;
        int send;
        int fifo_free;
        int width;
        u8 *start;
-       int i, over_period;
+       int i, ret, over_period;
 
        if (!fsi                        ||
            !fsi->substream             ||
@@ -435,23 +437,33 @@ static int fsi_data_push(struct fsi_priv *fsi)
 
        fsi->byte_offset += send * width;
 
+       ret = 0;
+       status = fsi_reg_read(fsi, DOFF_ST);
+       if (status & ERR_OVER) {
+               struct snd_soc_dai *dai = fsi_get_dai(substream);
+               dev_err(dai->dev, "over run error\n");
+               fsi_reg_write(fsi, DOFF_ST, status & ~ST_ERR);
+               ret = -EIO;
+       }
+
        fsi_irq_enable(fsi, 1);
 
        if (over_period)
                snd_pcm_period_elapsed(substream);
 
-       return 0;
+       return ret;
 }
 
 static int fsi_data_pop(struct fsi_priv *fsi)
 {
        struct snd_pcm_runtime *runtime;
        struct snd_pcm_substream *substream = NULL;
+       u32 status;
        int free;
        int fifo_fill;
        int width;
        u8 *start;
-       int i, over_period;
+       int i, ret, over_period;
 
        if (!fsi                        ||
            !fsi->substream             ||
@@ -506,12 +518,21 @@ static int fsi_data_pop(struct fsi_priv *fsi)
 
        fsi->byte_offset += fifo_fill * width;
 
+       ret = 0;
+       status = fsi_reg_read(fsi, DIFF_ST);
+       if (status & ERR_UNDER) {
+               struct snd_soc_dai *dai = fsi_get_dai(substream);
+               dev_err(dai->dev, "under run error\n");
+               fsi_reg_write(fsi, DIFF_ST, status & ~ST_ERR);
+               ret = -EIO;
+       }
+
        fsi_irq_enable(fsi, 0);
 
        if (over_period)
                snd_pcm_period_elapsed(substream);
 
-       return 0;
+       return ret;
 }
 
 static irqreturn_t fsi_interrupt(int irq, void *data)