1 // SPDX-License-Identifier: GPL-2.0 2 // 3 // Renesas R-Car SSIU support 4 // 5 // Copyright (c) 2015 Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> 6 7 #include "rsnd.h" 8 9 #define SSIU_NAME "ssiu" 10 11 struct rsnd_ssiu { 12 struct rsnd_mod mod; 13 }; 14 15 #define rsnd_ssiu_nr(priv) ((priv)->ssiu_nr) 16 #define for_each_rsnd_ssiu(pos, priv, i) \ 17 for (i = 0; \ 18 (i < rsnd_ssiu_nr(priv)) && \ 19 ((pos) = ((struct rsnd_ssiu *)(priv)->ssiu + i)); \ 20 i++) 21 22 static int rsnd_ssiu_init(struct rsnd_mod *mod, 23 struct rsnd_dai_stream *io, 24 struct rsnd_priv *priv) 25 { 26 struct rsnd_dai *rdai = rsnd_io_to_rdai(io); 27 u32 multi_ssi_slaves = rsnd_ssi_multi_slaves_runtime(io); 28 int use_busif = rsnd_ssi_use_busif(io); 29 int id = rsnd_mod_id(mod); 30 u32 mask1, val1; 31 u32 mask2, val2; 32 33 /* clear status */ 34 switch (id) { 35 case 0: 36 case 1: 37 case 2: 38 case 3: 39 case 4: 40 rsnd_mod_write(mod, SSI_SYS_STATUS0, 0xf << (id * 4)); 41 rsnd_mod_write(mod, SSI_SYS_STATUS2, 0xf << (id * 4)); 42 rsnd_mod_write(mod, SSI_SYS_STATUS4, 0xf << (id * 4)); 43 rsnd_mod_write(mod, SSI_SYS_STATUS6, 0xf << (id * 4)); 44 break; 45 case 9: 46 rsnd_mod_write(mod, SSI_SYS_STATUS1, 0xf << 4); 47 rsnd_mod_write(mod, SSI_SYS_STATUS3, 0xf << 4); 48 rsnd_mod_write(mod, SSI_SYS_STATUS5, 0xf << 4); 49 rsnd_mod_write(mod, SSI_SYS_STATUS7, 0xf << 4); 50 break; 51 } 52 53 /* 54 * SSI_MODE0 55 */ 56 rsnd_mod_bset(mod, SSI_MODE0, (1 << id), !use_busif << id); 57 58 /* 59 * SSI_MODE1 60 */ 61 mask1 = (1 << 4) | (1 << 20); /* mask sync bit */ 62 mask2 = (1 << 4); /* mask sync bit */ 63 val1 = val2 = 0; 64 if (id == 8) { 65 /* 66 * SSI8 pin is sharing with SSI7, nothing to do. 67 */ 68 } else if (rsnd_ssi_is_pin_sharing(io)) { 69 int shift = -1; 70 71 switch (id) { 72 case 1: 73 shift = 0; 74 break; 75 case 2: 76 shift = 2; 77 break; 78 case 4: 79 shift = 16; 80 break; 81 default: 82 return -EINVAL; 83 } 84 85 mask1 |= 0x3 << shift; 86 val1 = rsnd_rdai_is_clk_master(rdai) ? 87 0x2 << shift : 0x1 << shift; 88 89 } else if (multi_ssi_slaves) { 90 91 mask2 |= 0x00000007; 92 mask1 |= 0x0000000f; 93 94 switch (multi_ssi_slaves) { 95 case 0x0206: /* SSI0/1/2/9 */ 96 val2 = (1 << 4) | /* SSI0129 sync */ 97 (rsnd_rdai_is_clk_master(rdai) ? 0x2 : 0x1); 98 /* fall through */ 99 case 0x0006: /* SSI0/1/2 */ 100 val1 = rsnd_rdai_is_clk_master(rdai) ? 101 0xa : 0x5; 102 103 if (!val2) /* SSI012 sync */ 104 val1 |= (1 << 4); 105 } 106 } 107 108 rsnd_mod_bset(mod, SSI_MODE1, mask1, val1); 109 rsnd_mod_bset(mod, SSI_MODE2, mask2, val2); 110 111 return 0; 112 } 113 114 static struct rsnd_mod_ops rsnd_ssiu_ops_gen1 = { 115 .name = SSIU_NAME, 116 .init = rsnd_ssiu_init, 117 }; 118 119 static int rsnd_ssiu_init_gen2(struct rsnd_mod *mod, 120 struct rsnd_dai_stream *io, 121 struct rsnd_priv *priv) 122 { 123 int hdmi = rsnd_ssi_hdmi_port(io); 124 int ret; 125 u32 mode = 0; 126 127 ret = rsnd_ssiu_init(mod, io, priv); 128 if (ret < 0) 129 return ret; 130 131 if (rsnd_runtime_is_ssi_tdm(io)) { 132 /* 133 * TDM Extend Mode 134 * see 135 * rsnd_ssi_config_init() 136 */ 137 mode = 0x1; 138 } 139 140 rsnd_mod_write(mod, SSI_MODE, mode); 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_kcalloc(dev, nr, sizeof(*ssiu), 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 } 290