ASoC: sh: Add RZ/G2L SSIF-2 driver
authorBiju Das <biju.das.jz@bp.renesas.com>
Fri, 13 Aug 2021 09:11:54 +0000 (10:11 +0100)
committerMark Brown <broonie@kernel.org>
Fri, 13 Aug 2021 12:17:16 +0000 (13:17 +0100)
Add serial sound interface(SSIF-2) driver support for
RZ/G2L SoC.

Based on the work done by Chris Brandt for RZ/A SSI driver.

Signed-off-by: Biju Das <biju.das.jz@bp.renesas.com>
Reviewed-by: Lad Prabhakar <prabhakar.mahadev-lad.rj@bp.renesas.com>
Link: https://lore.kernel.org/r/20210813091156.10700-2-biju.das.jz@bp.renesas.com
Signed-off-by: Mark Brown <broonie@kernel.org>
sound/soc/sh/Kconfig
sound/soc/sh/Makefile
sound/soc/sh/rz-ssi.c [new file with mode: 0644]

index 346c806ba390c170c3f1a305b3175dd71dbc7ac5..ae46f187cc2aa588c66add8a8cb2fd90326582e6 100644 (file)
@@ -45,6 +45,12 @@ config SND_SOC_RCAR
        help
          This option enables R-Car SRU/SCU/SSIU/SSI sound support
 
+config SND_SOC_RZ
+       tristate "RZ/G2L series SSIF-2 support"
+       depends on ARCH_R9A07G044 || COMPILE_TEST
+       help
+         This option enables RZ/G2L SSIF-2 sound support.
+
 ##
 ## Boards
 ##
index 51bd7c81671c4a35b29a51024140b4a7297ce3b4..f6fd79948f6ae93f3219d10fe7efc758a2d83d44 100644 (file)
@@ -22,3 +22,7 @@ snd-soc-migor-objs            := migor.o
 
 obj-$(CONFIG_SND_SH7760_AC97)  += snd-soc-sh7760-ac97.o
 obj-$(CONFIG_SND_SIU_MIGOR)    += snd-soc-migor.o
+
+# RZ/G2L
+snd-soc-rz-ssi-objs            := rz-ssi.o
+obj-$(CONFIG_SND_SOC_RZ)       += snd-soc-rz-ssi.o
diff --git a/sound/soc/sh/rz-ssi.c b/sound/soc/sh/rz-ssi.c
new file mode 100644 (file)
index 0000000..615fa81
--- /dev/null
@@ -0,0 +1,871 @@
+// SPDX-License-Identifier: GPL-2.0
+//
+// Renesas RZ/G2L ASoC Serial Sound Interface (SSIF-2) Driver
+//
+// Copyright (C) 2021 Renesas Electronics Corp.
+// Copyright (C) 2019 Chris Brandt.
+//
+
+#include <linux/clk.h>
+#include <linux/io.h>
+#include <linux/module.h>
+#include <linux/of_device.h>
+#include <linux/pm_runtime.h>
+#include <linux/reset.h>
+#include <sound/soc.h>
+
+/* REGISTER OFFSET */
+#define SSICR                  0x000
+#define SSISR                  0x004
+#define SSIFCR                 0x010
+#define SSIFSR                 0x014
+#define SSIFTDR                        0x018
+#define SSIFRDR                        0x01c
+#define SSIOFR                 0x020
+#define SSISCR                 0x024
+
+/* SSI REGISTER BITS */
+#define SSICR_DWL(x)           (((x) & 0x7) << 19)
+#define SSICR_SWL(x)           (((x) & 0x7) << 16)
+#define SSICR_MST              BIT(14)
+#define SSICR_CKDV(x)          (((x) & 0xf) << 4)
+
+#define SSICR_CKS              BIT(30)
+#define SSICR_TUIEN            BIT(29)
+#define SSICR_TOIEN            BIT(28)
+#define SSICR_RUIEN            BIT(27)
+#define SSICR_ROIEN            BIT(26)
+#define SSICR_MST              BIT(14)
+#define SSICR_BCKP             BIT(13)
+#define SSICR_LRCKP            BIT(12)
+#define SSICR_CKDV(x)          (((x) & 0xf) << 4)
+#define SSICR_TEN              BIT(1)
+#define SSICR_REN              BIT(0)
+
+#define SSISR_TUIRQ            BIT(29)
+#define SSISR_TOIRQ            BIT(28)
+#define SSISR_RUIRQ            BIT(27)
+#define SSISR_ROIRQ            BIT(26)
+#define SSISR_IIRQ             BIT(25)
+
+#define SSIFCR_AUCKE           BIT(31)
+#define SSIFCR_SSIRST          BIT(16)
+#define SSIFCR_TIE             BIT(3)
+#define SSIFCR_RIE             BIT(2)
+#define SSIFCR_TFRST           BIT(1)
+#define SSIFCR_RFRST           BIT(0)
+
+#define SSIFSR_TDC_MASK                0x3f
+#define SSIFSR_TDC_SHIFT       24
+#define SSIFSR_RDC_MASK                0x3f
+#define SSIFSR_RDC_SHIFT       8
+
+#define SSIFSR_TDC(x)          (((x) & 0x1f) << 24)
+#define SSIFSR_TDE             BIT(16)
+#define SSIFSR_RDC(x)          (((x) & 0x1f) << 8)
+#define SSIFSR_RDF             BIT(0)
+
+#define SSIOFR_LRCONT          BIT(8)
+
+#define SSISCR_TDES(x)         (((x) & 0x1f) << 8)
+#define SSISCR_RDFS(x)         (((x) & 0x1f) << 0)
+
+/* Pre allocated buffers sizes */
+#define PREALLOC_BUFFER                (SZ_32K)
+#define PREALLOC_BUFFER_MAX    (SZ_32K)
+
+#define SSI_RATES              SNDRV_PCM_RATE_8000_48000 /* 8k-44.1kHz */
+#define SSI_FMTS               SNDRV_PCM_FMTBIT_S16_LE
+#define SSI_CHAN_MIN           2
+#define SSI_CHAN_MAX           2
+#define SSI_FIFO_DEPTH         32
+
+struct rz_ssi_priv;
+
+struct rz_ssi_stream {
+       struct rz_ssi_priv *priv;
+       struct snd_pcm_substream *substream;
+       int fifo_sample_size;   /* sample capacity of SSI FIFO */
+       int period_counter;     /* for keeping track of periods transferred */
+       int sample_width;
+       int buffer_pos;         /* current frame position in the buffer */
+       int running;            /* 0=stopped, 1=running */
+
+       int uerr_num;
+       int oerr_num;
+
+       int (*transfer)(struct rz_ssi_priv *ssi, struct rz_ssi_stream *strm);
+};
+
+struct rz_ssi_priv {
+       void __iomem *base;
+       struct platform_device *pdev;
+       struct reset_control *rstc;
+       struct device *dev;
+       struct clk *sfr_clk;
+       struct clk *clk;
+
+       int irq_int;
+       int irq_tx;
+       int irq_rx;
+
+       spinlock_t lock;
+
+       /*
+        * The SSI supports full-duplex transmission and reception.
+        * However, if an error occurs, channel reset (both transmission
+        * and reception reset) is required.
+        * So it is better to use as half-duplex (playing and recording
+        * should be done on separate channels).
+        */
+       struct rz_ssi_stream playback;
+       struct rz_ssi_stream capture;
+
+       /* clock */
+       unsigned long audio_mck;
+       unsigned long audio_clk_1;
+       unsigned long audio_clk_2;
+
+       bool lrckp_fsync_fall;  /* LR clock polarity (SSICR.LRCKP) */
+       bool bckp_rise; /* Bit clock polarity (SSICR.BCKP) */
+};
+
+static void rz_ssi_reg_writel(struct rz_ssi_priv *priv, uint reg, u32 data)
+{
+       writel(data, (priv->base + reg));
+}
+
+static u32 rz_ssi_reg_readl(struct rz_ssi_priv *priv, uint reg)
+{
+       return readl(priv->base + reg);
+}
+
+static void rz_ssi_reg_mask_setl(struct rz_ssi_priv __iomem *priv, uint reg,
+                                u32 bclr, u32 bset)
+{
+       u32 val;
+
+       val = readl(priv->base + reg);
+       val = (val & ~bclr) | bset;
+       writel(val, (priv->base + reg));
+}
+
+static inline struct snd_soc_dai *
+rz_ssi_get_dai(struct snd_pcm_substream *substream)
+{
+       struct snd_soc_pcm_runtime *rtd = asoc_substream_to_rtd(substream);
+
+       return asoc_rtd_to_cpu(rtd, 0);
+}
+
+static inline bool rz_ssi_stream_is_play(struct rz_ssi_priv *ssi,
+                                        struct snd_pcm_substream *substream)
+{
+       return substream->stream == SNDRV_PCM_STREAM_PLAYBACK;
+}
+
+static inline struct rz_ssi_stream *
+rz_ssi_stream_get(struct rz_ssi_priv *ssi, struct snd_pcm_substream *substream)
+{
+       struct rz_ssi_stream *stream = &ssi->playback;
+
+       if (substream->stream != SNDRV_PCM_STREAM_PLAYBACK)
+               stream = &ssi->capture;
+
+       return stream;
+}
+
+static int rz_ssi_stream_is_valid(struct rz_ssi_priv *ssi,
+                                 struct rz_ssi_stream *strm)
+{
+       unsigned long flags;
+       int ret;
+
+       spin_lock_irqsave(&ssi->lock, flags);
+       ret = !!(strm->substream && strm->substream->runtime);
+       spin_unlock_irqrestore(&ssi->lock, flags);
+
+       return ret;
+}
+
+static int rz_ssi_stream_init(struct rz_ssi_priv *ssi,
+                             struct rz_ssi_stream *strm,
+                             struct snd_pcm_substream *substream)
+{
+       struct snd_pcm_runtime *runtime = substream->runtime;
+
+       strm->substream = substream;
+       strm->sample_width = samples_to_bytes(runtime, 1);
+       strm->period_counter = 0;
+       strm->buffer_pos = 0;
+
+       strm->oerr_num = 0;
+       strm->uerr_num = 0;
+       strm->running = 0;
+
+       /* fifo init */
+       strm->fifo_sample_size = SSI_FIFO_DEPTH;
+
+       return 0;
+}
+
+static void rz_ssi_stream_quit(struct rz_ssi_priv *ssi,
+                              struct rz_ssi_stream *strm)
+{
+       struct snd_soc_dai *dai = rz_ssi_get_dai(strm->substream);
+       unsigned long flags;
+
+       spin_lock_irqsave(&ssi->lock, flags);
+       strm->substream = NULL;
+       spin_unlock_irqrestore(&ssi->lock, flags);
+
+       if (strm->oerr_num > 0)
+               dev_info(dai->dev, "overrun = %d\n", strm->oerr_num);
+
+       if (strm->uerr_num > 0)
+               dev_info(dai->dev, "underrun = %d\n", strm->uerr_num);
+}
+
+static int rz_ssi_clk_setup(struct rz_ssi_priv *ssi, unsigned int rate,
+                           unsigned int channels)
+{
+       static s8 ckdv[16] = { 1,  2,  4,  8, 16, 32, 64, 128,
+                              6, 12, 24, 48, 96, -1, -1, -1 };
+       unsigned int channel_bits = 32; /* System Word Length */
+       unsigned long bclk_rate = rate * channels * channel_bits;
+       unsigned int div;
+       unsigned int i;
+       u32 ssicr = 0;
+       u32 clk_ckdv;
+
+       /* Clear AUCKE so we can set MST */
+       rz_ssi_reg_writel(ssi, SSIFCR, 0);
+
+       /* Continue to output LRCK pin even when idle */
+       rz_ssi_reg_writel(ssi, SSIOFR, SSIOFR_LRCONT);
+       if (ssi->audio_clk_1 && ssi->audio_clk_2) {
+               if (ssi->audio_clk_1 % bclk_rate)
+                       ssi->audio_mck = ssi->audio_clk_2;
+               else
+                       ssi->audio_mck = ssi->audio_clk_1;
+       }
+
+       /* Clock setting */
+       ssicr |= SSICR_MST;
+       if (ssi->audio_mck == ssi->audio_clk_1)
+               ssicr |= SSICR_CKS;
+       if (ssi->bckp_rise)
+               ssicr |= SSICR_BCKP;
+       if (ssi->lrckp_fsync_fall)
+               ssicr |= SSICR_LRCKP;
+
+       /* Determine the clock divider */
+       clk_ckdv = 0;
+       div = ssi->audio_mck / bclk_rate;
+       /* try to find an match */
+       for (i = 0; i < ARRAY_SIZE(ckdv); i++) {
+               if (ckdv[i] == div) {
+                       clk_ckdv = i;
+                       break;
+               }
+       }
+
+       if (i == ARRAY_SIZE(ckdv)) {
+               dev_err(ssi->dev, "Rate not divisible by audio clock source\n");
+               return -EINVAL;
+       }
+
+       /*
+        * DWL: Data Word Length = 16 bits
+        * SWL: System Word Length = 32 bits
+        */
+       ssicr |= SSICR_CKDV(clk_ckdv);
+       ssicr |= SSICR_DWL(1) | SSICR_SWL(3);
+       rz_ssi_reg_writel(ssi, SSICR, ssicr);
+       rz_ssi_reg_writel(ssi, SSIFCR,
+                         (SSIFCR_AUCKE | SSIFCR_TFRST | SSIFCR_RFRST));
+
+       return 0;
+}
+
+static int rz_ssi_start(struct rz_ssi_priv *ssi, struct rz_ssi_stream *strm)
+{
+       bool is_play = rz_ssi_stream_is_play(ssi, strm->substream);
+       u32 ssicr, ssifcr;
+
+       ssicr = rz_ssi_reg_readl(ssi, SSICR);
+       ssifcr = rz_ssi_reg_readl(ssi, SSIFCR) & ~0xF;
+
+       /* FIFO interrupt thresholds */
+       rz_ssi_reg_writel(ssi, SSISCR,
+                         SSISCR_TDES(strm->fifo_sample_size / 2 - 1) |
+                         SSISCR_RDFS(0));
+
+       /* enable IRQ */
+       if (is_play) {
+               ssicr |= SSICR_TUIEN | SSICR_TOIEN;
+               ssifcr |= SSIFCR_TIE | SSIFCR_RFRST;
+       } else {
+               ssicr |= SSICR_RUIEN | SSICR_ROIEN;
+               ssifcr |= SSIFCR_RIE | SSIFCR_TFRST;
+       }
+
+       rz_ssi_reg_writel(ssi, SSICR, ssicr);
+       rz_ssi_reg_writel(ssi, SSIFCR, ssifcr);
+
+       /* Clear all error flags */
+       rz_ssi_reg_mask_setl(ssi, SSISR,
+                            (SSISR_TOIRQ | SSISR_TUIRQ | SSISR_ROIRQ |
+                             SSISR_RUIRQ), 0);
+
+       strm->running = 1;
+       ssicr |= is_play ? SSICR_TEN : SSICR_REN;
+       rz_ssi_reg_writel(ssi, SSICR, ssicr);
+
+       return 0;
+}
+
+static int rz_ssi_stop(struct rz_ssi_priv *ssi, struct rz_ssi_stream *strm)
+{
+       int timeout;
+
+       strm->running = 0;
+
+       /* Disable TX/RX */
+       rz_ssi_reg_mask_setl(ssi, SSICR, SSICR_TEN | SSICR_REN, 0);
+
+       /* Disable irqs */
+       rz_ssi_reg_mask_setl(ssi, SSICR, SSICR_TUIEN | SSICR_TOIEN |
+                            SSICR_RUIEN | SSICR_ROIEN, 0);
+       rz_ssi_reg_mask_setl(ssi, SSIFCR, SSIFCR_TIE | SSIFCR_RIE, 0);
+
+       /* Clear all error flags */
+       rz_ssi_reg_mask_setl(ssi, SSISR,
+                            (SSISR_TOIRQ | SSISR_TUIRQ | SSISR_ROIRQ |
+                             SSISR_RUIRQ), 0);
+
+       /* Wait for idle */
+       timeout = 100;
+       while (--timeout) {
+               if (rz_ssi_reg_readl(ssi, SSISR) | SSISR_IIRQ)
+                       break;
+               udelay(1);
+       }
+
+       if (!timeout)
+               dev_info(ssi->dev, "timeout waiting for SSI idle\n");
+
+       /* Hold FIFOs in reset */
+       rz_ssi_reg_mask_setl(ssi, SSIFCR, 0,
+                            SSIFCR_TFRST | SSIFCR_RFRST);
+
+       return 0;
+}
+
+static void rz_ssi_pointer_update(struct rz_ssi_stream *strm, int frames)
+{
+       struct snd_pcm_substream *substream = strm->substream;
+       struct snd_pcm_runtime *runtime;
+       int current_period;
+
+       if (!strm->running || !substream || !substream->runtime)
+               return;
+
+       runtime = substream->runtime;
+       strm->buffer_pos += frames;
+       WARN_ON(strm->buffer_pos > runtime->buffer_size);
+
+       /* ring buffer */
+       if (strm->buffer_pos == runtime->buffer_size)
+               strm->buffer_pos = 0;
+
+       current_period = strm->buffer_pos / runtime->period_size;
+       if (strm->period_counter != current_period) {
+               snd_pcm_period_elapsed(strm->substream);
+               strm->period_counter = current_period;
+       }
+}
+
+static int rz_ssi_pio_recv(struct rz_ssi_priv *ssi, struct rz_ssi_stream *strm)
+{
+       struct snd_pcm_substream *substream = strm->substream;
+       struct snd_pcm_runtime *runtime;
+       u16 *buf;
+       int fifo_samples;
+       int frames_left;
+       int samples = 0;
+       int i;
+
+       if (!rz_ssi_stream_is_valid(ssi, strm))
+               return -EINVAL;
+
+       runtime = substream->runtime;
+       /* frames left in this period */
+       frames_left = runtime->period_size - (strm->buffer_pos %
+                                             runtime->period_size);
+       if (frames_left == 0)
+               frames_left = runtime->period_size;
+
+       /* Samples in RX FIFO */
+       fifo_samples = (rz_ssi_reg_readl(ssi, SSIFSR) >>
+                       SSIFSR_RDC_SHIFT) & SSIFSR_RDC_MASK;
+
+       /* Only read full frames at a time */
+       while (frames_left && (fifo_samples >= runtime->channels)) {
+               samples += runtime->channels;
+               fifo_samples -= runtime->channels;
+               frames_left--;
+       }
+
+       /* not enough samples yet */
+       if (samples == 0)
+               return 0;
+
+       /* calculate new buffer index */
+       buf = (u16 *)(runtime->dma_area);
+       buf += strm->buffer_pos * runtime->channels;
+
+       /* Note, only supports 16-bit samples */
+       for (i = 0; i < samples; i++)
+               *buf++ = (u16)(rz_ssi_reg_readl(ssi, SSIFRDR) >> 16);
+
+       rz_ssi_reg_mask_setl(ssi, SSIFSR, SSIFSR_RDF, 0);
+       rz_ssi_pointer_update(strm, samples / runtime->channels);
+
+       /*
+        * If we finished this period, but there are more samples in
+        * the RX FIFO, call this function again
+        */
+       if (frames_left == 0 && fifo_samples >= runtime->channels)
+               rz_ssi_pio_recv(ssi, strm);
+
+       return 0;
+}
+
+static int rz_ssi_pio_send(struct rz_ssi_priv *ssi, struct rz_ssi_stream *strm)
+{
+       struct snd_pcm_substream *substream = strm->substream;
+       struct snd_pcm_runtime *runtime = substream->runtime;
+       int sample_space;
+       int samples = 0;
+       int frames_left;
+       int i;
+       u32 ssifsr;
+       u16 *buf;
+
+       if (!rz_ssi_stream_is_valid(ssi, strm))
+               return -EINVAL;
+
+       /* frames left in this period */
+       frames_left = runtime->period_size - (strm->buffer_pos %
+                                             runtime->period_size);
+       if (frames_left == 0)
+               frames_left = runtime->period_size;
+
+       sample_space = strm->fifo_sample_size;
+       ssifsr = rz_ssi_reg_readl(ssi, SSIFSR);
+       sample_space -= (ssifsr >> SSIFSR_TDC_SHIFT) & SSIFSR_TDC_MASK;
+
+       /* Only add full frames at a time */
+       while (frames_left && (sample_space >= runtime->channels)) {
+               samples += runtime->channels;
+               sample_space -= runtime->channels;
+               frames_left--;
+       }
+
+       /* no space to send anything right now */
+       if (samples == 0)
+               return 0;
+
+       /* calculate new buffer index */
+       buf = (u16 *)(runtime->dma_area);
+       buf += strm->buffer_pos * runtime->channels;
+
+       /* Note, only supports 16-bit samples */
+       for (i = 0; i < samples; i++)
+               rz_ssi_reg_writel(ssi, SSIFTDR, ((u32)(*buf++) << 16));
+
+       rz_ssi_reg_mask_setl(ssi, SSIFSR, SSIFSR_TDE, 0);
+       rz_ssi_pointer_update(strm, samples / runtime->channels);
+
+       return 0;
+}
+
+static irqreturn_t rz_ssi_interrupt(int irq, void *data)
+{
+       struct rz_ssi_stream *strm = NULL;
+       struct rz_ssi_priv *ssi = data;
+       u32 ssisr = rz_ssi_reg_readl(ssi, SSISR);
+
+       if (ssi->playback.substream)
+               strm = &ssi->playback;
+       else if (ssi->capture.substream)
+               strm = &ssi->capture;
+       else
+               return IRQ_HANDLED; /* Left over TX/RX interrupt */
+
+       if (irq == ssi->irq_int) { /* error or idle */
+               if (ssisr & SSISR_TUIRQ)
+                       strm->uerr_num++;
+               if (ssisr & SSISR_TOIRQ)
+                       strm->oerr_num++;
+               if (ssisr & SSISR_RUIRQ)
+                       strm->uerr_num++;
+               if (ssisr & SSISR_ROIRQ)
+                       strm->oerr_num++;
+
+               if (ssisr & (SSISR_TUIRQ | SSISR_TOIRQ | SSISR_RUIRQ |
+                            SSISR_ROIRQ)) {
+                       /* Error handling */
+                       /* You must reset (stop/restart) after each interrupt */
+                       rz_ssi_stop(ssi, strm);
+
+                       /* Clear all flags */
+                       rz_ssi_reg_mask_setl(ssi, SSISR, SSISR_TOIRQ |
+                                            SSISR_TUIRQ | SSISR_ROIRQ |
+                                            SSISR_RUIRQ, 0);
+
+                       /* Add/remove more data */
+                       strm->transfer(ssi, strm);
+
+                       /* Resume */
+                       rz_ssi_start(ssi, strm);
+               }
+       }
+
+       if (!strm->running)
+               return IRQ_HANDLED;
+
+       /* tx data empty */
+       if (irq == ssi->irq_tx)
+               strm->transfer(ssi, &ssi->playback);
+
+       /* rx data full */
+       if (irq == ssi->irq_rx) {
+               strm->transfer(ssi, &ssi->capture);
+               rz_ssi_reg_mask_setl(ssi, SSIFSR, SSIFSR_RDF, 0);
+       }
+
+       return IRQ_HANDLED;
+}
+
+static int rz_ssi_dai_trigger(struct snd_pcm_substream *substream, int cmd,
+                             struct snd_soc_dai *dai)
+{
+       struct rz_ssi_priv *ssi = snd_soc_dai_get_drvdata(dai);
+       struct rz_ssi_stream *strm = rz_ssi_stream_get(ssi, substream);
+       int ret = 0;
+
+       switch (cmd) {
+       case SNDRV_PCM_TRIGGER_START:
+               /* Soft Reset */
+               rz_ssi_reg_mask_setl(ssi, SSIFCR, 0, SSIFCR_SSIRST);
+               rz_ssi_reg_mask_setl(ssi, SSIFCR, SSIFCR_SSIRST, 0);
+               udelay(5);
+
+               ret = rz_ssi_stream_init(ssi, strm, substream);
+               if (ret)
+                       goto done;
+
+               ret = strm->transfer(ssi, strm);
+               if (ret)
+                       goto done;
+
+               ret = rz_ssi_start(ssi, strm);
+               break;
+       case SNDRV_PCM_TRIGGER_STOP:
+               rz_ssi_stop(ssi, strm);
+               rz_ssi_stream_quit(ssi, strm);
+               break;
+       }
+
+done:
+       return ret;
+}
+
+static int rz_ssi_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
+{
+       struct rz_ssi_priv *ssi = snd_soc_dai_get_drvdata(dai);
+
+       switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
+       case SND_SOC_DAIFMT_CBC_CFC:
+               break;
+       default:
+               dev_err(ssi->dev, "Codec should be clk and frame consumer\n");
+               return -EINVAL;
+       }
+
+       /*
+        * set clock polarity
+        *
+        * "normal" BCLK = Signal is available at rising edge of BCLK
+        * "normal" FSYNC = (I2S) Left ch starts with falling FSYNC edge
+        */
+       switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
+       case SND_SOC_DAIFMT_NB_NF:
+               ssi->bckp_rise = false;
+               ssi->lrckp_fsync_fall = false;
+               break;
+       case SND_SOC_DAIFMT_NB_IF:
+               ssi->bckp_rise = false;
+               ssi->lrckp_fsync_fall = true;
+               break;
+       case SND_SOC_DAIFMT_IB_NF:
+               ssi->bckp_rise = true;
+               ssi->lrckp_fsync_fall = false;
+               break;
+       case SND_SOC_DAIFMT_IB_IF:
+               ssi->bckp_rise = true;
+               ssi->lrckp_fsync_fall = true;
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       /* only i2s support */
+       switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
+       case SND_SOC_DAIFMT_I2S:
+               break;
+       default:
+               dev_err(ssi->dev, "Only I2S mode is supported.\n");
+               return -EINVAL;
+       }
+
+       return 0;
+}
+
+static int rz_ssi_dai_hw_params(struct snd_pcm_substream *substream,
+                               struct snd_pcm_hw_params *params,
+                               struct snd_soc_dai *dai)
+{
+       struct rz_ssi_priv *ssi = snd_soc_dai_get_drvdata(dai);
+       unsigned int sample_bits = hw_param_interval(params,
+                                       SNDRV_PCM_HW_PARAM_SAMPLE_BITS)->min;
+       unsigned int channels = params_channels(params);
+
+       if (sample_bits != 16) {
+               dev_err(ssi->dev, "Unsupported sample width: %d\n",
+                       sample_bits);
+               return -EINVAL;
+       }
+
+       if (channels != 2) {
+               dev_err(ssi->dev, "Number of channels not matched: %d\n",
+                       channels);
+               return -EINVAL;
+       }
+
+       return rz_ssi_clk_setup(ssi, params_rate(params),
+                               params_channels(params));
+}
+
+static const struct snd_soc_dai_ops rz_ssi_dai_ops = {
+       .trigger        = rz_ssi_dai_trigger,
+       .set_fmt        = rz_ssi_dai_set_fmt,
+       .hw_params      = rz_ssi_dai_hw_params,
+};
+
+static const struct snd_pcm_hardware rz_ssi_pcm_hardware = {
+       .info                   = SNDRV_PCM_INFO_INTERLEAVED    |
+                                 SNDRV_PCM_INFO_MMAP           |
+                                 SNDRV_PCM_INFO_MMAP_VALID,
+       .buffer_bytes_max       = PREALLOC_BUFFER,
+       .period_bytes_min       = 32,
+       .period_bytes_max       = 8192,
+       .channels_min           = SSI_CHAN_MIN,
+       .channels_max           = SSI_CHAN_MAX,
+       .periods_min            = 1,
+       .periods_max            = 32,
+       .fifo_size              = 32 * 2,
+};
+
+static int rz_ssi_pcm_open(struct snd_soc_component *component,
+                          struct snd_pcm_substream *substream)
+{
+       snd_soc_set_runtime_hwparams(substream, &rz_ssi_pcm_hardware);
+
+       return snd_pcm_hw_constraint_integer(substream->runtime,
+                                           SNDRV_PCM_HW_PARAM_PERIODS);
+}
+
+static snd_pcm_uframes_t rz_ssi_pcm_pointer(struct snd_soc_component *component,
+                                           struct snd_pcm_substream *substream)
+{
+       struct snd_soc_dai *dai = rz_ssi_get_dai(substream);
+       struct rz_ssi_priv *ssi = snd_soc_dai_get_drvdata(dai);
+       struct rz_ssi_stream *strm = rz_ssi_stream_get(ssi, substream);
+
+       return strm->buffer_pos;
+}
+
+static int rz_ssi_pcm_new(struct snd_soc_component *component,
+                         struct snd_soc_pcm_runtime *rtd)
+{
+       snd_pcm_set_managed_buffer_all(rtd->pcm, SNDRV_DMA_TYPE_DEV,
+                                      rtd->card->snd_card->dev,
+                                      PREALLOC_BUFFER, PREALLOC_BUFFER_MAX);
+       return 0;
+}
+
+static struct snd_soc_dai_driver rz_ssi_soc_dai[] = {
+       {
+               .name                   = "rz-ssi-dai",
+               .playback = {
+                       .rates          = SSI_RATES,
+                       .formats        = SSI_FMTS,
+                       .channels_min   = SSI_CHAN_MIN,
+                       .channels_max   = SSI_CHAN_MAX,
+               },
+               .capture = {
+                       .rates          = SSI_RATES,
+                       .formats        = SSI_FMTS,
+                       .channels_min   = SSI_CHAN_MIN,
+                       .channels_max   = SSI_CHAN_MAX,
+               },
+               .ops = &rz_ssi_dai_ops,
+       },
+};
+
+static const struct snd_soc_component_driver rz_ssi_soc_component = {
+       .name           = "rz-ssi",
+       .open           = rz_ssi_pcm_open,
+       .pointer        = rz_ssi_pcm_pointer,
+       .pcm_construct  = rz_ssi_pcm_new,
+};
+
+static int rz_ssi_probe(struct platform_device *pdev)
+{
+       struct rz_ssi_priv *ssi;
+       struct clk *audio_clk;
+       int ret;
+
+       ssi = devm_kzalloc(&pdev->dev, sizeof(*ssi), GFP_KERNEL);
+       if (!ssi)
+               return -ENOMEM;
+
+       ssi->pdev = pdev;
+       ssi->dev = &pdev->dev;
+       ssi->base = devm_platform_ioremap_resource(pdev, 0);
+       if (IS_ERR(ssi->base))
+               return PTR_ERR(ssi->base);
+
+       ssi->clk = devm_clk_get(&pdev->dev, "ssi");
+       if (IS_ERR(ssi->clk))
+               return PTR_ERR(ssi->clk);
+
+       ssi->sfr_clk = devm_clk_get(&pdev->dev, "ssi_sfr");
+       if (IS_ERR(ssi->sfr_clk))
+               return PTR_ERR(ssi->sfr_clk);
+
+       audio_clk = devm_clk_get(&pdev->dev, "audio_clk1");
+       if (IS_ERR(audio_clk))
+               return dev_err_probe(&pdev->dev, PTR_ERR(audio_clk),
+                                    "no audio clk1");
+
+       ssi->audio_clk_1 = clk_get_rate(audio_clk);
+       audio_clk = devm_clk_get(&pdev->dev, "audio_clk2");
+       if (IS_ERR(audio_clk))
+               return dev_err_probe(&pdev->dev, PTR_ERR(audio_clk),
+                                    "no audio clk2");
+
+       ssi->audio_clk_2 = clk_get_rate(audio_clk);
+       if (!(ssi->audio_clk_1 || ssi->audio_clk_2))
+               return dev_err_probe(&pdev->dev, -EINVAL,
+                                    "no audio clk1 or audio clk2");
+
+       ssi->audio_mck = ssi->audio_clk_1 ? ssi->audio_clk_1 : ssi->audio_clk_2;
+
+       ssi->playback.transfer = rz_ssi_pio_send;
+       ssi->capture.transfer = rz_ssi_pio_recv;
+       ssi->playback.priv = ssi;
+       ssi->capture.priv = ssi;
+
+       /* Error Interrupt */
+       ssi->irq_int = platform_get_irq_byname(pdev, "int_req");
+       if (ssi->irq_int < 0)
+               return dev_err_probe(&pdev->dev, -ENODEV,
+                                    "Unable to get SSI int_req IRQ\n");
+
+       ret = devm_request_irq(&pdev->dev, ssi->irq_int, &rz_ssi_interrupt,
+                              0, dev_name(&pdev->dev), ssi);
+       if (ret < 0)
+               return dev_err_probe(&pdev->dev, ret,
+                                    "irq request error (int_req)\n");
+
+       /* Tx and Rx interrupts (pio only) */
+       ssi->irq_tx = platform_get_irq_byname(pdev, "dma_tx");
+       if (ssi->irq_tx < 0)
+               return dev_err_probe(&pdev->dev, -ENODEV,
+                                    "Unable to get SSI dma_tx IRQ\n");
+
+       ret = devm_request_irq(&pdev->dev, ssi->irq_tx, &rz_ssi_interrupt, 0,
+                              dev_name(&pdev->dev), ssi);
+       if (ret < 0)
+               return dev_err_probe(&pdev->dev, ret,
+                                    "irq request error (dma_tx)\n");
+
+       ssi->irq_rx = platform_get_irq_byname(pdev, "dma_rx");
+       if (ssi->irq_rx < 0)
+               return dev_err_probe(&pdev->dev, -ENODEV,
+                                    "Unable to get SSI dma_rx IRQ\n");
+
+       ret = devm_request_irq(&pdev->dev, ssi->irq_rx, &rz_ssi_interrupt, 0,
+                              dev_name(&pdev->dev), ssi);
+       if (ret < 0)
+               return dev_err_probe(&pdev->dev, ret,
+                                    "irq request error (dma_rx)\n");
+
+       ssi->rstc = devm_reset_control_get_exclusive(&pdev->dev, NULL);
+       if (IS_ERR(ssi->rstc))
+               return PTR_ERR(ssi->rstc);
+
+       reset_control_deassert(ssi->rstc);
+       pm_runtime_enable(&pdev->dev);
+       pm_runtime_resume_and_get(&pdev->dev);
+
+       spin_lock_init(&ssi->lock);
+       dev_set_drvdata(&pdev->dev, ssi);
+       ret = devm_snd_soc_register_component(&pdev->dev, &rz_ssi_soc_component,
+                                             rz_ssi_soc_dai,
+                                             ARRAY_SIZE(rz_ssi_soc_dai));
+       if (ret < 0) {
+               pm_runtime_put(ssi->dev);
+               pm_runtime_disable(ssi->dev);
+               reset_control_assert(ssi->rstc);
+               dev_err(&pdev->dev, "failed to register snd component\n");
+       }
+
+       return ret;
+}
+
+static int rz_ssi_remove(struct platform_device *pdev)
+{
+       struct rz_ssi_priv *ssi = dev_get_drvdata(&pdev->dev);
+
+       pm_runtime_put(ssi->dev);
+       pm_runtime_disable(ssi->dev);
+       reset_control_assert(ssi->rstc);
+
+       return 0;
+}
+
+static const struct of_device_id rz_ssi_of_match[] = {
+       { .compatible = "renesas,rz-ssi", },
+       {/* Sentinel */},
+};
+MODULE_DEVICE_TABLE(of, rz_ssi_of_match);
+
+static struct platform_driver rz_ssi_driver = {
+       .driver = {
+               .name   = "rz-ssi-pcm-audio",
+               .of_match_table = rz_ssi_of_match,
+       },
+       .probe          = rz_ssi_probe,
+       .remove         = rz_ssi_remove,
+};
+
+module_platform_driver(rz_ssi_driver);
+
+MODULE_LICENSE("GPL v2");
+MODULE_DESCRIPTION("Renesas RZ/G2L ASoC Serial Sound Interface Driver");
+MODULE_AUTHOR("Biju Das <biju.das.jz@bp.renesas.com>");