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