Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) //
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3) // Renesas R-Car SSIU support
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4) //
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5) // Copyright (c) 2015 Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) #include "rsnd.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #define SSIU_NAME "ssiu"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) struct rsnd_ssiu {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) 	struct rsnd_mod mod;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) 	u32 busif_status[8]; /* for BUSIF0 - BUSIF7 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) 	unsigned int usrcnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) 	int id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) 	int id_sub;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) /* SSI_MODE */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #define TDM_EXT		(1 << 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #define TDM_SPLIT	(1 << 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #define rsnd_ssiu_nr(priv) ((priv)->ssiu_nr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #define rsnd_mod_to_ssiu(_mod) container_of((_mod), struct rsnd_ssiu, mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #define for_each_rsnd_ssiu(pos, priv, i)				\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 	for (i = 0;							\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 	     (i < rsnd_ssiu_nr(priv)) &&				\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 		     ((pos) = ((struct rsnd_ssiu *)(priv)->ssiu + i));	\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 	     i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32)  *	SSI	Gen2		Gen3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33)  *	0	BUSIF0-3	BUSIF0-7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34)  *	1	BUSIF0-3	BUSIF0-7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35)  *	2	BUSIF0-3	BUSIF0-7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36)  *	3	BUSIF0		BUSIF0-7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37)  *	4	BUSIF0		BUSIF0-7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38)  *	5	BUSIF0		BUSIF0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39)  *	6	BUSIF0		BUSIF0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40)  *	7	BUSIF0		BUSIF0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41)  *	8	BUSIF0		BUSIF0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42)  *	9	BUSIF0-3	BUSIF0-7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43)  *	total	22		52
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) static const int gen2_id[] = { 0, 4,  8, 12, 13, 14, 15, 16, 17, 18 };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) static const int gen3_id[] = { 0, 8, 16, 24, 32, 40, 41, 42, 43, 44 };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) static u32 *rsnd_ssiu_get_status(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 				 struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 				 enum rsnd_mod_type type)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	int busif = rsnd_mod_id_sub(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	return &ssiu->busif_status[busif];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) static int rsnd_ssiu_init(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 			  struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 			  struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	struct rsnd_dai *rdai = rsnd_io_to_rdai(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	u32 ssis = rsnd_ssi_multi_secondaries_runtime(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	int use_busif = rsnd_ssi_use_busif(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	int id = rsnd_mod_id(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	int is_clk_master = rsnd_rdai_is_clk_master(rdai);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	u32 val1, val2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	/* clear status */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	switch (id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	case 0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	case 1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	case 2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	case 3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 	case 4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 		for (i = 0; i < 4; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 			rsnd_mod_write(mod, SSI_SYS_STATUS(i * 2), 0xf << (id * 4));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 	case 9:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 		for (i = 0; i < 4; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 			rsnd_mod_write(mod, SSI_SYS_STATUS((i * 2) + 1), 0xf << 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	 * SSI_MODE0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	rsnd_mod_bset(mod, SSI_MODE0, (1 << id), !use_busif << id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	 * SSI_MODE1 / SSI_MODE2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	 *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 	 * FIXME
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	 * sharing/multi with SSI0 are mainly supported
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	val1 = rsnd_mod_read(mod, SSI_MODE1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	val2 = rsnd_mod_read(mod, SSI_MODE2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	if (rsnd_ssi_is_pin_sharing(io)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 		ssis |= (1 << id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	} else if (ssis) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 		/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 		 * Multi SSI
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 		 *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 		 * set synchronized bit here
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 		 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 		/* SSI4 is synchronized with SSI3 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 		if (ssis & (1 << 4))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 			val1 |= (1 << 20);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		/* SSI012 are synchronized */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 		if (ssis == 0x0006)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 			val1 |= (1 << 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 		/* SSI0129 are synchronized */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 		if (ssis == 0x0206)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 			val2 |= (1 << 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	/* SSI1 is sharing pin with SSI0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 	if (ssis & (1 << 1))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 		val1 |= is_clk_master ? 0x2 : 0x1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	/* SSI2 is sharing pin with SSI0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	if (ssis & (1 << 2))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 		val1 |= is_clk_master ?	0x2 << 2 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 					0x1 << 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 	/* SSI4 is sharing pin with SSI3 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 	if (ssis & (1 << 4))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 		val1 |= is_clk_master ? 0x2 << 16 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 					0x1 << 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	/* SSI9 is sharing pin with SSI0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	if (ssis & (1 << 9))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 		val2 |= is_clk_master ? 0x2 : 0x1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	rsnd_mod_bset(mod, SSI_MODE1, 0x0013001f, val1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	rsnd_mod_bset(mod, SSI_MODE2, 0x00000017, val2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) static struct rsnd_mod_ops rsnd_ssiu_ops_gen1 = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	.name		= SSIU_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	.init		= rsnd_ssiu_init,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	.get_status	= rsnd_ssiu_get_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) static int rsnd_ssiu_init_gen2(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 			       struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 			       struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	u32 has_hdmi0 = rsnd_flags_has(io, RSND_STREAM_HDMI0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	u32 has_hdmi1 = rsnd_flags_has(io, RSND_STREAM_HDMI1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	u32 mode = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	ret = rsnd_ssiu_init(mod, io, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 	ssiu->usrcnt++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 	 * TDM Extend/Split Mode
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	 * see
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 	 *	rsnd_ssi_config_init()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	if (rsnd_runtime_is_tdm(io))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 		mode = TDM_EXT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	else if (rsnd_runtime_is_tdm_split(io))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 		mode = TDM_SPLIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 	rsnd_mod_write(mod, SSI_MODE, mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	if (rsnd_ssi_use_busif(io)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 		int id = rsnd_mod_id(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 		int busif = rsnd_mod_id_sub(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 		enum rsnd_reg adinr_reg, mode_reg, dalign_reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 		if ((id == 9) && (busif >= 4)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 			adinr_reg = SSI9_BUSIF_ADINR(busif);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 			mode_reg = SSI9_BUSIF_MODE(busif);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 			dalign_reg = SSI9_BUSIF_DALIGN(busif);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 			adinr_reg = SSI_BUSIF_ADINR(busif);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 			mode_reg = SSI_BUSIF_MODE(busif);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 			dalign_reg = SSI_BUSIF_DALIGN(busif);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 		rsnd_mod_write(mod, adinr_reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 			       rsnd_get_adinr_bit(mod, io) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 			       (rsnd_io_is_play(io) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 				rsnd_runtime_channel_after_ctu(io) :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 				rsnd_runtime_channel_original(io)));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 		rsnd_mod_write(mod, mode_reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 			       rsnd_get_busif_shift(io, mod) | 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 		rsnd_mod_write(mod, dalign_reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 			       rsnd_get_dalign(mod, io));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	if (has_hdmi0 || has_hdmi1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 		enum rsnd_mod_type rsnd_ssi_array[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 			RSND_MOD_SSIM1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 			RSND_MOD_SSIM2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 			RSND_MOD_SSIM3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 		};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 		struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 		struct rsnd_mod *pos;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 		u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 		int i, shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 		i = rsnd_mod_id(ssi_mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 		/* output all same SSI as default */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 		val =	i << 16 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 			i << 20 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 			i << 24 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 			i << 28 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 			i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 		for_each_rsnd_mod_array(i, pos, io, rsnd_ssi_array) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 			shift	= (i * 4) + 20;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 			val	= (val & ~(0xF << shift)) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 				rsnd_mod_id(pos) << shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 		if (has_hdmi0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 			rsnd_mod_write(mod, HDMI0_SEL, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 		if (has_hdmi1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 			rsnd_mod_write(mod, HDMI1_SEL, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) static int rsnd_ssiu_start_gen2(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 				struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 				struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	int busif = rsnd_mod_id_sub(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 	if (!rsnd_ssi_use_busif(io))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	rsnd_mod_bset(mod, SSI_CTRL, 1 << (busif * 4), 1 << (busif * 4));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	if (rsnd_ssi_multi_secondaries_runtime(io))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 		rsnd_mod_write(mod, SSI_CONTROL, 0x1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) static int rsnd_ssiu_stop_gen2(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 			       struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 			       struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 	struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 	int busif = rsnd_mod_id_sub(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 	if (!rsnd_ssi_use_busif(io))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 	rsnd_mod_bset(mod, SSI_CTRL, 1 << (busif * 4), 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 	if (--ssiu->usrcnt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	if (rsnd_ssi_multi_secondaries_runtime(io))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 		rsnd_mod_write(mod, SSI_CONTROL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) static int rsnd_ssiu_id(struct rsnd_mod *mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 	struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	/* see rsnd_ssiu_probe() */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 	return ssiu->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) static int rsnd_ssiu_id_sub(struct rsnd_mod *mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 	struct rsnd_ssiu *ssiu = rsnd_mod_to_ssiu(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	/* see rsnd_ssiu_probe() */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 	return ssiu->id_sub;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) static struct dma_chan *rsnd_ssiu_dma_req(struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 					  struct rsnd_mod *mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 	int is_play = rsnd_io_is_play(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 	char *name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 	 * It should use "rcar_sound,ssiu" on DT.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 	 * But, we need to keep compatibility for old version.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 	 *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 	 * If it has "rcar_sound.ssiu", it will be used.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 	 * If not, "rcar_sound.ssi" will be used.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 	 * see
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 	 *	rsnd_ssi_dma_req()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 	 *	rsnd_dma_of_path()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 	name = is_play ? "rx" : "tx";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 	return rsnd_dma_request_channel(rsnd_ssiu_of_node(priv),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 					mod, name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) static struct rsnd_mod_ops rsnd_ssiu_ops_gen2 = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 	.name		= SSIU_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	.dma_req	= rsnd_ssiu_dma_req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 	.init		= rsnd_ssiu_init_gen2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 	.start		= rsnd_ssiu_start_gen2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 	.stop		= rsnd_ssiu_stop_gen2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 	.get_status	= rsnd_ssiu_get_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) static struct rsnd_mod *rsnd_ssiu_mod_get(struct rsnd_priv *priv, int id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 	if (WARN_ON(id < 0 || id >= rsnd_ssiu_nr(priv)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 		id = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 	return rsnd_mod_get((struct rsnd_ssiu *)(priv->ssiu) + id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) static void rsnd_parse_connect_ssiu_compatible(struct rsnd_priv *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 					       struct rsnd_dai_stream *io)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 	struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 	struct rsnd_mod *mod;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 	struct rsnd_ssiu *ssiu;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 	if (!ssi_mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 	/* select BUSIF0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 	for_each_rsnd_ssiu(ssiu, priv, i) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 		mod = rsnd_mod_get(ssiu);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 		if ((rsnd_mod_id(ssi_mod) == rsnd_mod_id(mod)) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 		    (rsnd_mod_id_sub(mod) == 0)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 			rsnd_dai_connect(mod, io, mod->type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 			return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) void rsnd_parse_connect_ssiu(struct rsnd_dai *rdai,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 			     struct device_node *playback,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 			     struct device_node *capture)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 	struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 	struct device_node *node = rsnd_ssiu_of_node(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 	struct device_node *np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 	struct rsnd_mod *mod;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 	struct rsnd_dai_stream *io_p = &rdai->playback;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 	struct rsnd_dai_stream *io_c = &rdai->capture;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 	/* use rcar_sound,ssiu if exist */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 	if (node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 		i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 		for_each_child_of_node(node, np) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 			mod = rsnd_ssiu_mod_get(priv, i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 			if (np == playback)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 				rsnd_dai_connect(mod, io_p, mod->type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 			if (np == capture)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 				rsnd_dai_connect(mod, io_c, mod->type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) 			i++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) 		of_node_put(node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 	/* Keep DT compatibility */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) 	if (!rsnd_io_to_mod_ssiu(io_p))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 		rsnd_parse_connect_ssiu_compatible(priv, io_p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) 	if (!rsnd_io_to_mod_ssiu(io_c))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) 		rsnd_parse_connect_ssiu_compatible(priv, io_c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) int rsnd_ssiu_probe(struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) 	struct device *dev = rsnd_priv_to_dev(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) 	struct device_node *node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) 	struct rsnd_ssiu *ssiu;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) 	struct rsnd_mod_ops *ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 	const int *list = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) 	int i, nr, ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) 	 * Keep DT compatibility.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 	 * if it has "rcar_sound,ssiu", use it.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) 	 * if not, use "rcar_sound,ssi"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 	 * see
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) 	 *	rsnd_ssiu_bufsif_to_id()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) 	node = rsnd_ssiu_of_node(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 	if (node)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) 		nr = of_get_child_count(node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) 		nr = priv->ssi_nr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 	ssiu	= devm_kcalloc(dev, nr, sizeof(*ssiu), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) 	if (!ssiu)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) 	priv->ssiu	= ssiu;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) 	priv->ssiu_nr	= nr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) 	if (rsnd_is_gen1(priv))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) 		ops = &rsnd_ssiu_ops_gen1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) 		ops = &rsnd_ssiu_ops_gen2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) 	/* Keep compatibility */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) 	nr = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) 	if ((node) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) 	    (ops == &rsnd_ssiu_ops_gen2)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) 		ops->id		= rsnd_ssiu_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) 		ops->id_sub	= rsnd_ssiu_id_sub;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) 		if (rsnd_is_gen2(priv)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) 			list	= gen2_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) 			nr	= ARRAY_SIZE(gen2_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) 		} else if (rsnd_is_gen3(priv)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) 			list	= gen3_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) 			nr	= ARRAY_SIZE(gen3_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) 			dev_err(dev, "unknown SSIU\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) 			return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) 	for_each_rsnd_ssiu(ssiu, priv, i) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) 		if (node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) 			int j;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) 			/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) 			 * see
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) 			 *	rsnd_ssiu_get_id()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) 			 *	rsnd_ssiu_get_id_sub()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) 			 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) 			for (j = 0; j < nr; j++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) 				if (list[j] > i)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) 					break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) 				ssiu->id	= j;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) 				ssiu->id_sub	= i - list[ssiu->id];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) 			ssiu->id = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) 		ret = rsnd_mod_init(priv, rsnd_mod_get(ssiu),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) 				    ops, NULL, RSND_MOD_SSIU, i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) 		if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) 			return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) void rsnd_ssiu_remove(struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) 	struct rsnd_ssiu *ssiu;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) 	for_each_rsnd_ssiu(ssiu, priv, i) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) 		rsnd_mod_quit(rsnd_mod_get(ssiu));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) }