• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * rt5670.c  --  RT5670 ALSA SoC audio codec driver
3  *
4  * Copyright 2014 Realtek Semiconductor Corp.
5  * Author: Bard Liao <bardliao@realtek.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  */
11 
12 #include <linux/module.h>
13 #include <linux/moduleparam.h>
14 #include <linux/init.h>
15 #include <linux/delay.h>
16 #include <linux/pm.h>
17 #include <linux/i2c.h>
18 #include <linux/platform_device.h>
19 #include <linux/spi/spi.h>
20 #include <sound/core.h>
21 #include <sound/pcm.h>
22 #include <sound/pcm_params.h>
23 #include <sound/jack.h>
24 #include <sound/soc.h>
25 #include <sound/soc-dapm.h>
26 #include <sound/initval.h>
27 #include <sound/tlv.h>
28 #include <sound/rt5670.h>
29 
30 #include "rl6231.h"
31 #include "rt5670.h"
32 #include "rt5670-dsp.h"
33 
34 #define RT5670_DEVICE_ID 0x6271
35 
36 #define RT5670_PR_RANGE_BASE (0xff + 1)
37 #define RT5670_PR_SPACING 0x100
38 
39 #define RT5670_PR_BASE (RT5670_PR_RANGE_BASE + (0 * RT5670_PR_SPACING))
40 
41 static const struct regmap_range_cfg rt5670_ranges[] = {
42 	{ .name = "PR", .range_min = RT5670_PR_BASE,
43 	  .range_max = RT5670_PR_BASE + 0xf8,
44 	  .selector_reg = RT5670_PRIV_INDEX,
45 	  .selector_mask = 0xff,
46 	  .selector_shift = 0x0,
47 	  .window_start = RT5670_PRIV_DATA,
48 	  .window_len = 0x1, },
49 };
50 
51 static struct reg_default init_list[] = {
52 	{ RT5670_PR_BASE + 0x14, 0x9a8a },
53 	{ RT5670_PR_BASE + 0x38, 0x3ba1 },
54 	{ RT5670_PR_BASE + 0x3d, 0x3640 },
55 };
56 #define RT5670_INIT_REG_LEN ARRAY_SIZE(init_list)
57 
58 static const struct reg_default rt5670_reg[] = {
59 	{ 0x00, 0x0000 },
60 	{ 0x02, 0x8888 },
61 	{ 0x03, 0x8888 },
62 	{ 0x0a, 0x0001 },
63 	{ 0x0b, 0x0827 },
64 	{ 0x0c, 0x0000 },
65 	{ 0x0d, 0x0008 },
66 	{ 0x0e, 0x0000 },
67 	{ 0x0f, 0x0808 },
68 	{ 0x19, 0xafaf },
69 	{ 0x1a, 0xafaf },
70 	{ 0x1b, 0x0011 },
71 	{ 0x1c, 0x2f2f },
72 	{ 0x1d, 0x2f2f },
73 	{ 0x1e, 0x0000 },
74 	{ 0x1f, 0x2f2f },
75 	{ 0x20, 0x0000 },
76 	{ 0x26, 0x7860 },
77 	{ 0x27, 0x7860 },
78 	{ 0x28, 0x7871 },
79 	{ 0x29, 0x8080 },
80 	{ 0x2a, 0x5656 },
81 	{ 0x2b, 0x5454 },
82 	{ 0x2c, 0xaaa0 },
83 	{ 0x2d, 0x0000 },
84 	{ 0x2e, 0x2f2f },
85 	{ 0x2f, 0x1002 },
86 	{ 0x30, 0x0000 },
87 	{ 0x31, 0x5f00 },
88 	{ 0x32, 0x0000 },
89 	{ 0x33, 0x0000 },
90 	{ 0x34, 0x0000 },
91 	{ 0x35, 0x0000 },
92 	{ 0x36, 0x0000 },
93 	{ 0x37, 0x0000 },
94 	{ 0x38, 0x0000 },
95 	{ 0x3b, 0x0000 },
96 	{ 0x3c, 0x007f },
97 	{ 0x3d, 0x0000 },
98 	{ 0x3e, 0x007f },
99 	{ 0x45, 0xe00f },
100 	{ 0x4c, 0x5380 },
101 	{ 0x4f, 0x0073 },
102 	{ 0x52, 0x00d3 },
103 	{ 0x53, 0xf000 },
104 	{ 0x61, 0x0000 },
105 	{ 0x62, 0x0001 },
106 	{ 0x63, 0x00c3 },
107 	{ 0x64, 0x0000 },
108 	{ 0x65, 0x0001 },
109 	{ 0x66, 0x0000 },
110 	{ 0x6f, 0x8000 },
111 	{ 0x70, 0x8000 },
112 	{ 0x71, 0x8000 },
113 	{ 0x72, 0x8000 },
114 	{ 0x73, 0x7770 },
115 	{ 0x74, 0x0e00 },
116 	{ 0x75, 0x1505 },
117 	{ 0x76, 0x0015 },
118 	{ 0x77, 0x0c00 },
119 	{ 0x78, 0x4000 },
120 	{ 0x79, 0x0123 },
121 	{ 0x7f, 0x1100 },
122 	{ 0x80, 0x0000 },
123 	{ 0x81, 0x0000 },
124 	{ 0x82, 0x0000 },
125 	{ 0x83, 0x0000 },
126 	{ 0x84, 0x0000 },
127 	{ 0x85, 0x0000 },
128 	{ 0x86, 0x0004 },
129 	{ 0x87, 0x0000 },
130 	{ 0x88, 0x0000 },
131 	{ 0x89, 0x0000 },
132 	{ 0x8a, 0x0000 },
133 	{ 0x8b, 0x0000 },
134 	{ 0x8c, 0x0003 },
135 	{ 0x8d, 0x0000 },
136 	{ 0x8e, 0x0004 },
137 	{ 0x8f, 0x1100 },
138 	{ 0x90, 0x0646 },
139 	{ 0x91, 0x0c06 },
140 	{ 0x93, 0x0000 },
141 	{ 0x94, 0x1270 },
142 	{ 0x95, 0x1000 },
143 	{ 0x97, 0x0000 },
144 	{ 0x98, 0x0000 },
145 	{ 0x99, 0x0000 },
146 	{ 0x9a, 0x2184 },
147 	{ 0x9b, 0x010a },
148 	{ 0x9c, 0x0aea },
149 	{ 0x9d, 0x000c },
150 	{ 0x9e, 0x0400 },
151 	{ 0xae, 0x7000 },
152 	{ 0xaf, 0x0000 },
153 	{ 0xb0, 0x7000 },
154 	{ 0xb1, 0x0000 },
155 	{ 0xb2, 0x0000 },
156 	{ 0xb3, 0x001f },
157 	{ 0xb4, 0x220c },
158 	{ 0xb5, 0x1f00 },
159 	{ 0xb6, 0x0000 },
160 	{ 0xb7, 0x0000 },
161 	{ 0xbb, 0x0000 },
162 	{ 0xbc, 0x0000 },
163 	{ 0xbd, 0x0000 },
164 	{ 0xbe, 0x0000 },
165 	{ 0xbf, 0x0000 },
166 	{ 0xc0, 0x0000 },
167 	{ 0xc1, 0x0000 },
168 	{ 0xc2, 0x0000 },
169 	{ 0xcd, 0x0000 },
170 	{ 0xce, 0x0000 },
171 	{ 0xcf, 0x1813 },
172 	{ 0xd0, 0x0690 },
173 	{ 0xd1, 0x1c17 },
174 	{ 0xd3, 0xa220 },
175 	{ 0xd4, 0x0000 },
176 	{ 0xd6, 0x0400 },
177 	{ 0xd9, 0x0809 },
178 	{ 0xda, 0x0000 },
179 	{ 0xdb, 0x0001 },
180 	{ 0xdc, 0x0049 },
181 	{ 0xdd, 0x0024 },
182 	{ 0xe6, 0x8000 },
183 	{ 0xe7, 0x0000 },
184 	{ 0xec, 0xa200 },
185 	{ 0xed, 0x0000 },
186 	{ 0xee, 0xa200 },
187 	{ 0xef, 0x0000 },
188 	{ 0xf8, 0x0000 },
189 	{ 0xf9, 0x0000 },
190 	{ 0xfa, 0x8010 },
191 	{ 0xfb, 0x0033 },
192 	{ 0xfc, 0x0100 },
193 };
194 
rt5670_volatile_register(struct device * dev,unsigned int reg)195 static bool rt5670_volatile_register(struct device *dev, unsigned int reg)
196 {
197 	int i;
198 
199 	for (i = 0; i < ARRAY_SIZE(rt5670_ranges); i++) {
200 		if ((reg >= rt5670_ranges[i].window_start &&
201 		     reg <= rt5670_ranges[i].window_start +
202 		     rt5670_ranges[i].window_len) ||
203 		    (reg >= rt5670_ranges[i].range_min &&
204 		     reg <= rt5670_ranges[i].range_max)) {
205 			return true;
206 		}
207 	}
208 
209 	switch (reg) {
210 	case RT5670_RESET:
211 	case RT5670_PDM_DATA_CTRL1:
212 	case RT5670_PDM1_DATA_CTRL4:
213 	case RT5670_PDM2_DATA_CTRL4:
214 	case RT5670_PRIV_DATA:
215 	case RT5670_ASRC_5:
216 	case RT5670_CJ_CTRL1:
217 	case RT5670_CJ_CTRL2:
218 	case RT5670_CJ_CTRL3:
219 	case RT5670_A_JD_CTRL1:
220 	case RT5670_A_JD_CTRL2:
221 	case RT5670_VAD_CTRL5:
222 	case RT5670_ADC_EQ_CTRL1:
223 	case RT5670_EQ_CTRL1:
224 	case RT5670_ALC_CTRL_1:
225 	case RT5670_IRQ_CTRL2:
226 	case RT5670_INT_IRQ_ST:
227 	case RT5670_IL_CMD:
228 	case RT5670_DSP_CTRL1:
229 	case RT5670_DSP_CTRL2:
230 	case RT5670_DSP_CTRL3:
231 	case RT5670_DSP_CTRL4:
232 	case RT5670_DSP_CTRL5:
233 	case RT5670_VENDOR_ID:
234 	case RT5670_VENDOR_ID1:
235 	case RT5670_VENDOR_ID2:
236 		return true;
237 	default:
238 		return false;
239 	}
240 }
241 
rt5670_readable_register(struct device * dev,unsigned int reg)242 static bool rt5670_readable_register(struct device *dev, unsigned int reg)
243 {
244 	int i;
245 
246 	for (i = 0; i < ARRAY_SIZE(rt5670_ranges); i++) {
247 		if ((reg >= rt5670_ranges[i].window_start &&
248 		     reg <= rt5670_ranges[i].window_start +
249 		     rt5670_ranges[i].window_len) ||
250 		    (reg >= rt5670_ranges[i].range_min &&
251 		     reg <= rt5670_ranges[i].range_max)) {
252 			return true;
253 		}
254 	}
255 
256 	switch (reg) {
257 	case RT5670_RESET:
258 	case RT5670_HP_VOL:
259 	case RT5670_LOUT1:
260 	case RT5670_CJ_CTRL1:
261 	case RT5670_CJ_CTRL2:
262 	case RT5670_CJ_CTRL3:
263 	case RT5670_IN2:
264 	case RT5670_INL1_INR1_VOL:
265 	case RT5670_DAC1_DIG_VOL:
266 	case RT5670_DAC2_DIG_VOL:
267 	case RT5670_DAC_CTRL:
268 	case RT5670_STO1_ADC_DIG_VOL:
269 	case RT5670_MONO_ADC_DIG_VOL:
270 	case RT5670_STO2_ADC_DIG_VOL:
271 	case RT5670_ADC_BST_VOL1:
272 	case RT5670_ADC_BST_VOL2:
273 	case RT5670_STO2_ADC_MIXER:
274 	case RT5670_STO1_ADC_MIXER:
275 	case RT5670_MONO_ADC_MIXER:
276 	case RT5670_AD_DA_MIXER:
277 	case RT5670_STO_DAC_MIXER:
278 	case RT5670_DD_MIXER:
279 	case RT5670_DIG_MIXER:
280 	case RT5670_DSP_PATH1:
281 	case RT5670_DSP_PATH2:
282 	case RT5670_DIG_INF1_DATA:
283 	case RT5670_DIG_INF2_DATA:
284 	case RT5670_PDM_OUT_CTRL:
285 	case RT5670_PDM_DATA_CTRL1:
286 	case RT5670_PDM1_DATA_CTRL2:
287 	case RT5670_PDM1_DATA_CTRL3:
288 	case RT5670_PDM1_DATA_CTRL4:
289 	case RT5670_PDM2_DATA_CTRL2:
290 	case RT5670_PDM2_DATA_CTRL3:
291 	case RT5670_PDM2_DATA_CTRL4:
292 	case RT5670_REC_L1_MIXER:
293 	case RT5670_REC_L2_MIXER:
294 	case RT5670_REC_R1_MIXER:
295 	case RT5670_REC_R2_MIXER:
296 	case RT5670_HPO_MIXER:
297 	case RT5670_MONO_MIXER:
298 	case RT5670_OUT_L1_MIXER:
299 	case RT5670_OUT_R1_MIXER:
300 	case RT5670_LOUT_MIXER:
301 	case RT5670_PWR_DIG1:
302 	case RT5670_PWR_DIG2:
303 	case RT5670_PWR_ANLG1:
304 	case RT5670_PWR_ANLG2:
305 	case RT5670_PWR_MIXER:
306 	case RT5670_PWR_VOL:
307 	case RT5670_PRIV_INDEX:
308 	case RT5670_PRIV_DATA:
309 	case RT5670_I2S4_SDP:
310 	case RT5670_I2S1_SDP:
311 	case RT5670_I2S2_SDP:
312 	case RT5670_I2S3_SDP:
313 	case RT5670_ADDA_CLK1:
314 	case RT5670_ADDA_CLK2:
315 	case RT5670_DMIC_CTRL1:
316 	case RT5670_DMIC_CTRL2:
317 	case RT5670_TDM_CTRL_1:
318 	case RT5670_TDM_CTRL_2:
319 	case RT5670_TDM_CTRL_3:
320 	case RT5670_DSP_CLK:
321 	case RT5670_GLB_CLK:
322 	case RT5670_PLL_CTRL1:
323 	case RT5670_PLL_CTRL2:
324 	case RT5670_ASRC_1:
325 	case RT5670_ASRC_2:
326 	case RT5670_ASRC_3:
327 	case RT5670_ASRC_4:
328 	case RT5670_ASRC_5:
329 	case RT5670_ASRC_7:
330 	case RT5670_ASRC_8:
331 	case RT5670_ASRC_9:
332 	case RT5670_ASRC_10:
333 	case RT5670_ASRC_11:
334 	case RT5670_ASRC_12:
335 	case RT5670_ASRC_13:
336 	case RT5670_ASRC_14:
337 	case RT5670_DEPOP_M1:
338 	case RT5670_DEPOP_M2:
339 	case RT5670_DEPOP_M3:
340 	case RT5670_CHARGE_PUMP:
341 	case RT5670_MICBIAS:
342 	case RT5670_A_JD_CTRL1:
343 	case RT5670_A_JD_CTRL2:
344 	case RT5670_VAD_CTRL1:
345 	case RT5670_VAD_CTRL2:
346 	case RT5670_VAD_CTRL3:
347 	case RT5670_VAD_CTRL4:
348 	case RT5670_VAD_CTRL5:
349 	case RT5670_ADC_EQ_CTRL1:
350 	case RT5670_ADC_EQ_CTRL2:
351 	case RT5670_EQ_CTRL1:
352 	case RT5670_EQ_CTRL2:
353 	case RT5670_ALC_DRC_CTRL1:
354 	case RT5670_ALC_DRC_CTRL2:
355 	case RT5670_ALC_CTRL_1:
356 	case RT5670_ALC_CTRL_2:
357 	case RT5670_ALC_CTRL_3:
358 	case RT5670_JD_CTRL:
359 	case RT5670_IRQ_CTRL1:
360 	case RT5670_IRQ_CTRL2:
361 	case RT5670_INT_IRQ_ST:
362 	case RT5670_GPIO_CTRL1:
363 	case RT5670_GPIO_CTRL2:
364 	case RT5670_GPIO_CTRL3:
365 	case RT5670_SCRABBLE_FUN:
366 	case RT5670_SCRABBLE_CTRL:
367 	case RT5670_BASE_BACK:
368 	case RT5670_MP3_PLUS1:
369 	case RT5670_MP3_PLUS2:
370 	case RT5670_ADJ_HPF1:
371 	case RT5670_ADJ_HPF2:
372 	case RT5670_HP_CALIB_AMP_DET:
373 	case RT5670_SV_ZCD1:
374 	case RT5670_SV_ZCD2:
375 	case RT5670_IL_CMD:
376 	case RT5670_IL_CMD2:
377 	case RT5670_IL_CMD3:
378 	case RT5670_DRC_HL_CTRL1:
379 	case RT5670_DRC_HL_CTRL2:
380 	case RT5670_ADC_MONO_HP_CTRL1:
381 	case RT5670_ADC_MONO_HP_CTRL2:
382 	case RT5670_ADC_STO2_HP_CTRL1:
383 	case RT5670_ADC_STO2_HP_CTRL2:
384 	case RT5670_JD_CTRL3:
385 	case RT5670_JD_CTRL4:
386 	case RT5670_DIG_MISC:
387 	case RT5670_DSP_CTRL1:
388 	case RT5670_DSP_CTRL2:
389 	case RT5670_DSP_CTRL3:
390 	case RT5670_DSP_CTRL4:
391 	case RT5670_DSP_CTRL5:
392 	case RT5670_GEN_CTRL2:
393 	case RT5670_GEN_CTRL3:
394 	case RT5670_VENDOR_ID:
395 	case RT5670_VENDOR_ID1:
396 	case RT5670_VENDOR_ID2:
397 		return true;
398 	default:
399 		return false;
400 	}
401 }
402 
403 static const DECLARE_TLV_DB_SCALE(out_vol_tlv, -4650, 150, 0);
404 static const DECLARE_TLV_DB_SCALE(dac_vol_tlv, -65625, 375, 0);
405 static const DECLARE_TLV_DB_SCALE(in_vol_tlv, -3450, 150, 0);
406 static const DECLARE_TLV_DB_SCALE(adc_vol_tlv, -17625, 375, 0);
407 static const DECLARE_TLV_DB_SCALE(adc_bst_tlv, 0, 1200, 0);
408 
409 /* {0, +20, +24, +30, +35, +40, +44, +50, +52} dB */
410 static unsigned int bst_tlv[] = {
411 	TLV_DB_RANGE_HEAD(7),
412 	0, 0, TLV_DB_SCALE_ITEM(0, 0, 0),
413 	1, 1, TLV_DB_SCALE_ITEM(2000, 0, 0),
414 	2, 2, TLV_DB_SCALE_ITEM(2400, 0, 0),
415 	3, 5, TLV_DB_SCALE_ITEM(3000, 500, 0),
416 	6, 6, TLV_DB_SCALE_ITEM(4400, 0, 0),
417 	7, 7, TLV_DB_SCALE_ITEM(5000, 0, 0),
418 	8, 8, TLV_DB_SCALE_ITEM(5200, 0, 0),
419 };
420 
421 /* Interface data select */
422 static const char * const rt5670_data_select[] = {
423 	"Normal", "Swap", "left copy to right", "right copy to left"
424 };
425 
426 static SOC_ENUM_SINGLE_DECL(rt5670_if2_dac_enum, RT5670_DIG_INF1_DATA,
427 				RT5670_IF2_DAC_SEL_SFT, rt5670_data_select);
428 
429 static SOC_ENUM_SINGLE_DECL(rt5670_if2_adc_enum, RT5670_DIG_INF1_DATA,
430 				RT5670_IF2_ADC_SEL_SFT, rt5670_data_select);
431 
432 static const struct snd_kcontrol_new rt5670_snd_controls[] = {
433 	/* Headphone Output Volume */
434 	SOC_DOUBLE("HP Playback Switch", RT5670_HP_VOL,
435 		RT5670_L_MUTE_SFT, RT5670_R_MUTE_SFT, 1, 1),
436 	SOC_DOUBLE_TLV("HP Playback Volume", RT5670_HP_VOL,
437 		RT5670_L_VOL_SFT, RT5670_R_VOL_SFT,
438 		39, 0, out_vol_tlv),
439 	/* OUTPUT Control */
440 	SOC_DOUBLE("OUT Channel Switch", RT5670_LOUT1,
441 		RT5670_VOL_L_SFT, RT5670_VOL_R_SFT, 1, 1),
442 	SOC_DOUBLE_TLV("OUT Playback Volume", RT5670_LOUT1,
443 		RT5670_L_VOL_SFT, RT5670_R_VOL_SFT, 39, 1, out_vol_tlv),
444 	/* DAC Digital Volume */
445 	SOC_DOUBLE("DAC2 Playback Switch", RT5670_DAC_CTRL,
446 		RT5670_M_DAC_L2_VOL_SFT, RT5670_M_DAC_R2_VOL_SFT, 1, 1),
447 	SOC_DOUBLE_TLV("DAC1 Playback Volume", RT5670_DAC1_DIG_VOL,
448 			RT5670_L_VOL_SFT, RT5670_R_VOL_SFT,
449 			175, 0, dac_vol_tlv),
450 	SOC_DOUBLE_TLV("Mono DAC Playback Volume", RT5670_DAC2_DIG_VOL,
451 			RT5670_L_VOL_SFT, RT5670_R_VOL_SFT,
452 			175, 0, dac_vol_tlv),
453 	/* IN1/IN2 Control */
454 	SOC_SINGLE_TLV("IN1 Boost Volume", RT5670_CJ_CTRL1,
455 		RT5670_BST_SFT1, 8, 0, bst_tlv),
456 	SOC_SINGLE_TLV("IN2 Boost Volume", RT5670_IN2,
457 		RT5670_BST_SFT1, 8, 0, bst_tlv),
458 	/* INL/INR Volume Control */
459 	SOC_DOUBLE_TLV("IN Capture Volume", RT5670_INL1_INR1_VOL,
460 			RT5670_INL_VOL_SFT, RT5670_INR_VOL_SFT,
461 			31, 1, in_vol_tlv),
462 	/* ADC Digital Volume Control */
463 	SOC_DOUBLE("ADC Capture Switch", RT5670_STO1_ADC_DIG_VOL,
464 		RT5670_L_MUTE_SFT, RT5670_R_MUTE_SFT, 1, 1),
465 	SOC_DOUBLE_TLV("ADC Capture Volume", RT5670_STO1_ADC_DIG_VOL,
466 			RT5670_L_VOL_SFT, RT5670_R_VOL_SFT,
467 			127, 0, adc_vol_tlv),
468 
469 	SOC_DOUBLE_TLV("Mono ADC Capture Volume", RT5670_MONO_ADC_DIG_VOL,
470 			RT5670_L_VOL_SFT, RT5670_R_VOL_SFT,
471 			127, 0, adc_vol_tlv),
472 
473 	/* ADC Boost Volume Control */
474 	SOC_DOUBLE_TLV("STO1 ADC Boost Gain Volume", RT5670_ADC_BST_VOL1,
475 			RT5670_STO1_ADC_L_BST_SFT, RT5670_STO1_ADC_R_BST_SFT,
476 			3, 0, adc_bst_tlv),
477 
478 	SOC_DOUBLE_TLV("STO2 ADC Boost Gain Volume", RT5670_ADC_BST_VOL1,
479 			RT5670_STO2_ADC_L_BST_SFT, RT5670_STO2_ADC_R_BST_SFT,
480 			3, 0, adc_bst_tlv),
481 
482 	SOC_ENUM("ADC IF2 Data Switch", rt5670_if2_adc_enum),
483 	SOC_ENUM("DAC IF2 Data Switch", rt5670_if2_dac_enum),
484 };
485 
486 /**
487  * set_dmic_clk - Set parameter of dmic.
488  *
489  * @w: DAPM widget.
490  * @kcontrol: The kcontrol of this widget.
491  * @event: Event id.
492  *
493  * Choose dmic clock between 1MHz and 3MHz.
494  * It is better for clock to approximate 3MHz.
495  */
set_dmic_clk(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)496 static int set_dmic_clk(struct snd_soc_dapm_widget *w,
497 	struct snd_kcontrol *kcontrol, int event)
498 {
499 	struct snd_soc_codec *codec = w->codec;
500 	struct rt5670_priv *rt5670 = snd_soc_codec_get_drvdata(codec);
501 	int idx = -EINVAL;
502 
503 	idx = rl6231_calc_dmic_clk(rt5670->sysclk);
504 
505 	if (idx < 0)
506 		dev_err(codec->dev, "Failed to set DMIC clock\n");
507 	else
508 		snd_soc_update_bits(codec, RT5670_DMIC_CTRL1,
509 			RT5670_DMIC_CLK_MASK, idx << RT5670_DMIC_CLK_SFT);
510 	return idx;
511 }
512 
is_sys_clk_from_pll(struct snd_soc_dapm_widget * source,struct snd_soc_dapm_widget * sink)513 static int is_sys_clk_from_pll(struct snd_soc_dapm_widget *source,
514 			 struct snd_soc_dapm_widget *sink)
515 {
516 	unsigned int val;
517 
518 	val = snd_soc_read(source->codec, RT5670_GLB_CLK);
519 	val &= RT5670_SCLK_SRC_MASK;
520 	if (val == RT5670_SCLK_SRC_PLL1)
521 		return 1;
522 	else
523 		return 0;
524 }
525 
is_using_asrc(struct snd_soc_dapm_widget * source,struct snd_soc_dapm_widget * sink)526 static int is_using_asrc(struct snd_soc_dapm_widget *source,
527 			 struct snd_soc_dapm_widget *sink)
528 {
529 	unsigned int reg, shift, val;
530 
531 	switch (source->shift) {
532 	case 0:
533 		reg = RT5670_ASRC_3;
534 		shift = 0;
535 		break;
536 	case 1:
537 		reg = RT5670_ASRC_3;
538 		shift = 4;
539 		break;
540 	case 2:
541 		reg = RT5670_ASRC_5;
542 		shift = 12;
543 		break;
544 	case 3:
545 		reg = RT5670_ASRC_2;
546 		shift = 0;
547 		break;
548 	case 8:
549 		reg = RT5670_ASRC_2;
550 		shift = 4;
551 		break;
552 	case 9:
553 		reg = RT5670_ASRC_2;
554 		shift = 8;
555 		break;
556 	case 10:
557 		reg = RT5670_ASRC_2;
558 		shift = 12;
559 		break;
560 	default:
561 		return 0;
562 	}
563 
564 	val = (snd_soc_read(source->codec, reg) >> shift) & 0xf;
565 	switch (val) {
566 	case 1:
567 	case 2:
568 	case 3:
569 	case 4:
570 		return 1;
571 	default:
572 		return 0;
573 	}
574 
575 }
576 
577 /* Digital Mixer */
578 static const struct snd_kcontrol_new rt5670_sto1_adc_l_mix[] = {
579 	SOC_DAPM_SINGLE("ADC1 Switch", RT5670_STO1_ADC_MIXER,
580 			RT5670_M_ADC_L1_SFT, 1, 1),
581 	SOC_DAPM_SINGLE("ADC2 Switch", RT5670_STO1_ADC_MIXER,
582 			RT5670_M_ADC_L2_SFT, 1, 1),
583 };
584 
585 static const struct snd_kcontrol_new rt5670_sto1_adc_r_mix[] = {
586 	SOC_DAPM_SINGLE("ADC1 Switch", RT5670_STO1_ADC_MIXER,
587 			RT5670_M_ADC_R1_SFT, 1, 1),
588 	SOC_DAPM_SINGLE("ADC2 Switch", RT5670_STO1_ADC_MIXER,
589 			RT5670_M_ADC_R2_SFT, 1, 1),
590 };
591 
592 static const struct snd_kcontrol_new rt5670_sto2_adc_l_mix[] = {
593 	SOC_DAPM_SINGLE("ADC1 Switch", RT5670_STO2_ADC_MIXER,
594 			RT5670_M_ADC_L1_SFT, 1, 1),
595 	SOC_DAPM_SINGLE("ADC2 Switch", RT5670_STO2_ADC_MIXER,
596 			RT5670_M_ADC_L2_SFT, 1, 1),
597 };
598 
599 static const struct snd_kcontrol_new rt5670_sto2_adc_r_mix[] = {
600 	SOC_DAPM_SINGLE("ADC1 Switch", RT5670_STO2_ADC_MIXER,
601 			RT5670_M_ADC_R1_SFT, 1, 1),
602 	SOC_DAPM_SINGLE("ADC2 Switch", RT5670_STO2_ADC_MIXER,
603 			RT5670_M_ADC_R2_SFT, 1, 1),
604 };
605 
606 static const struct snd_kcontrol_new rt5670_mono_adc_l_mix[] = {
607 	SOC_DAPM_SINGLE("ADC1 Switch", RT5670_MONO_ADC_MIXER,
608 			RT5670_M_MONO_ADC_L1_SFT, 1, 1),
609 	SOC_DAPM_SINGLE("ADC2 Switch", RT5670_MONO_ADC_MIXER,
610 			RT5670_M_MONO_ADC_L2_SFT, 1, 1),
611 };
612 
613 static const struct snd_kcontrol_new rt5670_mono_adc_r_mix[] = {
614 	SOC_DAPM_SINGLE("ADC1 Switch", RT5670_MONO_ADC_MIXER,
615 			RT5670_M_MONO_ADC_R1_SFT, 1, 1),
616 	SOC_DAPM_SINGLE("ADC2 Switch", RT5670_MONO_ADC_MIXER,
617 			RT5670_M_MONO_ADC_R2_SFT, 1, 1),
618 };
619 
620 static const struct snd_kcontrol_new rt5670_dac_l_mix[] = {
621 	SOC_DAPM_SINGLE("Stereo ADC Switch", RT5670_AD_DA_MIXER,
622 			RT5670_M_ADCMIX_L_SFT, 1, 1),
623 	SOC_DAPM_SINGLE("DAC1 Switch", RT5670_AD_DA_MIXER,
624 			RT5670_M_DAC1_L_SFT, 1, 1),
625 };
626 
627 static const struct snd_kcontrol_new rt5670_dac_r_mix[] = {
628 	SOC_DAPM_SINGLE("Stereo ADC Switch", RT5670_AD_DA_MIXER,
629 			RT5670_M_ADCMIX_R_SFT, 1, 1),
630 	SOC_DAPM_SINGLE("DAC1 Switch", RT5670_AD_DA_MIXER,
631 			RT5670_M_DAC1_R_SFT, 1, 1),
632 };
633 
634 static const struct snd_kcontrol_new rt5670_sto_dac_l_mix[] = {
635 	SOC_DAPM_SINGLE("DAC L1 Switch", RT5670_STO_DAC_MIXER,
636 			RT5670_M_DAC_L1_SFT, 1, 1),
637 	SOC_DAPM_SINGLE("DAC L2 Switch", RT5670_STO_DAC_MIXER,
638 			RT5670_M_DAC_L2_SFT, 1, 1),
639 	SOC_DAPM_SINGLE("DAC R1 Switch", RT5670_STO_DAC_MIXER,
640 			RT5670_M_DAC_R1_STO_L_SFT, 1, 1),
641 };
642 
643 static const struct snd_kcontrol_new rt5670_sto_dac_r_mix[] = {
644 	SOC_DAPM_SINGLE("DAC R1 Switch", RT5670_STO_DAC_MIXER,
645 			RT5670_M_DAC_R1_SFT, 1, 1),
646 	SOC_DAPM_SINGLE("DAC R2 Switch", RT5670_STO_DAC_MIXER,
647 			RT5670_M_DAC_R2_SFT, 1, 1),
648 	SOC_DAPM_SINGLE("DAC L1 Switch", RT5670_STO_DAC_MIXER,
649 			RT5670_M_DAC_L1_STO_R_SFT, 1, 1),
650 };
651 
652 static const struct snd_kcontrol_new rt5670_mono_dac_l_mix[] = {
653 	SOC_DAPM_SINGLE("DAC L1 Switch", RT5670_DD_MIXER,
654 			RT5670_M_DAC_L1_MONO_L_SFT, 1, 1),
655 	SOC_DAPM_SINGLE("DAC L2 Switch", RT5670_DD_MIXER,
656 			RT5670_M_DAC_L2_MONO_L_SFT, 1, 1),
657 	SOC_DAPM_SINGLE("DAC R2 Switch", RT5670_DD_MIXER,
658 			RT5670_M_DAC_R2_MONO_L_SFT, 1, 1),
659 };
660 
661 static const struct snd_kcontrol_new rt5670_mono_dac_r_mix[] = {
662 	SOC_DAPM_SINGLE("DAC R1 Switch", RT5670_DD_MIXER,
663 			RT5670_M_DAC_R1_MONO_R_SFT, 1, 1),
664 	SOC_DAPM_SINGLE("DAC R2 Switch", RT5670_DD_MIXER,
665 			RT5670_M_DAC_R2_MONO_R_SFT, 1, 1),
666 	SOC_DAPM_SINGLE("DAC L2 Switch", RT5670_DD_MIXER,
667 			RT5670_M_DAC_L2_MONO_R_SFT, 1, 1),
668 };
669 
670 static const struct snd_kcontrol_new rt5670_dig_l_mix[] = {
671 	SOC_DAPM_SINGLE("Sto DAC Mix L Switch", RT5670_DIG_MIXER,
672 			RT5670_M_STO_L_DAC_L_SFT, 1, 1),
673 	SOC_DAPM_SINGLE("DAC L2 Switch", RT5670_DIG_MIXER,
674 			RT5670_M_DAC_L2_DAC_L_SFT, 1, 1),
675 	SOC_DAPM_SINGLE("DAC R2 Switch", RT5670_DIG_MIXER,
676 			RT5670_M_DAC_R2_DAC_L_SFT, 1, 1),
677 };
678 
679 static const struct snd_kcontrol_new rt5670_dig_r_mix[] = {
680 	SOC_DAPM_SINGLE("Sto DAC Mix R Switch", RT5670_DIG_MIXER,
681 			RT5670_M_STO_R_DAC_R_SFT, 1, 1),
682 	SOC_DAPM_SINGLE("DAC R2 Switch", RT5670_DIG_MIXER,
683 			RT5670_M_DAC_R2_DAC_R_SFT, 1, 1),
684 	SOC_DAPM_SINGLE("DAC L2 Switch", RT5670_DIG_MIXER,
685 			RT5670_M_DAC_L2_DAC_R_SFT, 1, 1),
686 };
687 
688 /* Analog Input Mixer */
689 static const struct snd_kcontrol_new rt5670_rec_l_mix[] = {
690 	SOC_DAPM_SINGLE("INL Switch", RT5670_REC_L2_MIXER,
691 			RT5670_M_IN_L_RM_L_SFT, 1, 1),
692 	SOC_DAPM_SINGLE("BST2 Switch", RT5670_REC_L2_MIXER,
693 			RT5670_M_BST2_RM_L_SFT, 1, 1),
694 	SOC_DAPM_SINGLE("BST1 Switch", RT5670_REC_L2_MIXER,
695 			RT5670_M_BST1_RM_L_SFT, 1, 1),
696 };
697 
698 static const struct snd_kcontrol_new rt5670_rec_r_mix[] = {
699 	SOC_DAPM_SINGLE("INR Switch", RT5670_REC_R2_MIXER,
700 			RT5670_M_IN_R_RM_R_SFT, 1, 1),
701 	SOC_DAPM_SINGLE("BST2 Switch", RT5670_REC_R2_MIXER,
702 			RT5670_M_BST2_RM_R_SFT, 1, 1),
703 	SOC_DAPM_SINGLE("BST1 Switch", RT5670_REC_R2_MIXER,
704 			RT5670_M_BST1_RM_R_SFT, 1, 1),
705 };
706 
707 static const struct snd_kcontrol_new rt5670_out_l_mix[] = {
708 	SOC_DAPM_SINGLE("BST1 Switch", RT5670_OUT_L1_MIXER,
709 			RT5670_M_BST1_OM_L_SFT, 1, 1),
710 	SOC_DAPM_SINGLE("INL Switch", RT5670_OUT_L1_MIXER,
711 			RT5670_M_IN_L_OM_L_SFT, 1, 1),
712 	SOC_DAPM_SINGLE("DAC L2 Switch", RT5670_OUT_L1_MIXER,
713 			RT5670_M_DAC_L2_OM_L_SFT, 1, 1),
714 	SOC_DAPM_SINGLE("DAC L1 Switch", RT5670_OUT_L1_MIXER,
715 			RT5670_M_DAC_L1_OM_L_SFT, 1, 1),
716 };
717 
718 static const struct snd_kcontrol_new rt5670_out_r_mix[] = {
719 	SOC_DAPM_SINGLE("BST2 Switch", RT5670_OUT_R1_MIXER,
720 			RT5670_M_BST2_OM_R_SFT, 1, 1),
721 	SOC_DAPM_SINGLE("INR Switch", RT5670_OUT_R1_MIXER,
722 			RT5670_M_IN_R_OM_R_SFT, 1, 1),
723 	SOC_DAPM_SINGLE("DAC R2 Switch", RT5670_OUT_R1_MIXER,
724 			RT5670_M_DAC_R2_OM_R_SFT, 1, 1),
725 	SOC_DAPM_SINGLE("DAC R1 Switch", RT5670_OUT_R1_MIXER,
726 			RT5670_M_DAC_R1_OM_R_SFT, 1, 1),
727 };
728 
729 static const struct snd_kcontrol_new rt5670_hpo_mix[] = {
730 	SOC_DAPM_SINGLE("DAC1 Switch", RT5670_HPO_MIXER,
731 			RT5670_M_DAC1_HM_SFT, 1, 1),
732 	SOC_DAPM_SINGLE("HPVOL Switch", RT5670_HPO_MIXER,
733 			RT5670_M_HPVOL_HM_SFT, 1, 1),
734 };
735 
736 static const struct snd_kcontrol_new rt5670_hpvoll_mix[] = {
737 	SOC_DAPM_SINGLE("DAC1 Switch", RT5670_HPO_MIXER,
738 			RT5670_M_DACL1_HML_SFT, 1, 1),
739 	SOC_DAPM_SINGLE("INL Switch", RT5670_HPO_MIXER,
740 			RT5670_M_INL1_HML_SFT, 1, 1),
741 };
742 
743 static const struct snd_kcontrol_new rt5670_hpvolr_mix[] = {
744 	SOC_DAPM_SINGLE("DAC1 Switch", RT5670_HPO_MIXER,
745 			RT5670_M_DACR1_HMR_SFT, 1, 1),
746 	SOC_DAPM_SINGLE("INR Switch", RT5670_HPO_MIXER,
747 			RT5670_M_INR1_HMR_SFT, 1, 1),
748 };
749 
750 static const struct snd_kcontrol_new rt5670_lout_mix[] = {
751 	SOC_DAPM_SINGLE("DAC L1 Switch", RT5670_LOUT_MIXER,
752 			RT5670_M_DAC_L1_LM_SFT, 1, 1),
753 	SOC_DAPM_SINGLE("DAC R1 Switch", RT5670_LOUT_MIXER,
754 			RT5670_M_DAC_R1_LM_SFT, 1, 1),
755 	SOC_DAPM_SINGLE("OUTMIX L Switch", RT5670_LOUT_MIXER,
756 			RT5670_M_OV_L_LM_SFT, 1, 1),
757 	SOC_DAPM_SINGLE("OUTMIX R Switch", RT5670_LOUT_MIXER,
758 			RT5670_M_OV_R_LM_SFT, 1, 1),
759 };
760 
761 static const struct snd_kcontrol_new rt5670_hpl_mix[] = {
762 	SOC_DAPM_SINGLE("DAC L1 Switch", RT5670_HPO_MIXER,
763 			RT5670_M_DACL1_HML_SFT, 1, 1),
764 	SOC_DAPM_SINGLE("INL1 Switch", RT5670_HPO_MIXER,
765 			RT5670_M_INL1_HML_SFT, 1, 1),
766 };
767 
768 static const struct snd_kcontrol_new rt5670_hpr_mix[] = {
769 	SOC_DAPM_SINGLE("DAC R1 Switch", RT5670_HPO_MIXER,
770 			RT5670_M_DACR1_HMR_SFT, 1, 1),
771 	SOC_DAPM_SINGLE("INR1 Switch", RT5670_HPO_MIXER,
772 			RT5670_M_INR1_HMR_SFT, 1, 1),
773 };
774 
775 static const struct snd_kcontrol_new lout_l_enable_control =
776 	SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5670_LOUT1,
777 		RT5670_L_MUTE_SFT, 1, 1);
778 
779 static const struct snd_kcontrol_new lout_r_enable_control =
780 	SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5670_LOUT1,
781 		RT5670_R_MUTE_SFT, 1, 1);
782 
783 /* DAC1 L/R source */ /* MX-29 [9:8] [11:10] */
784 static const char * const rt5670_dac1_src[] = {
785 	"IF1 DAC", "IF2 DAC"
786 };
787 
788 static SOC_ENUM_SINGLE_DECL(rt5670_dac1l_enum, RT5670_AD_DA_MIXER,
789 	RT5670_DAC1_L_SEL_SFT, rt5670_dac1_src);
790 
791 static const struct snd_kcontrol_new rt5670_dac1l_mux =
792 	SOC_DAPM_ENUM("DAC1 L source", rt5670_dac1l_enum);
793 
794 static SOC_ENUM_SINGLE_DECL(rt5670_dac1r_enum, RT5670_AD_DA_MIXER,
795 	RT5670_DAC1_R_SEL_SFT, rt5670_dac1_src);
796 
797 static const struct snd_kcontrol_new rt5670_dac1r_mux =
798 	SOC_DAPM_ENUM("DAC1 R source", rt5670_dac1r_enum);
799 
800 /*DAC2 L/R source*/ /* MX-1B [6:4] [2:0] */
801 /* TODO Use SOC_VALUE_ENUM_SINGLE_DECL */
802 static const char * const rt5670_dac12_src[] = {
803 	"IF1 DAC", "IF2 DAC", "IF3 DAC", "TxDC DAC",
804 	"Bass", "VAD_ADC", "IF4 DAC"
805 };
806 
807 static SOC_ENUM_SINGLE_DECL(rt5670_dac2l_enum, RT5670_DAC_CTRL,
808 	RT5670_DAC2_L_SEL_SFT, rt5670_dac12_src);
809 
810 static const struct snd_kcontrol_new rt5670_dac_l2_mux =
811 	SOC_DAPM_ENUM("DAC2 L source", rt5670_dac2l_enum);
812 
813 static const char * const rt5670_dacr2_src[] = {
814 	"IF1 DAC", "IF2 DAC", "IF3 DAC", "TxDC DAC", "TxDP ADC", "IF4 DAC"
815 };
816 
817 static SOC_ENUM_SINGLE_DECL(rt5670_dac2r_enum, RT5670_DAC_CTRL,
818 	RT5670_DAC2_R_SEL_SFT, rt5670_dacr2_src);
819 
820 static const struct snd_kcontrol_new rt5670_dac_r2_mux =
821 	SOC_DAPM_ENUM("DAC2 R source", rt5670_dac2r_enum);
822 
823 /*RxDP source*/ /* MX-2D [15:13] */
824 static const char * const rt5670_rxdp_src[] = {
825 	"IF2 DAC", "IF1 DAC", "STO1 ADC Mixer", "STO2 ADC Mixer",
826 	"Mono ADC Mixer L", "Mono ADC Mixer R", "DAC1"
827 };
828 
829 static SOC_ENUM_SINGLE_DECL(rt5670_rxdp_enum, RT5670_DSP_PATH1,
830 	RT5670_RXDP_SEL_SFT, rt5670_rxdp_src);
831 
832 static const struct snd_kcontrol_new rt5670_rxdp_mux =
833 	SOC_DAPM_ENUM("DAC2 L source", rt5670_rxdp_enum);
834 
835 /* MX-2D [1] [0] */
836 static const char * const rt5670_dsp_bypass_src[] = {
837 	"DSP", "Bypass"
838 };
839 
840 static SOC_ENUM_SINGLE_DECL(rt5670_dsp_ul_enum, RT5670_DSP_PATH1,
841 	RT5670_DSP_UL_SFT, rt5670_dsp_bypass_src);
842 
843 static const struct snd_kcontrol_new rt5670_dsp_ul_mux =
844 	SOC_DAPM_ENUM("DSP UL source", rt5670_dsp_ul_enum);
845 
846 static SOC_ENUM_SINGLE_DECL(rt5670_dsp_dl_enum, RT5670_DSP_PATH1,
847 	RT5670_DSP_DL_SFT, rt5670_dsp_bypass_src);
848 
849 static const struct snd_kcontrol_new rt5670_dsp_dl_mux =
850 	SOC_DAPM_ENUM("DSP DL source", rt5670_dsp_dl_enum);
851 
852 /* Stereo2 ADC source */
853 /* MX-26 [15] */
854 static const char * const rt5670_stereo2_adc_lr_src[] = {
855 	"L", "LR"
856 };
857 
858 static SOC_ENUM_SINGLE_DECL(rt5670_stereo2_adc_lr_enum, RT5670_STO2_ADC_MIXER,
859 	RT5670_STO2_ADC_SRC_SFT, rt5670_stereo2_adc_lr_src);
860 
861 static const struct snd_kcontrol_new rt5670_sto2_adc_lr_mux =
862 	SOC_DAPM_ENUM("Stereo2 ADC LR source", rt5670_stereo2_adc_lr_enum);
863 
864 /* Stereo1 ADC source */
865 /* MX-27 MX-26 [12] */
866 static const char * const rt5670_stereo_adc1_src[] = {
867 	"DAC MIX", "ADC"
868 };
869 
870 static SOC_ENUM_SINGLE_DECL(rt5670_stereo1_adc1_enum, RT5670_STO1_ADC_MIXER,
871 	RT5670_ADC_1_SRC_SFT, rt5670_stereo_adc1_src);
872 
873 static const struct snd_kcontrol_new rt5670_sto_adc_l1_mux =
874 	SOC_DAPM_ENUM("Stereo1 ADC L1 source", rt5670_stereo1_adc1_enum);
875 
876 static const struct snd_kcontrol_new rt5670_sto_adc_r1_mux =
877 	SOC_DAPM_ENUM("Stereo1 ADC R1 source", rt5670_stereo1_adc1_enum);
878 
879 static SOC_ENUM_SINGLE_DECL(rt5670_stereo2_adc1_enum, RT5670_STO2_ADC_MIXER,
880 	RT5670_ADC_1_SRC_SFT, rt5670_stereo_adc1_src);
881 
882 static const struct snd_kcontrol_new rt5670_sto2_adc_l1_mux =
883 	SOC_DAPM_ENUM("Stereo2 ADC L1 source", rt5670_stereo2_adc1_enum);
884 
885 static const struct snd_kcontrol_new rt5670_sto2_adc_r1_mux =
886 	SOC_DAPM_ENUM("Stereo2 ADC R1 source", rt5670_stereo2_adc1_enum);
887 
888 /* MX-27 MX-26 [11] */
889 static const char * const rt5670_stereo_adc2_src[] = {
890 	"DAC MIX", "DMIC"
891 };
892 
893 static SOC_ENUM_SINGLE_DECL(rt5670_stereo1_adc2_enum, RT5670_STO1_ADC_MIXER,
894 	RT5670_ADC_2_SRC_SFT, rt5670_stereo_adc2_src);
895 
896 static const struct snd_kcontrol_new rt5670_sto_adc_l2_mux =
897 	SOC_DAPM_ENUM("Stereo1 ADC L2 source", rt5670_stereo1_adc2_enum);
898 
899 static const struct snd_kcontrol_new rt5670_sto_adc_r2_mux =
900 	SOC_DAPM_ENUM("Stereo1 ADC R2 source", rt5670_stereo1_adc2_enum);
901 
902 static SOC_ENUM_SINGLE_DECL(rt5670_stereo2_adc2_enum, RT5670_STO2_ADC_MIXER,
903 	RT5670_ADC_2_SRC_SFT, rt5670_stereo_adc2_src);
904 
905 static const struct snd_kcontrol_new rt5670_sto2_adc_l2_mux =
906 	SOC_DAPM_ENUM("Stereo2 ADC L2 source", rt5670_stereo2_adc2_enum);
907 
908 static const struct snd_kcontrol_new rt5670_sto2_adc_r2_mux =
909 	SOC_DAPM_ENUM("Stereo2 ADC R2 source", rt5670_stereo2_adc2_enum);
910 
911 /* MX-27 MX26 [10] */
912 static const char * const rt5670_stereo_adc_src[] = {
913 	"ADC1L ADC2R", "ADC3"
914 };
915 
916 static SOC_ENUM_SINGLE_DECL(rt5670_stereo1_adc_enum, RT5670_STO1_ADC_MIXER,
917 	RT5670_ADC_SRC_SFT, rt5670_stereo_adc_src);
918 
919 static const struct snd_kcontrol_new rt5670_sto_adc_mux =
920 	SOC_DAPM_ENUM("Stereo1 ADC source", rt5670_stereo1_adc_enum);
921 
922 static SOC_ENUM_SINGLE_DECL(rt5670_stereo2_adc_enum, RT5670_STO2_ADC_MIXER,
923 	RT5670_ADC_SRC_SFT, rt5670_stereo_adc_src);
924 
925 static const struct snd_kcontrol_new rt5670_sto2_adc_mux =
926 	SOC_DAPM_ENUM("Stereo2 ADC source", rt5670_stereo2_adc_enum);
927 
928 /* MX-27 MX-26 [9:8] */
929 static const char * const rt5670_stereo_dmic_src[] = {
930 	"DMIC1", "DMIC2", "DMIC3"
931 };
932 
933 static SOC_ENUM_SINGLE_DECL(rt5670_stereo1_dmic_enum, RT5670_STO1_ADC_MIXER,
934 	RT5670_DMIC_SRC_SFT, rt5670_stereo_dmic_src);
935 
936 static const struct snd_kcontrol_new rt5670_sto1_dmic_mux =
937 	SOC_DAPM_ENUM("Stereo1 DMIC source", rt5670_stereo1_dmic_enum);
938 
939 static SOC_ENUM_SINGLE_DECL(rt5670_stereo2_dmic_enum, RT5670_STO2_ADC_MIXER,
940 	RT5670_DMIC_SRC_SFT, rt5670_stereo_dmic_src);
941 
942 static const struct snd_kcontrol_new rt5670_sto2_dmic_mux =
943 	SOC_DAPM_ENUM("Stereo2 DMIC source", rt5670_stereo2_dmic_enum);
944 
945 /* MX-27 [0] */
946 static const char * const rt5670_stereo_dmic3_src[] = {
947 	"DMIC3", "PDM ADC"
948 };
949 
950 static SOC_ENUM_SINGLE_DECL(rt5670_stereo_dmic3_enum, RT5670_STO1_ADC_MIXER,
951 	RT5670_DMIC3_SRC_SFT, rt5670_stereo_dmic3_src);
952 
953 static const struct snd_kcontrol_new rt5670_sto_dmic3_mux =
954 	SOC_DAPM_ENUM("Stereo DMIC3 source", rt5670_stereo_dmic3_enum);
955 
956 /* Mono ADC source */
957 /* MX-28 [12] */
958 static const char * const rt5670_mono_adc_l1_src[] = {
959 	"Mono DAC MIXL", "ADC1"
960 };
961 
962 static SOC_ENUM_SINGLE_DECL(rt5670_mono_adc_l1_enum, RT5670_MONO_ADC_MIXER,
963 	RT5670_MONO_ADC_L1_SRC_SFT, rt5670_mono_adc_l1_src);
964 
965 static const struct snd_kcontrol_new rt5670_mono_adc_l1_mux =
966 	SOC_DAPM_ENUM("Mono ADC1 left source", rt5670_mono_adc_l1_enum);
967 /* MX-28 [11] */
968 static const char * const rt5670_mono_adc_l2_src[] = {
969 	"Mono DAC MIXL", "DMIC"
970 };
971 
972 static SOC_ENUM_SINGLE_DECL(rt5670_mono_adc_l2_enum, RT5670_MONO_ADC_MIXER,
973 	RT5670_MONO_ADC_L2_SRC_SFT, rt5670_mono_adc_l2_src);
974 
975 static const struct snd_kcontrol_new rt5670_mono_adc_l2_mux =
976 	SOC_DAPM_ENUM("Mono ADC2 left source", rt5670_mono_adc_l2_enum);
977 
978 /* MX-28 [9:8] */
979 static const char * const rt5670_mono_dmic_src[] = {
980 	"DMIC1", "DMIC2", "DMIC3"
981 };
982 
983 static SOC_ENUM_SINGLE_DECL(rt5670_mono_dmic_l_enum, RT5670_MONO_ADC_MIXER,
984 	RT5670_MONO_DMIC_L_SRC_SFT, rt5670_mono_dmic_src);
985 
986 static const struct snd_kcontrol_new rt5670_mono_dmic_l_mux =
987 	SOC_DAPM_ENUM("Mono DMIC left source", rt5670_mono_dmic_l_enum);
988 /* MX-28 [1:0] */
989 static SOC_ENUM_SINGLE_DECL(rt5670_mono_dmic_r_enum, RT5670_MONO_ADC_MIXER,
990 	RT5670_MONO_DMIC_R_SRC_SFT, rt5670_mono_dmic_src);
991 
992 static const struct snd_kcontrol_new rt5670_mono_dmic_r_mux =
993 	SOC_DAPM_ENUM("Mono DMIC Right source", rt5670_mono_dmic_r_enum);
994 /* MX-28 [4] */
995 static const char * const rt5670_mono_adc_r1_src[] = {
996 	"Mono DAC MIXR", "ADC2"
997 };
998 
999 static SOC_ENUM_SINGLE_DECL(rt5670_mono_adc_r1_enum, RT5670_MONO_ADC_MIXER,
1000 	RT5670_MONO_ADC_R1_SRC_SFT, rt5670_mono_adc_r1_src);
1001 
1002 static const struct snd_kcontrol_new rt5670_mono_adc_r1_mux =
1003 	SOC_DAPM_ENUM("Mono ADC1 right source", rt5670_mono_adc_r1_enum);
1004 /* MX-28 [3] */
1005 static const char * const rt5670_mono_adc_r2_src[] = {
1006 	"Mono DAC MIXR", "DMIC"
1007 };
1008 
1009 static SOC_ENUM_SINGLE_DECL(rt5670_mono_adc_r2_enum, RT5670_MONO_ADC_MIXER,
1010 	RT5670_MONO_ADC_R2_SRC_SFT, rt5670_mono_adc_r2_src);
1011 
1012 static const struct snd_kcontrol_new rt5670_mono_adc_r2_mux =
1013 	SOC_DAPM_ENUM("Mono ADC2 right source", rt5670_mono_adc_r2_enum);
1014 
1015 /* MX-2D [3:2] */
1016 static const char * const rt5670_txdp_slot_src[] = {
1017 	"Slot 0-1", "Slot 2-3", "Slot 4-5", "Slot 6-7"
1018 };
1019 
1020 static SOC_ENUM_SINGLE_DECL(rt5670_txdp_slot_enum, RT5670_DSP_PATH1,
1021 	RT5670_TXDP_SLOT_SEL_SFT, rt5670_txdp_slot_src);
1022 
1023 static const struct snd_kcontrol_new rt5670_txdp_slot_mux =
1024 	SOC_DAPM_ENUM("TxDP Slot source", rt5670_txdp_slot_enum);
1025 
1026 /* MX-2F [15] */
1027 static const char * const rt5670_if1_adc2_in_src[] = {
1028 	"IF_ADC2", "VAD_ADC"
1029 };
1030 
1031 static SOC_ENUM_SINGLE_DECL(rt5670_if1_adc2_in_enum, RT5670_DIG_INF1_DATA,
1032 	RT5670_IF1_ADC2_IN_SFT, rt5670_if1_adc2_in_src);
1033 
1034 static const struct snd_kcontrol_new rt5670_if1_adc2_in_mux =
1035 	SOC_DAPM_ENUM("IF1 ADC2 IN source", rt5670_if1_adc2_in_enum);
1036 
1037 /* MX-2F [14:12] */
1038 static const char * const rt5670_if2_adc_in_src[] = {
1039 	"IF_ADC1", "IF_ADC2", "IF_ADC3", "TxDC_DAC", "TxDP_ADC", "VAD_ADC"
1040 };
1041 
1042 static SOC_ENUM_SINGLE_DECL(rt5670_if2_adc_in_enum, RT5670_DIG_INF1_DATA,
1043 	RT5670_IF2_ADC_IN_SFT, rt5670_if2_adc_in_src);
1044 
1045 static const struct snd_kcontrol_new rt5670_if2_adc_in_mux =
1046 	SOC_DAPM_ENUM("IF2 ADC IN source", rt5670_if2_adc_in_enum);
1047 
1048 /* MX-30 [5:4] */
1049 static const char * const rt5670_if4_adc_in_src[] = {
1050 	"IF_ADC1", "IF_ADC2", "IF_ADC3"
1051 };
1052 
1053 static SOC_ENUM_SINGLE_DECL(rt5670_if4_adc_in_enum, RT5670_DIG_INF2_DATA,
1054 	RT5670_IF4_ADC_IN_SFT, rt5670_if4_adc_in_src);
1055 
1056 static const struct snd_kcontrol_new rt5670_if4_adc_in_mux =
1057 	SOC_DAPM_ENUM("IF4 ADC IN source", rt5670_if4_adc_in_enum);
1058 
1059 /* MX-31 [15] [13] [11] [9] */
1060 static const char * const rt5670_pdm_src[] = {
1061 	"Mono DAC", "Stereo DAC"
1062 };
1063 
1064 static SOC_ENUM_SINGLE_DECL(rt5670_pdm1_l_enum, RT5670_PDM_OUT_CTRL,
1065 	RT5670_PDM1_L_SFT, rt5670_pdm_src);
1066 
1067 static const struct snd_kcontrol_new rt5670_pdm1_l_mux =
1068 	SOC_DAPM_ENUM("PDM1 L source", rt5670_pdm1_l_enum);
1069 
1070 static SOC_ENUM_SINGLE_DECL(rt5670_pdm1_r_enum, RT5670_PDM_OUT_CTRL,
1071 	RT5670_PDM1_R_SFT, rt5670_pdm_src);
1072 
1073 static const struct snd_kcontrol_new rt5670_pdm1_r_mux =
1074 	SOC_DAPM_ENUM("PDM1 R source", rt5670_pdm1_r_enum);
1075 
1076 static SOC_ENUM_SINGLE_DECL(rt5670_pdm2_l_enum, RT5670_PDM_OUT_CTRL,
1077 	RT5670_PDM2_L_SFT, rt5670_pdm_src);
1078 
1079 static const struct snd_kcontrol_new rt5670_pdm2_l_mux =
1080 	SOC_DAPM_ENUM("PDM2 L source", rt5670_pdm2_l_enum);
1081 
1082 static SOC_ENUM_SINGLE_DECL(rt5670_pdm2_r_enum, RT5670_PDM_OUT_CTRL,
1083 	RT5670_PDM2_R_SFT, rt5670_pdm_src);
1084 
1085 static const struct snd_kcontrol_new rt5670_pdm2_r_mux =
1086 	SOC_DAPM_ENUM("PDM2 R source", rt5670_pdm2_r_enum);
1087 
1088 /* MX-FA [12] */
1089 static const char * const rt5670_if1_adc1_in1_src[] = {
1090 	"IF_ADC1", "IF1_ADC3"
1091 };
1092 
1093 static SOC_ENUM_SINGLE_DECL(rt5670_if1_adc1_in1_enum, RT5670_DIG_MISC,
1094 	RT5670_IF1_ADC1_IN1_SFT, rt5670_if1_adc1_in1_src);
1095 
1096 static const struct snd_kcontrol_new rt5670_if1_adc1_in1_mux =
1097 	SOC_DAPM_ENUM("IF1 ADC1 IN1 source", rt5670_if1_adc1_in1_enum);
1098 
1099 /* MX-FA [11] */
1100 static const char * const rt5670_if1_adc1_in2_src[] = {
1101 	"IF1_ADC1_IN1", "IF1_ADC4"
1102 };
1103 
1104 static SOC_ENUM_SINGLE_DECL(rt5670_if1_adc1_in2_enum, RT5670_DIG_MISC,
1105 	RT5670_IF1_ADC1_IN2_SFT, rt5670_if1_adc1_in2_src);
1106 
1107 static const struct snd_kcontrol_new rt5670_if1_adc1_in2_mux =
1108 	SOC_DAPM_ENUM("IF1 ADC1 IN2 source", rt5670_if1_adc1_in2_enum);
1109 
1110 /* MX-FA [10] */
1111 static const char * const rt5670_if1_adc2_in1_src[] = {
1112 	"IF1_ADC2_IN", "IF1_ADC4"
1113 };
1114 
1115 static SOC_ENUM_SINGLE_DECL(rt5670_if1_adc2_in1_enum, RT5670_DIG_MISC,
1116 	RT5670_IF1_ADC2_IN1_SFT, rt5670_if1_adc2_in1_src);
1117 
1118 static const struct snd_kcontrol_new rt5670_if1_adc2_in1_mux =
1119 	SOC_DAPM_ENUM("IF1 ADC2 IN1 source", rt5670_if1_adc2_in1_enum);
1120 
1121 /* MX-9D [9:8] */
1122 static const char * const rt5670_vad_adc_src[] = {
1123 	"Sto1 ADC L", "Mono ADC L", "Mono ADC R", "Sto2 ADC L"
1124 };
1125 
1126 static SOC_ENUM_SINGLE_DECL(rt5670_vad_adc_enum, RT5670_VAD_CTRL4,
1127 	RT5670_VAD_SEL_SFT, rt5670_vad_adc_src);
1128 
1129 static const struct snd_kcontrol_new rt5670_vad_adc_mux =
1130 	SOC_DAPM_ENUM("VAD ADC source", rt5670_vad_adc_enum);
1131 
rt5670_hp_power_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1132 static int rt5670_hp_power_event(struct snd_soc_dapm_widget *w,
1133 			   struct snd_kcontrol *kcontrol, int event)
1134 {
1135 	struct snd_soc_codec *codec = w->codec;
1136 	struct rt5670_priv *rt5670 = snd_soc_codec_get_drvdata(codec);
1137 
1138 	switch (event) {
1139 	case SND_SOC_DAPM_POST_PMU:
1140 		regmap_update_bits(rt5670->regmap, RT5670_CHARGE_PUMP,
1141 			RT5670_PM_HP_MASK, RT5670_PM_HP_HV);
1142 		regmap_update_bits(rt5670->regmap, RT5670_GEN_CTRL2,
1143 			0x0400, 0x0400);
1144 		/* headphone amp power on */
1145 		regmap_update_bits(rt5670->regmap, RT5670_PWR_ANLG1,
1146 			RT5670_PWR_HA |	RT5670_PWR_FV1 |
1147 			RT5670_PWR_FV2,	RT5670_PWR_HA |
1148 			RT5670_PWR_FV1 | RT5670_PWR_FV2);
1149 		/* depop parameters */
1150 		regmap_write(rt5670->regmap, RT5670_DEPOP_M2, 0x3100);
1151 		regmap_write(rt5670->regmap, RT5670_DEPOP_M1, 0x8009);
1152 		regmap_write(rt5670->regmap, RT5670_PR_BASE +
1153 			RT5670_HP_DCC_INT1, 0x9f00);
1154 		mdelay(20);
1155 		regmap_write(rt5670->regmap, RT5670_DEPOP_M1, 0x8019);
1156 		break;
1157 	case SND_SOC_DAPM_PRE_PMD:
1158 		regmap_write(rt5670->regmap, RT5670_DEPOP_M1, 0x0004);
1159 		msleep(30);
1160 		break;
1161 	default:
1162 		return 0;
1163 	}
1164 
1165 	return 0;
1166 }
1167 
rt5670_hp_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1168 static int rt5670_hp_event(struct snd_soc_dapm_widget *w,
1169 	struct snd_kcontrol *kcontrol, int event)
1170 {
1171 	struct snd_soc_codec *codec = w->codec;
1172 	struct rt5670_priv *rt5670 = snd_soc_codec_get_drvdata(codec);
1173 
1174 	switch (event) {
1175 	case SND_SOC_DAPM_POST_PMU:
1176 		/* headphone unmute sequence */
1177 		regmap_write(rt5670->regmap, RT5670_PR_BASE +
1178 				RT5670_MAMP_INT_REG2, 0xb400);
1179 		regmap_write(rt5670->regmap, RT5670_DEPOP_M3, 0x0772);
1180 		regmap_write(rt5670->regmap, RT5670_DEPOP_M1, 0x805d);
1181 		regmap_write(rt5670->regmap, RT5670_DEPOP_M1, 0x831d);
1182 		regmap_update_bits(rt5670->regmap, RT5670_GEN_CTRL2,
1183 				0x0300, 0x0300);
1184 		regmap_update_bits(rt5670->regmap, RT5670_HP_VOL,
1185 			RT5670_L_MUTE | RT5670_R_MUTE, 0);
1186 		msleep(80);
1187 		regmap_write(rt5670->regmap, RT5670_DEPOP_M1, 0x8019);
1188 		break;
1189 
1190 	case SND_SOC_DAPM_PRE_PMD:
1191 		/* headphone mute sequence */
1192 		regmap_write(rt5670->regmap, RT5670_PR_BASE +
1193 				RT5670_MAMP_INT_REG2, 0xb400);
1194 		regmap_write(rt5670->regmap, RT5670_DEPOP_M3, 0x0772);
1195 		regmap_write(rt5670->regmap, RT5670_DEPOP_M1, 0x803d);
1196 		mdelay(10);
1197 		regmap_write(rt5670->regmap, RT5670_DEPOP_M1, 0x831d);
1198 		mdelay(10);
1199 		regmap_update_bits(rt5670->regmap, RT5670_HP_VOL,
1200 				   RT5670_L_MUTE | RT5670_R_MUTE,
1201 				   RT5670_L_MUTE | RT5670_R_MUTE);
1202 		msleep(20);
1203 		regmap_update_bits(rt5670->regmap,
1204 				   RT5670_GEN_CTRL2, 0x0300, 0x0);
1205 		regmap_write(rt5670->regmap, RT5670_DEPOP_M1, 0x8019);
1206 		regmap_write(rt5670->regmap, RT5670_DEPOP_M3, 0x0707);
1207 		regmap_write(rt5670->regmap, RT5670_PR_BASE +
1208 				RT5670_MAMP_INT_REG2, 0xfc00);
1209 		break;
1210 
1211 	default:
1212 		return 0;
1213 	}
1214 
1215 	return 0;
1216 }
1217 
rt5670_bst1_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1218 static int rt5670_bst1_event(struct snd_soc_dapm_widget *w,
1219 	struct snd_kcontrol *kcontrol, int event)
1220 {
1221 	struct snd_soc_codec *codec = w->codec;
1222 
1223 	switch (event) {
1224 	case SND_SOC_DAPM_POST_PMU:
1225 		snd_soc_update_bits(codec, RT5670_PWR_ANLG2,
1226 				    RT5670_PWR_BST1_P, RT5670_PWR_BST1_P);
1227 		break;
1228 
1229 	case SND_SOC_DAPM_PRE_PMD:
1230 		snd_soc_update_bits(codec, RT5670_PWR_ANLG2,
1231 				    RT5670_PWR_BST1_P, 0);
1232 		break;
1233 
1234 	default:
1235 		return 0;
1236 	}
1237 
1238 	return 0;
1239 }
1240 
rt5670_bst2_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1241 static int rt5670_bst2_event(struct snd_soc_dapm_widget *w,
1242 	struct snd_kcontrol *kcontrol, int event)
1243 {
1244 	struct snd_soc_codec *codec = w->codec;
1245 
1246 	switch (event) {
1247 	case SND_SOC_DAPM_POST_PMU:
1248 		snd_soc_update_bits(codec, RT5670_PWR_ANLG2,
1249 				    RT5670_PWR_BST2_P, RT5670_PWR_BST2_P);
1250 		break;
1251 
1252 	case SND_SOC_DAPM_PRE_PMD:
1253 		snd_soc_update_bits(codec, RT5670_PWR_ANLG2,
1254 				    RT5670_PWR_BST2_P, 0);
1255 		break;
1256 
1257 	default:
1258 		return 0;
1259 	}
1260 
1261 	return 0;
1262 }
1263 
1264 static const struct snd_soc_dapm_widget rt5670_dapm_widgets[] = {
1265 	SND_SOC_DAPM_SUPPLY("PLL1", RT5670_PWR_ANLG2,
1266 			    RT5670_PWR_PLL_BIT, 0, NULL, 0),
1267 	SND_SOC_DAPM_SUPPLY("I2S DSP", RT5670_PWR_DIG2,
1268 			    RT5670_PWR_I2S_DSP_BIT, 0, NULL, 0),
1269 	SND_SOC_DAPM_SUPPLY("Mic Det Power", RT5670_PWR_VOL,
1270 			    RT5670_PWR_MIC_DET_BIT, 0, NULL, 0),
1271 
1272 	/* ASRC */
1273 	SND_SOC_DAPM_SUPPLY_S("I2S1 ASRC", 1, RT5670_ASRC_1,
1274 			      11, 0, NULL, 0),
1275 	SND_SOC_DAPM_SUPPLY_S("I2S2 ASRC", 1, RT5670_ASRC_1,
1276 			      12, 0, NULL, 0),
1277 	SND_SOC_DAPM_SUPPLY_S("DAC STO ASRC", 1, RT5670_ASRC_1,
1278 			      10, 0, NULL, 0),
1279 	SND_SOC_DAPM_SUPPLY_S("DAC MONO L ASRC", 1, RT5670_ASRC_1,
1280 			      9, 0, NULL, 0),
1281 	SND_SOC_DAPM_SUPPLY_S("DAC MONO R ASRC", 1, RT5670_ASRC_1,
1282 			      8, 0, NULL, 0),
1283 	SND_SOC_DAPM_SUPPLY_S("ADC STO1 ASRC", 1, RT5670_ASRC_1,
1284 			      3, 0, NULL, 0),
1285 	SND_SOC_DAPM_SUPPLY_S("ADC STO2 ASRC", 1, RT5670_ASRC_1,
1286 			      2, 0, NULL, 0),
1287 	SND_SOC_DAPM_SUPPLY_S("ADC MONO L ASRC", 1, RT5670_ASRC_1,
1288 			      1, 0, NULL, 0),
1289 	SND_SOC_DAPM_SUPPLY_S("ADC MONO R ASRC", 1, RT5670_ASRC_1,
1290 			      0, 0, NULL, 0),
1291 
1292 	/* Input Side */
1293 	/* micbias */
1294 	SND_SOC_DAPM_SUPPLY("MICBIAS1", RT5670_PWR_ANLG2,
1295 			     RT5670_PWR_MB1_BIT, 0, NULL, 0),
1296 
1297 	/* Input Lines */
1298 	SND_SOC_DAPM_INPUT("DMIC L1"),
1299 	SND_SOC_DAPM_INPUT("DMIC R1"),
1300 	SND_SOC_DAPM_INPUT("DMIC L2"),
1301 	SND_SOC_DAPM_INPUT("DMIC R2"),
1302 	SND_SOC_DAPM_INPUT("DMIC L3"),
1303 	SND_SOC_DAPM_INPUT("DMIC R3"),
1304 
1305 	SND_SOC_DAPM_INPUT("IN1P"),
1306 	SND_SOC_DAPM_INPUT("IN1N"),
1307 	SND_SOC_DAPM_INPUT("IN2P"),
1308 	SND_SOC_DAPM_INPUT("IN2N"),
1309 
1310 	SND_SOC_DAPM_PGA("DMIC1", SND_SOC_NOPM, 0, 0, NULL, 0),
1311 	SND_SOC_DAPM_PGA("DMIC2", SND_SOC_NOPM, 0, 0, NULL, 0),
1312 	SND_SOC_DAPM_PGA("DMIC3", SND_SOC_NOPM, 0, 0, NULL, 0),
1313 
1314 	SND_SOC_DAPM_SUPPLY("DMIC CLK", SND_SOC_NOPM, 0, 0,
1315 			    set_dmic_clk, SND_SOC_DAPM_PRE_PMU),
1316 	SND_SOC_DAPM_SUPPLY("DMIC1 Power", RT5670_DMIC_CTRL1,
1317 			    RT5670_DMIC_1_EN_SFT, 0, NULL, 0),
1318 	SND_SOC_DAPM_SUPPLY("DMIC2 Power", RT5670_DMIC_CTRL1,
1319 			    RT5670_DMIC_2_EN_SFT, 0, NULL, 0),
1320 	SND_SOC_DAPM_SUPPLY("DMIC3 Power", RT5670_DMIC_CTRL1,
1321 			    RT5670_DMIC_3_EN_SFT, 0, NULL, 0),
1322 	/* Boost */
1323 	SND_SOC_DAPM_PGA_E("BST1", RT5670_PWR_ANLG2, RT5670_PWR_BST1_BIT,
1324 			   0, NULL, 0, rt5670_bst1_event,
1325 			   SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
1326 	SND_SOC_DAPM_PGA_E("BST2", RT5670_PWR_ANLG2, RT5670_PWR_BST2_BIT,
1327 			   0, NULL, 0, rt5670_bst2_event,
1328 			   SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
1329 	/* Input Volume */
1330 	SND_SOC_DAPM_PGA("INL VOL", RT5670_PWR_VOL,
1331 			 RT5670_PWR_IN_L_BIT, 0, NULL, 0),
1332 	SND_SOC_DAPM_PGA("INR VOL", RT5670_PWR_VOL,
1333 			 RT5670_PWR_IN_R_BIT, 0, NULL, 0),
1334 
1335 	/* REC Mixer */
1336 	SND_SOC_DAPM_MIXER("RECMIXL", RT5670_PWR_MIXER, RT5670_PWR_RM_L_BIT, 0,
1337 			   rt5670_rec_l_mix, ARRAY_SIZE(rt5670_rec_l_mix)),
1338 	SND_SOC_DAPM_MIXER("RECMIXR", RT5670_PWR_MIXER, RT5670_PWR_RM_R_BIT, 0,
1339 			   rt5670_rec_r_mix, ARRAY_SIZE(rt5670_rec_r_mix)),
1340 	/* ADCs */
1341 	SND_SOC_DAPM_ADC("ADC 1", NULL, SND_SOC_NOPM, 0, 0),
1342 	SND_SOC_DAPM_ADC("ADC 2", NULL, SND_SOC_NOPM, 0, 0),
1343 
1344 	SND_SOC_DAPM_PGA("ADC 1_2", SND_SOC_NOPM, 0, 0, NULL, 0),
1345 
1346 	SND_SOC_DAPM_SUPPLY("ADC 1 power", RT5670_PWR_DIG1,
1347 			    RT5670_PWR_ADC_L_BIT, 0, NULL, 0),
1348 	SND_SOC_DAPM_SUPPLY("ADC 2 power", RT5670_PWR_DIG1,
1349 			    RT5670_PWR_ADC_R_BIT, 0, NULL, 0),
1350 	SND_SOC_DAPM_SUPPLY("ADC clock", RT5670_PR_BASE +
1351 			    RT5670_CHOP_DAC_ADC, 12, 0, NULL, 0),
1352 	/* ADC Mux */
1353 	SND_SOC_DAPM_MUX("Stereo1 DMIC Mux", SND_SOC_NOPM, 0, 0,
1354 			 &rt5670_sto1_dmic_mux),
1355 	SND_SOC_DAPM_MUX("Stereo1 ADC L2 Mux", SND_SOC_NOPM, 0, 0,
1356 			 &rt5670_sto_adc_l2_mux),
1357 	SND_SOC_DAPM_MUX("Stereo1 ADC R2 Mux", SND_SOC_NOPM, 0, 0,
1358 			 &rt5670_sto_adc_r2_mux),
1359 	SND_SOC_DAPM_MUX("Stereo1 ADC L1 Mux", SND_SOC_NOPM, 0, 0,
1360 			 &rt5670_sto_adc_l1_mux),
1361 	SND_SOC_DAPM_MUX("Stereo1 ADC R1 Mux", SND_SOC_NOPM, 0, 0,
1362 			 &rt5670_sto_adc_r1_mux),
1363 	SND_SOC_DAPM_MUX("Stereo2 DMIC Mux", SND_SOC_NOPM, 0, 0,
1364 			 &rt5670_sto2_dmic_mux),
1365 	SND_SOC_DAPM_MUX("Stereo2 ADC L2 Mux", SND_SOC_NOPM, 0, 0,
1366 			 &rt5670_sto2_adc_l2_mux),
1367 	SND_SOC_DAPM_MUX("Stereo2 ADC R2 Mux", SND_SOC_NOPM, 0, 0,
1368 			 &rt5670_sto2_adc_r2_mux),
1369 	SND_SOC_DAPM_MUX("Stereo2 ADC L1 Mux", SND_SOC_NOPM, 0, 0,
1370 			 &rt5670_sto2_adc_l1_mux),
1371 	SND_SOC_DAPM_MUX("Stereo2 ADC R1 Mux", SND_SOC_NOPM, 0, 0,
1372 			 &rt5670_sto2_adc_r1_mux),
1373 	SND_SOC_DAPM_MUX("Stereo2 ADC LR Mux", SND_SOC_NOPM, 0, 0,
1374 			 &rt5670_sto2_adc_lr_mux),
1375 	SND_SOC_DAPM_MUX("Mono DMIC L Mux", SND_SOC_NOPM, 0, 0,
1376 			 &rt5670_mono_dmic_l_mux),
1377 	SND_SOC_DAPM_MUX("Mono DMIC R Mux", SND_SOC_NOPM, 0, 0,
1378 			 &rt5670_mono_dmic_r_mux),
1379 	SND_SOC_DAPM_MUX("Mono ADC L2 Mux", SND_SOC_NOPM, 0, 0,
1380 			 &rt5670_mono_adc_l2_mux),
1381 	SND_SOC_DAPM_MUX("Mono ADC L1 Mux", SND_SOC_NOPM, 0, 0,
1382 			 &rt5670_mono_adc_l1_mux),
1383 	SND_SOC_DAPM_MUX("Mono ADC R1 Mux", SND_SOC_NOPM, 0, 0,
1384 			 &rt5670_mono_adc_r1_mux),
1385 	SND_SOC_DAPM_MUX("Mono ADC R2 Mux", SND_SOC_NOPM, 0, 0,
1386 			 &rt5670_mono_adc_r2_mux),
1387 	/* ADC Mixer */
1388 	SND_SOC_DAPM_SUPPLY("ADC Stereo1 Filter", RT5670_PWR_DIG2,
1389 			    RT5670_PWR_ADC_S1F_BIT, 0, NULL, 0),
1390 	SND_SOC_DAPM_SUPPLY("ADC Stereo2 Filter", RT5670_PWR_DIG2,
1391 			    RT5670_PWR_ADC_S2F_BIT, 0, NULL, 0),
1392 	SND_SOC_DAPM_MIXER("Sto1 ADC MIXL", RT5670_STO1_ADC_DIG_VOL,
1393 			   RT5670_L_MUTE_SFT, 1, rt5670_sto1_adc_l_mix,
1394 			   ARRAY_SIZE(rt5670_sto1_adc_l_mix)),
1395 	SND_SOC_DAPM_MIXER("Sto1 ADC MIXR", RT5670_STO1_ADC_DIG_VOL,
1396 			   RT5670_R_MUTE_SFT, 1, rt5670_sto1_adc_r_mix,
1397 			   ARRAY_SIZE(rt5670_sto1_adc_r_mix)),
1398 	SND_SOC_DAPM_MIXER("Sto2 ADC MIXL", SND_SOC_NOPM, 0, 0,
1399 			   rt5670_sto2_adc_l_mix,
1400 			   ARRAY_SIZE(rt5670_sto2_adc_l_mix)),
1401 	SND_SOC_DAPM_MIXER("Sto2 ADC MIXR", SND_SOC_NOPM, 0, 0,
1402 			   rt5670_sto2_adc_r_mix,
1403 			   ARRAY_SIZE(rt5670_sto2_adc_r_mix)),
1404 	SND_SOC_DAPM_SUPPLY("ADC Mono Left Filter", RT5670_PWR_DIG2,
1405 			    RT5670_PWR_ADC_MF_L_BIT, 0, NULL, 0),
1406 	SND_SOC_DAPM_MIXER("Mono ADC MIXL", RT5670_MONO_ADC_DIG_VOL,
1407 			   RT5670_L_MUTE_SFT, 1, rt5670_mono_adc_l_mix,
1408 			   ARRAY_SIZE(rt5670_mono_adc_l_mix)),
1409 	SND_SOC_DAPM_SUPPLY("ADC Mono Right Filter", RT5670_PWR_DIG2,
1410 			    RT5670_PWR_ADC_MF_R_BIT, 0, NULL, 0),
1411 	SND_SOC_DAPM_MIXER("Mono ADC MIXR", RT5670_MONO_ADC_DIG_VOL,
1412 			   RT5670_R_MUTE_SFT, 1, rt5670_mono_adc_r_mix,
1413 			   ARRAY_SIZE(rt5670_mono_adc_r_mix)),
1414 
1415 	/* ADC PGA */
1416 	SND_SOC_DAPM_PGA("Stereo1 ADC MIXL", SND_SOC_NOPM, 0, 0, NULL, 0),
1417 	SND_SOC_DAPM_PGA("Stereo1 ADC MIXR", SND_SOC_NOPM, 0, 0, NULL, 0),
1418 	SND_SOC_DAPM_PGA("Stereo2 ADC MIXL", SND_SOC_NOPM, 0, 0, NULL, 0),
1419 	SND_SOC_DAPM_PGA("Stereo2 ADC MIXR", SND_SOC_NOPM, 0, 0, NULL, 0),
1420 	SND_SOC_DAPM_PGA("Sto2 ADC LR MIX", SND_SOC_NOPM, 0, 0, NULL, 0),
1421 	SND_SOC_DAPM_PGA("Stereo1 ADC MIX", SND_SOC_NOPM, 0, 0, NULL, 0),
1422 	SND_SOC_DAPM_PGA("Stereo2 ADC MIX", SND_SOC_NOPM, 0, 0, NULL, 0),
1423 	SND_SOC_DAPM_PGA("Mono ADC MIX", SND_SOC_NOPM, 0, 0, NULL, 0),
1424 	SND_SOC_DAPM_PGA("VAD_ADC", SND_SOC_NOPM, 0, 0, NULL, 0),
1425 	SND_SOC_DAPM_PGA("IF_ADC1", SND_SOC_NOPM, 0, 0, NULL, 0),
1426 	SND_SOC_DAPM_PGA("IF_ADC2", SND_SOC_NOPM, 0, 0, NULL, 0),
1427 	SND_SOC_DAPM_PGA("IF_ADC3", SND_SOC_NOPM, 0, 0, NULL, 0),
1428 	SND_SOC_DAPM_PGA("IF1_ADC1", SND_SOC_NOPM, 0, 0, NULL, 0),
1429 	SND_SOC_DAPM_PGA("IF1_ADC2", SND_SOC_NOPM, 0, 0, NULL, 0),
1430 	SND_SOC_DAPM_PGA("IF1_ADC3", SND_SOC_NOPM, 0, 0, NULL, 0),
1431 	SND_SOC_DAPM_PGA("IF1_ADC4", SND_SOC_NOPM, 0, 0, NULL, 0),
1432 
1433 	/* DSP */
1434 	SND_SOC_DAPM_PGA("TxDP_ADC", SND_SOC_NOPM, 0, 0, NULL, 0),
1435 	SND_SOC_DAPM_PGA("TxDP_ADC_L", SND_SOC_NOPM, 0, 0, NULL, 0),
1436 	SND_SOC_DAPM_PGA("TxDP_ADC_R", SND_SOC_NOPM, 0, 0, NULL, 0),
1437 	SND_SOC_DAPM_PGA("TxDC_DAC", SND_SOC_NOPM, 0, 0, NULL, 0),
1438 
1439 	SND_SOC_DAPM_MUX("TDM Data Mux", SND_SOC_NOPM, 0, 0,
1440 			 &rt5670_txdp_slot_mux),
1441 
1442 	SND_SOC_DAPM_MUX("DSP UL Mux", SND_SOC_NOPM, 0, 0,
1443 			 &rt5670_dsp_ul_mux),
1444 	SND_SOC_DAPM_MUX("DSP DL Mux", SND_SOC_NOPM, 0, 0,
1445 			 &rt5670_dsp_dl_mux),
1446 
1447 	SND_SOC_DAPM_MUX("RxDP Mux", SND_SOC_NOPM, 0, 0,
1448 			 &rt5670_rxdp_mux),
1449 
1450 	/* IF2 Mux */
1451 	SND_SOC_DAPM_MUX("IF2 ADC Mux", SND_SOC_NOPM, 0, 0,
1452 			 &rt5670_if2_adc_in_mux),
1453 
1454 	/* Digital Interface */
1455 	SND_SOC_DAPM_SUPPLY("I2S1", RT5670_PWR_DIG1,
1456 			    RT5670_PWR_I2S1_BIT, 0, NULL, 0),
1457 	SND_SOC_DAPM_PGA("IF1 DAC1", SND_SOC_NOPM, 0, 0, NULL, 0),
1458 	SND_SOC_DAPM_PGA("IF1 DAC2", SND_SOC_NOPM, 0, 0, NULL, 0),
1459 	SND_SOC_DAPM_PGA("IF1 DAC1 L", SND_SOC_NOPM, 0, 0, NULL, 0),
1460 	SND_SOC_DAPM_PGA("IF1 DAC1 R", SND_SOC_NOPM, 0, 0, NULL, 0),
1461 	SND_SOC_DAPM_PGA("IF1 DAC2 L", SND_SOC_NOPM, 0, 0, NULL, 0),
1462 	SND_SOC_DAPM_PGA("IF1 DAC2 R", SND_SOC_NOPM, 0, 0, NULL, 0),
1463 	SND_SOC_DAPM_PGA("IF1 ADC", SND_SOC_NOPM, 0, 0, NULL, 0),
1464 	SND_SOC_DAPM_PGA("IF1 ADC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1465 	SND_SOC_DAPM_PGA("IF1 ADC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1466 	SND_SOC_DAPM_SUPPLY("I2S2", RT5670_PWR_DIG1,
1467 			    RT5670_PWR_I2S2_BIT, 0, NULL, 0),
1468 	SND_SOC_DAPM_PGA("IF2 DAC", SND_SOC_NOPM, 0, 0, NULL, 0),
1469 	SND_SOC_DAPM_PGA("IF2 DAC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1470 	SND_SOC_DAPM_PGA("IF2 DAC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1471 	SND_SOC_DAPM_PGA("IF2 ADC", SND_SOC_NOPM, 0, 0, NULL, 0),
1472 	SND_SOC_DAPM_PGA("IF2 ADC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1473 	SND_SOC_DAPM_PGA("IF2 ADC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1474 
1475 	/* Digital Interface Select */
1476 	SND_SOC_DAPM_MUX("IF1 ADC1 IN1 Mux", SND_SOC_NOPM, 0, 0,
1477 			 &rt5670_if1_adc1_in1_mux),
1478 	SND_SOC_DAPM_MUX("IF1 ADC1 IN2 Mux", SND_SOC_NOPM, 0, 0,
1479 			 &rt5670_if1_adc1_in2_mux),
1480 	SND_SOC_DAPM_MUX("IF1 ADC2 IN Mux", SND_SOC_NOPM, 0, 0,
1481 			 &rt5670_if1_adc2_in_mux),
1482 	SND_SOC_DAPM_MUX("IF1 ADC2 IN1 Mux", SND_SOC_NOPM, 0, 0,
1483 			 &rt5670_if1_adc2_in1_mux),
1484 	SND_SOC_DAPM_MUX("VAD ADC Mux", SND_SOC_NOPM, 0, 0,
1485 			 &rt5670_vad_adc_mux),
1486 
1487 	/* Audio Interface */
1488 	SND_SOC_DAPM_AIF_IN("AIF1RX", "AIF1 Playback", 0, SND_SOC_NOPM, 0, 0),
1489 	SND_SOC_DAPM_AIF_OUT("AIF1TX", "AIF1 Capture", 0, SND_SOC_NOPM, 0, 0),
1490 	SND_SOC_DAPM_AIF_IN("AIF2RX", "AIF2 Playback", 0, SND_SOC_NOPM, 0, 0),
1491 	SND_SOC_DAPM_AIF_OUT("AIF2TX", "AIF2 Capture", 0,
1492 			     RT5670_GPIO_CTRL1, RT5670_I2S2_PIN_SFT, 1),
1493 
1494 	/* Audio DSP */
1495 	SND_SOC_DAPM_PGA("Audio DSP", SND_SOC_NOPM, 0, 0, NULL, 0),
1496 
1497 	/* Output Side */
1498 	/* DAC mixer before sound effect  */
1499 	SND_SOC_DAPM_MIXER("DAC1 MIXL", SND_SOC_NOPM, 0, 0,
1500 			   rt5670_dac_l_mix, ARRAY_SIZE(rt5670_dac_l_mix)),
1501 	SND_SOC_DAPM_MIXER("DAC1 MIXR", SND_SOC_NOPM, 0, 0,
1502 			   rt5670_dac_r_mix, ARRAY_SIZE(rt5670_dac_r_mix)),
1503 	SND_SOC_DAPM_PGA("DAC MIX", SND_SOC_NOPM, 0, 0, NULL, 0),
1504 
1505 	/* DAC2 channel Mux */
1506 	SND_SOC_DAPM_MUX("DAC L2 Mux", SND_SOC_NOPM, 0, 0,
1507 			 &rt5670_dac_l2_mux),
1508 	SND_SOC_DAPM_MUX("DAC R2 Mux", SND_SOC_NOPM, 0, 0,
1509 			 &rt5670_dac_r2_mux),
1510 	SND_SOC_DAPM_PGA("DAC L2 Volume", RT5670_PWR_DIG1,
1511 			 RT5670_PWR_DAC_L2_BIT, 0, NULL, 0),
1512 	SND_SOC_DAPM_PGA("DAC R2 Volume", RT5670_PWR_DIG1,
1513 			 RT5670_PWR_DAC_R2_BIT, 0, NULL, 0),
1514 
1515 	SND_SOC_DAPM_MUX("DAC1 L Mux", SND_SOC_NOPM, 0, 0, &rt5670_dac1l_mux),
1516 	SND_SOC_DAPM_MUX("DAC1 R Mux", SND_SOC_NOPM, 0, 0, &rt5670_dac1r_mux),
1517 
1518 	/* DAC Mixer */
1519 	SND_SOC_DAPM_SUPPLY("DAC Stereo1 Filter", RT5670_PWR_DIG2,
1520 			    RT5670_PWR_DAC_S1F_BIT, 0, NULL, 0),
1521 	SND_SOC_DAPM_SUPPLY("DAC Mono Left Filter", RT5670_PWR_DIG2,
1522 			    RT5670_PWR_DAC_MF_L_BIT, 0, NULL, 0),
1523 	SND_SOC_DAPM_SUPPLY("DAC Mono Right Filter", RT5670_PWR_DIG2,
1524 			    RT5670_PWR_DAC_MF_R_BIT, 0, NULL, 0),
1525 	SND_SOC_DAPM_MIXER("Stereo DAC MIXL", SND_SOC_NOPM, 0, 0,
1526 			   rt5670_sto_dac_l_mix,
1527 			   ARRAY_SIZE(rt5670_sto_dac_l_mix)),
1528 	SND_SOC_DAPM_MIXER("Stereo DAC MIXR", SND_SOC_NOPM, 0, 0,
1529 			   rt5670_sto_dac_r_mix,
1530 			   ARRAY_SIZE(rt5670_sto_dac_r_mix)),
1531 	SND_SOC_DAPM_MIXER("Mono DAC MIXL", SND_SOC_NOPM, 0, 0,
1532 			   rt5670_mono_dac_l_mix,
1533 			   ARRAY_SIZE(rt5670_mono_dac_l_mix)),
1534 	SND_SOC_DAPM_MIXER("Mono DAC MIXR", SND_SOC_NOPM, 0, 0,
1535 			   rt5670_mono_dac_r_mix,
1536 			   ARRAY_SIZE(rt5670_mono_dac_r_mix)),
1537 	SND_SOC_DAPM_MIXER("DAC MIXL", SND_SOC_NOPM, 0, 0,
1538 			   rt5670_dig_l_mix,
1539 			   ARRAY_SIZE(rt5670_dig_l_mix)),
1540 	SND_SOC_DAPM_MIXER("DAC MIXR", SND_SOC_NOPM, 0, 0,
1541 			   rt5670_dig_r_mix,
1542 			   ARRAY_SIZE(rt5670_dig_r_mix)),
1543 
1544 	/* DACs */
1545 	SND_SOC_DAPM_SUPPLY("DAC L1 Power", RT5670_PWR_DIG1,
1546 			    RT5670_PWR_DAC_L1_BIT, 0, NULL, 0),
1547 	SND_SOC_DAPM_SUPPLY("DAC R1 Power", RT5670_PWR_DIG1,
1548 			    RT5670_PWR_DAC_R1_BIT, 0, NULL, 0),
1549 	SND_SOC_DAPM_DAC("DAC L1", NULL, SND_SOC_NOPM, 0, 0),
1550 	SND_SOC_DAPM_DAC("DAC R1", NULL, SND_SOC_NOPM, 0, 0),
1551 	SND_SOC_DAPM_DAC("DAC L2", NULL, RT5670_PWR_DIG1,
1552 			 RT5670_PWR_DAC_L2_BIT, 0),
1553 
1554 	SND_SOC_DAPM_DAC("DAC R2", NULL, RT5670_PWR_DIG1,
1555 			 RT5670_PWR_DAC_R2_BIT, 0),
1556 	/* OUT Mixer */
1557 
1558 	SND_SOC_DAPM_MIXER("OUT MIXL", RT5670_PWR_MIXER, RT5670_PWR_OM_L_BIT,
1559 			   0, rt5670_out_l_mix, ARRAY_SIZE(rt5670_out_l_mix)),
1560 	SND_SOC_DAPM_MIXER("OUT MIXR", RT5670_PWR_MIXER, RT5670_PWR_OM_R_BIT,
1561 			   0, rt5670_out_r_mix, ARRAY_SIZE(rt5670_out_r_mix)),
1562 	/* Ouput Volume */
1563 	SND_SOC_DAPM_MIXER("HPOVOL MIXL", RT5670_PWR_VOL,
1564 			   RT5670_PWR_HV_L_BIT, 0,
1565 			   rt5670_hpvoll_mix, ARRAY_SIZE(rt5670_hpvoll_mix)),
1566 	SND_SOC_DAPM_MIXER("HPOVOL MIXR", RT5670_PWR_VOL,
1567 			   RT5670_PWR_HV_R_BIT, 0,
1568 			   rt5670_hpvolr_mix, ARRAY_SIZE(rt5670_hpvolr_mix)),
1569 	SND_SOC_DAPM_PGA("DAC 1", SND_SOC_NOPM, 0, 0, NULL, 0),
1570 	SND_SOC_DAPM_PGA("DAC 2", SND_SOC_NOPM,	0, 0, NULL, 0),
1571 	SND_SOC_DAPM_PGA("HPOVOL", SND_SOC_NOPM, 0, 0, NULL, 0),
1572 
1573 	/* HPO/LOUT/Mono Mixer */
1574 	SND_SOC_DAPM_MIXER("HPO MIX", SND_SOC_NOPM, 0, 0,
1575 			   rt5670_hpo_mix, ARRAY_SIZE(rt5670_hpo_mix)),
1576 	SND_SOC_DAPM_MIXER("LOUT MIX", RT5670_PWR_ANLG1, RT5670_PWR_LM_BIT,
1577 			   0, rt5670_lout_mix, ARRAY_SIZE(rt5670_lout_mix)),
1578 	SND_SOC_DAPM_SUPPLY_S("Improve HP Amp Drv", 1, SND_SOC_NOPM, 0, 0,
1579 			      rt5670_hp_power_event, SND_SOC_DAPM_POST_PMU |
1580 			      SND_SOC_DAPM_PRE_PMD),
1581 	SND_SOC_DAPM_SUPPLY("HP L Amp", RT5670_PWR_ANLG1,
1582 			    RT5670_PWR_HP_L_BIT, 0, NULL, 0),
1583 	SND_SOC_DAPM_SUPPLY("HP R Amp", RT5670_PWR_ANLG1,
1584 			    RT5670_PWR_HP_R_BIT, 0, NULL, 0),
1585 	SND_SOC_DAPM_PGA_S("HP Amp", 1, SND_SOC_NOPM, 0, 0,
1586 			   rt5670_hp_event, SND_SOC_DAPM_PRE_PMD |
1587 			   SND_SOC_DAPM_POST_PMU),
1588 	SND_SOC_DAPM_SWITCH("LOUT L Playback", SND_SOC_NOPM, 0, 0,
1589 			    &lout_l_enable_control),
1590 	SND_SOC_DAPM_SWITCH("LOUT R Playback", SND_SOC_NOPM, 0, 0,
1591 			    &lout_r_enable_control),
1592 	SND_SOC_DAPM_PGA("LOUT Amp", SND_SOC_NOPM, 0, 0, NULL, 0),
1593 
1594 	/* PDM */
1595 	SND_SOC_DAPM_SUPPLY("PDM1 Power", RT5670_PWR_DIG2,
1596 		RT5670_PWR_PDM1_BIT, 0, NULL, 0),
1597 	SND_SOC_DAPM_SUPPLY("PDM2 Power", RT5670_PWR_DIG2,
1598 		RT5670_PWR_PDM2_BIT, 0, NULL, 0),
1599 
1600 	SND_SOC_DAPM_MUX("PDM1 L Mux", RT5670_PDM_OUT_CTRL,
1601 			 RT5670_M_PDM1_L_SFT, 1, &rt5670_pdm1_l_mux),
1602 	SND_SOC_DAPM_MUX("PDM1 R Mux", RT5670_PDM_OUT_CTRL,
1603 			 RT5670_M_PDM1_R_SFT, 1, &rt5670_pdm1_r_mux),
1604 	SND_SOC_DAPM_MUX("PDM2 L Mux", RT5670_PDM_OUT_CTRL,
1605 			 RT5670_M_PDM2_L_SFT, 1, &rt5670_pdm2_l_mux),
1606 	SND_SOC_DAPM_MUX("PDM2 R Mux", RT5670_PDM_OUT_CTRL,
1607 			 RT5670_M_PDM2_R_SFT, 1, &rt5670_pdm2_r_mux),
1608 
1609 	/* Output Lines */
1610 	SND_SOC_DAPM_OUTPUT("HPOL"),
1611 	SND_SOC_DAPM_OUTPUT("HPOR"),
1612 	SND_SOC_DAPM_OUTPUT("LOUTL"),
1613 	SND_SOC_DAPM_OUTPUT("LOUTR"),
1614 	SND_SOC_DAPM_OUTPUT("PDM1L"),
1615 	SND_SOC_DAPM_OUTPUT("PDM1R"),
1616 	SND_SOC_DAPM_OUTPUT("PDM2L"),
1617 	SND_SOC_DAPM_OUTPUT("PDM2R"),
1618 };
1619 
1620 static const struct snd_soc_dapm_route rt5670_dapm_routes[] = {
1621 	{ "ADC Stereo1 Filter", NULL, "ADC STO1 ASRC", is_using_asrc },
1622 	{ "ADC Stereo2 Filter", NULL, "ADC STO2 ASRC", is_using_asrc },
1623 	{ "ADC Mono Left Filter", NULL, "ADC MONO L ASRC", is_using_asrc },
1624 	{ "ADC Mono Right Filter", NULL, "ADC MONO R ASRC", is_using_asrc },
1625 	{ "DAC Mono Left Filter", NULL, "DAC MONO L ASRC", is_using_asrc },
1626 	{ "DAC Mono Right Filter", NULL, "DAC MONO R ASRC", is_using_asrc },
1627 	{ "DAC Stereo1 Filter", NULL, "DAC STO ASRC", is_using_asrc },
1628 
1629 	{ "I2S1", NULL, "I2S1 ASRC" },
1630 	{ "I2S2", NULL, "I2S2 ASRC" },
1631 
1632 	{ "DMIC1", NULL, "DMIC L1" },
1633 	{ "DMIC1", NULL, "DMIC R1" },
1634 	{ "DMIC2", NULL, "DMIC L2" },
1635 	{ "DMIC2", NULL, "DMIC R2" },
1636 	{ "DMIC3", NULL, "DMIC L3" },
1637 	{ "DMIC3", NULL, "DMIC R3" },
1638 
1639 	{ "BST1", NULL, "IN1P" },
1640 	{ "BST1", NULL, "IN1N" },
1641 	{ "BST1", NULL, "Mic Det Power" },
1642 	{ "BST2", NULL, "IN2P" },
1643 	{ "BST2", NULL, "IN2N" },
1644 
1645 	{ "INL VOL", NULL, "IN2P" },
1646 	{ "INR VOL", NULL, "IN2N" },
1647 
1648 	{ "RECMIXL", "INL Switch", "INL VOL" },
1649 	{ "RECMIXL", "BST2 Switch", "BST2" },
1650 	{ "RECMIXL", "BST1 Switch", "BST1" },
1651 
1652 	{ "RECMIXR", "INR Switch", "INR VOL" },
1653 	{ "RECMIXR", "BST2 Switch", "BST2" },
1654 	{ "RECMIXR", "BST1 Switch", "BST1" },
1655 
1656 	{ "ADC 1", NULL, "RECMIXL" },
1657 	{ "ADC 1", NULL, "ADC 1 power" },
1658 	{ "ADC 1", NULL, "ADC clock" },
1659 	{ "ADC 2", NULL, "RECMIXR" },
1660 	{ "ADC 2", NULL, "ADC 2 power" },
1661 	{ "ADC 2", NULL, "ADC clock" },
1662 
1663 	{ "DMIC L1", NULL, "DMIC CLK" },
1664 	{ "DMIC L1", NULL, "DMIC1 Power" },
1665 	{ "DMIC R1", NULL, "DMIC CLK" },
1666 	{ "DMIC R1", NULL, "DMIC1 Power" },
1667 	{ "DMIC L2", NULL, "DMIC CLK" },
1668 	{ "DMIC L2", NULL, "DMIC2 Power" },
1669 	{ "DMIC R2", NULL, "DMIC CLK" },
1670 	{ "DMIC R2", NULL, "DMIC2 Power" },
1671 	{ "DMIC L3", NULL, "DMIC CLK" },
1672 	{ "DMIC L3", NULL, "DMIC3 Power" },
1673 	{ "DMIC R3", NULL, "DMIC CLK" },
1674 	{ "DMIC R3", NULL, "DMIC3 Power" },
1675 
1676 	{ "Stereo1 DMIC Mux", "DMIC1", "DMIC1" },
1677 	{ "Stereo1 DMIC Mux", "DMIC2", "DMIC2" },
1678 	{ "Stereo1 DMIC Mux", "DMIC3", "DMIC3" },
1679 
1680 	{ "Stereo2 DMIC Mux", "DMIC1", "DMIC1" },
1681 	{ "Stereo2 DMIC Mux", "DMIC2", "DMIC2" },
1682 	{ "Stereo2 DMIC Mux", "DMIC3", "DMIC3" },
1683 
1684 	{ "Mono DMIC L Mux", "DMIC1", "DMIC L1" },
1685 	{ "Mono DMIC L Mux", "DMIC2", "DMIC L2" },
1686 	{ "Mono DMIC L Mux", "DMIC3", "DMIC L3" },
1687 
1688 	{ "Mono DMIC R Mux", "DMIC1", "DMIC R1" },
1689 	{ "Mono DMIC R Mux", "DMIC2", "DMIC R2" },
1690 	{ "Mono DMIC R Mux", "DMIC3", "DMIC R3" },
1691 
1692 	{ "ADC 1_2", NULL, "ADC 1" },
1693 	{ "ADC 1_2", NULL, "ADC 2" },
1694 
1695 	{ "Stereo1 ADC L2 Mux", "DMIC", "Stereo1 DMIC Mux" },
1696 	{ "Stereo1 ADC L2 Mux", "DAC MIX", "DAC MIXL" },
1697 	{ "Stereo1 ADC L1 Mux", "ADC", "ADC 1_2" },
1698 	{ "Stereo1 ADC L1 Mux", "DAC MIX", "DAC MIXL" },
1699 
1700 	{ "Stereo1 ADC R1 Mux", "ADC", "ADC 1_2" },
1701 	{ "Stereo1 ADC R1 Mux", "DAC MIX", "DAC MIXR" },
1702 	{ "Stereo1 ADC R2 Mux", "DMIC", "Stereo1 DMIC Mux" },
1703 	{ "Stereo1 ADC R2 Mux", "DAC MIX", "DAC MIXR" },
1704 
1705 	{ "Mono ADC L2 Mux", "DMIC", "Mono DMIC L Mux" },
1706 	{ "Mono ADC L2 Mux", "Mono DAC MIXL", "Mono DAC MIXL" },
1707 	{ "Mono ADC L1 Mux", "Mono DAC MIXL", "Mono DAC MIXL" },
1708 	{ "Mono ADC L1 Mux", "ADC1",  "ADC 1" },
1709 
1710 	{ "Mono ADC R1 Mux", "Mono DAC MIXR", "Mono DAC MIXR" },
1711 	{ "Mono ADC R1 Mux", "ADC2", "ADC 2" },
1712 	{ "Mono ADC R2 Mux", "DMIC", "Mono DMIC R Mux" },
1713 	{ "Mono ADC R2 Mux", "Mono DAC MIXR", "Mono DAC MIXR" },
1714 
1715 	{ "Sto1 ADC MIXL", "ADC1 Switch", "Stereo1 ADC L1 Mux" },
1716 	{ "Sto1 ADC MIXL", "ADC2 Switch", "Stereo1 ADC L2 Mux" },
1717 	{ "Sto1 ADC MIXR", "ADC1 Switch", "Stereo1 ADC R1 Mux" },
1718 	{ "Sto1 ADC MIXR", "ADC2 Switch", "Stereo1 ADC R2 Mux" },
1719 
1720 	{ "Stereo1 ADC MIXL", NULL, "Sto1 ADC MIXL" },
1721 	{ "Stereo1 ADC MIXL", NULL, "ADC Stereo1 Filter" },
1722 	{ "ADC Stereo1 Filter", NULL, "PLL1", is_sys_clk_from_pll },
1723 
1724 	{ "Stereo1 ADC MIXR", NULL, "Sto1 ADC MIXR" },
1725 	{ "Stereo1 ADC MIXR", NULL, "ADC Stereo1 Filter" },
1726 	{ "ADC Stereo1 Filter", NULL, "PLL1", is_sys_clk_from_pll },
1727 
1728 	{ "Mono ADC MIXL", "ADC1 Switch", "Mono ADC L1 Mux" },
1729 	{ "Mono ADC MIXL", "ADC2 Switch", "Mono ADC L2 Mux" },
1730 	{ "Mono ADC MIXL", NULL, "ADC Mono Left Filter" },
1731 	{ "ADC Mono Left Filter", NULL, "PLL1", is_sys_clk_from_pll },
1732 
1733 	{ "Mono ADC MIXR", "ADC1 Switch", "Mono ADC R1 Mux" },
1734 	{ "Mono ADC MIXR", "ADC2 Switch", "Mono ADC R2 Mux" },
1735 	{ "Mono ADC MIXR", NULL, "ADC Mono Right Filter" },
1736 	{ "ADC Mono Right Filter", NULL, "PLL1", is_sys_clk_from_pll },
1737 
1738 	{ "Stereo2 ADC L2 Mux", "DMIC", "Stereo2 DMIC Mux" },
1739 	{ "Stereo2 ADC L2 Mux", "DAC MIX", "DAC MIXL" },
1740 	{ "Stereo2 ADC L1 Mux", "ADC", "ADC 1_2" },
1741 	{ "Stereo2 ADC L1 Mux", "DAC MIX", "DAC MIXL" },
1742 
1743 	{ "Stereo2 ADC R1 Mux", "ADC", "ADC 1_2" },
1744 	{ "Stereo2 ADC R1 Mux", "DAC MIX", "DAC MIXR" },
1745 	{ "Stereo2 ADC R2 Mux", "DMIC", "Stereo2 DMIC Mux" },
1746 	{ "Stereo2 ADC R2 Mux", "DAC MIX", "DAC MIXR" },
1747 
1748 	{ "Sto2 ADC MIXL", "ADC1 Switch", "Stereo2 ADC L1 Mux" },
1749 	{ "Sto2 ADC MIXL", "ADC2 Switch", "Stereo2 ADC L2 Mux" },
1750 	{ "Sto2 ADC MIXR", "ADC1 Switch", "Stereo2 ADC R1 Mux" },
1751 	{ "Sto2 ADC MIXR", "ADC2 Switch", "Stereo2 ADC R2 Mux" },
1752 
1753 	{ "Sto2 ADC LR MIX", NULL, "Sto2 ADC MIXL" },
1754 	{ "Sto2 ADC LR MIX", NULL, "Sto2 ADC MIXR" },
1755 
1756 	{ "Stereo2 ADC LR Mux", "L", "Sto2 ADC MIXL" },
1757 	{ "Stereo2 ADC LR Mux", "LR", "Sto2 ADC LR MIX" },
1758 
1759 	{ "Stereo2 ADC MIXL", NULL, "Stereo2 ADC LR Mux" },
1760 	{ "Stereo2 ADC MIXL", NULL, "ADC Stereo2 Filter" },
1761 	{ "ADC Stereo2 Filter", NULL, "PLL1", is_sys_clk_from_pll },
1762 
1763 	{ "Stereo2 ADC MIXR", NULL, "Sto2 ADC MIXR" },
1764 	{ "Stereo2 ADC MIXR", NULL, "ADC Stereo2 Filter" },
1765 	{ "ADC Stereo2 Filter", NULL, "PLL1", is_sys_clk_from_pll },
1766 
1767 	{ "VAD ADC Mux", "Sto1 ADC L", "Stereo1 ADC MIXL" },
1768 	{ "VAD ADC Mux", "Mono ADC L", "Mono ADC MIXL" },
1769 	{ "VAD ADC Mux", "Mono ADC R", "Mono ADC MIXR" },
1770 	{ "VAD ADC Mux", "Sto2 ADC L", "Sto2 ADC MIXL" },
1771 
1772 	{ "VAD_ADC", NULL, "VAD ADC Mux" },
1773 
1774 	{ "IF_ADC1", NULL, "Stereo1 ADC MIXL" },
1775 	{ "IF_ADC1", NULL, "Stereo1 ADC MIXR" },
1776 	{ "IF_ADC2", NULL, "Mono ADC MIXL" },
1777 	{ "IF_ADC2", NULL, "Mono ADC MIXR" },
1778 	{ "IF_ADC3", NULL, "Stereo2 ADC MIXL" },
1779 	{ "IF_ADC3", NULL, "Stereo2 ADC MIXR" },
1780 
1781 	{ "IF1 ADC1 IN1 Mux", "IF_ADC1", "IF_ADC1" },
1782 	{ "IF1 ADC1 IN1 Mux", "IF1_ADC3", "IF1_ADC3" },
1783 
1784 	{ "IF1 ADC1 IN2 Mux", "IF1_ADC1_IN1", "IF1 ADC1 IN1 Mux" },
1785 	{ "IF1 ADC1 IN2 Mux", "IF1_ADC4", "IF1_ADC4" },
1786 
1787 	{ "IF1 ADC2 IN Mux", "IF_ADC2", "IF_ADC2" },
1788 	{ "IF1 ADC2 IN Mux", "VAD_ADC", "VAD_ADC" },
1789 
1790 	{ "IF1 ADC2 IN1 Mux", "IF1_ADC2_IN", "IF1 ADC2 IN Mux" },
1791 	{ "IF1 ADC2 IN1 Mux", "IF1_ADC4", "IF1_ADC4" },
1792 
1793 	{ "IF1_ADC1" , NULL, "IF1 ADC1 IN2 Mux" },
1794 	{ "IF1_ADC2" , NULL, "IF1 ADC2 IN1 Mux" },
1795 
1796 	{ "Stereo1 ADC MIX", NULL, "Stereo1 ADC MIXL" },
1797 	{ "Stereo1 ADC MIX", NULL, "Stereo1 ADC MIXR" },
1798 	{ "Stereo2 ADC MIX", NULL, "Sto2 ADC MIXL" },
1799 	{ "Stereo2 ADC MIX", NULL, "Sto2 ADC MIXR" },
1800 	{ "Mono ADC MIX", NULL, "Mono ADC MIXL" },
1801 	{ "Mono ADC MIX", NULL, "Mono ADC MIXR" },
1802 
1803 	{ "RxDP Mux", "IF2 DAC", "IF2 DAC" },
1804 	{ "RxDP Mux", "IF1 DAC", "IF1 DAC2" },
1805 	{ "RxDP Mux", "STO1 ADC Mixer", "Stereo1 ADC MIX" },
1806 	{ "RxDP Mux", "STO2 ADC Mixer", "Stereo2 ADC MIX" },
1807 	{ "RxDP Mux", "Mono ADC Mixer L", "Mono ADC MIXL" },
1808 	{ "RxDP Mux", "Mono ADC Mixer R", "Mono ADC MIXR" },
1809 	{ "RxDP Mux", "DAC1", "DAC MIX" },
1810 
1811 	{ "TDM Data Mux", "Slot 0-1", "Stereo1 ADC MIX" },
1812 	{ "TDM Data Mux", "Slot 2-3", "Mono ADC MIX" },
1813 	{ "TDM Data Mux", "Slot 4-5", "Stereo2 ADC MIX" },
1814 	{ "TDM Data Mux", "Slot 6-7", "IF2 DAC" },
1815 
1816 	{ "DSP UL Mux", "Bypass", "TDM Data Mux" },
1817 	{ "DSP UL Mux", NULL, "I2S DSP" },
1818 	{ "DSP DL Mux", "Bypass", "RxDP Mux" },
1819 	{ "DSP DL Mux", NULL, "I2S DSP" },
1820 
1821 	{ "TxDP_ADC_L", NULL, "DSP UL Mux" },
1822 	{ "TxDP_ADC_R", NULL, "DSP UL Mux" },
1823 	{ "TxDC_DAC", NULL, "DSP DL Mux" },
1824 
1825 	{ "TxDP_ADC", NULL, "TxDP_ADC_L" },
1826 	{ "TxDP_ADC", NULL, "TxDP_ADC_R" },
1827 
1828 	{ "IF1 ADC", NULL, "I2S1" },
1829 	{ "IF1 ADC", NULL, "IF1_ADC1" },
1830 	{ "IF1 ADC", NULL, "IF1_ADC2" },
1831 	{ "IF1 ADC", NULL, "IF_ADC3" },
1832 	{ "IF1 ADC", NULL, "TxDP_ADC" },
1833 
1834 	{ "IF2 ADC Mux", "IF_ADC1", "IF_ADC1" },
1835 	{ "IF2 ADC Mux", "IF_ADC2", "IF_ADC2" },
1836 	{ "IF2 ADC Mux", "IF_ADC3", "IF_ADC3" },
1837 	{ "IF2 ADC Mux", "TxDC_DAC", "TxDC_DAC" },
1838 	{ "IF2 ADC Mux", "TxDP_ADC", "TxDP_ADC" },
1839 	{ "IF2 ADC Mux", "VAD_ADC", "VAD_ADC" },
1840 
1841 	{ "IF2 ADC L", NULL, "IF2 ADC Mux" },
1842 	{ "IF2 ADC R", NULL, "IF2 ADC Mux" },
1843 
1844 	{ "IF2 ADC", NULL, "I2S2" },
1845 	{ "IF2 ADC", NULL, "IF2 ADC L" },
1846 	{ "IF2 ADC", NULL, "IF2 ADC R" },
1847 
1848 	{ "AIF1TX", NULL, "IF1 ADC" },
1849 	{ "AIF2TX", NULL, "IF2 ADC" },
1850 
1851 	{ "IF1 DAC1", NULL, "AIF1RX" },
1852 	{ "IF1 DAC2", NULL, "AIF1RX" },
1853 	{ "IF2 DAC", NULL, "AIF2RX" },
1854 
1855 	{ "IF1 DAC1", NULL, "I2S1" },
1856 	{ "IF1 DAC2", NULL, "I2S1" },
1857 	{ "IF2 DAC", NULL, "I2S2" },
1858 
1859 	{ "IF1 DAC2 L", NULL, "IF1 DAC2" },
1860 	{ "IF1 DAC2 R", NULL, "IF1 DAC2" },
1861 	{ "IF1 DAC1 L", NULL, "IF1 DAC1" },
1862 	{ "IF1 DAC1 R", NULL, "IF1 DAC1" },
1863 	{ "IF2 DAC L", NULL, "IF2 DAC" },
1864 	{ "IF2 DAC R", NULL, "IF2 DAC" },
1865 
1866 	{ "DAC1 L Mux", "IF1 DAC", "IF1 DAC1 L" },
1867 	{ "DAC1 L Mux", "IF2 DAC", "IF2 DAC L" },
1868 
1869 	{ "DAC1 R Mux", "IF1 DAC", "IF1 DAC1 R" },
1870 	{ "DAC1 R Mux", "IF2 DAC", "IF2 DAC R" },
1871 
1872 	{ "DAC1 MIXL", "Stereo ADC Switch", "Stereo1 ADC MIXL" },
1873 	{ "DAC1 MIXL", "DAC1 Switch", "DAC1 L Mux" },
1874 	{ "DAC1 MIXL", NULL, "DAC Stereo1 Filter" },
1875 	{ "DAC1 MIXR", "Stereo ADC Switch", "Stereo1 ADC MIXR" },
1876 	{ "DAC1 MIXR", "DAC1 Switch", "DAC1 R Mux" },
1877 	{ "DAC1 MIXR", NULL, "DAC Stereo1 Filter" },
1878 
1879 	{ "DAC Stereo1 Filter", NULL, "PLL1", is_sys_clk_from_pll },
1880 	{ "DAC Mono Left Filter", NULL, "PLL1", is_sys_clk_from_pll },
1881 	{ "DAC Mono Right Filter", NULL, "PLL1", is_sys_clk_from_pll },
1882 
1883 	{ "DAC MIX", NULL, "DAC1 MIXL" },
1884 	{ "DAC MIX", NULL, "DAC1 MIXR" },
1885 
1886 	{ "Audio DSP", NULL, "DAC1 MIXL" },
1887 	{ "Audio DSP", NULL, "DAC1 MIXR" },
1888 
1889 	{ "DAC L2 Mux", "IF1 DAC", "IF1 DAC2 L" },
1890 	{ "DAC L2 Mux", "IF2 DAC", "IF2 DAC L" },
1891 	{ "DAC L2 Mux", "TxDC DAC", "TxDC_DAC" },
1892 	{ "DAC L2 Mux", "VAD_ADC", "VAD_ADC" },
1893 	{ "DAC L2 Volume", NULL, "DAC L2 Mux" },
1894 	{ "DAC L2 Volume", NULL, "DAC Mono Left Filter" },
1895 
1896 	{ "DAC R2 Mux", "IF1 DAC", "IF1 DAC2 R" },
1897 	{ "DAC R2 Mux", "IF2 DAC", "IF2 DAC R" },
1898 	{ "DAC R2 Mux", "TxDC DAC", "TxDC_DAC" },
1899 	{ "DAC R2 Mux", "TxDP ADC", "TxDP_ADC" },
1900 	{ "DAC R2 Volume", NULL, "DAC R2 Mux" },
1901 	{ "DAC R2 Volume", NULL, "DAC Mono Right Filter" },
1902 
1903 	{ "Stereo DAC MIXL", "DAC L1 Switch", "DAC1 MIXL" },
1904 	{ "Stereo DAC MIXL", "DAC R1 Switch", "DAC1 MIXR" },
1905 	{ "Stereo DAC MIXL", "DAC L2 Switch", "DAC L2 Volume" },
1906 	{ "Stereo DAC MIXL", NULL, "DAC Stereo1 Filter" },
1907 	{ "Stereo DAC MIXL", NULL, "DAC L1 Power" },
1908 	{ "Stereo DAC MIXR", "DAC R1 Switch", "DAC1 MIXR" },
1909 	{ "Stereo DAC MIXR", "DAC L1 Switch", "DAC1 MIXL" },
1910 	{ "Stereo DAC MIXR", "DAC R2 Switch", "DAC R2 Volume" },
1911 	{ "Stereo DAC MIXR", NULL, "DAC Stereo1 Filter" },
1912 	{ "Stereo DAC MIXR", NULL, "DAC R1 Power" },
1913 
1914 	{ "Mono DAC MIXL", "DAC L1 Switch", "DAC1 MIXL" },
1915 	{ "Mono DAC MIXL", "DAC L2 Switch", "DAC L2 Volume" },
1916 	{ "Mono DAC MIXL", "DAC R2 Switch", "DAC R2 Volume" },
1917 	{ "Mono DAC MIXL", NULL, "DAC Mono Left Filter" },
1918 	{ "Mono DAC MIXR", "DAC R1 Switch", "DAC1 MIXR" },
1919 	{ "Mono DAC MIXR", "DAC R2 Switch", "DAC R2 Volume" },
1920 	{ "Mono DAC MIXR", "DAC L2 Switch", "DAC L2 Volume" },
1921 	{ "Mono DAC MIXR", NULL, "DAC Mono Right Filter" },
1922 
1923 	{ "DAC MIXL", "Sto DAC Mix L Switch", "Stereo DAC MIXL" },
1924 	{ "DAC MIXL", "DAC L2 Switch", "DAC L2 Volume" },
1925 	{ "DAC MIXL", "DAC R2 Switch", "DAC R2 Volume" },
1926 	{ "DAC MIXR", "Sto DAC Mix R Switch", "Stereo DAC MIXR" },
1927 	{ "DAC MIXR", "DAC R2 Switch", "DAC R2 Volume" },
1928 	{ "DAC MIXR", "DAC L2 Switch", "DAC L2 Volume" },
1929 
1930 	{ "DAC L1", NULL, "DAC L1 Power" },
1931 	{ "DAC L1", NULL, "Stereo DAC MIXL" },
1932 	{ "DAC R1", NULL, "DAC R1 Power" },
1933 	{ "DAC R1", NULL, "Stereo DAC MIXR" },
1934 	{ "DAC L2", NULL, "Mono DAC MIXL" },
1935 	{ "DAC R2", NULL, "Mono DAC MIXR" },
1936 
1937 	{ "OUT MIXL", "BST1 Switch", "BST1" },
1938 	{ "OUT MIXL", "INL Switch", "INL VOL" },
1939 	{ "OUT MIXL", "DAC L2 Switch", "DAC L2" },
1940 	{ "OUT MIXL", "DAC L1 Switch", "DAC L1" },
1941 
1942 	{ "OUT MIXR", "BST2 Switch", "BST2" },
1943 	{ "OUT MIXR", "INR Switch", "INR VOL" },
1944 	{ "OUT MIXR", "DAC R2 Switch", "DAC R2" },
1945 	{ "OUT MIXR", "DAC R1 Switch", "DAC R1" },
1946 
1947 	{ "HPOVOL MIXL", "DAC1 Switch", "DAC L1" },
1948 	{ "HPOVOL MIXL", "INL Switch", "INL VOL" },
1949 	{ "HPOVOL MIXR", "DAC1 Switch", "DAC R1" },
1950 	{ "HPOVOL MIXR", "INR Switch", "INR VOL" },
1951 
1952 	{ "DAC 2", NULL, "DAC L2" },
1953 	{ "DAC 2", NULL, "DAC R2" },
1954 	{ "DAC 1", NULL, "DAC L1" },
1955 	{ "DAC 1", NULL, "DAC R1" },
1956 	{ "HPOVOL", NULL, "HPOVOL MIXL" },
1957 	{ "HPOVOL", NULL, "HPOVOL MIXR" },
1958 	{ "HPO MIX", "DAC1 Switch", "DAC 1" },
1959 	{ "HPO MIX", "HPVOL Switch", "HPOVOL" },
1960 
1961 	{ "LOUT MIX", "DAC L1 Switch", "DAC L1" },
1962 	{ "LOUT MIX", "DAC R1 Switch", "DAC R1" },
1963 	{ "LOUT MIX", "OUTMIX L Switch", "OUT MIXL" },
1964 	{ "LOUT MIX", "OUTMIX R Switch", "OUT MIXR" },
1965 
1966 	{ "PDM1 L Mux", "Stereo DAC", "Stereo DAC MIXL" },
1967 	{ "PDM1 L Mux", "Mono DAC", "Mono DAC MIXL" },
1968 	{ "PDM1 L Mux", NULL, "PDM1 Power" },
1969 	{ "PDM1 R Mux", "Stereo DAC", "Stereo DAC MIXR" },
1970 	{ "PDM1 R Mux", "Mono DAC", "Mono DAC MIXR" },
1971 	{ "PDM1 R Mux", NULL, "PDM1 Power" },
1972 	{ "PDM2 L Mux", "Stereo DAC", "Stereo DAC MIXL" },
1973 	{ "PDM2 L Mux", "Mono DAC", "Mono DAC MIXL" },
1974 	{ "PDM2 L Mux", NULL, "PDM2 Power" },
1975 	{ "PDM2 R Mux", "Stereo DAC", "Stereo DAC MIXR" },
1976 	{ "PDM2 R Mux", "Mono DAC", "Mono DAC MIXR" },
1977 	{ "PDM2 R Mux", NULL, "PDM2 Power" },
1978 
1979 	{ "HP Amp", NULL, "HPO MIX" },
1980 	{ "HP Amp", NULL, "Mic Det Power" },
1981 	{ "HPOL", NULL, "HP Amp" },
1982 	{ "HPOL", NULL, "HP L Amp" },
1983 	{ "HPOL", NULL, "Improve HP Amp Drv" },
1984 	{ "HPOR", NULL, "HP Amp" },
1985 	{ "HPOR", NULL, "HP R Amp" },
1986 	{ "HPOR", NULL, "Improve HP Amp Drv" },
1987 
1988 	{ "LOUT Amp", NULL, "LOUT MIX" },
1989 	{ "LOUT L Playback", "Switch", "LOUT Amp" },
1990 	{ "LOUT R Playback", "Switch", "LOUT Amp" },
1991 	{ "LOUTL", NULL, "LOUT L Playback" },
1992 	{ "LOUTR", NULL, "LOUT R Playback" },
1993 	{ "LOUTL", NULL, "Improve HP Amp Drv" },
1994 	{ "LOUTR", NULL, "Improve HP Amp Drv" },
1995 
1996 	{ "PDM1L", NULL, "PDM1 L Mux" },
1997 	{ "PDM1R", NULL, "PDM1 R Mux" },
1998 	{ "PDM2L", NULL, "PDM2 L Mux" },
1999 	{ "PDM2R", NULL, "PDM2 R Mux" },
2000 };
2001 
rt5670_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)2002 static int rt5670_hw_params(struct snd_pcm_substream *substream,
2003 	struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
2004 {
2005 	struct snd_soc_codec *codec = dai->codec;
2006 	struct rt5670_priv *rt5670 = snd_soc_codec_get_drvdata(codec);
2007 	unsigned int val_len = 0, val_clk, mask_clk;
2008 	int pre_div, bclk_ms, frame_size;
2009 
2010 	rt5670->lrck[dai->id] = params_rate(params);
2011 	pre_div = rl6231_get_clk_info(rt5670->sysclk, rt5670->lrck[dai->id]);
2012 	if (pre_div < 0) {
2013 		dev_err(codec->dev, "Unsupported clock setting %d for DAI %d\n",
2014 			rt5670->lrck[dai->id], dai->id);
2015 		return -EINVAL;
2016 	}
2017 	frame_size = snd_soc_params_to_frame_size(params);
2018 	if (frame_size < 0) {
2019 		dev_err(codec->dev, "Unsupported frame size: %d\n", frame_size);
2020 		return -EINVAL;
2021 	}
2022 	bclk_ms = frame_size > 32;
2023 	rt5670->bclk[dai->id] = rt5670->lrck[dai->id] * (32 << bclk_ms);
2024 
2025 	dev_dbg(dai->dev, "bclk is %dHz and lrck is %dHz\n",
2026 		rt5670->bclk[dai->id], rt5670->lrck[dai->id]);
2027 	dev_dbg(dai->dev, "bclk_ms is %d and pre_div is %d for iis %d\n",
2028 				bclk_ms, pre_div, dai->id);
2029 
2030 	switch (params_width(params)) {
2031 	case 16:
2032 		break;
2033 	case 20:
2034 		val_len |= RT5670_I2S_DL_20;
2035 		break;
2036 	case 24:
2037 		val_len |= RT5670_I2S_DL_24;
2038 		break;
2039 	case 8:
2040 		val_len |= RT5670_I2S_DL_8;
2041 		break;
2042 	default:
2043 		return -EINVAL;
2044 	}
2045 
2046 	switch (dai->id) {
2047 	case RT5670_AIF1:
2048 		mask_clk = RT5670_I2S_BCLK_MS1_MASK | RT5670_I2S_PD1_MASK;
2049 		val_clk = bclk_ms << RT5670_I2S_BCLK_MS1_SFT |
2050 			pre_div << RT5670_I2S_PD1_SFT;
2051 		snd_soc_update_bits(codec, RT5670_I2S1_SDP,
2052 			RT5670_I2S_DL_MASK, val_len);
2053 		snd_soc_update_bits(codec, RT5670_ADDA_CLK1, mask_clk, val_clk);
2054 		break;
2055 	case RT5670_AIF2:
2056 		mask_clk = RT5670_I2S_BCLK_MS2_MASK | RT5670_I2S_PD2_MASK;
2057 		val_clk = bclk_ms << RT5670_I2S_BCLK_MS2_SFT |
2058 			pre_div << RT5670_I2S_PD2_SFT;
2059 		snd_soc_update_bits(codec, RT5670_I2S2_SDP,
2060 			RT5670_I2S_DL_MASK, val_len);
2061 		snd_soc_update_bits(codec, RT5670_ADDA_CLK1, mask_clk, val_clk);
2062 		break;
2063 	default:
2064 		dev_err(codec->dev, "Invalid dai->id: %d\n", dai->id);
2065 		return -EINVAL;
2066 	}
2067 
2068 	return 0;
2069 }
2070 
rt5670_set_dai_fmt(struct snd_soc_dai * dai,unsigned int fmt)2071 static int rt5670_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
2072 {
2073 	struct snd_soc_codec *codec = dai->codec;
2074 	struct rt5670_priv *rt5670 = snd_soc_codec_get_drvdata(codec);
2075 	unsigned int reg_val = 0;
2076 
2077 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
2078 	case SND_SOC_DAIFMT_CBM_CFM:
2079 		rt5670->master[dai->id] = 1;
2080 		break;
2081 	case SND_SOC_DAIFMT_CBS_CFS:
2082 		reg_val |= RT5670_I2S_MS_S;
2083 		rt5670->master[dai->id] = 0;
2084 		break;
2085 	default:
2086 		return -EINVAL;
2087 	}
2088 
2089 	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
2090 	case SND_SOC_DAIFMT_NB_NF:
2091 		break;
2092 	case SND_SOC_DAIFMT_IB_NF:
2093 		reg_val |= RT5670_I2S_BP_INV;
2094 		break;
2095 	default:
2096 		return -EINVAL;
2097 	}
2098 
2099 	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
2100 	case SND_SOC_DAIFMT_I2S:
2101 		break;
2102 	case SND_SOC_DAIFMT_LEFT_J:
2103 		reg_val |= RT5670_I2S_DF_LEFT;
2104 		break;
2105 	case SND_SOC_DAIFMT_DSP_A:
2106 		reg_val |= RT5670_I2S_DF_PCM_A;
2107 		break;
2108 	case SND_SOC_DAIFMT_DSP_B:
2109 		reg_val |= RT5670_I2S_DF_PCM_B;
2110 		break;
2111 	default:
2112 		return -EINVAL;
2113 	}
2114 
2115 	switch (dai->id) {
2116 	case RT5670_AIF1:
2117 		snd_soc_update_bits(codec, RT5670_I2S1_SDP,
2118 			RT5670_I2S_MS_MASK | RT5670_I2S_BP_MASK |
2119 			RT5670_I2S_DF_MASK, reg_val);
2120 		break;
2121 	case RT5670_AIF2:
2122 		snd_soc_update_bits(codec, RT5670_I2S2_SDP,
2123 			RT5670_I2S_MS_MASK | RT5670_I2S_BP_MASK |
2124 			RT5670_I2S_DF_MASK, reg_val);
2125 		break;
2126 	default:
2127 		dev_err(codec->dev, "Invalid dai->id: %d\n", dai->id);
2128 		return -EINVAL;
2129 	}
2130 	return 0;
2131 }
2132 
rt5670_set_dai_sysclk(struct snd_soc_dai * dai,int clk_id,unsigned int freq,int dir)2133 static int rt5670_set_dai_sysclk(struct snd_soc_dai *dai,
2134 		int clk_id, unsigned int freq, int dir)
2135 {
2136 	struct snd_soc_codec *codec = dai->codec;
2137 	struct rt5670_priv *rt5670 = snd_soc_codec_get_drvdata(codec);
2138 	unsigned int reg_val = 0;
2139 
2140 	if (freq == rt5670->sysclk && clk_id == rt5670->sysclk_src)
2141 		return 0;
2142 
2143 	switch (clk_id) {
2144 	case RT5670_SCLK_S_MCLK:
2145 		reg_val |= RT5670_SCLK_SRC_MCLK;
2146 		break;
2147 	case RT5670_SCLK_S_PLL1:
2148 		reg_val |= RT5670_SCLK_SRC_PLL1;
2149 		break;
2150 	case RT5670_SCLK_S_RCCLK:
2151 		reg_val |= RT5670_SCLK_SRC_RCCLK;
2152 		break;
2153 	default:
2154 		dev_err(codec->dev, "Invalid clock id (%d)\n", clk_id);
2155 		return -EINVAL;
2156 	}
2157 	snd_soc_update_bits(codec, RT5670_GLB_CLK,
2158 		RT5670_SCLK_SRC_MASK, reg_val);
2159 	rt5670->sysclk = freq;
2160 	rt5670->sysclk_src = clk_id;
2161 
2162 	dev_dbg(dai->dev, "Sysclk is %dHz and clock id is %d\n", freq, clk_id);
2163 
2164 	return 0;
2165 }
2166 
rt5670_set_dai_pll(struct snd_soc_dai * dai,int pll_id,int source,unsigned int freq_in,unsigned int freq_out)2167 static int rt5670_set_dai_pll(struct snd_soc_dai *dai, int pll_id, int source,
2168 			unsigned int freq_in, unsigned int freq_out)
2169 {
2170 	struct snd_soc_codec *codec = dai->codec;
2171 	struct rt5670_priv *rt5670 = snd_soc_codec_get_drvdata(codec);
2172 	struct rl6231_pll_code pll_code;
2173 	int ret;
2174 
2175 	if (source == rt5670->pll_src && freq_in == rt5670->pll_in &&
2176 	    freq_out == rt5670->pll_out)
2177 		return 0;
2178 
2179 	if (!freq_in || !freq_out) {
2180 		dev_dbg(codec->dev, "PLL disabled\n");
2181 
2182 		rt5670->pll_in = 0;
2183 		rt5670->pll_out = 0;
2184 		snd_soc_update_bits(codec, RT5670_GLB_CLK,
2185 			RT5670_SCLK_SRC_MASK, RT5670_SCLK_SRC_MCLK);
2186 		return 0;
2187 	}
2188 
2189 	switch (source) {
2190 	case RT5670_PLL1_S_MCLK:
2191 		snd_soc_update_bits(codec, RT5670_GLB_CLK,
2192 			RT5670_PLL1_SRC_MASK, RT5670_PLL1_SRC_MCLK);
2193 		break;
2194 	case RT5670_PLL1_S_BCLK1:
2195 	case RT5670_PLL1_S_BCLK2:
2196 	case RT5670_PLL1_S_BCLK3:
2197 	case RT5670_PLL1_S_BCLK4:
2198 		switch (dai->id) {
2199 		case RT5670_AIF1:
2200 			snd_soc_update_bits(codec, RT5670_GLB_CLK,
2201 				RT5670_PLL1_SRC_MASK, RT5670_PLL1_SRC_BCLK1);
2202 			break;
2203 		case RT5670_AIF2:
2204 			snd_soc_update_bits(codec, RT5670_GLB_CLK,
2205 				RT5670_PLL1_SRC_MASK, RT5670_PLL1_SRC_BCLK2);
2206 			break;
2207 		default:
2208 			dev_err(codec->dev, "Invalid dai->id: %d\n", dai->id);
2209 			return -EINVAL;
2210 		}
2211 		break;
2212 	default:
2213 		dev_err(codec->dev, "Unknown PLL source %d\n", source);
2214 		return -EINVAL;
2215 	}
2216 
2217 	ret = rl6231_pll_calc(freq_in, freq_out, &pll_code);
2218 	if (ret < 0) {
2219 		dev_err(codec->dev, "Unsupport input clock %d\n", freq_in);
2220 		return ret;
2221 	}
2222 
2223 	dev_dbg(codec->dev, "bypass=%d m=%d n=%d k=%d\n",
2224 		pll_code.m_bp, (pll_code.m_bp ? 0 : pll_code.m_code),
2225 		pll_code.n_code, pll_code.k_code);
2226 
2227 	snd_soc_write(codec, RT5670_PLL_CTRL1,
2228 		pll_code.n_code << RT5670_PLL_N_SFT | pll_code.k_code);
2229 	snd_soc_write(codec, RT5670_PLL_CTRL2,
2230 		(pll_code.m_bp ? 0 : pll_code.m_code) << RT5670_PLL_M_SFT |
2231 		pll_code.m_bp << RT5670_PLL_M_BP_SFT);
2232 
2233 	rt5670->pll_in = freq_in;
2234 	rt5670->pll_out = freq_out;
2235 	rt5670->pll_src = source;
2236 
2237 	return 0;
2238 }
2239 
rt5670_set_tdm_slot(struct snd_soc_dai * dai,unsigned int tx_mask,unsigned int rx_mask,int slots,int slot_width)2240 static int rt5670_set_tdm_slot(struct snd_soc_dai *dai, unsigned int tx_mask,
2241 			unsigned int rx_mask, int slots, int slot_width)
2242 {
2243 	struct snd_soc_codec *codec = dai->codec;
2244 	unsigned int val = 0;
2245 
2246 	if (rx_mask || tx_mask)
2247 		val |= (1 << 14);
2248 
2249 	switch (slots) {
2250 	case 4:
2251 		val |= (1 << 12);
2252 		break;
2253 	case 6:
2254 		val |= (2 << 12);
2255 		break;
2256 	case 8:
2257 		val |= (3 << 12);
2258 		break;
2259 	case 2:
2260 		break;
2261 	default:
2262 		return -EINVAL;
2263 	}
2264 
2265 	switch (slot_width) {
2266 	case 20:
2267 		val |= (1 << 10);
2268 		break;
2269 	case 24:
2270 		val |= (2 << 10);
2271 		break;
2272 	case 32:
2273 		val |= (3 << 10);
2274 		break;
2275 	case 16:
2276 		break;
2277 	default:
2278 		return -EINVAL;
2279 	}
2280 
2281 	snd_soc_update_bits(codec, RT5670_TDM_CTRL_1, 0x7c00, val);
2282 
2283 	return 0;
2284 }
2285 
rt5670_set_bias_level(struct snd_soc_codec * codec,enum snd_soc_bias_level level)2286 static int rt5670_set_bias_level(struct snd_soc_codec *codec,
2287 			enum snd_soc_bias_level level)
2288 {
2289 	switch (level) {
2290 	case SND_SOC_BIAS_PREPARE:
2291 		if (SND_SOC_BIAS_STANDBY == codec->dapm.bias_level) {
2292 			snd_soc_update_bits(codec, RT5670_PWR_ANLG1,
2293 				RT5670_PWR_VREF1 | RT5670_PWR_MB |
2294 				RT5670_PWR_BG | RT5670_PWR_VREF2,
2295 				RT5670_PWR_VREF1 | RT5670_PWR_MB |
2296 				RT5670_PWR_BG | RT5670_PWR_VREF2);
2297 			mdelay(10);
2298 			snd_soc_update_bits(codec, RT5670_PWR_ANLG1,
2299 				RT5670_PWR_FV1 | RT5670_PWR_FV2,
2300 				RT5670_PWR_FV1 | RT5670_PWR_FV2);
2301 			snd_soc_update_bits(codec, RT5670_CHARGE_PUMP,
2302 				RT5670_OSW_L_MASK | RT5670_OSW_R_MASK,
2303 				RT5670_OSW_L_DIS | RT5670_OSW_R_DIS);
2304 			snd_soc_update_bits(codec, RT5670_DIG_MISC, 0x1, 0x1);
2305 			snd_soc_update_bits(codec, RT5670_PWR_ANLG1,
2306 				RT5670_LDO_SEL_MASK, 0x3);
2307 		}
2308 		break;
2309 	case SND_SOC_BIAS_STANDBY:
2310 		snd_soc_write(codec, RT5670_PWR_DIG1, 0x0000);
2311 		snd_soc_write(codec, RT5670_PWR_DIG2, 0x0001);
2312 		snd_soc_write(codec, RT5670_PWR_VOL, 0x0000);
2313 		snd_soc_write(codec, RT5670_PWR_MIXER, 0x0001);
2314 		snd_soc_write(codec, RT5670_PWR_ANLG1, 0x2800);
2315 		snd_soc_write(codec, RT5670_PWR_ANLG2, 0x0004);
2316 		snd_soc_update_bits(codec, RT5670_DIG_MISC, 0x1, 0x0);
2317 		snd_soc_update_bits(codec, RT5670_PWR_ANLG1,
2318 				RT5670_LDO_SEL_MASK, 0x1);
2319 		break;
2320 
2321 	default:
2322 		break;
2323 	}
2324 	codec->dapm.bias_level = level;
2325 
2326 	return 0;
2327 }
2328 
rt5670_probe(struct snd_soc_codec * codec)2329 static int rt5670_probe(struct snd_soc_codec *codec)
2330 {
2331 	struct rt5670_priv *rt5670 = snd_soc_codec_get_drvdata(codec);
2332 
2333 	rt5670->codec = codec;
2334 
2335 	return 0;
2336 }
2337 
rt5670_remove(struct snd_soc_codec * codec)2338 static int rt5670_remove(struct snd_soc_codec *codec)
2339 {
2340 	struct rt5670_priv *rt5670 = snd_soc_codec_get_drvdata(codec);
2341 
2342 	regmap_write(rt5670->regmap, RT5670_RESET, 0);
2343 	return 0;
2344 }
2345 
2346 #ifdef CONFIG_PM
rt5670_suspend(struct snd_soc_codec * codec)2347 static int rt5670_suspend(struct snd_soc_codec *codec)
2348 {
2349 	struct rt5670_priv *rt5670 = snd_soc_codec_get_drvdata(codec);
2350 
2351 	regcache_cache_only(rt5670->regmap, true);
2352 	regcache_mark_dirty(rt5670->regmap);
2353 	return 0;
2354 }
2355 
rt5670_resume(struct snd_soc_codec * codec)2356 static int rt5670_resume(struct snd_soc_codec *codec)
2357 {
2358 	struct rt5670_priv *rt5670 = snd_soc_codec_get_drvdata(codec);
2359 
2360 	regcache_cache_only(rt5670->regmap, false);
2361 	regcache_sync(rt5670->regmap);
2362 
2363 	return 0;
2364 }
2365 #else
2366 #define rt5670_suspend NULL
2367 #define rt5670_resume NULL
2368 #endif
2369 
2370 #define RT5670_STEREO_RATES SNDRV_PCM_RATE_8000_96000
2371 #define RT5670_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
2372 			SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S8)
2373 
2374 static struct snd_soc_dai_ops rt5670_aif_dai_ops = {
2375 	.hw_params = rt5670_hw_params,
2376 	.set_fmt = rt5670_set_dai_fmt,
2377 	.set_sysclk = rt5670_set_dai_sysclk,
2378 	.set_tdm_slot = rt5670_set_tdm_slot,
2379 	.set_pll = rt5670_set_dai_pll,
2380 };
2381 
2382 static struct snd_soc_dai_driver rt5670_dai[] = {
2383 	{
2384 		.name = "rt5670-aif1",
2385 		.id = RT5670_AIF1,
2386 		.playback = {
2387 			.stream_name = "AIF1 Playback",
2388 			.channels_min = 1,
2389 			.channels_max = 2,
2390 			.rates = RT5670_STEREO_RATES,
2391 			.formats = RT5670_FORMATS,
2392 		},
2393 		.capture = {
2394 			.stream_name = "AIF1 Capture",
2395 			.channels_min = 1,
2396 			.channels_max = 2,
2397 			.rates = RT5670_STEREO_RATES,
2398 			.formats = RT5670_FORMATS,
2399 		},
2400 		.ops = &rt5670_aif_dai_ops,
2401 	},
2402 	{
2403 		.name = "rt5670-aif2",
2404 		.id = RT5670_AIF2,
2405 		.playback = {
2406 			.stream_name = "AIF2 Playback",
2407 			.channels_min = 1,
2408 			.channels_max = 2,
2409 			.rates = RT5670_STEREO_RATES,
2410 			.formats = RT5670_FORMATS,
2411 		},
2412 		.capture = {
2413 			.stream_name = "AIF2 Capture",
2414 			.channels_min = 1,
2415 			.channels_max = 2,
2416 			.rates = RT5670_STEREO_RATES,
2417 			.formats = RT5670_FORMATS,
2418 		},
2419 		.ops = &rt5670_aif_dai_ops,
2420 	},
2421 };
2422 
2423 static struct snd_soc_codec_driver soc_codec_dev_rt5670 = {
2424 	.probe = rt5670_probe,
2425 	.remove = rt5670_remove,
2426 	.suspend = rt5670_suspend,
2427 	.resume = rt5670_resume,
2428 	.set_bias_level = rt5670_set_bias_level,
2429 	.idle_bias_off = true,
2430 	.controls = rt5670_snd_controls,
2431 	.num_controls = ARRAY_SIZE(rt5670_snd_controls),
2432 	.dapm_widgets = rt5670_dapm_widgets,
2433 	.num_dapm_widgets = ARRAY_SIZE(rt5670_dapm_widgets),
2434 	.dapm_routes = rt5670_dapm_routes,
2435 	.num_dapm_routes = ARRAY_SIZE(rt5670_dapm_routes),
2436 };
2437 
2438 static const struct regmap_config rt5670_regmap = {
2439 	.reg_bits = 8,
2440 	.val_bits = 16,
2441 	.use_single_rw = true,
2442 	.max_register = RT5670_VENDOR_ID2 + 1 + (ARRAY_SIZE(rt5670_ranges) *
2443 					       RT5670_PR_SPACING),
2444 	.volatile_reg = rt5670_volatile_register,
2445 	.readable_reg = rt5670_readable_register,
2446 	.cache_type = REGCACHE_RBTREE,
2447 	.reg_defaults = rt5670_reg,
2448 	.num_reg_defaults = ARRAY_SIZE(rt5670_reg),
2449 	.ranges = rt5670_ranges,
2450 	.num_ranges = ARRAY_SIZE(rt5670_ranges),
2451 };
2452 
2453 static const struct i2c_device_id rt5670_i2c_id[] = {
2454 	{ "rt5670", 0 },
2455 	{ }
2456 };
2457 MODULE_DEVICE_TABLE(i2c, rt5670_i2c_id);
2458 
rt5670_i2c_probe(struct i2c_client * i2c,const struct i2c_device_id * id)2459 static int rt5670_i2c_probe(struct i2c_client *i2c,
2460 		    const struct i2c_device_id *id)
2461 {
2462 	struct rt5670_platform_data *pdata = dev_get_platdata(&i2c->dev);
2463 	struct rt5670_priv *rt5670;
2464 	int ret;
2465 	unsigned int val;
2466 
2467 	rt5670 = devm_kzalloc(&i2c->dev,
2468 				sizeof(struct rt5670_priv),
2469 				GFP_KERNEL);
2470 	if (NULL == rt5670)
2471 		return -ENOMEM;
2472 
2473 	i2c_set_clientdata(i2c, rt5670);
2474 
2475 	if (pdata)
2476 		rt5670->pdata = *pdata;
2477 
2478 	rt5670->regmap = devm_regmap_init_i2c(i2c, &rt5670_regmap);
2479 	if (IS_ERR(rt5670->regmap)) {
2480 		ret = PTR_ERR(rt5670->regmap);
2481 		dev_err(&i2c->dev, "Failed to allocate register map: %d\n",
2482 			ret);
2483 		return ret;
2484 	}
2485 
2486 	regmap_read(rt5670->regmap, RT5670_VENDOR_ID2, &val);
2487 	if (val != RT5670_DEVICE_ID) {
2488 		dev_err(&i2c->dev,
2489 			"Device with ID register %x is not rt5670/72\n", val);
2490 		return -ENODEV;
2491 	}
2492 
2493 	regmap_write(rt5670->regmap, RT5670_RESET, 0);
2494 	regmap_update_bits(rt5670->regmap, RT5670_PWR_ANLG1,
2495 		RT5670_PWR_HP_L | RT5670_PWR_HP_R |
2496 		RT5670_PWR_VREF2, RT5670_PWR_VREF2);
2497 	msleep(100);
2498 
2499 	regmap_write(rt5670->regmap, RT5670_RESET, 0);
2500 
2501 	ret = regmap_register_patch(rt5670->regmap, init_list,
2502 				    ARRAY_SIZE(init_list));
2503 	if (ret != 0)
2504 		dev_warn(&i2c->dev, "Failed to apply regmap patch: %d\n", ret);
2505 
2506 	if (rt5670->pdata.in2_diff)
2507 		regmap_update_bits(rt5670->regmap, RT5670_IN2,
2508 					RT5670_IN_DF2, RT5670_IN_DF2);
2509 
2510 	if (i2c->irq) {
2511 		regmap_update_bits(rt5670->regmap, RT5670_GPIO_CTRL1,
2512 				   RT5670_GP1_PIN_MASK, RT5670_GP1_PIN_IRQ);
2513 		regmap_update_bits(rt5670->regmap, RT5670_GPIO_CTRL2,
2514 				   RT5670_GP1_PF_MASK, RT5670_GP1_PF_OUT);
2515 
2516 	}
2517 
2518 	if (rt5670->pdata.jd_mode) {
2519 		regmap_update_bits(rt5670->regmap, RT5670_PWR_ANLG1,
2520 				   RT5670_PWR_MB, RT5670_PWR_MB);
2521 		regmap_update_bits(rt5670->regmap, RT5670_PWR_ANLG2,
2522 				   RT5670_PWR_JD1, RT5670_PWR_JD1);
2523 		regmap_update_bits(rt5670->regmap, RT5670_IRQ_CTRL1,
2524 				   RT5670_JD1_1_EN_MASK, RT5670_JD1_1_EN);
2525 		regmap_update_bits(rt5670->regmap, RT5670_JD_CTRL3,
2526 				   RT5670_JD_TRI_CBJ_SEL_MASK |
2527 				   RT5670_JD_TRI_HPO_SEL_MASK,
2528 				   RT5670_JD_CBJ_JD1_1 | RT5670_JD_HPO_JD1_1);
2529 		switch (rt5670->pdata.jd_mode) {
2530 		case 1:
2531 			regmap_update_bits(rt5670->regmap, RT5670_A_JD_CTRL1,
2532 					   RT5670_JD1_MODE_MASK,
2533 					   RT5670_JD1_MODE_0);
2534 			break;
2535 		case 2:
2536 			regmap_update_bits(rt5670->regmap, RT5670_A_JD_CTRL1,
2537 					   RT5670_JD1_MODE_MASK,
2538 					   RT5670_JD1_MODE_1);
2539 			break;
2540 		case 3:
2541 			regmap_update_bits(rt5670->regmap, RT5670_A_JD_CTRL1,
2542 					   RT5670_JD1_MODE_MASK,
2543 					   RT5670_JD1_MODE_2);
2544 			break;
2545 		default:
2546 			break;
2547 		}
2548 	}
2549 
2550 	if (rt5670->pdata.dmic_en) {
2551 		regmap_update_bits(rt5670->regmap, RT5670_GPIO_CTRL1,
2552 				   RT5670_GP2_PIN_MASK,
2553 				   RT5670_GP2_PIN_DMIC1_SCL);
2554 
2555 		switch (rt5670->pdata.dmic1_data_pin) {
2556 		case RT5670_DMIC_DATA_IN2P:
2557 			regmap_update_bits(rt5670->regmap, RT5670_DMIC_CTRL1,
2558 					   RT5670_DMIC_1_DP_MASK,
2559 					   RT5670_DMIC_1_DP_IN2P);
2560 			break;
2561 
2562 		case RT5670_DMIC_DATA_GPIO6:
2563 			regmap_update_bits(rt5670->regmap, RT5670_DMIC_CTRL1,
2564 					   RT5670_DMIC_1_DP_MASK,
2565 					   RT5670_DMIC_1_DP_GPIO6);
2566 			regmap_update_bits(rt5670->regmap, RT5670_GPIO_CTRL1,
2567 					   RT5670_GP6_PIN_MASK,
2568 					   RT5670_GP6_PIN_DMIC1_SDA);
2569 			break;
2570 
2571 		case RT5670_DMIC_DATA_GPIO7:
2572 			regmap_update_bits(rt5670->regmap, RT5670_DMIC_CTRL1,
2573 					   RT5670_DMIC_1_DP_MASK,
2574 					   RT5670_DMIC_1_DP_GPIO7);
2575 			regmap_update_bits(rt5670->regmap, RT5670_GPIO_CTRL1,
2576 					   RT5670_GP7_PIN_MASK,
2577 					   RT5670_GP7_PIN_DMIC1_SDA);
2578 			break;
2579 
2580 		default:
2581 			break;
2582 		}
2583 
2584 		switch (rt5670->pdata.dmic2_data_pin) {
2585 		case RT5670_DMIC_DATA_IN3N:
2586 			regmap_update_bits(rt5670->regmap, RT5670_DMIC_CTRL1,
2587 					   RT5670_DMIC_2_DP_MASK,
2588 					   RT5670_DMIC_2_DP_IN3N);
2589 			break;
2590 
2591 		case RT5670_DMIC_DATA_GPIO8:
2592 			regmap_update_bits(rt5670->regmap, RT5670_DMIC_CTRL1,
2593 					   RT5670_DMIC_2_DP_MASK,
2594 					   RT5670_DMIC_2_DP_GPIO8);
2595 			regmap_update_bits(rt5670->regmap, RT5670_GPIO_CTRL1,
2596 					   RT5670_GP8_PIN_MASK,
2597 					   RT5670_GP8_PIN_DMIC2_SDA);
2598 			break;
2599 
2600 		default:
2601 			break;
2602 		}
2603 
2604 		switch (rt5670->pdata.dmic3_data_pin) {
2605 		case RT5670_DMIC_DATA_GPIO5:
2606 			regmap_update_bits(rt5670->regmap, RT5670_DMIC_CTRL2,
2607 					   RT5670_DMIC_3_DP_MASK,
2608 					   RT5670_DMIC_3_DP_GPIO5);
2609 			regmap_update_bits(rt5670->regmap, RT5670_GPIO_CTRL1,
2610 					   RT5670_GP5_PIN_MASK,
2611 					   RT5670_GP5_PIN_DMIC3_SDA);
2612 			break;
2613 
2614 		case RT5670_DMIC_DATA_GPIO9:
2615 		case RT5670_DMIC_DATA_GPIO10:
2616 			dev_err(&i2c->dev,
2617 				"Always use GPIO5 as DMIC3 data pin\n");
2618 			break;
2619 
2620 		default:
2621 			break;
2622 		}
2623 
2624 	}
2625 
2626 	ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_rt5670,
2627 			rt5670_dai, ARRAY_SIZE(rt5670_dai));
2628 	if (ret < 0)
2629 		goto err;
2630 
2631 	return 0;
2632 err:
2633 	return ret;
2634 }
2635 
rt5670_i2c_remove(struct i2c_client * i2c)2636 static int rt5670_i2c_remove(struct i2c_client *i2c)
2637 {
2638 	snd_soc_unregister_codec(&i2c->dev);
2639 
2640 	return 0;
2641 }
2642 
2643 static struct i2c_driver rt5670_i2c_driver = {
2644 	.driver = {
2645 		.name = "rt5670",
2646 		.owner = THIS_MODULE,
2647 	},
2648 	.probe = rt5670_i2c_probe,
2649 	.remove   = rt5670_i2c_remove,
2650 	.id_table = rt5670_i2c_id,
2651 };
2652 
2653 module_i2c_driver(rt5670_i2c_driver);
2654 
2655 MODULE_DESCRIPTION("ASoC RT5670 driver");
2656 MODULE_AUTHOR("Bard Liao <bardliao@realtek.com>");
2657 MODULE_LICENSE("GPL v2");
2658