projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
ASoC: rt5640: Add minimal support for RT5642
[deliverable/linux.git] / sound / soc / codecs / rt5640.c
1 /*
2 * rt5640.c -- RT5640/RT5639 ALSA SoC audio codec driver
3 *
4 * Copyright 2011 Realtek Semiconductor Corp.
5 * Author: Johnny Hsu <johnnyhsu@realtek.com>
6 * Copyright (c) 2013, NVIDIA CORPORATION. All rights reserved.
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
11 */
12
13 #include <linux/module.h>
14 #include <linux/moduleparam.h>
15 #include <linux/init.h>
16 #include <linux/delay.h>
17 #include <linux/pm.h>
18 #include <linux/gpio.h>
19 #include <linux/i2c.h>
20 #include <linux/regmap.h>
21 #include <linux/of_gpio.h>
22 #include <linux/platform_device.h>
23 #include <linux/spi/spi.h>
24 #include <linux/acpi.h>
25 #include <sound/core.h>
26 #include <sound/pcm.h>
27 #include <sound/pcm_params.h>
28 #include <sound/soc.h>
29 #include <sound/soc-dapm.h>
30 #include <sound/initval.h>
31 #include <sound/tlv.h>
32
33 #include "rt5640.h"
34
35 #define RT5640_DEVICE_ID 0x6231
36
37 #define RT5640_PR_RANGE_BASE (0xff + 1)
38 #define RT5640_PR_SPACING 0x100
39
40 #define RT5640_PR_BASE (RT5640_PR_RANGE_BASE + (0 * RT5640_PR_SPACING))
41
42 static const struct regmap_range_cfg rt5640_ranges[] = {
43 { .name = "PR", .range_min = RT5640_PR_BASE,
44 .range_max = RT5640_PR_BASE + 0xb4,
45 .selector_reg = RT5640_PRIV_INDEX,
46 .selector_mask = 0xff,
47 .selector_shift = 0x0,
48 .window_start = RT5640_PRIV_DATA,
49 .window_len = 0x1, },
50 };
51
52 static struct reg_default init_list[] = {
53 {RT5640_PR_BASE + 0x3d, 0x3600},
54 {RT5640_PR_BASE + 0x12, 0x0aa8},
55 {RT5640_PR_BASE + 0x14, 0x0aaa},
56 {RT5640_PR_BASE + 0x20, 0x6110},
57 {RT5640_PR_BASE + 0x21, 0xe0e0},
58 {RT5640_PR_BASE + 0x23, 0x1804},
59 };
60 #define RT5640_INIT_REG_LEN ARRAY_SIZE(init_list)
61
62 static const struct reg_default rt5640_reg[] = {
63 { 0x00, 0x000e },
64 { 0x01, 0xc8c8 },
65 { 0x02, 0xc8c8 },
66 { 0x03, 0xc8c8 },
67 { 0x04, 0x8000 },
68 { 0x0d, 0x0000 },
69 { 0x0e, 0x0000 },
70 { 0x0f, 0x0808 },
71 { 0x19, 0xafaf },
72 { 0x1a, 0xafaf },
73 { 0x1b, 0x0000 },
74 { 0x1c, 0x2f2f },
75 { 0x1d, 0x2f2f },
76 { 0x1e, 0x0000 },
77 { 0x27, 0x7060 },
78 { 0x28, 0x7070 },
79 { 0x29, 0x8080 },
80 { 0x2a, 0x5454 },
81 { 0x2b, 0x5454 },
82 { 0x2c, 0xaa00 },
83 { 0x2d, 0x0000 },
84 { 0x2e, 0xa000 },
85 { 0x2f, 0x0000 },
86 { 0x3b, 0x0000 },
87 { 0x3c, 0x007f },
88 { 0x3d, 0x0000 },
89 { 0x3e, 0x007f },
90 { 0x45, 0xe000 },
91 { 0x46, 0x003e },
92 { 0x47, 0x003e },
93 { 0x48, 0xf800 },
94 { 0x49, 0x3800 },
95 { 0x4a, 0x0004 },
96 { 0x4c, 0xfc00 },
97 { 0x4d, 0x0000 },
98 { 0x4f, 0x01ff },
99 { 0x50, 0x0000 },
100 { 0x51, 0x0000 },
101 { 0x52, 0x01ff },
102 { 0x53, 0xf000 },
103 { 0x61, 0x0000 },
104 { 0x62, 0x0000 },
105 { 0x63, 0x00c0 },
106 { 0x64, 0x0000 },
107 { 0x65, 0x0000 },
108 { 0x66, 0x0000 },
109 { 0x6a, 0x0000 },
110 { 0x6c, 0x0000 },
111 { 0x70, 0x8000 },
112 { 0x71, 0x8000 },
113 { 0x72, 0x8000 },
114 { 0x73, 0x1114 },
115 { 0x74, 0x0c00 },
116 { 0x75, 0x1d00 },
117 { 0x80, 0x0000 },
118 { 0x81, 0x0000 },
119 { 0x82, 0x0000 },
120 { 0x83, 0x0000 },
121 { 0x84, 0x0000 },
122 { 0x85, 0x0008 },
123 { 0x89, 0x0000 },
124 { 0x8a, 0x0000 },
125 { 0x8b, 0x0600 },
126 { 0x8c, 0x0228 },
127 { 0x8d, 0xa000 },
128 { 0x8e, 0x0004 },
129 { 0x8f, 0x1100 },
130 { 0x90, 0x0646 },
131 { 0x91, 0x0c00 },
132 { 0x92, 0x0000 },
133 { 0x93, 0x3000 },
134 { 0xb0, 0x2080 },
135 { 0xb1, 0x0000 },
136 { 0xb4, 0x2206 },
137 { 0xb5, 0x1f00 },
138 { 0xb6, 0x0000 },
139 { 0xb8, 0x034b },
140 { 0xb9, 0x0066 },
141 { 0xba, 0x000b },
142 { 0xbb, 0x0000 },
143 { 0xbc, 0x0000 },
144 { 0xbd, 0x0000 },
145 { 0xbe, 0x0000 },
146 { 0xbf, 0x0000 },
147 { 0xc0, 0x0400 },
148 { 0xc2, 0x0000 },
149 { 0xc4, 0x0000 },
150 { 0xc5, 0x0000 },
151 { 0xc6, 0x2000 },
152 { 0xc8, 0x0000 },
153 { 0xc9, 0x0000 },
154 { 0xca, 0x0000 },
155 { 0xcb, 0x0000 },
156 { 0xcc, 0x0000 },
157 { 0xcf, 0x0013 },
158 { 0xd0, 0x0680 },
159 { 0xd1, 0x1c17 },
160 { 0xd2, 0x8c00 },
161 { 0xd3, 0xaa20 },
162 { 0xd6, 0x0400 },
163 { 0xd9, 0x0809 },
164 { 0xfe, 0x10ec },
165 { 0xff, 0x6231 },
166 };
167
168 static int rt5640_reset(struct snd_soc_codec *codec)
169 {
170 return snd_soc_write(codec, RT5640_RESET, 0);
171 }
172
173 static bool rt5640_volatile_register(struct device *dev, unsigned int reg)
174 {
175 int i;
176
177 for (i = 0; i < ARRAY_SIZE(rt5640_ranges); i++)
178 if ((reg >= rt5640_ranges[i].window_start &&
179 reg <= rt5640_ranges[i].window_start +
180 rt5640_ranges[i].window_len) ||
181 (reg >= rt5640_ranges[i].range_min &&
182 reg <= rt5640_ranges[i].range_max))
183 return true;
184
185 switch (reg) {
186 case RT5640_RESET:
187 case RT5640_ASRC_5:
188 case RT5640_EQ_CTRL1:
189 case RT5640_DRC_AGC_1:
190 case RT5640_ANC_CTRL1:
191 case RT5640_IRQ_CTRL2:
192 case RT5640_INT_IRQ_ST:
193 case RT5640_DSP_CTRL2:
194 case RT5640_DSP_CTRL3:
195 case RT5640_PRIV_INDEX:
196 case RT5640_PRIV_DATA:
197 case RT5640_PGM_REG_ARR1:
198 case RT5640_PGM_REG_ARR3:
199 case RT5640_VENDOR_ID:
200 case RT5640_VENDOR_ID1:
201 case RT5640_VENDOR_ID2:
202 return true;
203 default:
204 return false;
205 }
206 }
207
208 static bool rt5640_readable_register(struct device *dev, unsigned int reg)
209 {
210 int i;
211
212 for (i = 0; i < ARRAY_SIZE(rt5640_ranges); i++)
213 if ((reg >= rt5640_ranges[i].window_start &&
214 reg <= rt5640_ranges[i].window_start +
215 rt5640_ranges[i].window_len) ||
216 (reg >= rt5640_ranges[i].range_min &&
217 reg <= rt5640_ranges[i].range_max))
218 return true;
219
220 switch (reg) {
221 case RT5640_RESET:
222 case RT5640_SPK_VOL:
223 case RT5640_HP_VOL:
224 case RT5640_OUTPUT:
225 case RT5640_MONO_OUT:
226 case RT5640_IN1_IN2:
227 case RT5640_IN3_IN4:
228 case RT5640_INL_INR_VOL:
229 case RT5640_DAC1_DIG_VOL:
230 case RT5640_DAC2_DIG_VOL:
231 case RT5640_DAC2_CTRL:
232 case RT5640_ADC_DIG_VOL:
233 case RT5640_ADC_DATA:
234 case RT5640_ADC_BST_VOL:
235 case RT5640_STO_ADC_MIXER:
236 case RT5640_MONO_ADC_MIXER:
237 case RT5640_AD_DA_MIXER:
238 case RT5640_STO_DAC_MIXER:
239 case RT5640_MONO_DAC_MIXER:
240 case RT5640_DIG_MIXER:
241 case RT5640_DSP_PATH1:
242 case RT5640_DSP_PATH2:
243 case RT5640_DIG_INF_DATA:
244 case RT5640_REC_L1_MIXER:
245 case RT5640_REC_L2_MIXER:
246 case RT5640_REC_R1_MIXER:
247 case RT5640_REC_R2_MIXER:
248 case RT5640_HPO_MIXER:
249 case RT5640_SPK_L_MIXER:
250 case RT5640_SPK_R_MIXER:
251 case RT5640_SPO_L_MIXER:
252 case RT5640_SPO_R_MIXER:
253 case RT5640_SPO_CLSD_RATIO:
254 case RT5640_MONO_MIXER:
255 case RT5640_OUT_L1_MIXER:
256 case RT5640_OUT_L2_MIXER:
257 case RT5640_OUT_L3_MIXER:
258 case RT5640_OUT_R1_MIXER:
259 case RT5640_OUT_R2_MIXER:
260 case RT5640_OUT_R3_MIXER:
261 case RT5640_LOUT_MIXER:
262 case RT5640_PWR_DIG1:
263 case RT5640_PWR_DIG2:
264 case RT5640_PWR_ANLG1:
265 case RT5640_PWR_ANLG2:
266 case RT5640_PWR_MIXER:
267 case RT5640_PWR_VOL:
268 case RT5640_PRIV_INDEX:
269 case RT5640_PRIV_DATA:
270 case RT5640_I2S1_SDP:
271 case RT5640_I2S2_SDP:
272 case RT5640_ADDA_CLK1:
273 case RT5640_ADDA_CLK2:
274 case RT5640_DMIC:
275 case RT5640_GLB_CLK:
276 case RT5640_PLL_CTRL1:
277 case RT5640_PLL_CTRL2:
278 case RT5640_ASRC_1:
279 case RT5640_ASRC_2:
280 case RT5640_ASRC_3:
281 case RT5640_ASRC_4:
282 case RT5640_ASRC_5:
283 case RT5640_HP_OVCD:
284 case RT5640_CLS_D_OVCD:
285 case RT5640_CLS_D_OUT:
286 case RT5640_DEPOP_M1:
287 case RT5640_DEPOP_M2:
288 case RT5640_DEPOP_M3:
289 case RT5640_CHARGE_PUMP:
290 case RT5640_PV_DET_SPK_G:
291 case RT5640_MICBIAS:
292 case RT5640_EQ_CTRL1:
293 case RT5640_EQ_CTRL2:
294 case RT5640_WIND_FILTER:
295 case RT5640_DRC_AGC_1:
296 case RT5640_DRC_AGC_2:
297 case RT5640_DRC_AGC_3:
298 case RT5640_SVOL_ZC:
299 case RT5640_ANC_CTRL1:
300 case RT5640_ANC_CTRL2:
301 case RT5640_ANC_CTRL3:
302 case RT5640_JD_CTRL:
303 case RT5640_ANC_JD:
304 case RT5640_IRQ_CTRL1:
305 case RT5640_IRQ_CTRL2:
306 case RT5640_INT_IRQ_ST:
307 case RT5640_GPIO_CTRL1:
308 case RT5640_GPIO_CTRL2:
309 case RT5640_GPIO_CTRL3:
310 case RT5640_DSP_CTRL1:
311 case RT5640_DSP_CTRL2:
312 case RT5640_DSP_CTRL3:
313 case RT5640_DSP_CTRL4:
314 case RT5640_PGM_REG_ARR1:
315 case RT5640_PGM_REG_ARR2:
316 case RT5640_PGM_REG_ARR3:
317 case RT5640_PGM_REG_ARR4:
318 case RT5640_PGM_REG_ARR5:
319 case RT5640_SCB_FUNC:
320 case RT5640_SCB_CTRL:
321 case RT5640_BASE_BACK:
322 case RT5640_MP3_PLUS1:
323 case RT5640_MP3_PLUS2:
324 case RT5640_3D_HP:
325 case RT5640_ADJ_HPF:
326 case RT5640_HP_CALIB_AMP_DET:
327 case RT5640_HP_CALIB2:
328 case RT5640_SV_ZCD1:
329 case RT5640_SV_ZCD2:
330 case RT5640_DUMMY1:
331 case RT5640_DUMMY2:
332 case RT5640_DUMMY3:
333 case RT5640_VENDOR_ID:
334 case RT5640_VENDOR_ID1:
335 case RT5640_VENDOR_ID2:
336 return true;
337 default:
338 return false;
339 }
340 }
341
342 static const DECLARE_TLV_DB_SCALE(out_vol_tlv, -4650, 150, 0);
343 static const DECLARE_TLV_DB_SCALE(dac_vol_tlv, -65625, 375, 0);
344 static const DECLARE_TLV_DB_SCALE(in_vol_tlv, -3450, 150, 0);
345 static const DECLARE_TLV_DB_SCALE(adc_vol_tlv, -17625, 375, 0);
346 static const DECLARE_TLV_DB_SCALE(adc_bst_tlv, 0, 1200, 0);
347
348 /* {0, +20, +24, +30, +35, +40, +44, +50, +52} dB */
349 static unsigned int bst_tlv[] = {
350 TLV_DB_RANGE_HEAD(7),
351 0, 0, TLV_DB_SCALE_ITEM(0, 0, 0),
352 1, 1, TLV_DB_SCALE_ITEM(2000, 0, 0),
353 2, 2, TLV_DB_SCALE_ITEM(2400, 0, 0),
354 3, 5, TLV_DB_SCALE_ITEM(3000, 500, 0),
355 6, 6, TLV_DB_SCALE_ITEM(4400, 0, 0),
356 7, 7, TLV_DB_SCALE_ITEM(5000, 0, 0),
357 8, 8, TLV_DB_SCALE_ITEM(5200, 0, 0),
358 };
359
360 /* Interface data select */
361 static const char * const rt5640_data_select[] = {
362 "Normal", "left copy to right", "right copy to left", "Swap"};
363
364 static SOC_ENUM_SINGLE_DECL(rt5640_if1_dac_enum, RT5640_DIG_INF_DATA,
365 RT5640_IF1_DAC_SEL_SFT, rt5640_data_select);
366
367 static SOC_ENUM_SINGLE_DECL(rt5640_if1_adc_enum, RT5640_DIG_INF_DATA,
368 RT5640_IF1_ADC_SEL_SFT, rt5640_data_select);
369
370 static SOC_ENUM_SINGLE_DECL(rt5640_if2_dac_enum, RT5640_DIG_INF_DATA,
371 RT5640_IF2_DAC_SEL_SFT, rt5640_data_select);
372
373 static SOC_ENUM_SINGLE_DECL(rt5640_if2_adc_enum, RT5640_DIG_INF_DATA,
374 RT5640_IF2_ADC_SEL_SFT, rt5640_data_select);
375
376 /* Class D speaker gain ratio */
377 static const char * const rt5640_clsd_spk_ratio[] = {"1.66x", "1.83x", "1.94x",
378 "2x", "2.11x", "2.22x", "2.33x", "2.44x", "2.55x", "2.66x", "2.77x"};
379
380 static SOC_ENUM_SINGLE_DECL(rt5640_clsd_spk_ratio_enum, RT5640_CLS_D_OUT,
381 RT5640_CLSD_RATIO_SFT, rt5640_clsd_spk_ratio);
382
383 static const struct snd_kcontrol_new rt5640_snd_controls[] = {
384 /* Speaker Output Volume */
385 SOC_DOUBLE("Speaker Channel Switch", RT5640_SPK_VOL,
386 RT5640_VOL_L_SFT, RT5640_VOL_R_SFT, 1, 1),
387 SOC_DOUBLE_TLV("Speaker Playback Volume", RT5640_SPK_VOL,
388 RT5640_L_VOL_SFT, RT5640_R_VOL_SFT, 39, 1, out_vol_tlv),
389 /* Headphone Output Volume */
390 SOC_DOUBLE("HP Channel Switch", RT5640_HP_VOL,
391 RT5640_VOL_L_SFT, RT5640_VOL_R_SFT, 1, 1),
392 SOC_DOUBLE_TLV("HP Playback Volume", RT5640_HP_VOL,
393 RT5640_L_VOL_SFT, RT5640_R_VOL_SFT, 39, 1, out_vol_tlv),
394 /* OUTPUT Control */
395 SOC_DOUBLE("OUT Playback Switch", RT5640_OUTPUT,
396 RT5640_L_MUTE_SFT, RT5640_R_MUTE_SFT, 1, 1),
397 SOC_DOUBLE("OUT Channel Switch", RT5640_OUTPUT,
398 RT5640_VOL_L_SFT, RT5640_VOL_R_SFT, 1, 1),
399 SOC_DOUBLE_TLV("OUT Playback Volume", RT5640_OUTPUT,
400 RT5640_L_VOL_SFT, RT5640_R_VOL_SFT, 39, 1, out_vol_tlv),
401
402 /* DAC Digital Volume */
403 SOC_DOUBLE("DAC2 Playback Switch", RT5640_DAC2_CTRL,
404 RT5640_M_DAC_L2_VOL_SFT, RT5640_M_DAC_R2_VOL_SFT, 1, 1),
405 SOC_DOUBLE_TLV("DAC1 Playback Volume", RT5640_DAC1_DIG_VOL,
406 RT5640_L_VOL_SFT, RT5640_R_VOL_SFT,
407 175, 0, dac_vol_tlv),
408 /* IN1/IN2 Control */
409 SOC_SINGLE_TLV("IN1 Boost", RT5640_IN1_IN2,
410 RT5640_BST_SFT1, 8, 0, bst_tlv),
411 SOC_SINGLE_TLV("IN2 Boost", RT5640_IN3_IN4,
412 RT5640_BST_SFT2, 8, 0, bst_tlv),
413 /* INL/INR Volume Control */
414 SOC_DOUBLE_TLV("IN Capture Volume", RT5640_INL_INR_VOL,
415 RT5640_INL_VOL_SFT, RT5640_INR_VOL_SFT,
416 31, 1, in_vol_tlv),
417 /* ADC Digital Volume Control */
418 SOC_DOUBLE("ADC Capture Switch", RT5640_ADC_DIG_VOL,
419 RT5640_L_MUTE_SFT, RT5640_R_MUTE_SFT, 1, 1),
420 SOC_DOUBLE_TLV("ADC Capture Volume", RT5640_ADC_DIG_VOL,
421 RT5640_L_VOL_SFT, RT5640_R_VOL_SFT,
422 127, 0, adc_vol_tlv),
423 SOC_DOUBLE_TLV("Mono ADC Capture Volume", RT5640_ADC_DATA,
424 RT5640_L_VOL_SFT, RT5640_R_VOL_SFT,
425 127, 0, adc_vol_tlv),
426 /* ADC Boost Volume Control */
427 SOC_DOUBLE_TLV("ADC Boost Gain", RT5640_ADC_BST_VOL,
428 RT5640_ADC_L_BST_SFT, RT5640_ADC_R_BST_SFT,
429 3, 0, adc_bst_tlv),
430 /* Class D speaker gain ratio */
431 SOC_ENUM("Class D SPK Ratio Control", rt5640_clsd_spk_ratio_enum),
432
433 SOC_ENUM("ADC IF1 Data Switch", rt5640_if1_adc_enum),
434 SOC_ENUM("DAC IF1 Data Switch", rt5640_if1_dac_enum),
435 SOC_ENUM("ADC IF2 Data Switch", rt5640_if2_adc_enum),
436 SOC_ENUM("DAC IF2 Data Switch", rt5640_if2_dac_enum),
437 };
438
439 static const struct snd_kcontrol_new rt5640_specific_snd_controls[] = {
440 /* MONO Output Control */
441 SOC_SINGLE("Mono Playback Switch", RT5640_MONO_OUT, RT5640_L_MUTE_SFT,
442 1, 1),
443
444 SOC_DOUBLE_TLV("Mono DAC Playback Volume", RT5640_DAC2_DIG_VOL,
445 RT5640_L_VOL_SFT, RT5640_R_VOL_SFT, 175, 0, dac_vol_tlv),
446 };
447
448 /**
449 * set_dmic_clk - Set parameter of dmic.
450 *
451 * @w: DAPM widget.
452 * @kcontrol: The kcontrol of this widget.
453 * @event: Event id.
454 *
455 * Choose dmic clock between 1MHz and 3MHz.
456 * It is better for clock to approximate 3MHz.
457 */
458 static int set_dmic_clk(struct snd_soc_dapm_widget *w,
459 struct snd_kcontrol *kcontrol, int event)
460 {
461 struct snd_soc_codec *codec = w->codec;
462 struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
463 int div[] = {2, 3, 4, 6, 8, 12};
464 int idx = -EINVAL, i;
465 int rate, red, bound, temp;
466
467 rate = rt5640->sysclk;
468 red = 3000000 * 12;
469 for (i = 0; i < ARRAY_SIZE(div); i++) {
470 bound = div[i] * 3000000;
471 if (rate > bound)
472 continue;
473 temp = bound - rate;
474 if (temp < red) {
475 red = temp;
476 idx = i;
477 }
478 }
479 if (idx < 0)
480 dev_err(codec->dev, "Failed to set DMIC clock\n");
481 else
482 snd_soc_update_bits(codec, RT5640_DMIC, RT5640_DMIC_CLK_MASK,
483 idx << RT5640_DMIC_CLK_SFT);
484 return idx;
485 }
486
487 static int is_sys_clk_from_pll(struct snd_soc_dapm_widget *source,
488 struct snd_soc_dapm_widget *sink)
489 {
490 unsigned int val;
491
492 val = snd_soc_read(source->codec, RT5640_GLB_CLK);
493 val &= RT5640_SCLK_SRC_MASK;
494 if (val == RT5640_SCLK_SRC_PLL1)
495 return 1;
496 else
497 return 0;
498 }
499
500 /* Digital Mixer */
501 static const struct snd_kcontrol_new rt5640_sto_adc_l_mix[] = {
502 SOC_DAPM_SINGLE("ADC1 Switch", RT5640_STO_ADC_MIXER,
503 RT5640_M_ADC_L1_SFT, 1, 1),
504 SOC_DAPM_SINGLE("ADC2 Switch", RT5640_STO_ADC_MIXER,
505 RT5640_M_ADC_L2_SFT, 1, 1),
506 };
507
508 static const struct snd_kcontrol_new rt5640_sto_adc_r_mix[] = {
509 SOC_DAPM_SINGLE("ADC1 Switch", RT5640_STO_ADC_MIXER,
510 RT5640_M_ADC_R1_SFT, 1, 1),
511 SOC_DAPM_SINGLE("ADC2 Switch", RT5640_STO_ADC_MIXER,
512 RT5640_M_ADC_R2_SFT, 1, 1),
513 };
514
515 static const struct snd_kcontrol_new rt5640_mono_adc_l_mix[] = {
516 SOC_DAPM_SINGLE("ADC1 Switch", RT5640_MONO_ADC_MIXER,
517 RT5640_M_MONO_ADC_L1_SFT, 1, 1),
518 SOC_DAPM_SINGLE("ADC2 Switch", RT5640_MONO_ADC_MIXER,
519 RT5640_M_MONO_ADC_L2_SFT, 1, 1),
520 };
521
522 static const struct snd_kcontrol_new rt5640_mono_adc_r_mix[] = {
523 SOC_DAPM_SINGLE("ADC1 Switch", RT5640_MONO_ADC_MIXER,
524 RT5640_M_MONO_ADC_R1_SFT, 1, 1),
525 SOC_DAPM_SINGLE("ADC2 Switch", RT5640_MONO_ADC_MIXER,
526 RT5640_M_MONO_ADC_R2_SFT, 1, 1),
527 };
528
529 static const struct snd_kcontrol_new rt5640_dac_l_mix[] = {
530 SOC_DAPM_SINGLE("Stereo ADC Switch", RT5640_AD_DA_MIXER,
531 RT5640_M_ADCMIX_L_SFT, 1, 1),
532 SOC_DAPM_SINGLE("INF1 Switch", RT5640_AD_DA_MIXER,
533 RT5640_M_IF1_DAC_L_SFT, 1, 1),
534 };
535
536 static const struct snd_kcontrol_new rt5640_dac_r_mix[] = {
537 SOC_DAPM_SINGLE("Stereo ADC Switch", RT5640_AD_DA_MIXER,
538 RT5640_M_ADCMIX_R_SFT, 1, 1),
539 SOC_DAPM_SINGLE("INF1 Switch", RT5640_AD_DA_MIXER,
540 RT5640_M_IF1_DAC_R_SFT, 1, 1),
541 };
542
543 static const struct snd_kcontrol_new rt5640_sto_dac_l_mix[] = {
544 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_STO_DAC_MIXER,
545 RT5640_M_DAC_L1_SFT, 1, 1),
546 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_STO_DAC_MIXER,
547 RT5640_M_DAC_L2_SFT, 1, 1),
548 SOC_DAPM_SINGLE("ANC Switch", RT5640_STO_DAC_MIXER,
549 RT5640_M_ANC_DAC_L_SFT, 1, 1),
550 };
551
552 static const struct snd_kcontrol_new rt5640_sto_dac_r_mix[] = {
553 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_STO_DAC_MIXER,
554 RT5640_M_DAC_R1_SFT, 1, 1),
555 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_STO_DAC_MIXER,
556 RT5640_M_DAC_R2_SFT, 1, 1),
557 SOC_DAPM_SINGLE("ANC Switch", RT5640_STO_DAC_MIXER,
558 RT5640_M_ANC_DAC_R_SFT, 1, 1),
559 };
560
561 static const struct snd_kcontrol_new rt5639_sto_dac_l_mix[] = {
562 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_STO_DAC_MIXER,
563 RT5640_M_DAC_L1_SFT, 1, 1),
564 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_STO_DAC_MIXER,
565 RT5640_M_DAC_L2_SFT, 1, 1),
566 };
567
568 static const struct snd_kcontrol_new rt5639_sto_dac_r_mix[] = {
569 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_STO_DAC_MIXER,
570 RT5640_M_DAC_R1_SFT, 1, 1),
571 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_STO_DAC_MIXER,
572 RT5640_M_DAC_R2_SFT, 1, 1),
573 };
574
575 static const struct snd_kcontrol_new rt5640_mono_dac_l_mix[] = {
576 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_MONO_DAC_MIXER,
577 RT5640_M_DAC_L1_MONO_L_SFT, 1, 1),
578 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_MONO_DAC_MIXER,
579 RT5640_M_DAC_L2_MONO_L_SFT, 1, 1),
580 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_MONO_DAC_MIXER,
581 RT5640_M_DAC_R2_MONO_L_SFT, 1, 1),
582 };
583
584 static const struct snd_kcontrol_new rt5640_mono_dac_r_mix[] = {
585 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_MONO_DAC_MIXER,
586 RT5640_M_DAC_R1_MONO_R_SFT, 1, 1),
587 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_MONO_DAC_MIXER,
588 RT5640_M_DAC_R2_MONO_R_SFT, 1, 1),
589 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_MONO_DAC_MIXER,
590 RT5640_M_DAC_L2_MONO_R_SFT, 1, 1),
591 };
592
593 static const struct snd_kcontrol_new rt5640_dig_l_mix[] = {
594 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_DIG_MIXER,
595 RT5640_M_STO_L_DAC_L_SFT, 1, 1),
596 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_DIG_MIXER,
597 RT5640_M_DAC_L2_DAC_L_SFT, 1, 1),
598 };
599
600 static const struct snd_kcontrol_new rt5640_dig_r_mix[] = {
601 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_DIG_MIXER,
602 RT5640_M_STO_R_DAC_R_SFT, 1, 1),
603 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_DIG_MIXER,
604 RT5640_M_DAC_R2_DAC_R_SFT, 1, 1),
605 };
606
607 /* Analog Input Mixer */
608 static const struct snd_kcontrol_new rt5640_rec_l_mix[] = {
609 SOC_DAPM_SINGLE("HPOL Switch", RT5640_REC_L2_MIXER,
610 RT5640_M_HP_L_RM_L_SFT, 1, 1),
611 SOC_DAPM_SINGLE("INL Switch", RT5640_REC_L2_MIXER,
612 RT5640_M_IN_L_RM_L_SFT, 1, 1),
613 SOC_DAPM_SINGLE("BST2 Switch", RT5640_REC_L2_MIXER,
614 RT5640_M_BST4_RM_L_SFT, 1, 1),
615 SOC_DAPM_SINGLE("BST1 Switch", RT5640_REC_L2_MIXER,
616 RT5640_M_BST1_RM_L_SFT, 1, 1),
617 SOC_DAPM_SINGLE("OUT MIXL Switch", RT5640_REC_L2_MIXER,
618 RT5640_M_OM_L_RM_L_SFT, 1, 1),
619 };
620
621 static const struct snd_kcontrol_new rt5640_rec_r_mix[] = {
622 SOC_DAPM_SINGLE("HPOR Switch", RT5640_REC_R2_MIXER,
623 RT5640_M_HP_R_RM_R_SFT, 1, 1),
624 SOC_DAPM_SINGLE("INR Switch", RT5640_REC_R2_MIXER,
625 RT5640_M_IN_R_RM_R_SFT, 1, 1),
626 SOC_DAPM_SINGLE("BST2 Switch", RT5640_REC_R2_MIXER,
627 RT5640_M_BST4_RM_R_SFT, 1, 1),
628 SOC_DAPM_SINGLE("BST1 Switch", RT5640_REC_R2_MIXER,
629 RT5640_M_BST1_RM_R_SFT, 1, 1),
630 SOC_DAPM_SINGLE("OUT MIXR Switch", RT5640_REC_R2_MIXER,
631 RT5640_M_OM_R_RM_R_SFT, 1, 1),
632 };
633
634 /* Analog Output Mixer */
635 static const struct snd_kcontrol_new rt5640_spk_l_mix[] = {
636 SOC_DAPM_SINGLE("REC MIXL Switch", RT5640_SPK_L_MIXER,
637 RT5640_M_RM_L_SM_L_SFT, 1, 1),
638 SOC_DAPM_SINGLE("INL Switch", RT5640_SPK_L_MIXER,
639 RT5640_M_IN_L_SM_L_SFT, 1, 1),
640 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_SPK_L_MIXER,
641 RT5640_M_DAC_L1_SM_L_SFT, 1, 1),
642 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_SPK_L_MIXER,
643 RT5640_M_DAC_L2_SM_L_SFT, 1, 1),
644 SOC_DAPM_SINGLE("OUT MIXL Switch", RT5640_SPK_L_MIXER,
645 RT5640_M_OM_L_SM_L_SFT, 1, 1),
646 };
647
648 static const struct snd_kcontrol_new rt5640_spk_r_mix[] = {
649 SOC_DAPM_SINGLE("REC MIXR Switch", RT5640_SPK_R_MIXER,
650 RT5640_M_RM_R_SM_R_SFT, 1, 1),
651 SOC_DAPM_SINGLE("INR Switch", RT5640_SPK_R_MIXER,
652 RT5640_M_IN_R_SM_R_SFT, 1, 1),
653 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_SPK_R_MIXER,
654 RT5640_M_DAC_R1_SM_R_SFT, 1, 1),
655 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_SPK_R_MIXER,
656 RT5640_M_DAC_R2_SM_R_SFT, 1, 1),
657 SOC_DAPM_SINGLE("OUT MIXR Switch", RT5640_SPK_R_MIXER,
658 RT5640_M_OM_R_SM_R_SFT, 1, 1),
659 };
660
661 static const struct snd_kcontrol_new rt5640_out_l_mix[] = {
662 SOC_DAPM_SINGLE("SPK MIXL Switch", RT5640_OUT_L3_MIXER,
663 RT5640_M_SM_L_OM_L_SFT, 1, 1),
664 SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_L3_MIXER,
665 RT5640_M_BST1_OM_L_SFT, 1, 1),
666 SOC_DAPM_SINGLE("INL Switch", RT5640_OUT_L3_MIXER,
667 RT5640_M_IN_L_OM_L_SFT, 1, 1),
668 SOC_DAPM_SINGLE("REC MIXL Switch", RT5640_OUT_L3_MIXER,
669 RT5640_M_RM_L_OM_L_SFT, 1, 1),
670 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_OUT_L3_MIXER,
671 RT5640_M_DAC_R2_OM_L_SFT, 1, 1),
672 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_OUT_L3_MIXER,
673 RT5640_M_DAC_L2_OM_L_SFT, 1, 1),
674 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_OUT_L3_MIXER,
675 RT5640_M_DAC_L1_OM_L_SFT, 1, 1),
676 };
677
678 static const struct snd_kcontrol_new rt5640_out_r_mix[] = {
679 SOC_DAPM_SINGLE("SPK MIXR Switch", RT5640_OUT_R3_MIXER,
680 RT5640_M_SM_L_OM_R_SFT, 1, 1),
681 SOC_DAPM_SINGLE("BST2 Switch", RT5640_OUT_R3_MIXER,
682 RT5640_M_BST4_OM_R_SFT, 1, 1),
683 SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_R3_MIXER,
684 RT5640_M_BST1_OM_R_SFT, 1, 1),
685 SOC_DAPM_SINGLE("INR Switch", RT5640_OUT_R3_MIXER,
686 RT5640_M_IN_R_OM_R_SFT, 1, 1),
687 SOC_DAPM_SINGLE("REC MIXR Switch", RT5640_OUT_R3_MIXER,
688 RT5640_M_RM_R_OM_R_SFT, 1, 1),
689 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_OUT_R3_MIXER,
690 RT5640_M_DAC_L2_OM_R_SFT, 1, 1),
691 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_OUT_R3_MIXER,
692 RT5640_M_DAC_R2_OM_R_SFT, 1, 1),
693 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_OUT_R3_MIXER,
694 RT5640_M_DAC_R1_OM_R_SFT, 1, 1),
695 };
696
697 static const struct snd_kcontrol_new rt5639_out_l_mix[] = {
698 SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_L3_MIXER,
699 RT5640_M_BST1_OM_L_SFT, 1, 1),
700 SOC_DAPM_SINGLE("INL Switch", RT5640_OUT_L3_MIXER,
701 RT5640_M_IN_L_OM_L_SFT, 1, 1),
702 SOC_DAPM_SINGLE("REC MIXL Switch", RT5640_OUT_L3_MIXER,
703 RT5640_M_RM_L_OM_L_SFT, 1, 1),
704 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_OUT_L3_MIXER,
705 RT5640_M_DAC_L1_OM_L_SFT, 1, 1),
706 };
707
708 static const struct snd_kcontrol_new rt5639_out_r_mix[] = {
709 SOC_DAPM_SINGLE("BST2 Switch", RT5640_OUT_R3_MIXER,
710 RT5640_M_BST4_OM_R_SFT, 1, 1),
711 SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_R3_MIXER,
712 RT5640_M_BST1_OM_R_SFT, 1, 1),
713 SOC_DAPM_SINGLE("INR Switch", RT5640_OUT_R3_MIXER,
714 RT5640_M_IN_R_OM_R_SFT, 1, 1),
715 SOC_DAPM_SINGLE("REC MIXR Switch", RT5640_OUT_R3_MIXER,
716 RT5640_M_RM_R_OM_R_SFT, 1, 1),
717 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_OUT_R3_MIXER,
718 RT5640_M_DAC_R1_OM_R_SFT, 1, 1),
719 };
720
721 static const struct snd_kcontrol_new rt5640_spo_l_mix[] = {
722 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_SPO_L_MIXER,
723 RT5640_M_DAC_R1_SPM_L_SFT, 1, 1),
724 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_SPO_L_MIXER,
725 RT5640_M_DAC_L1_SPM_L_SFT, 1, 1),
726 SOC_DAPM_SINGLE("SPKVOL R Switch", RT5640_SPO_L_MIXER,
727 RT5640_M_SV_R_SPM_L_SFT, 1, 1),
728 SOC_DAPM_SINGLE("SPKVOL L Switch", RT5640_SPO_L_MIXER,
729 RT5640_M_SV_L_SPM_L_SFT, 1, 1),
730 SOC_DAPM_SINGLE("BST1 Switch", RT5640_SPO_L_MIXER,
731 RT5640_M_BST1_SPM_L_SFT, 1, 1),
732 };
733
734 static const struct snd_kcontrol_new rt5640_spo_r_mix[] = {
735 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_SPO_R_MIXER,
736 RT5640_M_DAC_R1_SPM_R_SFT, 1, 1),
737 SOC_DAPM_SINGLE("SPKVOL R Switch", RT5640_SPO_R_MIXER,
738 RT5640_M_SV_R_SPM_R_SFT, 1, 1),
739 SOC_DAPM_SINGLE("BST1 Switch", RT5640_SPO_R_MIXER,
740 RT5640_M_BST1_SPM_R_SFT, 1, 1),
741 };
742
743 static const struct snd_kcontrol_new rt5640_hpo_mix[] = {
744 SOC_DAPM_SINGLE("HPO MIX DAC2 Switch", RT5640_HPO_MIXER,
745 RT5640_M_DAC2_HM_SFT, 1, 1),
746 SOC_DAPM_SINGLE("HPO MIX DAC1 Switch", RT5640_HPO_MIXER,
747 RT5640_M_DAC1_HM_SFT, 1, 1),
748 SOC_DAPM_SINGLE("HPO MIX HPVOL Switch", RT5640_HPO_MIXER,
749 RT5640_M_HPVOL_HM_SFT, 1, 1),
750 };
751
752 static const struct snd_kcontrol_new rt5639_hpo_mix[] = {
753 SOC_DAPM_SINGLE("HPO MIX DAC1 Switch", RT5640_HPO_MIXER,
754 RT5640_M_DAC1_HM_SFT, 1, 1),
755 SOC_DAPM_SINGLE("HPO MIX HPVOL Switch", RT5640_HPO_MIXER,
756 RT5640_M_HPVOL_HM_SFT, 1, 1),
757 };
758
759 static const struct snd_kcontrol_new rt5640_lout_mix[] = {
760 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_LOUT_MIXER,
761 RT5640_M_DAC_L1_LM_SFT, 1, 1),
762 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_LOUT_MIXER,
763 RT5640_M_DAC_R1_LM_SFT, 1, 1),
764 SOC_DAPM_SINGLE("OUTVOL L Switch", RT5640_LOUT_MIXER,
765 RT5640_M_OV_L_LM_SFT, 1, 1),
766 SOC_DAPM_SINGLE("OUTVOL R Switch", RT5640_LOUT_MIXER,
767 RT5640_M_OV_R_LM_SFT, 1, 1),
768 };
769
770 static const struct snd_kcontrol_new rt5640_mono_mix[] = {
771 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_MONO_MIXER,
772 RT5640_M_DAC_R2_MM_SFT, 1, 1),
773 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_MONO_MIXER,
774 RT5640_M_DAC_L2_MM_SFT, 1, 1),
775 SOC_DAPM_SINGLE("OUTVOL R Switch", RT5640_MONO_MIXER,
776 RT5640_M_OV_R_MM_SFT, 1, 1),
777 SOC_DAPM_SINGLE("OUTVOL L Switch", RT5640_MONO_MIXER,
778 RT5640_M_OV_L_MM_SFT, 1, 1),
779 SOC_DAPM_SINGLE("BST1 Switch", RT5640_MONO_MIXER,
780 RT5640_M_BST1_MM_SFT, 1, 1),
781 };
782
783 static const struct snd_kcontrol_new spk_l_enable_control =
784 SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_SPK_VOL,
785 RT5640_L_MUTE_SFT, 1, 1);
786
787 static const struct snd_kcontrol_new spk_r_enable_control =
788 SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_SPK_VOL,
789 RT5640_R_MUTE_SFT, 1, 1);
790
791 static const struct snd_kcontrol_new hp_l_enable_control =
792 SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_HP_VOL,
793 RT5640_L_MUTE_SFT, 1, 1);
794
795 static const struct snd_kcontrol_new hp_r_enable_control =
796 SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_HP_VOL,
797 RT5640_R_MUTE_SFT, 1, 1);
798
799 /* Stereo ADC source */
800 static const char * const rt5640_stereo_adc1_src[] = {
801 "DIG MIX", "ADC"
802 };
803
804 static SOC_ENUM_SINGLE_DECL(rt5640_stereo_adc1_enum, RT5640_STO_ADC_MIXER,
805 RT5640_ADC_1_SRC_SFT, rt5640_stereo_adc1_src);
806
807 static const struct snd_kcontrol_new rt5640_sto_adc_1_mux =
808 SOC_DAPM_ENUM("Stereo ADC1 Mux", rt5640_stereo_adc1_enum);
809
810 static const char * const rt5640_stereo_adc2_src[] = {
811 "DMIC1", "DMIC2", "DIG MIX"
812 };
813
814 static SOC_ENUM_SINGLE_DECL(rt5640_stereo_adc2_enum, RT5640_STO_ADC_MIXER,
815 RT5640_ADC_2_SRC_SFT, rt5640_stereo_adc2_src);
816
817 static const struct snd_kcontrol_new rt5640_sto_adc_2_mux =
818 SOC_DAPM_ENUM("Stereo ADC2 Mux", rt5640_stereo_adc2_enum);
819
820 /* Mono ADC source */
821 static const char * const rt5640_mono_adc_l1_src[] = {
822 "Mono DAC MIXL", "ADCL"
823 };
824
825 static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_l1_enum, RT5640_MONO_ADC_MIXER,
826 RT5640_MONO_ADC_L1_SRC_SFT, rt5640_mono_adc_l1_src);
827
828 static const struct snd_kcontrol_new rt5640_mono_adc_l1_mux =
829 SOC_DAPM_ENUM("Mono ADC1 left source", rt5640_mono_adc_l1_enum);
830
831 static const char * const rt5640_mono_adc_l2_src[] = {
832 "DMIC L1", "DMIC L2", "Mono DAC MIXL"
833 };
834
835 static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_l2_enum, RT5640_MONO_ADC_MIXER,
836 RT5640_MONO_ADC_L2_SRC_SFT, rt5640_mono_adc_l2_src);
837
838 static const struct snd_kcontrol_new rt5640_mono_adc_l2_mux =
839 SOC_DAPM_ENUM("Mono ADC2 left source", rt5640_mono_adc_l2_enum);
840
841 static const char * const rt5640_mono_adc_r1_src[] = {
842 "Mono DAC MIXR", "ADCR"
843 };
844
845 static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_r1_enum, RT5640_MONO_ADC_MIXER,
846 RT5640_MONO_ADC_R1_SRC_SFT, rt5640_mono_adc_r1_src);
847
848 static const struct snd_kcontrol_new rt5640_mono_adc_r1_mux =
849 SOC_DAPM_ENUM("Mono ADC1 right source", rt5640_mono_adc_r1_enum);
850
851 static const char * const rt5640_mono_adc_r2_src[] = {
852 "DMIC R1", "DMIC R2", "Mono DAC MIXR"
853 };
854
855 static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_r2_enum, RT5640_MONO_ADC_MIXER,
856 RT5640_MONO_ADC_R2_SRC_SFT, rt5640_mono_adc_r2_src);
857
858 static const struct snd_kcontrol_new rt5640_mono_adc_r2_mux =
859 SOC_DAPM_ENUM("Mono ADC2 right source", rt5640_mono_adc_r2_enum);
860
861 /* DAC2 channel source */
862 static const char * const rt5640_dac_l2_src[] = {
863 "IF2", "Base L/R"
864 };
865
866 static int rt5640_dac_l2_values[] = {
867 0,
868 3,
869 };
870
871 static SOC_VALUE_ENUM_SINGLE_DECL(rt5640_dac_l2_enum,
872 RT5640_DSP_PATH2, RT5640_DAC_L2_SEL_SFT,
873 0x3, rt5640_dac_l2_src, rt5640_dac_l2_values);
874
875 static const struct snd_kcontrol_new rt5640_dac_l2_mux =
876 SOC_DAPM_VALUE_ENUM("DAC2 left channel source", rt5640_dac_l2_enum);
877
878 static const char * const rt5640_dac_r2_src[] = {
879 "IF2",
880 };
881
882 static int rt5640_dac_r2_values[] = {
883 0,
884 };
885
886 static SOC_VALUE_ENUM_SINGLE_DECL(rt5640_dac_r2_enum,
887 RT5640_DSP_PATH2, RT5640_DAC_R2_SEL_SFT,
888 0x3, rt5640_dac_r2_src, rt5640_dac_r2_values);
889
890 static const struct snd_kcontrol_new rt5640_dac_r2_mux =
891 SOC_DAPM_ENUM("DAC2 right channel source", rt5640_dac_r2_enum);
892
893 /* digital interface and iis interface map */
894 static const char * const rt5640_dai_iis_map[] = {
895 "1:1|2:2", "1:2|2:1", "1:1|2:1", "1:2|2:2"
896 };
897
898 static int rt5640_dai_iis_map_values[] = {
899 0,
900 5,
901 6,
902 7,
903 };
904
905 static SOC_VALUE_ENUM_SINGLE_DECL(rt5640_dai_iis_map_enum,
906 RT5640_I2S1_SDP, RT5640_I2S_IF_SFT,
907 0x7, rt5640_dai_iis_map,
908 rt5640_dai_iis_map_values);
909
910 static const struct snd_kcontrol_new rt5640_dai_mux =
911 SOC_DAPM_VALUE_ENUM("DAI select", rt5640_dai_iis_map_enum);
912
913 /* SDI select */
914 static const char * const rt5640_sdi_sel[] = {
915 "IF1", "IF2"
916 };
917
918 static SOC_ENUM_SINGLE_DECL(rt5640_sdi_sel_enum, RT5640_I2S2_SDP,
919 RT5640_I2S2_SDI_SFT, rt5640_sdi_sel);
920
921 static const struct snd_kcontrol_new rt5640_sdi_mux =
922 SOC_DAPM_ENUM("SDI select", rt5640_sdi_sel_enum);
923
924 static void hp_amp_power_on(struct snd_soc_codec *codec)
925 {
926 struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
927
928 /* depop parameters */
929 regmap_update_bits(rt5640->regmap, RT5640_PR_BASE +
930 RT5640_CHPUMP_INT_REG1, 0x0700, 0x0200);
931 regmap_update_bits(rt5640->regmap, RT5640_DEPOP_M2,
932 RT5640_DEPOP_MASK, RT5640_DEPOP_MAN);
933 regmap_update_bits(rt5640->regmap, RT5640_DEPOP_M1,
934 RT5640_HP_CP_MASK | RT5640_HP_SG_MASK | RT5640_HP_CB_MASK,
935 RT5640_HP_CP_PU | RT5640_HP_SG_DIS | RT5640_HP_CB_PU);
936 regmap_write(rt5640->regmap, RT5640_PR_BASE + RT5640_HP_DCC_INT1,
937 0x9f00);
938 /* headphone amp power on */
939 regmap_update_bits(rt5640->regmap, RT5640_PWR_ANLG1,
940 RT5640_PWR_FV1 | RT5640_PWR_FV2, 0);
941 regmap_update_bits(rt5640->regmap, RT5640_PWR_ANLG1,
942 RT5640_PWR_HA,
943 RT5640_PWR_HA);
944 usleep_range(10000, 15000);
945 regmap_update_bits(rt5640->regmap, RT5640_PWR_ANLG1,
946 RT5640_PWR_FV1 | RT5640_PWR_FV2 ,
947 RT5640_PWR_FV1 | RT5640_PWR_FV2);
948 }
949
950 static void rt5640_pmu_depop(struct snd_soc_codec *codec)
951 {
952 struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
953
954 regmap_update_bits(rt5640->regmap, RT5640_DEPOP_M2,
955 RT5640_DEPOP_MASK | RT5640_DIG_DP_MASK,
956 RT5640_DEPOP_AUTO | RT5640_DIG_DP_EN);
957 regmap_update_bits(rt5640->regmap, RT5640_CHARGE_PUMP,
958 RT5640_PM_HP_MASK, RT5640_PM_HP_HV);
959
960 regmap_update_bits(rt5640->regmap, RT5640_DEPOP_M3,
961 RT5640_CP_FQ1_MASK | RT5640_CP_FQ2_MASK | RT5640_CP_FQ3_MASK,
962 (RT5640_CP_FQ_192_KHZ << RT5640_CP_FQ1_SFT) |
963 (RT5640_CP_FQ_12_KHZ << RT5640_CP_FQ2_SFT) |
964 (RT5640_CP_FQ_192_KHZ << RT5640_CP_FQ3_SFT));
965
966 regmap_write(rt5640->regmap, RT5640_PR_BASE +
967 RT5640_MAMP_INT_REG2, 0x1c00);
968 regmap_update_bits(rt5640->regmap, RT5640_DEPOP_M1,
969 RT5640_HP_CP_MASK | RT5640_HP_SG_MASK,
970 RT5640_HP_CP_PD | RT5640_HP_SG_EN);
971 regmap_update_bits(rt5640->regmap, RT5640_PR_BASE +
972 RT5640_CHPUMP_INT_REG1, 0x0700, 0x0400);
973 }
974
975 static int rt5640_hp_event(struct snd_soc_dapm_widget *w,
976 struct snd_kcontrol *kcontrol, int event)
977 {
978 struct snd_soc_codec *codec = w->codec;
979 struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
980
981 switch (event) {
982 case SND_SOC_DAPM_POST_PMU:
983 rt5640_pmu_depop(codec);
984 rt5640->hp_mute = 0;
985 break;
986
987 case SND_SOC_DAPM_PRE_PMD:
988 rt5640->hp_mute = 1;
989 usleep_range(70000, 75000);
990 break;
991
992 default:
993 return 0;
994 }
995
996 return 0;
997 }
998
999 static int rt5640_hp_power_event(struct snd_soc_dapm_widget *w,
1000 struct snd_kcontrol *kcontrol, int event)
1001 {
1002 struct snd_soc_codec *codec = w->codec;
1003
1004 switch (event) {
1005 case SND_SOC_DAPM_POST_PMU:
1006 hp_amp_power_on(codec);
1007 break;
1008 default:
1009 return 0;
1010 }
1011
1012 return 0;
1013 }
1014
1015 static int rt5640_hp_post_event(struct snd_soc_dapm_widget *w,
1016 struct snd_kcontrol *kcontrol, int event)
1017 {
1018 struct snd_soc_codec *codec = w->codec;
1019 struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
1020
1021 switch (event) {
1022 case SND_SOC_DAPM_POST_PMU:
1023 if (!rt5640->hp_mute)
1024 usleep_range(80000, 85000);
1025
1026 break;
1027
1028 default:
1029 return 0;
1030 }
1031
1032 return 0;
1033 }
1034
1035 static const struct snd_soc_dapm_widget rt5640_dapm_widgets[] = {
1036 SND_SOC_DAPM_SUPPLY("PLL1", RT5640_PWR_ANLG2,
1037 RT5640_PWR_PLL_BIT, 0, NULL, 0),
1038 /* Input Side */
1039 /* micbias */
1040 SND_SOC_DAPM_SUPPLY("LDO2", RT5640_PWR_ANLG1,
1041 RT5640_PWR_LDO2_BIT, 0, NULL, 0),
1042 SND_SOC_DAPM_SUPPLY("MICBIAS1", RT5640_PWR_ANLG2,
1043 RT5640_PWR_MB1_BIT, 0, NULL, 0),
1044 /* Input Lines */
1045 SND_SOC_DAPM_INPUT("DMIC1"),
1046 SND_SOC_DAPM_INPUT("DMIC2"),
1047 SND_SOC_DAPM_INPUT("IN1P"),
1048 SND_SOC_DAPM_INPUT("IN1N"),
1049 SND_SOC_DAPM_INPUT("IN2P"),
1050 SND_SOC_DAPM_INPUT("IN2N"),
1051 SND_SOC_DAPM_PGA("DMIC L1", SND_SOC_NOPM, 0, 0, NULL, 0),
1052 SND_SOC_DAPM_PGA("DMIC R1", SND_SOC_NOPM, 0, 0, NULL, 0),
1053 SND_SOC_DAPM_PGA("DMIC L2", SND_SOC_NOPM, 0, 0, NULL, 0),
1054 SND_SOC_DAPM_PGA("DMIC R2", SND_SOC_NOPM, 0, 0, NULL, 0),
1055
1056 SND_SOC_DAPM_SUPPLY("DMIC CLK", SND_SOC_NOPM, 0, 0,
1057 set_dmic_clk, SND_SOC_DAPM_PRE_PMU),
1058 SND_SOC_DAPM_SUPPLY("DMIC1 Power", RT5640_DMIC, RT5640_DMIC_1_EN_SFT, 0,
1059 NULL, 0),
1060 SND_SOC_DAPM_SUPPLY("DMIC2 Power", RT5640_DMIC, RT5640_DMIC_2_EN_SFT, 0,
1061 NULL, 0),
1062 /* Boost */
1063 SND_SOC_DAPM_PGA("BST1", RT5640_PWR_ANLG2,
1064 RT5640_PWR_BST1_BIT, 0, NULL, 0),
1065 SND_SOC_DAPM_PGA("BST2", RT5640_PWR_ANLG2,
1066 RT5640_PWR_BST4_BIT, 0, NULL, 0),
1067 /* Input Volume */
1068 SND_SOC_DAPM_PGA("INL VOL", RT5640_PWR_VOL,
1069 RT5640_PWR_IN_L_BIT, 0, NULL, 0),
1070 SND_SOC_DAPM_PGA("INR VOL", RT5640_PWR_VOL,
1071 RT5640_PWR_IN_R_BIT, 0, NULL, 0),
1072 /* REC Mixer */
1073 SND_SOC_DAPM_MIXER("RECMIXL", RT5640_PWR_MIXER, RT5640_PWR_RM_L_BIT, 0,
1074 rt5640_rec_l_mix, ARRAY_SIZE(rt5640_rec_l_mix)),
1075 SND_SOC_DAPM_MIXER("RECMIXR", RT5640_PWR_MIXER, RT5640_PWR_RM_R_BIT, 0,
1076 rt5640_rec_r_mix, ARRAY_SIZE(rt5640_rec_r_mix)),
1077 /* ADCs */
1078 SND_SOC_DAPM_ADC("ADC L", NULL, RT5640_PWR_DIG1,
1079 RT5640_PWR_ADC_L_BIT, 0),
1080 SND_SOC_DAPM_ADC("ADC R", NULL, RT5640_PWR_DIG1,
1081 RT5640_PWR_ADC_R_BIT, 0),
1082 /* ADC Mux */
1083 SND_SOC_DAPM_MUX("Stereo ADC L2 Mux", SND_SOC_NOPM, 0, 0,
1084 &rt5640_sto_adc_2_mux),
1085 SND_SOC_DAPM_MUX("Stereo ADC R2 Mux", SND_SOC_NOPM, 0, 0,
1086 &rt5640_sto_adc_2_mux),
1087 SND_SOC_DAPM_MUX("Stereo ADC L1 Mux", SND_SOC_NOPM, 0, 0,
1088 &rt5640_sto_adc_1_mux),
1089 SND_SOC_DAPM_MUX("Stereo ADC R1 Mux", SND_SOC_NOPM, 0, 0,
1090 &rt5640_sto_adc_1_mux),
1091 SND_SOC_DAPM_MUX("Mono ADC L2 Mux", SND_SOC_NOPM, 0, 0,
1092 &rt5640_mono_adc_l2_mux),
1093 SND_SOC_DAPM_MUX("Mono ADC L1 Mux", SND_SOC_NOPM, 0, 0,
1094 &rt5640_mono_adc_l1_mux),
1095 SND_SOC_DAPM_MUX("Mono ADC R1 Mux", SND_SOC_NOPM, 0, 0,
1096 &rt5640_mono_adc_r1_mux),
1097 SND_SOC_DAPM_MUX("Mono ADC R2 Mux", SND_SOC_NOPM, 0, 0,
1098 &rt5640_mono_adc_r2_mux),
1099 /* ADC Mixer */
1100 SND_SOC_DAPM_SUPPLY("Stereo Filter", RT5640_PWR_DIG2,
1101 RT5640_PWR_ADC_SF_BIT, 0, NULL, 0),
1102 SND_SOC_DAPM_MIXER("Stereo ADC MIXL", SND_SOC_NOPM, 0, 0,
1103 rt5640_sto_adc_l_mix, ARRAY_SIZE(rt5640_sto_adc_l_mix)),
1104 SND_SOC_DAPM_MIXER("Stereo ADC MIXR", SND_SOC_NOPM, 0, 0,
1105 rt5640_sto_adc_r_mix, ARRAY_SIZE(rt5640_sto_adc_r_mix)),
1106 SND_SOC_DAPM_SUPPLY("Mono Left Filter", RT5640_PWR_DIG2,
1107 RT5640_PWR_ADC_MF_L_BIT, 0, NULL, 0),
1108 SND_SOC_DAPM_MIXER("Mono ADC MIXL", SND_SOC_NOPM, 0, 0,
1109 rt5640_mono_adc_l_mix, ARRAY_SIZE(rt5640_mono_adc_l_mix)),
1110 SND_SOC_DAPM_SUPPLY("Mono Right Filter", RT5640_PWR_DIG2,
1111 RT5640_PWR_ADC_MF_R_BIT, 0, NULL, 0),
1112 SND_SOC_DAPM_MIXER("Mono ADC MIXR", SND_SOC_NOPM, 0, 0,
1113 rt5640_mono_adc_r_mix, ARRAY_SIZE(rt5640_mono_adc_r_mix)),
1114
1115 /* Digital Interface */
1116 SND_SOC_DAPM_SUPPLY("I2S1", RT5640_PWR_DIG1,
1117 RT5640_PWR_I2S1_BIT, 0, NULL, 0),
1118 SND_SOC_DAPM_PGA("IF1 DAC", SND_SOC_NOPM, 0, 0, NULL, 0),
1119 SND_SOC_DAPM_PGA("IF1 DAC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1120 SND_SOC_DAPM_PGA("IF1 DAC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1121 SND_SOC_DAPM_PGA("IF1 ADC", SND_SOC_NOPM, 0, 0, NULL, 0),
1122 SND_SOC_DAPM_PGA("IF1 ADC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1123 SND_SOC_DAPM_PGA("IF1 ADC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1124 SND_SOC_DAPM_SUPPLY("I2S2", RT5640_PWR_DIG1,
1125 RT5640_PWR_I2S2_BIT, 0, NULL, 0),
1126 SND_SOC_DAPM_PGA("IF2 DAC", SND_SOC_NOPM, 0, 0, NULL, 0),
1127 SND_SOC_DAPM_PGA("IF2 DAC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1128 SND_SOC_DAPM_PGA("IF2 DAC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1129 SND_SOC_DAPM_PGA("IF2 ADC", SND_SOC_NOPM, 0, 0, NULL, 0),
1130 SND_SOC_DAPM_PGA("IF2 ADC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1131 SND_SOC_DAPM_PGA("IF2 ADC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1132 /* Digital Interface Select */
1133 SND_SOC_DAPM_MUX("DAI1 RX Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
1134 SND_SOC_DAPM_MUX("DAI1 TX Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
1135 SND_SOC_DAPM_MUX("DAI1 IF1 Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
1136 SND_SOC_DAPM_MUX("DAI1 IF2 Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
1137 SND_SOC_DAPM_MUX("SDI1 TX Mux", SND_SOC_NOPM, 0, 0, &rt5640_sdi_mux),
1138 SND_SOC_DAPM_MUX("DAI2 RX Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
1139 SND_SOC_DAPM_MUX("DAI2 TX Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
1140 SND_SOC_DAPM_MUX("DAI2 IF1 Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
1141 SND_SOC_DAPM_MUX("DAI2 IF2 Mux", SND_SOC_NOPM, 0, 0, &rt5640_dai_mux),
1142 SND_SOC_DAPM_MUX("SDI2 TX Mux", SND_SOC_NOPM, 0, 0, &rt5640_sdi_mux),
1143 /* Audio Interface */
1144 SND_SOC_DAPM_AIF_IN("AIF1RX", "AIF1 Playback", 0, SND_SOC_NOPM, 0, 0),
1145 SND_SOC_DAPM_AIF_OUT("AIF1TX", "AIF1 Capture", 0, SND_SOC_NOPM, 0, 0),
1146 SND_SOC_DAPM_AIF_IN("AIF2RX", "AIF2 Playback", 0, SND_SOC_NOPM, 0, 0),
1147 SND_SOC_DAPM_AIF_OUT("AIF2TX", "AIF2 Capture", 0, SND_SOC_NOPM, 0, 0),
1148
1149 /* Output Side */
1150 /* DAC mixer before sound effect */
1151 SND_SOC_DAPM_MIXER("DAC MIXL", SND_SOC_NOPM, 0, 0,
1152 rt5640_dac_l_mix, ARRAY_SIZE(rt5640_dac_l_mix)),
1153 SND_SOC_DAPM_MIXER("DAC MIXR", SND_SOC_NOPM, 0, 0,
1154 rt5640_dac_r_mix, ARRAY_SIZE(rt5640_dac_r_mix)),
1155
1156 /* DAC Mixer */
1157 SND_SOC_DAPM_MIXER("Mono DAC MIXL", SND_SOC_NOPM, 0, 0,
1158 rt5640_mono_dac_l_mix, ARRAY_SIZE(rt5640_mono_dac_l_mix)),
1159 SND_SOC_DAPM_MIXER("Mono DAC MIXR", SND_SOC_NOPM, 0, 0,
1160 rt5640_mono_dac_r_mix, ARRAY_SIZE(rt5640_mono_dac_r_mix)),
1161 SND_SOC_DAPM_MIXER("DIG MIXL", SND_SOC_NOPM, 0, 0,
1162 rt5640_dig_l_mix, ARRAY_SIZE(rt5640_dig_l_mix)),
1163 SND_SOC_DAPM_MIXER("DIG MIXR", SND_SOC_NOPM, 0, 0,
1164 rt5640_dig_r_mix, ARRAY_SIZE(rt5640_dig_r_mix)),
1165 /* DACs */
1166 SND_SOC_DAPM_DAC("DAC L1", NULL, RT5640_PWR_DIG1,
1167 RT5640_PWR_DAC_L1_BIT, 0),
1168 SND_SOC_DAPM_DAC("DAC R1", NULL, RT5640_PWR_DIG1,
1169 RT5640_PWR_DAC_R1_BIT, 0),
1170
1171 /* SPK/OUT Mixer */
1172 SND_SOC_DAPM_MIXER("SPK MIXL", RT5640_PWR_MIXER, RT5640_PWR_SM_L_BIT,
1173 0, rt5640_spk_l_mix, ARRAY_SIZE(rt5640_spk_l_mix)),
1174 SND_SOC_DAPM_MIXER("SPK MIXR", RT5640_PWR_MIXER, RT5640_PWR_SM_R_BIT,
1175 0, rt5640_spk_r_mix, ARRAY_SIZE(rt5640_spk_r_mix)),
1176 /* Ouput Volume */
1177 SND_SOC_DAPM_PGA("SPKVOL L", RT5640_PWR_VOL,
1178 RT5640_PWR_SV_L_BIT, 0, NULL, 0),
1179 SND_SOC_DAPM_PGA("SPKVOL R", RT5640_PWR_VOL,
1180 RT5640_PWR_SV_R_BIT, 0, NULL, 0),
1181 SND_SOC_DAPM_PGA("OUTVOL L", RT5640_PWR_VOL,
1182 RT5640_PWR_OV_L_BIT, 0, NULL, 0),
1183 SND_SOC_DAPM_PGA("OUTVOL R", RT5640_PWR_VOL,
1184 RT5640_PWR_OV_R_BIT, 0, NULL, 0),
1185 SND_SOC_DAPM_PGA("HPOVOL L", RT5640_PWR_VOL,
1186 RT5640_PWR_HV_L_BIT, 0, NULL, 0),
1187 SND_SOC_DAPM_PGA("HPOVOL R", RT5640_PWR_VOL,
1188 RT5640_PWR_HV_R_BIT, 0, NULL, 0),
1189 /* SPO/HPO/LOUT/Mono Mixer */
1190 SND_SOC_DAPM_MIXER("SPOL MIX", SND_SOC_NOPM, 0,
1191 0, rt5640_spo_l_mix, ARRAY_SIZE(rt5640_spo_l_mix)),
1192 SND_SOC_DAPM_MIXER("SPOR MIX", SND_SOC_NOPM, 0,
1193 0, rt5640_spo_r_mix, ARRAY_SIZE(rt5640_spo_r_mix)),
1194 SND_SOC_DAPM_MIXER("LOUT MIX", RT5640_PWR_ANLG1, RT5640_PWR_LM_BIT, 0,
1195 rt5640_lout_mix, ARRAY_SIZE(rt5640_lout_mix)),
1196 SND_SOC_DAPM_SUPPLY_S("Improve HP Amp Drv", 1, SND_SOC_NOPM,
1197 0, 0, rt5640_hp_power_event, SND_SOC_DAPM_POST_PMU),
1198 SND_SOC_DAPM_PGA_S("HP Amp", 1, SND_SOC_NOPM, 0, 0,
1199 rt5640_hp_event,
1200 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
1201 SND_SOC_DAPM_SUPPLY("HP L Amp", RT5640_PWR_ANLG1,
1202 RT5640_PWR_HP_L_BIT, 0, NULL, 0),
1203 SND_SOC_DAPM_SUPPLY("HP R Amp", RT5640_PWR_ANLG1,
1204 RT5640_PWR_HP_R_BIT, 0, NULL, 0),
1205 SND_SOC_DAPM_SUPPLY("Improve SPK Amp Drv", RT5640_PWR_DIG1,
1206 RT5640_PWR_CLS_D_BIT, 0, NULL, 0),
1207
1208 /* Output Switch */
1209 SND_SOC_DAPM_SWITCH("Speaker L Playback", SND_SOC_NOPM, 0, 0,
1210 &spk_l_enable_control),
1211 SND_SOC_DAPM_SWITCH("Speaker R Playback", SND_SOC_NOPM, 0, 0,
1212 &spk_r_enable_control),
1213 SND_SOC_DAPM_SWITCH("HP L Playback", SND_SOC_NOPM, 0, 0,
1214 &hp_l_enable_control),
1215 SND_SOC_DAPM_SWITCH("HP R Playback", SND_SOC_NOPM, 0, 0,
1216 &hp_r_enable_control),
1217 SND_SOC_DAPM_POST("HP Post", rt5640_hp_post_event),
1218 /* Output Lines */
1219 SND_SOC_DAPM_OUTPUT("SPOLP"),
1220 SND_SOC_DAPM_OUTPUT("SPOLN"),
1221 SND_SOC_DAPM_OUTPUT("SPORP"),
1222 SND_SOC_DAPM_OUTPUT("SPORN"),
1223 SND_SOC_DAPM_OUTPUT("HPOL"),
1224 SND_SOC_DAPM_OUTPUT("HPOR"),
1225 SND_SOC_DAPM_OUTPUT("LOUTL"),
1226 SND_SOC_DAPM_OUTPUT("LOUTR"),
1227 };
1228
1229 static const struct snd_soc_dapm_widget rt5640_specific_dapm_widgets[] = {
1230 /* Audio DSP */
1231 SND_SOC_DAPM_PGA("Audio DSP", SND_SOC_NOPM, 0, 0, NULL, 0),
1232 /* ANC */
1233 SND_SOC_DAPM_PGA("ANC", SND_SOC_NOPM, 0, 0, NULL, 0),
1234
1235 /* DAC2 channel Mux */
1236 SND_SOC_DAPM_MUX("DAC L2 Mux", SND_SOC_NOPM, 0, 0, &rt5640_dac_l2_mux),
1237 SND_SOC_DAPM_MUX("DAC R2 Mux", SND_SOC_NOPM, 0, 0, &rt5640_dac_r2_mux),
1238
1239 SND_SOC_DAPM_MIXER("Stereo DAC MIXL", SND_SOC_NOPM, 0, 0,
1240 rt5640_sto_dac_l_mix, ARRAY_SIZE(rt5640_sto_dac_l_mix)),
1241 SND_SOC_DAPM_MIXER("Stereo DAC MIXR", SND_SOC_NOPM, 0, 0,
1242 rt5640_sto_dac_r_mix, ARRAY_SIZE(rt5640_sto_dac_r_mix)),
1243
1244 SND_SOC_DAPM_DAC("DAC R2", NULL, RT5640_PWR_DIG1, RT5640_PWR_DAC_R2_BIT,
1245 0),
1246 SND_SOC_DAPM_DAC("DAC L2", NULL, RT5640_PWR_DIG1, RT5640_PWR_DAC_L2_BIT,
1247 0),
1248
1249 SND_SOC_DAPM_MIXER("OUT MIXL", RT5640_PWR_MIXER, RT5640_PWR_OM_L_BIT,
1250 0, rt5640_out_l_mix, ARRAY_SIZE(rt5640_out_l_mix)),
1251 SND_SOC_DAPM_MIXER("OUT MIXR", RT5640_PWR_MIXER, RT5640_PWR_OM_R_BIT,
1252 0, rt5640_out_r_mix, ARRAY_SIZE(rt5640_out_r_mix)),
1253
1254 SND_SOC_DAPM_MIXER("HPO MIX L", SND_SOC_NOPM, 0, 0,
1255 rt5640_hpo_mix, ARRAY_SIZE(rt5640_hpo_mix)),
1256 SND_SOC_DAPM_MIXER("HPO MIX R", SND_SOC_NOPM, 0, 0,
1257 rt5640_hpo_mix, ARRAY_SIZE(rt5640_hpo_mix)),
1258
1259 SND_SOC_DAPM_MIXER("Mono MIX", RT5640_PWR_ANLG1, RT5640_PWR_MM_BIT, 0,
1260 rt5640_mono_mix, ARRAY_SIZE(rt5640_mono_mix)),
1261 SND_SOC_DAPM_SUPPLY("Improve MONO Amp Drv", RT5640_PWR_ANLG1,
1262 RT5640_PWR_MA_BIT, 0, NULL, 0),
1263
1264 SND_SOC_DAPM_OUTPUT("MONOP"),
1265 SND_SOC_DAPM_OUTPUT("MONON"),
1266 };
1267
1268 static const struct snd_soc_dapm_widget rt5639_specific_dapm_widgets[] = {
1269 SND_SOC_DAPM_MIXER("Stereo DAC MIXL", SND_SOC_NOPM, 0, 0,
1270 rt5639_sto_dac_l_mix, ARRAY_SIZE(rt5639_sto_dac_l_mix)),
1271 SND_SOC_DAPM_MIXER("Stereo DAC MIXR", SND_SOC_NOPM, 0, 0,
1272 rt5639_sto_dac_r_mix, ARRAY_SIZE(rt5639_sto_dac_r_mix)),
1273
1274 SND_SOC_DAPM_SUPPLY("DAC L2 Filter", RT5640_PWR_DIG1,
1275 RT5640_PWR_DAC_L2_BIT, 0, NULL, 0),
1276 SND_SOC_DAPM_SUPPLY("DAC R2 Filter", RT5640_PWR_DIG1,
1277 RT5640_PWR_DAC_R2_BIT, 0, NULL, 0),
1278
1279 SND_SOC_DAPM_MIXER("OUT MIXL", RT5640_PWR_MIXER, RT5640_PWR_OM_L_BIT,
1280 0, rt5639_out_l_mix, ARRAY_SIZE(rt5639_out_l_mix)),
1281 SND_SOC_DAPM_MIXER("OUT MIXR", RT5640_PWR_MIXER, RT5640_PWR_OM_R_BIT,
1282 0, rt5639_out_r_mix, ARRAY_SIZE(rt5639_out_r_mix)),
1283
1284 SND_SOC_DAPM_MIXER("HPO MIX L", SND_SOC_NOPM, 0, 0,
1285 rt5639_hpo_mix, ARRAY_SIZE(rt5639_hpo_mix)),
1286 SND_SOC_DAPM_MIXER("HPO MIX R", SND_SOC_NOPM, 0, 0,
1287 rt5639_hpo_mix, ARRAY_SIZE(rt5639_hpo_mix)),
1288 };
1289
1290 static const struct snd_soc_dapm_route rt5640_dapm_routes[] = {
1291 {"IN1P", NULL, "LDO2"},
1292 {"IN2P", NULL, "LDO2"},
1293
1294 {"DMIC L1", NULL, "DMIC1"},
1295 {"DMIC R1", NULL, "DMIC1"},
1296 {"DMIC L2", NULL, "DMIC2"},
1297 {"DMIC R2", NULL, "DMIC2"},
1298
1299 {"BST1", NULL, "IN1P"},
1300 {"BST1", NULL, "IN1N"},
1301 {"BST2", NULL, "IN2P"},
1302 {"BST2", NULL, "IN2N"},
1303
1304 {"INL VOL", NULL, "IN2P"},
1305 {"INR VOL", NULL, "IN2N"},
1306
1307 {"RECMIXL", "HPOL Switch", "HPOL"},
1308 {"RECMIXL", "INL Switch", "INL VOL"},
1309 {"RECMIXL", "BST2 Switch", "BST2"},
1310 {"RECMIXL", "BST1 Switch", "BST1"},
1311 {"RECMIXL", "OUT MIXL Switch", "OUT MIXL"},
1312
1313 {"RECMIXR", "HPOR Switch", "HPOR"},
1314 {"RECMIXR", "INR Switch", "INR VOL"},
1315 {"RECMIXR", "BST2 Switch", "BST2"},
1316 {"RECMIXR", "BST1 Switch", "BST1"},
1317 {"RECMIXR", "OUT MIXR Switch", "OUT MIXR"},
1318
1319 {"ADC L", NULL, "RECMIXL"},
1320 {"ADC R", NULL, "RECMIXR"},
1321
1322 {"DMIC L1", NULL, "DMIC CLK"},
1323 {"DMIC L1", NULL, "DMIC1 Power"},
1324 {"DMIC R1", NULL, "DMIC CLK"},
1325 {"DMIC R1", NULL, "DMIC1 Power"},
1326 {"DMIC L2", NULL, "DMIC CLK"},
1327 {"DMIC L2", NULL, "DMIC2 Power"},
1328 {"DMIC R2", NULL, "DMIC CLK"},
1329 {"DMIC R2", NULL, "DMIC2 Power"},
1330
1331 {"Stereo ADC L2 Mux", "DMIC1", "DMIC L1"},
1332 {"Stereo ADC L2 Mux", "DMIC2", "DMIC L2"},
1333 {"Stereo ADC L2 Mux", "DIG MIX", "DIG MIXL"},
1334 {"Stereo ADC L1 Mux", "ADC", "ADC L"},
1335 {"Stereo ADC L1 Mux", "DIG MIX", "DIG MIXL"},
1336
1337 {"Stereo ADC R1 Mux", "ADC", "ADC R"},
1338 {"Stereo ADC R1 Mux", "DIG MIX", "DIG MIXR"},
1339 {"Stereo ADC R2 Mux", "DMIC1", "DMIC R1"},
1340 {"Stereo ADC R2 Mux", "DMIC2", "DMIC R2"},
1341 {"Stereo ADC R2 Mux", "DIG MIX", "DIG MIXR"},
1342
1343 {"Mono ADC L2 Mux", "DMIC L1", "DMIC L1"},
1344 {"Mono ADC L2 Mux", "DMIC L2", "DMIC L2"},
1345 {"Mono ADC L2 Mux", "Mono DAC MIXL", "Mono DAC MIXL"},
1346 {"Mono ADC L1 Mux", "Mono DAC MIXL", "Mono DAC MIXL"},
1347 {"Mono ADC L1 Mux", "ADCL", "ADC L"},
1348
1349 {"Mono ADC R1 Mux", "Mono DAC MIXR", "Mono DAC MIXR"},
1350 {"Mono ADC R1 Mux", "ADCR", "ADC R"},
1351 {"Mono ADC R2 Mux", "DMIC R1", "DMIC R1"},
1352 {"Mono ADC R2 Mux", "DMIC R2", "DMIC R2"},
1353 {"Mono ADC R2 Mux", "Mono DAC MIXR", "Mono DAC MIXR"},
1354
1355 {"Stereo ADC MIXL", "ADC1 Switch", "Stereo ADC L1 Mux"},
1356 {"Stereo ADC MIXL", "ADC2 Switch", "Stereo ADC L2 Mux"},
1357 {"Stereo ADC MIXL", NULL, "Stereo Filter"},
1358 {"Stereo Filter", NULL, "PLL1", is_sys_clk_from_pll},
1359
1360 {"Stereo ADC MIXR", "ADC1 Switch", "Stereo ADC R1 Mux"},
1361 {"Stereo ADC MIXR", "ADC2 Switch", "Stereo ADC R2 Mux"},
1362 {"Stereo ADC MIXR", NULL, "Stereo Filter"},
1363 {"Stereo Filter", NULL, "PLL1", is_sys_clk_from_pll},
1364
1365 {"Mono ADC MIXL", "ADC1 Switch", "Mono ADC L1 Mux"},
1366 {"Mono ADC MIXL", "ADC2 Switch", "Mono ADC L2 Mux"},
1367 {"Mono ADC MIXL", NULL, "Mono Left Filter"},
1368 {"Mono Left Filter", NULL, "PLL1", is_sys_clk_from_pll},
1369
1370 {"Mono ADC MIXR", "ADC1 Switch", "Mono ADC R1 Mux"},
1371 {"Mono ADC MIXR", "ADC2 Switch", "Mono ADC R2 Mux"},
1372 {"Mono ADC MIXR", NULL, "Mono Right Filter"},
1373 {"Mono Right Filter", NULL, "PLL1", is_sys_clk_from_pll},
1374
1375 {"IF2 ADC L", NULL, "Mono ADC MIXL"},
1376 {"IF2 ADC R", NULL, "Mono ADC MIXR"},
1377 {"IF1 ADC L", NULL, "Stereo ADC MIXL"},
1378 {"IF1 ADC R", NULL, "Stereo ADC MIXR"},
1379
1380 {"IF1 ADC", NULL, "I2S1"},
1381 {"IF1 ADC", NULL, "IF1 ADC L"},
1382 {"IF1 ADC", NULL, "IF1 ADC R"},
1383 {"IF2 ADC", NULL, "I2S2"},
1384 {"IF2 ADC", NULL, "IF2 ADC L"},
1385 {"IF2 ADC", NULL, "IF2 ADC R"},
1386
1387 {"DAI1 TX Mux", "1:1|2:2", "IF1 ADC"},
1388 {"DAI1 TX Mux", "1:2|2:1", "IF2 ADC"},
1389 {"DAI1 IF1 Mux", "1:1|2:1", "IF1 ADC"},
1390 {"DAI1 IF2 Mux", "1:1|2:1", "IF2 ADC"},
1391 {"SDI1 TX Mux", "IF1", "DAI1 IF1 Mux"},
1392 {"SDI1 TX Mux", "IF2", "DAI1 IF2 Mux"},
1393
1394 {"DAI2 TX Mux", "1:2|2:1", "IF1 ADC"},
1395 {"DAI2 TX Mux", "1:1|2:2", "IF2 ADC"},
1396 {"DAI2 IF1 Mux", "1:2|2:2", "IF1 ADC"},
1397 {"DAI2 IF2 Mux", "1:2|2:2", "IF2 ADC"},
1398 {"SDI2 TX Mux", "IF1", "DAI2 IF1 Mux"},
1399 {"SDI2 TX Mux", "IF2", "DAI2 IF2 Mux"},
1400
1401 {"AIF1TX", NULL, "DAI1 TX Mux"},
1402 {"AIF1TX", NULL, "SDI1 TX Mux"},
1403 {"AIF2TX", NULL, "DAI2 TX Mux"},
1404 {"AIF2TX", NULL, "SDI2 TX Mux"},
1405
1406 {"DAI1 RX Mux", "1:1|2:2", "AIF1RX"},
1407 {"DAI1 RX Mux", "1:1|2:1", "AIF1RX"},
1408 {"DAI1 RX Mux", "1:2|2:1", "AIF2RX"},
1409 {"DAI1 RX Mux", "1:2|2:2", "AIF2RX"},
1410
1411 {"DAI2 RX Mux", "1:2|2:1", "AIF1RX"},
1412 {"DAI2 RX Mux", "1:1|2:1", "AIF1RX"},
1413 {"DAI2 RX Mux", "1:1|2:2", "AIF2RX"},
1414 {"DAI2 RX Mux", "1:2|2:2", "AIF2RX"},
1415
1416 {"IF1 DAC", NULL, "I2S1"},
1417 {"IF1 DAC", NULL, "DAI1 RX Mux"},
1418 {"IF2 DAC", NULL, "I2S2"},
1419 {"IF2 DAC", NULL, "DAI2 RX Mux"},
1420
1421 {"IF1 DAC L", NULL, "IF1 DAC"},
1422 {"IF1 DAC R", NULL, "IF1 DAC"},
1423 {"IF2 DAC L", NULL, "IF2 DAC"},
1424 {"IF2 DAC R", NULL, "IF2 DAC"},
1425
1426 {"DAC MIXL", "Stereo ADC Switch", "Stereo ADC MIXL"},
1427 {"DAC MIXL", "INF1 Switch", "IF1 DAC L"},
1428 {"DAC MIXR", "Stereo ADC Switch", "Stereo ADC MIXR"},
1429 {"DAC MIXR", "INF1 Switch", "IF1 DAC R"},
1430
1431 {"Stereo DAC MIXL", "DAC L1 Switch", "DAC MIXL"},
1432 {"Stereo DAC MIXR", "DAC R1 Switch", "DAC MIXR"},
1433
1434 {"Mono DAC MIXL", "DAC L1 Switch", "DAC MIXL"},
1435 {"Mono DAC MIXR", "DAC R1 Switch", "DAC MIXR"},
1436
1437 {"DIG MIXL", "DAC L1 Switch", "DAC MIXL"},
1438 {"DIG MIXR", "DAC R1 Switch", "DAC MIXR"},
1439
1440 {"DAC L1", NULL, "Stereo DAC MIXL"},
1441 {"DAC L1", NULL, "PLL1", is_sys_clk_from_pll},
1442 {"DAC R1", NULL, "Stereo DAC MIXR"},
1443 {"DAC R1", NULL, "PLL1", is_sys_clk_from_pll},
1444
1445 {"SPK MIXL", "REC MIXL Switch", "RECMIXL"},
1446 {"SPK MIXL", "INL Switch", "INL VOL"},
1447 {"SPK MIXL", "DAC L1 Switch", "DAC L1"},
1448 {"SPK MIXL", "OUT MIXL Switch", "OUT MIXL"},
1449 {"SPK MIXR", "REC MIXR Switch", "RECMIXR"},
1450 {"SPK MIXR", "INR Switch", "INR VOL"},
1451 {"SPK MIXR", "DAC R1 Switch", "DAC R1"},
1452 {"SPK MIXR", "OUT MIXR Switch", "OUT MIXR"},
1453
1454 {"OUT MIXL", "BST1 Switch", "BST1"},
1455 {"OUT MIXL", "INL Switch", "INL VOL"},
1456 {"OUT MIXL", "REC MIXL Switch", "RECMIXL"},
1457 {"OUT MIXL", "DAC L1 Switch", "DAC L1"},
1458
1459 {"OUT MIXR", "BST2 Switch", "BST2"},
1460 {"OUT MIXR", "BST1 Switch", "BST1"},
1461 {"OUT MIXR", "INR Switch", "INR VOL"},
1462 {"OUT MIXR", "REC MIXR Switch", "RECMIXR"},
1463 {"OUT MIXR", "DAC R1 Switch", "DAC R1"},
1464
1465 {"SPKVOL L", NULL, "SPK MIXL"},
1466 {"SPKVOL R", NULL, "SPK MIXR"},
1467 {"HPOVOL L", NULL, "OUT MIXL"},
1468 {"HPOVOL R", NULL, "OUT MIXR"},
1469 {"OUTVOL L", NULL, "OUT MIXL"},
1470 {"OUTVOL R", NULL, "OUT MIXR"},
1471
1472 {"SPOL MIX", "DAC R1 Switch", "DAC R1"},
1473 {"SPOL MIX", "DAC L1 Switch", "DAC L1"},
1474 {"SPOL MIX", "SPKVOL R Switch", "SPKVOL R"},
1475 {"SPOL MIX", "SPKVOL L Switch", "SPKVOL L"},
1476 {"SPOL MIX", "BST1 Switch", "BST1"},
1477 {"SPOR MIX", "DAC R1 Switch", "DAC R1"},
1478 {"SPOR MIX", "SPKVOL R Switch", "SPKVOL R"},
1479 {"SPOR MIX", "BST1 Switch", "BST1"},
1480
1481 {"HPO MIX L", "HPO MIX DAC1 Switch", "DAC L1"},
1482 {"HPO MIX L", "HPO MIX HPVOL Switch", "HPOVOL L"},
1483 {"HPO MIX L", NULL, "HP L Amp"},
1484 {"HPO MIX R", "HPO MIX DAC1 Switch", "DAC R1"},
1485 {"HPO MIX R", "HPO MIX HPVOL Switch", "HPOVOL R"},
1486 {"HPO MIX R", NULL, "HP R Amp"},
1487
1488 {"LOUT MIX", "DAC L1 Switch", "DAC L1"},
1489 {"LOUT MIX", "DAC R1 Switch", "DAC R1"},
1490 {"LOUT MIX", "OUTVOL L Switch", "OUTVOL L"},
1491 {"LOUT MIX", "OUTVOL R Switch", "OUTVOL R"},
1492
1493 {"HP Amp", NULL, "HPO MIX L"},
1494 {"HP Amp", NULL, "HPO MIX R"},
1495
1496 {"Speaker L Playback", "Switch", "SPOL MIX"},
1497 {"Speaker R Playback", "Switch", "SPOR MIX"},
1498 {"SPOLP", NULL, "Speaker L Playback"},
1499 {"SPOLN", NULL, "Speaker L Playback"},
1500 {"SPORP", NULL, "Speaker R Playback"},
1501 {"SPORN", NULL, "Speaker R Playback"},
1502
1503 {"SPOLP", NULL, "Improve SPK Amp Drv"},
1504 {"SPOLN", NULL, "Improve SPK Amp Drv"},
1505 {"SPORP", NULL, "Improve SPK Amp Drv"},
1506 {"SPORN", NULL, "Improve SPK Amp Drv"},
1507
1508 {"HPOL", NULL, "Improve HP Amp Drv"},
1509 {"HPOR", NULL, "Improve HP Amp Drv"},
1510
1511 {"HP L Playback", "Switch", "HP Amp"},
1512 {"HP R Playback", "Switch", "HP Amp"},
1513 {"HPOL", NULL, "HP L Playback"},
1514 {"HPOR", NULL, "HP R Playback"},
1515 {"LOUTL", NULL, "LOUT MIX"},
1516 {"LOUTR", NULL, "LOUT MIX"},
1517 };
1518
1519 static const struct snd_soc_dapm_route rt5640_specific_dapm_routes[] = {
1520 {"ANC", NULL, "Stereo ADC MIXL"},
1521 {"ANC", NULL, "Stereo ADC MIXR"},
1522
1523 {"Audio DSP", NULL, "DAC MIXL"},
1524 {"Audio DSP", NULL, "DAC MIXR"},
1525
1526 {"DAC L2 Mux", "IF2", "IF2 DAC L"},
1527 {"DAC L2 Mux", "Base L/R", "Audio DSP"},
1528
1529 {"DAC R2 Mux", "IF2", "IF2 DAC R"},
1530
1531 {"Stereo DAC MIXL", "DAC L2 Switch", "DAC L2 Mux"},
1532 {"Stereo DAC MIXL", "ANC Switch", "ANC"},
1533 {"Stereo DAC MIXR", "DAC R2 Switch", "DAC R2 Mux"},
1534 {"Stereo DAC MIXR", "ANC Switch", "ANC"},
1535
1536 {"Mono DAC MIXL", "DAC L2 Switch", "DAC L2 Mux"},
1537 {"Mono DAC MIXL", "DAC R2 Switch", "DAC R2 Mux"},
1538
1539 {"Mono DAC MIXR", "DAC R2 Switch", "DAC R2 Mux"},
1540 {"Mono DAC MIXR", "DAC L2 Switch", "DAC L2 Mux"},
1541
1542 {"DIG MIXR", "DAC R2 Switch", "DAC R2 Mux"},
1543 {"DIG MIXL", "DAC L2 Switch", "DAC L2 Mux"},
1544
1545 {"DAC L2", NULL, "Mono DAC MIXL"},
1546 {"DAC L2", NULL, "PLL1", is_sys_clk_from_pll},
1547 {"DAC R2", NULL, "Mono DAC MIXR"},
1548 {"DAC R2", NULL, "PLL1", is_sys_clk_from_pll},
1549
1550 {"SPK MIXL", "DAC L2 Switch", "DAC L2"},
1551 {"SPK MIXR", "DAC R2 Switch", "DAC R2"},
1552
1553 {"OUT MIXL", "SPK MIXL Switch", "SPK MIXL"},
1554 {"OUT MIXR", "SPK MIXR Switch", "SPK MIXR"},
1555
1556 {"OUT MIXL", "DAC R2 Switch", "DAC R2"},
1557 {"OUT MIXL", "DAC L2 Switch", "DAC L2"},
1558
1559 {"OUT MIXR", "DAC L2 Switch", "DAC L2"},
1560 {"OUT MIXR", "DAC R2 Switch", "DAC R2"},
1561
1562 {"HPO MIX L", "HPO MIX DAC2 Switch", "DAC L2"},
1563 {"HPO MIX R", "HPO MIX DAC2 Switch", "DAC R2"},
1564
1565 {"Mono MIX", "DAC R2 Switch", "DAC R2"},
1566 {"Mono MIX", "DAC L2 Switch", "DAC L2"},
1567 {"Mono MIX", "OUTVOL R Switch", "OUTVOL R"},
1568 {"Mono MIX", "OUTVOL L Switch", "OUTVOL L"},
1569 {"Mono MIX", "BST1 Switch", "BST1"},
1570
1571 {"MONOP", NULL, "Mono MIX"},
1572 {"MONON", NULL, "Mono MIX"},
1573 {"MONOP", NULL, "Improve MONO Amp Drv"},
1574 };
1575
1576 static const struct snd_soc_dapm_route rt5639_specific_dapm_routes[] = {
1577 {"Stereo DAC MIXL", "DAC L2 Switch", "IF2 DAC L"},
1578 {"Stereo DAC MIXR", "DAC R2 Switch", "IF2 DAC R"},
1579
1580 {"Mono DAC MIXL", "DAC L2 Switch", "IF2 DAC L"},
1581 {"Mono DAC MIXL", "DAC R2 Switch", "IF2 DAC R"},
1582
1583 {"Mono DAC MIXR", "DAC R2 Switch", "IF2 DAC R"},
1584 {"Mono DAC MIXR", "DAC L2 Switch", "IF2 DAC L"},
1585
1586 {"DIG MIXL", "DAC L2 Switch", "IF2 DAC L"},
1587 {"DIG MIXR", "DAC R2 Switch", "IF2 DAC R"},
1588
1589 {"IF2 DAC L", NULL, "DAC L2 Filter"},
1590 {"IF2 DAC R", NULL, "DAC R2 Filter"},
1591 };
1592
1593 static int get_sdp_info(struct snd_soc_codec *codec, int dai_id)
1594 {
1595 int ret = 0, val;
1596
1597 if (codec == NULL)
1598 return -EINVAL;
1599
1600 val = snd_soc_read(codec, RT5640_I2S1_SDP);
1601 val = (val & RT5640_I2S_IF_MASK) >> RT5640_I2S_IF_SFT;
1602 switch (dai_id) {
1603 case RT5640_AIF1:
1604 switch (val) {
1605 case RT5640_IF_123:
1606 case RT5640_IF_132:
1607 ret |= RT5640_U_IF1;
1608 break;
1609 case RT5640_IF_113:
1610 ret |= RT5640_U_IF1;
1611 case RT5640_IF_312:
1612 case RT5640_IF_213:
1613 ret |= RT5640_U_IF2;
1614 break;
1615 }
1616 break;
1617
1618 case RT5640_AIF2:
1619 switch (val) {
1620 case RT5640_IF_231:
1621 case RT5640_IF_213:
1622 ret |= RT5640_U_IF1;
1623 break;
1624 case RT5640_IF_223:
1625 ret |= RT5640_U_IF1;
1626 case RT5640_IF_123:
1627 case RT5640_IF_321:
1628 ret |= RT5640_U_IF2;
1629 break;
1630 }
1631 break;
1632
1633 default:
1634 ret = -EINVAL;
1635 break;
1636 }
1637
1638 return ret;
1639 }
1640
1641 static int get_clk_info(int sclk, int rate)
1642 {
1643 int i, pd[] = {1, 2, 3, 4, 6, 8, 12, 16};
1644
1645 if (sclk <= 0 || rate <= 0)
1646 return -EINVAL;
1647
1648 rate = rate << 8;
1649 for (i = 0; i < ARRAY_SIZE(pd); i++)
1650 if (sclk == rate * pd[i])
1651 return i;
1652
1653 return -EINVAL;
1654 }
1655
1656 static int rt5640_hw_params(struct snd_pcm_substream *substream,
1657 struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
1658 {
1659 struct snd_soc_codec *codec = dai->codec;
1660 struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
1661 unsigned int val_len = 0, val_clk, mask_clk;
1662 int dai_sel, pre_div, bclk_ms, frame_size;
1663
1664 rt5640->lrck[dai->id] = params_rate(params);
1665 pre_div = get_clk_info(rt5640->sysclk, rt5640->lrck[dai->id]);
1666 if (pre_div < 0) {
1667 dev_err(codec->dev, "Unsupported clock setting %d for DAI %d\n",
1668 rt5640->lrck[dai->id], dai->id);
1669 return -EINVAL;
1670 }
1671 frame_size = snd_soc_params_to_frame_size(params);
1672 if (frame_size < 0) {
1673 dev_err(codec->dev, "Unsupported frame size: %d\n", frame_size);
1674 return frame_size;
1675 }
1676 if (frame_size > 32)
1677 bclk_ms = 1;
1678 else
1679 bclk_ms = 0;
1680 rt5640->bclk[dai->id] = rt5640->lrck[dai->id] * (32 << bclk_ms);
1681
1682 dev_dbg(dai->dev, "bclk is %dHz and lrck is %dHz\n",
1683 rt5640->bclk[dai->id], rt5640->lrck[dai->id]);
1684 dev_dbg(dai->dev, "bclk_ms is %d and pre_div is %d for iis %d\n",
1685 bclk_ms, pre_div, dai->id);
1686
1687 switch (params_width(params)) {
1688 case 16:
1689 break;
1690 case 20:
1691 val_len |= RT5640_I2S_DL_20;
1692 break;
1693 case 24:
1694 val_len |= RT5640_I2S_DL_24;
1695 break;
1696 case 8:
1697 val_len |= RT5640_I2S_DL_8;
1698 break;
1699 default:
1700 return -EINVAL;
1701 }
1702
1703 dai_sel = get_sdp_info(codec, dai->id);
1704 if (dai_sel < 0) {
1705 dev_err(codec->dev, "Failed to get sdp info: %d\n", dai_sel);
1706 return -EINVAL;
1707 }
1708 if (dai_sel & RT5640_U_IF1) {
1709 mask_clk = RT5640_I2S_BCLK_MS1_MASK | RT5640_I2S_PD1_MASK;
1710 val_clk = bclk_ms << RT5640_I2S_BCLK_MS1_SFT |
1711 pre_div << RT5640_I2S_PD1_SFT;
1712 snd_soc_update_bits(codec, RT5640_I2S1_SDP,
1713 RT5640_I2S_DL_MASK, val_len);
1714 snd_soc_update_bits(codec, RT5640_ADDA_CLK1, mask_clk, val_clk);
1715 }
1716 if (dai_sel & RT5640_U_IF2) {
1717 mask_clk = RT5640_I2S_BCLK_MS2_MASK | RT5640_I2S_PD2_MASK;
1718 val_clk = bclk_ms << RT5640_I2S_BCLK_MS2_SFT |
1719 pre_div << RT5640_I2S_PD2_SFT;
1720 snd_soc_update_bits(codec, RT5640_I2S2_SDP,
1721 RT5640_I2S_DL_MASK, val_len);
1722 snd_soc_update_bits(codec, RT5640_ADDA_CLK1, mask_clk, val_clk);
1723 }
1724
1725 return 0;
1726 }
1727
1728 static int rt5640_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
1729 {
1730 struct snd_soc_codec *codec = dai->codec;
1731 struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
1732 unsigned int reg_val = 0;
1733 int dai_sel;
1734
1735 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1736 case SND_SOC_DAIFMT_CBM_CFM:
1737 rt5640->master[dai->id] = 1;
1738 break;
1739 case SND_SOC_DAIFMT_CBS_CFS:
1740 reg_val |= RT5640_I2S_MS_S;
1741 rt5640->master[dai->id] = 0;
1742 break;
1743 default:
1744 return -EINVAL;
1745 }
1746
1747 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1748 case SND_SOC_DAIFMT_NB_NF:
1749 break;
1750 case SND_SOC_DAIFMT_IB_NF:
1751 reg_val |= RT5640_I2S_BP_INV;
1752 break;
1753 default:
1754 return -EINVAL;
1755 }
1756
1757 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1758 case SND_SOC_DAIFMT_I2S:
1759 break;
1760 case SND_SOC_DAIFMT_LEFT_J:
1761 reg_val |= RT5640_I2S_DF_LEFT;
1762 break;
1763 case SND_SOC_DAIFMT_DSP_A:
1764 reg_val |= RT5640_I2S_DF_PCM_A;
1765 break;
1766 case SND_SOC_DAIFMT_DSP_B:
1767 reg_val |= RT5640_I2S_DF_PCM_B;
1768 break;
1769 default:
1770 return -EINVAL;
1771 }
1772
1773 dai_sel = get_sdp_info(codec, dai->id);
1774 if (dai_sel < 0) {
1775 dev_err(codec->dev, "Failed to get sdp info: %d\n", dai_sel);
1776 return -EINVAL;
1777 }
1778 if (dai_sel & RT5640_U_IF1) {
1779 snd_soc_update_bits(codec, RT5640_I2S1_SDP,
1780 RT5640_I2S_MS_MASK | RT5640_I2S_BP_MASK |
1781 RT5640_I2S_DF_MASK, reg_val);
1782 }
1783 if (dai_sel & RT5640_U_IF2) {
1784 snd_soc_update_bits(codec, RT5640_I2S2_SDP,
1785 RT5640_I2S_MS_MASK | RT5640_I2S_BP_MASK |
1786 RT5640_I2S_DF_MASK, reg_val);
1787 }
1788
1789 return 0;
1790 }
1791
1792 static int rt5640_set_dai_sysclk(struct snd_soc_dai *dai,
1793 int clk_id, unsigned int freq, int dir)
1794 {
1795 struct snd_soc_codec *codec = dai->codec;
1796 struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
1797 unsigned int reg_val = 0;
1798
1799 if (freq == rt5640->sysclk && clk_id == rt5640->sysclk_src)
1800 return 0;
1801
1802 switch (clk_id) {
1803 case RT5640_SCLK_S_MCLK:
1804 reg_val |= RT5640_SCLK_SRC_MCLK;
1805 break;
1806 case RT5640_SCLK_S_PLL1:
1807 reg_val |= RT5640_SCLK_SRC_PLL1;
1808 break;
1809 default:
1810 dev_err(codec->dev, "Invalid clock id (%d)\n", clk_id);
1811 return -EINVAL;
1812 }
1813 snd_soc_update_bits(codec, RT5640_GLB_CLK,
1814 RT5640_SCLK_SRC_MASK, reg_val);
1815 rt5640->sysclk = freq;
1816 rt5640->sysclk_src = clk_id;
1817
1818 dev_dbg(dai->dev, "Sysclk is %dHz and clock id is %d\n", freq, clk_id);
1819 return 0;
1820 }
1821
1822 /**
1823 * rt5640_pll_calc - Calculate PLL M/N/K code.
1824 * @freq_in: external clock provided to codec.
1825 * @freq_out: target clock which codec works on.
1826 * @pll_code: Pointer to structure with M, N, K and bypass flag.
1827 *
1828 * Calculate M/N/K code to configure PLL for codec. And K is assigned to 2
1829 * which make calculation more efficiently.
1830 *
1831 * Returns 0 for success or negative error code.
1832 */
1833 static int rt5640_pll_calc(const unsigned int freq_in,
1834 const unsigned int freq_out, struct rt5640_pll_code *pll_code)
1835 {
1836 int max_n = RT5640_PLL_N_MAX, max_m = RT5640_PLL_M_MAX;
1837 int n = 0, m = 0, red, n_t, m_t, in_t, out_t;
1838 int red_t = abs(freq_out - freq_in);
1839 bool bypass = false;
1840
1841 if (RT5640_PLL_INP_MAX < freq_in || RT5640_PLL_INP_MIN > freq_in)
1842 return -EINVAL;
1843
1844 for (n_t = 0; n_t <= max_n; n_t++) {
1845 in_t = (freq_in >> 1) + (freq_in >> 2) * n_t;
1846 if (in_t < 0)
1847 continue;
1848 if (in_t == freq_out) {
1849 bypass = true;
1850 n = n_t;
1851 goto code_find;
1852 }
1853 for (m_t = 0; m_t <= max_m; m_t++) {
1854 out_t = in_t / (m_t + 2);
1855 red = abs(out_t - freq_out);
1856 if (red < red_t) {
1857 n = n_t;
1858 m = m_t;
1859 if (red == 0)
1860 goto code_find;
1861 red_t = red;
1862 }
1863 }
1864 }
1865 pr_debug("Only get approximation about PLL\n");
1866
1867 code_find:
1868 pll_code->m_bp = bypass;
1869 pll_code->m_code = m;
1870 pll_code->n_code = n;
1871 pll_code->k_code = 2;
1872 return 0;
1873 }
1874
1875 static int rt5640_set_dai_pll(struct snd_soc_dai *dai, int pll_id, int source,
1876 unsigned int freq_in, unsigned int freq_out)
1877 {
1878 struct snd_soc_codec *codec = dai->codec;
1879 struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
1880 struct rt5640_pll_code *pll_code = &rt5640->pll_code;
1881 int ret, dai_sel;
1882
1883 if (source == rt5640->pll_src && freq_in == rt5640->pll_in &&
1884 freq_out == rt5640->pll_out)
1885 return 0;
1886
1887 if (!freq_in || !freq_out) {
1888 dev_dbg(codec->dev, "PLL disabled\n");
1889
1890 rt5640->pll_in = 0;
1891 rt5640->pll_out = 0;
1892 snd_soc_update_bits(codec, RT5640_GLB_CLK,
1893 RT5640_SCLK_SRC_MASK, RT5640_SCLK_SRC_MCLK);
1894 return 0;
1895 }
1896
1897 switch (source) {
1898 case RT5640_PLL1_S_MCLK:
1899 snd_soc_update_bits(codec, RT5640_GLB_CLK,
1900 RT5640_PLL1_SRC_MASK, RT5640_PLL1_SRC_MCLK);
1901 break;
1902 case RT5640_PLL1_S_BCLK1:
1903 case RT5640_PLL1_S_BCLK2:
1904 dai_sel = get_sdp_info(codec, dai->id);
1905 if (dai_sel < 0) {
1906 dev_err(codec->dev,
1907 "Failed to get sdp info: %d\n", dai_sel);
1908 return -EINVAL;
1909 }
1910 if (dai_sel & RT5640_U_IF1) {
1911 snd_soc_update_bits(codec, RT5640_GLB_CLK,
1912 RT5640_PLL1_SRC_MASK, RT5640_PLL1_SRC_BCLK1);
1913 }
1914 if (dai_sel & RT5640_U_IF2) {
1915 snd_soc_update_bits(codec, RT5640_GLB_CLK,
1916 RT5640_PLL1_SRC_MASK, RT5640_PLL1_SRC_BCLK2);
1917 }
1918 break;
1919 default:
1920 dev_err(codec->dev, "Unknown PLL source %d\n", source);
1921 return -EINVAL;
1922 }
1923
1924 ret = rt5640_pll_calc(freq_in, freq_out, pll_code);
1925 if (ret < 0) {
1926 dev_err(codec->dev, "Unsupport input clock %d\n", freq_in);
1927 return ret;
1928 }
1929
1930 dev_dbg(codec->dev, "bypass=%d m=%d n=%d k=2\n", pll_code->m_bp,
1931 (pll_code->m_bp ? 0 : pll_code->m_code), pll_code->n_code);
1932
1933 snd_soc_write(codec, RT5640_PLL_CTRL1,
1934 pll_code->n_code << RT5640_PLL_N_SFT | pll_code->k_code);
1935 snd_soc_write(codec, RT5640_PLL_CTRL2,
1936 (pll_code->m_bp ? 0 : pll_code->m_code) << RT5640_PLL_M_SFT |
1937 pll_code->m_bp << RT5640_PLL_M_BP_SFT);
1938
1939 rt5640->pll_in = freq_in;
1940 rt5640->pll_out = freq_out;
1941 rt5640->pll_src = source;
1942
1943 return 0;
1944 }
1945
1946 static int rt5640_set_bias_level(struct snd_soc_codec *codec,
1947 enum snd_soc_bias_level level)
1948 {
1949 switch (level) {
1950 case SND_SOC_BIAS_STANDBY:
1951 if (SND_SOC_BIAS_OFF == codec->dapm.bias_level) {
1952 snd_soc_update_bits(codec, RT5640_PWR_ANLG1,
1953 RT5640_PWR_VREF1 | RT5640_PWR_MB |
1954 RT5640_PWR_BG | RT5640_PWR_VREF2,
1955 RT5640_PWR_VREF1 | RT5640_PWR_MB |
1956 RT5640_PWR_BG | RT5640_PWR_VREF2);
1957 usleep_range(10000, 15000);
1958 snd_soc_update_bits(codec, RT5640_PWR_ANLG1,
1959 RT5640_PWR_FV1 | RT5640_PWR_FV2,
1960 RT5640_PWR_FV1 | RT5640_PWR_FV2);
1961 snd_soc_update_bits(codec, RT5640_DUMMY1,
1962 0x0301, 0x0301);
1963 snd_soc_update_bits(codec, RT5640_MICBIAS,
1964 0x0030, 0x0030);
1965 }
1966 break;
1967
1968 case SND_SOC_BIAS_OFF:
1969 snd_soc_write(codec, RT5640_DEPOP_M1, 0x0004);
1970 snd_soc_write(codec, RT5640_DEPOP_M2, 0x1100);
1971 snd_soc_update_bits(codec, RT5640_DUMMY1, 0x1, 0);
1972 snd_soc_write(codec, RT5640_PWR_DIG1, 0x0000);
1973 snd_soc_write(codec, RT5640_PWR_DIG2, 0x0000);
1974 snd_soc_write(codec, RT5640_PWR_VOL, 0x0000);
1975 snd_soc_write(codec, RT5640_PWR_MIXER, 0x0000);
1976 snd_soc_write(codec, RT5640_PWR_ANLG1, 0x0000);
1977 snd_soc_write(codec, RT5640_PWR_ANLG2, 0x0000);
1978 break;
1979
1980 default:
1981 break;
1982 }
1983 codec->dapm.bias_level = level;
1984
1985 return 0;
1986 }
1987
1988 static int rt5640_probe(struct snd_soc_codec *codec)
1989 {
1990 struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
1991
1992 rt5640->codec = codec;
1993
1994 rt5640_set_bias_level(codec, SND_SOC_BIAS_OFF);
1995
1996 snd_soc_update_bits(codec, RT5640_DUMMY1, 0x0301, 0x0301);
1997 snd_soc_update_bits(codec, RT5640_MICBIAS, 0x0030, 0x0030);
1998 snd_soc_update_bits(codec, RT5640_DSP_PATH2, 0xfc00, 0x0c00);
1999
2000 switch (snd_soc_read(codec, RT5640_RESET) & RT5640_ID_MASK) {
2001 case RT5640_ID_5640:
2002 case RT5640_ID_5642:
2003 snd_soc_add_codec_controls(codec,
2004 rt5640_specific_snd_controls,
2005 ARRAY_SIZE(rt5640_specific_snd_controls));
2006 snd_soc_dapm_new_controls(&codec->dapm,
2007 rt5640_specific_dapm_widgets,
2008 ARRAY_SIZE(rt5640_specific_dapm_widgets));
2009 snd_soc_dapm_add_routes(&codec->dapm,
2010 rt5640_specific_dapm_routes,
2011 ARRAY_SIZE(rt5640_specific_dapm_routes));
2012 break;
2013 case RT5640_ID_5639:
2014 snd_soc_dapm_new_controls(&codec->dapm,
2015 rt5639_specific_dapm_widgets,
2016 ARRAY_SIZE(rt5639_specific_dapm_widgets));
2017 snd_soc_dapm_add_routes(&codec->dapm,
2018 rt5639_specific_dapm_routes,
2019 ARRAY_SIZE(rt5639_specific_dapm_routes));
2020 break;
2021 }
2022
2023 return 0;
2024 }
2025
2026 static int rt5640_remove(struct snd_soc_codec *codec)
2027 {
2028 rt5640_reset(codec);
2029
2030 return 0;
2031 }
2032
2033 #ifdef CONFIG_PM
2034 static int rt5640_suspend(struct snd_soc_codec *codec)
2035 {
2036 struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
2037
2038 rt5640_set_bias_level(codec, SND_SOC_BIAS_OFF);
2039 rt5640_reset(codec);
2040 regcache_cache_only(rt5640->regmap, true);
2041 regcache_mark_dirty(rt5640->regmap);
2042 if (gpio_is_valid(rt5640->pdata.ldo1_en))
2043 gpio_set_value_cansleep(rt5640->pdata.ldo1_en, 0);
2044
2045 return 0;
2046 }
2047
2048 static int rt5640_resume(struct snd_soc_codec *codec)
2049 {
2050 struct rt5640_priv *rt5640 = snd_soc_codec_get_drvdata(codec);
2051
2052 if (gpio_is_valid(rt5640->pdata.ldo1_en)) {
2053 gpio_set_value_cansleep(rt5640->pdata.ldo1_en, 1);
2054 msleep(400);
2055 }
2056
2057 regcache_cache_only(rt5640->regmap, false);
2058 regcache_sync(rt5640->regmap);
2059
2060 return 0;
2061 }
2062 #else
2063 #define rt5640_suspend NULL
2064 #define rt5640_resume NULL
2065 #endif
2066
2067 #define RT5640_STEREO_RATES SNDRV_PCM_RATE_8000_96000
2068 #define RT5640_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
2069 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S8)
2070
2071 static const struct snd_soc_dai_ops rt5640_aif_dai_ops = {
2072 .hw_params = rt5640_hw_params,
2073 .set_fmt = rt5640_set_dai_fmt,
2074 .set_sysclk = rt5640_set_dai_sysclk,
2075 .set_pll = rt5640_set_dai_pll,
2076 };
2077
2078 static struct snd_soc_dai_driver rt5640_dai[] = {
2079 {
2080 .name = "rt5640-aif1",
2081 .id = RT5640_AIF1,
2082 .playback = {
2083 .stream_name = "AIF1 Playback",
2084 .channels_min = 1,
2085 .channels_max = 2,
2086 .rates = RT5640_STEREO_RATES,
2087 .formats = RT5640_FORMATS,
2088 },
2089 .capture = {
2090 .stream_name = "AIF1 Capture",
2091 .channels_min = 1,
2092 .channels_max = 2,
2093 .rates = RT5640_STEREO_RATES,
2094 .formats = RT5640_FORMATS,
2095 },
2096 .ops = &rt5640_aif_dai_ops,
2097 },
2098 {
2099 .name = "rt5640-aif2",
2100 .id = RT5640_AIF2,
2101 .playback = {
2102 .stream_name = "AIF2 Playback",
2103 .channels_min = 1,
2104 .channels_max = 2,
2105 .rates = RT5640_STEREO_RATES,
2106 .formats = RT5640_FORMATS,
2107 },
2108 .capture = {
2109 .stream_name = "AIF2 Capture",
2110 .channels_min = 1,
2111 .channels_max = 2,
2112 .rates = RT5640_STEREO_RATES,
2113 .formats = RT5640_FORMATS,
2114 },
2115 .ops = &rt5640_aif_dai_ops,
2116 },
2117 };
2118
2119 static struct snd_soc_codec_driver soc_codec_dev_rt5640 = {
2120 .probe = rt5640_probe,
2121 .remove = rt5640_remove,
2122 .suspend = rt5640_suspend,
2123 .resume = rt5640_resume,
2124 .set_bias_level = rt5640_set_bias_level,
2125 .idle_bias_off = true,
2126 .controls = rt5640_snd_controls,
2127 .num_controls = ARRAY_SIZE(rt5640_snd_controls),
2128 .dapm_widgets = rt5640_dapm_widgets,
2129 .num_dapm_widgets = ARRAY_SIZE(rt5640_dapm_widgets),
2130 .dapm_routes = rt5640_dapm_routes,
2131 .num_dapm_routes = ARRAY_SIZE(rt5640_dapm_routes),
2132 };
2133
2134 static const struct regmap_config rt5640_regmap = {
2135 .reg_bits = 8,
2136 .val_bits = 16,
2137
2138 .max_register = RT5640_VENDOR_ID2 + 1 + (ARRAY_SIZE(rt5640_ranges) *
2139 RT5640_PR_SPACING),
2140 .volatile_reg = rt5640_volatile_register,
2141 .readable_reg = rt5640_readable_register,
2142
2143 .cache_type = REGCACHE_RBTREE,
2144 .reg_defaults = rt5640_reg,
2145 .num_reg_defaults = ARRAY_SIZE(rt5640_reg),
2146 .ranges = rt5640_ranges,
2147 .num_ranges = ARRAY_SIZE(rt5640_ranges),
2148 };
2149
2150 static const struct i2c_device_id rt5640_i2c_id[] = {
2151 { "rt5640", 0 },
2152 { "rt5639", 0 },
2153 { "rt5642", 0 },
2154 { }
2155 };
2156 MODULE_DEVICE_TABLE(i2c, rt5640_i2c_id);
2157
2158 #if defined(CONFIG_OF)
2159 static const struct of_device_id rt5640_of_match[] = {
2160 { .compatible = "realtek,rt5640", },
2161 {},
2162 };
2163 MODULE_DEVICE_TABLE(of, rt5640_of_match);
2164 #endif
2165
2166 #ifdef CONFIG_ACPI
2167 static struct acpi_device_id rt5640_acpi_match[] = {
2168 { "INT33CA", 0 },
2169 { "10EC5640", 0 },
2170 { },
2171 };
2172 MODULE_DEVICE_TABLE(acpi, rt5640_acpi_match);
2173 #endif
2174
2175 static int rt5640_parse_dt(struct rt5640_priv *rt5640, struct device_node *np)
2176 {
2177 rt5640->pdata.in1_diff = of_property_read_bool(np,
2178 "realtek,in1-differential");
2179 rt5640->pdata.in2_diff = of_property_read_bool(np,
2180 "realtek,in2-differential");
2181
2182 rt5640->pdata.ldo1_en = of_get_named_gpio(np,
2183 "realtek,ldo1-en-gpios", 0);
2184 /*
2185 * LDO1_EN is optional (it may be statically tied on the board).
2186 * -ENOENT means that the property doesn't exist, i.e. there is no
2187 * GPIO, so is not an error. Any other error code means the property
2188 * exists, but could not be parsed.
2189 */
2190 if (!gpio_is_valid(rt5640->pdata.ldo1_en) &&
2191 (rt5640->pdata.ldo1_en != -ENOENT))
2192 return rt5640->pdata.ldo1_en;
2193
2194 return 0;
2195 }
2196
2197 static int rt5640_i2c_probe(struct i2c_client *i2c,
2198 const struct i2c_device_id *id)
2199 {
2200 struct rt5640_platform_data *pdata = dev_get_platdata(&i2c->dev);
2201 struct rt5640_priv *rt5640;
2202 int ret;
2203 unsigned int val;
2204
2205 rt5640 = devm_kzalloc(&i2c->dev,
2206 sizeof(struct rt5640_priv),
2207 GFP_KERNEL);
2208 if (NULL == rt5640)
2209 return -ENOMEM;
2210 i2c_set_clientdata(i2c, rt5640);
2211
2212 if (pdata) {
2213 rt5640->pdata = *pdata;
2214 /*
2215 * Translate zero'd out (default) pdata value to an invalid
2216 * GPIO ID. This makes the pdata and DT paths consistent in
2217 * terms of the value left in this field when no GPIO is
2218 * specified, but means we can't actually use GPIO 0.
2219 */
2220 if (!rt5640->pdata.ldo1_en)
2221 rt5640->pdata.ldo1_en = -EINVAL;
2222 } else if (i2c->dev.of_node) {
2223 ret = rt5640_parse_dt(rt5640, i2c->dev.of_node);
2224 if (ret)
2225 return ret;
2226 } else
2227 rt5640->pdata.ldo1_en = -EINVAL;
2228
2229 rt5640->regmap = devm_regmap_init_i2c(i2c, &rt5640_regmap);
2230 if (IS_ERR(rt5640->regmap)) {
2231 ret = PTR_ERR(rt5640->regmap);
2232 dev_err(&i2c->dev, "Failed to allocate register map: %d\n",
2233 ret);
2234 return ret;
2235 }
2236
2237 if (gpio_is_valid(rt5640->pdata.ldo1_en)) {
2238 ret = devm_gpio_request_one(&i2c->dev, rt5640->pdata.ldo1_en,
2239 GPIOF_OUT_INIT_HIGH,
2240 "RT5640 LDO1_EN");
2241 if (ret < 0) {
2242 dev_err(&i2c->dev, "Failed to request LDO1_EN %d: %d\n",
2243 rt5640->pdata.ldo1_en, ret);
2244 return ret;
2245 }
2246 msleep(400);
2247 }
2248
2249 regmap_read(rt5640->regmap, RT5640_VENDOR_ID2, &val);
2250 if (val != RT5640_DEVICE_ID) {
2251 dev_err(&i2c->dev,
2252 "Device with ID register %x is not rt5640/39\n", val);
2253 return -ENODEV;
2254 }
2255
2256 regmap_write(rt5640->regmap, RT5640_RESET, 0);
2257
2258 ret = regmap_register_patch(rt5640->regmap, init_list,
2259 ARRAY_SIZE(init_list));
2260 if (ret != 0)
2261 dev_warn(&i2c->dev, "Failed to apply regmap patch: %d\n", ret);
2262
2263 if (rt5640->pdata.in1_diff)
2264 regmap_update_bits(rt5640->regmap, RT5640_IN1_IN2,
2265 RT5640_IN_DF1, RT5640_IN_DF1);
2266
2267 if (rt5640->pdata.in2_diff)
2268 regmap_update_bits(rt5640->regmap, RT5640_IN3_IN4,
2269 RT5640_IN_DF2, RT5640_IN_DF2);
2270
2271 if (rt5640->pdata.dmic_en) {
2272 regmap_update_bits(rt5640->regmap, RT5640_GPIO_CTRL1,
2273 RT5640_GP2_PIN_MASK, RT5640_GP2_PIN_DMIC1_SCL);
2274
2275 if (rt5640->pdata.dmic1_data_pin) {
2276 regmap_update_bits(rt5640->regmap, RT5640_DMIC,
2277 RT5640_DMIC_1_DP_MASK, RT5640_DMIC_1_DP_GPIO3);
2278 regmap_update_bits(rt5640->regmap, RT5640_GPIO_CTRL1,
2279 RT5640_GP3_PIN_MASK, RT5640_GP3_PIN_DMIC1_SDA);
2280 }
2281
2282 if (rt5640->pdata.dmic2_data_pin) {
2283 regmap_update_bits(rt5640->regmap, RT5640_DMIC,
2284 RT5640_DMIC_2_DP_MASK, RT5640_DMIC_2_DP_GPIO4);
2285 regmap_update_bits(rt5640->regmap, RT5640_GPIO_CTRL1,
2286 RT5640_GP4_PIN_MASK, RT5640_GP4_PIN_DMIC2_SDA);
2287 }
2288 }
2289
2290 rt5640->hp_mute = 1;
2291
2292 ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_rt5640,
2293 rt5640_dai, ARRAY_SIZE(rt5640_dai));
2294 if (ret < 0)
2295 goto err;
2296
2297 return 0;
2298 err:
2299 return ret;
2300 }
2301
2302 static int rt5640_i2c_remove(struct i2c_client *i2c)
2303 {
2304 snd_soc_unregister_codec(&i2c->dev);
2305
2306 return 0;
2307 }
2308
2309 static struct i2c_driver rt5640_i2c_driver = {
2310 .driver = {
2311 .name = "rt5640",
2312 .owner = THIS_MODULE,
2313 .acpi_match_table = ACPI_PTR(rt5640_acpi_match),
2314 .of_match_table = of_match_ptr(rt5640_of_match),
2315 },
2316 .probe = rt5640_i2c_probe,
2317 .remove = rt5640_i2c_remove,
2318 .id_table = rt5640_i2c_id,
2319 };
2320 module_i2c_driver(rt5640_i2c_driver);
2321
2322 MODULE_DESCRIPTION("ASoC RT5640/RT5639 driver");
2323 MODULE_AUTHOR("Johnny Hsu <johnnyhsu@realtek.com>");
2324 MODULE_LICENSE("GPL v2");
Linux kernel - Deliverables
This page took 0.099291 seconds and 6 git commands to generate.