0001
0002
0003
0004
0005
0006
0007 #include "rsnd.h"
0008
0009 #define SSIU_NAME "ssiu"
0010
0011 struct rsnd_ssiu {
0012 struct rsnd_mod mod;
0013 u32 busif_status[8];
0014 unsigned int usrcnt;
0015 int id;
0016 int id_sub;
0017 };
0018
0019
0020 #define TDM_EXT (1 << 0)
0021 #define TDM_SPLIT (1 << 8)
0022
0023 #define rsnd_ssiu_nr(priv) ((priv)->ssiu_nr)
0024 #define rsnd_mod_to_ssiu(_mod) container_of((_mod), struct rsnd_ssiu, mod)
0025 #define for_each_rsnd_ssiu(pos, priv, i) \
0026 for (i = 0; \
0027 (i < rsnd_ssiu_nr(priv)) && \
0028 ((pos) = ((struct rsnd_ssiu *)(priv)->ssiu + i)); \
0029 i++)
0030
0031
0032
0033
0034
0035
0036
0037
0038
0039
0040
0041
0042
0043
0044
0045 static const int gen2_id[] = { 0, 4, 8, 12, 13, 14, 15, 16, 17, 18 };
0046 static const int gen3_id[] = { 0, 8, 16, 24, 32, 40, 41, 42, 43, 44 };
0047
0048
0049 #define rsnd_ssiu_busif_err_irq_enable(mod) rsnd_ssiu_busif_err_irq_ctrl(mod, 1)
0050 #define rsnd_ssiu_busif_err_irq_disable(mod) rsnd_ssiu_busif_err_irq_ctrl(mod, 0)
0051 static void rsnd_ssiu_busif_err_irq_ctrl(struct rsnd_mod *mod, int enable)
0052 {
0053 int id = rsnd_mod_id(mod);
0054 int shift, offset;
0055 int i;
0056
0057 switch (id) {
0058 case 0:
0059 case 1:
0060 case 2:
0061 case 3:
0062 case 4:
0063 shift = id;
0064 offset = 0;
0065 break;
0066 case 9:
0067 shift = 1;
0068 offset = 1;
0069 break;
0070 default:
0071 return;
0072 }
0073
0074 for (i = 0; i < 4; i++) {
0075 enum rsnd_reg reg = SSI_SYS_INT_ENABLE((i * 2) + offset);
0076 u32 val = 0xf << (shift * 4);
0077 u32 sys_int_enable = rsnd_mod_read(mod, reg);
0078
0079 if (enable)
0080 sys_int_enable |= val;
0081 else
0082 sys_int_enable &= ~val;
0083 rsnd_mod_write(mod, reg, sys_int_enable);
0084 }
0085 }
0086
0087 bool rsnd_ssiu_busif_err_status_clear(struct rsnd_mod *mod)
0088 {
0089 bool error = false;
0090 int id = rsnd_mod_id(mod);
0091 int shift, offset;
0092 int i;
0093
0094 switch (id) {
0095 case 0:
0096 case 1:
0097 case 2:
0098 case 3:
0099 case 4:
0100 shift = id;
0101 offset = 0;
0102 break;
0103 case 9:
0104 shift = 1;
0105 offset = 1;
0106 break;
0107 default:
0108 goto out;
0109 }
0110
0111 for (i = 0; i < 4; i++) {
0112 u32 reg = SSI_SYS_STATUS(i * 2) + offset;
0113 u32 status = rsnd_mod_read(mod, reg);
0114 u32 val = 0xf << (shift * 4);
0115
0116 status &= val;
0117 if (status) {
0118 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
0119 struct device *dev = rsnd_priv_to_dev(priv);
0120
0121 rsnd_print_irq_status(dev, "%s err status : 0x%08x\n",
0122 rsnd_mod_name(mod), status);
0123 error = true;
0124 }
0125 rsnd_mod_write(mod, reg, val);
0126 }
0127 out:
0128 return error;
0129 }
0130
0131 static u32 *rsnd_ssiu_get_status(struct rsnd_mod *mod,
0132 struct rsnd_dai_stream *io,
0133 enum rsnd_mod_type type)
0134 {
0135 struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
0136 int busif = rsnd_mod_id_sub(mod);
0137
0138 return &ssiu->busif_status[busif];
0139 }
0140
0141 static int rsnd_ssiu_init(struct rsnd_mod *mod,
0142 struct rsnd_dai_stream *io,
0143 struct rsnd_priv *priv)
0144 {
0145 struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
0146 u32 ssis = rsnd_ssi_multi_secondaries_runtime(io);
0147 int use_busif = rsnd_ssi_use_busif(io);
0148 int id = rsnd_mod_id(mod);
0149 int is_clk_master = rsnd_rdai_is_clk_master(rdai);
0150 u32 val1, val2;
0151
0152
0153 rsnd_ssiu_busif_err_status_clear(mod);
0154
0155
0156
0157
0158 rsnd_mod_bset(mod, SSI_MODE0, (1 << id), !use_busif << id);
0159
0160
0161
0162
0163
0164
0165
0166 val1 = rsnd_mod_read(mod, SSI_MODE1);
0167 val2 = rsnd_mod_read(mod, SSI_MODE2);
0168 if (rsnd_ssi_is_pin_sharing(io)) {
0169
0170 ssis |= (1 << id);
0171
0172 } else if (ssis) {
0173
0174
0175
0176
0177
0178
0179
0180 if (ssis & (1 << 4))
0181 val1 |= (1 << 20);
0182
0183 if (ssis == 0x0006)
0184 val1 |= (1 << 4);
0185
0186 if (ssis == 0x0206)
0187 val2 |= (1 << 4);
0188 }
0189
0190
0191 if (ssis & (1 << 1))
0192 val1 |= is_clk_master ? 0x2 : 0x1;
0193
0194
0195 if (ssis & (1 << 2))
0196 val1 |= is_clk_master ? 0x2 << 2 :
0197 0x1 << 2;
0198
0199 if (ssis & (1 << 4))
0200 val1 |= is_clk_master ? 0x2 << 16 :
0201 0x1 << 16;
0202
0203 if (ssis & (1 << 9))
0204 val2 |= is_clk_master ? 0x2 : 0x1;
0205
0206 rsnd_mod_bset(mod, SSI_MODE1, 0x0013001f, val1);
0207 rsnd_mod_bset(mod, SSI_MODE2, 0x00000017, val2);
0208
0209
0210
0211
0212
0213
0214
0215 rsnd_ssiu_busif_err_irq_enable(mod);
0216
0217 return 0;
0218 }
0219
0220 static int rsnd_ssiu_quit(struct rsnd_mod *mod,
0221 struct rsnd_dai_stream *io,
0222 struct rsnd_priv *priv)
0223 {
0224
0225 rsnd_ssiu_busif_err_irq_disable(mod);
0226
0227 return 0;
0228 }
0229
0230 static struct rsnd_mod_ops rsnd_ssiu_ops_gen1 = {
0231 .name = SSIU_NAME,
0232 .init = rsnd_ssiu_init,
0233 .quit = rsnd_ssiu_quit,
0234 .get_status = rsnd_ssiu_get_status,
0235 };
0236
0237 static int rsnd_ssiu_init_gen2(struct rsnd_mod *mod,
0238 struct rsnd_dai_stream *io,
0239 struct rsnd_priv *priv)
0240 {
0241 struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
0242 u32 has_hdmi0 = rsnd_flags_has(io, RSND_STREAM_HDMI0);
0243 u32 has_hdmi1 = rsnd_flags_has(io, RSND_STREAM_HDMI1);
0244 int ret;
0245 u32 mode = 0;
0246
0247 ret = rsnd_ssiu_init(mod, io, priv);
0248 if (ret < 0)
0249 return ret;
0250
0251 ssiu->usrcnt++;
0252
0253
0254
0255
0256
0257
0258 if (rsnd_runtime_is_tdm(io))
0259 mode = TDM_EXT;
0260 else if (rsnd_runtime_is_tdm_split(io))
0261 mode = TDM_SPLIT;
0262
0263 rsnd_mod_write(mod, SSI_MODE, mode);
0264
0265 if (rsnd_ssi_use_busif(io)) {
0266 int id = rsnd_mod_id(mod);
0267 int busif = rsnd_mod_id_sub(mod);
0268 enum rsnd_reg adinr_reg, mode_reg, dalign_reg;
0269
0270 if ((id == 9) && (busif >= 4)) {
0271 adinr_reg = SSI9_BUSIF_ADINR(busif);
0272 mode_reg = SSI9_BUSIF_MODE(busif);
0273 dalign_reg = SSI9_BUSIF_DALIGN(busif);
0274 } else {
0275 adinr_reg = SSI_BUSIF_ADINR(busif);
0276 mode_reg = SSI_BUSIF_MODE(busif);
0277 dalign_reg = SSI_BUSIF_DALIGN(busif);
0278 }
0279
0280 rsnd_mod_write(mod, adinr_reg,
0281 rsnd_get_adinr_bit(mod, io) |
0282 (rsnd_io_is_play(io) ?
0283 rsnd_runtime_channel_after_ctu(io) :
0284 rsnd_runtime_channel_original(io)));
0285 rsnd_mod_write(mod, mode_reg,
0286 rsnd_get_busif_shift(io, mod) | 1);
0287 rsnd_mod_write(mod, dalign_reg,
0288 rsnd_get_dalign(mod, io));
0289 }
0290
0291 if (has_hdmi0 || has_hdmi1) {
0292 enum rsnd_mod_type rsnd_ssi_array[] = {
0293 RSND_MOD_SSIM1,
0294 RSND_MOD_SSIM2,
0295 RSND_MOD_SSIM3,
0296 };
0297 struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io);
0298 struct rsnd_mod *pos;
0299 u32 val;
0300 int i;
0301
0302 i = rsnd_mod_id(ssi_mod);
0303
0304
0305 val = i << 16 |
0306 i << 20 |
0307 i << 24 |
0308 i << 28 |
0309 i;
0310
0311 for_each_rsnd_mod_array(i, pos, io, rsnd_ssi_array) {
0312 int shift = (i * 4) + 20;
0313
0314 val = (val & ~(0xF << shift)) |
0315 rsnd_mod_id(pos) << shift;
0316 }
0317
0318 if (has_hdmi0)
0319 rsnd_mod_write(mod, HDMI0_SEL, val);
0320 if (has_hdmi1)
0321 rsnd_mod_write(mod, HDMI1_SEL, val);
0322 }
0323
0324 return 0;
0325 }
0326
0327 static int rsnd_ssiu_start_gen2(struct rsnd_mod *mod,
0328 struct rsnd_dai_stream *io,
0329 struct rsnd_priv *priv)
0330 {
0331 int busif = rsnd_mod_id_sub(mod);
0332
0333 if (!rsnd_ssi_use_busif(io))
0334 return 0;
0335
0336 rsnd_mod_bset(mod, SSI_CTRL, 1 << (busif * 4), 1 << (busif * 4));
0337
0338 if (rsnd_ssi_multi_secondaries_runtime(io))
0339 rsnd_mod_write(mod, SSI_CONTROL, 0x1);
0340
0341 return 0;
0342 }
0343
0344 static int rsnd_ssiu_stop_gen2(struct rsnd_mod *mod,
0345 struct rsnd_dai_stream *io,
0346 struct rsnd_priv *priv)
0347 {
0348 struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
0349 int busif = rsnd_mod_id_sub(mod);
0350
0351 if (!rsnd_ssi_use_busif(io))
0352 return 0;
0353
0354 rsnd_mod_bset(mod, SSI_CTRL, 1 << (busif * 4), 0);
0355
0356 if (--ssiu->usrcnt)
0357 return 0;
0358
0359 if (rsnd_ssi_multi_secondaries_runtime(io))
0360 rsnd_mod_write(mod, SSI_CONTROL, 0);
0361
0362 return 0;
0363 }
0364
0365 static int rsnd_ssiu_id(struct rsnd_mod *mod)
0366 {
0367 struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
0368
0369
0370 return ssiu->id;
0371 }
0372
0373 static int rsnd_ssiu_id_sub(struct rsnd_mod *mod)
0374 {
0375 struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
0376
0377
0378 return ssiu->id_sub;
0379 }
0380
0381 static struct dma_chan *rsnd_ssiu_dma_req(struct rsnd_dai_stream *io,
0382 struct rsnd_mod *mod)
0383 {
0384 struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
0385 int is_play = rsnd_io_is_play(io);
0386 char *name;
0387
0388
0389
0390
0391
0392
0393
0394
0395
0396
0397
0398
0399 name = is_play ? "rx" : "tx";
0400
0401 return rsnd_dma_request_channel(rsnd_ssiu_of_node(priv),
0402 SSIU_NAME, mod, name);
0403 }
0404
0405 #ifdef CONFIG_DEBUG_FS
0406 static void rsnd_ssiu_debug_info(struct seq_file *m,
0407 struct rsnd_dai_stream *io,
0408 struct rsnd_mod *mod)
0409 {
0410 rsnd_debugfs_mod_reg_show(m, mod, RSND_GEN2_SSIU,
0411 rsnd_mod_id(mod) * 0x80, 0x80);
0412 }
0413 #define DEBUG_INFO .debug_info = rsnd_ssiu_debug_info
0414 #else
0415 #define DEBUG_INFO
0416 #endif
0417
0418 static struct rsnd_mod_ops rsnd_ssiu_ops_gen2 = {
0419 .name = SSIU_NAME,
0420 .dma_req = rsnd_ssiu_dma_req,
0421 .init = rsnd_ssiu_init_gen2,
0422 .quit = rsnd_ssiu_quit,
0423 .start = rsnd_ssiu_start_gen2,
0424 .stop = rsnd_ssiu_stop_gen2,
0425 .get_status = rsnd_ssiu_get_status,
0426 DEBUG_INFO
0427 };
0428
0429 static struct rsnd_mod *rsnd_ssiu_mod_get(struct rsnd_priv *priv, int id)
0430 {
0431 if (WARN_ON(id < 0 || id >= rsnd_ssiu_nr(priv)))
0432 id = 0;
0433
0434 return rsnd_mod_get((struct rsnd_ssiu *)(priv->ssiu) + id);
0435 }
0436
0437 static void rsnd_parse_connect_ssiu_compatible(struct rsnd_priv *priv,
0438 struct rsnd_dai_stream *io)
0439 {
0440 struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io);
0441 struct rsnd_ssiu *ssiu;
0442 int is_dma_mode;
0443 int i;
0444
0445 if (!ssi_mod)
0446 return;
0447
0448 is_dma_mode = rsnd_ssi_is_dma_mode(ssi_mod);
0449
0450
0451 for_each_rsnd_ssiu(ssiu, priv, i) {
0452 struct rsnd_mod *mod = rsnd_mod_get(ssiu);
0453
0454 if (is_dma_mode &&
0455 (rsnd_mod_id(ssi_mod) == rsnd_mod_id(mod)) &&
0456 (rsnd_mod_id_sub(mod) == 0)) {
0457 rsnd_dai_connect(mod, io, mod->type);
0458 return;
0459 }
0460 }
0461 }
0462
0463 void rsnd_parse_connect_ssiu(struct rsnd_dai *rdai,
0464 struct device_node *playback,
0465 struct device_node *capture)
0466 {
0467 struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
0468 struct device *dev = rsnd_priv_to_dev(priv);
0469 struct device_node *node = rsnd_ssiu_of_node(priv);
0470 struct rsnd_dai_stream *io_p = &rdai->playback;
0471 struct rsnd_dai_stream *io_c = &rdai->capture;
0472
0473
0474 if (node) {
0475 struct device_node *np;
0476 int i = 0;
0477
0478 for_each_child_of_node(node, np) {
0479 struct rsnd_mod *mod;
0480
0481 i = rsnd_node_fixed_index(dev, np, SSIU_NAME, i);
0482 if (i < 0) {
0483 of_node_put(np);
0484 break;
0485 }
0486
0487 mod = rsnd_ssiu_mod_get(priv, i);
0488
0489 if (np == playback)
0490 rsnd_dai_connect(mod, io_p, mod->type);
0491 if (np == capture)
0492 rsnd_dai_connect(mod, io_c, mod->type);
0493 i++;
0494 }
0495
0496 of_node_put(node);
0497 }
0498
0499
0500 if (!rsnd_io_to_mod_ssiu(io_p))
0501 rsnd_parse_connect_ssiu_compatible(priv, io_p);
0502 if (!rsnd_io_to_mod_ssiu(io_c))
0503 rsnd_parse_connect_ssiu_compatible(priv, io_c);
0504 }
0505
0506 int rsnd_ssiu_probe(struct rsnd_priv *priv)
0507 {
0508 struct device *dev = rsnd_priv_to_dev(priv);
0509 struct device_node *node;
0510 struct rsnd_ssiu *ssiu;
0511 struct rsnd_mod_ops *ops;
0512 const int *list = NULL;
0513 int i, nr;
0514
0515
0516
0517
0518
0519
0520
0521
0522 node = rsnd_ssiu_of_node(priv);
0523 if (node)
0524 nr = rsnd_node_count(priv, node, SSIU_NAME);
0525 else
0526 nr = priv->ssi_nr;
0527
0528 if (!nr)
0529 return -EINVAL;
0530
0531 ssiu = devm_kcalloc(dev, nr, sizeof(*ssiu), GFP_KERNEL);
0532 if (!ssiu)
0533 return -ENOMEM;
0534
0535 priv->ssiu = ssiu;
0536 priv->ssiu_nr = nr;
0537
0538 if (rsnd_is_gen1(priv))
0539 ops = &rsnd_ssiu_ops_gen1;
0540 else
0541 ops = &rsnd_ssiu_ops_gen2;
0542
0543
0544 nr = 0;
0545 if ((node) &&
0546 (ops == &rsnd_ssiu_ops_gen2)) {
0547 ops->id = rsnd_ssiu_id;
0548 ops->id_sub = rsnd_ssiu_id_sub;
0549
0550 if (rsnd_is_gen2(priv)) {
0551 list = gen2_id;
0552 nr = ARRAY_SIZE(gen2_id);
0553 } else if (rsnd_is_gen3(priv)) {
0554 list = gen3_id;
0555 nr = ARRAY_SIZE(gen3_id);
0556 } else {
0557 dev_err(dev, "unknown SSIU\n");
0558 return -ENODEV;
0559 }
0560 }
0561
0562 for_each_rsnd_ssiu(ssiu, priv, i) {
0563 int ret;
0564
0565 if (node) {
0566 int j;
0567
0568
0569
0570
0571
0572
0573 for (j = 0; j < nr; j++) {
0574 if (list[j] > i)
0575 break;
0576 ssiu->id = j;
0577 ssiu->id_sub = i - list[ssiu->id];
0578 }
0579 } else {
0580 ssiu->id = i;
0581 }
0582
0583 ret = rsnd_mod_init(priv, rsnd_mod_get(ssiu),
0584 ops, NULL, RSND_MOD_SSIU, i);
0585 if (ret)
0586 return ret;
0587 }
0588
0589 return 0;
0590 }
0591
0592 void rsnd_ssiu_remove(struct rsnd_priv *priv)
0593 {
0594 struct rsnd_ssiu *ssiu;
0595 int i;
0596
0597 for_each_rsnd_ssiu(ssiu, priv, i) {
0598 rsnd_mod_quit(rsnd_mod_get(ssiu));
0599 }
0600 }