cae08b7ffa5323fbb6e44ad1e8af7a3ccb623082
[platform/adaptation/renesas_rcar/renesas_kernel.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, 0);
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_dma_start(struct rsnd_mod *mod,
474                               struct rsnd_dai *rdai)
475 {
476         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
477         struct rsnd_dma *dma = rsnd_mod_to_dma(&ssi->mod);
478         struct rsnd_dai_stream *io = rsnd_mod_to_io(mod);
479
480         /* enable DMA transfer */
481         ssi->cr_etc = DMEN;
482
483         rsnd_src_ssiu_start(mod, rdai, rsnd_ssi_use_busif(mod));
484
485         rsnd_dma_start(dma);
486
487         rsnd_ssi_hw_start(ssi, ssi->rdai, io);
488
489         /* enable WS continue */
490         if (rsnd_dai_is_clk_master(rdai))
491                 rsnd_mod_write(&ssi->mod, SSIWSR, CONT);
492
493         return 0;
494 }
495
496 static int rsnd_ssi_dma_stop(struct rsnd_mod *mod,
497                              struct rsnd_dai *rdai)
498 {
499         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
500         struct rsnd_dma *dma = rsnd_mod_to_dma(&ssi->mod);
501
502         ssi->cr_etc = 0;
503
504         rsnd_ssi_record_error(ssi, rsnd_mod_read(mod, SSISR));
505
506         rsnd_ssi_hw_stop(ssi, rdai);
507
508         rsnd_dma_stop(dma);
509
510         rsnd_src_ssiu_stop(mod, rdai, 1);
511
512         return 0;
513 }
514
515 static char *rsnd_ssi_dma_name(struct rsnd_mod *mod)
516 {
517         return rsnd_ssi_use_busif(mod) ? "ssiu" : SSI_NAME;
518 }
519
520 static struct rsnd_mod_ops rsnd_ssi_dma_ops = {
521         .name   = SSI_NAME,
522         .dma_name = rsnd_ssi_dma_name,
523         .probe  = rsnd_ssi_dma_probe,
524         .remove = rsnd_ssi_dma_remove,
525         .init   = rsnd_ssi_init,
526         .quit   = rsnd_ssi_quit,
527         .start  = rsnd_ssi_dma_start,
528         .stop   = rsnd_ssi_dma_stop,
529 };
530
531 /*
532  *              Non SSI
533  */
534 static struct rsnd_mod_ops rsnd_ssi_non_ops = {
535         .name   = SSI_NAME,
536 };
537
538 /*
539  *              ssi mod function
540  */
541 struct rsnd_mod *rsnd_ssi_mod_get(struct rsnd_priv *priv, int id)
542 {
543         if (WARN_ON(id < 0 || id >= rsnd_ssi_nr(priv)))
544                 id = 0;
545
546         return &((struct rsnd_ssi *)(priv->ssi) + id)->mod;
547 }
548
549 int rsnd_ssi_is_pin_sharing(struct rsnd_mod *mod)
550 {
551         struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod);
552
553         return !!(rsnd_ssi_mode_flags(ssi) & RSND_SSI_CLK_PIN_SHARE);
554 }
555
556 static void rsnd_ssi_parent_clk_setup(struct rsnd_priv *priv, struct rsnd_ssi *ssi)
557 {
558         if (!rsnd_ssi_is_pin_sharing(&ssi->mod))
559                 return;
560
561         switch (rsnd_mod_id(&ssi->mod)) {
562         case 1:
563         case 2:
564                 ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 0));
565                 break;
566         case 4:
567                 ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 3));
568                 break;
569         case 8:
570                 ssi->parent = rsnd_mod_to_ssi(rsnd_ssi_mod_get(priv, 7));
571                 break;
572         }
573 }
574
575
576 static void rsnd_of_parse_ssi(struct platform_device *pdev,
577                               const struct rsnd_of_data *of_data,
578                               struct rsnd_priv *priv)
579 {
580         struct device_node *node;
581         struct device_node *np;
582         struct rsnd_ssi_platform_info *ssi_info;
583         struct rcar_snd_info *info = rsnd_priv_to_info(priv);
584         struct device *dev = &pdev->dev;
585         int nr, i;
586
587         if (!of_data)
588                 return;
589
590         node = of_get_child_by_name(dev->of_node, "rcar_sound,ssi");
591         if (!node)
592                 return;
593
594         nr = of_get_child_count(node);
595         if (!nr)
596                 goto rsnd_of_parse_ssi_end;
597
598         ssi_info = devm_kzalloc(dev,
599                                 sizeof(struct rsnd_ssi_platform_info) * nr,
600                                 GFP_KERNEL);
601         if (!ssi_info) {
602                 dev_err(dev, "ssi info allocation error\n");
603                 goto rsnd_of_parse_ssi_end;
604         }
605
606         info->ssi_info          = ssi_info;
607         info->ssi_info_nr       = nr;
608
609         i = -1;
610         for_each_child_of_node(node, np) {
611                 i++;
612
613                 ssi_info = info->ssi_info + i;
614
615                 /*
616                  * pin settings
617                  */
618                 if (of_get_property(np, "shared-pin", NULL))
619                         ssi_info->flags |= RSND_SSI_CLK_PIN_SHARE;
620
621                 /*
622                  * irq
623                  */
624                 ssi_info->pio_irq = irq_of_parse_and_map(np, 0);
625
626                 /*
627                  * DMA
628                  */
629                 ssi_info->dma_id = of_get_property(np, "pio-transfer", NULL) ?
630                         0 : 1;
631
632                 if (of_get_property(np, "no-busif", NULL))
633                         ssi_info->flags |= RSND_SSI_NO_BUSIF;
634         }
635
636 rsnd_of_parse_ssi_end:
637         of_node_put(node);
638 }
639
640 int rsnd_ssi_probe(struct platform_device *pdev,
641                    const struct rsnd_of_data *of_data,
642                    struct rsnd_priv *priv)
643 {
644         struct rcar_snd_info *info = rsnd_priv_to_info(priv);
645         struct rsnd_ssi_platform_info *pinfo;
646         struct device *dev = rsnd_priv_to_dev(priv);
647         struct rsnd_mod_ops *ops;
648         struct clk *clk;
649         struct rsnd_ssi *ssi;
650         char name[RSND_SSI_NAME_SIZE];
651         int i, nr;
652
653         rsnd_of_parse_ssi(pdev, of_data, priv);
654
655         /*
656          *      init SSI
657          */
658         nr      = info->ssi_info_nr;
659         ssi     = devm_kzalloc(dev, sizeof(*ssi) * nr, GFP_KERNEL);
660         if (!ssi) {
661                 dev_err(dev, "SSI allocate failed\n");
662                 return -ENOMEM;
663         }
664
665         priv->ssi       = ssi;
666         priv->ssi_nr    = nr;
667
668         for_each_rsnd_ssi(ssi, priv, i) {
669                 pinfo = &info->ssi_info[i];
670
671                 snprintf(name, RSND_SSI_NAME_SIZE, "%s.%d",
672                          SSI_NAME, i);
673
674                 clk = devm_clk_get(dev, name);
675                 if (IS_ERR(clk))
676                         return PTR_ERR(clk);
677
678                 ssi->info       = pinfo;
679                 ssi->clk        = clk;
680
681                 ops = &rsnd_ssi_non_ops;
682                 if (pinfo->dma_id > 0)
683                         ops = &rsnd_ssi_dma_ops;
684                 else if (rsnd_ssi_pio_available(ssi))
685                         ops = &rsnd_ssi_pio_ops;
686
687                 rsnd_mod_init(priv, &ssi->mod, ops, RSND_MOD_SSI, i);
688
689                 rsnd_ssi_parent_clk_setup(priv, ssi);
690         }
691
692         return 0;
693 }