sound/soc/sh/rcar/ssiu.c

   1 /*
   2  * Renesas R-Car SSIU support
   3  *
   4  * Copyright (c) 2015 Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  */
  10 #include "rsnd.h"
  11
  12 #define SSIU_NAME "ssiu"
  13
  14 struct rsnd_ssiu {
  15         struct rsnd_mod mod;
  16 };
  17
  18 #define rsnd_ssiu_nr(priv) ((priv)->ssiu_nr)
  19 #define for_each_rsnd_ssiu(pos, priv, i)                                \
  20         for (i = 0;                                                     \
  21              (i < rsnd_ssiu_nr(priv)) &&                                \
  22                      ((pos) = ((struct rsnd_ssiu *)(priv)->ssiu + i));  \
  23              i++)
  24
  25 static int rsnd_ssiu_init(struct rsnd_mod *mod,
  26                           struct rsnd_dai_stream *io,
  27                           struct rsnd_priv *priv)
  28 {
  29         struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
  30         u32 multi_ssi_slaves = rsnd_ssi_multi_slaves_runtime(io);
  31         int use_busif = rsnd_ssi_use_busif(io);
  32         int id = rsnd_mod_id(mod);
  33         u32 mask1, val1;
  34         u32 mask2, val2;
  35
  36         /*
  37          * SSI_MODE0
  38          */
  39         rsnd_mod_bset(mod, SSI_MODE0, (1 << id), !use_busif << id);
  40
  41         /*
  42          * SSI_MODE1
  43          */
  44         mask1 = (1 << 4) | (1 << 20);   /* mask sync bit */
  45         mask2 = (1 << 4);               /* mask sync bit */
  46         val1  = val2  = 0;
  47         if (rsnd_ssi_is_pin_sharing(io)) {
  48                 int shift = -1;
  49
  50                 switch (id) {
  51                 case 1:
  52                         shift = 0;
  53                         break;
  54                 case 2:
  55                         shift = 2;
  56                         break;
  57                 case 4:
  58                         shift = 16;
  59                         break;
  60                 default:
  61                         return -EINVAL;
  62                 }
  63
  64                 mask1 |= 0x3 << shift;
  65                 val1 = rsnd_rdai_is_clk_master(rdai) ?
  66                         0x2 << shift : 0x1 << shift;
  67
  68         } else if (multi_ssi_slaves) {
  69
  70                 mask2 |= 0x00000007;
  71                 mask1 |= 0x0000000f;
  72
  73                 switch (multi_ssi_slaves) {
  74                 case 0x0206: /* SSI0/1/2/9 */
  75                         val2 = (1 << 4) | /* SSI0129 sync */
  76                                 (rsnd_rdai_is_clk_master(rdai) ? 0x2 : 0x1);
  77                         /* fall through */
  78                 case 0x0006: /* SSI0/1/2 */
  79                         val1 = rsnd_rdai_is_clk_master(rdai) ?
  80                                 0xa : 0x5;
  81
  82                         if (!val2)  /* SSI012 sync */
  83                                 val1 |= (1 << 4);
  84                 }
  85         }
  86
  87         rsnd_mod_bset(mod, SSI_MODE1, mask1, val1);
  88         rsnd_mod_bset(mod, SSI_MODE2, mask2, val2);
  89
  90         return 0;
  91 }
  92
  93 static struct rsnd_mod_ops rsnd_ssiu_ops_gen1 = {
  94         .name   = SSIU_NAME,
  95         .init   = rsnd_ssiu_init,
  96 };
  97
  98 static int rsnd_ssiu_init_gen2(struct rsnd_mod *mod,
  99                                struct rsnd_dai_stream *io,
 100                                struct rsnd_priv *priv)
 101 {
 102         int ret;
 103
 104         ret = rsnd_ssiu_init(mod, io, priv);
 105         if (ret < 0)
 106                 return ret;
 107
 108         if (rsnd_runtime_is_ssi_tdm(io)) {
 109                 /*
 110                  * TDM Extend Mode
 111                  * see
 112                  *      rsnd_ssi_config_init()
 113                  */
 114                 rsnd_mod_write(mod, SSI_MODE, 0x1);
 115         }
 116
 117         if (rsnd_ssi_use_busif(io)) {
 118                 rsnd_mod_write(mod, SSI_BUSIF_ADINR,
 119                                rsnd_get_adinr_bit(mod, io) |
 120                                (rsnd_io_is_play(io) ?
 121                                 rsnd_runtime_channel_after_ctu(io) :
 122                                 rsnd_runtime_channel_original(io)));
 123                 rsnd_mod_write(mod, SSI_BUSIF_MODE,  1);
 124                 rsnd_mod_write(mod, SSI_BUSIF_DALIGN,
 125                                rsnd_get_dalign(mod, io));
 126         }
 127
 128         return 0;
 129 }
 130
 131 static int rsnd_ssiu_start_gen2(struct rsnd_mod *mod,
 132                                 struct rsnd_dai_stream *io,
 133                                 struct rsnd_priv *priv)
 134 {
 135         if (!rsnd_ssi_use_busif(io))
 136                 return 0;
 137
 138         rsnd_mod_write(mod, SSI_CTRL, 0x1);
 139
 140         if (rsnd_ssi_multi_slaves_runtime(io))
 141                 rsnd_mod_write(mod, SSI_CONTROL, 0x1);
 142
 143         return 0;
 144 }
 145
 146 static int rsnd_ssiu_stop_gen2(struct rsnd_mod *mod,
 147                                struct rsnd_dai_stream *io,
 148                                struct rsnd_priv *priv)
 149 {
 150         if (!rsnd_ssi_use_busif(io))
 151                 return 0;
 152
 153         rsnd_mod_write(mod, SSI_CTRL, 0);
 154
 155         if (rsnd_ssi_multi_slaves_runtime(io))
 156                 rsnd_mod_write(mod, SSI_CONTROL, 0);
 157
 158         return 0;
 159 }
 160
 161 static struct rsnd_mod_ops rsnd_ssiu_ops_gen2 = {
 162         .name   = SSIU_NAME,
 163         .init   = rsnd_ssiu_init_gen2,
 164         .start  = rsnd_ssiu_start_gen2,
 165         .stop   = rsnd_ssiu_stop_gen2,
 166 };
 167
 168 static struct rsnd_mod *rsnd_ssiu_mod_get(struct rsnd_priv *priv, int id)
 169 {
 170         if (WARN_ON(id < 0 || id >= rsnd_ssiu_nr(priv)))
 171                 id = 0;
 172
 173         return rsnd_mod_get((struct rsnd_ssiu *)(priv->ssiu) + id);
 174 }
 175
 176 int rsnd_ssiu_attach(struct rsnd_dai_stream *io,
 177                      struct rsnd_mod *ssi_mod)
 178 {
 179         struct rsnd_priv *priv = rsnd_io_to_priv(io);
 180         struct rsnd_mod *mod = rsnd_ssiu_mod_get(priv, rsnd_mod_id(ssi_mod));
 181
 182         rsnd_mod_confirm_ssi(ssi_mod);
 183
 184         return rsnd_dai_connect(mod, io, mod->type);
 185 }
 186
 187 int rsnd_ssiu_probe(struct rsnd_priv *priv)
 188 {
 189         struct device *dev = rsnd_priv_to_dev(priv);
 190         struct rsnd_ssiu *ssiu;
 191         static struct rsnd_mod_ops *ops;
 192         int i, nr, ret;
 193
 194         /* same number to SSI */
 195         nr      = priv->ssi_nr;
 196         ssiu    = devm_kzalloc(dev, sizeof(*ssiu) * nr, GFP_KERNEL);
 197         if (!ssiu)
 198                 return -ENOMEM;
 199
 200         priv->ssiu      = ssiu;
 201         priv->ssiu_nr   = nr;
 202
 203         if (rsnd_is_gen1(priv))
 204                 ops = &rsnd_ssiu_ops_gen1;
 205         else
 206                 ops = &rsnd_ssiu_ops_gen2;
 207
 208         for_each_rsnd_ssiu(ssiu, priv, i) {
 209                 ret = rsnd_mod_init(priv, rsnd_mod_get(ssiu),
 210                                     ops, NULL, rsnd_mod_get_status,
 211                                     RSND_MOD_SSIU, i);
 212                 if (ret)
 213                         return ret;
 214         }
 215
 216         return 0;
 217 }
 218
 219 void rsnd_ssiu_remove(struct rsnd_priv *priv)
 220 {
 221         struct rsnd_ssiu *ssiu;
 222         int i;
 223
 224         for_each_rsnd_ssiu(ssiu, priv, i) {
 225                 rsnd_mod_quit(rsnd_mod_get(ssiu));
 226         }
 227 }