1 // SPDX-License-Identifier: GPL-2.0-only
2 // Copyright (c) 2018-2020, The Linux Foundation. All rights reserved.
3
4 #include <linux/module.h>
5 #include <linux/init.h>
6 #include <linux/io.h>
7 #include <linux/platform_device.h>
8 #include <linux/clk.h>
9 #include <linux/of_clk.h>
10 #include <linux/clk-provider.h>
11 #include <sound/soc.h>
12 #include <sound/soc-dapm.h>
13 #include <linux/of_platform.h>
14 #include <sound/tlv.h>
15 #include "lpass-wsa-macro.h"
16
17 #define CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL (0x0000)
18 #define CDC_WSA_MCLK_EN_MASK BIT(0)
19 #define CDC_WSA_MCLK_ENABLE BIT(0)
20 #define CDC_WSA_MCLK_DISABLE 0
21 #define CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL (0x0004)
22 #define CDC_WSA_FS_CNT_EN_MASK BIT(0)
23 #define CDC_WSA_FS_CNT_ENABLE BIT(0)
24 #define CDC_WSA_FS_CNT_DISABLE 0
25 #define CDC_WSA_CLK_RST_CTRL_SWR_CONTROL (0x0008)
26 #define CDC_WSA_SWR_CLK_EN_MASK BIT(0)
27 #define CDC_WSA_SWR_CLK_ENABLE BIT(0)
28 #define CDC_WSA_SWR_RST_EN_MASK BIT(1)
29 #define CDC_WSA_SWR_RST_ENABLE BIT(1)
30 #define CDC_WSA_SWR_RST_DISABLE 0
31 #define CDC_WSA_TOP_TOP_CFG0 (0x0080)
32 #define CDC_WSA_TOP_TOP_CFG1 (0x0084)
33 #define CDC_WSA_TOP_FREQ_MCLK (0x0088)
34 #define CDC_WSA_TOP_DEBUG_BUS_SEL (0x008C)
35 #define CDC_WSA_TOP_DEBUG_EN0 (0x0090)
36 #define CDC_WSA_TOP_DEBUG_EN1 (0x0094)
37 #define CDC_WSA_TOP_DEBUG_DSM_LB (0x0098)
38 #define CDC_WSA_TOP_RX_I2S_CTL (0x009C)
39 #define CDC_WSA_TOP_TX_I2S_CTL (0x00A0)
40 #define CDC_WSA_TOP_I2S_CLK (0x00A4)
41 #define CDC_WSA_TOP_I2S_RESET (0x00A8)
42 #define CDC_WSA_RX_INP_MUX_RX_INT0_CFG0 (0x0100)
43 #define CDC_WSA_RX_INTX_1_MIX_INP0_SEL_MASK GENMASK(2, 0)
44 #define CDC_WSA_RX_INTX_1_MIX_INP1_SEL_MASK GENMASK(5, 3)
45 #define CDC_WSA_RX_INP_MUX_RX_INT0_CFG1 (0x0104)
46 #define CDC_WSA_RX_INTX_2_SEL_MASK GENMASK(2, 0)
47 #define CDC_WSA_RX_INTX_1_MIX_INP2_SEL_MASK GENMASK(5, 3)
48 #define CDC_WSA_RX_INP_MUX_RX_INT1_CFG0 (0x0108)
49 #define CDC_WSA_RX_INP_MUX_RX_INT1_CFG1 (0x010C)
50 #define CDC_WSA_RX_INP_MUX_RX_MIX_CFG0 (0x0110)
51 #define CDC_WSA_RX_MIX_TX1_SEL_MASK GENMASK(5, 3)
52 #define CDC_WSA_RX_MIX_TX1_SEL_SHFT 3
53 #define CDC_WSA_RX_MIX_TX0_SEL_MASK GENMASK(2, 0)
54 #define CDC_WSA_RX_INP_MUX_RX_EC_CFG0 (0x0114)
55 #define CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0 (0x0118)
56 #define CDC_WSA_TX0_SPKR_PROT_PATH_CTL (0x0244)
57 #define CDC_WSA_TX_SPKR_PROT_RESET_MASK BIT(5)
58 #define CDC_WSA_TX_SPKR_PROT_RESET BIT(5)
59 #define CDC_WSA_TX_SPKR_PROT_NO_RESET 0
60 #define CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK BIT(4)
61 #define CDC_WSA_TX_SPKR_PROT_CLK_ENABLE BIT(4)
62 #define CDC_WSA_TX_SPKR_PROT_CLK_DISABLE 0
63 #define CDC_WSA_TX_SPKR_PROT_PCM_RATE_MASK GENMASK(3, 0)
64 #define CDC_WSA_TX_SPKR_PROT_PCM_RATE_8K 0
65 #define CDC_WSA_TX0_SPKR_PROT_PATH_CFG0 (0x0248)
66 #define CDC_WSA_TX1_SPKR_PROT_PATH_CTL (0x0264)
67 #define CDC_WSA_TX1_SPKR_PROT_PATH_CFG0 (0x0268)
68 #define CDC_WSA_TX2_SPKR_PROT_PATH_CTL (0x0284)
69 #define CDC_WSA_TX2_SPKR_PROT_PATH_CFG0 (0x0288)
70 #define CDC_WSA_TX3_SPKR_PROT_PATH_CTL (0x02A4)
71 #define CDC_WSA_TX3_SPKR_PROT_PATH_CFG0 (0x02A8)
72 #define CDC_WSA_INTR_CTRL_CFG (0x0340)
73 #define CDC_WSA_INTR_CTRL_CLR_COMMIT (0x0344)
74 #define CDC_WSA_INTR_CTRL_PIN1_MASK0 (0x0360)
75 #define CDC_WSA_INTR_CTRL_PIN1_STATUS0 (0x0368)
76 #define CDC_WSA_INTR_CTRL_PIN1_CLEAR0 (0x0370)
77 #define CDC_WSA_INTR_CTRL_PIN2_MASK0 (0x0380)
78 #define CDC_WSA_INTR_CTRL_PIN2_STATUS0 (0x0388)
79 #define CDC_WSA_INTR_CTRL_PIN2_CLEAR0 (0x0390)
80 #define CDC_WSA_INTR_CTRL_LEVEL0 (0x03C0)
81 #define CDC_WSA_INTR_CTRL_BYPASS0 (0x03C8)
82 #define CDC_WSA_INTR_CTRL_SET0 (0x03D0)
83 #define CDC_WSA_RX0_RX_PATH_CTL (0x0400)
84 #define CDC_WSA_RX_PATH_CLK_EN_MASK BIT(5)
85 #define CDC_WSA_RX_PATH_CLK_ENABLE BIT(5)
86 #define CDC_WSA_RX_PATH_CLK_DISABLE 0
87 #define CDC_WSA_RX_PATH_PGA_MUTE_EN_MASK BIT(4)
88 #define CDC_WSA_RX_PATH_PGA_MUTE_ENABLE BIT(4)
89 #define CDC_WSA_RX_PATH_PGA_MUTE_DISABLE 0
90 #define CDC_WSA_RX0_RX_PATH_CFG0 (0x0404)
91 #define CDC_WSA_RX_PATH_COMP_EN_MASK BIT(1)
92 #define CDC_WSA_RX_PATH_COMP_ENABLE BIT(1)
93 #define CDC_WSA_RX_PATH_HD2_EN_MASK BIT(2)
94 #define CDC_WSA_RX_PATH_HD2_ENABLE BIT(2)
95 #define CDC_WSA_RX_PATH_SPKR_RATE_MASK BIT(3)
96 #define CDC_WSA_RX_PATH_SPKR_RATE_FS_2P4_3P072 BIT(3)
97 #define CDC_WSA_RX0_RX_PATH_CFG1 (0x0408)
98 #define CDC_WSA_RX_PATH_SMART_BST_EN_MASK BIT(0)
99 #define CDC_WSA_RX_PATH_SMART_BST_ENABLE BIT(0)
100 #define CDC_WSA_RX_PATH_SMART_BST_DISABLE 0
101 #define CDC_WSA_RX0_RX_PATH_CFG2 (0x040C)
102 #define CDC_WSA_RX0_RX_PATH_CFG3 (0x0410)
103 #define CDC_WSA_RX_DC_DCOEFF_MASK GENMASK(1, 0)
104 #define CDC_WSA_RX0_RX_VOL_CTL (0x0414)
105 #define CDC_WSA_RX0_RX_PATH_MIX_CTL (0x0418)
106 #define CDC_WSA_RX_PATH_MIX_CLK_EN_MASK BIT(5)
107 #define CDC_WSA_RX_PATH_MIX_CLK_ENABLE BIT(5)
108 #define CDC_WSA_RX_PATH_MIX_CLK_DISABLE 0
109 #define CDC_WSA_RX0_RX_PATH_MIX_CFG (0x041C)
110 #define CDC_WSA_RX0_RX_VOL_MIX_CTL (0x0420)
111 #define CDC_WSA_RX0_RX_PATH_SEC0 (0x0424)
112 #define CDC_WSA_RX0_RX_PATH_SEC1 (0x0428)
113 #define CDC_WSA_RX_PGA_HALF_DB_MASK BIT(0)
114 #define CDC_WSA_RX_PGA_HALF_DB_ENABLE BIT(0)
115 #define CDC_WSA_RX_PGA_HALF_DB_DISABLE 0
116 #define CDC_WSA_RX0_RX_PATH_SEC2 (0x042C)
117 #define CDC_WSA_RX0_RX_PATH_SEC3 (0x0430)
118 #define CDC_WSA_RX_PATH_HD2_SCALE_MASK GENMASK(1, 0)
119 #define CDC_WSA_RX_PATH_HD2_ALPHA_MASK GENMASK(5, 2)
120 #define CDC_WSA_RX0_RX_PATH_SEC5 (0x0438)
121 #define CDC_WSA_RX0_RX_PATH_SEC6 (0x043C)
122 #define CDC_WSA_RX0_RX_PATH_SEC7 (0x0440)
123 #define CDC_WSA_RX0_RX_PATH_MIX_SEC0 (0x0444)
124 #define CDC_WSA_RX0_RX_PATH_MIX_SEC1 (0x0448)
125 #define CDC_WSA_RX0_RX_PATH_DSMDEM_CTL (0x044C)
126 #define CDC_WSA_RX_DSMDEM_CLK_EN_MASK BIT(0)
127 #define CDC_WSA_RX_DSMDEM_CLK_ENABLE BIT(0)
128 #define CDC_WSA_RX1_RX_PATH_CTL (0x0480)
129 #define CDC_WSA_RX1_RX_PATH_CFG0 (0x0484)
130 #define CDC_WSA_RX1_RX_PATH_CFG1 (0x0488)
131 #define CDC_WSA_RX1_RX_PATH_CFG2 (0x048C)
132 #define CDC_WSA_RX1_RX_PATH_CFG3 (0x0490)
133 #define CDC_WSA_RX1_RX_VOL_CTL (0x0494)
134 #define CDC_WSA_RX1_RX_PATH_MIX_CTL (0x0498)
135 #define CDC_WSA_RX1_RX_PATH_MIX_CFG (0x049C)
136 #define CDC_WSA_RX1_RX_VOL_MIX_CTL (0x04A0)
137 #define CDC_WSA_RX1_RX_PATH_SEC0 (0x04A4)
138 #define CDC_WSA_RX1_RX_PATH_SEC1 (0x04A8)
139 #define CDC_WSA_RX1_RX_PATH_SEC2 (0x04AC)
140 #define CDC_WSA_RX1_RX_PATH_SEC3 (0x04B0)
141 #define CDC_WSA_RX1_RX_PATH_SEC5 (0x04B8)
142 #define CDC_WSA_RX1_RX_PATH_SEC6 (0x04BC)
143 #define CDC_WSA_RX1_RX_PATH_SEC7 (0x04C0)
144 #define CDC_WSA_RX1_RX_PATH_MIX_SEC0 (0x04C4)
145 #define CDC_WSA_RX1_RX_PATH_MIX_SEC1 (0x04C8)
146 #define CDC_WSA_RX1_RX_PATH_DSMDEM_CTL (0x04CC)
147 #define CDC_WSA_BOOST0_BOOST_PATH_CTL (0x0500)
148 #define CDC_WSA_BOOST_PATH_CLK_EN_MASK BIT(4)
149 #define CDC_WSA_BOOST_PATH_CLK_ENABLE BIT(4)
150 #define CDC_WSA_BOOST_PATH_CLK_DISABLE 0
151 #define CDC_WSA_BOOST0_BOOST_CTL (0x0504)
152 #define CDC_WSA_BOOST0_BOOST_CFG1 (0x0508)
153 #define CDC_WSA_BOOST0_BOOST_CFG2 (0x050C)
154 #define CDC_WSA_BOOST1_BOOST_PATH_CTL (0x0540)
155 #define CDC_WSA_BOOST1_BOOST_CTL (0x0544)
156 #define CDC_WSA_BOOST1_BOOST_CFG1 (0x0548)
157 #define CDC_WSA_BOOST1_BOOST_CFG2 (0x054C)
158 #define CDC_WSA_COMPANDER0_CTL0 (0x0580)
159 #define CDC_WSA_COMPANDER_CLK_EN_MASK BIT(0)
160 #define CDC_WSA_COMPANDER_CLK_ENABLE BIT(0)
161 #define CDC_WSA_COMPANDER_SOFT_RST_MASK BIT(1)
162 #define CDC_WSA_COMPANDER_SOFT_RST_ENABLE BIT(1)
163 #define CDC_WSA_COMPANDER_HALT_MASK BIT(2)
164 #define CDC_WSA_COMPANDER_HALT BIT(2)
165 #define CDC_WSA_COMPANDER0_CTL1 (0x0584)
166 #define CDC_WSA_COMPANDER0_CTL2 (0x0588)
167 #define CDC_WSA_COMPANDER0_CTL3 (0x058C)
168 #define CDC_WSA_COMPANDER0_CTL4 (0x0590)
169 #define CDC_WSA_COMPANDER0_CTL5 (0x0594)
170 #define CDC_WSA_COMPANDER0_CTL6 (0x0598)
171 #define CDC_WSA_COMPANDER0_CTL7 (0x059C)
172 #define CDC_WSA_COMPANDER1_CTL0 (0x05C0)
173 #define CDC_WSA_COMPANDER1_CTL1 (0x05C4)
174 #define CDC_WSA_COMPANDER1_CTL2 (0x05C8)
175 #define CDC_WSA_COMPANDER1_CTL3 (0x05CC)
176 #define CDC_WSA_COMPANDER1_CTL4 (0x05D0)
177 #define CDC_WSA_COMPANDER1_CTL5 (0x05D4)
178 #define CDC_WSA_COMPANDER1_CTL6 (0x05D8)
179 #define CDC_WSA_COMPANDER1_CTL7 (0x05DC)
180 #define CDC_WSA_SOFTCLIP0_CRC (0x0600)
181 #define CDC_WSA_SOFTCLIP_CLK_EN_MASK BIT(0)
182 #define CDC_WSA_SOFTCLIP_CLK_ENABLE BIT(0)
183 #define CDC_WSA_SOFTCLIP0_SOFTCLIP_CTRL (0x0604)
184 #define CDC_WSA_SOFTCLIP_EN_MASK BIT(0)
185 #define CDC_WSA_SOFTCLIP_ENABLE BIT(0)
186 #define CDC_WSA_SOFTCLIP1_CRC (0x0640)
187 #define CDC_WSA_SOFTCLIP1_SOFTCLIP_CTRL (0x0644)
188 #define CDC_WSA_EC_HQ0_EC_REF_HQ_PATH_CTL (0x0680)
189 #define CDC_WSA_EC_HQ_EC_CLK_EN_MASK BIT(0)
190 #define CDC_WSA_EC_HQ_EC_CLK_ENABLE BIT(0)
191 #define CDC_WSA_EC_HQ0_EC_REF_HQ_CFG0 (0x0684)
192 #define CDC_WSA_EC_HQ_EC_REF_PCM_RATE_MASK GENMASK(4, 1)
193 #define CDC_WSA_EC_HQ_EC_REF_PCM_RATE_48K BIT(3)
194 #define CDC_WSA_EC_HQ1_EC_REF_HQ_PATH_CTL (0x06C0)
195 #define CDC_WSA_EC_HQ1_EC_REF_HQ_CFG0 (0x06C4)
196 #define CDC_WSA_SPLINE_ASRC0_CLK_RST_CTL (0x0700)
197 #define CDC_WSA_SPLINE_ASRC0_CTL0 (0x0704)
198 #define CDC_WSA_SPLINE_ASRC0_CTL1 (0x0708)
199 #define CDC_WSA_SPLINE_ASRC0_FIFO_CTL (0x070C)
200 #define CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_LSB (0x0710)
201 #define CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_MSB (0x0714)
202 #define CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_LSB (0x0718)
203 #define CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_MSB (0x071C)
204 #define CDC_WSA_SPLINE_ASRC0_STATUS_FIFO (0x0720)
205 #define CDC_WSA_SPLINE_ASRC1_CLK_RST_CTL (0x0740)
206 #define CDC_WSA_SPLINE_ASRC1_CTL0 (0x0744)
207 #define CDC_WSA_SPLINE_ASRC1_CTL1 (0x0748)
208 #define CDC_WSA_SPLINE_ASRC1_FIFO_CTL (0x074C)
209 #define CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_LSB (0x0750)
210 #define CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_MSB (0x0754)
211 #define CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_LSB (0x0758)
212 #define CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_MSB (0x075C)
213 #define CDC_WSA_SPLINE_ASRC1_STATUS_FIFO (0x0760)
214 #define WSA_MAX_OFFSET (0x0760)
215
216 #define WSA_MACRO_RX_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\
217 SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |\
218 SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000)
219 #define WSA_MACRO_RX_MIX_RATES (SNDRV_PCM_RATE_48000 |\
220 SNDRV_PCM_RATE_96000 | SNDRV_PCM_RATE_192000)
221 #define WSA_MACRO_RX_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
222 SNDRV_PCM_FMTBIT_S24_LE |\
223 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
224
225 #define WSA_MACRO_ECHO_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\
226 SNDRV_PCM_RATE_48000)
227 #define WSA_MACRO_ECHO_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
228 SNDRV_PCM_FMTBIT_S24_LE |\
229 SNDRV_PCM_FMTBIT_S24_3LE)
230
231 #define NUM_INTERPOLATORS 2
232 #define WSA_NUM_CLKS_MAX 5
233 #define WSA_MACRO_MCLK_FREQ 19200000
234 #define WSA_MACRO_MUX_INP_MASK2 0x38
235 #define WSA_MACRO_MUX_CFG_OFFSET 0x8
236 #define WSA_MACRO_MUX_CFG1_OFFSET 0x4
237 #define WSA_MACRO_RX_COMP_OFFSET 0x40
238 #define WSA_MACRO_RX_SOFTCLIP_OFFSET 0x40
239 #define WSA_MACRO_RX_PATH_OFFSET 0x80
240 #define WSA_MACRO_RX_PATH_CFG3_OFFSET 0x10
241 #define WSA_MACRO_RX_PATH_DSMDEM_OFFSET 0x4C
242 #define WSA_MACRO_FS_RATE_MASK 0x0F
243 #define WSA_MACRO_EC_MIX_TX0_MASK 0x03
244 #define WSA_MACRO_EC_MIX_TX1_MASK 0x18
245 #define WSA_MACRO_MAX_DMA_CH_PER_PORT 0x2
246
247 enum {
248 WSA_MACRO_GAIN_OFFSET_M1P5_DB,
249 WSA_MACRO_GAIN_OFFSET_0_DB,
250 };
251 enum {
252 WSA_MACRO_RX0 = 0,
253 WSA_MACRO_RX1,
254 WSA_MACRO_RX_MIX,
255 WSA_MACRO_RX_MIX0 = WSA_MACRO_RX_MIX,
256 WSA_MACRO_RX_MIX1,
257 WSA_MACRO_RX_MAX,
258 };
259
260 enum {
261 WSA_MACRO_TX0 = 0,
262 WSA_MACRO_TX1,
263 WSA_MACRO_TX_MAX,
264 };
265
266 enum {
267 WSA_MACRO_EC0_MUX = 0,
268 WSA_MACRO_EC1_MUX,
269 WSA_MACRO_EC_MUX_MAX,
270 };
271
272 enum {
273 WSA_MACRO_COMP1, /* SPK_L */
274 WSA_MACRO_COMP2, /* SPK_R */
275 WSA_MACRO_COMP_MAX
276 };
277
278 enum {
279 WSA_MACRO_SOFTCLIP0, /* RX0 */
280 WSA_MACRO_SOFTCLIP1, /* RX1 */
281 WSA_MACRO_SOFTCLIP_MAX
282 };
283
284 enum {
285 INTn_1_INP_SEL_ZERO = 0,
286 INTn_1_INP_SEL_RX0,
287 INTn_1_INP_SEL_RX1,
288 INTn_1_INP_SEL_RX2,
289 INTn_1_INP_SEL_RX3,
290 INTn_1_INP_SEL_DEC0,
291 INTn_1_INP_SEL_DEC1,
292 };
293
294 enum {
295 INTn_2_INP_SEL_ZERO = 0,
296 INTn_2_INP_SEL_RX0,
297 INTn_2_INP_SEL_RX1,
298 INTn_2_INP_SEL_RX2,
299 INTn_2_INP_SEL_RX3,
300 };
301
302 struct interp_sample_rate {
303 int sample_rate;
304 int rate_val;
305 };
306
307 static struct interp_sample_rate int_prim_sample_rate_val[] = {
308 {8000, 0x0}, /* 8K */
309 {16000, 0x1}, /* 16K */
310 {24000, -EINVAL},/* 24K */
311 {32000, 0x3}, /* 32K */
312 {48000, 0x4}, /* 48K */
313 {96000, 0x5}, /* 96K */
314 {192000, 0x6}, /* 192K */
315 {384000, 0x7}, /* 384K */
316 {44100, 0x8}, /* 44.1K */
317 };
318
319 static struct interp_sample_rate int_mix_sample_rate_val[] = {
320 {48000, 0x4}, /* 48K */
321 {96000, 0x5}, /* 96K */
322 {192000, 0x6}, /* 192K */
323 };
324
325 enum {
326 WSA_MACRO_AIF_INVALID = 0,
327 WSA_MACRO_AIF1_PB,
328 WSA_MACRO_AIF_MIX1_PB,
329 WSA_MACRO_AIF_VI,
330 WSA_MACRO_AIF_ECHO,
331 WSA_MACRO_MAX_DAIS,
332 };
333
334 struct wsa_macro {
335 struct device *dev;
336 int comp_enabled[WSA_MACRO_COMP_MAX];
337 int ec_hq[WSA_MACRO_RX1 + 1];
338 u16 prim_int_users[WSA_MACRO_RX1 + 1];
339 u16 wsa_mclk_users;
340 bool reset_swr;
341 unsigned long active_ch_mask[WSA_MACRO_MAX_DAIS];
342 unsigned long active_ch_cnt[WSA_MACRO_MAX_DAIS];
343 int rx_port_value[WSA_MACRO_RX_MAX];
344 int ear_spkr_gain;
345 int spkr_gain_offset;
346 int spkr_mode;
347 int is_softclip_on[WSA_MACRO_SOFTCLIP_MAX];
348 int softclip_clk_users[WSA_MACRO_SOFTCLIP_MAX];
349 struct regmap *regmap;
350 struct clk_bulk_data clks[WSA_NUM_CLKS_MAX];
351 struct clk_hw hw;
352 };
353 #define to_wsa_macro(_hw) container_of(_hw, struct wsa_macro, hw)
354
355 static const DECLARE_TLV_DB_SCALE(digital_gain, -8400, 100, -8400);
356
357 static const char *const rx_text[] = {
358 "ZERO", "RX0", "RX1", "RX_MIX0", "RX_MIX1", "DEC0", "DEC1"
359 };
360
361 static const char *const rx_mix_text[] = {
362 "ZERO", "RX0", "RX1", "RX_MIX0", "RX_MIX1"
363 };
364
365 static const char *const rx_mix_ec_text[] = {
366 "ZERO", "RX_MIX_TX0", "RX_MIX_TX1"
367 };
368
369 static const char *const rx_mux_text[] = {
370 "ZERO", "AIF1_PB", "AIF_MIX1_PB"
371 };
372
373 static const char *const rx_sidetone_mix_text[] = {
374 "ZERO", "SRC0"
375 };
376
377 static const char * const wsa_macro_ear_spkr_pa_gain_text[] = {
378 "G_DEFAULT", "G_0_DB", "G_1_DB", "G_2_DB", "G_3_DB",
379 "G_4_DB", "G_5_DB", "G_6_DB"
380 };
381
382 static SOC_ENUM_SINGLE_EXT_DECL(wsa_macro_ear_spkr_pa_gain_enum,
383 wsa_macro_ear_spkr_pa_gain_text);
384
385 /* RX INT0 */
386 static const struct soc_enum rx0_prim_inp0_chain_enum =
387 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT0_CFG0,
388 0, 7, rx_text);
389
390 static const struct soc_enum rx0_prim_inp1_chain_enum =
391 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT0_CFG0,
392 3, 7, rx_text);
393
394 static const struct soc_enum rx0_prim_inp2_chain_enum =
395 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT0_CFG1,
396 3, 7, rx_text);
397
398 static const struct soc_enum rx0_mix_chain_enum =
399 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT0_CFG1,
400 0, 5, rx_mix_text);
401
402 static const struct soc_enum rx0_sidetone_mix_enum =
403 SOC_ENUM_SINGLE(SND_SOC_NOPM, 0, 2, rx_sidetone_mix_text);
404
405 static const struct snd_kcontrol_new rx0_prim_inp0_mux =
406 SOC_DAPM_ENUM("WSA_RX0 INP0 Mux", rx0_prim_inp0_chain_enum);
407
408 static const struct snd_kcontrol_new rx0_prim_inp1_mux =
409 SOC_DAPM_ENUM("WSA_RX0 INP1 Mux", rx0_prim_inp1_chain_enum);
410
411 static const struct snd_kcontrol_new rx0_prim_inp2_mux =
412 SOC_DAPM_ENUM("WSA_RX0 INP2 Mux", rx0_prim_inp2_chain_enum);
413
414 static const struct snd_kcontrol_new rx0_mix_mux =
415 SOC_DAPM_ENUM("WSA_RX0 MIX Mux", rx0_mix_chain_enum);
416
417 static const struct snd_kcontrol_new rx0_sidetone_mix_mux =
418 SOC_DAPM_ENUM("WSA_RX0 SIDETONE MIX Mux", rx0_sidetone_mix_enum);
419
420 /* RX INT1 */
421 static const struct soc_enum rx1_prim_inp0_chain_enum =
422 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT1_CFG0,
423 0, 7, rx_text);
424
425 static const struct soc_enum rx1_prim_inp1_chain_enum =
426 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT1_CFG0,
427 3, 7, rx_text);
428
429 static const struct soc_enum rx1_prim_inp2_chain_enum =
430 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT1_CFG1,
431 3, 7, rx_text);
432
433 static const struct soc_enum rx1_mix_chain_enum =
434 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_INT1_CFG1,
435 0, 5, rx_mix_text);
436
437 static const struct snd_kcontrol_new rx1_prim_inp0_mux =
438 SOC_DAPM_ENUM("WSA_RX1 INP0 Mux", rx1_prim_inp0_chain_enum);
439
440 static const struct snd_kcontrol_new rx1_prim_inp1_mux =
441 SOC_DAPM_ENUM("WSA_RX1 INP1 Mux", rx1_prim_inp1_chain_enum);
442
443 static const struct snd_kcontrol_new rx1_prim_inp2_mux =
444 SOC_DAPM_ENUM("WSA_RX1 INP2 Mux", rx1_prim_inp2_chain_enum);
445
446 static const struct snd_kcontrol_new rx1_mix_mux =
447 SOC_DAPM_ENUM("WSA_RX1 MIX Mux", rx1_mix_chain_enum);
448
449 static const struct soc_enum rx_mix_ec0_enum =
450 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_MIX_CFG0,
451 0, 3, rx_mix_ec_text);
452
453 static const struct soc_enum rx_mix_ec1_enum =
454 SOC_ENUM_SINGLE(CDC_WSA_RX_INP_MUX_RX_MIX_CFG0,
455 3, 3, rx_mix_ec_text);
456
457 static const struct snd_kcontrol_new rx_mix_ec0_mux =
458 SOC_DAPM_ENUM("WSA RX_MIX EC0_Mux", rx_mix_ec0_enum);
459
460 static const struct snd_kcontrol_new rx_mix_ec1_mux =
461 SOC_DAPM_ENUM("WSA RX_MIX EC1_Mux", rx_mix_ec1_enum);
462
463 static const struct reg_default wsa_defaults[] = {
464 /* WSA Macro */
465 { CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL, 0x00},
466 { CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL, 0x00},
467 { CDC_WSA_CLK_RST_CTRL_SWR_CONTROL, 0x00},
468 { CDC_WSA_TOP_TOP_CFG0, 0x00},
469 { CDC_WSA_TOP_TOP_CFG1, 0x00},
470 { CDC_WSA_TOP_FREQ_MCLK, 0x00},
471 { CDC_WSA_TOP_DEBUG_BUS_SEL, 0x00},
472 { CDC_WSA_TOP_DEBUG_EN0, 0x00},
473 { CDC_WSA_TOP_DEBUG_EN1, 0x00},
474 { CDC_WSA_TOP_DEBUG_DSM_LB, 0x88},
475 { CDC_WSA_TOP_RX_I2S_CTL, 0x0C},
476 { CDC_WSA_TOP_TX_I2S_CTL, 0x0C},
477 { CDC_WSA_TOP_I2S_CLK, 0x02},
478 { CDC_WSA_TOP_I2S_RESET, 0x00},
479 { CDC_WSA_RX_INP_MUX_RX_INT0_CFG0, 0x00},
480 { CDC_WSA_RX_INP_MUX_RX_INT0_CFG1, 0x00},
481 { CDC_WSA_RX_INP_MUX_RX_INT1_CFG0, 0x00},
482 { CDC_WSA_RX_INP_MUX_RX_INT1_CFG1, 0x00},
483 { CDC_WSA_RX_INP_MUX_RX_MIX_CFG0, 0x00},
484 { CDC_WSA_RX_INP_MUX_RX_EC_CFG0, 0x00},
485 { CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0, 0x00},
486 { CDC_WSA_TX0_SPKR_PROT_PATH_CTL, 0x02},
487 { CDC_WSA_TX0_SPKR_PROT_PATH_CFG0, 0x00},
488 { CDC_WSA_TX1_SPKR_PROT_PATH_CTL, 0x02},
489 { CDC_WSA_TX1_SPKR_PROT_PATH_CFG0, 0x00},
490 { CDC_WSA_TX2_SPKR_PROT_PATH_CTL, 0x02},
491 { CDC_WSA_TX2_SPKR_PROT_PATH_CFG0, 0x00},
492 { CDC_WSA_TX3_SPKR_PROT_PATH_CTL, 0x02},
493 { CDC_WSA_TX3_SPKR_PROT_PATH_CFG0, 0x00},
494 { CDC_WSA_INTR_CTRL_CFG, 0x00},
495 { CDC_WSA_INTR_CTRL_CLR_COMMIT, 0x00},
496 { CDC_WSA_INTR_CTRL_PIN1_MASK0, 0xFF},
497 { CDC_WSA_INTR_CTRL_PIN1_STATUS0, 0x00},
498 { CDC_WSA_INTR_CTRL_PIN1_CLEAR0, 0x00},
499 { CDC_WSA_INTR_CTRL_PIN2_MASK0, 0xFF},
500 { CDC_WSA_INTR_CTRL_PIN2_STATUS0, 0x00},
501 { CDC_WSA_INTR_CTRL_PIN2_CLEAR0, 0x00},
502 { CDC_WSA_INTR_CTRL_LEVEL0, 0x00},
503 { CDC_WSA_INTR_CTRL_BYPASS0, 0x00},
504 { CDC_WSA_INTR_CTRL_SET0, 0x00},
505 { CDC_WSA_RX0_RX_PATH_CTL, 0x04},
506 { CDC_WSA_RX0_RX_PATH_CFG0, 0x00},
507 { CDC_WSA_RX0_RX_PATH_CFG1, 0x64},
508 { CDC_WSA_RX0_RX_PATH_CFG2, 0x8F},
509 { CDC_WSA_RX0_RX_PATH_CFG3, 0x00},
510 { CDC_WSA_RX0_RX_VOL_CTL, 0x00},
511 { CDC_WSA_RX0_RX_PATH_MIX_CTL, 0x04},
512 { CDC_WSA_RX0_RX_PATH_MIX_CFG, 0x7E},
513 { CDC_WSA_RX0_RX_VOL_MIX_CTL, 0x00},
514 { CDC_WSA_RX0_RX_PATH_SEC0, 0x04},
515 { CDC_WSA_RX0_RX_PATH_SEC1, 0x08},
516 { CDC_WSA_RX0_RX_PATH_SEC2, 0x00},
517 { CDC_WSA_RX0_RX_PATH_SEC3, 0x00},
518 { CDC_WSA_RX0_RX_PATH_SEC5, 0x00},
519 { CDC_WSA_RX0_RX_PATH_SEC6, 0x00},
520 { CDC_WSA_RX0_RX_PATH_SEC7, 0x00},
521 { CDC_WSA_RX0_RX_PATH_MIX_SEC0, 0x08},
522 { CDC_WSA_RX0_RX_PATH_MIX_SEC1, 0x00},
523 { CDC_WSA_RX0_RX_PATH_DSMDEM_CTL, 0x00},
524 { CDC_WSA_RX1_RX_PATH_CFG0, 0x00},
525 { CDC_WSA_RX1_RX_PATH_CFG1, 0x64},
526 { CDC_WSA_RX1_RX_PATH_CFG2, 0x8F},
527 { CDC_WSA_RX1_RX_PATH_CFG3, 0x00},
528 { CDC_WSA_RX1_RX_VOL_CTL, 0x00},
529 { CDC_WSA_RX1_RX_PATH_MIX_CTL, 0x04},
530 { CDC_WSA_RX1_RX_PATH_MIX_CFG, 0x7E},
531 { CDC_WSA_RX1_RX_VOL_MIX_CTL, 0x00},
532 { CDC_WSA_RX1_RX_PATH_SEC0, 0x04},
533 { CDC_WSA_RX1_RX_PATH_SEC1, 0x08},
534 { CDC_WSA_RX1_RX_PATH_SEC2, 0x00},
535 { CDC_WSA_RX1_RX_PATH_SEC3, 0x00},
536 { CDC_WSA_RX1_RX_PATH_SEC5, 0x00},
537 { CDC_WSA_RX1_RX_PATH_SEC6, 0x00},
538 { CDC_WSA_RX1_RX_PATH_SEC7, 0x00},
539 { CDC_WSA_RX1_RX_PATH_MIX_SEC0, 0x08},
540 { CDC_WSA_RX1_RX_PATH_MIX_SEC1, 0x00},
541 { CDC_WSA_RX1_RX_PATH_DSMDEM_CTL, 0x00},
542 { CDC_WSA_BOOST0_BOOST_PATH_CTL, 0x00},
543 { CDC_WSA_BOOST0_BOOST_CTL, 0xD0},
544 { CDC_WSA_BOOST0_BOOST_CFG1, 0x89},
545 { CDC_WSA_BOOST0_BOOST_CFG2, 0x04},
546 { CDC_WSA_BOOST1_BOOST_PATH_CTL, 0x00},
547 { CDC_WSA_BOOST1_BOOST_CTL, 0xD0},
548 { CDC_WSA_BOOST1_BOOST_CFG1, 0x89},
549 { CDC_WSA_BOOST1_BOOST_CFG2, 0x04},
550 { CDC_WSA_COMPANDER0_CTL0, 0x60},
551 { CDC_WSA_COMPANDER0_CTL1, 0xDB},
552 { CDC_WSA_COMPANDER0_CTL2, 0xFF},
553 { CDC_WSA_COMPANDER0_CTL3, 0x35},
554 { CDC_WSA_COMPANDER0_CTL4, 0xFF},
555 { CDC_WSA_COMPANDER0_CTL5, 0x00},
556 { CDC_WSA_COMPANDER0_CTL6, 0x01},
557 { CDC_WSA_COMPANDER0_CTL7, 0x28},
558 { CDC_WSA_COMPANDER1_CTL0, 0x60},
559 { CDC_WSA_COMPANDER1_CTL1, 0xDB},
560 { CDC_WSA_COMPANDER1_CTL2, 0xFF},
561 { CDC_WSA_COMPANDER1_CTL3, 0x35},
562 { CDC_WSA_COMPANDER1_CTL4, 0xFF},
563 { CDC_WSA_COMPANDER1_CTL5, 0x00},
564 { CDC_WSA_COMPANDER1_CTL6, 0x01},
565 { CDC_WSA_COMPANDER1_CTL7, 0x28},
566 { CDC_WSA_SOFTCLIP0_CRC, 0x00},
567 { CDC_WSA_SOFTCLIP0_SOFTCLIP_CTRL, 0x38},
568 { CDC_WSA_SOFTCLIP1_CRC, 0x00},
569 { CDC_WSA_SOFTCLIP1_SOFTCLIP_CTRL, 0x38},
570 { CDC_WSA_EC_HQ0_EC_REF_HQ_PATH_CTL, 0x00},
571 { CDC_WSA_EC_HQ0_EC_REF_HQ_CFG0, 0x01},
572 { CDC_WSA_EC_HQ1_EC_REF_HQ_PATH_CTL, 0x00},
573 { CDC_WSA_EC_HQ1_EC_REF_HQ_CFG0, 0x01},
574 { CDC_WSA_SPLINE_ASRC0_CLK_RST_CTL, 0x00},
575 { CDC_WSA_SPLINE_ASRC0_CTL0, 0x00},
576 { CDC_WSA_SPLINE_ASRC0_CTL1, 0x00},
577 { CDC_WSA_SPLINE_ASRC0_FIFO_CTL, 0xA8},
578 { CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_LSB, 0x00},
579 { CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_MSB, 0x00},
580 { CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_LSB, 0x00},
581 { CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_MSB, 0x00},
582 { CDC_WSA_SPLINE_ASRC0_STATUS_FIFO, 0x00},
583 { CDC_WSA_SPLINE_ASRC1_CLK_RST_CTL, 0x00},
584 { CDC_WSA_SPLINE_ASRC1_CTL0, 0x00},
585 { CDC_WSA_SPLINE_ASRC1_CTL1, 0x00},
586 { CDC_WSA_SPLINE_ASRC1_FIFO_CTL, 0xA8},
587 { CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_LSB, 0x00},
588 { CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_MSB, 0x00},
589 { CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_LSB, 0x00},
590 { CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_MSB, 0x00},
591 { CDC_WSA_SPLINE_ASRC1_STATUS_FIFO, 0x00},
592 };
593
wsa_is_wronly_register(struct device * dev,unsigned int reg)594 static bool wsa_is_wronly_register(struct device *dev,
595 unsigned int reg)
596 {
597 switch (reg) {
598 case CDC_WSA_INTR_CTRL_CLR_COMMIT:
599 case CDC_WSA_INTR_CTRL_PIN1_CLEAR0:
600 case CDC_WSA_INTR_CTRL_PIN2_CLEAR0:
601 return true;
602 }
603
604 return false;
605 }
606
wsa_is_rw_register(struct device * dev,unsigned int reg)607 static bool wsa_is_rw_register(struct device *dev, unsigned int reg)
608 {
609 switch (reg) {
610 case CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL:
611 case CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL:
612 case CDC_WSA_CLK_RST_CTRL_SWR_CONTROL:
613 case CDC_WSA_TOP_TOP_CFG0:
614 case CDC_WSA_TOP_TOP_CFG1:
615 case CDC_WSA_TOP_FREQ_MCLK:
616 case CDC_WSA_TOP_DEBUG_BUS_SEL:
617 case CDC_WSA_TOP_DEBUG_EN0:
618 case CDC_WSA_TOP_DEBUG_EN1:
619 case CDC_WSA_TOP_DEBUG_DSM_LB:
620 case CDC_WSA_TOP_RX_I2S_CTL:
621 case CDC_WSA_TOP_TX_I2S_CTL:
622 case CDC_WSA_TOP_I2S_CLK:
623 case CDC_WSA_TOP_I2S_RESET:
624 case CDC_WSA_RX_INP_MUX_RX_INT0_CFG0:
625 case CDC_WSA_RX_INP_MUX_RX_INT0_CFG1:
626 case CDC_WSA_RX_INP_MUX_RX_INT1_CFG0:
627 case CDC_WSA_RX_INP_MUX_RX_INT1_CFG1:
628 case CDC_WSA_RX_INP_MUX_RX_MIX_CFG0:
629 case CDC_WSA_RX_INP_MUX_RX_EC_CFG0:
630 case CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0:
631 case CDC_WSA_TX0_SPKR_PROT_PATH_CTL:
632 case CDC_WSA_TX0_SPKR_PROT_PATH_CFG0:
633 case CDC_WSA_TX1_SPKR_PROT_PATH_CTL:
634 case CDC_WSA_TX1_SPKR_PROT_PATH_CFG0:
635 case CDC_WSA_TX2_SPKR_PROT_PATH_CTL:
636 case CDC_WSA_TX2_SPKR_PROT_PATH_CFG0:
637 case CDC_WSA_TX3_SPKR_PROT_PATH_CTL:
638 case CDC_WSA_TX3_SPKR_PROT_PATH_CFG0:
639 case CDC_WSA_INTR_CTRL_CFG:
640 case CDC_WSA_INTR_CTRL_PIN1_MASK0:
641 case CDC_WSA_INTR_CTRL_PIN2_MASK0:
642 case CDC_WSA_INTR_CTRL_LEVEL0:
643 case CDC_WSA_INTR_CTRL_BYPASS0:
644 case CDC_WSA_INTR_CTRL_SET0:
645 case CDC_WSA_RX0_RX_PATH_CTL:
646 case CDC_WSA_RX0_RX_PATH_CFG0:
647 case CDC_WSA_RX0_RX_PATH_CFG1:
648 case CDC_WSA_RX0_RX_PATH_CFG2:
649 case CDC_WSA_RX0_RX_PATH_CFG3:
650 case CDC_WSA_RX0_RX_VOL_CTL:
651 case CDC_WSA_RX0_RX_PATH_MIX_CTL:
652 case CDC_WSA_RX0_RX_PATH_MIX_CFG:
653 case CDC_WSA_RX0_RX_VOL_MIX_CTL:
654 case CDC_WSA_RX0_RX_PATH_SEC0:
655 case CDC_WSA_RX0_RX_PATH_SEC1:
656 case CDC_WSA_RX0_RX_PATH_SEC2:
657 case CDC_WSA_RX0_RX_PATH_SEC3:
658 case CDC_WSA_RX0_RX_PATH_SEC5:
659 case CDC_WSA_RX0_RX_PATH_SEC6:
660 case CDC_WSA_RX0_RX_PATH_SEC7:
661 case CDC_WSA_RX0_RX_PATH_MIX_SEC0:
662 case CDC_WSA_RX0_RX_PATH_MIX_SEC1:
663 case CDC_WSA_RX0_RX_PATH_DSMDEM_CTL:
664 case CDC_WSA_RX1_RX_PATH_CTL:
665 case CDC_WSA_RX1_RX_PATH_CFG0:
666 case CDC_WSA_RX1_RX_PATH_CFG1:
667 case CDC_WSA_RX1_RX_PATH_CFG2:
668 case CDC_WSA_RX1_RX_PATH_CFG3:
669 case CDC_WSA_RX1_RX_VOL_CTL:
670 case CDC_WSA_RX1_RX_PATH_MIX_CTL:
671 case CDC_WSA_RX1_RX_PATH_MIX_CFG:
672 case CDC_WSA_RX1_RX_VOL_MIX_CTL:
673 case CDC_WSA_RX1_RX_PATH_SEC0:
674 case CDC_WSA_RX1_RX_PATH_SEC1:
675 case CDC_WSA_RX1_RX_PATH_SEC2:
676 case CDC_WSA_RX1_RX_PATH_SEC3:
677 case CDC_WSA_RX1_RX_PATH_SEC5:
678 case CDC_WSA_RX1_RX_PATH_SEC6:
679 case CDC_WSA_RX1_RX_PATH_SEC7:
680 case CDC_WSA_RX1_RX_PATH_MIX_SEC0:
681 case CDC_WSA_RX1_RX_PATH_MIX_SEC1:
682 case CDC_WSA_RX1_RX_PATH_DSMDEM_CTL:
683 case CDC_WSA_BOOST0_BOOST_PATH_CTL:
684 case CDC_WSA_BOOST0_BOOST_CTL:
685 case CDC_WSA_BOOST0_BOOST_CFG1:
686 case CDC_WSA_BOOST0_BOOST_CFG2:
687 case CDC_WSA_BOOST1_BOOST_PATH_CTL:
688 case CDC_WSA_BOOST1_BOOST_CTL:
689 case CDC_WSA_BOOST1_BOOST_CFG1:
690 case CDC_WSA_BOOST1_BOOST_CFG2:
691 case CDC_WSA_COMPANDER0_CTL0:
692 case CDC_WSA_COMPANDER0_CTL1:
693 case CDC_WSA_COMPANDER0_CTL2:
694 case CDC_WSA_COMPANDER0_CTL3:
695 case CDC_WSA_COMPANDER0_CTL4:
696 case CDC_WSA_COMPANDER0_CTL5:
697 case CDC_WSA_COMPANDER0_CTL7:
698 case CDC_WSA_COMPANDER1_CTL0:
699 case CDC_WSA_COMPANDER1_CTL1:
700 case CDC_WSA_COMPANDER1_CTL2:
701 case CDC_WSA_COMPANDER1_CTL3:
702 case CDC_WSA_COMPANDER1_CTL4:
703 case CDC_WSA_COMPANDER1_CTL5:
704 case CDC_WSA_COMPANDER1_CTL7:
705 case CDC_WSA_SOFTCLIP0_CRC:
706 case CDC_WSA_SOFTCLIP0_SOFTCLIP_CTRL:
707 case CDC_WSA_SOFTCLIP1_CRC:
708 case CDC_WSA_SOFTCLIP1_SOFTCLIP_CTRL:
709 case CDC_WSA_EC_HQ0_EC_REF_HQ_PATH_CTL:
710 case CDC_WSA_EC_HQ0_EC_REF_HQ_CFG0:
711 case CDC_WSA_EC_HQ1_EC_REF_HQ_PATH_CTL:
712 case CDC_WSA_EC_HQ1_EC_REF_HQ_CFG0:
713 case CDC_WSA_SPLINE_ASRC0_CLK_RST_CTL:
714 case CDC_WSA_SPLINE_ASRC0_CTL0:
715 case CDC_WSA_SPLINE_ASRC0_CTL1:
716 case CDC_WSA_SPLINE_ASRC0_FIFO_CTL:
717 case CDC_WSA_SPLINE_ASRC1_CLK_RST_CTL:
718 case CDC_WSA_SPLINE_ASRC1_CTL0:
719 case CDC_WSA_SPLINE_ASRC1_CTL1:
720 case CDC_WSA_SPLINE_ASRC1_FIFO_CTL:
721 return true;
722 }
723
724 return false;
725 }
726
wsa_is_writeable_register(struct device * dev,unsigned int reg)727 static bool wsa_is_writeable_register(struct device *dev, unsigned int reg)
728 {
729 bool ret;
730
731 ret = wsa_is_rw_register(dev, reg);
732 if (!ret)
733 return wsa_is_wronly_register(dev, reg);
734
735 return ret;
736 }
737
wsa_is_readable_register(struct device * dev,unsigned int reg)738 static bool wsa_is_readable_register(struct device *dev, unsigned int reg)
739 {
740 switch (reg) {
741 case CDC_WSA_INTR_CTRL_CLR_COMMIT:
742 case CDC_WSA_INTR_CTRL_PIN1_CLEAR0:
743 case CDC_WSA_INTR_CTRL_PIN2_CLEAR0:
744 case CDC_WSA_INTR_CTRL_PIN1_STATUS0:
745 case CDC_WSA_INTR_CTRL_PIN2_STATUS0:
746 case CDC_WSA_COMPANDER0_CTL6:
747 case CDC_WSA_COMPANDER1_CTL6:
748 case CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_LSB:
749 case CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_MSB:
750 case CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_LSB:
751 case CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_MSB:
752 case CDC_WSA_SPLINE_ASRC0_STATUS_FIFO:
753 case CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_LSB:
754 case CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_MSB:
755 case CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_LSB:
756 case CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_MSB:
757 case CDC_WSA_SPLINE_ASRC1_STATUS_FIFO:
758 return true;
759 }
760
761 return wsa_is_rw_register(dev, reg);
762 }
763
wsa_is_volatile_register(struct device * dev,unsigned int reg)764 static bool wsa_is_volatile_register(struct device *dev, unsigned int reg)
765 {
766 /* Update volatile list for rx/tx macros */
767 switch (reg) {
768 case CDC_WSA_INTR_CTRL_PIN1_STATUS0:
769 case CDC_WSA_INTR_CTRL_PIN2_STATUS0:
770 case CDC_WSA_COMPANDER0_CTL6:
771 case CDC_WSA_COMPANDER1_CTL6:
772 case CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_LSB:
773 case CDC_WSA_SPLINE_ASRC0_STATUS_FMIN_CNTR_MSB:
774 case CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_LSB:
775 case CDC_WSA_SPLINE_ASRC0_STATUS_FMAX_CNTR_MSB:
776 case CDC_WSA_SPLINE_ASRC0_STATUS_FIFO:
777 case CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_LSB:
778 case CDC_WSA_SPLINE_ASRC1_STATUS_FMIN_CNTR_MSB:
779 case CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_LSB:
780 case CDC_WSA_SPLINE_ASRC1_STATUS_FMAX_CNTR_MSB:
781 case CDC_WSA_SPLINE_ASRC1_STATUS_FIFO:
782 return true;
783 }
784 return false;
785 }
786
787 static const struct regmap_config wsa_regmap_config = {
788 .name = "wsa_macro",
789 .reg_bits = 16,
790 .val_bits = 32, /* 8 but with 32 bit read/write */
791 .reg_stride = 4,
792 .cache_type = REGCACHE_FLAT,
793 .reg_defaults = wsa_defaults,
794 .num_reg_defaults = ARRAY_SIZE(wsa_defaults),
795 .max_register = WSA_MAX_OFFSET,
796 .writeable_reg = wsa_is_writeable_register,
797 .volatile_reg = wsa_is_volatile_register,
798 .readable_reg = wsa_is_readable_register,
799 };
800
801 /**
802 * wsa_macro_set_spkr_mode - Configures speaker compander and smartboost
803 * settings based on speaker mode.
804 *
805 * @component: codec instance
806 * @mode: Indicates speaker configuration mode.
807 *
808 * Returns 0 on success or -EINVAL on error.
809 */
wsa_macro_set_spkr_mode(struct snd_soc_component * component,int mode)810 int wsa_macro_set_spkr_mode(struct snd_soc_component *component, int mode)
811 {
812 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
813
814 wsa->spkr_mode = mode;
815
816 switch (mode) {
817 case WSA_MACRO_SPKR_MODE_1:
818 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER0_CTL3, 0x80, 0x00);
819 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER1_CTL3, 0x80, 0x00);
820 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER0_CTL7, 0x01, 0x00);
821 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER1_CTL7, 0x01, 0x00);
822 snd_soc_component_update_bits(component, CDC_WSA_BOOST0_BOOST_CTL, 0x7C, 0x44);
823 snd_soc_component_update_bits(component, CDC_WSA_BOOST1_BOOST_CTL, 0x7C, 0x44);
824 break;
825 default:
826 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER0_CTL3, 0x80, 0x80);
827 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER1_CTL3, 0x80, 0x80);
828 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER0_CTL7, 0x01, 0x01);
829 snd_soc_component_update_bits(component, CDC_WSA_COMPANDER1_CTL7, 0x01, 0x01);
830 snd_soc_component_update_bits(component, CDC_WSA_BOOST0_BOOST_CTL, 0x7C, 0x58);
831 snd_soc_component_update_bits(component, CDC_WSA_BOOST1_BOOST_CTL, 0x7C, 0x58);
832 break;
833 }
834 return 0;
835 }
836 EXPORT_SYMBOL(wsa_macro_set_spkr_mode);
837
wsa_macro_set_prim_interpolator_rate(struct snd_soc_dai * dai,u8 int_prim_fs_rate_reg_val,u32 sample_rate)838 static int wsa_macro_set_prim_interpolator_rate(struct snd_soc_dai *dai,
839 u8 int_prim_fs_rate_reg_val,
840 u32 sample_rate)
841 {
842 u8 int_1_mix1_inp;
843 u32 j, port;
844 u16 int_mux_cfg0, int_mux_cfg1;
845 u16 int_fs_reg;
846 u8 inp0_sel, inp1_sel, inp2_sel;
847 struct snd_soc_component *component = dai->component;
848 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
849
850 for_each_set_bit(port, &wsa->active_ch_mask[dai->id], WSA_MACRO_RX_MAX) {
851 int_1_mix1_inp = port;
852 if ((int_1_mix1_inp < WSA_MACRO_RX0) || (int_1_mix1_inp > WSA_MACRO_RX_MIX1)) {
853 dev_err(component->dev, "%s: Invalid RX port, Dai ID is %d\n",
854 __func__, dai->id);
855 return -EINVAL;
856 }
857
858 int_mux_cfg0 = CDC_WSA_RX_INP_MUX_RX_INT0_CFG0;
859
860 /*
861 * Loop through all interpolator MUX inputs and find out
862 * to which interpolator input, the cdc_dma rx port
863 * is connected
864 */
865 for (j = 0; j < NUM_INTERPOLATORS; j++) {
866 int_mux_cfg1 = int_mux_cfg0 + WSA_MACRO_MUX_CFG1_OFFSET;
867 inp0_sel = snd_soc_component_read_field(component, int_mux_cfg0,
868 CDC_WSA_RX_INTX_1_MIX_INP0_SEL_MASK);
869 inp1_sel = snd_soc_component_read_field(component, int_mux_cfg0,
870 CDC_WSA_RX_INTX_1_MIX_INP1_SEL_MASK);
871 inp2_sel = snd_soc_component_read_field(component, int_mux_cfg1,
872 CDC_WSA_RX_INTX_1_MIX_INP2_SEL_MASK);
873
874 if ((inp0_sel == int_1_mix1_inp + INTn_1_INP_SEL_RX0) ||
875 (inp1_sel == int_1_mix1_inp + INTn_1_INP_SEL_RX0) ||
876 (inp2_sel == int_1_mix1_inp + INTn_1_INP_SEL_RX0)) {
877 int_fs_reg = CDC_WSA_RX0_RX_PATH_CTL +
878 WSA_MACRO_RX_PATH_OFFSET * j;
879 /* sample_rate is in Hz */
880 snd_soc_component_update_bits(component, int_fs_reg,
881 WSA_MACRO_FS_RATE_MASK,
882 int_prim_fs_rate_reg_val);
883 }
884 int_mux_cfg0 += WSA_MACRO_MUX_CFG_OFFSET;
885 }
886 }
887
888 return 0;
889 }
890
wsa_macro_set_mix_interpolator_rate(struct snd_soc_dai * dai,u8 int_mix_fs_rate_reg_val,u32 sample_rate)891 static int wsa_macro_set_mix_interpolator_rate(struct snd_soc_dai *dai,
892 u8 int_mix_fs_rate_reg_val,
893 u32 sample_rate)
894 {
895 u8 int_2_inp;
896 u32 j, port;
897 u16 int_mux_cfg1, int_fs_reg;
898 u8 int_mux_cfg1_val;
899 struct snd_soc_component *component = dai->component;
900 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
901
902 for_each_set_bit(port, &wsa->active_ch_mask[dai->id], WSA_MACRO_RX_MAX) {
903 int_2_inp = port;
904 if ((int_2_inp < WSA_MACRO_RX0) || (int_2_inp > WSA_MACRO_RX_MIX1)) {
905 dev_err(component->dev, "%s: Invalid RX port, Dai ID is %d\n",
906 __func__, dai->id);
907 return -EINVAL;
908 }
909
910 int_mux_cfg1 = CDC_WSA_RX_INP_MUX_RX_INT0_CFG1;
911 for (j = 0; j < NUM_INTERPOLATORS; j++) {
912 int_mux_cfg1_val = snd_soc_component_read_field(component, int_mux_cfg1,
913 CDC_WSA_RX_INTX_2_SEL_MASK);
914
915 if (int_mux_cfg1_val == int_2_inp + INTn_2_INP_SEL_RX0) {
916 int_fs_reg = CDC_WSA_RX0_RX_PATH_MIX_CTL +
917 WSA_MACRO_RX_PATH_OFFSET * j;
918
919 snd_soc_component_update_bits(component,
920 int_fs_reg,
921 WSA_MACRO_FS_RATE_MASK,
922 int_mix_fs_rate_reg_val);
923 }
924 int_mux_cfg1 += WSA_MACRO_MUX_CFG_OFFSET;
925 }
926 }
927 return 0;
928 }
929
wsa_macro_set_interpolator_rate(struct snd_soc_dai * dai,u32 sample_rate)930 static int wsa_macro_set_interpolator_rate(struct snd_soc_dai *dai,
931 u32 sample_rate)
932 {
933 int rate_val = 0;
934 int i, ret;
935
936 /* set mixing path rate */
937 for (i = 0; i < ARRAY_SIZE(int_mix_sample_rate_val); i++) {
938 if (sample_rate == int_mix_sample_rate_val[i].sample_rate) {
939 rate_val = int_mix_sample_rate_val[i].rate_val;
940 break;
941 }
942 }
943 if ((i == ARRAY_SIZE(int_mix_sample_rate_val)) || (rate_val < 0))
944 goto prim_rate;
945
946 ret = wsa_macro_set_mix_interpolator_rate(dai, (u8) rate_val, sample_rate);
947 if (ret < 0)
948 return ret;
949 prim_rate:
950 /* set primary path sample rate */
951 for (i = 0; i < ARRAY_SIZE(int_prim_sample_rate_val); i++) {
952 if (sample_rate == int_prim_sample_rate_val[i].sample_rate) {
953 rate_val = int_prim_sample_rate_val[i].rate_val;
954 break;
955 }
956 }
957 if ((i == ARRAY_SIZE(int_prim_sample_rate_val)) || (rate_val < 0))
958 return -EINVAL;
959
960 ret = wsa_macro_set_prim_interpolator_rate(dai, (u8) rate_val, sample_rate);
961
962 return ret;
963 }
964
wsa_macro_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)965 static int wsa_macro_hw_params(struct snd_pcm_substream *substream,
966 struct snd_pcm_hw_params *params,
967 struct snd_soc_dai *dai)
968 {
969 struct snd_soc_component *component = dai->component;
970 int ret;
971
972 switch (substream->stream) {
973 case SNDRV_PCM_STREAM_PLAYBACK:
974 ret = wsa_macro_set_interpolator_rate(dai, params_rate(params));
975 if (ret) {
976 dev_err(component->dev,
977 "%s: cannot set sample rate: %u\n",
978 __func__, params_rate(params));
979 return ret;
980 }
981 break;
982 default:
983 break;
984 }
985 return 0;
986 }
987
wsa_macro_get_channel_map(struct snd_soc_dai * dai,unsigned int * tx_num,unsigned int * tx_slot,unsigned int * rx_num,unsigned int * rx_slot)988 static int wsa_macro_get_channel_map(struct snd_soc_dai *dai,
989 unsigned int *tx_num, unsigned int *tx_slot,
990 unsigned int *rx_num, unsigned int *rx_slot)
991 {
992 struct snd_soc_component *component = dai->component;
993 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
994 u16 val, mask = 0, cnt = 0, temp;
995
996 switch (dai->id) {
997 case WSA_MACRO_AIF_VI:
998 *tx_slot = wsa->active_ch_mask[dai->id];
999 *tx_num = wsa->active_ch_cnt[dai->id];
1000 break;
1001 case WSA_MACRO_AIF1_PB:
1002 case WSA_MACRO_AIF_MIX1_PB:
1003 for_each_set_bit(temp, &wsa->active_ch_mask[dai->id],
1004 WSA_MACRO_RX_MAX) {
1005 mask |= (1 << temp);
1006 if (++cnt == WSA_MACRO_MAX_DMA_CH_PER_PORT)
1007 break;
1008 }
1009 if (mask & 0x0C)
1010 mask = mask >> 0x2;
1011 *rx_slot = mask;
1012 *rx_num = cnt;
1013 break;
1014 case WSA_MACRO_AIF_ECHO:
1015 val = snd_soc_component_read(component, CDC_WSA_RX_INP_MUX_RX_MIX_CFG0);
1016 if (val & WSA_MACRO_EC_MIX_TX1_MASK) {
1017 mask |= 0x2;
1018 cnt++;
1019 }
1020 if (val & WSA_MACRO_EC_MIX_TX0_MASK) {
1021 mask |= 0x1;
1022 cnt++;
1023 }
1024 *tx_slot = mask;
1025 *tx_num = cnt;
1026 break;
1027 default:
1028 dev_err(component->dev, "%s: Invalid AIF\n", __func__);
1029 break;
1030 }
1031 return 0;
1032 }
1033
1034 static const struct snd_soc_dai_ops wsa_macro_dai_ops = {
1035 .hw_params = wsa_macro_hw_params,
1036 .get_channel_map = wsa_macro_get_channel_map,
1037 };
1038
1039 static struct snd_soc_dai_driver wsa_macro_dai[] = {
1040 {
1041 .name = "wsa_macro_rx1",
1042 .id = WSA_MACRO_AIF1_PB,
1043 .playback = {
1044 .stream_name = "WSA_AIF1 Playback",
1045 .rates = WSA_MACRO_RX_RATES,
1046 .formats = WSA_MACRO_RX_FORMATS,
1047 .rate_max = 384000,
1048 .rate_min = 8000,
1049 .channels_min = 1,
1050 .channels_max = 2,
1051 },
1052 .ops = &wsa_macro_dai_ops,
1053 },
1054 {
1055 .name = "wsa_macro_rx_mix",
1056 .id = WSA_MACRO_AIF_MIX1_PB,
1057 .playback = {
1058 .stream_name = "WSA_AIF_MIX1 Playback",
1059 .rates = WSA_MACRO_RX_MIX_RATES,
1060 .formats = WSA_MACRO_RX_FORMATS,
1061 .rate_max = 192000,
1062 .rate_min = 48000,
1063 .channels_min = 1,
1064 .channels_max = 2,
1065 },
1066 .ops = &wsa_macro_dai_ops,
1067 },
1068 {
1069 .name = "wsa_macro_vifeedback",
1070 .id = WSA_MACRO_AIF_VI,
1071 .capture = {
1072 .stream_name = "WSA_AIF_VI Capture",
1073 .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_48000,
1074 .formats = WSA_MACRO_RX_FORMATS,
1075 .rate_max = 48000,
1076 .rate_min = 8000,
1077 .channels_min = 1,
1078 .channels_max = 4,
1079 },
1080 .ops = &wsa_macro_dai_ops,
1081 },
1082 {
1083 .name = "wsa_macro_echo",
1084 .id = WSA_MACRO_AIF_ECHO,
1085 .capture = {
1086 .stream_name = "WSA_AIF_ECHO Capture",
1087 .rates = WSA_MACRO_ECHO_RATES,
1088 .formats = WSA_MACRO_ECHO_FORMATS,
1089 .rate_max = 48000,
1090 .rate_min = 8000,
1091 .channels_min = 1,
1092 .channels_max = 2,
1093 },
1094 .ops = &wsa_macro_dai_ops,
1095 },
1096 };
1097
wsa_macro_mclk_enable(struct wsa_macro * wsa,bool mclk_enable)1098 static void wsa_macro_mclk_enable(struct wsa_macro *wsa, bool mclk_enable)
1099 {
1100 struct regmap *regmap = wsa->regmap;
1101
1102 if (mclk_enable) {
1103 if (wsa->wsa_mclk_users == 0) {
1104 regcache_mark_dirty(regmap);
1105 regcache_sync(regmap);
1106 /* 9.6MHz MCLK, set value 0x00 if other frequency */
1107 regmap_update_bits(regmap, CDC_WSA_TOP_FREQ_MCLK, 0x01, 0x01);
1108 regmap_update_bits(regmap,
1109 CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL,
1110 CDC_WSA_MCLK_EN_MASK,
1111 CDC_WSA_MCLK_ENABLE);
1112 regmap_update_bits(regmap,
1113 CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL,
1114 CDC_WSA_FS_CNT_EN_MASK,
1115 CDC_WSA_FS_CNT_ENABLE);
1116 }
1117 wsa->wsa_mclk_users++;
1118 } else {
1119 if (wsa->wsa_mclk_users <= 0) {
1120 dev_err(wsa->dev, "clock already disabled\n");
1121 wsa->wsa_mclk_users = 0;
1122 return;
1123 }
1124 wsa->wsa_mclk_users--;
1125 if (wsa->wsa_mclk_users == 0) {
1126 regmap_update_bits(regmap,
1127 CDC_WSA_CLK_RST_CTRL_FS_CNT_CONTROL,
1128 CDC_WSA_FS_CNT_EN_MASK,
1129 CDC_WSA_FS_CNT_DISABLE);
1130 regmap_update_bits(regmap,
1131 CDC_WSA_CLK_RST_CTRL_MCLK_CONTROL,
1132 CDC_WSA_MCLK_EN_MASK,
1133 CDC_WSA_MCLK_DISABLE);
1134 }
1135 }
1136 }
1137
wsa_macro_mclk_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1138 static int wsa_macro_mclk_event(struct snd_soc_dapm_widget *w,
1139 struct snd_kcontrol *kcontrol, int event)
1140 {
1141 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1142 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1143
1144 wsa_macro_mclk_enable(wsa, event == SND_SOC_DAPM_PRE_PMU);
1145 return 0;
1146 }
1147
wsa_macro_enable_vi_feedback(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1148 static int wsa_macro_enable_vi_feedback(struct snd_soc_dapm_widget *w,
1149 struct snd_kcontrol *kcontrol,
1150 int event)
1151 {
1152 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1153 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1154 u32 tx_reg0, tx_reg1;
1155
1156 if (test_bit(WSA_MACRO_TX0, &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) {
1157 tx_reg0 = CDC_WSA_TX0_SPKR_PROT_PATH_CTL;
1158 tx_reg1 = CDC_WSA_TX1_SPKR_PROT_PATH_CTL;
1159 } else if (test_bit(WSA_MACRO_TX1, &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) {
1160 tx_reg0 = CDC_WSA_TX2_SPKR_PROT_PATH_CTL;
1161 tx_reg1 = CDC_WSA_TX3_SPKR_PROT_PATH_CTL;
1162 }
1163
1164 switch (event) {
1165 case SND_SOC_DAPM_POST_PMU:
1166 /* Enable V&I sensing */
1167 snd_soc_component_update_bits(component, tx_reg0,
1168 CDC_WSA_TX_SPKR_PROT_RESET_MASK,
1169 CDC_WSA_TX_SPKR_PROT_RESET);
1170 snd_soc_component_update_bits(component, tx_reg1,
1171 CDC_WSA_TX_SPKR_PROT_RESET_MASK,
1172 CDC_WSA_TX_SPKR_PROT_RESET);
1173 snd_soc_component_update_bits(component, tx_reg0,
1174 CDC_WSA_TX_SPKR_PROT_PCM_RATE_MASK,
1175 CDC_WSA_TX_SPKR_PROT_PCM_RATE_8K);
1176 snd_soc_component_update_bits(component, tx_reg1,
1177 CDC_WSA_TX_SPKR_PROT_PCM_RATE_MASK,
1178 CDC_WSA_TX_SPKR_PROT_PCM_RATE_8K);
1179 snd_soc_component_update_bits(component, tx_reg0,
1180 CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK,
1181 CDC_WSA_TX_SPKR_PROT_CLK_ENABLE);
1182 snd_soc_component_update_bits(component, tx_reg1,
1183 CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK,
1184 CDC_WSA_TX_SPKR_PROT_CLK_ENABLE);
1185 snd_soc_component_update_bits(component, tx_reg0,
1186 CDC_WSA_TX_SPKR_PROT_RESET_MASK,
1187 CDC_WSA_TX_SPKR_PROT_NO_RESET);
1188 snd_soc_component_update_bits(component, tx_reg1,
1189 CDC_WSA_TX_SPKR_PROT_RESET_MASK,
1190 CDC_WSA_TX_SPKR_PROT_NO_RESET);
1191 break;
1192 case SND_SOC_DAPM_POST_PMD:
1193 /* Disable V&I sensing */
1194 snd_soc_component_update_bits(component, tx_reg0,
1195 CDC_WSA_TX_SPKR_PROT_RESET_MASK,
1196 CDC_WSA_TX_SPKR_PROT_RESET);
1197 snd_soc_component_update_bits(component, tx_reg1,
1198 CDC_WSA_TX_SPKR_PROT_RESET_MASK,
1199 CDC_WSA_TX_SPKR_PROT_RESET);
1200 snd_soc_component_update_bits(component, tx_reg0,
1201 CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK,
1202 CDC_WSA_TX_SPKR_PROT_CLK_DISABLE);
1203 snd_soc_component_update_bits(component, tx_reg1,
1204 CDC_WSA_TX_SPKR_PROT_CLK_EN_MASK,
1205 CDC_WSA_TX_SPKR_PROT_CLK_DISABLE);
1206 break;
1207 }
1208
1209 return 0;
1210 }
1211
wsa_macro_enable_mix_path(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1212 static int wsa_macro_enable_mix_path(struct snd_soc_dapm_widget *w,
1213 struct snd_kcontrol *kcontrol, int event)
1214 {
1215 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1216 u16 path_reg, gain_reg;
1217 int val;
1218
1219 switch (w->shift) {
1220 case WSA_MACRO_RX_MIX0:
1221 path_reg = CDC_WSA_RX0_RX_PATH_MIX_CTL;
1222 gain_reg = CDC_WSA_RX0_RX_VOL_MIX_CTL;
1223 break;
1224 case WSA_MACRO_RX_MIX1:
1225 path_reg = CDC_WSA_RX1_RX_PATH_MIX_CTL;
1226 gain_reg = CDC_WSA_RX1_RX_VOL_MIX_CTL;
1227 break;
1228 default:
1229 return 0;
1230 }
1231
1232 switch (event) {
1233 case SND_SOC_DAPM_POST_PMU:
1234 val = snd_soc_component_read(component, gain_reg);
1235 snd_soc_component_write(component, gain_reg, val);
1236 break;
1237 case SND_SOC_DAPM_POST_PMD:
1238 snd_soc_component_update_bits(component, path_reg,
1239 CDC_WSA_RX_PATH_MIX_CLK_EN_MASK,
1240 CDC_WSA_RX_PATH_MIX_CLK_DISABLE);
1241 break;
1242 }
1243
1244 return 0;
1245 }
1246
wsa_macro_hd2_control(struct snd_soc_component * component,u16 reg,int event)1247 static void wsa_macro_hd2_control(struct snd_soc_component *component,
1248 u16 reg, int event)
1249 {
1250 u16 hd2_scale_reg;
1251 u16 hd2_enable_reg;
1252
1253 if (reg == CDC_WSA_RX0_RX_PATH_CTL) {
1254 hd2_scale_reg = CDC_WSA_RX0_RX_PATH_SEC3;
1255 hd2_enable_reg = CDC_WSA_RX0_RX_PATH_CFG0;
1256 }
1257 if (reg == CDC_WSA_RX1_RX_PATH_CTL) {
1258 hd2_scale_reg = CDC_WSA_RX1_RX_PATH_SEC3;
1259 hd2_enable_reg = CDC_WSA_RX1_RX_PATH_CFG0;
1260 }
1261
1262 if (hd2_enable_reg && SND_SOC_DAPM_EVENT_ON(event)) {
1263 snd_soc_component_update_bits(component, hd2_scale_reg,
1264 CDC_WSA_RX_PATH_HD2_ALPHA_MASK,
1265 0x10);
1266 snd_soc_component_update_bits(component, hd2_scale_reg,
1267 CDC_WSA_RX_PATH_HD2_SCALE_MASK,
1268 0x1);
1269 snd_soc_component_update_bits(component, hd2_enable_reg,
1270 CDC_WSA_RX_PATH_HD2_EN_MASK,
1271 CDC_WSA_RX_PATH_HD2_ENABLE);
1272 }
1273
1274 if (hd2_enable_reg && SND_SOC_DAPM_EVENT_OFF(event)) {
1275 snd_soc_component_update_bits(component, hd2_enable_reg,
1276 CDC_WSA_RX_PATH_HD2_EN_MASK, 0);
1277 snd_soc_component_update_bits(component, hd2_scale_reg,
1278 CDC_WSA_RX_PATH_HD2_SCALE_MASK,
1279 0);
1280 snd_soc_component_update_bits(component, hd2_scale_reg,
1281 CDC_WSA_RX_PATH_HD2_ALPHA_MASK,
1282 0);
1283 }
1284 }
1285
wsa_macro_config_compander(struct snd_soc_component * component,int comp,int event)1286 static int wsa_macro_config_compander(struct snd_soc_component *component,
1287 int comp, int event)
1288 {
1289 u16 comp_ctl0_reg, rx_path_cfg0_reg;
1290 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1291
1292 if (!wsa->comp_enabled[comp])
1293 return 0;
1294
1295 comp_ctl0_reg = CDC_WSA_COMPANDER0_CTL0 +
1296 (comp * WSA_MACRO_RX_COMP_OFFSET);
1297 rx_path_cfg0_reg = CDC_WSA_RX0_RX_PATH_CFG0 +
1298 (comp * WSA_MACRO_RX_PATH_OFFSET);
1299
1300 if (SND_SOC_DAPM_EVENT_ON(event)) {
1301 /* Enable Compander Clock */
1302 snd_soc_component_update_bits(component, comp_ctl0_reg,
1303 CDC_WSA_COMPANDER_CLK_EN_MASK,
1304 CDC_WSA_COMPANDER_CLK_ENABLE);
1305 snd_soc_component_update_bits(component, comp_ctl0_reg,
1306 CDC_WSA_COMPANDER_SOFT_RST_MASK,
1307 CDC_WSA_COMPANDER_SOFT_RST_ENABLE);
1308 snd_soc_component_update_bits(component, comp_ctl0_reg,
1309 CDC_WSA_COMPANDER_SOFT_RST_MASK,
1310 0);
1311 snd_soc_component_update_bits(component, rx_path_cfg0_reg,
1312 CDC_WSA_RX_PATH_COMP_EN_MASK,
1313 CDC_WSA_RX_PATH_COMP_ENABLE);
1314 }
1315
1316 if (SND_SOC_DAPM_EVENT_OFF(event)) {
1317 snd_soc_component_update_bits(component, comp_ctl0_reg,
1318 CDC_WSA_COMPANDER_HALT_MASK,
1319 CDC_WSA_COMPANDER_HALT);
1320 snd_soc_component_update_bits(component, rx_path_cfg0_reg,
1321 CDC_WSA_RX_PATH_COMP_EN_MASK, 0);
1322 snd_soc_component_update_bits(component, comp_ctl0_reg,
1323 CDC_WSA_COMPANDER_SOFT_RST_MASK,
1324 CDC_WSA_COMPANDER_SOFT_RST_ENABLE);
1325 snd_soc_component_update_bits(component, comp_ctl0_reg,
1326 CDC_WSA_COMPANDER_SOFT_RST_MASK,
1327 0);
1328 snd_soc_component_update_bits(component, comp_ctl0_reg,
1329 CDC_WSA_COMPANDER_CLK_EN_MASK, 0);
1330 snd_soc_component_update_bits(component, comp_ctl0_reg,
1331 CDC_WSA_COMPANDER_HALT_MASK, 0);
1332 }
1333
1334 return 0;
1335 }
1336
wsa_macro_enable_softclip_clk(struct snd_soc_component * component,struct wsa_macro * wsa,int path,bool enable)1337 static void wsa_macro_enable_softclip_clk(struct snd_soc_component *component,
1338 struct wsa_macro *wsa,
1339 int path,
1340 bool enable)
1341 {
1342 u16 softclip_clk_reg = CDC_WSA_SOFTCLIP0_CRC +
1343 (path * WSA_MACRO_RX_SOFTCLIP_OFFSET);
1344 u8 softclip_mux_mask = (1 << path);
1345 u8 softclip_mux_value = (1 << path);
1346
1347 if (enable) {
1348 if (wsa->softclip_clk_users[path] == 0) {
1349 snd_soc_component_update_bits(component,
1350 softclip_clk_reg,
1351 CDC_WSA_SOFTCLIP_CLK_EN_MASK,
1352 CDC_WSA_SOFTCLIP_CLK_ENABLE);
1353 snd_soc_component_update_bits(component,
1354 CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0,
1355 softclip_mux_mask, softclip_mux_value);
1356 }
1357 wsa->softclip_clk_users[path]++;
1358 } else {
1359 wsa->softclip_clk_users[path]--;
1360 if (wsa->softclip_clk_users[path] == 0) {
1361 snd_soc_component_update_bits(component,
1362 softclip_clk_reg,
1363 CDC_WSA_SOFTCLIP_CLK_EN_MASK,
1364 0);
1365 snd_soc_component_update_bits(component,
1366 CDC_WSA_RX_INP_MUX_SOFTCLIP_CFG0,
1367 softclip_mux_mask, 0x00);
1368 }
1369 }
1370 }
1371
wsa_macro_config_softclip(struct snd_soc_component * component,int path,int event)1372 static int wsa_macro_config_softclip(struct snd_soc_component *component,
1373 int path, int event)
1374 {
1375 u16 softclip_ctrl_reg;
1376 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1377 int softclip_path = 0;
1378
1379 if (path == WSA_MACRO_COMP1)
1380 softclip_path = WSA_MACRO_SOFTCLIP0;
1381 else if (path == WSA_MACRO_COMP2)
1382 softclip_path = WSA_MACRO_SOFTCLIP1;
1383
1384 if (!wsa->is_softclip_on[softclip_path])
1385 return 0;
1386
1387 softclip_ctrl_reg = CDC_WSA_SOFTCLIP0_SOFTCLIP_CTRL +
1388 (softclip_path * WSA_MACRO_RX_SOFTCLIP_OFFSET);
1389
1390 if (SND_SOC_DAPM_EVENT_ON(event)) {
1391 /* Enable Softclip clock and mux */
1392 wsa_macro_enable_softclip_clk(component, wsa, softclip_path,
1393 true);
1394 /* Enable Softclip control */
1395 snd_soc_component_update_bits(component, softclip_ctrl_reg,
1396 CDC_WSA_SOFTCLIP_EN_MASK,
1397 CDC_WSA_SOFTCLIP_ENABLE);
1398 }
1399
1400 if (SND_SOC_DAPM_EVENT_OFF(event)) {
1401 snd_soc_component_update_bits(component, softclip_ctrl_reg,
1402 CDC_WSA_SOFTCLIP_EN_MASK, 0);
1403 wsa_macro_enable_softclip_clk(component, wsa, softclip_path,
1404 false);
1405 }
1406
1407 return 0;
1408 }
1409
wsa_macro_adie_lb(struct snd_soc_component * component,int interp_idx)1410 static bool wsa_macro_adie_lb(struct snd_soc_component *component,
1411 int interp_idx)
1412 {
1413 u16 int_mux_cfg0, int_mux_cfg1;
1414 u8 int_n_inp0, int_n_inp1, int_n_inp2;
1415
1416 int_mux_cfg0 = CDC_WSA_RX_INP_MUX_RX_INT0_CFG0 + interp_idx * 8;
1417 int_mux_cfg1 = int_mux_cfg0 + 4;
1418
1419 int_n_inp0 = snd_soc_component_read_field(component, int_mux_cfg0,
1420 CDC_WSA_RX_INTX_1_MIX_INP0_SEL_MASK);
1421 if (int_n_inp0 == INTn_1_INP_SEL_DEC0 ||
1422 int_n_inp0 == INTn_1_INP_SEL_DEC1)
1423 return true;
1424
1425 int_n_inp1 = snd_soc_component_read_field(component, int_mux_cfg0,
1426 CDC_WSA_RX_INTX_1_MIX_INP1_SEL_MASK);
1427 if (int_n_inp1 == INTn_1_INP_SEL_DEC0 ||
1428 int_n_inp1 == INTn_1_INP_SEL_DEC1)
1429 return true;
1430
1431 int_n_inp2 = snd_soc_component_read_field(component, int_mux_cfg1,
1432 CDC_WSA_RX_INTX_1_MIX_INP2_SEL_MASK);
1433 if (int_n_inp2 == INTn_1_INP_SEL_DEC0 ||
1434 int_n_inp2 == INTn_1_INP_SEL_DEC1)
1435 return true;
1436
1437 return false;
1438 }
1439
wsa_macro_enable_main_path(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1440 static int wsa_macro_enable_main_path(struct snd_soc_dapm_widget *w,
1441 struct snd_kcontrol *kcontrol,
1442 int event)
1443 {
1444 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1445 u16 reg;
1446
1447 reg = CDC_WSA_RX0_RX_PATH_CTL + WSA_MACRO_RX_PATH_OFFSET * w->shift;
1448 switch (event) {
1449 case SND_SOC_DAPM_PRE_PMU:
1450 if (wsa_macro_adie_lb(component, w->shift)) {
1451 snd_soc_component_update_bits(component, reg,
1452 CDC_WSA_RX_PATH_CLK_EN_MASK,
1453 CDC_WSA_RX_PATH_CLK_ENABLE);
1454 }
1455 break;
1456 default:
1457 break;
1458 }
1459 return 0;
1460 }
1461
wsa_macro_interp_get_primary_reg(u16 reg,u16 * ind)1462 static int wsa_macro_interp_get_primary_reg(u16 reg, u16 *ind)
1463 {
1464 u16 prim_int_reg = 0;
1465
1466 switch (reg) {
1467 case CDC_WSA_RX0_RX_PATH_CTL:
1468 case CDC_WSA_RX0_RX_PATH_MIX_CTL:
1469 prim_int_reg = CDC_WSA_RX0_RX_PATH_CTL;
1470 *ind = 0;
1471 break;
1472 case CDC_WSA_RX1_RX_PATH_CTL:
1473 case CDC_WSA_RX1_RX_PATH_MIX_CTL:
1474 prim_int_reg = CDC_WSA_RX1_RX_PATH_CTL;
1475 *ind = 1;
1476 break;
1477 }
1478
1479 return prim_int_reg;
1480 }
1481
wsa_macro_enable_prim_interpolator(struct snd_soc_component * component,u16 reg,int event)1482 static int wsa_macro_enable_prim_interpolator(struct snd_soc_component *component,
1483 u16 reg, int event)
1484 {
1485 u16 prim_int_reg;
1486 u16 ind = 0;
1487 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1488
1489 prim_int_reg = wsa_macro_interp_get_primary_reg(reg, &ind);
1490
1491 switch (event) {
1492 case SND_SOC_DAPM_PRE_PMU:
1493 wsa->prim_int_users[ind]++;
1494 if (wsa->prim_int_users[ind] == 1) {
1495 snd_soc_component_update_bits(component,
1496 prim_int_reg + WSA_MACRO_RX_PATH_CFG3_OFFSET,
1497 CDC_WSA_RX_DC_DCOEFF_MASK,
1498 0x3);
1499 snd_soc_component_update_bits(component, prim_int_reg,
1500 CDC_WSA_RX_PATH_PGA_MUTE_EN_MASK,
1501 CDC_WSA_RX_PATH_PGA_MUTE_ENABLE);
1502 wsa_macro_hd2_control(component, prim_int_reg, event);
1503 snd_soc_component_update_bits(component,
1504 prim_int_reg + WSA_MACRO_RX_PATH_DSMDEM_OFFSET,
1505 CDC_WSA_RX_DSMDEM_CLK_EN_MASK,
1506 CDC_WSA_RX_DSMDEM_CLK_ENABLE);
1507 }
1508 if ((reg != prim_int_reg) &&
1509 ((snd_soc_component_read(
1510 component, prim_int_reg)) & 0x10))
1511 snd_soc_component_update_bits(component, reg,
1512 0x10, 0x10);
1513 break;
1514 case SND_SOC_DAPM_POST_PMD:
1515 wsa->prim_int_users[ind]--;
1516 if (wsa->prim_int_users[ind] == 0) {
1517 snd_soc_component_update_bits(component,
1518 prim_int_reg + WSA_MACRO_RX_PATH_DSMDEM_OFFSET,
1519 CDC_WSA_RX_DSMDEM_CLK_EN_MASK, 0);
1520 wsa_macro_hd2_control(component, prim_int_reg, event);
1521 }
1522 break;
1523 }
1524
1525 return 0;
1526 }
1527
wsa_macro_config_ear_spkr_gain(struct snd_soc_component * component,struct wsa_macro * wsa,int event,int gain_reg)1528 static int wsa_macro_config_ear_spkr_gain(struct snd_soc_component *component,
1529 struct wsa_macro *wsa,
1530 int event, int gain_reg)
1531 {
1532 int comp_gain_offset, val;
1533
1534 switch (wsa->spkr_mode) {
1535 /* Compander gain in WSA_MACRO_SPKR_MODE1 case is 12 dB */
1536 case WSA_MACRO_SPKR_MODE_1:
1537 comp_gain_offset = -12;
1538 break;
1539 /* Default case compander gain is 15 dB */
1540 default:
1541 comp_gain_offset = -15;
1542 break;
1543 }
1544
1545 switch (event) {
1546 case SND_SOC_DAPM_POST_PMU:
1547 /* Apply ear spkr gain only if compander is enabled */
1548 if (wsa->comp_enabled[WSA_MACRO_COMP1] &&
1549 (gain_reg == CDC_WSA_RX0_RX_VOL_CTL) &&
1550 (wsa->ear_spkr_gain != 0)) {
1551 /* For example, val is -8(-12+5-1) for 4dB of gain */
1552 val = comp_gain_offset + wsa->ear_spkr_gain - 1;
1553 snd_soc_component_write(component, gain_reg, val);
1554 }
1555 break;
1556 case SND_SOC_DAPM_POST_PMD:
1557 /*
1558 * Reset RX0 volume to 0 dB if compander is enabled and
1559 * ear_spkr_gain is non-zero.
1560 */
1561 if (wsa->comp_enabled[WSA_MACRO_COMP1] &&
1562 (gain_reg == CDC_WSA_RX0_RX_VOL_CTL) &&
1563 (wsa->ear_spkr_gain != 0)) {
1564 snd_soc_component_write(component, gain_reg, 0x0);
1565 }
1566 break;
1567 }
1568
1569 return 0;
1570 }
1571
wsa_macro_enable_interpolator(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1572 static int wsa_macro_enable_interpolator(struct snd_soc_dapm_widget *w,
1573 struct snd_kcontrol *kcontrol,
1574 int event)
1575 {
1576 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1577 u16 gain_reg;
1578 u16 reg;
1579 int val;
1580 int offset_val = 0;
1581 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1582
1583 if (w->shift == WSA_MACRO_COMP1) {
1584 reg = CDC_WSA_RX0_RX_PATH_CTL;
1585 gain_reg = CDC_WSA_RX0_RX_VOL_CTL;
1586 } else if (w->shift == WSA_MACRO_COMP2) {
1587 reg = CDC_WSA_RX1_RX_PATH_CTL;
1588 gain_reg = CDC_WSA_RX1_RX_VOL_CTL;
1589 }
1590
1591 switch (event) {
1592 case SND_SOC_DAPM_PRE_PMU:
1593 /* Reset if needed */
1594 wsa_macro_enable_prim_interpolator(component, reg, event);
1595 break;
1596 case SND_SOC_DAPM_POST_PMU:
1597 wsa_macro_config_compander(component, w->shift, event);
1598 wsa_macro_config_softclip(component, w->shift, event);
1599 /* apply gain after int clk is enabled */
1600 if ((wsa->spkr_gain_offset == WSA_MACRO_GAIN_OFFSET_M1P5_DB) &&
1601 (wsa->comp_enabled[WSA_MACRO_COMP1] ||
1602 wsa->comp_enabled[WSA_MACRO_COMP2])) {
1603 snd_soc_component_update_bits(component,
1604 CDC_WSA_RX0_RX_PATH_SEC1,
1605 CDC_WSA_RX_PGA_HALF_DB_MASK,
1606 CDC_WSA_RX_PGA_HALF_DB_ENABLE);
1607 snd_soc_component_update_bits(component,
1608 CDC_WSA_RX0_RX_PATH_MIX_SEC0,
1609 CDC_WSA_RX_PGA_HALF_DB_MASK,
1610 CDC_WSA_RX_PGA_HALF_DB_ENABLE);
1611 snd_soc_component_update_bits(component,
1612 CDC_WSA_RX1_RX_PATH_SEC1,
1613 CDC_WSA_RX_PGA_HALF_DB_MASK,
1614 CDC_WSA_RX_PGA_HALF_DB_ENABLE);
1615 snd_soc_component_update_bits(component,
1616 CDC_WSA_RX1_RX_PATH_MIX_SEC0,
1617 CDC_WSA_RX_PGA_HALF_DB_MASK,
1618 CDC_WSA_RX_PGA_HALF_DB_ENABLE);
1619 offset_val = -2;
1620 }
1621 val = snd_soc_component_read(component, gain_reg);
1622 val += offset_val;
1623 snd_soc_component_write(component, gain_reg, val);
1624 wsa_macro_config_ear_spkr_gain(component, wsa,
1625 event, gain_reg);
1626 break;
1627 case SND_SOC_DAPM_POST_PMD:
1628 wsa_macro_config_compander(component, w->shift, event);
1629 wsa_macro_config_softclip(component, w->shift, event);
1630 wsa_macro_enable_prim_interpolator(component, reg, event);
1631 if ((wsa->spkr_gain_offset == WSA_MACRO_GAIN_OFFSET_M1P5_DB) &&
1632 (wsa->comp_enabled[WSA_MACRO_COMP1] ||
1633 wsa->comp_enabled[WSA_MACRO_COMP2])) {
1634 snd_soc_component_update_bits(component,
1635 CDC_WSA_RX0_RX_PATH_SEC1,
1636 CDC_WSA_RX_PGA_HALF_DB_MASK,
1637 CDC_WSA_RX_PGA_HALF_DB_DISABLE);
1638 snd_soc_component_update_bits(component,
1639 CDC_WSA_RX0_RX_PATH_MIX_SEC0,
1640 CDC_WSA_RX_PGA_HALF_DB_MASK,
1641 CDC_WSA_RX_PGA_HALF_DB_DISABLE);
1642 snd_soc_component_update_bits(component,
1643 CDC_WSA_RX1_RX_PATH_SEC1,
1644 CDC_WSA_RX_PGA_HALF_DB_MASK,
1645 CDC_WSA_RX_PGA_HALF_DB_DISABLE);
1646 snd_soc_component_update_bits(component,
1647 CDC_WSA_RX1_RX_PATH_MIX_SEC0,
1648 CDC_WSA_RX_PGA_HALF_DB_MASK,
1649 CDC_WSA_RX_PGA_HALF_DB_DISABLE);
1650 offset_val = 2;
1651 val = snd_soc_component_read(component, gain_reg);
1652 val += offset_val;
1653 snd_soc_component_write(component, gain_reg, val);
1654 }
1655 wsa_macro_config_ear_spkr_gain(component, wsa,
1656 event, gain_reg);
1657 break;
1658 }
1659
1660 return 0;
1661 }
1662
wsa_macro_spk_boost_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1663 static int wsa_macro_spk_boost_event(struct snd_soc_dapm_widget *w,
1664 struct snd_kcontrol *kcontrol,
1665 int event)
1666 {
1667 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1668 u16 boost_path_ctl, boost_path_cfg1;
1669 u16 reg, reg_mix;
1670
1671 if (!strcmp(w->name, "WSA_RX INT0 CHAIN")) {
1672 boost_path_ctl = CDC_WSA_BOOST0_BOOST_PATH_CTL;
1673 boost_path_cfg1 = CDC_WSA_RX0_RX_PATH_CFG1;
1674 reg = CDC_WSA_RX0_RX_PATH_CTL;
1675 reg_mix = CDC_WSA_RX0_RX_PATH_MIX_CTL;
1676 } else if (!strcmp(w->name, "WSA_RX INT1 CHAIN")) {
1677 boost_path_ctl = CDC_WSA_BOOST1_BOOST_PATH_CTL;
1678 boost_path_cfg1 = CDC_WSA_RX1_RX_PATH_CFG1;
1679 reg = CDC_WSA_RX1_RX_PATH_CTL;
1680 reg_mix = CDC_WSA_RX1_RX_PATH_MIX_CTL;
1681 }
1682
1683 switch (event) {
1684 case SND_SOC_DAPM_PRE_PMU:
1685 snd_soc_component_update_bits(component, boost_path_cfg1,
1686 CDC_WSA_RX_PATH_SMART_BST_EN_MASK,
1687 CDC_WSA_RX_PATH_SMART_BST_ENABLE);
1688 snd_soc_component_update_bits(component, boost_path_ctl,
1689 CDC_WSA_BOOST_PATH_CLK_EN_MASK,
1690 CDC_WSA_BOOST_PATH_CLK_ENABLE);
1691 if ((snd_soc_component_read(component, reg_mix)) & 0x10)
1692 snd_soc_component_update_bits(component, reg_mix,
1693 0x10, 0x00);
1694 break;
1695 case SND_SOC_DAPM_POST_PMU:
1696 snd_soc_component_update_bits(component, reg, 0x10, 0x00);
1697 break;
1698 case SND_SOC_DAPM_POST_PMD:
1699 snd_soc_component_update_bits(component, boost_path_ctl,
1700 CDC_WSA_BOOST_PATH_CLK_EN_MASK,
1701 CDC_WSA_BOOST_PATH_CLK_DISABLE);
1702 snd_soc_component_update_bits(component, boost_path_cfg1,
1703 CDC_WSA_RX_PATH_SMART_BST_EN_MASK,
1704 CDC_WSA_RX_PATH_SMART_BST_DISABLE);
1705 break;
1706 }
1707
1708 return 0;
1709 }
1710
wsa_macro_enable_echo(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1711 static int wsa_macro_enable_echo(struct snd_soc_dapm_widget *w,
1712 struct snd_kcontrol *kcontrol,
1713 int event)
1714 {
1715 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1716 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1717 u16 val, ec_tx, ec_hq_reg;
1718
1719 val = snd_soc_component_read(component, CDC_WSA_RX_INP_MUX_RX_MIX_CFG0);
1720
1721 switch (w->shift) {
1722 case WSA_MACRO_EC0_MUX:
1723 val = val & CDC_WSA_RX_MIX_TX0_SEL_MASK;
1724 ec_tx = val - 1;
1725 break;
1726 case WSA_MACRO_EC1_MUX:
1727 val = val & CDC_WSA_RX_MIX_TX1_SEL_MASK;
1728 ec_tx = (val >> CDC_WSA_RX_MIX_TX1_SEL_SHFT) - 1;
1729 break;
1730 }
1731
1732 if (wsa->ec_hq[ec_tx]) {
1733 ec_hq_reg = CDC_WSA_EC_HQ0_EC_REF_HQ_PATH_CTL + 0x40 * ec_tx;
1734 snd_soc_component_update_bits(component, ec_hq_reg,
1735 CDC_WSA_EC_HQ_EC_CLK_EN_MASK,
1736 CDC_WSA_EC_HQ_EC_CLK_ENABLE);
1737 ec_hq_reg = CDC_WSA_EC_HQ0_EC_REF_HQ_CFG0 + 0x40 * ec_tx;
1738 /* default set to 48k */
1739 snd_soc_component_update_bits(component, ec_hq_reg,
1740 CDC_WSA_EC_HQ_EC_REF_PCM_RATE_MASK,
1741 CDC_WSA_EC_HQ_EC_REF_PCM_RATE_48K);
1742 }
1743
1744 return 0;
1745 }
1746
wsa_macro_get_ec_hq(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1747 static int wsa_macro_get_ec_hq(struct snd_kcontrol *kcontrol,
1748 struct snd_ctl_elem_value *ucontrol)
1749 {
1750
1751 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1752 int ec_tx = ((struct soc_mixer_control *) kcontrol->private_value)->shift;
1753 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1754
1755 ucontrol->value.integer.value[0] = wsa->ec_hq[ec_tx];
1756
1757 return 0;
1758 }
1759
wsa_macro_set_ec_hq(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1760 static int wsa_macro_set_ec_hq(struct snd_kcontrol *kcontrol,
1761 struct snd_ctl_elem_value *ucontrol)
1762 {
1763 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1764 int ec_tx = ((struct soc_mixer_control *) kcontrol->private_value)->shift;
1765 int value = ucontrol->value.integer.value[0];
1766 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1767
1768 wsa->ec_hq[ec_tx] = value;
1769
1770 return 0;
1771 }
1772
wsa_macro_get_compander(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1773 static int wsa_macro_get_compander(struct snd_kcontrol *kcontrol,
1774 struct snd_ctl_elem_value *ucontrol)
1775 {
1776
1777 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1778 int comp = ((struct soc_mixer_control *) kcontrol->private_value)->shift;
1779 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1780
1781 ucontrol->value.integer.value[0] = wsa->comp_enabled[comp];
1782 return 0;
1783 }
1784
wsa_macro_set_compander(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1785 static int wsa_macro_set_compander(struct snd_kcontrol *kcontrol,
1786 struct snd_ctl_elem_value *ucontrol)
1787 {
1788 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1789 int comp = ((struct soc_mixer_control *) kcontrol->private_value)->shift;
1790 int value = ucontrol->value.integer.value[0];
1791 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1792
1793 wsa->comp_enabled[comp] = value;
1794
1795 return 0;
1796 }
1797
wsa_macro_ear_spkr_pa_gain_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1798 static int wsa_macro_ear_spkr_pa_gain_get(struct snd_kcontrol *kcontrol,
1799 struct snd_ctl_elem_value *ucontrol)
1800 {
1801 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1802 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1803
1804 ucontrol->value.integer.value[0] = wsa->ear_spkr_gain;
1805
1806 return 0;
1807 }
1808
wsa_macro_ear_spkr_pa_gain_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1809 static int wsa_macro_ear_spkr_pa_gain_put(struct snd_kcontrol *kcontrol,
1810 struct snd_ctl_elem_value *ucontrol)
1811 {
1812 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1813 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1814
1815 wsa->ear_spkr_gain = ucontrol->value.integer.value[0];
1816
1817 return 0;
1818 }
1819
wsa_macro_rx_mux_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1820 static int wsa_macro_rx_mux_get(struct snd_kcontrol *kcontrol,
1821 struct snd_ctl_elem_value *ucontrol)
1822 {
1823 struct snd_soc_dapm_widget *widget =
1824 snd_soc_dapm_kcontrol_widget(kcontrol);
1825 struct snd_soc_component *component =
1826 snd_soc_dapm_to_component(widget->dapm);
1827 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1828
1829 ucontrol->value.integer.value[0] =
1830 wsa->rx_port_value[widget->shift];
1831 return 0;
1832 }
1833
wsa_macro_rx_mux_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1834 static int wsa_macro_rx_mux_put(struct snd_kcontrol *kcontrol,
1835 struct snd_ctl_elem_value *ucontrol)
1836 {
1837 struct snd_soc_dapm_widget *widget =
1838 snd_soc_dapm_kcontrol_widget(kcontrol);
1839 struct snd_soc_component *component =
1840 snd_soc_dapm_to_component(widget->dapm);
1841 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1842 struct snd_soc_dapm_update *update = NULL;
1843 u32 rx_port_value = ucontrol->value.integer.value[0];
1844 u32 bit_input;
1845 u32 aif_rst;
1846 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1847
1848 aif_rst = wsa->rx_port_value[widget->shift];
1849 if (!rx_port_value) {
1850 if (aif_rst == 0) {
1851 dev_err(component->dev, "%s: AIF reset already\n", __func__);
1852 return 0;
1853 }
1854 if (aif_rst >= WSA_MACRO_RX_MAX) {
1855 dev_err(component->dev, "%s: Invalid AIF reset\n", __func__);
1856 return 0;
1857 }
1858 }
1859 wsa->rx_port_value[widget->shift] = rx_port_value;
1860
1861 bit_input = widget->shift;
1862
1863 switch (rx_port_value) {
1864 case 0:
1865 if (wsa->active_ch_cnt[aif_rst]) {
1866 clear_bit(bit_input,
1867 &wsa->active_ch_mask[aif_rst]);
1868 wsa->active_ch_cnt[aif_rst]--;
1869 }
1870 break;
1871 case 1:
1872 case 2:
1873 set_bit(bit_input,
1874 &wsa->active_ch_mask[rx_port_value]);
1875 wsa->active_ch_cnt[rx_port_value]++;
1876 break;
1877 default:
1878 dev_err(component->dev,
1879 "%s: Invalid AIF_ID for WSA RX MUX %d\n",
1880 __func__, rx_port_value);
1881 return -EINVAL;
1882 }
1883
1884 snd_soc_dapm_mux_update_power(widget->dapm, kcontrol,
1885 rx_port_value, e, update);
1886 return 0;
1887 }
1888
wsa_macro_soft_clip_enable_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1889 static int wsa_macro_soft_clip_enable_get(struct snd_kcontrol *kcontrol,
1890 struct snd_ctl_elem_value *ucontrol)
1891 {
1892 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1893 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1894 int path = ((struct soc_mixer_control *)kcontrol->private_value)->shift;
1895
1896 ucontrol->value.integer.value[0] = wsa->is_softclip_on[path];
1897
1898 return 0;
1899 }
1900
wsa_macro_soft_clip_enable_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1901 static int wsa_macro_soft_clip_enable_put(struct snd_kcontrol *kcontrol,
1902 struct snd_ctl_elem_value *ucontrol)
1903 {
1904 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1905 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1906 int path = ((struct soc_mixer_control *) kcontrol->private_value)->shift;
1907
1908 wsa->is_softclip_on[path] = ucontrol->value.integer.value[0];
1909
1910 return 0;
1911 }
1912
1913 static const struct snd_kcontrol_new wsa_macro_snd_controls[] = {
1914 SOC_ENUM_EXT("EAR SPKR PA Gain", wsa_macro_ear_spkr_pa_gain_enum,
1915 wsa_macro_ear_spkr_pa_gain_get,
1916 wsa_macro_ear_spkr_pa_gain_put),
1917 SOC_SINGLE_EXT("WSA_Softclip0 Enable", SND_SOC_NOPM,
1918 WSA_MACRO_SOFTCLIP0, 1, 0,
1919 wsa_macro_soft_clip_enable_get,
1920 wsa_macro_soft_clip_enable_put),
1921 SOC_SINGLE_EXT("WSA_Softclip1 Enable", SND_SOC_NOPM,
1922 WSA_MACRO_SOFTCLIP1, 1, 0,
1923 wsa_macro_soft_clip_enable_get,
1924 wsa_macro_soft_clip_enable_put),
1925
1926 SOC_SINGLE_S8_TLV("WSA_RX0 Digital Volume", CDC_WSA_RX0_RX_VOL_CTL,
1927 -84, 40, digital_gain),
1928 SOC_SINGLE_S8_TLV("WSA_RX1 Digital Volume", CDC_WSA_RX1_RX_VOL_CTL,
1929 -84, 40, digital_gain),
1930
1931 SOC_SINGLE("WSA_RX0 Digital Mute", CDC_WSA_RX0_RX_PATH_CTL, 4, 1, 0),
1932 SOC_SINGLE("WSA_RX1 Digital Mute", CDC_WSA_RX1_RX_PATH_CTL, 4, 1, 0),
1933 SOC_SINGLE("WSA_RX0_MIX Digital Mute", CDC_WSA_RX0_RX_PATH_MIX_CTL, 4,
1934 1, 0),
1935 SOC_SINGLE("WSA_RX1_MIX Digital Mute", CDC_WSA_RX1_RX_PATH_MIX_CTL, 4,
1936 1, 0),
1937 SOC_SINGLE_EXT("WSA_COMP1 Switch", SND_SOC_NOPM, WSA_MACRO_COMP1, 1, 0,
1938 wsa_macro_get_compander, wsa_macro_set_compander),
1939 SOC_SINGLE_EXT("WSA_COMP2 Switch", SND_SOC_NOPM, WSA_MACRO_COMP2, 1, 0,
1940 wsa_macro_get_compander, wsa_macro_set_compander),
1941 SOC_SINGLE_EXT("WSA_RX0 EC_HQ Switch", SND_SOC_NOPM, WSA_MACRO_RX0, 1, 0,
1942 wsa_macro_get_ec_hq, wsa_macro_set_ec_hq),
1943 SOC_SINGLE_EXT("WSA_RX1 EC_HQ Switch", SND_SOC_NOPM, WSA_MACRO_RX1, 1, 0,
1944 wsa_macro_get_ec_hq, wsa_macro_set_ec_hq),
1945 };
1946
1947 static const struct soc_enum rx_mux_enum =
1948 SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(rx_mux_text), rx_mux_text);
1949
1950 static const struct snd_kcontrol_new rx_mux[WSA_MACRO_RX_MAX] = {
1951 SOC_DAPM_ENUM_EXT("WSA RX0 Mux", rx_mux_enum,
1952 wsa_macro_rx_mux_get, wsa_macro_rx_mux_put),
1953 SOC_DAPM_ENUM_EXT("WSA RX1 Mux", rx_mux_enum,
1954 wsa_macro_rx_mux_get, wsa_macro_rx_mux_put),
1955 SOC_DAPM_ENUM_EXT("WSA RX_MIX0 Mux", rx_mux_enum,
1956 wsa_macro_rx_mux_get, wsa_macro_rx_mux_put),
1957 SOC_DAPM_ENUM_EXT("WSA RX_MIX1 Mux", rx_mux_enum,
1958 wsa_macro_rx_mux_get, wsa_macro_rx_mux_put),
1959 };
1960
wsa_macro_vi_feed_mixer_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1961 static int wsa_macro_vi_feed_mixer_get(struct snd_kcontrol *kcontrol,
1962 struct snd_ctl_elem_value *ucontrol)
1963 {
1964 struct snd_soc_dapm_widget *widget = snd_soc_dapm_kcontrol_widget(kcontrol);
1965 struct snd_soc_component *component = snd_soc_dapm_to_component(widget->dapm);
1966 struct soc_mixer_control *mixer = (struct soc_mixer_control *)kcontrol->private_value;
1967 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1968 u32 spk_tx_id = mixer->shift;
1969 u32 dai_id = widget->shift;
1970
1971 if (test_bit(spk_tx_id, &wsa->active_ch_mask[dai_id]))
1972 ucontrol->value.integer.value[0] = 1;
1973 else
1974 ucontrol->value.integer.value[0] = 0;
1975
1976 return 0;
1977 }
1978
wsa_macro_vi_feed_mixer_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1979 static int wsa_macro_vi_feed_mixer_put(struct snd_kcontrol *kcontrol,
1980 struct snd_ctl_elem_value *ucontrol)
1981 {
1982 struct snd_soc_dapm_widget *widget = snd_soc_dapm_kcontrol_widget(kcontrol);
1983 struct snd_soc_component *component = snd_soc_dapm_to_component(widget->dapm);
1984 struct soc_mixer_control *mixer = (struct soc_mixer_control *)kcontrol->private_value;
1985 struct wsa_macro *wsa = snd_soc_component_get_drvdata(component);
1986 u32 enable = ucontrol->value.integer.value[0];
1987 u32 spk_tx_id = mixer->shift;
1988
1989 if (enable) {
1990 if (spk_tx_id == WSA_MACRO_TX0 &&
1991 !test_bit(WSA_MACRO_TX0,
1992 &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) {
1993 set_bit(WSA_MACRO_TX0,
1994 &wsa->active_ch_mask[WSA_MACRO_AIF_VI]);
1995 wsa->active_ch_cnt[WSA_MACRO_AIF_VI]++;
1996 }
1997 if (spk_tx_id == WSA_MACRO_TX1 &&
1998 !test_bit(WSA_MACRO_TX1,
1999 &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) {
2000 set_bit(WSA_MACRO_TX1,
2001 &wsa->active_ch_mask[WSA_MACRO_AIF_VI]);
2002 wsa->active_ch_cnt[WSA_MACRO_AIF_VI]++;
2003 }
2004 } else {
2005 if (spk_tx_id == WSA_MACRO_TX0 &&
2006 test_bit(WSA_MACRO_TX0,
2007 &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) {
2008 clear_bit(WSA_MACRO_TX0,
2009 &wsa->active_ch_mask[WSA_MACRO_AIF_VI]);
2010 wsa->active_ch_cnt[WSA_MACRO_AIF_VI]--;
2011 }
2012 if (spk_tx_id == WSA_MACRO_TX1 &&
2013 test_bit(WSA_MACRO_TX1,
2014 &wsa->active_ch_mask[WSA_MACRO_AIF_VI])) {
2015 clear_bit(WSA_MACRO_TX1,
2016 &wsa->active_ch_mask[WSA_MACRO_AIF_VI]);
2017 wsa->active_ch_cnt[WSA_MACRO_AIF_VI]--;
2018 }
2019 }
2020 snd_soc_dapm_mixer_update_power(widget->dapm, kcontrol, enable, NULL);
2021
2022 return 0;
2023 }
2024
2025 static const struct snd_kcontrol_new aif_vi_mixer[] = {
2026 SOC_SINGLE_EXT("WSA_SPKR_VI_1", SND_SOC_NOPM, WSA_MACRO_TX0, 1, 0,
2027 wsa_macro_vi_feed_mixer_get,
2028 wsa_macro_vi_feed_mixer_put),
2029 SOC_SINGLE_EXT("WSA_SPKR_VI_2", SND_SOC_NOPM, WSA_MACRO_TX1, 1, 0,
2030 wsa_macro_vi_feed_mixer_get,
2031 wsa_macro_vi_feed_mixer_put),
2032 };
2033
2034 static const struct snd_soc_dapm_widget wsa_macro_dapm_widgets[] = {
2035 SND_SOC_DAPM_AIF_IN("WSA AIF1 PB", "WSA_AIF1 Playback", 0,
2036 SND_SOC_NOPM, 0, 0),
2037 SND_SOC_DAPM_AIF_IN("WSA AIF_MIX1 PB", "WSA_AIF_MIX1 Playback", 0,
2038 SND_SOC_NOPM, 0, 0),
2039
2040 SND_SOC_DAPM_AIF_OUT_E("WSA AIF_VI", "WSA_AIF_VI Capture", 0,
2041 SND_SOC_NOPM, WSA_MACRO_AIF_VI, 0,
2042 wsa_macro_enable_vi_feedback,
2043 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
2044 SND_SOC_DAPM_AIF_OUT("WSA AIF_ECHO", "WSA_AIF_ECHO Capture", 0,
2045 SND_SOC_NOPM, 0, 0),
2046
2047 SND_SOC_DAPM_MIXER("WSA_AIF_VI Mixer", SND_SOC_NOPM, WSA_MACRO_AIF_VI,
2048 0, aif_vi_mixer, ARRAY_SIZE(aif_vi_mixer)),
2049 SND_SOC_DAPM_MUX_E("WSA RX_MIX EC0_MUX", SND_SOC_NOPM,
2050 WSA_MACRO_EC0_MUX, 0,
2051 &rx_mix_ec0_mux, wsa_macro_enable_echo,
2052 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
2053 SND_SOC_DAPM_MUX_E("WSA RX_MIX EC1_MUX", SND_SOC_NOPM,
2054 WSA_MACRO_EC1_MUX, 0,
2055 &rx_mix_ec1_mux, wsa_macro_enable_echo,
2056 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
2057
2058 SND_SOC_DAPM_MUX("WSA RX0 MUX", SND_SOC_NOPM, WSA_MACRO_RX0, 0,
2059 &rx_mux[WSA_MACRO_RX0]),
2060 SND_SOC_DAPM_MUX("WSA RX1 MUX", SND_SOC_NOPM, WSA_MACRO_RX1, 0,
2061 &rx_mux[WSA_MACRO_RX1]),
2062 SND_SOC_DAPM_MUX("WSA RX_MIX0 MUX", SND_SOC_NOPM, WSA_MACRO_RX_MIX0, 0,
2063 &rx_mux[WSA_MACRO_RX_MIX0]),
2064 SND_SOC_DAPM_MUX("WSA RX_MIX1 MUX", SND_SOC_NOPM, WSA_MACRO_RX_MIX1, 0,
2065 &rx_mux[WSA_MACRO_RX_MIX1]),
2066
2067 SND_SOC_DAPM_MIXER("WSA RX0", SND_SOC_NOPM, 0, 0, NULL, 0),
2068 SND_SOC_DAPM_MIXER("WSA RX1", SND_SOC_NOPM, 0, 0, NULL, 0),
2069 SND_SOC_DAPM_MIXER("WSA RX_MIX0", SND_SOC_NOPM, 0, 0, NULL, 0),
2070 SND_SOC_DAPM_MIXER("WSA RX_MIX1", SND_SOC_NOPM, 0, 0, NULL, 0),
2071
2072 SND_SOC_DAPM_MUX("WSA_RX0 INP0", SND_SOC_NOPM, 0, 0, &rx0_prim_inp0_mux),
2073 SND_SOC_DAPM_MUX("WSA_RX0 INP1", SND_SOC_NOPM, 0, 0, &rx0_prim_inp1_mux),
2074 SND_SOC_DAPM_MUX("WSA_RX0 INP2", SND_SOC_NOPM, 0, 0, &rx0_prim_inp2_mux),
2075 SND_SOC_DAPM_MUX_E("WSA_RX0 MIX INP", SND_SOC_NOPM, WSA_MACRO_RX_MIX0,
2076 0, &rx0_mix_mux, wsa_macro_enable_mix_path,
2077 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
2078 SND_SOC_DAPM_MUX("WSA_RX1 INP0", SND_SOC_NOPM, 0, 0, &rx1_prim_inp0_mux),
2079 SND_SOC_DAPM_MUX("WSA_RX1 INP1", SND_SOC_NOPM, 0, 0, &rx1_prim_inp1_mux),
2080 SND_SOC_DAPM_MUX("WSA_RX1 INP2", SND_SOC_NOPM, 0, 0, &rx1_prim_inp2_mux),
2081 SND_SOC_DAPM_MUX_E("WSA_RX1 MIX INP", SND_SOC_NOPM, WSA_MACRO_RX_MIX1,
2082 0, &rx1_mix_mux, wsa_macro_enable_mix_path,
2083 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
2084
2085 SND_SOC_DAPM_MIXER_E("WSA_RX INT0 MIX", SND_SOC_NOPM, 0, 0, NULL, 0,
2086 wsa_macro_enable_main_path, SND_SOC_DAPM_PRE_PMU),
2087 SND_SOC_DAPM_MIXER_E("WSA_RX INT1 MIX", SND_SOC_NOPM, 1, 0, NULL, 0,
2088 wsa_macro_enable_main_path, SND_SOC_DAPM_PRE_PMU),
2089
2090 SND_SOC_DAPM_MIXER("WSA_RX INT0 SEC MIX", SND_SOC_NOPM, 0, 0, NULL, 0),
2091 SND_SOC_DAPM_MIXER("WSA_RX INT1 SEC MIX", SND_SOC_NOPM, 0, 0, NULL, 0),
2092
2093 SND_SOC_DAPM_MUX("WSA_RX0 INT0 SIDETONE MIX", CDC_WSA_RX0_RX_PATH_CFG1,
2094 4, 0, &rx0_sidetone_mix_mux),
2095
2096 SND_SOC_DAPM_INPUT("WSA SRC0_INP"),
2097 SND_SOC_DAPM_INPUT("WSA_TX DEC0_INP"),
2098 SND_SOC_DAPM_INPUT("WSA_TX DEC1_INP"),
2099
2100 SND_SOC_DAPM_MIXER_E("WSA_RX INT0 INTERP", SND_SOC_NOPM,
2101 WSA_MACRO_COMP1, 0, NULL, 0,
2102 wsa_macro_enable_interpolator,
2103 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
2104 SND_SOC_DAPM_POST_PMD),
2105
2106 SND_SOC_DAPM_MIXER_E("WSA_RX INT1 INTERP", SND_SOC_NOPM,
2107 WSA_MACRO_COMP2, 0, NULL, 0,
2108 wsa_macro_enable_interpolator,
2109 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
2110 SND_SOC_DAPM_POST_PMD),
2111
2112 SND_SOC_DAPM_MIXER_E("WSA_RX INT0 CHAIN", SND_SOC_NOPM, 0, 0,
2113 NULL, 0, wsa_macro_spk_boost_event,
2114 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
2115 SND_SOC_DAPM_POST_PMD),
2116
2117 SND_SOC_DAPM_MIXER_E("WSA_RX INT1 CHAIN", SND_SOC_NOPM, 0, 0,
2118 NULL, 0, wsa_macro_spk_boost_event,
2119 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
2120 SND_SOC_DAPM_POST_PMD),
2121
2122 SND_SOC_DAPM_INPUT("VIINPUT_WSA"),
2123 SND_SOC_DAPM_OUTPUT("WSA_SPK1 OUT"),
2124 SND_SOC_DAPM_OUTPUT("WSA_SPK2 OUT"),
2125
2126 SND_SOC_DAPM_SUPPLY("WSA_RX0_CLK", CDC_WSA_RX0_RX_PATH_CTL, 5, 0, NULL, 0),
2127 SND_SOC_DAPM_SUPPLY("WSA_RX1_CLK", CDC_WSA_RX1_RX_PATH_CTL, 5, 0, NULL, 0),
2128 SND_SOC_DAPM_SUPPLY("WSA_RX_MIX0_CLK", CDC_WSA_RX0_RX_PATH_MIX_CTL, 5, 0, NULL, 0),
2129 SND_SOC_DAPM_SUPPLY("WSA_RX_MIX1_CLK", CDC_WSA_RX1_RX_PATH_MIX_CTL, 5, 0, NULL, 0),
2130 SND_SOC_DAPM_SUPPLY_S("WSA_MCLK", 0, SND_SOC_NOPM, 0, 0,
2131 wsa_macro_mclk_event,
2132 SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
2133 };
2134
2135 static const struct snd_soc_dapm_route wsa_audio_map[] = {
2136 /* VI Feedback */
2137 {"WSA_AIF_VI Mixer", "WSA_SPKR_VI_1", "VIINPUT_WSA"},
2138 {"WSA_AIF_VI Mixer", "WSA_SPKR_VI_2", "VIINPUT_WSA"},
2139 {"WSA AIF_VI", NULL, "WSA_AIF_VI Mixer"},
2140 {"WSA AIF_VI", NULL, "WSA_MCLK"},
2141
2142 {"WSA RX_MIX EC0_MUX", "RX_MIX_TX0", "WSA_RX INT0 SEC MIX"},
2143 {"WSA RX_MIX EC1_MUX", "RX_MIX_TX0", "WSA_RX INT0 SEC MIX"},
2144 {"WSA RX_MIX EC0_MUX", "RX_MIX_TX1", "WSA_RX INT1 SEC MIX"},
2145 {"WSA RX_MIX EC1_MUX", "RX_MIX_TX1", "WSA_RX INT1 SEC MIX"},
2146 {"WSA AIF_ECHO", NULL, "WSA RX_MIX EC0_MUX"},
2147 {"WSA AIF_ECHO", NULL, "WSA RX_MIX EC1_MUX"},
2148 {"WSA AIF_ECHO", NULL, "WSA_MCLK"},
2149
2150 {"WSA AIF1 PB", NULL, "WSA_MCLK"},
2151 {"WSA AIF_MIX1 PB", NULL, "WSA_MCLK"},
2152
2153 {"WSA RX0 MUX", "AIF1_PB", "WSA AIF1 PB"},
2154 {"WSA RX1 MUX", "AIF1_PB", "WSA AIF1 PB"},
2155 {"WSA RX_MIX0 MUX", "AIF1_PB", "WSA AIF1 PB"},
2156 {"WSA RX_MIX1 MUX", "AIF1_PB", "WSA AIF1 PB"},
2157
2158 {"WSA RX0 MUX", "AIF_MIX1_PB", "WSA AIF_MIX1 PB"},
2159 {"WSA RX1 MUX", "AIF_MIX1_PB", "WSA AIF_MIX1 PB"},
2160 {"WSA RX_MIX0 MUX", "AIF_MIX1_PB", "WSA AIF_MIX1 PB"},
2161 {"WSA RX_MIX1 MUX", "AIF_MIX1_PB", "WSA AIF_MIX1 PB"},
2162
2163 {"WSA RX0", NULL, "WSA RX0 MUX"},
2164 {"WSA RX1", NULL, "WSA RX1 MUX"},
2165 {"WSA RX_MIX0", NULL, "WSA RX_MIX0 MUX"},
2166 {"WSA RX_MIX1", NULL, "WSA RX_MIX1 MUX"},
2167
2168 {"WSA RX0", NULL, "WSA_RX0_CLK"},
2169 {"WSA RX1", NULL, "WSA_RX1_CLK"},
2170 {"WSA RX_MIX0", NULL, "WSA_RX_MIX0_CLK"},
2171 {"WSA RX_MIX1", NULL, "WSA_RX_MIX1_CLK"},
2172
2173 {"WSA_RX0 INP0", "RX0", "WSA RX0"},
2174 {"WSA_RX0 INP0", "RX1", "WSA RX1"},
2175 {"WSA_RX0 INP0", "RX_MIX0", "WSA RX_MIX0"},
2176 {"WSA_RX0 INP0", "RX_MIX1", "WSA RX_MIX1"},
2177 {"WSA_RX0 INP0", "DEC0", "WSA_TX DEC0_INP"},
2178 {"WSA_RX0 INP0", "DEC1", "WSA_TX DEC1_INP"},
2179 {"WSA_RX INT0 MIX", NULL, "WSA_RX0 INP0"},
2180
2181 {"WSA_RX0 INP1", "RX0", "WSA RX0"},
2182 {"WSA_RX0 INP1", "RX1", "WSA RX1"},
2183 {"WSA_RX0 INP1", "RX_MIX0", "WSA RX_MIX0"},
2184 {"WSA_RX0 INP1", "RX_MIX1", "WSA RX_MIX1"},
2185 {"WSA_RX0 INP1", "DEC0", "WSA_TX DEC0_INP"},
2186 {"WSA_RX0 INP1", "DEC1", "WSA_TX DEC1_INP"},
2187 {"WSA_RX INT0 MIX", NULL, "WSA_RX0 INP1"},
2188
2189 {"WSA_RX0 INP2", "RX0", "WSA RX0"},
2190 {"WSA_RX0 INP2", "RX1", "WSA RX1"},
2191 {"WSA_RX0 INP2", "RX_MIX0", "WSA RX_MIX0"},
2192 {"WSA_RX0 INP2", "RX_MIX1", "WSA RX_MIX1"},
2193 {"WSA_RX0 INP2", "DEC0", "WSA_TX DEC0_INP"},
2194 {"WSA_RX0 INP2", "DEC1", "WSA_TX DEC1_INP"},
2195 {"WSA_RX INT0 MIX", NULL, "WSA_RX0 INP2"},
2196
2197 {"WSA_RX0 MIX INP", "RX0", "WSA RX0"},
2198 {"WSA_RX0 MIX INP", "RX1", "WSA RX1"},
2199 {"WSA_RX0 MIX INP", "RX_MIX0", "WSA RX_MIX0"},
2200 {"WSA_RX0 MIX INP", "RX_MIX1", "WSA RX_MIX1"},
2201 {"WSA_RX INT0 SEC MIX", NULL, "WSA_RX0 MIX INP"},
2202
2203 {"WSA_RX INT0 SEC MIX", NULL, "WSA_RX INT0 MIX"},
2204 {"WSA_RX INT0 INTERP", NULL, "WSA_RX INT0 SEC MIX"},
2205 {"WSA_RX0 INT0 SIDETONE MIX", "SRC0", "WSA SRC0_INP"},
2206 {"WSA_RX INT0 INTERP", NULL, "WSA_RX0 INT0 SIDETONE MIX"},
2207 {"WSA_RX INT0 CHAIN", NULL, "WSA_RX INT0 INTERP"},
2208
2209 {"WSA_SPK1 OUT", NULL, "WSA_RX INT0 CHAIN"},
2210 {"WSA_SPK1 OUT", NULL, "WSA_MCLK"},
2211
2212 {"WSA_RX1 INP0", "RX0", "WSA RX0"},
2213 {"WSA_RX1 INP0", "RX1", "WSA RX1"},
2214 {"WSA_RX1 INP0", "RX_MIX0", "WSA RX_MIX0"},
2215 {"WSA_RX1 INP0", "RX_MIX1", "WSA RX_MIX1"},
2216 {"WSA_RX1 INP0", "DEC0", "WSA_TX DEC0_INP"},
2217 {"WSA_RX1 INP0", "DEC1", "WSA_TX DEC1_INP"},
2218 {"WSA_RX INT1 MIX", NULL, "WSA_RX1 INP0"},
2219
2220 {"WSA_RX1 INP1", "RX0", "WSA RX0"},
2221 {"WSA_RX1 INP1", "RX1", "WSA RX1"},
2222 {"WSA_RX1 INP1", "RX_MIX0", "WSA RX_MIX0"},
2223 {"WSA_RX1 INP1", "RX_MIX1", "WSA RX_MIX1"},
2224 {"WSA_RX1 INP1", "DEC0", "WSA_TX DEC0_INP"},
2225 {"WSA_RX1 INP1", "DEC1", "WSA_TX DEC1_INP"},
2226 {"WSA_RX INT1 MIX", NULL, "WSA_RX1 INP1"},
2227
2228 {"WSA_RX1 INP2", "RX0", "WSA RX0"},
2229 {"WSA_RX1 INP2", "RX1", "WSA RX1"},
2230 {"WSA_RX1 INP2", "RX_MIX0", "WSA RX_MIX0"},
2231 {"WSA_RX1 INP2", "RX_MIX1", "WSA RX_MIX1"},
2232 {"WSA_RX1 INP2", "DEC0", "WSA_TX DEC0_INP"},
2233 {"WSA_RX1 INP2", "DEC1", "WSA_TX DEC1_INP"},
2234 {"WSA_RX INT1 MIX", NULL, "WSA_RX1 INP2"},
2235
2236 {"WSA_RX1 MIX INP", "RX0", "WSA RX0"},
2237 {"WSA_RX1 MIX INP", "RX1", "WSA RX1"},
2238 {"WSA_RX1 MIX INP", "RX_MIX0", "WSA RX_MIX0"},
2239 {"WSA_RX1 MIX INP", "RX_MIX1", "WSA RX_MIX1"},
2240 {"WSA_RX INT1 SEC MIX", NULL, "WSA_RX1 MIX INP"},
2241
2242 {"WSA_RX INT1 SEC MIX", NULL, "WSA_RX INT1 MIX"},
2243 {"WSA_RX INT1 INTERP", NULL, "WSA_RX INT1 SEC MIX"},
2244
2245 {"WSA_RX INT1 CHAIN", NULL, "WSA_RX INT1 INTERP"},
2246 {"WSA_SPK2 OUT", NULL, "WSA_RX INT1 CHAIN"},
2247 {"WSA_SPK2 OUT", NULL, "WSA_MCLK"},
2248 };
2249
wsa_swrm_clock(struct wsa_macro * wsa,bool enable)2250 static int wsa_swrm_clock(struct wsa_macro *wsa, bool enable)
2251 {
2252 struct regmap *regmap = wsa->regmap;
2253
2254 if (enable) {
2255 wsa_macro_mclk_enable(wsa, true);
2256
2257 /* reset swr ip */
2258 if (wsa->reset_swr)
2259 regmap_update_bits(regmap,
2260 CDC_WSA_CLK_RST_CTRL_SWR_CONTROL,
2261 CDC_WSA_SWR_RST_EN_MASK,
2262 CDC_WSA_SWR_RST_ENABLE);
2263
2264 regmap_update_bits(regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL,
2265 CDC_WSA_SWR_CLK_EN_MASK,
2266 CDC_WSA_SWR_CLK_ENABLE);
2267
2268 /* Bring out of reset */
2269 if (wsa->reset_swr)
2270 regmap_update_bits(regmap,
2271 CDC_WSA_CLK_RST_CTRL_SWR_CONTROL,
2272 CDC_WSA_SWR_RST_EN_MASK,
2273 CDC_WSA_SWR_RST_DISABLE);
2274 wsa->reset_swr = false;
2275 } else {
2276 regmap_update_bits(regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL,
2277 CDC_WSA_SWR_CLK_EN_MASK, 0);
2278 wsa_macro_mclk_enable(wsa, false);
2279 }
2280
2281 return 0;
2282 }
2283
wsa_macro_component_probe(struct snd_soc_component * comp)2284 static int wsa_macro_component_probe(struct snd_soc_component *comp)
2285 {
2286 struct wsa_macro *wsa = snd_soc_component_get_drvdata(comp);
2287
2288 snd_soc_component_init_regmap(comp, wsa->regmap);
2289
2290 wsa->spkr_gain_offset = WSA_MACRO_GAIN_OFFSET_M1P5_DB;
2291
2292 /* set SPKR rate to FS_2P4_3P072 */
2293 snd_soc_component_update_bits(comp, CDC_WSA_RX0_RX_PATH_CFG1,
2294 CDC_WSA_RX_PATH_SPKR_RATE_MASK,
2295 CDC_WSA_RX_PATH_SPKR_RATE_FS_2P4_3P072);
2296
2297 snd_soc_component_update_bits(comp, CDC_WSA_RX1_RX_PATH_CFG1,
2298 CDC_WSA_RX_PATH_SPKR_RATE_MASK,
2299 CDC_WSA_RX_PATH_SPKR_RATE_FS_2P4_3P072);
2300
2301 wsa_macro_set_spkr_mode(comp, WSA_MACRO_SPKR_MODE_1);
2302
2303 return 0;
2304 }
2305
swclk_gate_enable(struct clk_hw * hw)2306 static int swclk_gate_enable(struct clk_hw *hw)
2307 {
2308 return wsa_swrm_clock(to_wsa_macro(hw), true);
2309 }
2310
swclk_gate_disable(struct clk_hw * hw)2311 static void swclk_gate_disable(struct clk_hw *hw)
2312 {
2313 wsa_swrm_clock(to_wsa_macro(hw), false);
2314 }
2315
swclk_gate_is_enabled(struct clk_hw * hw)2316 static int swclk_gate_is_enabled(struct clk_hw *hw)
2317 {
2318 struct wsa_macro *wsa = to_wsa_macro(hw);
2319 int ret, val;
2320
2321 regmap_read(wsa->regmap, CDC_WSA_CLK_RST_CTRL_SWR_CONTROL, &val);
2322 ret = val & BIT(0);
2323
2324 return ret;
2325 }
2326
swclk_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)2327 static unsigned long swclk_recalc_rate(struct clk_hw *hw,
2328 unsigned long parent_rate)
2329 {
2330 return parent_rate / 2;
2331 }
2332
2333 static const struct clk_ops swclk_gate_ops = {
2334 .prepare = swclk_gate_enable,
2335 .unprepare = swclk_gate_disable,
2336 .is_enabled = swclk_gate_is_enabled,
2337 .recalc_rate = swclk_recalc_rate,
2338 };
2339
wsa_macro_register_mclk_output(struct wsa_macro * wsa)2340 static int wsa_macro_register_mclk_output(struct wsa_macro *wsa)
2341 {
2342 struct device *dev = wsa->dev;
2343 const char *parent_clk_name;
2344 const char *clk_name = "mclk";
2345 struct clk_hw *hw;
2346 struct clk_init_data init;
2347 int ret;
2348
2349 parent_clk_name = __clk_get_name(wsa->clks[2].clk);
2350
2351 init.name = clk_name;
2352 init.ops = &swclk_gate_ops;
2353 init.flags = 0;
2354 init.parent_names = &parent_clk_name;
2355 init.num_parents = 1;
2356 wsa->hw.init = &init;
2357 hw = &wsa->hw;
2358 ret = clk_hw_register(wsa->dev, hw);
2359 if (ret)
2360 return ret;
2361
2362 return devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get, hw);
2363 }
2364
2365 static const struct snd_soc_component_driver wsa_macro_component_drv = {
2366 .name = "WSA MACRO",
2367 .probe = wsa_macro_component_probe,
2368 .controls = wsa_macro_snd_controls,
2369 .num_controls = ARRAY_SIZE(wsa_macro_snd_controls),
2370 .dapm_widgets = wsa_macro_dapm_widgets,
2371 .num_dapm_widgets = ARRAY_SIZE(wsa_macro_dapm_widgets),
2372 .dapm_routes = wsa_audio_map,
2373 .num_dapm_routes = ARRAY_SIZE(wsa_audio_map),
2374 };
2375
wsa_macro_probe(struct platform_device * pdev)2376 static int wsa_macro_probe(struct platform_device *pdev)
2377 {
2378 struct device *dev = &pdev->dev;
2379 struct wsa_macro *wsa;
2380 void __iomem *base;
2381 int ret;
2382
2383 wsa = devm_kzalloc(dev, sizeof(*wsa), GFP_KERNEL);
2384 if (!wsa)
2385 return -ENOMEM;
2386
2387 wsa->clks[0].id = "macro";
2388 wsa->clks[1].id = "dcodec";
2389 wsa->clks[2].id = "mclk";
2390 wsa->clks[3].id = "npl";
2391 wsa->clks[4].id = "fsgen";
2392
2393 ret = devm_clk_bulk_get(dev, WSA_NUM_CLKS_MAX, wsa->clks);
2394 if (ret) {
2395 dev_err(dev, "Error getting WSA Clocks (%d)\n", ret);
2396 return ret;
2397 }
2398
2399 base = devm_platform_ioremap_resource(pdev, 0);
2400 if (IS_ERR(base))
2401 return PTR_ERR(base);
2402
2403 wsa->regmap = devm_regmap_init_mmio(dev, base, &wsa_regmap_config);
2404
2405 dev_set_drvdata(dev, wsa);
2406
2407 wsa->reset_swr = true;
2408 wsa->dev = dev;
2409
2410 /* set MCLK and NPL rates */
2411 clk_set_rate(wsa->clks[2].clk, WSA_MACRO_MCLK_FREQ);
2412 clk_set_rate(wsa->clks[3].clk, WSA_MACRO_MCLK_FREQ);
2413
2414 ret = clk_bulk_prepare_enable(WSA_NUM_CLKS_MAX, wsa->clks);
2415 if (ret)
2416 return ret;
2417
2418 wsa_macro_register_mclk_output(wsa);
2419
2420 ret = devm_snd_soc_register_component(dev, &wsa_macro_component_drv,
2421 wsa_macro_dai,
2422 ARRAY_SIZE(wsa_macro_dai));
2423 if (ret)
2424 goto err;
2425
2426 return ret;
2427 err:
2428 clk_bulk_disable_unprepare(WSA_NUM_CLKS_MAX, wsa->clks);
2429
2430 return ret;
2431
2432 }
2433
wsa_macro_remove(struct platform_device * pdev)2434 static int wsa_macro_remove(struct platform_device *pdev)
2435 {
2436 struct wsa_macro *wsa = dev_get_drvdata(&pdev->dev);
2437
2438 clk_bulk_disable_unprepare(WSA_NUM_CLKS_MAX, wsa->clks);
2439
2440 return 0;
2441 }
2442
2443 static const struct of_device_id wsa_macro_dt_match[] = {
2444 {.compatible = "qcom,sm8250-lpass-wsa-macro"},
2445 {}
2446 };
2447 MODULE_DEVICE_TABLE(of, wsa_macro_dt_match);
2448
2449 static struct platform_driver wsa_macro_driver = {
2450 .driver = {
2451 .name = "wsa_macro",
2452 .of_match_table = wsa_macro_dt_match,
2453 },
2454 .probe = wsa_macro_probe,
2455 .remove = wsa_macro_remove,
2456 };
2457
2458 module_platform_driver(wsa_macro_driver);
2459 MODULE_DESCRIPTION("WSA macro driver");
2460 MODULE_LICENSE("GPL");
2461