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         /* clear status */
  37         switch (id) {
  38         case 0:
  39         case 1:
  40         case 2:
  41         case 3:
  42         case 4:
  43                 rsnd_mod_write(mod, SSI_SYS_STATUS0, 0xf << (id * 4));
  44                 rsnd_mod_write(mod, SSI_SYS_STATUS2, 0xf << (id * 4));
  45                 rsnd_mod_write(mod, SSI_SYS_STATUS4, 0xf << (id * 4));
  46                 rsnd_mod_write(mod, SSI_SYS_STATUS6, 0xf << (id * 4));
  47                 break;
  48         case 9:
  49                 rsnd_mod_write(mod, SSI_SYS_STATUS1, 0xf << 4);
  50                 rsnd_mod_write(mod, SSI_SYS_STATUS3, 0xf << 4);
  51                 rsnd_mod_write(mod, SSI_SYS_STATUS5, 0xf << 4);
  52                 rsnd_mod_write(mod, SSI_SYS_STATUS7, 0xf << 4);
  53                 break;
  54         }
  55
  56         /*
  57          * SSI_MODE0
  58          */
  59         rsnd_mod_bset(mod, SSI_MODE0, (1 << id), !use_busif << id);
  60
  61         /*
  62          * SSI_MODE1
  63          */
  64         mask1 = (1 << 4) | (1 << 20);   /* mask sync bit */
  65         mask2 = (1 << 4);               /* mask sync bit */
  66         val1  = val2  = 0;
  67         if (id == 8) {
  68                 /*
  69                  * SSI8 pin is sharing with SSI7, nothing to do.
  70                  */
  71         } else if (rsnd_ssi_is_pin_sharing(io)) {
  72                 int shift = -1;
  73
  74                 switch (id) {
  75                 case 1:
  76                         shift = 0;
  77                         break;
  78                 case 2:
  79                         shift = 2;
  80                         break;
  81                 case 4:
  82                         shift = 16;
  83                         break;
  84                 default:
  85                         return -EINVAL;
  86                 }
  87
  88                 mask1 |= 0x3 << shift;
  89                 val1 = rsnd_rdai_is_clk_master(rdai) ?
  90                         0x2 << shift : 0x1 << shift;
  91
  92         } else if (multi_ssi_slaves) {
  93
  94                 mask2 |= 0x00000007;
  95                 mask1 |= 0x0000000f;
  96
  97                 switch (multi_ssi_slaves) {
  98                 case 0x0206: /* SSI0/1/2/9 */
  99                         val2 = (1 << 4) | /* SSI0129 sync */
 100                                 (rsnd_rdai_is_clk_master(rdai) ? 0x2 : 0x1);
 101                         /* fall through */
 102                 case 0x0006: /* SSI0/1/2 */
 103                         val1 = rsnd_rdai_is_clk_master(rdai) ?
 104                                 0xa : 0x5;
 105
 106                         if (!val2)  /* SSI012 sync */
 107                                 val1 |= (1 << 4);
 108                 }
 109         }
 110
 111         rsnd_mod_bset(mod, SSI_MODE1, mask1, val1);
 112         rsnd_mod_bset(mod, SSI_MODE2, mask2, val2);
 113
 114         return 0;
 115 }
 116
 117 static struct rsnd_mod_ops rsnd_ssiu_ops_gen1 = {
 118         .name   = SSIU_NAME,
 119         .init   = rsnd_ssiu_init,
 120 };
 121
 122 static int rsnd_ssiu_init_gen2(struct rsnd_mod *mod,
 123                                struct rsnd_dai_stream *io,
 124                                struct rsnd_priv *priv)
 125 {
 126         int hdmi = rsnd_ssi_hdmi_port(io);
 127         int ret;
 128
 129         ret = rsnd_ssiu_init(mod, io, priv);
 130         if (ret < 0)
 131                 return ret;
 132
 133         if (rsnd_runtime_is_ssi_tdm(io)) {
 134                 /*
 135                  * TDM Extend Mode
 136                  * see
 137                  *      rsnd_ssi_config_init()
 138                  */
 139                 rsnd_mod_write(mod, SSI_MODE, 0x1);
 140         }
 141
 142         if (rsnd_ssi_use_busif(io)) {
 143                 rsnd_mod_write(mod, SSI_BUSIF_ADINR,
 144                                rsnd_get_adinr_bit(mod, io) |
 145                                (rsnd_io_is_play(io) ?
 146                                 rsnd_runtime_channel_after_ctu(io) :
 147                                 rsnd_runtime_channel_original(io)));
 148                 rsnd_mod_write(mod, SSI_BUSIF_MODE,
 149                                rsnd_get_busif_shift(io, mod) | 1);
 150                 rsnd_mod_write(mod, SSI_BUSIF_DALIGN,
 151                                rsnd_get_dalign(mod, io));
 152         }
 153
 154         if (hdmi) {
 155                 enum rsnd_mod_type rsnd_ssi_array[] = {
 156                         RSND_MOD_SSIM1,
 157                         RSND_MOD_SSIM2,
 158                         RSND_MOD_SSIM3,
 159                 };
 160                 struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io);
 161                 struct rsnd_mod *pos;
 162                 u32 val;
 163                 int i, shift;
 164
 165                 i = rsnd_mod_id(ssi_mod);
 166
 167                 /* output all same SSI as default */
 168                 val =   i << 16 |
 169                         i << 20 |
 170                         i << 24 |
 171                         i << 28 |
 172                         i;
 173
 174                 for_each_rsnd_mod_array(i, pos, io, rsnd_ssi_array) {
 175                         shift   = (i * 4) + 16;
 176                         val     = (val & ~(0xF << shift)) |
 177                                 rsnd_mod_id(pos) << shift;
 178                 }
 179
 180                 switch (hdmi) {
 181                 case RSND_SSI_HDMI_PORT0:
 182                         rsnd_mod_write(mod, HDMI0_SEL, val);
 183                         break;
 184                 case RSND_SSI_HDMI_PORT1:
 185                         rsnd_mod_write(mod, HDMI1_SEL, val);
 186                         break;
 187                 }
 188         }
 189
 190         return 0;
 191 }
 192
 193 static int rsnd_ssiu_start_gen2(struct rsnd_mod *mod,
 194                                 struct rsnd_dai_stream *io,
 195                                 struct rsnd_priv *priv)
 196 {
 197         if (!rsnd_ssi_use_busif(io))
 198                 return 0;
 199
 200         rsnd_mod_write(mod, SSI_CTRL, 0x1);
 201
 202         if (rsnd_ssi_multi_slaves_runtime(io))
 203                 rsnd_mod_write(mod, SSI_CONTROL, 0x1);
 204
 205         return 0;
 206 }
 207
 208 static int rsnd_ssiu_stop_gen2(struct rsnd_mod *mod,
 209                                struct rsnd_dai_stream *io,
 210                                struct rsnd_priv *priv)
 211 {
 212         if (!rsnd_ssi_use_busif(io))
 213                 return 0;
 214
 215         rsnd_mod_write(mod, SSI_CTRL, 0);
 216
 217         if (rsnd_ssi_multi_slaves_runtime(io))
 218                 rsnd_mod_write(mod, SSI_CONTROL, 0);
 219
 220         return 0;
 221 }
 222
 223 static struct rsnd_mod_ops rsnd_ssiu_ops_gen2 = {
 224         .name   = SSIU_NAME,
 225         .init   = rsnd_ssiu_init_gen2,
 226         .start  = rsnd_ssiu_start_gen2,
 227         .stop   = rsnd_ssiu_stop_gen2,
 228 };
 229
 230 static struct rsnd_mod *rsnd_ssiu_mod_get(struct rsnd_priv *priv, int id)
 231 {
 232         if (WARN_ON(id < 0 || id >= rsnd_ssiu_nr(priv)))
 233                 id = 0;
 234
 235         return rsnd_mod_get((struct rsnd_ssiu *)(priv->ssiu) + id);
 236 }
 237
 238 int rsnd_ssiu_attach(struct rsnd_dai_stream *io,
 239                      struct rsnd_mod *ssi_mod)
 240 {
 241         struct rsnd_priv *priv = rsnd_io_to_priv(io);
 242         struct rsnd_mod *mod = rsnd_ssiu_mod_get(priv, rsnd_mod_id(ssi_mod));
 243
 244         rsnd_mod_confirm_ssi(ssi_mod);
 245
 246         return rsnd_dai_connect(mod, io, mod->type);
 247 }
 248
 249 int rsnd_ssiu_probe(struct rsnd_priv *priv)
 250 {
 251         struct device *dev = rsnd_priv_to_dev(priv);
 252         struct rsnd_ssiu *ssiu;
 253         struct rsnd_mod_ops *ops;
 254         int i, nr, ret;
 255
 256         /* same number to SSI */
 257         nr      = priv->ssi_nr;
 258         ssiu    = devm_kzalloc(dev, sizeof(*ssiu) * nr, GFP_KERNEL);
 259         if (!ssiu)
 260                 return -ENOMEM;
 261
 262         priv->ssiu      = ssiu;
 263         priv->ssiu_nr   = nr;
 264
 265         if (rsnd_is_gen1(priv))
 266                 ops = &rsnd_ssiu_ops_gen1;
 267         else
 268                 ops = &rsnd_ssiu_ops_gen2;
 269
 270         for_each_rsnd_ssiu(ssiu, priv, i) {
 271                 ret = rsnd_mod_init(priv, rsnd_mod_get(ssiu),
 272                                     ops, NULL, rsnd_mod_get_status,
 273                                     RSND_MOD_SSIU, i);
 274                 if (ret)
 275                         return ret;
 276         }
 277
 278         return 0;
 279 }
 280
 281 void rsnd_ssiu_remove(struct rsnd_priv *priv)
 282 {
 283         struct rsnd_ssiu *ssiu;
 284         int i;
 285
 286         for_each_rsnd_ssiu(ssiu, priv, i) {
 287                 rsnd_mod_quit(rsnd_mod_get(ssiu));
 288         }
 289 }