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