sound/soc/sh/rcar/ssi.c

   1 /*
   2  * Renesas R-Car SSIU/SSI support
   3  *
   4  * Copyright (C) 2013 Renesas Solutions Corp.
   5  * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
   6  *
   7  * Based on fsi.c
   8  * Kuninori Morimoto <morimoto.kuninori@renesas.com>
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License version 2 as
  12  * published by the Free Software Foundation.
  13  */
  14 #include <linux/delay.h>
  15 #include "rsnd.h"
  16 #define RSND_SSI_NAME_SIZE 16
  17
  18 /*
  19  * SSICR
  20  */
  21 #define FORCE           (1 << 31)       /* Fixed */
  22 #define DMEN            (1 << 28)       /* DMA Enable */
  23 #define UIEN            (1 << 27)       /* Underflow Interrupt Enable */
  24 #define OIEN            (1 << 26)       /* Overflow Interrupt Enable */
  25 #define IIEN            (1 << 25)       /* Idle Mode Interrupt Enable */
  26 #define DIEN            (1 << 24)       /* Data Interrupt Enable */
  27 #define CHNL_4          (1 << 22)       /* Channels */
  28 #define CHNL_6          (2 << 22)       /* Channels */
  29 #define CHNL_8          (3 << 22)       /* Channels */
  30 #define DWL_8           (0 << 19)       /* Data Word Length */
  31 #define DWL_16          (1 << 19)       /* Data Word Length */
  32 #define DWL_18          (2 << 19)       /* Data Word Length */
  33 #define DWL_20          (3 << 19)       /* Data Word Length */
  34 #define DWL_22          (4 << 19)       /* Data Word Length */
  35 #define DWL_24          (5 << 19)       /* Data Word Length */
  36 #define DWL_32          (6 << 19)       /* Data Word Length */
  37
  38 #define SWL_32          (3 << 16)       /* R/W System Word Length */
  39 #define SCKD            (1 << 15)       /* Serial Bit Clock Direction */
  40 #define SWSD            (1 << 14)       /* Serial WS Direction */
  41 #define SCKP            (1 << 13)       /* Serial Bit Clock Polarity */
  42 #define SWSP            (1 << 12)       /* Serial WS Polarity */
  43 #define SDTA            (1 << 10)       /* Serial Data Alignment */
  44 #define PDTA            (1 <<  9)       /* Parallel Data Alignment */
  45 #define DEL             (1 <<  8)       /* Serial Data Delay */
  46 #define CKDV(v)         (v <<  4)       /* Serial Clock Division Ratio */
  47 #define TRMD            (1 <<  1)       /* Transmit/Receive Mode Select */
  48 #define EN              (1 <<  0)       /* SSI Module Enable */
  49
  50 /*
  51  * SSISR
  52  */
  53 #define UIRQ            (1 << 27)       /* Underflow Error Interrupt Status */
  54 #define OIRQ            (1 << 26)       /* Overflow Error Interrupt Status */
  55 #define IIRQ            (1 << 25)       /* Idle Mode Interrupt Status */
  56 #define DIRQ            (1 << 24)       /* Data Interrupt Status Flag */
  57
  58 /*
  59  * SSIWSR
  60  */
  61 #define CONT            (1 << 8)        /* WS Continue Function */
  62 #define WS_MODE         (1 << 0)        /* WS Mode */
  63
  64 #define SSI_NAME "ssi"
  65
  66 struct rsnd_ssi {
  67         struct rsnd_mod mod;
  68         struct rsnd_mod *dma;
  69
  70         u32 flags;
  71         u32 cr_own;
  72         u32 cr_clk;
  73         u32 cr_mode;
  74         u32 wsr;
  75         int chan;
  76         int rate;
  77         int irq;
  78         unsigned int usrcnt;
  79 };
  80
  81 /* flags */
  82 #define RSND_SSI_CLK_PIN_SHARE          (1 << 0)
  83 #define RSND_SSI_NO_BUSIF               (1 << 1) /* SSI+DMA without BUSIF */
  84
  85 #define for_each_rsnd_ssi(pos, priv, i)                                 \
  86         for (i = 0;                                                     \
  87              (i < rsnd_ssi_nr(priv)) &&                                 \
  88                 ((pos) = ((struct rsnd_ssi *)(priv)->ssi + i));         \
  89              i++)
  90
  91 #define rsnd_ssi_get(priv, id) ((struct rsnd_ssi *)(priv->ssi) + id)
  92 #define rsnd_ssi_to_dma(mod) ((ssi)->dma)
  93 #define rsnd_ssi_nr(priv) ((priv)->ssi_nr)
  94 #define rsnd_mod_to_ssi(_mod) container_of((_mod), struct rsnd_ssi, mod)
  95 #define rsnd_ssi_mode_flags(p) ((p)->flags)
  96 #define rsnd_ssi_is_parent(ssi, io) ((ssi) == rsnd_io_to_mod_ssip(io))
  97 #define rsnd_ssi_is_multi_slave(mod, io) \
  98         (rsnd_ssi_multi_slaves(io) & (1 << rsnd_mod_id(mod)))
  99 #define rsnd_ssi_is_run_mods(mod, io) \
 100         (rsnd_ssi_run_mods(io) & (1 << rsnd_mod_id(mod)))
 101
 102 int rsnd_ssi_use_busif(struct rsnd_dai_stream *io)
 103 {
 104         struct rsnd_mod *mod = rsnd_io_to_mod_ssi(io);
 105         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 106         int use_busif = 0;
 107
 108         if (!rsnd_ssi_is_dma_mode(mod))
 109                 return 0;
 110
 111         if (!(rsnd_ssi_mode_flags(ssi) & RSND_SSI_NO_BUSIF))
 112                 use_busif = 1;
 113         if (rsnd_io_to_mod_src(io))
 114                 use_busif = 1;
 115
 116         return use_busif;
 117 }
 118
 119 static void rsnd_ssi_status_clear(struct rsnd_mod *mod)
 120 {
 121         rsnd_mod_write(mod, SSISR, 0);
 122 }
 123
 124 static u32 rsnd_ssi_status_get(struct rsnd_mod *mod)
 125 {
 126         return rsnd_mod_read(mod, SSISR);
 127 }
 128
 129 static void rsnd_ssi_status_check(struct rsnd_mod *mod,
 130                                   u32 bit)
 131 {
 132         struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
 133         struct device *dev = rsnd_priv_to_dev(priv);
 134         u32 status;
 135         int i;
 136
 137         for (i = 0; i < 1024; i++) {
 138                 status = rsnd_ssi_status_get(mod);
 139                 if (status & bit)
 140                         return;
 141
 142                 udelay(50);
 143         }
 144
 145         dev_warn(dev, "%s[%d] status check failed\n",
 146                  rsnd_mod_name(mod), rsnd_mod_id(mod));
 147 }
 148
 149 static u32 rsnd_ssi_multi_slaves(struct rsnd_dai_stream *io)
 150 {
 151         struct rsnd_mod *mod;
 152         enum rsnd_mod_type types[] = {
 153                 RSND_MOD_SSIM1,
 154                 RSND_MOD_SSIM2,
 155                 RSND_MOD_SSIM3,
 156         };
 157         int i, mask;
 158
 159         mask = 0;
 160         for (i = 0; i < ARRAY_SIZE(types); i++) {
 161                 mod = rsnd_io_to_mod(io, types[i]);
 162                 if (!mod)
 163                         continue;
 164
 165                 mask |= 1 << rsnd_mod_id(mod);
 166         }
 167
 168         return mask;
 169 }
 170
 171 static u32 rsnd_ssi_run_mods(struct rsnd_dai_stream *io)
 172 {
 173         struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io);
 174         struct rsnd_mod *ssi_parent_mod = rsnd_io_to_mod_ssip(io);
 175         u32 mods;
 176
 177         mods = rsnd_ssi_multi_slaves_runtime(io) |
 178                 1 << rsnd_mod_id(ssi_mod);
 179
 180         if (ssi_parent_mod)
 181                 mods |= 1 << rsnd_mod_id(ssi_parent_mod);
 182
 183         return mods;
 184 }
 185
 186 u32 rsnd_ssi_multi_slaves_runtime(struct rsnd_dai_stream *io)
 187 {
 188         if (rsnd_runtime_is_ssi_multi(io))
 189                 return rsnd_ssi_multi_slaves(io);
 190
 191         return 0;
 192 }
 193
 194 static int rsnd_ssi_master_clk_start(struct rsnd_mod *mod,
 195                                      struct rsnd_dai_stream *io)
 196 {
 197         struct rsnd_priv *priv = rsnd_io_to_priv(io);
 198         struct device *dev = rsnd_priv_to_dev(priv);
 199         struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
 200         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 201         struct rsnd_mod *ssi_parent_mod = rsnd_io_to_mod_ssip(io);
 202         int chan = rsnd_runtime_channel_for_ssi(io);
 203         int j, ret;
 204         int ssi_clk_mul_table[] = {
 205                 1, 2, 4, 8, 16, 6, 12,
 206         };
 207         unsigned int main_rate;
 208         unsigned int rate = rsnd_io_is_play(io) ?
 209                 rsnd_src_get_out_rate(priv, io) :
 210                 rsnd_src_get_in_rate(priv, io);
 211
 212         if (!rsnd_rdai_is_clk_master(rdai))
 213                 return 0;
 214
 215         if (ssi_parent_mod && !rsnd_ssi_is_parent(mod, io))
 216                 return 0;
 217
 218         if (rsnd_ssi_is_multi_slave(mod, io))
 219                 return 0;
 220
 221         if (ssi->usrcnt > 1) {
 222                 if (ssi->rate != rate) {
 223                         dev_err(dev, "SSI parent/child should use same rate\n");
 224                         return -EINVAL;
 225                 }
 226
 227                 return 0;
 228         }
 229
 230         /*
 231          * Find best clock, and try to start ADG
 232          */
 233         for (j = 0; j < ARRAY_SIZE(ssi_clk_mul_table); j++) {
 234
 235                 /*
 236                  * It will set SSIWSR.CONT here, but SSICR.CKDV = 000
 237                  * with it is not allowed. (SSIWSR.WS_MODE with
 238                  * SSICR.CKDV = 000 is not allowed either).
 239                  * Skip it. See SSICR.CKDV
 240                  */
 241                 if (j == 0)
 242                         continue;
 243
 244                 /*
 245                  * this driver is assuming that
 246                  * system word is 32bit x chan
 247                  * see rsnd_ssi_init()
 248                  */
 249                 main_rate = rate * 32 * chan * ssi_clk_mul_table[j];
 250
 251                 ret = rsnd_adg_ssi_clk_try_start(mod, main_rate);
 252                 if (0 == ret) {
 253                         ssi->cr_clk     = FORCE | SWL_32 |
 254                                 SCKD | SWSD | CKDV(j);
 255                         ssi->wsr = CONT;
 256
 257                         ssi->rate = rate;
 258
 259                         dev_dbg(dev, "%s[%d] outputs %u Hz\n",
 260                                 rsnd_mod_name(mod),
 261                                 rsnd_mod_id(mod), rate);
 262
 263                         return 0;
 264                 }
 265         }
 266
 267         dev_err(dev, "unsupported clock rate\n");
 268         return -EIO;
 269 }
 270
 271 static void rsnd_ssi_master_clk_stop(struct rsnd_mod *mod,
 272                                      struct rsnd_dai_stream *io)
 273 {
 274         struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
 275         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 276         struct rsnd_mod *ssi_parent_mod = rsnd_io_to_mod_ssip(io);
 277
 278         if (!rsnd_rdai_is_clk_master(rdai))
 279                 return;
 280
 281         if (ssi_parent_mod && !rsnd_ssi_is_parent(mod, io))
 282                 return;
 283
 284         if (ssi->usrcnt > 1)
 285                 return;
 286
 287         ssi->cr_clk     = 0;
 288         ssi->rate       = 0;
 289
 290         rsnd_adg_ssi_clk_stop(mod);
 291 }
 292
 293 static void rsnd_ssi_config_init(struct rsnd_mod *mod,
 294                                 struct rsnd_dai_stream *io)
 295 {
 296         struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
 297         struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
 298         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 299         u32 cr_own;
 300         u32 cr_mode;
 301         u32 wsr;
 302         int is_tdm;
 303
 304         is_tdm = rsnd_runtime_is_ssi_tdm(io);
 305
 306         /*
 307          * always use 32bit system word.
 308          * see also rsnd_ssi_master_clk_enable()
 309          */
 310         cr_own = FORCE | SWL_32 | PDTA;
 311
 312         if (rdai->bit_clk_inv)
 313                 cr_own |= SCKP;
 314         if (rdai->frm_clk_inv ^ is_tdm)
 315                 cr_own |= SWSP;
 316         if (rdai->data_alignment)
 317                 cr_own |= SDTA;
 318         if (rdai->sys_delay)
 319                 cr_own |= DEL;
 320         if (rsnd_io_is_play(io))
 321                 cr_own |= TRMD;
 322
 323         switch (runtime->sample_bits) {
 324         case 16:
 325                 cr_own |= DWL_16;
 326                 break;
 327         case 32:
 328                 cr_own |= DWL_24;
 329                 break;
 330         }
 331
 332         if (rsnd_ssi_is_dma_mode(mod)) {
 333                 cr_mode = UIEN | OIEN | /* over/under run */
 334                           DMEN;         /* DMA : enable DMA */
 335         } else {
 336                 cr_mode = DIEN;         /* PIO : enable Data interrupt */
 337         }
 338
 339         /*
 340          * TDM Extend Mode
 341          * see
 342          *      rsnd_ssiu_init_gen2()
 343          */
 344         wsr = ssi->wsr;
 345         if (is_tdm) {
 346                 wsr     |= WS_MODE;
 347                 cr_own  |= CHNL_8;
 348         }
 349
 350         ssi->cr_own     = cr_own;
 351         ssi->cr_mode    = cr_mode;
 352         ssi->wsr        = wsr;
 353 }
 354
 355 static void rsnd_ssi_register_setup(struct rsnd_mod *mod)
 356 {
 357         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 358
 359         rsnd_mod_write(mod, SSIWSR,     ssi->wsr);
 360         rsnd_mod_write(mod, SSICR,      ssi->cr_own     |
 361                                         ssi->cr_clk     |
 362                                         ssi->cr_mode); /* without EN */
 363 }
 364
 365 /*
 366  *      SSI mod common functions
 367  */
 368 static int rsnd_ssi_init(struct rsnd_mod *mod,
 369                          struct rsnd_dai_stream *io,
 370                          struct rsnd_priv *priv)
 371 {
 372         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 373         int ret;
 374
 375         if (!rsnd_ssi_is_run_mods(mod, io))
 376                 return 0;
 377
 378         ssi->usrcnt++;
 379
 380         rsnd_mod_power_on(mod);
 381
 382         ret = rsnd_ssi_master_clk_start(mod, io);
 383         if (ret < 0)
 384                 return ret;
 385
 386         if (!rsnd_ssi_is_parent(mod, io))
 387                 rsnd_ssi_config_init(mod, io);
 388
 389         rsnd_ssi_register_setup(mod);
 390
 391         /* clear error status */
 392         rsnd_ssi_status_clear(mod);
 393
 394         return 0;
 395 }
 396
 397 static int rsnd_ssi_quit(struct rsnd_mod *mod,
 398                          struct rsnd_dai_stream *io,
 399                          struct rsnd_priv *priv)
 400 {
 401         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 402         struct device *dev = rsnd_priv_to_dev(priv);
 403
 404         if (!rsnd_ssi_is_run_mods(mod, io))
 405                 return 0;
 406
 407         if (!ssi->usrcnt) {
 408                 dev_err(dev, "%s[%d] usrcnt error\n",
 409                         rsnd_mod_name(mod), rsnd_mod_id(mod));
 410                 return -EIO;
 411         }
 412
 413         if (!rsnd_ssi_is_parent(mod, io))
 414                 ssi->cr_own     = 0;
 415
 416         rsnd_ssi_master_clk_stop(mod, io);
 417
 418         rsnd_mod_power_off(mod);
 419
 420         ssi->usrcnt--;
 421
 422         return 0;
 423 }
 424
 425 static int rsnd_ssi_hw_params(struct rsnd_mod *mod,
 426                               struct rsnd_dai_stream *io,
 427                               struct snd_pcm_substream *substream,
 428                               struct snd_pcm_hw_params *params)
 429 {
 430         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 431         int chan = params_channels(params);
 432
 433         /*
 434          * Already working.
 435          * It will happen if SSI has parent/child connection.
 436          */
 437         if (ssi->usrcnt > 1) {
 438                 /*
 439                  * it is error if child <-> parent SSI uses
 440                  * different channels.
 441                  */
 442                 if (ssi->chan != chan)
 443                         return -EIO;
 444         }
 445
 446         ssi->chan = chan;
 447
 448         return 0;
 449 }
 450
 451 static int rsnd_ssi_start(struct rsnd_mod *mod,
 452                           struct rsnd_dai_stream *io,
 453                           struct rsnd_priv *priv)
 454 {
 455         if (!rsnd_ssi_is_run_mods(mod, io))
 456                 return 0;
 457
 458         /*
 459          * EN will be set via SSIU :: SSI_CONTROL
 460          * if Multi channel mode
 461          */
 462         if (rsnd_ssi_multi_slaves_runtime(io))
 463                 return 0;
 464
 465         rsnd_mod_bset(mod, SSICR, EN, EN);
 466
 467         return 0;
 468 }
 469
 470 static int rsnd_ssi_stop(struct rsnd_mod *mod,
 471                          struct rsnd_dai_stream *io,
 472                          struct rsnd_priv *priv)
 473 {
 474         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 475         u32 cr;
 476
 477         if (!rsnd_ssi_is_run_mods(mod, io))
 478                 return 0;
 479
 480         /*
 481          * don't stop if not last user
 482          * see also
 483          *      rsnd_ssi_start
 484          *      rsnd_ssi_interrupt
 485          */
 486         if (ssi->usrcnt > 1)
 487                 return 0;
 488
 489         /*
 490          * disable all IRQ,
 491          * and, wait all data was sent
 492          */
 493         cr  =   ssi->cr_own     |
 494                 ssi->cr_clk;
 495
 496         rsnd_mod_write(mod, SSICR, cr | EN);
 497         rsnd_ssi_status_check(mod, DIRQ);
 498
 499         /*
 500          * disable SSI,
 501          * and, wait idle state
 502          */
 503         rsnd_mod_write(mod, SSICR, cr); /* disabled all */
 504         rsnd_ssi_status_check(mod, IIRQ);
 505
 506         return 0;
 507 }
 508
 509 static int rsnd_ssi_irq(struct rsnd_mod *mod,
 510                         struct rsnd_dai_stream *io,
 511                         struct rsnd_priv *priv,
 512                         int enable)
 513 {
 514         u32 val = 0;
 515
 516         if (rsnd_is_gen1(priv))
 517                 return 0;
 518
 519         if (rsnd_ssi_is_parent(mod, io))
 520                 return 0;
 521
 522         if (!rsnd_ssi_is_run_mods(mod, io))
 523                 return 0;
 524
 525         if (enable)
 526                 val = rsnd_ssi_is_dma_mode(mod) ? 0x0e000000 : 0x0f000000;
 527
 528         rsnd_mod_write(mod, SSI_INT_ENABLE, val);
 529
 530         return 0;
 531 }
 532
 533 static void __rsnd_ssi_interrupt(struct rsnd_mod *mod,
 534                                  struct rsnd_dai_stream *io)
 535 {
 536         struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
 537         int is_dma = rsnd_ssi_is_dma_mode(mod);
 538         u32 status;
 539         bool elapsed = false;
 540         bool stop = false;
 541
 542         spin_lock(&priv->lock);
 543
 544         /* ignore all cases if not working */
 545         if (!rsnd_io_is_working(io))
 546                 goto rsnd_ssi_interrupt_out;
 547
 548         status = rsnd_ssi_status_get(mod);
 549
 550         /* PIO only */
 551         if (!is_dma && (status & DIRQ)) {
 552                 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
 553                 u32 *buf = (u32 *)(runtime->dma_area +
 554                                    rsnd_dai_pointer_offset(io, 0));
 555                 int shift = 0;
 556
 557                 switch (runtime->sample_bits) {
 558                 case 32:
 559                         shift = 8;
 560                         break;
 561                 }
 562
 563                 /*
 564                  * 8/16/32 data can be assesse to TDR/RDR register
 565                  * directly as 32bit data
 566                  * see rsnd_ssi_init()
 567                  */
 568                 if (rsnd_io_is_play(io))
 569                         rsnd_mod_write(mod, SSITDR, (*buf) << shift);
 570                 else
 571                         *buf = (rsnd_mod_read(mod, SSIRDR) >> shift);
 572
 573                 elapsed = rsnd_dai_pointer_update(io, sizeof(*buf));
 574         }
 575
 576         /* DMA only */
 577         if (is_dma && (status & (UIRQ | OIRQ)))
 578                 stop = true;
 579
 580         rsnd_ssi_status_clear(mod);
 581 rsnd_ssi_interrupt_out:
 582         spin_unlock(&priv->lock);
 583
 584         if (elapsed)
 585                 rsnd_dai_period_elapsed(io);
 586
 587         if (stop)
 588                 snd_pcm_stop_xrun(io->substream);
 589
 590 }
 591
 592 static irqreturn_t rsnd_ssi_interrupt(int irq, void *data)
 593 {
 594         struct rsnd_mod *mod = data;
 595
 596         rsnd_mod_interrupt(mod, __rsnd_ssi_interrupt);
 597
 598         return IRQ_HANDLED;
 599 }
 600
 601 /*
 602  *              SSI PIO
 603  */
 604 static void rsnd_ssi_parent_attach(struct rsnd_mod *mod,
 605                                    struct rsnd_dai_stream *io)
 606 {
 607         struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
 608         struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
 609
 610         if (!__rsnd_ssi_is_pin_sharing(mod))
 611                 return;
 612
 613         if (!rsnd_rdai_is_clk_master(rdai))
 614                 return;
 615
 616         switch (rsnd_mod_id(mod)) {
 617         case 1:
 618         case 2:
 619                 rsnd_dai_connect(rsnd_ssi_mod_get(priv, 0), io, RSND_MOD_SSIP);
 620                 break;
 621         case 4:
 622                 rsnd_dai_connect(rsnd_ssi_mod_get(priv, 3), io, RSND_MOD_SSIP);
 623                 break;
 624         case 8:
 625                 rsnd_dai_connect(rsnd_ssi_mod_get(priv, 7), io, RSND_MOD_SSIP);
 626                 break;
 627         }
 628 }
 629
 630 static int rsnd_ssi_pcm_new(struct rsnd_mod *mod,
 631                             struct rsnd_dai_stream *io,
 632                             struct snd_soc_pcm_runtime *rtd)
 633 {
 634         /*
 635          * rsnd_rdai_is_clk_master() will be enabled after set_fmt,
 636          * and, pcm_new will be called after it.
 637          * This function reuse pcm_new at this point.
 638          */
 639         rsnd_ssi_parent_attach(mod, io);
 640
 641         return 0;
 642 }
 643
 644 static int rsnd_ssi_common_probe(struct rsnd_mod *mod,
 645                                  struct rsnd_dai_stream *io,
 646                                  struct rsnd_priv *priv)
 647 {
 648         struct device *dev = rsnd_priv_to_dev(priv);
 649         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 650         int ret;
 651
 652         /*
 653          * SSIP/SSIU/IRQ are not needed on
 654          * SSI Multi slaves
 655          */
 656         if (rsnd_ssi_is_multi_slave(mod, io))
 657                 return 0;
 658
 659         /*
 660          * It can't judge ssi parent at this point
 661          * see rsnd_ssi_pcm_new()
 662          */
 663
 664         ret = rsnd_ssiu_attach(io, mod);
 665         if (ret < 0)
 666                 return ret;
 667
 668         ret = devm_request_irq(dev, ssi->irq,
 669                                rsnd_ssi_interrupt,
 670                                IRQF_SHARED,
 671                                dev_name(dev), mod);
 672
 673         return ret;
 674 }
 675
 676 static struct rsnd_mod_ops rsnd_ssi_pio_ops = {
 677         .name   = SSI_NAME,
 678         .probe  = rsnd_ssi_common_probe,
 679         .init   = rsnd_ssi_init,
 680         .quit   = rsnd_ssi_quit,
 681         .start  = rsnd_ssi_start,
 682         .stop   = rsnd_ssi_stop,
 683         .irq    = rsnd_ssi_irq,
 684         .pcm_new = rsnd_ssi_pcm_new,
 685         .hw_params = rsnd_ssi_hw_params,
 686 };
 687
 688 static int rsnd_ssi_dma_probe(struct rsnd_mod *mod,
 689                               struct rsnd_dai_stream *io,
 690                               struct rsnd_priv *priv)
 691 {
 692         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 693         int dma_id = 0; /* not needed */
 694         int ret;
 695
 696         /*
 697          * SSIP/SSIU/IRQ/DMA are not needed on
 698          * SSI Multi slaves
 699          */
 700         if (rsnd_ssi_is_multi_slave(mod, io))
 701                 return 0;
 702
 703         ret = rsnd_ssi_common_probe(mod, io, priv);
 704         if (ret)
 705                 return ret;
 706
 707         /* SSI probe might be called many times in MUX multi path */
 708         ret = rsnd_dma_attach(io, mod, &ssi->dma, dma_id);
 709
 710         return ret;
 711 }
 712
 713 static int rsnd_ssi_dma_remove(struct rsnd_mod *mod,
 714                                struct rsnd_dai_stream *io,
 715                                struct rsnd_priv *priv)
 716 {
 717         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 718         struct rsnd_mod *pure_ssi_mod = rsnd_io_to_mod_ssi(io);
 719         struct device *dev = rsnd_priv_to_dev(priv);
 720         int irq = ssi->irq;
 721
 722         /* Do nothing if non SSI (= SSI parent, multi SSI) mod */
 723         if (pure_ssi_mod != mod)
 724                 return 0;
 725
 726         /* PIO will request IRQ again */
 727         devm_free_irq(dev, irq, mod);
 728
 729         return 0;
 730 }
 731
 732 static int rsnd_ssi_fallback(struct rsnd_mod *mod,
 733                              struct rsnd_dai_stream *io,
 734                              struct rsnd_priv *priv)
 735 {
 736         struct device *dev = rsnd_priv_to_dev(priv);
 737
 738         /*
 739          * fallback to PIO
 740          *
 741          * SSI .probe might be called again.
 742          * see
 743          *      rsnd_rdai_continuance_probe()
 744          */
 745         mod->ops = &rsnd_ssi_pio_ops;
 746
 747         dev_info(dev, "%s[%d] fallback to PIO mode\n",
 748                  rsnd_mod_name(mod), rsnd_mod_id(mod));
 749
 750         return 0;
 751 }
 752
 753 static struct dma_chan *rsnd_ssi_dma_req(struct rsnd_dai_stream *io,
 754                                          struct rsnd_mod *mod)
 755 {
 756         struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
 757         int is_play = rsnd_io_is_play(io);
 758         char *name;
 759
 760         if (rsnd_ssi_use_busif(io))
 761                 name = is_play ? "rxu" : "txu";
 762         else
 763                 name = is_play ? "rx" : "tx";
 764
 765         return rsnd_dma_request_channel(rsnd_ssi_of_node(priv),
 766                                         mod, name);
 767 }
 768
 769 static struct rsnd_mod_ops rsnd_ssi_dma_ops = {
 770         .name   = SSI_NAME,
 771         .dma_req = rsnd_ssi_dma_req,
 772         .probe  = rsnd_ssi_dma_probe,
 773         .remove = rsnd_ssi_dma_remove,
 774         .init   = rsnd_ssi_init,
 775         .quit   = rsnd_ssi_quit,
 776         .start  = rsnd_ssi_start,
 777         .stop   = rsnd_ssi_stop,
 778         .irq    = rsnd_ssi_irq,
 779         .pcm_new = rsnd_ssi_pcm_new,
 780         .fallback = rsnd_ssi_fallback,
 781         .hw_params = rsnd_ssi_hw_params,
 782 };
 783
 784 int rsnd_ssi_is_dma_mode(struct rsnd_mod *mod)
 785 {
 786         return mod->ops == &rsnd_ssi_dma_ops;
 787 }
 788
 789
 790 /*
 791  *              Non SSI
 792  */
 793 static struct rsnd_mod_ops rsnd_ssi_non_ops = {
 794         .name   = SSI_NAME,
 795 };
 796
 797 /*
 798  *              ssi mod function
 799  */
 800 static void rsnd_ssi_connect(struct rsnd_mod *mod,
 801                              struct rsnd_dai_stream *io)
 802 {
 803         struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
 804         enum rsnd_mod_type types[] = {
 805                 RSND_MOD_SSI,
 806                 RSND_MOD_SSIM1,
 807                 RSND_MOD_SSIM2,
 808                 RSND_MOD_SSIM3,
 809         };
 810         enum rsnd_mod_type type;
 811         int i;
 812
 813         /* try SSI -> SSIM1 -> SSIM2 -> SSIM3 */
 814         for (i = 0; i < ARRAY_SIZE(types); i++) {
 815                 type = types[i];
 816                 if (!rsnd_io_to_mod(io, type)) {
 817                         rsnd_dai_connect(mod, io, type);
 818                         rsnd_set_slot(rdai, 2 * (i + 1), (i + 1));
 819                         return;
 820                 }
 821         }
 822 }
 823
 824 void rsnd_parse_connect_ssi(struct rsnd_dai *rdai,
 825                             struct device_node *playback,
 826                             struct device_node *capture)
 827 {
 828         struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
 829         struct device_node *node;
 830         struct device_node *np;
 831         struct rsnd_mod *mod;
 832         int i;
 833
 834         node = rsnd_ssi_of_node(priv);
 835         if (!node)
 836                 return;
 837
 838         i = 0;
 839         for_each_child_of_node(node, np) {
 840                 mod = rsnd_ssi_mod_get(priv, i);
 841                 if (np == playback)
 842                         rsnd_ssi_connect(mod, &rdai->playback);
 843                 if (np == capture)
 844                         rsnd_ssi_connect(mod, &rdai->capture);
 845                 i++;
 846         }
 847
 848         of_node_put(node);
 849 }
 850
 851 struct rsnd_mod *rsnd_ssi_mod_get(struct rsnd_priv *priv, int id)
 852 {
 853         if (WARN_ON(id < 0 || id >= rsnd_ssi_nr(priv)))
 854                 id = 0;
 855
 856         return rsnd_mod_get(rsnd_ssi_get(priv, id));
 857 }
 858
 859 int __rsnd_ssi_is_pin_sharing(struct rsnd_mod *mod)
 860 {
 861         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 862
 863         return !!(rsnd_ssi_mode_flags(ssi) & RSND_SSI_CLK_PIN_SHARE);
 864 }
 865
 866 static u32 *rsnd_ssi_get_status(struct rsnd_dai_stream *io,
 867                                 struct rsnd_mod *mod,
 868                                 enum rsnd_mod_type type)
 869 {
 870         /*
 871          * SSIP (= SSI parent) needs to be special, otherwise,
 872          * 2nd SSI might doesn't start. see also rsnd_mod_call()
 873          *
 874          * We can't include parent SSI status on SSI, because we don't know
 875          * how many SSI requests parent SSI. Thus, it is localed on "io" now.
 876          * ex) trouble case
 877          *      Playback: SSI0
 878          *      Capture : SSI1 (needs SSI0)
 879          *
 880          * 1) start Capture  -> SSI0/SSI1 are started.
 881          * 2) start Playback -> SSI0 doesn't work, because it is already
 882          *                      marked as "started" on 1)
 883          *
 884          * OTOH, using each mod's status is good for MUX case.
 885          * It doesn't need to start in 2nd start
 886          * ex)
 887          *      IO-0: SRC0 -> CTU1 -+-> MUX -> DVC -> SSIU -> SSI0
 888          *                          |
 889          *      IO-1: SRC1 -> CTU2 -+
 890          *
 891          * 1) start IO-0 ->     start SSI0
 892          * 2) start IO-1 ->     SSI0 doesn't need to start, because it is
 893          *                      already started on 1)
 894          */
 895         if (type == RSND_MOD_SSIP)
 896                 return &io->parent_ssi_status;
 897
 898         return rsnd_mod_get_status(io, mod, type);
 899 }
 900
 901 int rsnd_ssi_probe(struct rsnd_priv *priv)
 902 {
 903         struct device_node *node;
 904         struct device_node *np;
 905         struct device *dev = rsnd_priv_to_dev(priv);
 906         struct rsnd_mod_ops *ops;
 907         struct clk *clk;
 908         struct rsnd_ssi *ssi;
 909         char name[RSND_SSI_NAME_SIZE];
 910         int i, nr, ret;
 911
 912         node = rsnd_ssi_of_node(priv);
 913         if (!node)
 914                 return -EINVAL;
 915
 916         nr = of_get_child_count(node);
 917         if (!nr) {
 918                 ret = -EINVAL;
 919                 goto rsnd_ssi_probe_done;
 920         }
 921
 922         ssi     = devm_kzalloc(dev, sizeof(*ssi) * nr, GFP_KERNEL);
 923         if (!ssi) {
 924                 ret = -ENOMEM;
 925                 goto rsnd_ssi_probe_done;
 926         }
 927
 928         priv->ssi       = ssi;
 929         priv->ssi_nr    = nr;
 930
 931         i = 0;
 932         for_each_child_of_node(node, np) {
 933                 ssi = rsnd_ssi_get(priv, i);
 934
 935                 snprintf(name, RSND_SSI_NAME_SIZE, "%s.%d",
 936                          SSI_NAME, i);
 937
 938                 clk = devm_clk_get(dev, name);
 939                 if (IS_ERR(clk)) {
 940                         ret = PTR_ERR(clk);
 941                         goto rsnd_ssi_probe_done;
 942                 }
 943
 944                 if (of_get_property(np, "shared-pin", NULL))
 945                         ssi->flags |= RSND_SSI_CLK_PIN_SHARE;
 946
 947                 if (of_get_property(np, "no-busif", NULL))
 948                         ssi->flags |= RSND_SSI_NO_BUSIF;
 949
 950                 ssi->irq = irq_of_parse_and_map(np, 0);
 951                 if (!ssi->irq) {
 952                         ret = -EINVAL;
 953                         goto rsnd_ssi_probe_done;
 954                 }
 955
 956                 ops = &rsnd_ssi_non_ops;
 957                 if (of_property_read_bool(np, "pio-transfer"))
 958                         ops = &rsnd_ssi_pio_ops;
 959                 else
 960                         ops = &rsnd_ssi_dma_ops;
 961
 962                 ret = rsnd_mod_init(priv, rsnd_mod_get(ssi), ops, clk,
 963                                     rsnd_ssi_get_status, RSND_MOD_SSI, i);
 964                 if (ret)
 965                         goto rsnd_ssi_probe_done;
 966
 967                 i++;
 968         }
 969
 970         ret = 0;
 971
 972 rsnd_ssi_probe_done:
 973         of_node_put(node);
 974
 975         return ret;
 976 }
 977
 978 void rsnd_ssi_remove(struct rsnd_priv *priv)
 979 {
 980         struct rsnd_ssi *ssi;
 981         int i;
 982
 983         for_each_rsnd_ssi(ssi, priv, i) {
 984                 rsnd_mod_quit(rsnd_mod_get(ssi));
 985         }
 986 }