Quelle  ssi.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
//
// Renesas R-Car SSIU/SSI support
//
// Copyright (C) 2013 Renesas Solutions Corp.
// Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
//
// Based on fsi.c
// Kuninori Morimoto <morimoto.kuninori@renesas.com>

/*
 * you can enable below define if you don't need
 * SSI interrupt status debug message when debugging
 * see rsnd_print_irq_status()
 *
 * #define RSND_DEBUG_NO_IRQ_STATUS 1
 */

#include <sound/simple_card_utils.h>
#include <linux/of.h>
#include <linux/of_irq.h>
#include <linux/delay.h>
#include "rsnd.h"
#define RSND_SSI_NAME_SIZE 16

/*
 * SSICR
 */
#define FORCE  (1u << 31) /* Fixed */
#define DMEN  (1u << 28) /* DMA Enable */
#define UIEN  (1u << 27) /* Underflow Interrupt Enable */
#define OIEN  (1u << 26) /* Overflow Interrupt Enable */
#define IIEN  (1u << 25) /* Idle Mode Interrupt Enable */
#define DIEN  (1u << 24) /* Data Interrupt Enable */
#define CHNL_4  (1u << 22) /* Channels */
#define CHNL_6  (2u << 22) /* Channels */
#define CHNL_8  (3u << 22) /* Channels */
#define DWL_MASK (7u << 19) /* Data Word Length mask */
#define DWL_8  (0u << 19) /* Data Word Length */
#define DWL_16  (1u << 19) /* Data Word Length */
#define DWL_18  (2u << 19) /* Data Word Length */
#define DWL_20  (3u << 19) /* Data Word Length */
#define DWL_22  (4u << 19) /* Data Word Length */
#define DWL_24  (5u << 19) /* Data Word Length */
#define DWL_32  (6u << 19) /* Data Word Length */

/*
 * System word length
 */
#define SWL_16  (1 << 16) /* R/W System Word Length */
#define SWL_24  (2 << 16) /* R/W System Word Length */
#define SWL_32  (3 << 16) /* R/W System Word Length */

#define SCKD  (1 << 15) /* Serial Bit Clock Direction */
#define SWSD  (1 << 14) /* Serial WS Direction */
#define SCKP  (1 << 13) /* Serial Bit Clock Polarity */
#define SWSP  (1 << 12) /* Serial WS Polarity */
#define SDTA  (1 << 10) /* Serial Data Alignment */
#define PDTA  (1 <<  9) /* Parallel Data Alignment */
#define DEL  (1 <<  8) /* Serial Data Delay */
#define CKDV(v)  (v <<  4) /* Serial Clock Division Ratio */
#define TRMD  (1 <<  1) /* Transmit/Receive Mode Select */
#define EN  (1 <<  0) /* SSI Module Enable */

/*
 * SSISR
 */
#define UIRQ  (1 << 27) /* Underflow Error Interrupt Status */
#define OIRQ  (1 << 26) /* Overflow Error Interrupt Status */
#define IIRQ  (1 << 25) /* Idle Mode Interrupt Status */
#define DIRQ  (1 << 24) /* Data Interrupt Status Flag */

/*
 * SSIWSR
 */
#define CONT  (1 << 8) /* WS Continue Function */
#define WS_MODE  (1 << 0) /* WS Mode */

#define SSI_NAME "ssi"

struct rsnd_ssi {
 struct rsnd_mod mod;

 u32 flags;
 u32 cr_own;
 u32 cr_clk;
 u32 cr_mode;
 u32 cr_en;
 u32 wsr;
 int chan;
 int rate;
 int irq;
 unsigned int usrcnt;

 /* for PIO */
 int byte_pos;
 int byte_per_period;
 int next_period_byte;
};

/* flags */
#define RSND_SSI_CLK_PIN_SHARE  (1 << 0)
#define RSND_SSI_NO_BUSIF  (1 << 1) /* SSI+DMA without BUSIF */
#define RSND_SSI_PROBED   (1 << 2)

#define for_each_rsnd_ssi(pos, priv, i)     \
 for (i = 0;       \
      (i < rsnd_ssi_nr(priv)) &&     \
  ((pos) = ((struct rsnd_ssi *)(priv)->ssi + i));  \
      i++)

#define rsnd_ssi_get(priv, id) ((struct rsnd_ssi *)(priv->ssi) + id)
#define rsnd_ssi_nr(priv) ((priv)->ssi_nr)
#define rsnd_mod_to_ssi(_mod) container_of((_mod), struct rsnd_ssi, mod)
#define rsnd_ssi_is_parent(ssi, io) ((ssi) == rsnd_io_to_mod_ssip(io))
#define rsnd_ssi_is_multi_secondary(mod, io)    \
 (rsnd_ssi_multi_secondaries(io) & (1 << rsnd_mod_id(mod)))
#define rsnd_ssi_is_run_mods(mod, io) \
 (rsnd_ssi_run_mods(io) & (1 << rsnd_mod_id(mod)))
#define rsnd_ssi_can_output_clk(mod) (!__rsnd_ssi_is_pin_sharing(mod))

int rsnd_ssi_use_busif(struct rsnd_dai_stream *io)
{
 struct rsnd_mod *mod = rsnd_io_to_mod_ssi(io);
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 int use_busif = 0;

 if (!rsnd_ssi_is_dma_mode(mod))
  return 0;

 if (!(rsnd_flags_has(ssi, RSND_SSI_NO_BUSIF)))
  use_busif = 1;
 if (rsnd_io_to_mod_src(io))
  use_busif = 1;

 return use_busif;
}

static void rsnd_ssi_status_clear(struct rsnd_mod *mod)
{
 rsnd_mod_write(mod, SSISR, 0);
}

static u32 rsnd_ssi_status_get(struct rsnd_mod *mod)
{
 return rsnd_mod_read(mod, SSISR);
}

static void rsnd_ssi_status_check(struct rsnd_mod *mod,
      u32 bit)
{
 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
 struct device *dev = rsnd_priv_to_dev(priv);
 u32 status;
 int i;

 for (i = 0; i < 1024; i++) {
  status = rsnd_ssi_status_get(mod);
  if (status & bit)
   return;

  udelay(5);
 }

 dev_warn(dev, "%s status check failed\n", rsnd_mod_name(mod));
}

static u32 rsnd_ssi_multi_secondaries(struct rsnd_dai_stream *io)
{
 static const enum rsnd_mod_type types[] = {
  RSND_MOD_SSIM1,
  RSND_MOD_SSIM2,
  RSND_MOD_SSIM3,
 };
 int i, mask;

 mask = 0;
 for (i = 0; i < ARRAY_SIZE(types); i++) {
  struct rsnd_mod *mod = rsnd_io_to_mod(io, types[i]);

  if (!mod)
   continue;

  mask |= 1 << rsnd_mod_id(mod);
 }

 return mask;
}

static u32 rsnd_ssi_run_mods(struct rsnd_dai_stream *io)
{
 struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io);
 struct rsnd_mod *ssi_parent_mod = rsnd_io_to_mod_ssip(io);
 u32 mods;

 mods = rsnd_ssi_multi_secondaries_runtime(io) |
  1 << rsnd_mod_id(ssi_mod);

 if (ssi_parent_mod)
  mods |= 1 << rsnd_mod_id(ssi_parent_mod);

 return mods;
}

u32 rsnd_ssi_multi_secondaries_runtime(struct rsnd_dai_stream *io)
{
 if (rsnd_runtime_is_multi_ssi(io))
  return rsnd_ssi_multi_secondaries(io);

 return 0;
}

static u32 rsnd_rdai_width_to_swl(struct rsnd_dai *rdai)
{
 struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
 struct device *dev = rsnd_priv_to_dev(priv);
 int width = rsnd_rdai_width_get(rdai);

 switch (width) {
 case 32: return SWL_32;
 case 24: return SWL_24;
 case 16: return SWL_16;
 }

 dev_err(dev, "unsupported slot width value: %d\n", width);
 return 0;
}

unsigned int rsnd_ssi_clk_query(struct rsnd_dai *rdai,
         int param1, int param2, int *idx)
{
 struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
 static const int ssi_clk_mul_table[] = {
  1, 2, 4, 8, 16, 6, 12,
 };
 int j, ret;
 unsigned int main_rate;
 int width = rsnd_rdai_width_get(rdai);

 for (j = 0; j < ARRAY_SIZE(ssi_clk_mul_table); j++) {

  /*
   * It will set SSIWSR.CONT here, but SSICR.CKDV = 000
   * with it is not allowed. (SSIWSR.WS_MODE with
   * SSICR.CKDV = 000 is not allowed either).
   * Skip it. See SSICR.CKDV
 */
  if (j == 0)
   continue;

  main_rate = width * param1 * param2 * ssi_clk_mul_table[j];

  ret = rsnd_adg_clk_query(priv, main_rate);
  if (ret < 0)
   continue;

  if (idx)
   *idx = j;

  return main_rate;
 }

 return 0;
}

static int rsnd_ssi_master_clk_start(struct rsnd_mod *mod,
         struct rsnd_dai_stream *io)
{
 struct rsnd_priv *priv = rsnd_io_to_priv(io);
 struct device *dev = rsnd_priv_to_dev(priv);
 struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 int chan = rsnd_runtime_channel_for_ssi(io);
 int idx, ret;
 unsigned int main_rate;
 unsigned int rate = rsnd_io_is_play(io) ?
  rsnd_src_get_out_rate(priv, io) :
  rsnd_src_get_in_rate(priv, io);

 if (!rsnd_rdai_is_clk_master(rdai))
  return 0;

 if (!rsnd_ssi_can_output_clk(mod))
  return 0;

 if (rsnd_ssi_is_multi_secondary(mod, io))
  return 0;

 if (rsnd_runtime_is_tdm_split(io))
  chan = rsnd_io_converted_chan(io);

 chan = rsnd_channel_normalization(chan);

 if (ssi->usrcnt > 0) {
  if (ssi->rate != rate) {
   dev_err(dev, "SSI parent/child should use same rate\n");
   return -EINVAL;
  }

  if (ssi->chan != chan) {
   dev_err(dev, "SSI parent/child should use same chan\n");
   return -EINVAL;
  }

  return 0;
 }

 ret = -EIO;
 main_rate = rsnd_ssi_clk_query(rdai, rate, chan, &idx);
 if (!main_rate)
  goto rate_err;

 ret = rsnd_adg_ssi_clk_try_start(mod, main_rate);
 if (ret < 0)
  goto rate_err;

 /*
  * SSI clock will be output contiguously
  * by below settings.
  * This means, rsnd_ssi_master_clk_start()
  * and rsnd_ssi_register_setup() are necessary
  * for SSI parent
  *
  * SSICR  : FORCE, SCKD, SWSD
  * SSIWSR : CONT
 */
 ssi->cr_clk = FORCE | rsnd_rdai_width_to_swl(rdai) |
   SCKD | SWSD | CKDV(idx);
 ssi->wsr = CONT;
 ssi->rate = rate;
 ssi->chan = chan;

 dev_dbg(dev, "%s outputs %d chan %u Hz\n",
  rsnd_mod_name(mod), chan, rate);

 return 0;

rate_err:
 dev_err(dev, "unsupported clock rate (%d)\n", rate);

 return ret;
}

static void rsnd_ssi_master_clk_stop(struct rsnd_mod *mod,
         struct rsnd_dai_stream *io)
{
 struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);

 if (!rsnd_rdai_is_clk_master(rdai))
  return;

 if (!rsnd_ssi_can_output_clk(mod))
  return;

 if (ssi->usrcnt > 1)
  return;

 ssi->cr_clk = 0;
 ssi->rate = 0;
 ssi->chan = 0;

 rsnd_adg_ssi_clk_stop(mod);
}

static void rsnd_ssi_config_init(struct rsnd_mod *mod,
    struct rsnd_dai_stream *io)
{
 struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
 struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
 struct device *dev = rsnd_priv_to_dev(priv);
 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 u32 cr_own = ssi->cr_own;
 u32 cr_mode = ssi->cr_mode;
 u32 wsr  = ssi->wsr;
 int width;
 int is_tdm, is_tdm_split;

 is_tdm  = rsnd_runtime_is_tdm(io);
 is_tdm_split = rsnd_runtime_is_tdm_split(io);

 if (is_tdm)
  dev_dbg(dev, "TDM mode\n");
 if (is_tdm_split)
  dev_dbg(dev, "TDM Split mode\n");

 cr_own |= FORCE | rsnd_rdai_width_to_swl(rdai);

 if (rdai->bit_clk_inv)
  cr_own |= SCKP;
 if (rdai->frm_clk_inv && !is_tdm)
  cr_own |= SWSP;
 if (rdai->data_alignment)
  cr_own |= SDTA;
 if (rdai->sys_delay)
  cr_own |= DEL;

 /*
  * TDM Mode
  * see
  * rsnd_ssiu_init_gen2()
 */
 if (is_tdm || is_tdm_split) {
  wsr |= WS_MODE;
  cr_own |= CHNL_8;
 }

 /*
  * We shouldn't exchange SWSP after running.
  * This means, parent needs to care it.
 */
 if (rsnd_ssi_is_parent(mod, io))
  goto init_end;

 if (rsnd_io_is_play(io))
  cr_own |= TRMD;

 cr_own &= ~DWL_MASK;
 width = snd_pcm_format_width(runtime->format);
 if (is_tdm_split) {
  /*
   * The SWL and DWL bits in SSICR should be fixed at 32-bit
   * setting when TDM split mode.
   * see datasheet
   * Operation :: TDM Format Split Function (TDM Split Mode)
 */
  width = 32;
 }

 switch (width) {
 case 8:
  cr_own |= DWL_8;
  break;
 case 16:
  cr_own |= DWL_16;
  break;
 case 24:
  cr_own |= DWL_24;
  break;
 case 32:
  cr_own |= DWL_32;
  break;
 }

 if (rsnd_ssi_is_dma_mode(mod)) {
  cr_mode = UIEN | OIEN | /* over/under run */
     DMEN;  /* DMA : enable DMA */
 } else {
  cr_mode = DIEN;  /* PIO : enable Data interrupt */
 }

init_end:
 ssi->cr_own = cr_own;
 ssi->cr_mode = cr_mode;
 ssi->wsr = wsr;
}

static void rsnd_ssi_register_setup(struct rsnd_mod *mod)
{
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);

 rsnd_mod_write(mod, SSIWSR, ssi->wsr);
 rsnd_mod_write(mod, SSICR, ssi->cr_own |
     ssi->cr_clk |
     ssi->cr_mode |
     ssi->cr_en);
}

/*
 * SSI mod common functions
 */
static int rsnd_ssi_init(struct rsnd_mod *mod,
    struct rsnd_dai_stream *io,
    struct rsnd_priv *priv)
{
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 int ret;

 if (!rsnd_ssi_is_run_mods(mod, io))
  return 0;

 ret = rsnd_ssi_master_clk_start(mod, io);
 if (ret < 0)
  return ret;

 ssi->usrcnt++;

 ret = rsnd_mod_power_on(mod);
 if (ret < 0)
  return ret;

 rsnd_ssi_config_init(mod, io);

 rsnd_ssi_register_setup(mod);

 /* clear error status */
 rsnd_ssi_status_clear(mod);

 return 0;
}

static int rsnd_ssi_quit(struct rsnd_mod *mod,
    struct rsnd_dai_stream *io,
    struct rsnd_priv *priv)
{
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 struct device *dev = rsnd_priv_to_dev(priv);

 if (!rsnd_ssi_is_run_mods(mod, io))
  return 0;

 if (!ssi->usrcnt) {
  dev_err(dev, "%s usrcnt error\n", rsnd_mod_name(mod));
  return -EIO;
 }

 rsnd_ssi_master_clk_stop(mod, io);

 rsnd_mod_power_off(mod);

 ssi->usrcnt--;

 if (!ssi->usrcnt) {
  ssi->cr_own = 0;
  ssi->cr_mode = 0;
  ssi->wsr = 0;
 }

 return 0;
}

static int rsnd_ssi_hw_params(struct rsnd_mod *mod,
         struct rsnd_dai_stream *io,
         struct snd_pcm_substream *substream,
         struct snd_pcm_hw_params *params)
{
 struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
 unsigned int fmt_width = snd_pcm_format_width(params_format(params));

 if (fmt_width > rdai->chan_width) {
  struct rsnd_priv *priv = rsnd_io_to_priv(io);
  struct device *dev = rsnd_priv_to_dev(priv);

  dev_err(dev, "invalid combination of slot-width and format-data-width\n");
  return -EINVAL;
 }

 return 0;
}

static int rsnd_ssi_start(struct rsnd_mod *mod,
     struct rsnd_dai_stream *io,
     struct rsnd_priv *priv)
{
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);

 if (!rsnd_ssi_is_run_mods(mod, io))
  return 0;

 /*
  * EN will be set via SSIU :: SSI_CONTROL
  * if Multi channel mode
 */
 if (rsnd_ssi_multi_secondaries_runtime(io))
  return 0;

 /*
  * EN is for data output.
  * SSI parent EN is not needed.
 */
 if (rsnd_ssi_is_parent(mod, io))
  return 0;

 ssi->cr_en = EN;

 rsnd_mod_write(mod, SSICR, ssi->cr_own |
     ssi->cr_clk |
     ssi->cr_mode |
     ssi->cr_en);

 return 0;
}

static int rsnd_ssi_stop(struct rsnd_mod *mod,
    struct rsnd_dai_stream *io,
    struct rsnd_priv *priv)
{
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 u32 cr;

 if (!rsnd_ssi_is_run_mods(mod, io))
  return 0;

 if (rsnd_ssi_is_parent(mod, io))
  return 0;

 cr  = ssi->cr_own |
  ssi->cr_clk;

 /*
  * disable all IRQ,
  * Playback: Wait all data was sent
  * Capture:  It might not receave data. Do nothing
 */
 if (rsnd_io_is_play(io)) {
  rsnd_mod_write(mod, SSICR, cr | ssi->cr_en);
  rsnd_ssi_status_check(mod, DIRQ);
 }

 /* In multi-SSI mode, stop is performed by setting ssi0129 in
  * SSI_CONTROL to 0 (in rsnd_ssio_stop_gen2). Do nothing here.
 */
 if (rsnd_ssi_multi_secondaries_runtime(io))
  return 0;

 /*
  * disable SSI,
  * and, wait idle state
 */
 rsnd_mod_write(mod, SSICR, cr); /* disabled all */
 rsnd_ssi_status_check(mod, IIRQ);

 ssi->cr_en = 0;

 return 0;
}

static int rsnd_ssi_irq(struct rsnd_mod *mod,
   struct rsnd_dai_stream *io,
   struct rsnd_priv *priv,
   int enable)
{
 u32 val = 0;
 int is_tdm, is_tdm_split;
 int id = rsnd_mod_id(mod);

 is_tdm  = rsnd_runtime_is_tdm(io);
 is_tdm_split = rsnd_runtime_is_tdm_split(io);

 if (rsnd_is_gen1(priv))
  return 0;

 if (rsnd_ssi_is_parent(mod, io))
  return 0;

 if (!rsnd_ssi_is_run_mods(mod, io))
  return 0;

 if (enable)
  val = rsnd_ssi_is_dma_mode(mod) ? 0x0e000000 : 0x0f000000;

 if (is_tdm || is_tdm_split) {
  switch (id) {
  case 0:
  case 1:
  case 2:
  case 3:
  case 4:
  case 9:
   val |= 0x0000ff00;
   break;
  }
 }

 rsnd_mod_write(mod, SSI_INT_ENABLE, val);

 return 0;
}

static bool rsnd_ssi_pio_interrupt(struct rsnd_mod *mod,
       struct rsnd_dai_stream *io);
static void __rsnd_ssi_interrupt(struct rsnd_mod *mod,
     struct rsnd_dai_stream *io)
{
 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
 struct device *dev = rsnd_priv_to_dev(priv);
 int is_dma = rsnd_ssi_is_dma_mode(mod);
 u32 status;
 bool elapsed = false;
 bool stop = false;

 spin_lock(&priv->lock);

 /* ignore all cases if not working */
 if (!rsnd_io_is_working(io))
  goto rsnd_ssi_interrupt_out;

 status = rsnd_ssi_status_get(mod);

 /* PIO only */
 if (!is_dma && (status & DIRQ))
  elapsed = rsnd_ssi_pio_interrupt(mod, io);

 /* DMA only */
 if (is_dma && (status & (UIRQ | OIRQ))) {
  rsnd_print_irq_status(dev, "%s err status : 0x%08x\n",
          rsnd_mod_name(mod), status);

  stop = true;
 }

 stop |= rsnd_ssiu_busif_err_status_clear(mod);

 rsnd_ssi_status_clear(mod);
rsnd_ssi_interrupt_out:
 spin_unlock(&priv->lock);

 if (elapsed)
  snd_pcm_period_elapsed(io->substream);

 if (stop)
  snd_pcm_stop_xrun(io->substream);

}

static irqreturn_t rsnd_ssi_interrupt(int irq, void *data)
{
 struct rsnd_mod *mod = data;

 rsnd_mod_interrupt(mod, __rsnd_ssi_interrupt);

 return IRQ_HANDLED;
}

static u32 *rsnd_ssi_get_status(struct rsnd_mod *mod,
    struct rsnd_dai_stream *io,
    enum rsnd_mod_type type)
{
 /*
  * SSIP (= SSI parent) needs to be special, otherwise,
  * 2nd SSI might doesn't start. see also rsnd_mod_call()
  *
  * We can't include parent SSI status on SSI, because we don't know
  * how many SSI requests parent SSI. Thus, it is localed on "io" now.
  * ex) trouble case
  * Playback: SSI0
  * Capture : SSI1 (needs SSI0)
  *
  * 1) start Capture  -> SSI0/SSI1 are started.
  * 2) start Playback -> SSI0 doesn't work, because it is already
  *   marked as "started" on 1)
  *
  * OTOH, using each mod's status is good for MUX case.
  * It doesn't need to start in 2nd start
  * ex)
  * IO-0: SRC0 -> CTU1 -+-> MUX -> DVC -> SSIU -> SSI0
  *       |
  * IO-1: SRC1 -> CTU2 -+
  *
  * 1) start IO-0 -> start SSI0
  * 2) start IO-1 -> SSI0 doesn't need to start, because it is
  *   already started on 1)
 */
 if (type == RSND_MOD_SSIP)
  return &io->parent_ssi_status;

 return rsnd_mod_get_status(mod, io, type);
}

/*
 *  SSI PIO
 */
static void rsnd_ssi_parent_attach(struct rsnd_mod *mod,
       struct rsnd_dai_stream *io)
{
 struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);

 if (!__rsnd_ssi_is_pin_sharing(mod))
  return;

 if (!rsnd_rdai_is_clk_master(rdai))
  return;

 if (rsnd_ssi_is_multi_secondary(mod, io))
  return;

 switch (rsnd_mod_id(mod)) {
 case 1:
 case 2:
 case 9:
  rsnd_dai_connect(rsnd_ssi_mod_get(priv, 0), io, RSND_MOD_SSIP);
  break;
 case 4:
  rsnd_dai_connect(rsnd_ssi_mod_get(priv, 3), io, RSND_MOD_SSIP);
  break;
 case 8:
  rsnd_dai_connect(rsnd_ssi_mod_get(priv, 7), io, RSND_MOD_SSIP);
  break;
 }
}

static int rsnd_ssi_pcm_new(struct rsnd_mod *mod,
       struct rsnd_dai_stream *io,
       struct snd_soc_pcm_runtime *rtd)
{
 /*
  * rsnd_rdai_is_clk_master() will be enabled after set_fmt,
  * and, pcm_new will be called after it.
  * This function reuse pcm_new at this point.
 */
 rsnd_ssi_parent_attach(mod, io);

 return 0;
}

static int rsnd_ssi_common_probe(struct rsnd_mod *mod,
     struct rsnd_dai_stream *io,
     struct rsnd_priv *priv)
{
 struct device *dev = rsnd_priv_to_dev(priv);
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 int ret = 0;

 /*
  * SSIP/SSIU/IRQ are not needed on
  * SSI Multi secondaries
 */
 if (rsnd_ssi_is_multi_secondary(mod, io))
  return 0;

 /*
  * It can't judge ssi parent at this point
  * see rsnd_ssi_pcm_new()
 */

 /*
  * SSI might be called again as PIO fallback
  * It is easy to manual handling for IRQ request/free
  *
  * OTOH, this function might be called many times if platform is
  * using MIX. It needs xxx_attach() many times on xxx_probe().
  * Because of it, we can't control .probe/.remove calling count by
  * mod->status.
  * But it don't need to call request_irq() many times.
  * Let's control it by RSND_SSI_PROBED flag.
 */
 if (!rsnd_flags_has(ssi, RSND_SSI_PROBED)) {
  ret = request_irq(ssi->irq,
      rsnd_ssi_interrupt,
      IRQF_SHARED,
      dev_name(dev), mod);

  rsnd_flags_set(ssi, RSND_SSI_PROBED);
 }

 return ret;
}

static int rsnd_ssi_common_remove(struct rsnd_mod *mod,
      struct rsnd_dai_stream *io,
      struct rsnd_priv *priv)
{
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 struct rsnd_mod *pure_ssi_mod = rsnd_io_to_mod_ssi(io);

 /* Do nothing if non SSI (= SSI parent, multi SSI) mod */
 if (pure_ssi_mod != mod)
  return 0;

 /* PIO will request IRQ again */
 if (rsnd_flags_has(ssi, RSND_SSI_PROBED)) {
  free_irq(ssi->irq, mod);

  rsnd_flags_del(ssi, RSND_SSI_PROBED);
 }

 return 0;
}

/*
 * SSI PIO functions
 */
static bool rsnd_ssi_pio_interrupt(struct rsnd_mod *mod,
       struct rsnd_dai_stream *io)
{
 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 u32 *buf = (u32 *)(runtime->dma_area + ssi->byte_pos);
 int shift = 0;
 int byte_pos;
 bool elapsed = false;

 if (snd_pcm_format_width(runtime->format) == 24)
  shift = 8;

 /*
  * 8/16/32 data can be assesse to TDR/RDR register
  * directly as 32bit data
  * see rsnd_ssi_init()
 */
 if (rsnd_io_is_play(io))
  rsnd_mod_write(mod, SSITDR, (*buf) << shift);
 else
  *buf = (rsnd_mod_read(mod, SSIRDR) >> shift);

 byte_pos = ssi->byte_pos + sizeof(*buf);

 if (byte_pos >= ssi->next_period_byte) {
  int period_pos = byte_pos / ssi->byte_per_period;

  if (period_pos >= runtime->periods) {
   byte_pos = 0;
   period_pos = 0;
  }

  ssi->next_period_byte = (period_pos + 1) * ssi->byte_per_period;

  elapsed = true;
 }

 WRITE_ONCE(ssi->byte_pos, byte_pos);

 return elapsed;
}

static int rsnd_ssi_pio_init(struct rsnd_mod *mod,
        struct rsnd_dai_stream *io,
        struct rsnd_priv *priv)
{
 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);

 if (!rsnd_ssi_is_parent(mod, io)) {
  ssi->byte_pos  = 0;
  ssi->byte_per_period = runtime->period_size *
       runtime->channels *
       samples_to_bytes(runtime, 1);
  ssi->next_period_byte = ssi->byte_per_period;
 }

 return rsnd_ssi_init(mod, io, priv);
}

static int rsnd_ssi_pio_pointer(struct rsnd_mod *mod,
       struct rsnd_dai_stream *io,
       snd_pcm_uframes_t *pointer)
{
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);

 *pointer = bytes_to_frames(runtime, READ_ONCE(ssi->byte_pos));

 return 0;
}

static struct rsnd_mod_ops rsnd_ssi_pio_ops = {
 .name  = SSI_NAME,
 .probe  = rsnd_ssi_common_probe,
 .remove  = rsnd_ssi_common_remove,
 .init  = rsnd_ssi_pio_init,
 .quit  = rsnd_ssi_quit,
 .start  = rsnd_ssi_start,
 .stop  = rsnd_ssi_stop,
 .irq  = rsnd_ssi_irq,
 .pointer = rsnd_ssi_pio_pointer,
 .pcm_new = rsnd_ssi_pcm_new,
 .hw_params = rsnd_ssi_hw_params,
 .get_status = rsnd_ssi_get_status,
};

static int rsnd_ssi_dma_probe(struct rsnd_mod *mod,
         struct rsnd_dai_stream *io,
         struct rsnd_priv *priv)
{
 int ret;

 /*
  * SSIP/SSIU/IRQ/DMA are not needed on
  * SSI Multi secondaries
 */
 if (rsnd_ssi_is_multi_secondary(mod, io))
  return 0;

 ret = rsnd_ssi_common_probe(mod, io, priv);
 if (ret)
  return ret;

 /* SSI probe might be called many times in MUX multi path */
 ret = rsnd_dma_attach(io, mod, &io->dma);

 return ret;
}

static int rsnd_ssi_fallback(struct rsnd_mod *mod,
        struct rsnd_dai_stream *io,
        struct rsnd_priv *priv)
{
 struct device *dev = rsnd_priv_to_dev(priv);

 /*
  * fallback to PIO
  *
  * SSI .probe might be called again.
  * see
  * rsnd_rdai_continuance_probe()
 */
 mod->ops = &rsnd_ssi_pio_ops;

 dev_info(dev, "%s fallback to PIO mode\n", rsnd_mod_name(mod));

 return 0;
}

static struct dma_chan *rsnd_ssi_dma_req(struct rsnd_dai_stream *io,
      struct rsnd_mod *mod)
{
 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
 int is_play = rsnd_io_is_play(io);
 char *name;

 /*
  * It should use "rcar_sound,ssiu" on DT.
  * But, we need to keep compatibility for old version.
  *
  * If it has "rcar_sound.ssiu", it will be used.
  * If not, "rcar_sound.ssi" will be used.
  * see
  * rsnd_ssiu_dma_req()
  * rsnd_dma_of_path()
 */

 if (rsnd_ssi_use_busif(io))
  name = is_play ? "rxu" : "txu";
 else
  name = is_play ? "rx" : "tx";

 return rsnd_dma_request_channel(rsnd_ssi_of_node(priv),
     SSI_NAME, mod, name);
}

#ifdef CONFIG_DEBUG_FS
static void rsnd_ssi_debug_info(struct seq_file *m,
    struct rsnd_dai_stream *io,
    struct rsnd_mod *mod)
{
 struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
 struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);

 seq_printf(m, "clock:           %s\n",  rsnd_rdai_is_clk_master(rdai) ?
        "provider" : "consumer");
 seq_printf(m, "bit_clk_inv:     %d\n",  rdai->bit_clk_inv);
 seq_printf(m, "frm_clk_inv:     %d\n",  rdai->frm_clk_inv);
 seq_printf(m, "pin share:       %d\n",  __rsnd_ssi_is_pin_sharing(mod));
 seq_printf(m, "can out clk:     %d\n",  rsnd_ssi_can_output_clk(mod));
 seq_printf(m, "multi secondary: %d\n",  rsnd_ssi_is_multi_secondary(mod, io));
 seq_printf(m, "tdm:             %d, %d\n", rsnd_runtime_is_tdm(io),
       rsnd_runtime_is_tdm_split(io));
 seq_printf(m, "chan:            %d\n",  ssi->chan);
 seq_printf(m, "user:            %d\n",  ssi->usrcnt);

 rsnd_debugfs_mod_reg_show(m, mod, RSND_BASE_SSI,
      rsnd_mod_id(mod) * 0x40, 0x40);
}
#define DEBUG_INFO .debug_info = rsnd_ssi_debug_info
#else
#define DEBUG_INFO
#endif

static struct rsnd_mod_ops rsnd_ssi_dma_ops = {
 .name  = SSI_NAME,
 .dma_req = rsnd_ssi_dma_req,
 .probe  = rsnd_ssi_dma_probe,
 .remove  = rsnd_ssi_common_remove,
 .init  = rsnd_ssi_init,
 .quit  = rsnd_ssi_quit,
 .start  = rsnd_ssi_start,
 .stop  = rsnd_ssi_stop,
 .irq  = rsnd_ssi_irq,
 .pcm_new = rsnd_ssi_pcm_new,
 .fallback = rsnd_ssi_fallback,
 .hw_params = rsnd_ssi_hw_params,
 .get_status = rsnd_ssi_get_status,
 DEBUG_INFO
};

int rsnd_ssi_is_dma_mode(struct rsnd_mod *mod)
{
 return mod->ops == &rsnd_ssi_dma_ops;
}

/*
 *  ssi mod function
 */
static void rsnd_ssi_connect(struct rsnd_mod *mod,
        struct rsnd_dai_stream *io)
{
 struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
 static const enum rsnd_mod_type types[] = {
  RSND_MOD_SSI,
  RSND_MOD_SSIM1,
  RSND_MOD_SSIM2,
  RSND_MOD_SSIM3,
 };
 enum rsnd_mod_type type;
 int i;

 /* try SSI -> SSIM1 -> SSIM2 -> SSIM3 */
 for (i = 0; i < ARRAY_SIZE(types); i++) {
  type = types[i];
  if (!rsnd_io_to_mod(io, type)) {
   rsnd_dai_connect(mod, io, type);
   rsnd_rdai_channels_set(rdai, (i + 1) * 2);
   rsnd_rdai_ssi_lane_set(rdai, (i + 1));
   return;
  }
 }
}

void rsnd_parse_connect_ssi(struct rsnd_dai *rdai,
       struct device_node *playback,
       struct device_node *capture)
{
 struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
 struct device *dev = rsnd_priv_to_dev(priv);
 struct device_node *node;
 int i;

 node = rsnd_ssi_of_node(priv);
 if (!node)
  return;

 i = 0;
 for_each_child_of_node_scoped(node, np) {
  struct rsnd_mod *mod;

  i = rsnd_node_fixed_index(dev, np, SSI_NAME, i);
  if (i < 0)
   break;

  mod = rsnd_ssi_mod_get(priv, i);

  if (np == playback)
   rsnd_ssi_connect(mod, &rdai->playback);
  if (np == capture)
   rsnd_ssi_connect(mod, &rdai->capture);
  i++;
 }

 of_node_put(node);
}

struct rsnd_mod *rsnd_ssi_mod_get(struct rsnd_priv *priv, int id)
{
 if (WARN_ON(id < 0 || id >= rsnd_ssi_nr(priv)))
  id = 0;

 return rsnd_mod_get(rsnd_ssi_get(priv, id));
}

int __rsnd_ssi_is_pin_sharing(struct rsnd_mod *mod)
{
 if (!mod)
  return 0;

 return !!(rsnd_flags_has(rsnd_mod_to_ssi(mod), RSND_SSI_CLK_PIN_SHARE));
}

int rsnd_ssi_probe(struct rsnd_priv *priv)
{
 struct device_node *node;
 struct device *dev = rsnd_priv_to_dev(priv);
 struct rsnd_mod_ops *ops;
 struct clk *clk;
 struct rsnd_ssi *ssi;
 char name[RSND_SSI_NAME_SIZE];
 int i, nr, ret;

 node = rsnd_ssi_of_node(priv);
 if (!node)
  return -EINVAL;

 nr = rsnd_node_count(priv, node, SSI_NAME);
 if (!nr) {
  ret = -EINVAL;
  goto rsnd_ssi_probe_done;
 }

 ssi = devm_kcalloc(dev, nr, sizeof(*ssi), GFP_KERNEL);
 if (!ssi) {
  ret = -ENOMEM;
  goto rsnd_ssi_probe_done;
 }

 priv->ssi = ssi;
 priv->ssi_nr = nr;

 i = 0;
 for_each_child_of_node_scoped(node, np) {
  if (!of_device_is_available(np))
   goto skip;

  i = rsnd_node_fixed_index(dev, np, SSI_NAME, i);
  if (i < 0) {
   ret = -EINVAL;
   goto rsnd_ssi_probe_done;
  }

  ssi = rsnd_ssi_get(priv, i);

  snprintf(name, RSND_SSI_NAME_SIZE, "%s.%d",
    SSI_NAME, i);

  clk = devm_clk_get(dev, name);
  if (IS_ERR(clk)) {
   ret = PTR_ERR(clk);
   goto rsnd_ssi_probe_done;
  }

  if (of_property_read_bool(np, "shared-pin"))
   rsnd_flags_set(ssi, RSND_SSI_CLK_PIN_SHARE);

  if (of_property_read_bool(np, "no-busif"))
   rsnd_flags_set(ssi, RSND_SSI_NO_BUSIF);

  ssi->irq = irq_of_parse_and_map(np, 0);
  if (!ssi->irq) {
   ret = -EINVAL;
   goto rsnd_ssi_probe_done;
  }

  if (of_property_read_bool(np, "pio-transfer"))
   ops = &rsnd_ssi_pio_ops;
  else
   ops = &rsnd_ssi_dma_ops;

  ret = rsnd_mod_init(priv, rsnd_mod_get(ssi), ops, clk,
        RSND_MOD_SSI, i);
  if (ret)
   goto rsnd_ssi_probe_done;

skip:
  i++;
 }

 ret = 0;

rsnd_ssi_probe_done:
 of_node_put(node);

 return ret;
}

void rsnd_ssi_remove(struct rsnd_priv *priv)
{
 struct rsnd_ssi *ssi;
 int i;

 for_each_rsnd_ssi(ssi, priv, i) {
  rsnd_mod_quit(rsnd_mod_get(ssi));
 }
}