1 // SPDX-License-Identifier: GPL-2.0
3 // Renesas R-Car SSIU/SSI support
5 // Copyright (C) 2013 Renesas Solutions Corp.
6 // Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
9 // Kuninori Morimoto <morimoto.kuninori@renesas.com>
12 * you can enable below define if you don't need
13 * SSI interrupt status debug message when debugging
14 * see rsnd_dbg_irq_status()
16 * #define RSND_DEBUG_NO_IRQ_STATUS 1
19 #include <sound/simple_card_utils.h>
20 #include <linux/delay.h>
22 #define RSND_SSI_NAME_SIZE 16
27 #define FORCE (1 << 31) /* Fixed */
28 #define DMEN (1 << 28) /* DMA Enable */
29 #define UIEN (1 << 27) /* Underflow Interrupt Enable */
30 #define OIEN (1 << 26) /* Overflow Interrupt Enable */
31 #define IIEN (1 << 25) /* Idle Mode Interrupt Enable */
32 #define DIEN (1 << 24) /* Data Interrupt Enable */
33 #define CHNL_4 (1 << 22) /* Channels */
34 #define CHNL_6 (2 << 22) /* Channels */
35 #define CHNL_8 (3 << 22) /* Channels */
36 #define DWL_MASK (7 << 19) /* Data Word Length mask */
37 #define DWL_8 (0 << 19) /* Data Word Length */
38 #define DWL_16 (1 << 19) /* Data Word Length */
39 #define DWL_18 (2 << 19) /* Data Word Length */
40 #define DWL_20 (3 << 19) /* Data Word Length */
41 #define DWL_22 (4 << 19) /* Data Word Length */
42 #define DWL_24 (5 << 19) /* Data Word Length */
43 #define DWL_32 (6 << 19) /* Data Word Length */
48 #define SWL_16 (1 << 16) /* R/W System Word Length */
49 #define SWL_24 (2 << 16) /* R/W System Word Length */
50 #define SWL_32 (3 << 16) /* R/W System Word Length */
52 #define SCKD (1 << 15) /* Serial Bit Clock Direction */
53 #define SWSD (1 << 14) /* Serial WS Direction */
54 #define SCKP (1 << 13) /* Serial Bit Clock Polarity */
55 #define SWSP (1 << 12) /* Serial WS Polarity */
56 #define SDTA (1 << 10) /* Serial Data Alignment */
57 #define PDTA (1 << 9) /* Parallel Data Alignment */
58 #define DEL (1 << 8) /* Serial Data Delay */
59 #define CKDV(v) (v << 4) /* Serial Clock Division Ratio */
60 #define TRMD (1 << 1) /* Transmit/Receive Mode Select */
61 #define EN (1 << 0) /* SSI Module Enable */
66 #define UIRQ (1 << 27) /* Underflow Error Interrupt Status */
67 #define OIRQ (1 << 26) /* Overflow Error Interrupt Status */
68 #define IIRQ (1 << 25) /* Idle Mode Interrupt Status */
69 #define DIRQ (1 << 24) /* Data Interrupt Status Flag */
74 #define CONT (1 << 8) /* WS Continue Function */
75 #define WS_MODE (1 << 0) /* WS Mode */
77 #define SSI_NAME "ssi"
100 #define RSND_SSI_CLK_PIN_SHARE (1 << 0)
101 #define RSND_SSI_NO_BUSIF (1 << 1) /* SSI+DMA without BUSIF */
102 #define RSND_SSI_PROBED (1 << 2)
104 #define for_each_rsnd_ssi(pos, priv, i) \
106 (i < rsnd_ssi_nr(priv)) && \
107 ((pos) = ((struct rsnd_ssi *)(priv)->ssi + i)); \
110 #define rsnd_ssi_get(priv, id) ((struct rsnd_ssi *)(priv->ssi) + id)
111 #define rsnd_ssi_nr(priv) ((priv)->ssi_nr)
112 #define rsnd_mod_to_ssi(_mod) container_of((_mod), struct rsnd_ssi, mod)
113 #define rsnd_ssi_is_parent(ssi, io) ((ssi) == rsnd_io_to_mod_ssip(io))
114 #define rsnd_ssi_is_multi_slave(mod, io) \
115 (rsnd_ssi_multi_slaves(io) & (1 << rsnd_mod_id(mod)))
116 #define rsnd_ssi_is_run_mods(mod, io) \
117 (rsnd_ssi_run_mods(io) & (1 << rsnd_mod_id(mod)))
118 #define rsnd_ssi_can_output_clk(mod) (!__rsnd_ssi_is_pin_sharing(mod))
120 static int rsnd_ssi_is_dma_mode(struct rsnd_mod
*mod
);
122 int rsnd_ssi_use_busif(struct rsnd_dai_stream
*io
)
124 struct rsnd_mod
*mod
= rsnd_io_to_mod_ssi(io
);
125 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
128 if (!rsnd_ssi_is_dma_mode(mod
))
131 if (!(rsnd_flags_has(ssi
, RSND_SSI_NO_BUSIF
)))
133 if (rsnd_io_to_mod_src(io
))
139 static void rsnd_ssi_status_clear(struct rsnd_mod
*mod
)
141 rsnd_mod_write(mod
, SSISR
, 0);
144 static u32
rsnd_ssi_status_get(struct rsnd_mod
*mod
)
146 return rsnd_mod_read(mod
, SSISR
);
149 static void rsnd_ssi_status_check(struct rsnd_mod
*mod
,
152 struct rsnd_priv
*priv
= rsnd_mod_to_priv(mod
);
153 struct device
*dev
= rsnd_priv_to_dev(priv
);
157 for (i
= 0; i
< 1024; i
++) {
158 status
= rsnd_ssi_status_get(mod
);
165 dev_warn(dev
, "%s status check failed\n", rsnd_mod_name(mod
));
168 static u32
rsnd_ssi_multi_slaves(struct rsnd_dai_stream
*io
)
170 struct rsnd_mod
*mod
;
171 enum rsnd_mod_type types
[] = {
179 for (i
= 0; i
< ARRAY_SIZE(types
); i
++) {
180 mod
= rsnd_io_to_mod(io
, types
[i
]);
184 mask
|= 1 << rsnd_mod_id(mod
);
190 static u32
rsnd_ssi_run_mods(struct rsnd_dai_stream
*io
)
192 struct rsnd_mod
*ssi_mod
= rsnd_io_to_mod_ssi(io
);
193 struct rsnd_mod
*ssi_parent_mod
= rsnd_io_to_mod_ssip(io
);
196 mods
= rsnd_ssi_multi_slaves_runtime(io
) |
197 1 << rsnd_mod_id(ssi_mod
);
200 mods
|= 1 << rsnd_mod_id(ssi_parent_mod
);
205 u32
rsnd_ssi_multi_slaves_runtime(struct rsnd_dai_stream
*io
)
207 if (rsnd_runtime_is_multi_ssi(io
))
208 return rsnd_ssi_multi_slaves(io
);
213 static u32
rsnd_rdai_width_to_swl(struct rsnd_dai
*rdai
)
215 struct rsnd_priv
*priv
= rsnd_rdai_to_priv(rdai
);
216 struct device
*dev
= rsnd_priv_to_dev(priv
);
217 int width
= rsnd_rdai_width_get(rdai
);
220 case 32: return SWL_32
;
221 case 24: return SWL_24
;
222 case 16: return SWL_16
;
225 dev_err(dev
, "unsupported slot width value: %d\n", width
);
229 unsigned int rsnd_ssi_clk_query(struct rsnd_dai
*rdai
,
230 int param1
, int param2
, int *idx
)
232 struct rsnd_priv
*priv
= rsnd_rdai_to_priv(rdai
);
233 int ssi_clk_mul_table
[] = {
234 1, 2, 4, 8, 16, 6, 12,
237 unsigned int main_rate
;
238 int width
= rsnd_rdai_width_get(rdai
);
240 for (j
= 0; j
< ARRAY_SIZE(ssi_clk_mul_table
); j
++) {
243 * It will set SSIWSR.CONT here, but SSICR.CKDV = 000
244 * with it is not allowed. (SSIWSR.WS_MODE with
245 * SSICR.CKDV = 000 is not allowed either).
246 * Skip it. See SSICR.CKDV
251 main_rate
= width
* param1
* param2
* ssi_clk_mul_table
[j
];
253 ret
= rsnd_adg_clk_query(priv
, main_rate
);
266 static int rsnd_ssi_master_clk_start(struct rsnd_mod
*mod
,
267 struct rsnd_dai_stream
*io
)
269 struct rsnd_priv
*priv
= rsnd_io_to_priv(io
);
270 struct device
*dev
= rsnd_priv_to_dev(priv
);
271 struct rsnd_dai
*rdai
= rsnd_io_to_rdai(io
);
272 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
273 int chan
= rsnd_runtime_channel_for_ssi(io
);
275 unsigned int main_rate
;
276 unsigned int rate
= rsnd_io_is_play(io
) ?
277 rsnd_src_get_out_rate(priv
, io
) :
278 rsnd_src_get_in_rate(priv
, io
);
280 if (!rsnd_rdai_is_clk_master(rdai
))
283 if (!rsnd_ssi_can_output_clk(mod
))
286 if (rsnd_ssi_is_multi_slave(mod
, io
))
289 if (rsnd_runtime_is_tdm_split(io
))
290 chan
= rsnd_io_converted_chan(io
);
292 chan
= rsnd_channel_normalization(chan
);
294 if (ssi
->usrcnt
> 0) {
295 if (ssi
->rate
!= rate
) {
296 dev_err(dev
, "SSI parent/child should use same rate\n");
300 if (ssi
->chan
!= chan
) {
301 dev_err(dev
, "SSI parent/child should use same chan\n");
308 main_rate
= rsnd_ssi_clk_query(rdai
, rate
, chan
, &idx
);
310 dev_err(dev
, "unsupported clock rate\n");
314 ret
= rsnd_adg_ssi_clk_try_start(mod
, main_rate
);
319 * SSI clock will be output contiguously
321 * This means, rsnd_ssi_master_clk_start()
322 * and rsnd_ssi_register_setup() are necessary
325 * SSICR : FORCE, SCKD, SWSD
328 ssi
->cr_clk
= FORCE
| rsnd_rdai_width_to_swl(rdai
) |
329 SCKD
| SWSD
| CKDV(idx
);
334 dev_dbg(dev
, "%s outputs %d chan %u Hz\n",
335 rsnd_mod_name(mod
), chan
, rate
);
340 static void rsnd_ssi_master_clk_stop(struct rsnd_mod
*mod
,
341 struct rsnd_dai_stream
*io
)
343 struct rsnd_dai
*rdai
= rsnd_io_to_rdai(io
);
344 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
346 if (!rsnd_rdai_is_clk_master(rdai
))
349 if (!rsnd_ssi_can_output_clk(mod
))
359 rsnd_adg_ssi_clk_stop(mod
);
362 static void rsnd_ssi_config_init(struct rsnd_mod
*mod
,
363 struct rsnd_dai_stream
*io
)
365 struct rsnd_dai
*rdai
= rsnd_io_to_rdai(io
);
366 struct rsnd_priv
*priv
= rsnd_rdai_to_priv(rdai
);
367 struct device
*dev
= rsnd_priv_to_dev(priv
);
368 struct snd_pcm_runtime
*runtime
= rsnd_io_to_runtime(io
);
369 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
370 u32 cr_own
= ssi
->cr_own
;
371 u32 cr_mode
= ssi
->cr_mode
;
374 int is_tdm
, is_tdm_split
;
376 is_tdm
= rsnd_runtime_is_tdm(io
);
377 is_tdm_split
= rsnd_runtime_is_tdm_split(io
);
380 dev_dbg(dev
, "TDM mode\n");
382 dev_dbg(dev
, "TDM Split mode\n");
384 cr_own
|= FORCE
| rsnd_rdai_width_to_swl(rdai
);
386 if (rdai
->bit_clk_inv
)
388 if (rdai
->frm_clk_inv
&& !is_tdm
)
390 if (rdai
->data_alignment
)
398 * rsnd_ssiu_init_gen2()
401 if (is_tdm
|| is_tdm_split
) {
407 * We shouldn't exchange SWSP after running.
408 * This means, parent needs to care it.
410 if (rsnd_ssi_is_parent(mod
, io
))
413 if (rsnd_io_is_play(io
))
417 width
= snd_pcm_format_width(runtime
->format
);
420 * The SWL and DWL bits in SSICR should be fixed at 32-bit
421 * setting when TDM split mode.
423 * Operation :: TDM Format Split Function (TDM Split Mode)
443 if (rsnd_ssi_is_dma_mode(mod
)) {
444 cr_mode
= UIEN
| OIEN
| /* over/under run */
445 DMEN
; /* DMA : enable DMA */
447 cr_mode
= DIEN
; /* PIO : enable Data interrupt */
451 ssi
->cr_own
= cr_own
;
452 ssi
->cr_mode
= cr_mode
;
456 static void rsnd_ssi_register_setup(struct rsnd_mod
*mod
)
458 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
460 rsnd_mod_write(mod
, SSIWSR
, ssi
->wsr
);
461 rsnd_mod_write(mod
, SSICR
, ssi
->cr_own
|
468 * SSI mod common functions
470 static int rsnd_ssi_init(struct rsnd_mod
*mod
,
471 struct rsnd_dai_stream
*io
,
472 struct rsnd_priv
*priv
)
474 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
476 if (!rsnd_ssi_is_run_mods(mod
, io
))
481 rsnd_mod_power_on(mod
);
483 rsnd_ssi_config_init(mod
, io
);
485 rsnd_ssi_register_setup(mod
);
487 /* clear error status */
488 rsnd_ssi_status_clear(mod
);
493 static int rsnd_ssi_quit(struct rsnd_mod
*mod
,
494 struct rsnd_dai_stream
*io
,
495 struct rsnd_priv
*priv
)
497 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
498 struct device
*dev
= rsnd_priv_to_dev(priv
);
500 if (!rsnd_ssi_is_run_mods(mod
, io
))
504 dev_err(dev
, "%s usrcnt error\n", rsnd_mod_name(mod
));
508 rsnd_ssi_master_clk_stop(mod
, io
);
510 rsnd_mod_power_off(mod
);
523 static int rsnd_ssi_hw_params(struct rsnd_mod
*mod
,
524 struct rsnd_dai_stream
*io
,
525 struct snd_pcm_substream
*substream
,
526 struct snd_pcm_hw_params
*params
)
528 struct rsnd_dai
*rdai
= rsnd_io_to_rdai(io
);
529 unsigned int fmt_width
= snd_pcm_format_width(params_format(params
));
531 if (fmt_width
> rdai
->chan_width
) {
532 struct rsnd_priv
*priv
= rsnd_io_to_priv(io
);
533 struct device
*dev
= rsnd_priv_to_dev(priv
);
535 dev_err(dev
, "invalid combination of slot-width and format-data-width\n");
542 static int rsnd_ssi_start(struct rsnd_mod
*mod
,
543 struct rsnd_dai_stream
*io
,
544 struct rsnd_priv
*priv
)
546 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
548 if (!rsnd_ssi_is_run_mods(mod
, io
))
552 * EN will be set via SSIU :: SSI_CONTROL
553 * if Multi channel mode
555 if (rsnd_ssi_multi_slaves_runtime(io
))
559 * EN is for data output.
560 * SSI parent EN is not needed.
562 if (rsnd_ssi_is_parent(mod
, io
))
567 rsnd_mod_write(mod
, SSICR
, ssi
->cr_own
|
575 static int rsnd_ssi_stop(struct rsnd_mod
*mod
,
576 struct rsnd_dai_stream
*io
,
577 struct rsnd_priv
*priv
)
579 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
582 if (!rsnd_ssi_is_run_mods(mod
, io
))
585 if (rsnd_ssi_is_parent(mod
, io
))
593 * Playback: Wait all data was sent
594 * Capture: It might not receave data. Do nothing
596 if (rsnd_io_is_play(io
)) {
597 rsnd_mod_write(mod
, SSICR
, cr
| ssi
->cr_en
);
598 rsnd_ssi_status_check(mod
, DIRQ
);
601 /* In multi-SSI mode, stop is performed by setting ssi0129 in
602 * SSI_CONTROL to 0 (in rsnd_ssio_stop_gen2). Do nothing here.
604 if (rsnd_ssi_multi_slaves_runtime(io
))
609 * and, wait idle state
611 rsnd_mod_write(mod
, SSICR
, cr
); /* disabled all */
612 rsnd_ssi_status_check(mod
, IIRQ
);
619 static int rsnd_ssi_irq(struct rsnd_mod
*mod
,
620 struct rsnd_dai_stream
*io
,
621 struct rsnd_priv
*priv
,
626 if (rsnd_is_gen1(priv
))
629 if (rsnd_ssi_is_parent(mod
, io
))
632 if (!rsnd_ssi_is_run_mods(mod
, io
))
636 val
= rsnd_ssi_is_dma_mode(mod
) ? 0x0e000000 : 0x0f000000;
638 rsnd_mod_write(mod
, SSI_INT_ENABLE
, val
);
643 static bool rsnd_ssi_pio_interrupt(struct rsnd_mod
*mod
,
644 struct rsnd_dai_stream
*io
);
645 static void __rsnd_ssi_interrupt(struct rsnd_mod
*mod
,
646 struct rsnd_dai_stream
*io
)
648 struct rsnd_priv
*priv
= rsnd_mod_to_priv(mod
);
649 struct device
*dev
= rsnd_priv_to_dev(priv
);
650 int is_dma
= rsnd_ssi_is_dma_mode(mod
);
652 bool elapsed
= false;
655 spin_lock(&priv
->lock
);
657 /* ignore all cases if not working */
658 if (!rsnd_io_is_working(io
))
659 goto rsnd_ssi_interrupt_out
;
661 status
= rsnd_ssi_status_get(mod
);
664 if (!is_dma
&& (status
& DIRQ
))
665 elapsed
= rsnd_ssi_pio_interrupt(mod
, io
);
668 if (is_dma
&& (status
& (UIRQ
| OIRQ
))) {
669 rsnd_dbg_irq_status(dev
, "%s err status : 0x%08x\n",
670 rsnd_mod_name(mod
), status
);
675 rsnd_ssi_status_clear(mod
);
676 rsnd_ssi_interrupt_out
:
677 spin_unlock(&priv
->lock
);
680 rsnd_dai_period_elapsed(io
);
683 snd_pcm_stop_xrun(io
->substream
);
687 static irqreturn_t
rsnd_ssi_interrupt(int irq
, void *data
)
689 struct rsnd_mod
*mod
= data
;
691 rsnd_mod_interrupt(mod
, __rsnd_ssi_interrupt
);
696 static u32
*rsnd_ssi_get_status(struct rsnd_mod
*mod
,
697 struct rsnd_dai_stream
*io
,
698 enum rsnd_mod_type type
)
701 * SSIP (= SSI parent) needs to be special, otherwise,
702 * 2nd SSI might doesn't start. see also rsnd_mod_call()
704 * We can't include parent SSI status on SSI, because we don't know
705 * how many SSI requests parent SSI. Thus, it is localed on "io" now.
708 * Capture : SSI1 (needs SSI0)
710 * 1) start Capture -> SSI0/SSI1 are started.
711 * 2) start Playback -> SSI0 doesn't work, because it is already
712 * marked as "started" on 1)
714 * OTOH, using each mod's status is good for MUX case.
715 * It doesn't need to start in 2nd start
717 * IO-0: SRC0 -> CTU1 -+-> MUX -> DVC -> SSIU -> SSI0
719 * IO-1: SRC1 -> CTU2 -+
721 * 1) start IO-0 -> start SSI0
722 * 2) start IO-1 -> SSI0 doesn't need to start, because it is
723 * already started on 1)
725 if (type
== RSND_MOD_SSIP
)
726 return &io
->parent_ssi_status
;
728 return rsnd_mod_get_status(mod
, io
, type
);
734 static void rsnd_ssi_parent_attach(struct rsnd_mod
*mod
,
735 struct rsnd_dai_stream
*io
)
737 struct rsnd_dai
*rdai
= rsnd_io_to_rdai(io
);
738 struct rsnd_priv
*priv
= rsnd_mod_to_priv(mod
);
740 if (!__rsnd_ssi_is_pin_sharing(mod
))
743 if (!rsnd_rdai_is_clk_master(rdai
))
746 if (rsnd_ssi_is_multi_slave(mod
, io
))
749 switch (rsnd_mod_id(mod
)) {
753 rsnd_dai_connect(rsnd_ssi_mod_get(priv
, 0), io
, RSND_MOD_SSIP
);
756 rsnd_dai_connect(rsnd_ssi_mod_get(priv
, 3), io
, RSND_MOD_SSIP
);
759 rsnd_dai_connect(rsnd_ssi_mod_get(priv
, 7), io
, RSND_MOD_SSIP
);
764 static int rsnd_ssi_pcm_new(struct rsnd_mod
*mod
,
765 struct rsnd_dai_stream
*io
,
766 struct snd_soc_pcm_runtime
*rtd
)
769 * rsnd_rdai_is_clk_master() will be enabled after set_fmt,
770 * and, pcm_new will be called after it.
771 * This function reuse pcm_new at this point.
773 rsnd_ssi_parent_attach(mod
, io
);
778 static int rsnd_ssi_common_probe(struct rsnd_mod
*mod
,
779 struct rsnd_dai_stream
*io
,
780 struct rsnd_priv
*priv
)
782 struct device
*dev
= rsnd_priv_to_dev(priv
);
783 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
787 * SSIP/SSIU/IRQ are not needed on
790 if (rsnd_ssi_is_multi_slave(mod
, io
))
794 * It can't judge ssi parent at this point
795 * see rsnd_ssi_pcm_new()
799 * SSI might be called again as PIO fallback
800 * It is easy to manual handling for IRQ request/free
802 * OTOH, this function might be called many times if platform is
803 * using MIX. It needs xxx_attach() many times on xxx_probe().
804 * Because of it, we can't control .probe/.remove calling count by
806 * But it don't need to call request_irq() many times.
807 * Let's control it by RSND_SSI_PROBED flag.
809 if (!rsnd_flags_has(ssi
, RSND_SSI_PROBED
)) {
810 ret
= request_irq(ssi
->irq
,
815 rsnd_flags_set(ssi
, RSND_SSI_PROBED
);
821 static int rsnd_ssi_common_remove(struct rsnd_mod
*mod
,
822 struct rsnd_dai_stream
*io
,
823 struct rsnd_priv
*priv
)
825 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
826 struct rsnd_mod
*pure_ssi_mod
= rsnd_io_to_mod_ssi(io
);
828 /* Do nothing if non SSI (= SSI parent, multi SSI) mod */
829 if (pure_ssi_mod
!= mod
)
832 /* PIO will request IRQ again */
833 if (rsnd_flags_has(ssi
, RSND_SSI_PROBED
)) {
834 free_irq(ssi
->irq
, mod
);
836 rsnd_flags_del(ssi
, RSND_SSI_PROBED
);
845 static bool rsnd_ssi_pio_interrupt(struct rsnd_mod
*mod
,
846 struct rsnd_dai_stream
*io
)
848 struct snd_pcm_runtime
*runtime
= rsnd_io_to_runtime(io
);
849 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
850 u32
*buf
= (u32
*)(runtime
->dma_area
+ ssi
->byte_pos
);
853 bool elapsed
= false;
855 if (snd_pcm_format_width(runtime
->format
) == 24)
859 * 8/16/32 data can be assesse to TDR/RDR register
860 * directly as 32bit data
861 * see rsnd_ssi_init()
863 if (rsnd_io_is_play(io
))
864 rsnd_mod_write(mod
, SSITDR
, (*buf
) << shift
);
866 *buf
= (rsnd_mod_read(mod
, SSIRDR
) >> shift
);
868 byte_pos
= ssi
->byte_pos
+ sizeof(*buf
);
870 if (byte_pos
>= ssi
->next_period_byte
) {
871 int period_pos
= byte_pos
/ ssi
->byte_per_period
;
873 if (period_pos
>= runtime
->periods
) {
878 ssi
->next_period_byte
= (period_pos
+ 1) * ssi
->byte_per_period
;
883 WRITE_ONCE(ssi
->byte_pos
, byte_pos
);
888 static int rsnd_ssi_pio_init(struct rsnd_mod
*mod
,
889 struct rsnd_dai_stream
*io
,
890 struct rsnd_priv
*priv
)
892 struct snd_pcm_runtime
*runtime
= rsnd_io_to_runtime(io
);
893 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
895 if (!rsnd_ssi_is_parent(mod
, io
)) {
897 ssi
->byte_per_period
= runtime
->period_size
*
899 samples_to_bytes(runtime
, 1);
900 ssi
->next_period_byte
= ssi
->byte_per_period
;
903 return rsnd_ssi_init(mod
, io
, priv
);
906 static int rsnd_ssi_pio_pointer(struct rsnd_mod
*mod
,
907 struct rsnd_dai_stream
*io
,
908 snd_pcm_uframes_t
*pointer
)
910 struct rsnd_ssi
*ssi
= rsnd_mod_to_ssi(mod
);
911 struct snd_pcm_runtime
*runtime
= rsnd_io_to_runtime(io
);
913 *pointer
= bytes_to_frames(runtime
, READ_ONCE(ssi
->byte_pos
));
918 static int rsnd_ssi_prepare(struct rsnd_mod
*mod
,
919 struct rsnd_dai_stream
*io
,
920 struct rsnd_priv
*priv
)
922 return rsnd_ssi_master_clk_start(mod
, io
);
925 static struct rsnd_mod_ops rsnd_ssi_pio_ops
= {
927 .probe
= rsnd_ssi_common_probe
,
928 .remove
= rsnd_ssi_common_remove
,
929 .init
= rsnd_ssi_pio_init
,
930 .quit
= rsnd_ssi_quit
,
931 .start
= rsnd_ssi_start
,
932 .stop
= rsnd_ssi_stop
,
934 .pointer
= rsnd_ssi_pio_pointer
,
935 .pcm_new
= rsnd_ssi_pcm_new
,
936 .hw_params
= rsnd_ssi_hw_params
,
937 .prepare
= rsnd_ssi_prepare
,
938 .get_status
= rsnd_ssi_get_status
,
941 static int rsnd_ssi_dma_probe(struct rsnd_mod
*mod
,
942 struct rsnd_dai_stream
*io
,
943 struct rsnd_priv
*priv
)
948 * SSIP/SSIU/IRQ/DMA are not needed on
951 if (rsnd_ssi_is_multi_slave(mod
, io
))
954 ret
= rsnd_ssi_common_probe(mod
, io
, priv
);
958 /* SSI probe might be called many times in MUX multi path */
959 ret
= rsnd_dma_attach(io
, mod
, &io
->dma
);
964 static int rsnd_ssi_fallback(struct rsnd_mod
*mod
,
965 struct rsnd_dai_stream
*io
,
966 struct rsnd_priv
*priv
)
968 struct device
*dev
= rsnd_priv_to_dev(priv
);
973 * SSI .probe might be called again.
975 * rsnd_rdai_continuance_probe()
977 mod
->ops
= &rsnd_ssi_pio_ops
;
979 dev_info(dev
, "%s fallback to PIO mode\n", rsnd_mod_name(mod
));
984 static struct dma_chan
*rsnd_ssi_dma_req(struct rsnd_dai_stream
*io
,
985 struct rsnd_mod
*mod
)
987 struct rsnd_priv
*priv
= rsnd_mod_to_priv(mod
);
988 int is_play
= rsnd_io_is_play(io
);
992 * It should use "rcar_sound,ssiu" on DT.
993 * But, we need to keep compatibility for old version.
995 * If it has "rcar_sound.ssiu", it will be used.
996 * If not, "rcar_sound.ssi" will be used.
998 * rsnd_ssiu_dma_req()
1002 if (rsnd_ssi_use_busif(io
))
1003 name
= is_play
? "rxu" : "txu";
1005 name
= is_play
? "rx" : "tx";
1007 return rsnd_dma_request_channel(rsnd_ssi_of_node(priv
),
1011 static struct rsnd_mod_ops rsnd_ssi_dma_ops
= {
1013 .dma_req
= rsnd_ssi_dma_req
,
1014 .probe
= rsnd_ssi_dma_probe
,
1015 .remove
= rsnd_ssi_common_remove
,
1016 .init
= rsnd_ssi_init
,
1017 .quit
= rsnd_ssi_quit
,
1018 .start
= rsnd_ssi_start
,
1019 .stop
= rsnd_ssi_stop
,
1020 .irq
= rsnd_ssi_irq
,
1021 .pcm_new
= rsnd_ssi_pcm_new
,
1022 .fallback
= rsnd_ssi_fallback
,
1023 .hw_params
= rsnd_ssi_hw_params
,
1024 .prepare
= rsnd_ssi_prepare
,
1025 .get_status
= rsnd_ssi_get_status
,
1028 static int rsnd_ssi_is_dma_mode(struct rsnd_mod
*mod
)
1030 return mod
->ops
== &rsnd_ssi_dma_ops
;
1036 static void rsnd_ssi_connect(struct rsnd_mod
*mod
,
1037 struct rsnd_dai_stream
*io
)
1039 struct rsnd_dai
*rdai
= rsnd_io_to_rdai(io
);
1040 enum rsnd_mod_type types
[] = {
1046 enum rsnd_mod_type type
;
1049 /* try SSI -> SSIM1 -> SSIM2 -> SSIM3 */
1050 for (i
= 0; i
< ARRAY_SIZE(types
); i
++) {
1052 if (!rsnd_io_to_mod(io
, type
)) {
1053 rsnd_dai_connect(mod
, io
, type
);
1054 rsnd_rdai_channels_set(rdai
, (i
+ 1) * 2);
1055 rsnd_rdai_ssi_lane_set(rdai
, (i
+ 1));
1061 void rsnd_parse_connect_ssi(struct rsnd_dai
*rdai
,
1062 struct device_node
*playback
,
1063 struct device_node
*capture
)
1065 struct rsnd_priv
*priv
= rsnd_rdai_to_priv(rdai
);
1066 struct device_node
*node
;
1067 struct device_node
*np
;
1068 struct rsnd_mod
*mod
;
1071 node
= rsnd_ssi_of_node(priv
);
1076 for_each_child_of_node(node
, np
) {
1077 mod
= rsnd_ssi_mod_get(priv
, i
);
1079 rsnd_ssi_connect(mod
, &rdai
->playback
);
1081 rsnd_ssi_connect(mod
, &rdai
->capture
);
1088 struct rsnd_mod
*rsnd_ssi_mod_get(struct rsnd_priv
*priv
, int id
)
1090 if (WARN_ON(id
< 0 || id
>= rsnd_ssi_nr(priv
)))
1093 return rsnd_mod_get(rsnd_ssi_get(priv
, id
));
1096 int __rsnd_ssi_is_pin_sharing(struct rsnd_mod
*mod
)
1101 return !!(rsnd_flags_has(rsnd_mod_to_ssi(mod
), RSND_SSI_CLK_PIN_SHARE
));
1104 int rsnd_ssi_probe(struct rsnd_priv
*priv
)
1106 struct device_node
*node
;
1107 struct device_node
*np
;
1108 struct device
*dev
= rsnd_priv_to_dev(priv
);
1109 struct rsnd_mod_ops
*ops
;
1111 struct rsnd_ssi
*ssi
;
1112 char name
[RSND_SSI_NAME_SIZE
];
1115 node
= rsnd_ssi_of_node(priv
);
1119 nr
= of_get_child_count(node
);
1122 goto rsnd_ssi_probe_done
;
1125 ssi
= devm_kcalloc(dev
, nr
, sizeof(*ssi
), GFP_KERNEL
);
1128 goto rsnd_ssi_probe_done
;
1135 for_each_child_of_node(node
, np
) {
1136 if (!of_device_is_available(np
))
1139 ssi
= rsnd_ssi_get(priv
, i
);
1141 snprintf(name
, RSND_SSI_NAME_SIZE
, "%s.%d",
1144 clk
= devm_clk_get(dev
, name
);
1148 goto rsnd_ssi_probe_done
;
1151 if (of_get_property(np
, "shared-pin", NULL
))
1152 rsnd_flags_set(ssi
, RSND_SSI_CLK_PIN_SHARE
);
1154 if (of_get_property(np
, "no-busif", NULL
))
1155 rsnd_flags_set(ssi
, RSND_SSI_NO_BUSIF
);
1157 ssi
->irq
= irq_of_parse_and_map(np
, 0);
1161 goto rsnd_ssi_probe_done
;
1164 if (of_property_read_bool(np
, "pio-transfer"))
1165 ops
= &rsnd_ssi_pio_ops
;
1167 ops
= &rsnd_ssi_dma_ops
;
1169 ret
= rsnd_mod_init(priv
, rsnd_mod_get(ssi
), ops
, clk
,
1173 goto rsnd_ssi_probe_done
;
1181 rsnd_ssi_probe_done
:
1187 void rsnd_ssi_remove(struct rsnd_priv
*priv
)
1189 struct rsnd_ssi
*ssi
;
1192 for_each_rsnd_ssi(ssi
, priv
, i
) {
1193 rsnd_mod_quit(rsnd_mod_get(ssi
));