^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) }