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
  28 #define DWL_8           (0 << 19)       /* Data Word Length */
  29 #define DWL_16          (1 << 19)       /* Data Word Length */
  30 #define DWL_18          (2 << 19)       /* Data Word Length */
  31 #define DWL_20          (3 << 19)       /* Data Word Length */
  32 #define DWL_22          (4 << 19)       /* Data Word Length */
  33 #define DWL_24          (5 << 19)       /* Data Word Length */
  34 #define DWL_32          (6 << 19)       /* Data Word Length */
  35
  36 #define SWL_32          (3 << 16)       /* R/W System Word Length */
  37 #define SCKD            (1 << 15)       /* Serial Bit Clock Direction */
  38 #define SWSD            (1 << 14)       /* Serial WS Direction */
  39 #define SCKP            (1 << 13)       /* Serial Bit Clock Polarity */
  40 #define SWSP            (1 << 12)       /* Serial WS Polarity */
  41 #define SDTA            (1 << 10)       /* Serial Data Alignment */
  42 #define DEL             (1 <<  8)       /* Serial Data Delay */
  43 #define CKDV(v)         (v <<  4)       /* Serial Clock Division Ratio */
  44 #define TRMD            (1 <<  1)       /* Transmit/Receive Mode Select */
  45 #define EN              (1 <<  0)       /* SSI Module Enable */
  46
  47 /*
  48  * SSISR
  49  */
  50 #define UIRQ            (1 << 27)       /* Underflow Error Interrupt Status */
  51 #define OIRQ            (1 << 26)       /* Overflow Error Interrupt Status */
  52 #define IIRQ            (1 << 25)       /* Idle Mode Interrupt Status */
  53 #define DIRQ            (1 << 24)       /* Data Interrupt Status Flag */
  54
  55 /*
  56  * SSIWSR
  57  */
  58 #define CONT            (1 << 8)        /* WS Continue Function */
  59
  60 #define SSI_NAME "ssi"
  61
  62 struct rsnd_ssi {
  63         struct clk *clk;
  64         struct rsnd_ssi_platform_info *info; /* rcar_snd.h */
  65         struct rsnd_ssi *parent;
  66         struct rsnd_mod mod;
  67
  68         struct rsnd_dai *rdai;
  69         u32 cr_own;
  70         u32 cr_clk;
  71         int err;
  72         unsigned int usrcnt;
  73         unsigned int rate;
  74 };
  75
  76 #define for_each_rsnd_ssi(pos, priv, i)                                 \
  77         for (i = 0;                                                     \
  78              (i < rsnd_ssi_nr(priv)) &&                                 \
  79                 ((pos) = ((struct rsnd_ssi *)(priv)->ssi + i));         \
  80              i++)
  81
  82 #define rsnd_ssi_nr(priv) ((priv)->ssi_nr)
  83 #define rsnd_mod_to_ssi(_mod) container_of((_mod), struct rsnd_ssi, mod)
  84 #define rsnd_dma_to_ssi(dma)  rsnd_mod_to_ssi(rsnd_dma_to_mod(dma))
  85 #define rsnd_ssi_pio_available(ssi) ((ssi)->info->pio_irq > 0)
  86 #define rsnd_ssi_dma_available(ssi) \
  87         rsnd_dma_available(rsnd_mod_to_dma(&(ssi)->mod))
  88 #define rsnd_ssi_clk_from_parent(ssi) ((ssi)->parent)
  89 #define rsnd_ssi_mode_flags(p) ((p)->info->flags)
  90 #define rsnd_ssi_dai_id(ssi) ((ssi)->info->dai_id)
  91
  92 static int rsnd_ssi_use_busif(struct rsnd_mod *mod)
  93 {
  94         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
  95         struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
  96         int use_busif = 0;
  97
  98         if (!rsnd_ssi_is_dma_mode(mod))
  99                 return 0;
 100
 101         if (!(rsnd_ssi_mode_flags(ssi) & RSND_SSI_NO_BUSIF))
 102                 use_busif = 1;
 103         if (rsnd_io_to_mod_src(io))
 104                 use_busif = 1;
 105
 106         return use_busif;
 107 }
 108
 109 static void rsnd_ssi_status_check(struct rsnd_mod *mod,
 110                                   u32 bit)
 111 {
 112         struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
 113         struct device *dev = rsnd_priv_to_dev(priv);
 114         u32 status;
 115         int i;
 116
 117         for (i = 0; i < 1024; i++) {
 118                 status = rsnd_mod_read(mod, SSISR);
 119                 if (status & bit)
 120                         return;
 121
 122                 udelay(50);
 123         }
 124
 125         dev_warn(dev, "status check failed\n");
 126 }
 127
 128 static int rsnd_ssi_master_clk_start(struct rsnd_ssi *ssi,
 129                                      struct rsnd_dai_stream *io)
 130 {
 131         struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
 132         struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
 133         struct device *dev = rsnd_priv_to_dev(priv);
 134         int i, j, ret;
 135         int adg_clk_div_table[] = {
 136                 1, 6, /* see adg.c */
 137         };
 138         int ssi_clk_mul_table[] = {
 139                 1, 2, 4, 8, 16, 6, 12,
 140         };
 141         unsigned int main_rate;
 142         unsigned int rate = rsnd_src_get_ssi_rate(priv, io, runtime);
 143
 144         /*
 145          * Find best clock, and try to start ADG
 146          */
 147         for (i = 0; i < ARRAY_SIZE(adg_clk_div_table); i++) {
 148                 for (j = 0; j < ARRAY_SIZE(ssi_clk_mul_table); j++) {
 149
 150                         /*
 151                          * this driver is assuming that
 152                          * system word is 64fs (= 2 x 32bit)
 153                          * see rsnd_ssi_init()
 154                          */
 155                         main_rate = rate / adg_clk_div_table[i]
 156                                 * 32 * 2 * ssi_clk_mul_table[j];
 157
 158                         ret = rsnd_adg_ssi_clk_try_start(&ssi->mod, main_rate);
 159                         if (0 == ret) {
 160                                 ssi->rate       = rate;
 161                                 ssi->cr_clk     = FORCE | SWL_32 |
 162                                                   SCKD | SWSD | CKDV(j);
 163
 164                                 dev_dbg(dev, "%s[%d] outputs %u Hz\n",
 165                                         rsnd_mod_name(&ssi->mod),
 166                                         rsnd_mod_id(&ssi->mod), rate);
 167
 168                                 return 0;
 169                         }
 170                 }
 171         }
 172
 173         dev_err(dev, "unsupported clock rate\n");
 174         return -EIO;
 175 }
 176
 177 static void rsnd_ssi_master_clk_stop(struct rsnd_ssi *ssi)
 178 {
 179         ssi->rate = 0;
 180         ssi->cr_clk = 0;
 181         rsnd_adg_ssi_clk_stop(&ssi->mod);
 182 }
 183
 184 static void rsnd_ssi_hw_start(struct rsnd_ssi *ssi,
 185                               struct rsnd_dai *rdai,
 186                               struct rsnd_dai_stream *io)
 187 {
 188         struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
 189         struct device *dev = rsnd_priv_to_dev(priv);
 190         u32 cr_mode;
 191         u32 cr;
 192
 193         if (0 == ssi->usrcnt) {
 194                 clk_prepare_enable(ssi->clk);
 195
 196                 if (rsnd_dai_is_clk_master(rdai)) {
 197                         if (rsnd_ssi_clk_from_parent(ssi))
 198                                 rsnd_ssi_hw_start(ssi->parent, rdai, io);
 199                         else
 200                                 rsnd_ssi_master_clk_start(ssi, io);
 201                 }
 202         }
 203
 204         cr_mode = rsnd_ssi_is_dma_mode(&ssi->mod) ?
 205                 DMEN :                  /* DMA : use DMA */
 206                 UIEN | OIEN | DIEN;     /* PIO : enable interrupt */
 207
 208
 209         cr  =   ssi->cr_own     |
 210                 ssi->cr_clk     |
 211                 cr_mode         |
 212                 EN;
 213
 214         rsnd_mod_write(&ssi->mod, SSICR, cr);
 215
 216         /* enable WS continue */
 217         if (rsnd_dai_is_clk_master(rdai))
 218                 rsnd_mod_write(&ssi->mod, SSIWSR, CONT);
 219
 220         /* clear error status */
 221         rsnd_mod_write(&ssi->mod, SSISR, 0);
 222
 223         ssi->usrcnt++;
 224
 225         dev_dbg(dev, "%s[%d] hw started\n",
 226                 rsnd_mod_name(&ssi->mod), rsnd_mod_id(&ssi->mod));
 227 }
 228
 229 static void rsnd_ssi_hw_stop(struct rsnd_ssi *ssi,
 230                              struct rsnd_dai *rdai)
 231 {
 232         struct rsnd_priv *priv = rsnd_mod_to_priv(&ssi->mod);
 233         struct device *dev = rsnd_priv_to_dev(priv);
 234         u32 cr;
 235
 236         if (0 == ssi->usrcnt) /* stop might be called without start */
 237                 return;
 238
 239         ssi->usrcnt--;
 240
 241         if (0 == ssi->usrcnt) {
 242                 /*
 243                  * disable all IRQ,
 244                  * and, wait all data was sent
 245                  */
 246                 cr  =   ssi->cr_own     |
 247                         ssi->cr_clk;
 248
 249                 rsnd_mod_write(&ssi->mod, SSICR, cr | EN);
 250                 rsnd_ssi_status_check(&ssi->mod, DIRQ);
 251
 252                 /*
 253                  * disable SSI,
 254                  * and, wait idle state
 255                  */
 256                 rsnd_mod_write(&ssi->mod, SSICR, cr);   /* disabled all */
 257                 rsnd_ssi_status_check(&ssi->mod, IIRQ);
 258
 259                 if (rsnd_dai_is_clk_master(rdai)) {
 260                         if (rsnd_ssi_clk_from_parent(ssi))
 261                                 rsnd_ssi_hw_stop(ssi->parent, rdai);
 262                         else
 263                                 rsnd_ssi_master_clk_stop(ssi);
 264                 }
 265
 266                 clk_disable_unprepare(ssi->clk);
 267         }
 268
 269         dev_dbg(dev, "%s[%d] hw stopped\n",
 270                 rsnd_mod_name(&ssi->mod), rsnd_mod_id(&ssi->mod));
 271 }
 272
 273 /*
 274  *      SSI mod common functions
 275  */
 276 static int rsnd_ssi_init(struct rsnd_mod *mod,
 277                          struct rsnd_dai *rdai)
 278 {
 279         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 280         struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
 281         struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
 282         u32 cr;
 283
 284         cr = FORCE;
 285
 286         /*
 287          * always use 32bit system word for easy clock calculation.
 288          * see also rsnd_ssi_master_clk_enable()
 289          */
 290         cr |= SWL_32;
 291
 292         /*
 293          * init clock settings for SSICR
 294          */
 295         switch (runtime->sample_bits) {
 296         case 16:
 297                 cr |= DWL_16;
 298                 break;
 299         case 32:
 300                 cr |= DWL_24;
 301                 break;
 302         default:
 303                 return -EIO;
 304         }
 305
 306         if (rdai->bit_clk_inv)
 307                 cr |= SCKP;
 308         if (rdai->frm_clk_inv)
 309                 cr |= SWSP;
 310         if (rdai->data_alignment)
 311                 cr |= SDTA;
 312         if (rdai->sys_delay)
 313                 cr |= DEL;
 314         if (rsnd_dai_is_play(rdai, io))
 315                 cr |= TRMD;
 316
 317         /*
 318          * set ssi parameter
 319          */
 320         ssi->rdai       = rdai;
 321         ssi->cr_own     = cr;
 322         ssi->err        = -1; /* ignore 1st error */
 323
 324         return 0;
 325 }
 326
 327 static int rsnd_ssi_quit(struct rsnd_mod *mod,
 328                          struct rsnd_dai *rdai)
 329 {
 330         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 331         struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
 332         struct device *dev = rsnd_priv_to_dev(priv);
 333
 334         if (ssi->err > 0)
 335                 dev_warn(dev, "ssi under/over flow err = %d\n", ssi->err);
 336
 337         ssi->rdai       = NULL;
 338         ssi->cr_own     = 0;
 339         ssi->err        = 0;
 340
 341         return 0;
 342 }
 343
 344 static void rsnd_ssi_record_error(struct rsnd_ssi *ssi, u32 status)
 345 {
 346         /* under/over flow error */
 347         if (status & (UIRQ | OIRQ)) {
 348                 ssi->err++;
 349
 350                 /* clear error status */
 351                 rsnd_mod_write(&ssi->mod, SSISR, 0);
 352         }
 353 }
 354
 355 /*
 356  *              SSI PIO
 357  */
 358 static irqreturn_t rsnd_ssi_pio_interrupt(int irq, void *data)
 359 {
 360         struct rsnd_ssi *ssi = data;
 361         struct rsnd_mod *mod = &ssi->mod;
 362         struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
 363         u32 status = rsnd_mod_read(mod, SSISR);
 364         irqreturn_t ret = IRQ_NONE;
 365
 366         if (io && (status & DIRQ)) {
 367                 struct rsnd_dai *rdai = ssi->rdai;
 368                 struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
 369                 u32 *buf = (u32 *)(runtime->dma_area +
 370                                    rsnd_dai_pointer_offset(io, 0));
 371
 372                 rsnd_ssi_record_error(ssi, status);
 373
 374                 /*
 375                  * 8/16/32 data can be assesse to TDR/RDR register
 376                  * directly as 32bit data
 377                  * see rsnd_ssi_init()
 378                  */
 379                 if (rsnd_dai_is_play(rdai, io))
 380                         rsnd_mod_write(mod, SSITDR, *buf);
 381                 else
 382                         *buf = rsnd_mod_read(mod, SSIRDR);
 383
 384                 rsnd_dai_pointer_update(io, sizeof(*buf));
 385
 386                 ret = IRQ_HANDLED;
 387         }
 388
 389         return ret;
 390 }
 391
 392 static int rsnd_ssi_pio_probe(struct rsnd_mod *mod,
 393                               struct rsnd_dai *rdai)
 394 {
 395         struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
 396         struct device *dev = rsnd_priv_to_dev(priv);
 397         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 398         int irq = ssi->info->pio_irq;
 399         int ret;
 400
 401         ret = devm_request_irq(dev, irq,
 402                                rsnd_ssi_pio_interrupt,
 403                                IRQF_SHARED,
 404                                dev_name(dev), ssi);
 405         if (ret)
 406                 dev_err(dev, "%s[%d] (PIO) request interrupt failed\n",
 407                         rsnd_mod_name(mod), rsnd_mod_id(mod));
 408         else
 409                 dev_dbg(dev, "%s[%d] (PIO) is probed\n",
 410                         rsnd_mod_name(mod), rsnd_mod_id(mod));
 411
 412         return ret;
 413 }
 414
 415 static int rsnd_ssi_start(struct rsnd_mod *mod,
 416                           struct rsnd_dai *rdai)
 417 {
 418         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 419         struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
 420
 421         rsnd_src_ssiu_start(mod, rdai, rsnd_ssi_use_busif(mod));
 422
 423         rsnd_ssi_hw_start(ssi, rdai, io);
 424
 425         rsnd_src_ssi_irq_enable(mod, rdai);
 426
 427         return 0;
 428 }
 429
 430 static int rsnd_ssi_stop(struct rsnd_mod *mod,
 431                          struct rsnd_dai *rdai)
 432 {
 433         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 434
 435         rsnd_src_ssi_irq_disable(mod, rdai);
 436
 437         rsnd_ssi_record_error(ssi, rsnd_mod_read(mod, SSISR));
 438
 439         rsnd_ssi_hw_stop(ssi, rdai);
 440
 441         rsnd_src_ssiu_stop(mod, rdai);
 442
 443         return 0;
 444 }
 445
 446 static struct rsnd_mod_ops rsnd_ssi_pio_ops = {
 447         .name   = SSI_NAME,
 448         .probe  = rsnd_ssi_pio_probe,
 449         .init   = rsnd_ssi_init,
 450         .quit   = rsnd_ssi_quit,
 451         .start  = rsnd_ssi_start,
 452         .stop   = rsnd_ssi_stop,
 453 };
 454
 455 static int rsnd_ssi_dma_probe(struct rsnd_mod *mod,
 456                           struct rsnd_dai *rdai)
 457 {
 458         struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
 459         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 460         struct device *dev = rsnd_priv_to_dev(priv);
 461         int dma_id = ssi->info->dma_id;
 462         int ret;
 463
 464         ret = rsnd_dma_init(
 465                 priv, rsnd_mod_to_dma(mod),
 466                 rsnd_info_is_playback(priv, ssi),
 467                 dma_id);
 468
 469         if (ret < 0)
 470                 dev_err(dev, "%s[%d] (DMA) is failed\n",
 471                         rsnd_mod_name(mod), rsnd_mod_id(mod));
 472         else
 473                 dev_dbg(dev, "%s[%d] (DMA) is probed\n",
 474                         rsnd_mod_name(mod), rsnd_mod_id(mod));
 475
 476         return ret;
 477 }
 478
 479 static int rsnd_ssi_dma_remove(struct rsnd_mod *mod,
 480                                struct rsnd_dai *rdai)
 481 {
 482         rsnd_dma_quit(rsnd_mod_to_priv(mod), rsnd_mod_to_dma(mod));
 483
 484         return 0;
 485 }
 486
 487 static int rsnd_ssi_fallback(struct rsnd_mod *mod,
 488                              struct rsnd_dai *rdai)
 489 {
 490         struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
 491         struct device *dev = rsnd_priv_to_dev(priv);
 492
 493         /*
 494          * fallback to PIO
 495          *
 496          * SSI .probe might be called again.
 497          * see
 498          *      rsnd_rdai_continuance_probe()
 499          */
 500         mod->ops = &rsnd_ssi_pio_ops;
 501
 502         dev_info(dev, "%s[%d] fallback to PIO mode\n",
 503                  rsnd_mod_name(mod), rsnd_mod_id(mod));
 504
 505         return 0;
 506 }
 507
 508 static int rsnd_ssi_dma_start(struct rsnd_mod *mod,
 509                               struct rsnd_dai *rdai)
 510 {
 511         struct rsnd_dma *dma = rsnd_mod_to_dma(mod);
 512
 513         rsnd_ssi_start(mod, rdai);
 514
 515         rsnd_dma_start(dma);
 516
 517         return 0;
 518 }
 519
 520 static int rsnd_ssi_dma_stop(struct rsnd_mod *mod,
 521                              struct rsnd_dai *rdai)
 522 {
 523         struct rsnd_dma *dma = rsnd_mod_to_dma(mod);
 524
 525         rsnd_dma_stop(dma);
 526
 527         rsnd_ssi_stop(mod, rdai);
 528
 529         return 0;
 530 }
 531
 532 static char *rsnd_ssi_dma_name(struct rsnd_mod *mod)
 533 {
 534         return rsnd_ssi_use_busif(mod) ? "ssiu" : SSI_NAME;
 535 }
 536
 537 static struct rsnd_mod_ops rsnd_ssi_dma_ops = {
 538         .name   = SSI_NAME,
 539         .dma_name = rsnd_ssi_dma_name,
 540         .probe  = rsnd_ssi_dma_probe,
 541         .remove = rsnd_ssi_dma_remove,
 542         .init   = rsnd_ssi_init,
 543         .quit   = rsnd_ssi_quit,
 544         .start  = rsnd_ssi_dma_start,
 545         .stop   = rsnd_ssi_dma_stop,
 546         .fallback = rsnd_ssi_fallback,
 547 };
 548
 549 int rsnd_ssi_is_dma_mode(struct rsnd_mod *mod)
 550 {
 551         return mod->ops == &rsnd_ssi_dma_ops;
 552 }
 553
 554
 555 /*
 556  *              Non SSI
 557  */
 558 static struct rsnd_mod_ops rsnd_ssi_non_ops = {
 559         .name   = SSI_NAME,
 560 };
 561
 562 /*
 563  *              ssi mod function
 564  */
 565 struct rsnd_mod *rsnd_ssi_mod_get(struct rsnd_priv *priv, int id)
 566 {
 567         if (WARN_ON(id < 0 || id >= rsnd_ssi_nr(priv)))
 568                 id = 0;
 569
 570         return &((struct rsnd_ssi *)(priv->ssi) + id)->mod;
 571 }
 572
 573 int rsnd_ssi_is_pin_sharing(struct rsnd_mod *mod)
 574 {
 575         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
 576
 577         return !!(rsnd_ssi_mode_flags(ssi) & RSND_SSI_CLK_PIN_SHARE);
 578 }
 579
 580 static void rsnd_ssi_parent_clk_setup(struct rsnd_priv *priv, struct rsnd_ssi *ssi)
 581 {
 582         if (!rsnd_ssi_is_pin_sharing(&ssi->mod))
 583                 return;
 584
 585         switch (rsnd_mod_id(&ssi->mod)) {
 586         case 1:
 587         case 2:
 588                 ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 0));
 589                 break;
 590         case 4:
 591                 ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 3));
 592                 break;
 593         case 8:
 594                 ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 7));
 595                 break;
 596         }
 597 }
 598
 599
 600 static void rsnd_of_parse_ssi(struct platform_device *pdev,
 601                               const struct rsnd_of_data *of_data,
 602                               struct rsnd_priv *priv)
 603 {
 604         struct device_node *node;
 605         struct device_node *np;
 606         struct rsnd_ssi_platform_info *ssi_info;
 607         struct rcar_snd_info *info = rsnd_priv_to_info(priv);
 608         struct device *dev = &pdev->dev;
 609         int nr, i;
 610
 611         if (!of_data)
 612                 return;
 613
 614         node = of_get_child_by_name(dev->of_node, "rcar_sound,ssi");
 615         if (!node)
 616                 return;
 617
 618         nr = of_get_child_count(node);
 619         if (!nr)
 620                 goto rsnd_of_parse_ssi_end;
 621
 622         ssi_info = devm_kzalloc(dev,
 623                                 sizeof(struct rsnd_ssi_platform_info) * nr,
 624                                 GFP_KERNEL);
 625         if (!ssi_info) {
 626                 dev_err(dev, "ssi info allocation error\n");
 627                 goto rsnd_of_parse_ssi_end;
 628         }
 629
 630         info->ssi_info          = ssi_info;
 631         info->ssi_info_nr       = nr;
 632
 633         i = -1;
 634         for_each_child_of_node(node, np) {
 635                 i++;
 636
 637                 ssi_info = info->ssi_info + i;
 638
 639                 /*
 640                  * pin settings
 641                  */
 642                 if (of_get_property(np, "shared-pin", NULL))
 643                         ssi_info->flags |= RSND_SSI_CLK_PIN_SHARE;
 644
 645                 /*
 646                  * irq
 647                  */
 648                 ssi_info->pio_irq = irq_of_parse_and_map(np, 0);
 649
 650                 /*
 651                  * DMA
 652                  */
 653                 ssi_info->dma_id = of_get_property(np, "pio-transfer", NULL) ?
 654                         0 : 1;
 655
 656                 if (of_get_property(np, "no-busif", NULL))
 657                         ssi_info->flags |= RSND_SSI_NO_BUSIF;
 658         }
 659
 660 rsnd_of_parse_ssi_end:
 661         of_node_put(node);
 662 }
 663
 664 int rsnd_ssi_probe(struct platform_device *pdev,
 665                    const struct rsnd_of_data *of_data,
 666                    struct rsnd_priv *priv)
 667 {
 668         struct rcar_snd_info *info = rsnd_priv_to_info(priv);
 669         struct rsnd_ssi_platform_info *pinfo;
 670         struct device *dev = rsnd_priv_to_dev(priv);
 671         struct rsnd_mod_ops *ops;
 672         struct clk *clk;
 673         struct rsnd_ssi *ssi;
 674         char name[RSND_SSI_NAME_SIZE];
 675         int i, nr;
 676
 677         rsnd_of_parse_ssi(pdev, of_data, priv);
 678
 679         /*
 680          *      init SSI
 681          */
 682         nr      = info->ssi_info_nr;
 683         ssi     = devm_kzalloc(dev, sizeof(*ssi) * nr, GFP_KERNEL);
 684         if (!ssi) {
 685                 dev_err(dev, "SSI allocate failed\n");
 686                 return -ENOMEM;
 687         }
 688
 689         priv->ssi       = ssi;
 690         priv->ssi_nr    = nr;
 691
 692         for_each_rsnd_ssi(ssi, priv, i) {
 693                 pinfo = &info->ssi_info[i];
 694
 695                 snprintf(name, RSND_SSI_NAME_SIZE, "%s.%d",
 696                          SSI_NAME, i);
 697
 698                 clk = devm_clk_get(dev, name);
 699                 if (IS_ERR(clk))
 700                         return PTR_ERR(clk);
 701
 702                 ssi->info       = pinfo;
 703                 ssi->clk        = clk;
 704
 705                 ops = &rsnd_ssi_non_ops;
 706                 if (pinfo->dma_id > 0)
 707                         ops = &rsnd_ssi_dma_ops;
 708                 else if (rsnd_ssi_pio_available(ssi))
 709                         ops = &rsnd_ssi_pio_ops;
 710
 711                 rsnd_mod_init(priv, &ssi->mod, ops, RSND_MOD_SSI, i);
 712
 713                 rsnd_ssi_parent_clk_setup(priv, ssi);
 714         }
 715
 716         return 0;
 717 }