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