1 // SPDX-License-Identifier: GPL-2.0
2 // Copyright (c) 2016, The Linux Foundation. All rights reserved.
3 
4 #include <linux/module.h>
5 #include <linux/err.h>
6 #include <linux/kernel.h>
7 #include <linux/delay.h>
8 #include <linux/types.h>
9 #include <linux/clk.h>
10 #include <linux/of.h>
11 #include <linux/platform_device.h>
12 #include <linux/regmap.h>
13 #include <linux/mfd/syscon.h>
14 #include <sound/soc.h>
15 #include <sound/pcm.h>
16 #include <sound/pcm_params.h>
17 #include <sound/tlv.h>
18 
19 #define LPASS_CDC_CLK_RX_RESET_CTL		(0x000)
20 #define LPASS_CDC_CLK_TX_RESET_B1_CTL		(0x004)
21 #define CLK_RX_RESET_B1_CTL_TX1_RESET_MASK	BIT(0)
22 #define CLK_RX_RESET_B1_CTL_TX2_RESET_MASK	BIT(1)
23 #define LPASS_CDC_CLK_DMIC_B1_CTL		(0x008)
24 #define DMIC_B1_CTL_DMIC0_CLK_SEL_MASK		GENMASK(3, 1)
25 #define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV2		(0x0 << 1)
26 #define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV3		(0x1 << 1)
27 #define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV4		(0x2 << 1)
28 #define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV6		(0x3 << 1)
29 #define DMIC_B1_CTL_DMIC0_CLK_SEL_DIV16		(0x4 << 1)
30 #define DMIC_B1_CTL_DMIC0_CLK_EN_MASK		BIT(0)
31 #define DMIC_B1_CTL_DMIC0_CLK_EN_ENABLE		BIT(0)
32 
33 #define LPASS_CDC_CLK_RX_I2S_CTL		(0x00C)
34 #define RX_I2S_CTL_RX_I2S_MODE_MASK		BIT(5)
35 #define RX_I2S_CTL_RX_I2S_MODE_16		BIT(5)
36 #define RX_I2S_CTL_RX_I2S_MODE_32		0
37 #define RX_I2S_CTL_RX_I2S_FS_RATE_MASK		GENMASK(2, 0)
38 #define RX_I2S_CTL_RX_I2S_FS_RATE_F_8_KHZ	0x0
39 #define RX_I2S_CTL_RX_I2S_FS_RATE_F_16_KHZ	0x1
40 #define RX_I2S_CTL_RX_I2S_FS_RATE_F_32_KHZ	0x2
41 #define RX_I2S_CTL_RX_I2S_FS_RATE_F_48_KHZ	0x3
42 #define RX_I2S_CTL_RX_I2S_FS_RATE_F_96_KHZ	0x4
43 #define RX_I2S_CTL_RX_I2S_FS_RATE_F_192_KHZ	0x5
44 #define LPASS_CDC_CLK_TX_I2S_CTL		(0x010)
45 #define TX_I2S_CTL_TX_I2S_MODE_MASK		BIT(5)
46 #define TX_I2S_CTL_TX_I2S_MODE_16		BIT(5)
47 #define TX_I2S_CTL_TX_I2S_MODE_32		0
48 #define TX_I2S_CTL_TX_I2S_FS_RATE_MASK		GENMASK(2, 0)
49 #define TX_I2S_CTL_TX_I2S_FS_RATE_F_8_KHZ	0x0
50 #define TX_I2S_CTL_TX_I2S_FS_RATE_F_16_KHZ	0x1
51 #define TX_I2S_CTL_TX_I2S_FS_RATE_F_32_KHZ	0x2
52 #define TX_I2S_CTL_TX_I2S_FS_RATE_F_48_KHZ	0x3
53 #define TX_I2S_CTL_TX_I2S_FS_RATE_F_96_KHZ	0x4
54 #define TX_I2S_CTL_TX_I2S_FS_RATE_F_192_KHZ	0x5
55 
56 #define LPASS_CDC_CLK_OTHR_RESET_B1_CTL		(0x014)
57 #define LPASS_CDC_CLK_TX_CLK_EN_B1_CTL		(0x018)
58 #define LPASS_CDC_CLK_OTHR_CTL			(0x01C)
59 #define LPASS_CDC_CLK_RX_B1_CTL			(0x020)
60 #define LPASS_CDC_CLK_MCLK_CTL			(0x024)
61 #define MCLK_CTL_MCLK_EN_MASK			BIT(0)
62 #define MCLK_CTL_MCLK_EN_ENABLE			BIT(0)
63 #define MCLK_CTL_MCLK_EN_DISABLE		0
64 #define LPASS_CDC_CLK_PDM_CTL			(0x028)
65 #define LPASS_CDC_CLK_PDM_CTL_PDM_EN_MASK	BIT(0)
66 #define LPASS_CDC_CLK_PDM_CTL_PDM_EN		BIT(0)
67 #define LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_MASK	BIT(1)
68 #define LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_FB	BIT(1)
69 #define LPASS_CDC_CLK_PDM_CTL_PDM_CLK_PDM_CLK	0
70 
71 #define LPASS_CDC_CLK_SD_CTL			(0x02C)
72 #define LPASS_CDC_RX1_B1_CTL			(0x040)
73 #define LPASS_CDC_RX2_B1_CTL			(0x060)
74 #define LPASS_CDC_RX3_B1_CTL			(0x080)
75 #define LPASS_CDC_RX1_B2_CTL			(0x044)
76 #define LPASS_CDC_RX2_B2_CTL			(0x064)
77 #define LPASS_CDC_RX3_B2_CTL			(0x084)
78 #define LPASS_CDC_RX1_B3_CTL			(0x048)
79 #define LPASS_CDC_RX2_B3_CTL			(0x068)
80 #define LPASS_CDC_RX3_B3_CTL			(0x088)
81 #define LPASS_CDC_RX1_B4_CTL			(0x04C)
82 #define LPASS_CDC_RX2_B4_CTL			(0x06C)
83 #define LPASS_CDC_RX3_B4_CTL			(0x08C)
84 #define LPASS_CDC_RX1_B5_CTL			(0x050)
85 #define LPASS_CDC_RX2_B5_CTL			(0x070)
86 #define LPASS_CDC_RX3_B5_CTL			(0x090)
87 #define LPASS_CDC_RX1_B6_CTL			(0x054)
88 #define RXn_B6_CTL_MUTE_MASK			BIT(0)
89 #define RXn_B6_CTL_MUTE_ENABLE			BIT(0)
90 #define RXn_B6_CTL_MUTE_DISABLE			0
91 #define LPASS_CDC_RX2_B6_CTL			(0x074)
92 #define LPASS_CDC_RX3_B6_CTL			(0x094)
93 #define LPASS_CDC_RX1_VOL_CTL_B1_CTL		(0x058)
94 #define LPASS_CDC_RX2_VOL_CTL_B1_CTL		(0x078)
95 #define LPASS_CDC_RX3_VOL_CTL_B1_CTL		(0x098)
96 #define LPASS_CDC_RX1_VOL_CTL_B2_CTL		(0x05C)
97 #define LPASS_CDC_RX2_VOL_CTL_B2_CTL		(0x07C)
98 #define LPASS_CDC_RX3_VOL_CTL_B2_CTL		(0x09C)
99 #define LPASS_CDC_TOP_GAIN_UPDATE		(0x0A0)
100 #define LPASS_CDC_TOP_CTL			(0x0A4)
101 #define TOP_CTL_DIG_MCLK_FREQ_MASK		BIT(0)
102 #define TOP_CTL_DIG_MCLK_FREQ_F_12_288MHZ	0
103 #define TOP_CTL_DIG_MCLK_FREQ_F_9_6MHZ		BIT(0)
104 
105 #define LPASS_CDC_DEBUG_DESER1_CTL		(0x0E0)
106 #define LPASS_CDC_DEBUG_DESER2_CTL		(0x0E4)
107 #define LPASS_CDC_DEBUG_B1_CTL_CFG		(0x0E8)
108 #define LPASS_CDC_DEBUG_B2_CTL_CFG		(0x0EC)
109 #define LPASS_CDC_DEBUG_B3_CTL_CFG		(0x0F0)
110 #define LPASS_CDC_IIR1_GAIN_B1_CTL		(0x100)
111 #define LPASS_CDC_IIR2_GAIN_B1_CTL		(0x140)
112 #define LPASS_CDC_IIR1_GAIN_B2_CTL		(0x104)
113 #define LPASS_CDC_IIR2_GAIN_B2_CTL		(0x144)
114 #define LPASS_CDC_IIR1_GAIN_B3_CTL		(0x108)
115 #define LPASS_CDC_IIR2_GAIN_B3_CTL		(0x148)
116 #define LPASS_CDC_IIR1_GAIN_B4_CTL		(0x10C)
117 #define LPASS_CDC_IIR2_GAIN_B4_CTL		(0x14C)
118 #define LPASS_CDC_IIR1_GAIN_B5_CTL		(0x110)
119 #define LPASS_CDC_IIR2_GAIN_B5_CTL		(0x150)
120 #define LPASS_CDC_IIR1_GAIN_B6_CTL		(0x114)
121 #define LPASS_CDC_IIR2_GAIN_B6_CTL		(0x154)
122 #define LPASS_CDC_IIR1_GAIN_B7_CTL		(0x118)
123 #define LPASS_CDC_IIR2_GAIN_B7_CTL		(0x158)
124 #define LPASS_CDC_IIR1_GAIN_B8_CTL		(0x11C)
125 #define LPASS_CDC_IIR2_GAIN_B8_CTL		(0x15C)
126 #define LPASS_CDC_IIR1_CTL			(0x120)
127 #define LPASS_CDC_IIR2_CTL			(0x160)
128 #define LPASS_CDC_IIR1_GAIN_TIMER_CTL		(0x124)
129 #define LPASS_CDC_IIR2_GAIN_TIMER_CTL		(0x164)
130 #define LPASS_CDC_IIR1_COEF_B1_CTL		(0x128)
131 #define LPASS_CDC_IIR2_COEF_B1_CTL		(0x168)
132 #define LPASS_CDC_IIR1_COEF_B2_CTL		(0x12C)
133 #define LPASS_CDC_IIR2_COEF_B2_CTL		(0x16C)
134 #define LPASS_CDC_CONN_RX1_B1_CTL		(0x180)
135 #define LPASS_CDC_CONN_RX1_B2_CTL		(0x184)
136 #define LPASS_CDC_CONN_RX1_B3_CTL		(0x188)
137 #define LPASS_CDC_CONN_RX2_B1_CTL		(0x18C)
138 #define LPASS_CDC_CONN_RX2_B2_CTL		(0x190)
139 #define LPASS_CDC_CONN_RX2_B3_CTL		(0x194)
140 #define LPASS_CDC_CONN_RX3_B1_CTL		(0x198)
141 #define LPASS_CDC_CONN_RX3_B2_CTL		(0x19C)
142 #define LPASS_CDC_CONN_TX_B1_CTL		(0x1A0)
143 #define LPASS_CDC_CONN_EQ1_B1_CTL		(0x1A8)
144 #define LPASS_CDC_CONN_EQ1_B2_CTL		(0x1AC)
145 #define LPASS_CDC_CONN_EQ1_B3_CTL		(0x1B0)
146 #define LPASS_CDC_CONN_EQ1_B4_CTL		(0x1B4)
147 #define LPASS_CDC_CONN_EQ2_B1_CTL		(0x1B8)
148 #define LPASS_CDC_CONN_EQ2_B2_CTL		(0x1BC)
149 #define LPASS_CDC_CONN_EQ2_B3_CTL		(0x1C0)
150 #define LPASS_CDC_CONN_EQ2_B4_CTL		(0x1C4)
151 #define LPASS_CDC_CONN_TX_I2S_SD1_CTL		(0x1C8)
152 #define LPASS_CDC_TX1_VOL_CTL_TIMER		(0x280)
153 #define LPASS_CDC_TX2_VOL_CTL_TIMER		(0x2A0)
154 #define LPASS_CDC_TX1_VOL_CTL_GAIN		(0x284)
155 #define LPASS_CDC_TX2_VOL_CTL_GAIN		(0x2A4)
156 #define LPASS_CDC_TX1_VOL_CTL_CFG		(0x288)
157 #define TX_VOL_CTL_CFG_MUTE_EN_MASK		BIT(0)
158 #define TX_VOL_CTL_CFG_MUTE_EN_ENABLE		BIT(0)
159 
160 #define LPASS_CDC_TX2_VOL_CTL_CFG		(0x2A8)
161 #define LPASS_CDC_TX1_MUX_CTL			(0x28C)
162 #define TX_MUX_CTL_CUT_OFF_FREQ_MASK		GENMASK(5, 4)
163 #define TX_MUX_CTL_CUT_OFF_FREQ_SHIFT		4
164 #define TX_MUX_CTL_CF_NEG_3DB_4HZ		(0x0 << 4)
165 #define TX_MUX_CTL_CF_NEG_3DB_75HZ		(0x1 << 4)
166 #define TX_MUX_CTL_CF_NEG_3DB_150HZ		(0x2 << 4)
167 #define TX_MUX_CTL_HPF_BP_SEL_MASK		BIT(3)
168 #define TX_MUX_CTL_HPF_BP_SEL_BYPASS		BIT(3)
169 #define TX_MUX_CTL_HPF_BP_SEL_NO_BYPASS		0
170 
171 #define LPASS_CDC_TX2_MUX_CTL			(0x2AC)
172 #define LPASS_CDC_TX1_CLK_FS_CTL		(0x290)
173 #define LPASS_CDC_TX2_CLK_FS_CTL		(0x2B0)
174 #define LPASS_CDC_TX1_DMIC_CTL			(0x294)
175 #define LPASS_CDC_TX2_DMIC_CTL			(0x2B4)
176 #define TXN_DMIC_CTL_CLK_SEL_MASK		GENMASK(2, 0)
177 #define TXN_DMIC_CTL_CLK_SEL_DIV2		0x0
178 #define TXN_DMIC_CTL_CLK_SEL_DIV3		0x1
179 #define TXN_DMIC_CTL_CLK_SEL_DIV4		0x2
180 #define TXN_DMIC_CTL_CLK_SEL_DIV6		0x3
181 #define TXN_DMIC_CTL_CLK_SEL_DIV16		0x4
182 
183 #define MSM8916_WCD_DIGITAL_RATES (SNDRV_PCM_RATE_8000 | \
184 				   SNDRV_PCM_RATE_16000 | \
185 				   SNDRV_PCM_RATE_32000 | \
186 				   SNDRV_PCM_RATE_48000)
187 #define MSM8916_WCD_DIGITAL_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\
188 				     SNDRV_PCM_FMTBIT_S32_LE)
189 
190 /* Codec supports 2 IIR filters */
191 enum {
192 	IIR1 = 0,
193 	IIR2,
194 	IIR_MAX,
195 };
196 
197 /* Codec supports 5 bands */
198 enum {
199 	BAND1 = 0,
200 	BAND2,
201 	BAND3,
202 	BAND4,
203 	BAND5,
204 	BAND_MAX,
205 };
206 
207 #define WCD_IIR_FILTER_SIZE	(sizeof(u32)*BAND_MAX)
208 
209 #define WCD_IIR_FILTER_CTL(xname, iidx, bidx) \
210 {       .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
211 	.info = wcd_iir_filter_info, \
212 	.get = msm8x16_wcd_get_iir_band_audio_mixer, \
213 	.put = msm8x16_wcd_put_iir_band_audio_mixer, \
214 	.private_value = (unsigned long)&(struct wcd_iir_filter_ctl) { \
215 		.iir_idx = iidx, \
216 		.band_idx = bidx, \
217 		.bytes_ext = {.max = WCD_IIR_FILTER_SIZE, }, \
218 	} \
219 }
220 
221 struct wcd_iir_filter_ctl {
222 	unsigned int iir_idx;
223 	unsigned int band_idx;
224 	struct soc_bytes_ext bytes_ext;
225 };
226 
227 struct msm8916_wcd_digital_priv {
228 	struct clk *ahbclk, *mclk;
229 };
230 
231 static const unsigned long rx_gain_reg[] = {
232 	LPASS_CDC_RX1_VOL_CTL_B2_CTL,
233 	LPASS_CDC_RX2_VOL_CTL_B2_CTL,
234 	LPASS_CDC_RX3_VOL_CTL_B2_CTL,
235 };
236 
237 static const unsigned long tx_gain_reg[] = {
238 	LPASS_CDC_TX1_VOL_CTL_GAIN,
239 	LPASS_CDC_TX2_VOL_CTL_GAIN,
240 };
241 
242 static const char *const rx_mix1_text[] = {
243 	"ZERO", "IIR1", "IIR2", "RX1", "RX2", "RX3"
244 };
245 
246 static const char * const rx_mix2_text[] = {
247 	"ZERO", "IIR1", "IIR2"
248 };
249 
250 static const char *const dec_mux_text[] = {
251 	"ZERO", "ADC1", "ADC2", "ADC3", "DMIC1", "DMIC2"
252 };
253 
254 static const char *const cic_mux_text[] = { "AMIC", "DMIC" };
255 
256 /* RX1 MIX1 */
257 static const struct soc_enum rx_mix1_inp_enum[] = {
258 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX1_B1_CTL, 0, 6, rx_mix1_text),
259 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX1_B1_CTL, 3, 6, rx_mix1_text),
260 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX1_B2_CTL, 0, 6, rx_mix1_text),
261 };
262 
263 /* RX2 MIX1 */
264 static const struct soc_enum rx2_mix1_inp_enum[] = {
265 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX2_B1_CTL, 0, 6, rx_mix1_text),
266 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX2_B1_CTL, 3, 6, rx_mix1_text),
267 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX2_B2_CTL, 0, 6, rx_mix1_text),
268 };
269 
270 /* RX3 MIX1 */
271 static const struct soc_enum rx3_mix1_inp_enum[] = {
272 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX3_B1_CTL, 0, 6, rx_mix1_text),
273 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX3_B1_CTL, 3, 6, rx_mix1_text),
274 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX3_B2_CTL, 0, 6, rx_mix1_text),
275 };
276 
277 /* RX1 MIX2 */
278 static const struct soc_enum rx_mix2_inp1_chain_enum =
279 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX1_B3_CTL,
280 		0, 3, rx_mix2_text);
281 
282 /* RX2 MIX2 */
283 static const struct soc_enum rx2_mix2_inp1_chain_enum =
284 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_RX2_B3_CTL,
285 		0, 3, rx_mix2_text);
286 
287 /* DEC */
288 static const struct soc_enum dec1_mux_enum = SOC_ENUM_SINGLE(
289 				LPASS_CDC_CONN_TX_B1_CTL, 0, 6, dec_mux_text);
290 static const struct soc_enum dec2_mux_enum = SOC_ENUM_SINGLE(
291 				LPASS_CDC_CONN_TX_B1_CTL, 3, 6, dec_mux_text);
292 
293 /* CIC */
294 static const struct soc_enum cic1_mux_enum = SOC_ENUM_SINGLE(
295 				LPASS_CDC_TX1_MUX_CTL, 0, 2, cic_mux_text);
296 static const struct soc_enum cic2_mux_enum = SOC_ENUM_SINGLE(
297 				LPASS_CDC_TX2_MUX_CTL, 0, 2, cic_mux_text);
298 
299 /* RDAC2 MUX */
300 static const struct snd_kcontrol_new dec1_mux = SOC_DAPM_ENUM(
301 				"DEC1 MUX Mux", dec1_mux_enum);
302 static const struct snd_kcontrol_new dec2_mux = SOC_DAPM_ENUM(
303 				"DEC2 MUX Mux",	dec2_mux_enum);
304 static const struct snd_kcontrol_new cic1_mux = SOC_DAPM_ENUM(
305 				"CIC1 MUX Mux", cic1_mux_enum);
306 static const struct snd_kcontrol_new cic2_mux = SOC_DAPM_ENUM(
307 				"CIC2 MUX Mux",	cic2_mux_enum);
308 static const struct snd_kcontrol_new rx_mix1_inp1_mux = SOC_DAPM_ENUM(
309 				"RX1 MIX1 INP1 Mux", rx_mix1_inp_enum[0]);
310 static const struct snd_kcontrol_new rx_mix1_inp2_mux = SOC_DAPM_ENUM(
311 				"RX1 MIX1 INP2 Mux", rx_mix1_inp_enum[1]);
312 static const struct snd_kcontrol_new rx_mix1_inp3_mux = SOC_DAPM_ENUM(
313 				"RX1 MIX1 INP3 Mux", rx_mix1_inp_enum[2]);
314 static const struct snd_kcontrol_new rx2_mix1_inp1_mux = SOC_DAPM_ENUM(
315 				"RX2 MIX1 INP1 Mux", rx2_mix1_inp_enum[0]);
316 static const struct snd_kcontrol_new rx2_mix1_inp2_mux = SOC_DAPM_ENUM(
317 				"RX2 MIX1 INP2 Mux", rx2_mix1_inp_enum[1]);
318 static const struct snd_kcontrol_new rx2_mix1_inp3_mux = SOC_DAPM_ENUM(
319 				"RX2 MIX1 INP3 Mux", rx2_mix1_inp_enum[2]);
320 static const struct snd_kcontrol_new rx3_mix1_inp1_mux = SOC_DAPM_ENUM(
321 				"RX3 MIX1 INP1 Mux", rx3_mix1_inp_enum[0]);
322 static const struct snd_kcontrol_new rx3_mix1_inp2_mux = SOC_DAPM_ENUM(
323 				"RX3 MIX1 INP2 Mux", rx3_mix1_inp_enum[1]);
324 static const struct snd_kcontrol_new rx3_mix1_inp3_mux = SOC_DAPM_ENUM(
325 				"RX3 MIX1 INP3 Mux", rx3_mix1_inp_enum[2]);
326 static const struct snd_kcontrol_new rx1_mix2_inp1_mux = SOC_DAPM_ENUM(
327 				"RX1 MIX2 INP1 Mux", rx_mix2_inp1_chain_enum);
328 static const struct snd_kcontrol_new rx2_mix2_inp1_mux = SOC_DAPM_ENUM(
329 				"RX2 MIX2 INP1 Mux", rx2_mix2_inp1_chain_enum);
330 
331 /* Digital Gain control -84 dB to +40 dB in 1 dB steps */
332 static const DECLARE_TLV_DB_SCALE(digital_gain, -8400, 100, -8400);
333 
334 /* Cutoff Freq for High Pass Filter at -3dB */
335 static const char * const hpf_cutoff_text[] = {
336 	"4Hz", "75Hz", "150Hz",
337 };
338 
339 static SOC_ENUM_SINGLE_DECL(tx1_hpf_cutoff_enum, LPASS_CDC_TX1_MUX_CTL, 4,
340 			    hpf_cutoff_text);
341 static SOC_ENUM_SINGLE_DECL(tx2_hpf_cutoff_enum, LPASS_CDC_TX2_MUX_CTL, 4,
342 			    hpf_cutoff_text);
343 
344 /* cut off for dc blocker inside rx chain */
345 static const char * const dc_blocker_cutoff_text[] = {
346 	"4Hz", "75Hz", "150Hz",
347 };
348 
349 static SOC_ENUM_SINGLE_DECL(rx1_dcb_cutoff_enum, LPASS_CDC_RX1_B4_CTL, 0,
350 			    dc_blocker_cutoff_text);
351 static SOC_ENUM_SINGLE_DECL(rx2_dcb_cutoff_enum, LPASS_CDC_RX2_B4_CTL, 0,
352 			    dc_blocker_cutoff_text);
353 static SOC_ENUM_SINGLE_DECL(rx3_dcb_cutoff_enum, LPASS_CDC_RX3_B4_CTL, 0,
354 			    dc_blocker_cutoff_text);
355 
356 static int msm8x16_wcd_codec_set_iir_gain(struct snd_soc_dapm_widget *w,
357 		struct snd_kcontrol *kcontrol, int event)
358 {
359 	struct snd_soc_component *component =
360 			snd_soc_dapm_to_component(w->dapm);
361 	int value = 0, reg = 0;
362 
363 	switch (event) {
364 	case SND_SOC_DAPM_POST_PMU:
365 		if (w->shift == 0)
366 			reg = LPASS_CDC_IIR1_GAIN_B1_CTL;
367 		else if (w->shift == 1)
368 			reg = LPASS_CDC_IIR2_GAIN_B1_CTL;
369 		value = snd_soc_component_read(component, reg);
370 		snd_soc_component_write(component, reg, value);
371 		break;
372 	default:
373 		break;
374 	}
375 	return 0;
376 }
377 
378 static uint32_t get_iir_band_coeff(struct snd_soc_component *component,
379 				   int iir_idx, int band_idx,
380 				   int coeff_idx)
381 {
382 	uint32_t value = 0;
383 
384 	/* Address does not automatically update if reading */
385 	snd_soc_component_write(component,
386 		(LPASS_CDC_IIR1_COEF_B1_CTL + 64 * iir_idx),
387 		((band_idx * BAND_MAX + coeff_idx)
388 		* sizeof(uint32_t)) & 0x7F);
389 
390 	value |= snd_soc_component_read(component,
391 		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx));
392 
393 	snd_soc_component_write(component,
394 		(LPASS_CDC_IIR1_COEF_B1_CTL + 64 * iir_idx),
395 		((band_idx * BAND_MAX + coeff_idx)
396 		* sizeof(uint32_t) + 1) & 0x7F);
397 
398 	value |= (snd_soc_component_read(component,
399 		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx)) << 8);
400 
401 	snd_soc_component_write(component,
402 		(LPASS_CDC_IIR1_COEF_B1_CTL + 64 * iir_idx),
403 		((band_idx * BAND_MAX + coeff_idx)
404 		* sizeof(uint32_t) + 2) & 0x7F);
405 
406 	value |= (snd_soc_component_read(component,
407 		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx)) << 16);
408 
409 	snd_soc_component_write(component,
410 		(LPASS_CDC_IIR1_COEF_B1_CTL + 64 * iir_idx),
411 		((band_idx * BAND_MAX + coeff_idx)
412 		* sizeof(uint32_t) + 3) & 0x7F);
413 
414 	/* Mask bits top 2 bits since they are reserved */
415 	value |= ((snd_soc_component_read(component,
416 		 (LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx)) & 0x3f) << 24);
417 	return value;
418 
419 }
420 
421 static int msm8x16_wcd_get_iir_band_audio_mixer(
422 					struct snd_kcontrol *kcontrol,
423 					struct snd_ctl_elem_value *ucontrol)
424 {
425 
426 	struct snd_soc_component *component =
427 			snd_soc_kcontrol_component(kcontrol);
428 	struct wcd_iir_filter_ctl *ctl =
429 			(struct wcd_iir_filter_ctl *)kcontrol->private_value;
430 	struct soc_bytes_ext *params = &ctl->bytes_ext;
431 	int iir_idx = ctl->iir_idx;
432 	int band_idx = ctl->band_idx;
433 	u32 coeff[BAND_MAX];
434 
435 	coeff[0] = get_iir_band_coeff(component, iir_idx, band_idx, 0);
436 	coeff[1] = get_iir_band_coeff(component, iir_idx, band_idx, 1);
437 	coeff[2] = get_iir_band_coeff(component, iir_idx, band_idx, 2);
438 	coeff[3] = get_iir_band_coeff(component, iir_idx, band_idx, 3);
439 	coeff[4] = get_iir_band_coeff(component, iir_idx, band_idx, 4);
440 
441 	memcpy(ucontrol->value.bytes.data, &coeff[0], params->max);
442 
443 	return 0;
444 }
445 
446 static void set_iir_band_coeff(struct snd_soc_component *component,
447 				int iir_idx, int band_idx,
448 				uint32_t value)
449 {
450 	snd_soc_component_write(component,
451 		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx),
452 		(value & 0xFF));
453 
454 	snd_soc_component_write(component,
455 		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx),
456 		(value >> 8) & 0xFF);
457 
458 	snd_soc_component_write(component,
459 		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx),
460 		(value >> 16) & 0xFF);
461 
462 	/* Mask top 2 bits, 7-8 are reserved */
463 	snd_soc_component_write(component,
464 		(LPASS_CDC_IIR1_COEF_B2_CTL + 64 * iir_idx),
465 		(value >> 24) & 0x3F);
466 }
467 
468 static int msm8x16_wcd_put_iir_band_audio_mixer(
469 					struct snd_kcontrol *kcontrol,
470 					struct snd_ctl_elem_value *ucontrol)
471 {
472 	struct snd_soc_component *component =
473 			snd_soc_kcontrol_component(kcontrol);
474 	struct wcd_iir_filter_ctl *ctl =
475 			(struct wcd_iir_filter_ctl *)kcontrol->private_value;
476 	struct soc_bytes_ext *params = &ctl->bytes_ext;
477 	int iir_idx = ctl->iir_idx;
478 	int band_idx = ctl->band_idx;
479 	u32 coeff[BAND_MAX];
480 
481 	memcpy(&coeff[0], ucontrol->value.bytes.data, params->max);
482 
483 	/* Mask top bit it is reserved */
484 	/* Updates addr automatically for each B2 write */
485 	snd_soc_component_write(component,
486 		(LPASS_CDC_IIR1_COEF_B1_CTL + 64 * iir_idx),
487 		(band_idx * BAND_MAX * sizeof(uint32_t)) & 0x7F);
488 
489 	set_iir_band_coeff(component, iir_idx, band_idx, coeff[0]);
490 	set_iir_band_coeff(component, iir_idx, band_idx, coeff[1]);
491 	set_iir_band_coeff(component, iir_idx, band_idx, coeff[2]);
492 	set_iir_band_coeff(component, iir_idx, band_idx, coeff[3]);
493 	set_iir_band_coeff(component, iir_idx, band_idx, coeff[4]);
494 
495 	return 0;
496 }
497 
498 static int wcd_iir_filter_info(struct snd_kcontrol *kcontrol,
499 				struct snd_ctl_elem_info *ucontrol)
500 {
501 	struct wcd_iir_filter_ctl *ctl =
502 		(struct wcd_iir_filter_ctl *)kcontrol->private_value;
503 	struct soc_bytes_ext *params = &ctl->bytes_ext;
504 
505 	ucontrol->type = SNDRV_CTL_ELEM_TYPE_BYTES;
506 	ucontrol->count = params->max;
507 
508 	return 0;
509 }
510 
511 static const struct snd_kcontrol_new msm8916_wcd_digital_snd_controls[] = {
512 	SOC_SINGLE_S8_TLV("RX1 Digital Volume", LPASS_CDC_RX1_VOL_CTL_B2_CTL,
513 			-84, 40, digital_gain),
514 	SOC_SINGLE_S8_TLV("RX2 Digital Volume", LPASS_CDC_RX2_VOL_CTL_B2_CTL,
515 			-84, 40, digital_gain),
516 	SOC_SINGLE_S8_TLV("RX3 Digital Volume", LPASS_CDC_RX3_VOL_CTL_B2_CTL,
517 			-84, 40, digital_gain),
518 	SOC_SINGLE_S8_TLV("TX1 Digital Volume", LPASS_CDC_TX1_VOL_CTL_GAIN,
519 			-84, 40, digital_gain),
520 	SOC_SINGLE_S8_TLV("TX2 Digital Volume", LPASS_CDC_TX2_VOL_CTL_GAIN,
521 			-84, 40, digital_gain),
522 	SOC_ENUM("TX1 HPF Cutoff", tx1_hpf_cutoff_enum),
523 	SOC_ENUM("TX2 HPF Cutoff", tx2_hpf_cutoff_enum),
524 	SOC_SINGLE("TX1 HPF Switch", LPASS_CDC_TX1_MUX_CTL, 3, 1, 0),
525 	SOC_SINGLE("TX2 HPF Switch", LPASS_CDC_TX2_MUX_CTL, 3, 1, 0),
526 	SOC_ENUM("RX1 DCB Cutoff", rx1_dcb_cutoff_enum),
527 	SOC_ENUM("RX2 DCB Cutoff", rx2_dcb_cutoff_enum),
528 	SOC_ENUM("RX3 DCB Cutoff", rx3_dcb_cutoff_enum),
529 	SOC_SINGLE("RX1 DCB Switch", LPASS_CDC_RX1_B5_CTL, 2, 1, 0),
530 	SOC_SINGLE("RX2 DCB Switch", LPASS_CDC_RX2_B5_CTL, 2, 1, 0),
531 	SOC_SINGLE("RX3 DCB Switch", LPASS_CDC_RX3_B5_CTL, 2, 1, 0),
532 	SOC_SINGLE("RX1 Mute Switch", LPASS_CDC_RX1_B6_CTL, 0, 1, 0),
533 	SOC_SINGLE("RX2 Mute Switch", LPASS_CDC_RX2_B6_CTL, 0, 1, 0),
534 	SOC_SINGLE("RX3 Mute Switch", LPASS_CDC_RX3_B6_CTL, 0, 1, 0),
535 
536 	SOC_SINGLE("IIR1 Band1 Switch", LPASS_CDC_IIR1_CTL, 0, 1, 0),
537 	SOC_SINGLE("IIR1 Band2 Switch", LPASS_CDC_IIR1_CTL, 1, 1, 0),
538 	SOC_SINGLE("IIR1 Band3 Switch", LPASS_CDC_IIR1_CTL, 2, 1, 0),
539 	SOC_SINGLE("IIR1 Band4 Switch", LPASS_CDC_IIR1_CTL, 3, 1, 0),
540 	SOC_SINGLE("IIR1 Band5 Switch", LPASS_CDC_IIR1_CTL, 4, 1, 0),
541 	SOC_SINGLE("IIR2 Band1 Switch", LPASS_CDC_IIR2_CTL, 0, 1, 0),
542 	SOC_SINGLE("IIR2 Band2 Switch", LPASS_CDC_IIR2_CTL, 1, 1, 0),
543 	SOC_SINGLE("IIR2 Band3 Switch", LPASS_CDC_IIR2_CTL, 2, 1, 0),
544 	SOC_SINGLE("IIR2 Band4 Switch", LPASS_CDC_IIR2_CTL, 3, 1, 0),
545 	SOC_SINGLE("IIR2 Band5 Switch", LPASS_CDC_IIR2_CTL, 4, 1, 0),
546 	WCD_IIR_FILTER_CTL("IIR1 Band1", IIR1, BAND1),
547 	WCD_IIR_FILTER_CTL("IIR1 Band2", IIR1, BAND2),
548 	WCD_IIR_FILTER_CTL("IIR1 Band3", IIR1, BAND3),
549 	WCD_IIR_FILTER_CTL("IIR1 Band4", IIR1, BAND4),
550 	WCD_IIR_FILTER_CTL("IIR1 Band5", IIR1, BAND5),
551 	WCD_IIR_FILTER_CTL("IIR2 Band1", IIR2, BAND1),
552 	WCD_IIR_FILTER_CTL("IIR2 Band2", IIR2, BAND2),
553 	WCD_IIR_FILTER_CTL("IIR2 Band3", IIR2, BAND3),
554 	WCD_IIR_FILTER_CTL("IIR2 Band4", IIR2, BAND4),
555 	WCD_IIR_FILTER_CTL("IIR2 Band5", IIR2, BAND5),
556 	SOC_SINGLE_S8_TLV("IIR1 INP1 Volume", LPASS_CDC_IIR1_GAIN_B1_CTL,
557 			-84, 40, digital_gain),
558 	SOC_SINGLE_S8_TLV("IIR1 INP2 Volume", LPASS_CDC_IIR1_GAIN_B2_CTL,
559 			-84, 40, digital_gain),
560 	SOC_SINGLE_S8_TLV("IIR1 INP3 Volume", LPASS_CDC_IIR1_GAIN_B3_CTL,
561 			-84, 40, digital_gain),
562 	SOC_SINGLE_S8_TLV("IIR1 INP4 Volume", LPASS_CDC_IIR1_GAIN_B4_CTL,
563 			-84, 40, digital_gain),
564 	SOC_SINGLE_S8_TLV("IIR2 INP1 Volume", LPASS_CDC_IIR2_GAIN_B1_CTL,
565 			-84, 40, digital_gain),
566 	SOC_SINGLE_S8_TLV("IIR2 INP2 Volume", LPASS_CDC_IIR2_GAIN_B2_CTL,
567 			-84, 40, digital_gain),
568 	SOC_SINGLE_S8_TLV("IIR2 INP3 Volume", LPASS_CDC_IIR2_GAIN_B3_CTL,
569 			-84, 40, digital_gain),
570 	SOC_SINGLE_S8_TLV("IIR2 INP4 Volume", LPASS_CDC_IIR2_GAIN_B4_CTL,
571 			-84, 40, digital_gain),
572 
573 };
574 
575 static int msm8916_wcd_digital_enable_interpolator(
576 						struct snd_soc_dapm_widget *w,
577 						struct snd_kcontrol *kcontrol,
578 						int event)
579 {
580 	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
581 
582 	switch (event) {
583 	case SND_SOC_DAPM_POST_PMU:
584 		/* apply the digital gain after the interpolator is enabled */
585 		usleep_range(10000, 10100);
586 		snd_soc_component_write(component, rx_gain_reg[w->shift],
587 			      snd_soc_component_read(component, rx_gain_reg[w->shift]));
588 		break;
589 	case SND_SOC_DAPM_POST_PMD:
590 		snd_soc_component_update_bits(component, LPASS_CDC_CLK_RX_RESET_CTL,
591 					      1 << w->shift, 1 << w->shift);
592 		snd_soc_component_update_bits(component, LPASS_CDC_CLK_RX_RESET_CTL,
593 					      1 << w->shift, 0x0);
594 		break;
595 	}
596 	return 0;
597 }
598 
599 static int msm8916_wcd_digital_enable_dec(struct snd_soc_dapm_widget *w,
600 					  struct snd_kcontrol *kcontrol,
601 					  int event)
602 {
603 	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
604 	unsigned int decimator = w->shift + 1;
605 	u16 dec_reset_reg, tx_vol_ctl_reg, tx_mux_ctl_reg;
606 	u8 dec_hpf_cut_of_freq;
607 
608 	dec_reset_reg = LPASS_CDC_CLK_TX_RESET_B1_CTL;
609 	tx_vol_ctl_reg = LPASS_CDC_TX1_VOL_CTL_CFG + 32 * (decimator - 1);
610 	tx_mux_ctl_reg = LPASS_CDC_TX1_MUX_CTL + 32 * (decimator - 1);
611 
612 	switch (event) {
613 	case SND_SOC_DAPM_PRE_PMU:
614 		/* Enable TX digital mute */
615 		snd_soc_component_update_bits(component, tx_vol_ctl_reg,
616 				    TX_VOL_CTL_CFG_MUTE_EN_MASK,
617 				    TX_VOL_CTL_CFG_MUTE_EN_ENABLE);
618 		dec_hpf_cut_of_freq = snd_soc_component_read(component, tx_mux_ctl_reg) &
619 					TX_MUX_CTL_CUT_OFF_FREQ_MASK;
620 		dec_hpf_cut_of_freq >>= TX_MUX_CTL_CUT_OFF_FREQ_SHIFT;
621 		if (dec_hpf_cut_of_freq != TX_MUX_CTL_CF_NEG_3DB_150HZ) {
622 			/* set cut of freq to CF_MIN_3DB_150HZ (0x1) */
623 			snd_soc_component_update_bits(component, tx_mux_ctl_reg,
624 					    TX_MUX_CTL_CUT_OFF_FREQ_MASK,
625 					    TX_MUX_CTL_CF_NEG_3DB_150HZ);
626 		}
627 		break;
628 	case SND_SOC_DAPM_POST_PMU:
629 		/* enable HPF */
630 		snd_soc_component_update_bits(component, tx_mux_ctl_reg,
631 				    TX_MUX_CTL_HPF_BP_SEL_MASK,
632 				    TX_MUX_CTL_HPF_BP_SEL_NO_BYPASS);
633 		/* apply the digital gain after the decimator is enabled */
634 		snd_soc_component_write(component, tx_gain_reg[w->shift],
635 			      snd_soc_component_read(component, tx_gain_reg[w->shift]));
636 		snd_soc_component_update_bits(component, tx_vol_ctl_reg,
637 				    TX_VOL_CTL_CFG_MUTE_EN_MASK, 0);
638 		break;
639 	case SND_SOC_DAPM_PRE_PMD:
640 		snd_soc_component_update_bits(component, tx_vol_ctl_reg,
641 				    TX_VOL_CTL_CFG_MUTE_EN_MASK,
642 				    TX_VOL_CTL_CFG_MUTE_EN_ENABLE);
643 		snd_soc_component_update_bits(component, tx_mux_ctl_reg,
644 				    TX_MUX_CTL_HPF_BP_SEL_MASK,
645 				    TX_MUX_CTL_HPF_BP_SEL_BYPASS);
646 		break;
647 	case SND_SOC_DAPM_POST_PMD:
648 		snd_soc_component_update_bits(component, dec_reset_reg, 1 << w->shift,
649 				    1 << w->shift);
650 		snd_soc_component_update_bits(component, dec_reset_reg, 1 << w->shift, 0x0);
651 		snd_soc_component_update_bits(component, tx_mux_ctl_reg,
652 				    TX_MUX_CTL_HPF_BP_SEL_MASK,
653 				    TX_MUX_CTL_HPF_BP_SEL_BYPASS);
654 		snd_soc_component_update_bits(component, tx_vol_ctl_reg,
655 				    TX_VOL_CTL_CFG_MUTE_EN_MASK, 0);
656 		break;
657 	}
658 
659 	return 0;
660 }
661 
662 static int msm8916_wcd_digital_enable_dmic(struct snd_soc_dapm_widget *w,
663 					   struct snd_kcontrol *kcontrol,
664 					   int event)
665 {
666 	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
667 	unsigned int dmic;
668 	int ret;
669 	/* get dmic number out of widget name */
670 	char *dmic_num = strpbrk(w->name, "12");
671 
672 	if (dmic_num == NULL) {
673 		dev_err(component->dev, "Invalid DMIC\n");
674 		return -EINVAL;
675 	}
676 	ret = kstrtouint(dmic_num, 10, &dmic);
677 	if (ret < 0 || dmic > 2) {
678 		dev_err(component->dev, "Invalid DMIC line on the component\n");
679 		return -EINVAL;
680 	}
681 
682 	switch (event) {
683 	case SND_SOC_DAPM_PRE_PMU:
684 		snd_soc_component_update_bits(component, LPASS_CDC_CLK_DMIC_B1_CTL,
685 				    DMIC_B1_CTL_DMIC0_CLK_SEL_MASK,
686 				    DMIC_B1_CTL_DMIC0_CLK_SEL_DIV3);
687 		switch (dmic) {
688 		case 1:
689 			snd_soc_component_update_bits(component, LPASS_CDC_TX1_DMIC_CTL,
690 					    TXN_DMIC_CTL_CLK_SEL_MASK,
691 					    TXN_DMIC_CTL_CLK_SEL_DIV3);
692 			break;
693 		case 2:
694 			snd_soc_component_update_bits(component, LPASS_CDC_TX2_DMIC_CTL,
695 					    TXN_DMIC_CTL_CLK_SEL_MASK,
696 					    TXN_DMIC_CTL_CLK_SEL_DIV3);
697 			break;
698 		}
699 		break;
700 	}
701 
702 	return 0;
703 }
704 
705 static const char * const iir_inp1_text[] = {
706 	"ZERO", "DEC1", "DEC2", "RX1", "RX2", "RX3"
707 };
708 
709 static const struct soc_enum iir1_inp1_mux_enum =
710 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_EQ1_B1_CTL,
711 		0, 6, iir_inp1_text);
712 
713 static const struct soc_enum iir2_inp1_mux_enum =
714 	SOC_ENUM_SINGLE(LPASS_CDC_CONN_EQ2_B1_CTL,
715 		0, 6, iir_inp1_text);
716 
717 static const struct snd_kcontrol_new iir1_inp1_mux =
718 	SOC_DAPM_ENUM("IIR1 INP1 Mux", iir1_inp1_mux_enum);
719 
720 static const struct snd_kcontrol_new iir2_inp1_mux =
721 	SOC_DAPM_ENUM("IIR2 INP1 Mux", iir2_inp1_mux_enum);
722 
723 static const struct snd_soc_dapm_widget msm8916_wcd_digital_dapm_widgets[] = {
724 	/*RX stuff */
725 	SND_SOC_DAPM_AIF_IN("I2S RX1", NULL, 0, SND_SOC_NOPM, 0, 0),
726 	SND_SOC_DAPM_AIF_IN("I2S RX2", NULL, 0, SND_SOC_NOPM, 0, 0),
727 	SND_SOC_DAPM_AIF_IN("I2S RX3", NULL, 0, SND_SOC_NOPM, 0, 0),
728 
729 	SND_SOC_DAPM_OUTPUT("PDM_RX1"),
730 	SND_SOC_DAPM_OUTPUT("PDM_RX2"),
731 	SND_SOC_DAPM_OUTPUT("PDM_RX3"),
732 
733 	SND_SOC_DAPM_INPUT("LPASS_PDM_TX"),
734 
735 	SND_SOC_DAPM_MIXER("RX1 MIX1", SND_SOC_NOPM, 0, 0, NULL, 0),
736 	SND_SOC_DAPM_MIXER("RX2 MIX1", SND_SOC_NOPM, 0, 0, NULL, 0),
737 	SND_SOC_DAPM_MIXER("RX3 MIX1", SND_SOC_NOPM, 0, 0, NULL, 0),
738 
739 	/* Interpolator */
740 	SND_SOC_DAPM_MIXER_E("RX1 INT", LPASS_CDC_CLK_RX_B1_CTL, 0, 0, NULL,
741 			     0, msm8916_wcd_digital_enable_interpolator,
742 			     SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
743 	SND_SOC_DAPM_MIXER_E("RX2 INT", LPASS_CDC_CLK_RX_B1_CTL, 1, 0, NULL,
744 			     0, msm8916_wcd_digital_enable_interpolator,
745 			     SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
746 	SND_SOC_DAPM_MIXER_E("RX3 INT", LPASS_CDC_CLK_RX_B1_CTL, 2, 0, NULL,
747 			     0, msm8916_wcd_digital_enable_interpolator,
748 			     SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
749 	SND_SOC_DAPM_MUX("RX1 MIX1 INP1", SND_SOC_NOPM, 0, 0,
750 			 &rx_mix1_inp1_mux),
751 	SND_SOC_DAPM_MUX("RX1 MIX1 INP2", SND_SOC_NOPM, 0, 0,
752 			 &rx_mix1_inp2_mux),
753 	SND_SOC_DAPM_MUX("RX1 MIX1 INP3", SND_SOC_NOPM, 0, 0,
754 			 &rx_mix1_inp3_mux),
755 	SND_SOC_DAPM_MUX("RX2 MIX1 INP1", SND_SOC_NOPM, 0, 0,
756 			 &rx2_mix1_inp1_mux),
757 	SND_SOC_DAPM_MUX("RX2 MIX1 INP2", SND_SOC_NOPM, 0, 0,
758 			 &rx2_mix1_inp2_mux),
759 	SND_SOC_DAPM_MUX("RX2 MIX1 INP3", SND_SOC_NOPM, 0, 0,
760 			 &rx2_mix1_inp3_mux),
761 	SND_SOC_DAPM_MUX("RX3 MIX1 INP1", SND_SOC_NOPM, 0, 0,
762 			 &rx3_mix1_inp1_mux),
763 	SND_SOC_DAPM_MUX("RX3 MIX1 INP2", SND_SOC_NOPM, 0, 0,
764 			 &rx3_mix1_inp2_mux),
765 	SND_SOC_DAPM_MUX("RX3 MIX1 INP3", SND_SOC_NOPM, 0, 0,
766 			 &rx3_mix1_inp3_mux),
767 	SND_SOC_DAPM_MUX("RX1 MIX2 INP1", SND_SOC_NOPM, 0, 0,
768 			 &rx1_mix2_inp1_mux),
769 	SND_SOC_DAPM_MUX("RX2 MIX2 INP1", SND_SOC_NOPM, 0, 0,
770 			 &rx2_mix2_inp1_mux),
771 
772 	SND_SOC_DAPM_MUX("CIC1 MUX", SND_SOC_NOPM, 0, 0, &cic1_mux),
773 	SND_SOC_DAPM_MUX("CIC2 MUX", SND_SOC_NOPM, 0, 0, &cic2_mux),
774 	/* TX */
775 	SND_SOC_DAPM_MIXER("ADC1", SND_SOC_NOPM, 0, 0, NULL, 0),
776 	SND_SOC_DAPM_MIXER("ADC2", SND_SOC_NOPM, 0, 0, NULL, 0),
777 	SND_SOC_DAPM_MIXER("ADC3", SND_SOC_NOPM, 0, 0, NULL, 0),
778 
779 	SND_SOC_DAPM_MUX_E("DEC1 MUX", LPASS_CDC_CLK_TX_CLK_EN_B1_CTL, 0, 0,
780 			   &dec1_mux, msm8916_wcd_digital_enable_dec,
781 			   SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
782 			   SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
783 	SND_SOC_DAPM_MUX_E("DEC2 MUX", LPASS_CDC_CLK_TX_CLK_EN_B1_CTL, 1, 0,
784 			   &dec2_mux, msm8916_wcd_digital_enable_dec,
785 			   SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
786 			   SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
787 	SND_SOC_DAPM_AIF_OUT("I2S TX1", NULL, 0, SND_SOC_NOPM, 0, 0),
788 	SND_SOC_DAPM_AIF_OUT("I2S TX2", NULL, 0, SND_SOC_NOPM, 0, 0),
789 	SND_SOC_DAPM_AIF_OUT("I2S TX3", NULL, 0, SND_SOC_NOPM, 0, 0),
790 
791 	/* Digital Mic Inputs */
792 	SND_SOC_DAPM_ADC_E("DMIC1", NULL, SND_SOC_NOPM, 0, 0,
793 			   msm8916_wcd_digital_enable_dmic,
794 			   SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
795 	SND_SOC_DAPM_ADC_E("DMIC2", NULL, SND_SOC_NOPM, 0, 0,
796 			   msm8916_wcd_digital_enable_dmic,
797 			   SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
798 	SND_SOC_DAPM_SUPPLY("DMIC_CLK", LPASS_CDC_CLK_DMIC_B1_CTL, 0, 0,
799 			    NULL, 0),
800 	SND_SOC_DAPM_SUPPLY("RX_I2S_CLK", LPASS_CDC_CLK_RX_I2S_CTL,
801 			    4, 0, NULL, 0),
802 	SND_SOC_DAPM_SUPPLY("TX_I2S_CLK", LPASS_CDC_CLK_TX_I2S_CTL, 4, 0,
803 			    NULL, 0),
804 
805 	SND_SOC_DAPM_SUPPLY("MCLK", SND_SOC_NOPM, 0, 0, NULL, 0),
806 	SND_SOC_DAPM_SUPPLY("PDM_CLK", LPASS_CDC_CLK_PDM_CTL, 0, 0, NULL, 0),
807 	/* Connectivity Clock */
808 	SND_SOC_DAPM_SUPPLY_S("CDC_CONN", -2, LPASS_CDC_CLK_OTHR_CTL, 2, 0,
809 			      NULL, 0),
810 	SND_SOC_DAPM_MIC("Digital Mic1", NULL),
811 	SND_SOC_DAPM_MIC("Digital Mic2", NULL),
812 
813 	/* Sidetone */
814 	SND_SOC_DAPM_MUX("IIR1 INP1 MUX", SND_SOC_NOPM, 0, 0, &iir1_inp1_mux),
815 	SND_SOC_DAPM_PGA_E("IIR1", LPASS_CDC_CLK_SD_CTL, 0, 0, NULL, 0,
816 		msm8x16_wcd_codec_set_iir_gain, SND_SOC_DAPM_POST_PMU),
817 
818 	SND_SOC_DAPM_MUX("IIR2 INP1 MUX", SND_SOC_NOPM, 0, 0, &iir2_inp1_mux),
819 	SND_SOC_DAPM_PGA_E("IIR2", LPASS_CDC_CLK_SD_CTL, 1, 0, NULL, 0,
820 		msm8x16_wcd_codec_set_iir_gain, SND_SOC_DAPM_POST_PMU),
821 
822 };
823 
824 static int msm8916_wcd_digital_get_clks(struct platform_device *pdev,
825 					struct msm8916_wcd_digital_priv	*priv)
826 {
827 	struct device *dev = &pdev->dev;
828 
829 	priv->ahbclk = devm_clk_get(dev, "ahbix-clk");
830 	if (IS_ERR(priv->ahbclk)) {
831 		dev_err(dev, "failed to get ahbix clk\n");
832 		return PTR_ERR(priv->ahbclk);
833 	}
834 
835 	priv->mclk = devm_clk_get(dev, "mclk");
836 	if (IS_ERR(priv->mclk)) {
837 		dev_err(dev, "failed to get mclk\n");
838 		return PTR_ERR(priv->mclk);
839 	}
840 
841 	return 0;
842 }
843 
844 static int msm8916_wcd_digital_component_probe(struct snd_soc_component *component)
845 {
846 	struct msm8916_wcd_digital_priv *priv = dev_get_drvdata(component->dev);
847 
848 	snd_soc_component_set_drvdata(component, priv);
849 
850 	return 0;
851 }
852 
853 static int msm8916_wcd_digital_component_set_sysclk(struct snd_soc_component *component,
854 						int clk_id, int source,
855 						unsigned int freq, int dir)
856 {
857 	struct msm8916_wcd_digital_priv *p = dev_get_drvdata(component->dev);
858 
859 	return clk_set_rate(p->mclk, freq);
860 }
861 
862 static int msm8916_wcd_digital_hw_params(struct snd_pcm_substream *substream,
863 					 struct snd_pcm_hw_params *params,
864 					 struct snd_soc_dai *dai)
865 {
866 	u8 tx_fs_rate;
867 	u8 rx_fs_rate;
868 
869 	switch (params_rate(params)) {
870 	case 8000:
871 		tx_fs_rate = TX_I2S_CTL_TX_I2S_FS_RATE_F_8_KHZ;
872 		rx_fs_rate = RX_I2S_CTL_RX_I2S_FS_RATE_F_8_KHZ;
873 		break;
874 	case 16000:
875 		tx_fs_rate = TX_I2S_CTL_TX_I2S_FS_RATE_F_16_KHZ;
876 		rx_fs_rate = RX_I2S_CTL_RX_I2S_FS_RATE_F_16_KHZ;
877 		break;
878 	case 32000:
879 		tx_fs_rate = TX_I2S_CTL_TX_I2S_FS_RATE_F_32_KHZ;
880 		rx_fs_rate = RX_I2S_CTL_RX_I2S_FS_RATE_F_32_KHZ;
881 		break;
882 	case 48000:
883 		tx_fs_rate = TX_I2S_CTL_TX_I2S_FS_RATE_F_48_KHZ;
884 		rx_fs_rate = RX_I2S_CTL_RX_I2S_FS_RATE_F_48_KHZ;
885 		break;
886 	default:
887 		dev_err(dai->component->dev, "Invalid sampling rate %d\n",
888 			params_rate(params));
889 		return -EINVAL;
890 	}
891 
892 	switch (substream->stream) {
893 	case SNDRV_PCM_STREAM_CAPTURE:
894 		snd_soc_component_update_bits(dai->component, LPASS_CDC_CLK_TX_I2S_CTL,
895 				    TX_I2S_CTL_TX_I2S_FS_RATE_MASK, tx_fs_rate);
896 		break;
897 	case SNDRV_PCM_STREAM_PLAYBACK:
898 		snd_soc_component_update_bits(dai->component, LPASS_CDC_CLK_RX_I2S_CTL,
899 				    RX_I2S_CTL_RX_I2S_FS_RATE_MASK, rx_fs_rate);
900 		break;
901 	default:
902 		return -EINVAL;
903 	}
904 
905 	switch (params_format(params)) {
906 	case SNDRV_PCM_FORMAT_S16_LE:
907 		snd_soc_component_update_bits(dai->component, LPASS_CDC_CLK_TX_I2S_CTL,
908 				    TX_I2S_CTL_TX_I2S_MODE_MASK,
909 				    TX_I2S_CTL_TX_I2S_MODE_16);
910 		snd_soc_component_update_bits(dai->component, LPASS_CDC_CLK_RX_I2S_CTL,
911 				    RX_I2S_CTL_RX_I2S_MODE_MASK,
912 				    RX_I2S_CTL_RX_I2S_MODE_16);
913 		break;
914 
915 	case SNDRV_PCM_FORMAT_S32_LE:
916 		snd_soc_component_update_bits(dai->component, LPASS_CDC_CLK_TX_I2S_CTL,
917 				    TX_I2S_CTL_TX_I2S_MODE_MASK,
918 				    TX_I2S_CTL_TX_I2S_MODE_32);
919 		snd_soc_component_update_bits(dai->component, LPASS_CDC_CLK_RX_I2S_CTL,
920 				    RX_I2S_CTL_RX_I2S_MODE_MASK,
921 				    RX_I2S_CTL_RX_I2S_MODE_32);
922 		break;
923 	default:
924 		dev_err(dai->dev, "%s: wrong format selected\n", __func__);
925 		return -EINVAL;
926 	}
927 
928 	return 0;
929 }
930 
931 static const struct snd_soc_dapm_route msm8916_wcd_digital_audio_map[] = {
932 
933 	{"I2S RX1",  NULL, "AIF1 Playback"},
934 	{"I2S RX2",  NULL, "AIF1 Playback"},
935 	{"I2S RX3",  NULL, "AIF1 Playback"},
936 
937 	{"AIF1 Capture", NULL, "I2S TX1"},
938 	{"AIF1 Capture", NULL, "I2S TX2"},
939 	{"AIF1 Capture", NULL, "I2S TX3"},
940 
941 	{"CIC1 MUX", "DMIC", "DEC1 MUX"},
942 	{"CIC1 MUX", "AMIC", "DEC1 MUX"},
943 	{"CIC2 MUX", "DMIC", "DEC2 MUX"},
944 	{"CIC2 MUX", "AMIC", "DEC2 MUX"},
945 
946 	/* Decimator Inputs */
947 	{"DEC1 MUX", "DMIC1", "DMIC1"},
948 	{"DEC1 MUX", "DMIC2", "DMIC2"},
949 	{"DEC1 MUX", "ADC1", "ADC1"},
950 	{"DEC1 MUX", "ADC2", "ADC2"},
951 	{"DEC1 MUX", "ADC3", "ADC3"},
952 	{"DEC1 MUX", NULL, "CDC_CONN"},
953 
954 	{"DEC2 MUX", "DMIC1", "DMIC1"},
955 	{"DEC2 MUX", "DMIC2", "DMIC2"},
956 	{"DEC2 MUX", "ADC1", "ADC1"},
957 	{"DEC2 MUX", "ADC2", "ADC2"},
958 	{"DEC2 MUX", "ADC3", "ADC3"},
959 	{"DEC2 MUX", NULL, "CDC_CONN"},
960 
961 	{"DMIC1", NULL, "DMIC_CLK"},
962 	{"DMIC2", NULL, "DMIC_CLK"},
963 
964 	{"I2S TX1", NULL, "CIC1 MUX"},
965 	{"I2S TX2", NULL, "CIC2 MUX"},
966 
967 	{"I2S TX1", NULL, "TX_I2S_CLK"},
968 	{"I2S TX2", NULL, "TX_I2S_CLK"},
969 
970 	{"TX_I2S_CLK", NULL, "MCLK"},
971 	{"TX_I2S_CLK", NULL, "PDM_CLK"},
972 
973 	{"ADC1", NULL, "LPASS_PDM_TX"},
974 	{"ADC2", NULL, "LPASS_PDM_TX"},
975 	{"ADC3", NULL, "LPASS_PDM_TX"},
976 
977 	{"I2S RX1", NULL, "RX_I2S_CLK"},
978 	{"I2S RX2", NULL, "RX_I2S_CLK"},
979 	{"I2S RX3", NULL, "RX_I2S_CLK"},
980 
981 	{"RX_I2S_CLK", NULL, "PDM_CLK"},
982 	{"RX_I2S_CLK", NULL, "MCLK"},
983 	{"RX_I2S_CLK", NULL, "CDC_CONN"},
984 
985 	/* RX1 PATH.. */
986 	{"PDM_RX1", NULL, "RX1 INT"},
987 	{"RX1 INT", NULL, "RX1 MIX1"},
988 
989 	{"RX1 MIX1", NULL, "RX1 MIX1 INP1"},
990 	{"RX1 MIX1", NULL, "RX1 MIX1 INP2"},
991 	{"RX1 MIX1", NULL, "RX1 MIX1 INP3"},
992 
993 	{"RX1 MIX1 INP1", "RX1", "I2S RX1"},
994 	{"RX1 MIX1 INP1", "RX2", "I2S RX2"},
995 	{"RX1 MIX1 INP1", "RX3", "I2S RX3"},
996 	{"RX1 MIX1 INP1", "IIR1", "IIR1"},
997 	{"RX1 MIX1 INP1", "IIR2", "IIR2"},
998 
999 	{"RX1 MIX1 INP2", "RX1", "I2S RX1"},
1000 	{"RX1 MIX1 INP2", "RX2", "I2S RX2"},
1001 	{"RX1 MIX1 INP2", "RX3", "I2S RX3"},
1002 	{"RX1 MIX1 INP2", "IIR1", "IIR1"},
1003 	{"RX1 MIX1 INP2", "IIR2", "IIR2"},
1004 
1005 	{"RX1 MIX1 INP3", "RX1", "I2S RX1"},
1006 	{"RX1 MIX1 INP3", "RX2", "I2S RX2"},
1007 	{"RX1 MIX1 INP3", "RX3", "I2S RX3"},
1008 
1009 	/* RX2 PATH */
1010 	{"PDM_RX2", NULL, "RX2 INT"},
1011 	{"RX2 INT", NULL, "RX2 MIX1"},
1012 
1013 	{"RX2 MIX1", NULL, "RX2 MIX1 INP1"},
1014 	{"RX2 MIX1", NULL, "RX2 MIX1 INP2"},
1015 	{"RX2 MIX1", NULL, "RX2 MIX1 INP3"},
1016 
1017 	{"RX2 MIX1 INP1", "RX1", "I2S RX1"},
1018 	{"RX2 MIX1 INP1", "RX2", "I2S RX2"},
1019 	{"RX2 MIX1 INP1", "RX3", "I2S RX3"},
1020 	{"RX2 MIX1 INP1", "IIR1", "IIR1"},
1021 	{"RX2 MIX1 INP1", "IIR2", "IIR2"},
1022 
1023 	{"RX2 MIX1 INP2", "RX1", "I2S RX1"},
1024 	{"RX2 MIX1 INP2", "RX2", "I2S RX2"},
1025 	{"RX2 MIX1 INP2", "RX3", "I2S RX3"},
1026 	{"RX2 MIX1 INP1", "IIR1", "IIR1"},
1027 	{"RX2 MIX1 INP1", "IIR2", "IIR2"},
1028 
1029 	{"RX2 MIX1 INP3", "RX1", "I2S RX1"},
1030 	{"RX2 MIX1 INP3", "RX2", "I2S RX2"},
1031 	{"RX2 MIX1 INP3", "RX3", "I2S RX3"},
1032 
1033 	/* RX3 PATH */
1034 	{"PDM_RX3", NULL, "RX3 INT"},
1035 	{"RX3 INT", NULL, "RX3 MIX1"},
1036 
1037 	{"RX3 MIX1", NULL, "RX3 MIX1 INP1"},
1038 	{"RX3 MIX1", NULL, "RX3 MIX1 INP2"},
1039 	{"RX3 MIX1", NULL, "RX3 MIX1 INP3"},
1040 
1041 	{"RX3 MIX1 INP1", "RX1", "I2S RX1"},
1042 	{"RX3 MIX1 INP1", "RX2", "I2S RX2"},
1043 	{"RX3 MIX1 INP1", "RX3", "I2S RX3"},
1044 	{"RX3 MIX1 INP1", "IIR1", "IIR1"},
1045 	{"RX3 MIX1 INP1", "IIR2", "IIR2"},
1046 
1047 	{"RX3 MIX1 INP2", "RX1", "I2S RX1"},
1048 	{"RX3 MIX1 INP2", "RX2", "I2S RX2"},
1049 	{"RX3 MIX1 INP2", "RX3", "I2S RX3"},
1050 	{"RX3 MIX1 INP2", "IIR1", "IIR1"},
1051 	{"RX3 MIX1 INP2", "IIR2", "IIR2"},
1052 
1053 	{"RX1 MIX2 INP1", "IIR1", "IIR1"},
1054 	{"RX2 MIX2 INP1", "IIR1", "IIR1"},
1055 	{"RX1 MIX2 INP1", "IIR2", "IIR2"},
1056 	{"RX2 MIX2 INP1", "IIR2", "IIR2"},
1057 
1058 	{"IIR1", NULL, "IIR1 INP1 MUX"},
1059 	{"IIR1 INP1 MUX", "DEC1", "DEC1 MUX"},
1060 	{"IIR1 INP1 MUX", "DEC2", "DEC2 MUX"},
1061 
1062 	{"IIR2", NULL, "IIR2 INP1 MUX"},
1063 	{"IIR2 INP1 MUX", "DEC1", "DEC1 MUX"},
1064 	{"IIR2 INP1 MUX", "DEC2", "DEC2 MUX"},
1065 
1066 	{"RX3 MIX1 INP3", "RX1", "I2S RX1"},
1067 	{"RX3 MIX1 INP3", "RX2", "I2S RX2"},
1068 	{"RX3 MIX1 INP3", "RX3", "I2S RX3"},
1069 
1070 };
1071 
1072 static int msm8916_wcd_digital_startup(struct snd_pcm_substream *substream,
1073 				       struct snd_soc_dai *dai)
1074 {
1075 	struct snd_soc_component *component = dai->component;
1076 	struct msm8916_wcd_digital_priv *msm8916_wcd;
1077 	unsigned long mclk_rate;
1078 
1079 	msm8916_wcd = snd_soc_component_get_drvdata(component);
1080 	snd_soc_component_update_bits(component, LPASS_CDC_CLK_MCLK_CTL,
1081 			    MCLK_CTL_MCLK_EN_MASK,
1082 			    MCLK_CTL_MCLK_EN_ENABLE);
1083 	snd_soc_component_update_bits(component, LPASS_CDC_CLK_PDM_CTL,
1084 			    LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_MASK,
1085 			    LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_FB);
1086 
1087 	mclk_rate = clk_get_rate(msm8916_wcd->mclk);
1088 	switch (mclk_rate) {
1089 	case 12288000:
1090 		snd_soc_component_update_bits(component, LPASS_CDC_TOP_CTL,
1091 				    TOP_CTL_DIG_MCLK_FREQ_MASK,
1092 				    TOP_CTL_DIG_MCLK_FREQ_F_12_288MHZ);
1093 		break;
1094 	case 9600000:
1095 		snd_soc_component_update_bits(component, LPASS_CDC_TOP_CTL,
1096 				    TOP_CTL_DIG_MCLK_FREQ_MASK,
1097 				    TOP_CTL_DIG_MCLK_FREQ_F_9_6MHZ);
1098 		break;
1099 	default:
1100 		dev_err(component->dev, "Invalid mclk rate %ld\n", mclk_rate);
1101 		break;
1102 	}
1103 	return 0;
1104 }
1105 
1106 static void msm8916_wcd_digital_shutdown(struct snd_pcm_substream *substream,
1107 					 struct snd_soc_dai *dai)
1108 {
1109 	snd_soc_component_update_bits(dai->component, LPASS_CDC_CLK_PDM_CTL,
1110 			    LPASS_CDC_CLK_PDM_CTL_PDM_CLK_SEL_MASK, 0);
1111 }
1112 
1113 static const struct snd_soc_dai_ops msm8916_wcd_digital_dai_ops = {
1114 	.startup = msm8916_wcd_digital_startup,
1115 	.shutdown = msm8916_wcd_digital_shutdown,
1116 	.hw_params = msm8916_wcd_digital_hw_params,
1117 };
1118 
1119 static struct snd_soc_dai_driver msm8916_wcd_digital_dai[] = {
1120 	[0] = {
1121 	       .name = "msm8916_wcd_digital_i2s_rx1",
1122 	       .id = 0,
1123 	       .playback = {
1124 			    .stream_name = "AIF1 Playback",
1125 			    .rates = MSM8916_WCD_DIGITAL_RATES,
1126 			    .formats = MSM8916_WCD_DIGITAL_FORMATS,
1127 			    .channels_min = 1,
1128 			    .channels_max = 3,
1129 			    },
1130 	       .ops = &msm8916_wcd_digital_dai_ops,
1131 	       },
1132 	[1] = {
1133 	       .name = "msm8916_wcd_digital_i2s_tx1",
1134 	       .id = 1,
1135 	       .capture = {
1136 			   .stream_name = "AIF1 Capture",
1137 			   .rates = MSM8916_WCD_DIGITAL_RATES,
1138 			   .formats = MSM8916_WCD_DIGITAL_FORMATS,
1139 			   .channels_min = 1,
1140 			   .channels_max = 4,
1141 			   },
1142 	       .ops = &msm8916_wcd_digital_dai_ops,
1143 	       },
1144 };
1145 
1146 static const struct snd_soc_component_driver msm8916_wcd_digital = {
1147 	.probe			= msm8916_wcd_digital_component_probe,
1148 	.set_sysclk		= msm8916_wcd_digital_component_set_sysclk,
1149 	.controls		= msm8916_wcd_digital_snd_controls,
1150 	.num_controls		= ARRAY_SIZE(msm8916_wcd_digital_snd_controls),
1151 	.dapm_widgets		= msm8916_wcd_digital_dapm_widgets,
1152 	.num_dapm_widgets	= ARRAY_SIZE(msm8916_wcd_digital_dapm_widgets),
1153 	.dapm_routes		= msm8916_wcd_digital_audio_map,
1154 	.num_dapm_routes	= ARRAY_SIZE(msm8916_wcd_digital_audio_map),
1155 	.idle_bias_on		= 1,
1156 	.use_pmdown_time	= 1,
1157 	.endianness		= 1,
1158 };
1159 
1160 static const struct regmap_config msm8916_codec_regmap_config = {
1161 	.reg_bits = 32,
1162 	.reg_stride = 4,
1163 	.val_bits = 32,
1164 	.max_register = LPASS_CDC_TX2_DMIC_CTL,
1165 	.cache_type = REGCACHE_FLAT,
1166 };
1167 
1168 static int msm8916_wcd_digital_probe(struct platform_device *pdev)
1169 {
1170 	struct msm8916_wcd_digital_priv *priv;
1171 	struct device *dev = &pdev->dev;
1172 	void __iomem *base;
1173 	struct regmap *digital_map;
1174 	int ret;
1175 
1176 	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
1177 	if (!priv)
1178 		return -ENOMEM;
1179 
1180 	base = devm_platform_ioremap_resource(pdev, 0);
1181 	if (IS_ERR(base))
1182 		return PTR_ERR(base);
1183 
1184 	digital_map =
1185 	    devm_regmap_init_mmio(&pdev->dev, base,
1186 				  &msm8916_codec_regmap_config);
1187 	if (IS_ERR(digital_map))
1188 		return PTR_ERR(digital_map);
1189 
1190 	ret = msm8916_wcd_digital_get_clks(pdev, priv);
1191 	if (ret < 0)
1192 		return ret;
1193 
1194 	ret = clk_prepare_enable(priv->ahbclk);
1195 	if (ret < 0) {
1196 		dev_err(dev, "failed to enable ahbclk %d\n", ret);
1197 		return ret;
1198 	}
1199 
1200 	ret = clk_prepare_enable(priv->mclk);
1201 	if (ret < 0) {
1202 		dev_err(dev, "failed to enable mclk %d\n", ret);
1203 		goto err_clk;
1204 	}
1205 
1206 	dev_set_drvdata(dev, priv);
1207 
1208 	ret = devm_snd_soc_register_component(dev, &msm8916_wcd_digital,
1209 				      msm8916_wcd_digital_dai,
1210 				      ARRAY_SIZE(msm8916_wcd_digital_dai));
1211 	if (ret)
1212 		goto err_mclk;
1213 
1214 	return 0;
1215 
1216 err_mclk:
1217 	clk_disable_unprepare(priv->mclk);
1218 err_clk:
1219 	clk_disable_unprepare(priv->ahbclk);
1220 	return ret;
1221 }
1222 
1223 static void msm8916_wcd_digital_remove(struct platform_device *pdev)
1224 {
1225 	struct msm8916_wcd_digital_priv *priv = dev_get_drvdata(&pdev->dev);
1226 
1227 	clk_disable_unprepare(priv->mclk);
1228 	clk_disable_unprepare(priv->ahbclk);
1229 }
1230 
1231 static const struct of_device_id msm8916_wcd_digital_match_table[] = {
1232 	{ .compatible = "qcom,msm8916-wcd-digital-codec" },
1233 	{ }
1234 };
1235 
1236 MODULE_DEVICE_TABLE(of, msm8916_wcd_digital_match_table);
1237 
1238 static struct platform_driver msm8916_wcd_digital_driver = {
1239 	.driver = {
1240 		   .name = "msm8916-wcd-digital-codec",
1241 		   .of_match_table = msm8916_wcd_digital_match_table,
1242 	},
1243 	.probe = msm8916_wcd_digital_probe,
1244 	.remove_new = msm8916_wcd_digital_remove,
1245 };
1246 
1247 module_platform_driver(msm8916_wcd_digital_driver);
1248 
1249 MODULE_AUTHOR("Srinivas Kandagatla <srinivas.kandagatla@linaro.org>");
1250 MODULE_DESCRIPTION("MSM8916 WCD Digital Codec driver");
1251 MODULE_LICENSE("GPL v2");
1252