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