Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^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 SRC support
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4) //
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5) // Copyright (C) 2013 Renesas Solutions Corp.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6) // Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  * you can enable below define if you don't need
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  * SSI interrupt status debug message when debugging
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  * see rsnd_dbg_irq_status()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13)  * #define RSND_DEBUG_NO_IRQ_STATUS 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include "rsnd.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #define SRC_NAME "src"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) /* SCU_SYSTEM_STATUS0/1 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #define OUF_SRC(id)	((1 << (id + 16)) | (1 << id))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) struct rsnd_src {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 	struct rsnd_mod mod;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 	struct rsnd_mod *dma;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 	struct rsnd_kctrl_cfg_s sen;  /* sync convert enable */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 	struct rsnd_kctrl_cfg_s sync; /* sync convert */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 	int irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #define RSND_SRC_NAME_SIZE 16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #define rsnd_src_get(priv, id) ((struct rsnd_src *)(priv->src) + id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) #define rsnd_src_nr(priv) ((priv)->src_nr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) #define rsnd_src_sync_is_enabled(mod) (rsnd_mod_to_src(mod)->sen.val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) #define rsnd_mod_to_src(_mod)				\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 	container_of((_mod), struct rsnd_src, mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) #define for_each_rsnd_src(pos, priv, i)				\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 	for ((i) = 0;						\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	     ((i) < rsnd_src_nr(priv)) &&			\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	     ((pos) = (struct rsnd_src *)(priv)->src + i);	\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 	     i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48)  *		image of SRC (Sampling Rate Converter)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50)  * 96kHz   <-> +-----+	48kHz	+-----+	 48kHz	+-------+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51)  * 48kHz   <-> | SRC | <------>	| SSI |	<----->	| codec |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52)  * 44.1kHz <-> +-----+		+-----+		+-------+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53)  * ...
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) static void rsnd_src_activation(struct rsnd_mod *mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 	rsnd_mod_write(mod, SRC_SWRSR, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	rsnd_mod_write(mod, SRC_SWRSR, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) static void rsnd_src_halt(struct rsnd_mod *mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	rsnd_mod_write(mod, SRC_SRCIR, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	rsnd_mod_write(mod, SRC_SWRSR, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) static struct dma_chan *rsnd_src_dma_req(struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 					 struct rsnd_mod *mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	int is_play = rsnd_io_is_play(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	return rsnd_dma_request_channel(rsnd_src_of_node(priv),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 					mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 					is_play ? "rx" : "tx");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) static u32 rsnd_src_convert_rate(struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 				 struct rsnd_mod *mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	struct rsnd_src *src = rsnd_mod_to_src(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	u32 convert_rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	if (!runtime)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 	if (!rsnd_src_sync_is_enabled(mod))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 		return rsnd_io_converted_rate(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	convert_rate = src->sync.val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	if (!convert_rate)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 		convert_rate = rsnd_io_converted_rate(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	if (!convert_rate)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 		convert_rate = runtime->rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	return convert_rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) unsigned int rsnd_src_get_rate(struct rsnd_priv *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 			       struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 			       int is_in)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	struct rsnd_mod *src_mod = rsnd_io_to_mod_src(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	unsigned int rate = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	int is_play = rsnd_io_is_play(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 	 * Playback
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	 * runtime_rate -> [SRC] -> convert_rate
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	 *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	 * Capture
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 	 * convert_rate -> [SRC] -> runtime_rate
^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) 	if (is_play == is_in)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 		return runtime->rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	 * return convert rate if SRC is used,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	 * otherwise, return runtime->rate as usual
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 	if (src_mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 		rate = rsnd_src_convert_rate(io, src_mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	if (!rate)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 		rate = runtime->rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	return rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) static const u32 bsdsr_table_pattern1[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	0x01800000, /* 6 - 1/6 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	0x01000000, /* 6 - 1/4 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 	0x00c00000, /* 6 - 1/3 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	0x00800000, /* 6 - 1/2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	0x00600000, /* 6 - 2/3 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	0x00400000, /* 6 - 1   */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) static const u32 bsdsr_table_pattern2[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	0x02400000, /* 6 - 1/6 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	0x01800000, /* 6 - 1/4 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	0x01200000, /* 6 - 1/3 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 	0x00c00000, /* 6 - 1/2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	0x00900000, /* 6 - 2/3 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	0x00600000, /* 6 - 1   */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) static const u32 bsisr_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 	0x00100060, /* 6 - 1/6 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	0x00100040, /* 6 - 1/4 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	0x00100030, /* 6 - 1/3 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	0x00100020, /* 6 - 1/2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	0x00100020, /* 6 - 2/3 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 	0x00100020, /* 6 - 1   */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) static const u32 chan288888[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 	0x00000006, /* 1 to 2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 	0x000001fe, /* 1 to 8 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	0x000001fe, /* 1 to 8 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 	0x000001fe, /* 1 to 8 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	0x000001fe, /* 1 to 8 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	0x000001fe, /* 1 to 8 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) static const u32 chan244888[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	0x00000006, /* 1 to 2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 	0x0000001e, /* 1 to 4 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 	0x0000001e, /* 1 to 4 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	0x000001fe, /* 1 to 8 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	0x000001fe, /* 1 to 8 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	0x000001fe, /* 1 to 8 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) static const u32 chan222222[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 	0x00000006, /* 1 to 2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 	0x00000006, /* 1 to 2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 	0x00000006, /* 1 to 2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	0x00000006, /* 1 to 2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	0x00000006, /* 1 to 2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 	0x00000006, /* 1 to 2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) static void rsnd_src_set_convert_rate(struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 				      struct rsnd_mod *mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 	struct device *dev = rsnd_priv_to_dev(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 	struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 	int is_play = rsnd_io_is_play(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 	int use_src = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 	u32 fin, fout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	u32 ifscr, fsrate, adinr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	u32 cr, route;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 	u32 i_busif, o_busif, tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	const u32 *bsdsr_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 	const u32 *chptn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 	uint ratio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	int chan;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 	int idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	if (!runtime)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 	fin  = rsnd_src_get_in_rate(priv, io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 	fout = rsnd_src_get_out_rate(priv, io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 	chan = rsnd_runtime_channel_original(io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 	/* 6 - 1/6 are very enough ratio for SRC_BSDSR */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 	if (fin == fout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 		ratio = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 	else if (fin > fout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 		ratio = 100 * fin / fout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 		ratio = 100 * fout / fin;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 	if (ratio > 600) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 		dev_err(dev, "FSO/FSI ratio error\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 	use_src = (fin != fout) | rsnd_src_sync_is_enabled(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 	 * SRC_ADINR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 	adinr = rsnd_get_adinr_bit(mod, io) | chan;
^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) 	 * SRC_IFSCR / SRC_IFSVR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 	ifscr = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 	fsrate = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	if (use_src) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 		u64 n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 		ifscr = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 		n = (u64)0x0400000 * fin;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 		do_div(n, fout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 		fsrate = n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 	 * SRC_SRCCR / SRC_ROUTE_MODE0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 	cr	= 0x00011110;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	route	= 0x0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 	if (use_src) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 		route	= 0x1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 		if (rsnd_src_sync_is_enabled(mod)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 			cr |= 0x1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 			route |= rsnd_io_is_play(io) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 				(0x1 << 24) : (0x1 << 25);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 	 * SRC_BSDSR / SRC_BSISR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 	 *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 	 * see
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	 *	Combination of Register Setting Related to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 	 *	FSO/FSI Ratio and Channel, Latency
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 	switch (rsnd_mod_id(mod)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	case 0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 		chptn		= chan288888;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 		bsdsr_table	= bsdsr_table_pattern1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 	case 1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 	case 3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	case 4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 		chptn		= chan244888;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 		bsdsr_table	= bsdsr_table_pattern1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 	case 2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	case 9:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 		chptn		= chan222222;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 		bsdsr_table	= bsdsr_table_pattern1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 	case 5:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 	case 6:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 	case 7:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 	case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 		chptn		= chan222222;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 		bsdsr_table	= bsdsr_table_pattern2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 		goto convert_rate_err;
^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) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 	 * E3 need to overwrite
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 	if (rsnd_is_e3(priv))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 		switch (rsnd_mod_id(mod)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 		case 0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 		case 4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 			chptn	= chan222222;
^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) 	for (idx = 0; idx < ARRAY_SIZE(chan222222); idx++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 		if (chptn[idx] & (1 << chan))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 	if (chan > 8 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 	    idx >= ARRAY_SIZE(chan222222))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 		goto convert_rate_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	/* BUSIF_MODE */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 	tmp = rsnd_get_busif_shift(io, mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 	i_busif = ( is_play ? tmp : 0) | 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 	o_busif = (!is_play ? tmp : 0) | 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 	rsnd_mod_write(mod, SRC_ROUTE_MODE0, route);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 	rsnd_mod_write(mod, SRC_SRCIR, 1);	/* initialize */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 	rsnd_mod_write(mod, SRC_ADINR, adinr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 	rsnd_mod_write(mod, SRC_IFSCR, ifscr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 	rsnd_mod_write(mod, SRC_IFSVR, fsrate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 	rsnd_mod_write(mod, SRC_SRCCR, cr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 	rsnd_mod_write(mod, SRC_BSDSR, bsdsr_table[idx]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 	rsnd_mod_write(mod, SRC_BSISR, bsisr_table[idx]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 	rsnd_mod_write(mod, SRC_SRCIR, 0);	/* cancel initialize */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 	rsnd_mod_write(mod, SRC_I_BUSIF_MODE, i_busif);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 	rsnd_mod_write(mod, SRC_O_BUSIF_MODE, o_busif);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 	rsnd_mod_write(mod, SRC_BUSIF_DALIGN, rsnd_get_dalign(mod, io));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 	rsnd_adg_set_src_timesel_gen2(mod, io, fin, fout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 	return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) convert_rate_err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 	dev_err(dev, "unknown BSDSR/BSDIR settings\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) static int rsnd_src_irq(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 			struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 			struct rsnd_priv *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 			int enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 	struct rsnd_src *src = rsnd_mod_to_src(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 	u32 sys_int_val, int_val, sys_int_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 	int irq = src->irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 	int id = rsnd_mod_id(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 	sys_int_val =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 	sys_int_mask = OUF_SRC(id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 	int_val = 0x3300;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 	 * IRQ is not supported on non-DT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 	 * see
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 	 *	rsnd_src_probe_()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 	if ((irq <= 0) || !enable) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 		sys_int_val = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 		int_val = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 	 * WORKAROUND
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 	 *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 	 * ignore over flow error when rsnd_src_sync_is_enabled()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 	if (rsnd_src_sync_is_enabled(mod))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) 		sys_int_val = sys_int_val & 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 	rsnd_mod_write(mod, SRC_INT_ENABLE0, int_val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) 	rsnd_mod_bset(mod, SCU_SYS_INT_EN0, sys_int_mask, sys_int_val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 	rsnd_mod_bset(mod, SCU_SYS_INT_EN1, sys_int_mask, sys_int_val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) static void rsnd_src_status_clear(struct rsnd_mod *mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) 	u32 val = OUF_SRC(rsnd_mod_id(mod));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) 	rsnd_mod_write(mod, SCU_SYS_STATUS0, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) 	rsnd_mod_write(mod, SCU_SYS_STATUS1, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) static bool rsnd_src_error_occurred(struct rsnd_mod *mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) 	struct device *dev = rsnd_priv_to_dev(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) 	u32 val0, val1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) 	u32 status0, status1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) 	bool ret = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) 	val0 = val1 = OUF_SRC(rsnd_mod_id(mod));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) 	 * WORKAROUND
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) 	 *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 	 * ignore over flow error when rsnd_src_sync_is_enabled()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) 	if (rsnd_src_sync_is_enabled(mod))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) 		val0 = val0 & 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 	status0 = rsnd_mod_read(mod, SCU_SYS_STATUS0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) 	status1 = rsnd_mod_read(mod, SCU_SYS_STATUS1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 	if ((status0 & val0) || (status1 & val1)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) 		rsnd_dbg_irq_status(dev, "%s err status : 0x%08x, 0x%08x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) 			rsnd_mod_name(mod), status0, status1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) 		ret = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) static int rsnd_src_start(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) 			  struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) 			  struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) 	u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) 	 * WORKAROUND
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) 	 *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) 	 * Enable SRC output if you want to use sync convert together with DVC
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) 	val = (rsnd_io_to_mod_dvc(io) && !rsnd_src_sync_is_enabled(mod)) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) 		0x01 : 0x11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) 	rsnd_mod_write(mod, SRC_CTRL, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) 	return 0;
^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) static int rsnd_src_stop(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) 			 struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) 			 struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) 	rsnd_mod_write(mod, SRC_CTRL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) static int rsnd_src_init(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) 			 struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) 			 struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) 	struct rsnd_src *src = rsnd_mod_to_src(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) 	/* reset sync convert_rate */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) 	src->sync.val = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) 	rsnd_mod_power_on(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) 	rsnd_src_activation(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) 	rsnd_src_set_convert_rate(io, mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) 	rsnd_src_status_clear(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) static int rsnd_src_quit(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) 			 struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) 			 struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) 	struct rsnd_src *src = rsnd_mod_to_src(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) 	rsnd_src_halt(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) 	rsnd_mod_power_off(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) 	/* reset sync convert_rate */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) 	src->sync.val = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) static void __rsnd_src_interrupt(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) 				 struct rsnd_dai_stream *io)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) 	struct rsnd_priv *priv = rsnd_mod_to_priv(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) 	bool stop = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) 	spin_lock(&priv->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) 	/* ignore all cases if not working */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) 	if (!rsnd_io_is_working(io))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) 		goto rsnd_src_interrupt_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) 	if (rsnd_src_error_occurred(mod))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) 		stop = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) 	rsnd_src_status_clear(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) rsnd_src_interrupt_out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) 	spin_unlock(&priv->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) 	if (stop)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) 		snd_pcm_stop_xrun(io->substream);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) static irqreturn_t rsnd_src_interrupt(int irq, void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) 	struct rsnd_mod *mod = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) 	rsnd_mod_interrupt(mod, __rsnd_src_interrupt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) 	return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) static int rsnd_src_probe_(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) 			   struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) 			   struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) 	struct rsnd_src *src = rsnd_mod_to_src(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) 	struct device *dev = rsnd_priv_to_dev(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) 	int irq = src->irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) 	if (irq > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) 		/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) 		 * IRQ is not supported on non-DT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) 		 * see
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) 		 *	rsnd_src_irq()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) 		 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) 		ret = devm_request_irq(dev, irq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) 				       rsnd_src_interrupt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) 				       IRQF_SHARED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) 				       dev_name(dev), mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) 		if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) 			return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) 	ret = rsnd_dma_attach(io, mod, &src->dma);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) static int rsnd_src_pcm_new(struct rsnd_mod *mod,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) 			    struct rsnd_dai_stream *io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) 			    struct snd_soc_pcm_runtime *rtd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) 	struct rsnd_src *src = rsnd_mod_to_src(mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) 	 * enable SRC sync convert if possible
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) 	 * It can't use SRC Synchronous convert
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) 	 * when Capture if it uses CMD
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) 	if (rsnd_io_to_mod_cmd(io) && !rsnd_io_is_play(io))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) 	 * enable sync convert
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) 	ret = rsnd_kctrl_new_s(mod, io, rtd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) 			       rsnd_io_is_play(io) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) 			       "SRC Out Rate Switch" :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) 			       "SRC In Rate Switch",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) 			       rsnd_kctrl_accept_anytime,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) 			       rsnd_src_set_convert_rate,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) 			       &src->sen, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) 	ret = rsnd_kctrl_new_s(mod, io, rtd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) 			       rsnd_io_is_play(io) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) 			       "SRC Out Rate" :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) 			       "SRC In Rate",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) 			       rsnd_kctrl_accept_runtime,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) 			       rsnd_src_set_convert_rate,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) 			       &src->sync, 192000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) static struct rsnd_mod_ops rsnd_src_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) 	.name		= SRC_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) 	.dma_req	= rsnd_src_dma_req,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) 	.probe		= rsnd_src_probe_,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) 	.init		= rsnd_src_init,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) 	.quit		= rsnd_src_quit,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) 	.start		= rsnd_src_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) 	.stop		= rsnd_src_stop,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) 	.irq		= rsnd_src_irq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) 	.pcm_new	= rsnd_src_pcm_new,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) 	.get_status	= rsnd_mod_get_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) struct rsnd_mod *rsnd_src_mod_get(struct rsnd_priv *priv, int id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) 	if (WARN_ON(id < 0 || id >= rsnd_src_nr(priv)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) 		id = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) 	return rsnd_mod_get(rsnd_src_get(priv, id));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) int rsnd_src_probe(struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) 	struct device_node *node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) 	struct device_node *np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) 	struct device *dev = rsnd_priv_to_dev(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) 	struct rsnd_src *src;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) 	struct clk *clk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) 	char name[RSND_SRC_NAME_SIZE];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) 	int i, nr, ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) 	/* This driver doesn't support Gen1 at this point */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) 	if (rsnd_is_gen1(priv))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) 	node = rsnd_src_of_node(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) 	if (!node)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) 		return 0; /* not used is not error */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) 	nr = of_get_child_count(node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) 	if (!nr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) 		ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) 		goto rsnd_src_probe_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) 	src	= devm_kcalloc(dev, nr, sizeof(*src), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) 	if (!src) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) 		ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) 		goto rsnd_src_probe_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) 	priv->src_nr	= nr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) 	priv->src	= src;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) 	i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) 	for_each_child_of_node(node, np) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) 		if (!of_device_is_available(np))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) 			goto skip;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) 		src = rsnd_src_get(priv, i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) 		snprintf(name, RSND_SRC_NAME_SIZE, "%s.%d",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) 			 SRC_NAME, i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) 		src->irq = irq_of_parse_and_map(np, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) 		if (!src->irq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) 			ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) 			of_node_put(np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) 			goto rsnd_src_probe_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) 		clk = devm_clk_get(dev, name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) 		if (IS_ERR(clk)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) 			ret = PTR_ERR(clk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) 			of_node_put(np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) 			goto rsnd_src_probe_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) 		ret = rsnd_mod_init(priv, rsnd_mod_get(src),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) 				    &rsnd_src_ops, clk, RSND_MOD_SRC, i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) 		if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) 			of_node_put(np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) 			goto rsnd_src_probe_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) skip:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) 		i++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) 	ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) rsnd_src_probe_done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) 	of_node_put(node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) void rsnd_src_remove(struct rsnd_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) 	struct rsnd_src *src;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) 	for_each_rsnd_src(src, priv, i) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) 		rsnd_mod_quit(rsnd_mod_get(src));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) }