2 * rt5640.c -- RT5640/RT5639 ALSA SoC audio codec driver
4 * Copyright 2011 Realtek Semiconductor Corp.
5 * Author: Johnny Hsu <johnnyhsu@realtek.com>
6 * Copyright (c) 2013, NVIDIA CORPORATION. All rights reserved.
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.
13 #include <linux/module.h>
14 #include <linux/moduleparam.h>
15 #include <linux/init.h>
16 #include <linux/delay.h>
18 #include <linux/gpio.h>
19 #include <linux/i2c.h>
20 #include <linux/regmap.h>
22 #include <linux/of_gpio.h>
23 #include <linux/platform_device.h>
24 #include <linux/spi/spi.h>
25 #include <linux/acpi.h>
26 #include <sound/core.h>
27 #include <sound/jack.h>
28 #include <sound/pcm.h>
29 #include <sound/pcm_params.h>
30 #include <sound/soc.h>
31 #include <sound/soc-dapm.h>
32 #include <sound/initval.h>
33 #include <sound/tlv.h>
38 #define RT5640_DEVICE_ID 0x6231
40 #define RT5640_PR_RANGE_BASE (0xff + 1)
41 #define RT5640_PR_SPACING 0x100
43 #define RT5640_PR_BASE (RT5640_PR_RANGE_BASE + (0 * RT5640_PR_SPACING))
45 static const struct regmap_range_cfg rt5640_ranges
[] = {
46 { .name
= "PR", .range_min
= RT5640_PR_BASE
,
47 .range_max
= RT5640_PR_BASE
+ 0xb4,
48 .selector_reg
= RT5640_PRIV_INDEX
,
49 .selector_mask
= 0xff,
50 .selector_shift
= 0x0,
51 .window_start
= RT5640_PRIV_DATA
,
55 static const struct reg_sequence init_list
[] = {
56 {RT5640_PR_BASE
+ 0x3d, 0x3600},
57 {RT5640_PR_BASE
+ 0x12, 0x0aa8},
58 {RT5640_PR_BASE
+ 0x14, 0x0aaa},
59 {RT5640_PR_BASE
+ 0x20, 0x6110},
60 {RT5640_PR_BASE
+ 0x21, 0xe0e0},
61 {RT5640_PR_BASE
+ 0x23, 0x1804},
64 static const struct reg_default rt5640_reg
[] = {
170 static int rt5640_reset(struct snd_soc_component
*component
)
172 return snd_soc_component_write(component
, RT5640_RESET
, 0);
175 static bool rt5640_volatile_register(struct device
*dev
, unsigned int reg
)
179 for (i
= 0; i
< ARRAY_SIZE(rt5640_ranges
); i
++)
180 if ((reg
>= rt5640_ranges
[i
].window_start
&&
181 reg
<= rt5640_ranges
[i
].window_start
+
182 rt5640_ranges
[i
].window_len
) ||
183 (reg
>= rt5640_ranges
[i
].range_min
&&
184 reg
<= rt5640_ranges
[i
].range_max
))
190 case RT5640_EQ_CTRL1
:
191 case RT5640_DRC_AGC_1
:
192 case RT5640_ANC_CTRL1
:
193 case RT5640_IRQ_CTRL2
:
194 case RT5640_INT_IRQ_ST
:
195 case RT5640_DSP_CTRL2
:
196 case RT5640_DSP_CTRL3
:
197 case RT5640_PRIV_INDEX
:
198 case RT5640_PRIV_DATA
:
199 case RT5640_PGM_REG_ARR1
:
200 case RT5640_PGM_REG_ARR3
:
201 case RT5640_VENDOR_ID
:
202 case RT5640_VENDOR_ID1
:
203 case RT5640_VENDOR_ID2
:
210 static bool rt5640_readable_register(struct device
*dev
, unsigned int reg
)
214 for (i
= 0; i
< ARRAY_SIZE(rt5640_ranges
); i
++)
215 if ((reg
>= rt5640_ranges
[i
].window_start
&&
216 reg
<= rt5640_ranges
[i
].window_start
+
217 rt5640_ranges
[i
].window_len
) ||
218 (reg
>= rt5640_ranges
[i
].range_min
&&
219 reg
<= rt5640_ranges
[i
].range_max
))
227 case RT5640_MONO_OUT
:
230 case RT5640_INL_INR_VOL
:
231 case RT5640_DAC1_DIG_VOL
:
232 case RT5640_DAC2_DIG_VOL
:
233 case RT5640_DAC2_CTRL
:
234 case RT5640_ADC_DIG_VOL
:
235 case RT5640_ADC_DATA
:
236 case RT5640_ADC_BST_VOL
:
237 case RT5640_STO_ADC_MIXER
:
238 case RT5640_MONO_ADC_MIXER
:
239 case RT5640_AD_DA_MIXER
:
240 case RT5640_STO_DAC_MIXER
:
241 case RT5640_MONO_DAC_MIXER
:
242 case RT5640_DIG_MIXER
:
243 case RT5640_DSP_PATH1
:
244 case RT5640_DSP_PATH2
:
245 case RT5640_DIG_INF_DATA
:
246 case RT5640_REC_L1_MIXER
:
247 case RT5640_REC_L2_MIXER
:
248 case RT5640_REC_R1_MIXER
:
249 case RT5640_REC_R2_MIXER
:
250 case RT5640_HPO_MIXER
:
251 case RT5640_SPK_L_MIXER
:
252 case RT5640_SPK_R_MIXER
:
253 case RT5640_SPO_L_MIXER
:
254 case RT5640_SPO_R_MIXER
:
255 case RT5640_SPO_CLSD_RATIO
:
256 case RT5640_MONO_MIXER
:
257 case RT5640_OUT_L1_MIXER
:
258 case RT5640_OUT_L2_MIXER
:
259 case RT5640_OUT_L3_MIXER
:
260 case RT5640_OUT_R1_MIXER
:
261 case RT5640_OUT_R2_MIXER
:
262 case RT5640_OUT_R3_MIXER
:
263 case RT5640_LOUT_MIXER
:
264 case RT5640_PWR_DIG1
:
265 case RT5640_PWR_DIG2
:
266 case RT5640_PWR_ANLG1
:
267 case RT5640_PWR_ANLG2
:
268 case RT5640_PWR_MIXER
:
270 case RT5640_PRIV_INDEX
:
271 case RT5640_PRIV_DATA
:
272 case RT5640_I2S1_SDP
:
273 case RT5640_I2S2_SDP
:
274 case RT5640_ADDA_CLK1
:
275 case RT5640_ADDA_CLK2
:
278 case RT5640_PLL_CTRL1
:
279 case RT5640_PLL_CTRL2
:
286 case RT5640_CLS_D_OVCD
:
287 case RT5640_CLS_D_OUT
:
288 case RT5640_DEPOP_M1
:
289 case RT5640_DEPOP_M2
:
290 case RT5640_DEPOP_M3
:
291 case RT5640_CHARGE_PUMP
:
292 case RT5640_PV_DET_SPK_G
:
294 case RT5640_EQ_CTRL1
:
295 case RT5640_EQ_CTRL2
:
296 case RT5640_WIND_FILTER
:
297 case RT5640_DRC_AGC_1
:
298 case RT5640_DRC_AGC_2
:
299 case RT5640_DRC_AGC_3
:
301 case RT5640_ANC_CTRL1
:
302 case RT5640_ANC_CTRL2
:
303 case RT5640_ANC_CTRL3
:
306 case RT5640_IRQ_CTRL1
:
307 case RT5640_IRQ_CTRL2
:
308 case RT5640_INT_IRQ_ST
:
309 case RT5640_GPIO_CTRL1
:
310 case RT5640_GPIO_CTRL2
:
311 case RT5640_GPIO_CTRL3
:
312 case RT5640_DSP_CTRL1
:
313 case RT5640_DSP_CTRL2
:
314 case RT5640_DSP_CTRL3
:
315 case RT5640_DSP_CTRL4
:
316 case RT5640_PGM_REG_ARR1
:
317 case RT5640_PGM_REG_ARR2
:
318 case RT5640_PGM_REG_ARR3
:
319 case RT5640_PGM_REG_ARR4
:
320 case RT5640_PGM_REG_ARR5
:
321 case RT5640_SCB_FUNC
:
322 case RT5640_SCB_CTRL
:
323 case RT5640_BASE_BACK
:
324 case RT5640_MP3_PLUS1
:
325 case RT5640_MP3_PLUS2
:
328 case RT5640_HP_CALIB_AMP_DET
:
329 case RT5640_HP_CALIB2
:
335 case RT5640_VENDOR_ID
:
336 case RT5640_VENDOR_ID1
:
337 case RT5640_VENDOR_ID2
:
344 static const DECLARE_TLV_DB_SCALE(out_vol_tlv
, -4650, 150, 0);
345 static const DECLARE_TLV_DB_SCALE(dac_vol_tlv
, -65625, 375, 0);
346 static const DECLARE_TLV_DB_SCALE(in_vol_tlv
, -3450, 150, 0);
347 static const DECLARE_TLV_DB_SCALE(adc_vol_tlv
, -17625, 375, 0);
348 static const DECLARE_TLV_DB_SCALE(adc_bst_tlv
, 0, 1200, 0);
350 /* {0, +20, +24, +30, +35, +40, +44, +50, +52} dB */
351 static const DECLARE_TLV_DB_RANGE(bst_tlv
,
352 0, 0, TLV_DB_SCALE_ITEM(0, 0, 0),
353 1, 1, TLV_DB_SCALE_ITEM(2000, 0, 0),
354 2, 2, TLV_DB_SCALE_ITEM(2400, 0, 0),
355 3, 5, TLV_DB_SCALE_ITEM(3000, 500, 0),
356 6, 6, TLV_DB_SCALE_ITEM(4400, 0, 0),
357 7, 7, TLV_DB_SCALE_ITEM(5000, 0, 0),
358 8, 8, TLV_DB_SCALE_ITEM(5200, 0, 0)
361 /* Interface data select */
362 static const char * const rt5640_data_select
[] = {
363 "Normal", "Swap", "left copy to right", "right copy to left"};
365 static SOC_ENUM_SINGLE_DECL(rt5640_if1_dac_enum
, RT5640_DIG_INF_DATA
,
366 RT5640_IF1_DAC_SEL_SFT
, rt5640_data_select
);
368 static SOC_ENUM_SINGLE_DECL(rt5640_if1_adc_enum
, RT5640_DIG_INF_DATA
,
369 RT5640_IF1_ADC_SEL_SFT
, rt5640_data_select
);
371 static SOC_ENUM_SINGLE_DECL(rt5640_if2_dac_enum
, RT5640_DIG_INF_DATA
,
372 RT5640_IF2_DAC_SEL_SFT
, rt5640_data_select
);
374 static SOC_ENUM_SINGLE_DECL(rt5640_if2_adc_enum
, RT5640_DIG_INF_DATA
,
375 RT5640_IF2_ADC_SEL_SFT
, rt5640_data_select
);
377 /* Class D speaker gain ratio */
378 static const char * const rt5640_clsd_spk_ratio
[] = {"1.66x", "1.83x", "1.94x",
379 "2x", "2.11x", "2.22x", "2.33x", "2.44x", "2.55x", "2.66x", "2.77x"};
381 static SOC_ENUM_SINGLE_DECL(rt5640_clsd_spk_ratio_enum
, RT5640_CLS_D_OUT
,
382 RT5640_CLSD_RATIO_SFT
, rt5640_clsd_spk_ratio
);
384 static const struct snd_kcontrol_new rt5640_snd_controls
[] = {
385 /* Speaker Output Volume */
386 SOC_DOUBLE("Speaker Channel Switch", RT5640_SPK_VOL
,
387 RT5640_VOL_L_SFT
, RT5640_VOL_R_SFT
, 1, 1),
388 SOC_DOUBLE_TLV("Speaker Playback Volume", RT5640_SPK_VOL
,
389 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
, 39, 1, out_vol_tlv
),
390 /* Headphone Output Volume */
391 SOC_DOUBLE("HP Channel Switch", RT5640_HP_VOL
,
392 RT5640_VOL_L_SFT
, RT5640_VOL_R_SFT
, 1, 1),
393 SOC_DOUBLE_TLV("HP Playback Volume", RT5640_HP_VOL
,
394 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
, 39, 1, out_vol_tlv
),
396 SOC_DOUBLE("OUT Playback Switch", RT5640_OUTPUT
,
397 RT5640_L_MUTE_SFT
, RT5640_R_MUTE_SFT
, 1, 1),
398 SOC_DOUBLE("OUT Channel Switch", RT5640_OUTPUT
,
399 RT5640_VOL_L_SFT
, RT5640_VOL_R_SFT
, 1, 1),
400 SOC_DOUBLE_TLV("OUT Playback Volume", RT5640_OUTPUT
,
401 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
, 39, 1, out_vol_tlv
),
403 /* DAC Digital Volume */
404 SOC_DOUBLE("DAC2 Playback Switch", RT5640_DAC2_CTRL
,
405 RT5640_M_DAC_L2_VOL_SFT
, RT5640_M_DAC_R2_VOL_SFT
, 1, 1),
406 SOC_DOUBLE_TLV("DAC1 Playback Volume", RT5640_DAC1_DIG_VOL
,
407 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
,
408 175, 0, dac_vol_tlv
),
409 /* IN1/IN2/IN3 Control */
410 SOC_SINGLE_TLV("IN1 Boost", RT5640_IN1_IN2
,
411 RT5640_BST_SFT1
, 8, 0, bst_tlv
),
412 SOC_SINGLE_TLV("IN2 Boost", RT5640_IN3_IN4
,
413 RT5640_BST_SFT2
, 8, 0, bst_tlv
),
414 SOC_SINGLE_TLV("IN3 Boost", RT5640_IN1_IN2
,
415 RT5640_BST_SFT2
, 8, 0, bst_tlv
),
417 /* INL/INR Volume Control */
418 SOC_DOUBLE_TLV("IN Capture Volume", RT5640_INL_INR_VOL
,
419 RT5640_INL_VOL_SFT
, RT5640_INR_VOL_SFT
,
421 /* ADC Digital Volume Control */
422 SOC_DOUBLE("ADC Capture Switch", RT5640_ADC_DIG_VOL
,
423 RT5640_L_MUTE_SFT
, RT5640_R_MUTE_SFT
, 1, 1),
424 SOC_DOUBLE_TLV("ADC Capture Volume", RT5640_ADC_DIG_VOL
,
425 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
,
426 127, 0, adc_vol_tlv
),
427 SOC_DOUBLE("Mono ADC Capture Switch", RT5640_DUMMY1
,
428 RT5640_M_MONO_ADC_L_SFT
, RT5640_M_MONO_ADC_R_SFT
, 1, 1),
429 SOC_DOUBLE_TLV("Mono ADC Capture Volume", RT5640_ADC_DATA
,
430 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
,
431 127, 0, adc_vol_tlv
),
432 /* ADC Boost Volume Control */
433 SOC_DOUBLE_TLV("ADC Boost Gain", RT5640_ADC_BST_VOL
,
434 RT5640_ADC_L_BST_SFT
, RT5640_ADC_R_BST_SFT
,
436 /* Class D speaker gain ratio */
437 SOC_ENUM("Class D SPK Ratio Control", rt5640_clsd_spk_ratio_enum
),
439 SOC_ENUM("ADC IF1 Data Switch", rt5640_if1_adc_enum
),
440 SOC_ENUM("DAC IF1 Data Switch", rt5640_if1_dac_enum
),
441 SOC_ENUM("ADC IF2 Data Switch", rt5640_if2_adc_enum
),
442 SOC_ENUM("DAC IF2 Data Switch", rt5640_if2_dac_enum
),
445 static const struct snd_kcontrol_new rt5640_specific_snd_controls
[] = {
446 /* MONO Output Control */
447 SOC_SINGLE("Mono Playback Switch", RT5640_MONO_OUT
, RT5640_L_MUTE_SFT
,
450 SOC_DOUBLE_TLV("Mono DAC Playback Volume", RT5640_DAC2_DIG_VOL
,
451 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
, 175, 0, dac_vol_tlv
),
455 * set_dmic_clk - Set parameter of dmic.
458 * @kcontrol: The kcontrol of this widget.
462 static int set_dmic_clk(struct snd_soc_dapm_widget
*w
,
463 struct snd_kcontrol
*kcontrol
, int event
)
465 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
466 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
469 rate
= rt5640
->sysclk
/ rl6231_get_pre_div(rt5640
->regmap
,
470 RT5640_ADDA_CLK1
, RT5640_I2S_PD1_SFT
);
471 idx
= rl6231_calc_dmic_clk(rate
);
473 dev_err(component
->dev
, "Failed to set DMIC clock\n");
475 snd_soc_component_update_bits(component
, RT5640_DMIC
, RT5640_DMIC_CLK_MASK
,
476 idx
<< RT5640_DMIC_CLK_SFT
);
480 static int is_using_asrc(struct snd_soc_dapm_widget
*source
,
481 struct snd_soc_dapm_widget
*sink
)
483 struct snd_soc_component
*component
= snd_soc_dapm_to_component(source
->dapm
);
484 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
486 if (!rt5640
->asrc_en
)
493 static const struct snd_kcontrol_new rt5640_sto_adc_l_mix
[] = {
494 SOC_DAPM_SINGLE("ADC1 Switch", RT5640_STO_ADC_MIXER
,
495 RT5640_M_ADC_L1_SFT
, 1, 1),
496 SOC_DAPM_SINGLE("ADC2 Switch", RT5640_STO_ADC_MIXER
,
497 RT5640_M_ADC_L2_SFT
, 1, 1),
500 static const struct snd_kcontrol_new rt5640_sto_adc_r_mix
[] = {
501 SOC_DAPM_SINGLE("ADC1 Switch", RT5640_STO_ADC_MIXER
,
502 RT5640_M_ADC_R1_SFT
, 1, 1),
503 SOC_DAPM_SINGLE("ADC2 Switch", RT5640_STO_ADC_MIXER
,
504 RT5640_M_ADC_R2_SFT
, 1, 1),
507 static const struct snd_kcontrol_new rt5640_mono_adc_l_mix
[] = {
508 SOC_DAPM_SINGLE("ADC1 Switch", RT5640_MONO_ADC_MIXER
,
509 RT5640_M_MONO_ADC_L1_SFT
, 1, 1),
510 SOC_DAPM_SINGLE("ADC2 Switch", RT5640_MONO_ADC_MIXER
,
511 RT5640_M_MONO_ADC_L2_SFT
, 1, 1),
514 static const struct snd_kcontrol_new rt5640_mono_adc_r_mix
[] = {
515 SOC_DAPM_SINGLE("ADC1 Switch", RT5640_MONO_ADC_MIXER
,
516 RT5640_M_MONO_ADC_R1_SFT
, 1, 1),
517 SOC_DAPM_SINGLE("ADC2 Switch", RT5640_MONO_ADC_MIXER
,
518 RT5640_M_MONO_ADC_R2_SFT
, 1, 1),
521 static const struct snd_kcontrol_new rt5640_dac_l_mix
[] = {
522 SOC_DAPM_SINGLE("Stereo ADC Switch", RT5640_AD_DA_MIXER
,
523 RT5640_M_ADCMIX_L_SFT
, 1, 1),
524 SOC_DAPM_SINGLE("INF1 Switch", RT5640_AD_DA_MIXER
,
525 RT5640_M_IF1_DAC_L_SFT
, 1, 1),
528 static const struct snd_kcontrol_new rt5640_dac_r_mix
[] = {
529 SOC_DAPM_SINGLE("Stereo ADC Switch", RT5640_AD_DA_MIXER
,
530 RT5640_M_ADCMIX_R_SFT
, 1, 1),
531 SOC_DAPM_SINGLE("INF1 Switch", RT5640_AD_DA_MIXER
,
532 RT5640_M_IF1_DAC_R_SFT
, 1, 1),
535 static const struct snd_kcontrol_new rt5640_sto_dac_l_mix
[] = {
536 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_STO_DAC_MIXER
,
537 RT5640_M_DAC_L1_SFT
, 1, 1),
538 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_STO_DAC_MIXER
,
539 RT5640_M_DAC_L2_SFT
, 1, 1),
540 SOC_DAPM_SINGLE("ANC Switch", RT5640_STO_DAC_MIXER
,
541 RT5640_M_ANC_DAC_L_SFT
, 1, 1),
544 static const struct snd_kcontrol_new rt5640_sto_dac_r_mix
[] = {
545 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_STO_DAC_MIXER
,
546 RT5640_M_DAC_R1_SFT
, 1, 1),
547 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_STO_DAC_MIXER
,
548 RT5640_M_DAC_R2_SFT
, 1, 1),
549 SOC_DAPM_SINGLE("ANC Switch", RT5640_STO_DAC_MIXER
,
550 RT5640_M_ANC_DAC_R_SFT
, 1, 1),
553 static const struct snd_kcontrol_new rt5639_sto_dac_l_mix
[] = {
554 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_STO_DAC_MIXER
,
555 RT5640_M_DAC_L1_SFT
, 1, 1),
556 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_STO_DAC_MIXER
,
557 RT5640_M_DAC_L2_SFT
, 1, 1),
560 static const struct snd_kcontrol_new rt5639_sto_dac_r_mix
[] = {
561 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_STO_DAC_MIXER
,
562 RT5640_M_DAC_R1_SFT
, 1, 1),
563 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_STO_DAC_MIXER
,
564 RT5640_M_DAC_R2_SFT
, 1, 1),
567 static const struct snd_kcontrol_new rt5640_mono_dac_l_mix
[] = {
568 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_MONO_DAC_MIXER
,
569 RT5640_M_DAC_L1_MONO_L_SFT
, 1, 1),
570 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_MONO_DAC_MIXER
,
571 RT5640_M_DAC_L2_MONO_L_SFT
, 1, 1),
572 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_MONO_DAC_MIXER
,
573 RT5640_M_DAC_R2_MONO_L_SFT
, 1, 1),
576 static const struct snd_kcontrol_new rt5640_mono_dac_r_mix
[] = {
577 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_MONO_DAC_MIXER
,
578 RT5640_M_DAC_R1_MONO_R_SFT
, 1, 1),
579 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_MONO_DAC_MIXER
,
580 RT5640_M_DAC_R2_MONO_R_SFT
, 1, 1),
581 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_MONO_DAC_MIXER
,
582 RT5640_M_DAC_L2_MONO_R_SFT
, 1, 1),
585 static const struct snd_kcontrol_new rt5640_dig_l_mix
[] = {
586 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_DIG_MIXER
,
587 RT5640_M_STO_L_DAC_L_SFT
, 1, 1),
588 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_DIG_MIXER
,
589 RT5640_M_DAC_L2_DAC_L_SFT
, 1, 1),
592 static const struct snd_kcontrol_new rt5640_dig_r_mix
[] = {
593 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_DIG_MIXER
,
594 RT5640_M_STO_R_DAC_R_SFT
, 1, 1),
595 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_DIG_MIXER
,
596 RT5640_M_DAC_R2_DAC_R_SFT
, 1, 1),
599 /* Analog Input Mixer */
600 static const struct snd_kcontrol_new rt5640_rec_l_mix
[] = {
601 SOC_DAPM_SINGLE("HPOL Switch", RT5640_REC_L2_MIXER
,
602 RT5640_M_HP_L_RM_L_SFT
, 1, 1),
603 SOC_DAPM_SINGLE("INL Switch", RT5640_REC_L2_MIXER
,
604 RT5640_M_IN_L_RM_L_SFT
, 1, 1),
605 SOC_DAPM_SINGLE("BST3 Switch", RT5640_REC_L2_MIXER
,
606 RT5640_M_BST2_RM_L_SFT
, 1, 1),
607 SOC_DAPM_SINGLE("BST2 Switch", RT5640_REC_L2_MIXER
,
608 RT5640_M_BST4_RM_L_SFT
, 1, 1),
609 SOC_DAPM_SINGLE("BST1 Switch", RT5640_REC_L2_MIXER
,
610 RT5640_M_BST1_RM_L_SFT
, 1, 1),
611 SOC_DAPM_SINGLE("OUT MIXL Switch", RT5640_REC_L2_MIXER
,
612 RT5640_M_OM_L_RM_L_SFT
, 1, 1),
615 static const struct snd_kcontrol_new rt5640_rec_r_mix
[] = {
616 SOC_DAPM_SINGLE("HPOR Switch", RT5640_REC_R2_MIXER
,
617 RT5640_M_HP_R_RM_R_SFT
, 1, 1),
618 SOC_DAPM_SINGLE("INR Switch", RT5640_REC_R2_MIXER
,
619 RT5640_M_IN_R_RM_R_SFT
, 1, 1),
620 SOC_DAPM_SINGLE("BST3 Switch", RT5640_REC_R2_MIXER
,
621 RT5640_M_BST2_RM_R_SFT
, 1, 1),
622 SOC_DAPM_SINGLE("BST2 Switch", RT5640_REC_R2_MIXER
,
623 RT5640_M_BST4_RM_R_SFT
, 1, 1),
624 SOC_DAPM_SINGLE("BST1 Switch", RT5640_REC_R2_MIXER
,
625 RT5640_M_BST1_RM_R_SFT
, 1, 1),
626 SOC_DAPM_SINGLE("OUT MIXR Switch", RT5640_REC_R2_MIXER
,
627 RT5640_M_OM_R_RM_R_SFT
, 1, 1),
630 /* Analog Output Mixer */
631 static const struct snd_kcontrol_new rt5640_spk_l_mix
[] = {
632 SOC_DAPM_SINGLE("REC MIXL Switch", RT5640_SPK_L_MIXER
,
633 RT5640_M_RM_L_SM_L_SFT
, 1, 1),
634 SOC_DAPM_SINGLE("INL Switch", RT5640_SPK_L_MIXER
,
635 RT5640_M_IN_L_SM_L_SFT
, 1, 1),
636 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_SPK_L_MIXER
,
637 RT5640_M_DAC_L1_SM_L_SFT
, 1, 1),
638 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_SPK_L_MIXER
,
639 RT5640_M_DAC_L2_SM_L_SFT
, 1, 1),
640 SOC_DAPM_SINGLE("OUT MIXL Switch", RT5640_SPK_L_MIXER
,
641 RT5640_M_OM_L_SM_L_SFT
, 1, 1),
644 static const struct snd_kcontrol_new rt5640_spk_r_mix
[] = {
645 SOC_DAPM_SINGLE("REC MIXR Switch", RT5640_SPK_R_MIXER
,
646 RT5640_M_RM_R_SM_R_SFT
, 1, 1),
647 SOC_DAPM_SINGLE("INR Switch", RT5640_SPK_R_MIXER
,
648 RT5640_M_IN_R_SM_R_SFT
, 1, 1),
649 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_SPK_R_MIXER
,
650 RT5640_M_DAC_R1_SM_R_SFT
, 1, 1),
651 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_SPK_R_MIXER
,
652 RT5640_M_DAC_R2_SM_R_SFT
, 1, 1),
653 SOC_DAPM_SINGLE("OUT MIXR Switch", RT5640_SPK_R_MIXER
,
654 RT5640_M_OM_R_SM_R_SFT
, 1, 1),
657 static const struct snd_kcontrol_new rt5640_out_l_mix
[] = {
658 SOC_DAPM_SINGLE("SPK MIXL Switch", RT5640_OUT_L3_MIXER
,
659 RT5640_M_SM_L_OM_L_SFT
, 1, 1),
660 SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_L3_MIXER
,
661 RT5640_M_BST1_OM_L_SFT
, 1, 1),
662 SOC_DAPM_SINGLE("INL Switch", RT5640_OUT_L3_MIXER
,
663 RT5640_M_IN_L_OM_L_SFT
, 1, 1),
664 SOC_DAPM_SINGLE("REC MIXL Switch", RT5640_OUT_L3_MIXER
,
665 RT5640_M_RM_L_OM_L_SFT
, 1, 1),
666 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_OUT_L3_MIXER
,
667 RT5640_M_DAC_R2_OM_L_SFT
, 1, 1),
668 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_OUT_L3_MIXER
,
669 RT5640_M_DAC_L2_OM_L_SFT
, 1, 1),
670 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_OUT_L3_MIXER
,
671 RT5640_M_DAC_L1_OM_L_SFT
, 1, 1),
674 static const struct snd_kcontrol_new rt5640_out_r_mix
[] = {
675 SOC_DAPM_SINGLE("SPK MIXR Switch", RT5640_OUT_R3_MIXER
,
676 RT5640_M_SM_L_OM_R_SFT
, 1, 1),
677 SOC_DAPM_SINGLE("BST2 Switch", RT5640_OUT_R3_MIXER
,
678 RT5640_M_BST4_OM_R_SFT
, 1, 1),
679 SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_R3_MIXER
,
680 RT5640_M_BST1_OM_R_SFT
, 1, 1),
681 SOC_DAPM_SINGLE("INR Switch", RT5640_OUT_R3_MIXER
,
682 RT5640_M_IN_R_OM_R_SFT
, 1, 1),
683 SOC_DAPM_SINGLE("REC MIXR Switch", RT5640_OUT_R3_MIXER
,
684 RT5640_M_RM_R_OM_R_SFT
, 1, 1),
685 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_OUT_R3_MIXER
,
686 RT5640_M_DAC_L2_OM_R_SFT
, 1, 1),
687 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_OUT_R3_MIXER
,
688 RT5640_M_DAC_R2_OM_R_SFT
, 1, 1),
689 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_OUT_R3_MIXER
,
690 RT5640_M_DAC_R1_OM_R_SFT
, 1, 1),
693 static const struct snd_kcontrol_new rt5639_out_l_mix
[] = {
694 SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_L3_MIXER
,
695 RT5640_M_BST1_OM_L_SFT
, 1, 1),
696 SOC_DAPM_SINGLE("INL Switch", RT5640_OUT_L3_MIXER
,
697 RT5640_M_IN_L_OM_L_SFT
, 1, 1),
698 SOC_DAPM_SINGLE("REC MIXL Switch", RT5640_OUT_L3_MIXER
,
699 RT5640_M_RM_L_OM_L_SFT
, 1, 1),
700 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_OUT_L3_MIXER
,
701 RT5640_M_DAC_L1_OM_L_SFT
, 1, 1),
704 static const struct snd_kcontrol_new rt5639_out_r_mix
[] = {
705 SOC_DAPM_SINGLE("BST2 Switch", RT5640_OUT_R3_MIXER
,
706 RT5640_M_BST4_OM_R_SFT
, 1, 1),
707 SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_R3_MIXER
,
708 RT5640_M_BST1_OM_R_SFT
, 1, 1),
709 SOC_DAPM_SINGLE("INR Switch", RT5640_OUT_R3_MIXER
,
710 RT5640_M_IN_R_OM_R_SFT
, 1, 1),
711 SOC_DAPM_SINGLE("REC MIXR Switch", RT5640_OUT_R3_MIXER
,
712 RT5640_M_RM_R_OM_R_SFT
, 1, 1),
713 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_OUT_R3_MIXER
,
714 RT5640_M_DAC_R1_OM_R_SFT
, 1, 1),
717 static const struct snd_kcontrol_new rt5640_spo_l_mix
[] = {
718 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_SPO_L_MIXER
,
719 RT5640_M_DAC_R1_SPM_L_SFT
, 1, 1),
720 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_SPO_L_MIXER
,
721 RT5640_M_DAC_L1_SPM_L_SFT
, 1, 1),
722 SOC_DAPM_SINGLE("SPKVOL R Switch", RT5640_SPO_L_MIXER
,
723 RT5640_M_SV_R_SPM_L_SFT
, 1, 1),
724 SOC_DAPM_SINGLE("SPKVOL L Switch", RT5640_SPO_L_MIXER
,
725 RT5640_M_SV_L_SPM_L_SFT
, 1, 1),
726 SOC_DAPM_SINGLE("BST1 Switch", RT5640_SPO_L_MIXER
,
727 RT5640_M_BST1_SPM_L_SFT
, 1, 1),
730 static const struct snd_kcontrol_new rt5640_spo_r_mix
[] = {
731 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_SPO_R_MIXER
,
732 RT5640_M_DAC_R1_SPM_R_SFT
, 1, 1),
733 SOC_DAPM_SINGLE("SPKVOL R Switch", RT5640_SPO_R_MIXER
,
734 RT5640_M_SV_R_SPM_R_SFT
, 1, 1),
735 SOC_DAPM_SINGLE("BST1 Switch", RT5640_SPO_R_MIXER
,
736 RT5640_M_BST1_SPM_R_SFT
, 1, 1),
739 static const struct snd_kcontrol_new rt5640_hpo_mix
[] = {
740 SOC_DAPM_SINGLE("HPO MIX DAC2 Switch", RT5640_HPO_MIXER
,
741 RT5640_M_DAC2_HM_SFT
, 1, 1),
742 SOC_DAPM_SINGLE("HPO MIX DAC1 Switch", RT5640_HPO_MIXER
,
743 RT5640_M_DAC1_HM_SFT
, 1, 1),
744 SOC_DAPM_SINGLE("HPO MIX HPVOL Switch", RT5640_HPO_MIXER
,
745 RT5640_M_HPVOL_HM_SFT
, 1, 1),
748 static const struct snd_kcontrol_new rt5639_hpo_mix
[] = {
749 SOC_DAPM_SINGLE("HPO MIX DAC1 Switch", RT5640_HPO_MIXER
,
750 RT5640_M_DAC1_HM_SFT
, 1, 1),
751 SOC_DAPM_SINGLE("HPO MIX HPVOL Switch", RT5640_HPO_MIXER
,
752 RT5640_M_HPVOL_HM_SFT
, 1, 1),
755 static const struct snd_kcontrol_new rt5640_lout_mix
[] = {
756 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_LOUT_MIXER
,
757 RT5640_M_DAC_L1_LM_SFT
, 1, 1),
758 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_LOUT_MIXER
,
759 RT5640_M_DAC_R1_LM_SFT
, 1, 1),
760 SOC_DAPM_SINGLE("OUTVOL L Switch", RT5640_LOUT_MIXER
,
761 RT5640_M_OV_L_LM_SFT
, 1, 1),
762 SOC_DAPM_SINGLE("OUTVOL R Switch", RT5640_LOUT_MIXER
,
763 RT5640_M_OV_R_LM_SFT
, 1, 1),
766 static const struct snd_kcontrol_new rt5640_mono_mix
[] = {
767 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_MONO_MIXER
,
768 RT5640_M_DAC_R2_MM_SFT
, 1, 1),
769 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_MONO_MIXER
,
770 RT5640_M_DAC_L2_MM_SFT
, 1, 1),
771 SOC_DAPM_SINGLE("OUTVOL R Switch", RT5640_MONO_MIXER
,
772 RT5640_M_OV_R_MM_SFT
, 1, 1),
773 SOC_DAPM_SINGLE("OUTVOL L Switch", RT5640_MONO_MIXER
,
774 RT5640_M_OV_L_MM_SFT
, 1, 1),
775 SOC_DAPM_SINGLE("BST1 Switch", RT5640_MONO_MIXER
,
776 RT5640_M_BST1_MM_SFT
, 1, 1),
779 static const struct snd_kcontrol_new spk_l_enable_control
=
780 SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_SPK_VOL
,
781 RT5640_L_MUTE_SFT
, 1, 1);
783 static const struct snd_kcontrol_new spk_r_enable_control
=
784 SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_SPK_VOL
,
785 RT5640_R_MUTE_SFT
, 1, 1);
787 static const struct snd_kcontrol_new hp_l_enable_control
=
788 SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_HP_VOL
,
789 RT5640_L_MUTE_SFT
, 1, 1);
791 static const struct snd_kcontrol_new hp_r_enable_control
=
792 SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_HP_VOL
,
793 RT5640_R_MUTE_SFT
, 1, 1);
795 /* Stereo ADC source */
796 static const char * const rt5640_stereo_adc1_src
[] = {
800 static SOC_ENUM_SINGLE_DECL(rt5640_stereo_adc1_enum
, RT5640_STO_ADC_MIXER
,
801 RT5640_ADC_1_SRC_SFT
, rt5640_stereo_adc1_src
);
803 static const struct snd_kcontrol_new rt5640_sto_adc_1_mux
=
804 SOC_DAPM_ENUM("Stereo ADC1 Mux", rt5640_stereo_adc1_enum
);
806 static const char * const rt5640_stereo_adc2_src
[] = {
807 "DMIC1", "DMIC2", "DIG MIX"
810 static SOC_ENUM_SINGLE_DECL(rt5640_stereo_adc2_enum
, RT5640_STO_ADC_MIXER
,
811 RT5640_ADC_2_SRC_SFT
, rt5640_stereo_adc2_src
);
813 static const struct snd_kcontrol_new rt5640_sto_adc_2_mux
=
814 SOC_DAPM_ENUM("Stereo ADC2 Mux", rt5640_stereo_adc2_enum
);
816 /* Mono ADC source */
817 static const char * const rt5640_mono_adc_l1_src
[] = {
818 "Mono DAC MIXL", "ADCL"
821 static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_l1_enum
, RT5640_MONO_ADC_MIXER
,
822 RT5640_MONO_ADC_L1_SRC_SFT
, rt5640_mono_adc_l1_src
);
824 static const struct snd_kcontrol_new rt5640_mono_adc_l1_mux
=
825 SOC_DAPM_ENUM("Mono ADC1 left source", rt5640_mono_adc_l1_enum
);
827 static const char * const rt5640_mono_adc_l2_src
[] = {
828 "DMIC L1", "DMIC L2", "Mono DAC MIXL"
831 static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_l2_enum
, RT5640_MONO_ADC_MIXER
,
832 RT5640_MONO_ADC_L2_SRC_SFT
, rt5640_mono_adc_l2_src
);
834 static const struct snd_kcontrol_new rt5640_mono_adc_l2_mux
=
835 SOC_DAPM_ENUM("Mono ADC2 left source", rt5640_mono_adc_l2_enum
);
837 static const char * const rt5640_mono_adc_r1_src
[] = {
838 "Mono DAC MIXR", "ADCR"
841 static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_r1_enum
, RT5640_MONO_ADC_MIXER
,
842 RT5640_MONO_ADC_R1_SRC_SFT
, rt5640_mono_adc_r1_src
);
844 static const struct snd_kcontrol_new rt5640_mono_adc_r1_mux
=
845 SOC_DAPM_ENUM("Mono ADC1 right source", rt5640_mono_adc_r1_enum
);
847 static const char * const rt5640_mono_adc_r2_src
[] = {
848 "DMIC R1", "DMIC R2", "Mono DAC MIXR"
851 static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_r2_enum
, RT5640_MONO_ADC_MIXER
,
852 RT5640_MONO_ADC_R2_SRC_SFT
, rt5640_mono_adc_r2_src
);
854 static const struct snd_kcontrol_new rt5640_mono_adc_r2_mux
=
855 SOC_DAPM_ENUM("Mono ADC2 right source", rt5640_mono_adc_r2_enum
);
857 /* DAC2 channel source */
858 static const char * const rt5640_dac_l2_src
[] = {
862 static int rt5640_dac_l2_values
[] = {
867 static SOC_VALUE_ENUM_SINGLE_DECL(rt5640_dac_l2_enum
,
868 RT5640_DSP_PATH2
, RT5640_DAC_L2_SEL_SFT
,
869 0x3, rt5640_dac_l2_src
, rt5640_dac_l2_values
);
871 static const struct snd_kcontrol_new rt5640_dac_l2_mux
=
872 SOC_DAPM_ENUM("DAC2 left channel source", rt5640_dac_l2_enum
);
874 static const char * const rt5640_dac_r2_src
[] = {
878 static int rt5640_dac_r2_values
[] = {
882 static SOC_VALUE_ENUM_SINGLE_DECL(rt5640_dac_r2_enum
,
883 RT5640_DSP_PATH2
, RT5640_DAC_R2_SEL_SFT
,
884 0x3, rt5640_dac_r2_src
, rt5640_dac_r2_values
);
886 static const struct snd_kcontrol_new rt5640_dac_r2_mux
=
887 SOC_DAPM_ENUM("DAC2 right channel source", rt5640_dac_r2_enum
);
889 /* digital interface and iis interface map */
890 static const char * const rt5640_dai_iis_map
[] = {
891 "1:1|2:2", "1:2|2:1", "1:1|2:1", "1:2|2:2"
894 static int rt5640_dai_iis_map_values
[] = {
901 static SOC_VALUE_ENUM_SINGLE_DECL(rt5640_dai_iis_map_enum
,
902 RT5640_I2S1_SDP
, RT5640_I2S_IF_SFT
,
903 0x7, rt5640_dai_iis_map
,
904 rt5640_dai_iis_map_values
);
906 static const struct snd_kcontrol_new rt5640_dai_mux
=
907 SOC_DAPM_ENUM("DAI select", rt5640_dai_iis_map_enum
);
910 static const char * const rt5640_sdi_sel
[] = {
914 static SOC_ENUM_SINGLE_DECL(rt5640_sdi_sel_enum
, RT5640_I2S2_SDP
,
915 RT5640_I2S2_SDI_SFT
, rt5640_sdi_sel
);
917 static const struct snd_kcontrol_new rt5640_sdi_mux
=
918 SOC_DAPM_ENUM("SDI select", rt5640_sdi_sel_enum
);
920 static void hp_amp_power_on(struct snd_soc_component
*component
)
922 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
924 /* depop parameters */
925 regmap_update_bits(rt5640
->regmap
, RT5640_PR_BASE
+
926 RT5640_CHPUMP_INT_REG1
, 0x0700, 0x0200);
927 regmap_update_bits(rt5640
->regmap
, RT5640_DEPOP_M2
,
928 RT5640_DEPOP_MASK
, RT5640_DEPOP_MAN
);
929 regmap_update_bits(rt5640
->regmap
, RT5640_DEPOP_M1
,
930 RT5640_HP_CP_MASK
| RT5640_HP_SG_MASK
| RT5640_HP_CB_MASK
,
931 RT5640_HP_CP_PU
| RT5640_HP_SG_DIS
| RT5640_HP_CB_PU
);
932 regmap_write(rt5640
->regmap
, RT5640_PR_BASE
+ RT5640_HP_DCC_INT1
,
934 /* headphone amp power on */
935 regmap_update_bits(rt5640
->regmap
, RT5640_PWR_ANLG1
,
936 RT5640_PWR_FV1
| RT5640_PWR_FV2
, 0);
937 regmap_update_bits(rt5640
->regmap
, RT5640_PWR_ANLG1
,
940 usleep_range(10000, 15000);
941 regmap_update_bits(rt5640
->regmap
, RT5640_PWR_ANLG1
,
942 RT5640_PWR_FV1
| RT5640_PWR_FV2
,
943 RT5640_PWR_FV1
| RT5640_PWR_FV2
);
946 static void rt5640_pmu_depop(struct snd_soc_component
*component
)
948 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
950 regmap_update_bits(rt5640
->regmap
, RT5640_DEPOP_M2
,
951 RT5640_DEPOP_MASK
| RT5640_DIG_DP_MASK
,
952 RT5640_DEPOP_AUTO
| RT5640_DIG_DP_EN
);
953 regmap_update_bits(rt5640
->regmap
, RT5640_CHARGE_PUMP
,
954 RT5640_PM_HP_MASK
, RT5640_PM_HP_HV
);
956 regmap_update_bits(rt5640
->regmap
, RT5640_DEPOP_M3
,
957 RT5640_CP_FQ1_MASK
| RT5640_CP_FQ2_MASK
| RT5640_CP_FQ3_MASK
,
958 (RT5640_CP_FQ_192_KHZ
<< RT5640_CP_FQ1_SFT
) |
959 (RT5640_CP_FQ_12_KHZ
<< RT5640_CP_FQ2_SFT
) |
960 (RT5640_CP_FQ_192_KHZ
<< RT5640_CP_FQ3_SFT
));
962 regmap_write(rt5640
->regmap
, RT5640_PR_BASE
+
963 RT5640_MAMP_INT_REG2
, 0x1c00);
964 regmap_update_bits(rt5640
->regmap
, RT5640_DEPOP_M1
,
965 RT5640_HP_CP_MASK
| RT5640_HP_SG_MASK
,
966 RT5640_HP_CP_PD
| RT5640_HP_SG_EN
);
967 regmap_update_bits(rt5640
->regmap
, RT5640_PR_BASE
+
968 RT5640_CHPUMP_INT_REG1
, 0x0700, 0x0400);
971 static int rt5640_hp_event(struct snd_soc_dapm_widget
*w
,
972 struct snd_kcontrol
*kcontrol
, int event
)
974 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
975 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
978 case SND_SOC_DAPM_POST_PMU
:
979 rt5640_pmu_depop(component
);
983 case SND_SOC_DAPM_PRE_PMD
:
995 static int rt5640_lout_event(struct snd_soc_dapm_widget
*w
,
996 struct snd_kcontrol
*kcontrol
, int event
)
998 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
1001 case SND_SOC_DAPM_POST_PMU
:
1002 hp_amp_power_on(component
);
1003 snd_soc_component_update_bits(component
, RT5640_PWR_ANLG1
,
1004 RT5640_PWR_LM
, RT5640_PWR_LM
);
1005 snd_soc_component_update_bits(component
, RT5640_OUTPUT
,
1006 RT5640_L_MUTE
| RT5640_R_MUTE
, 0);
1009 case SND_SOC_DAPM_PRE_PMD
:
1010 snd_soc_component_update_bits(component
, RT5640_OUTPUT
,
1011 RT5640_L_MUTE
| RT5640_R_MUTE
,
1012 RT5640_L_MUTE
| RT5640_R_MUTE
);
1013 snd_soc_component_update_bits(component
, RT5640_PWR_ANLG1
,
1024 static int rt5640_hp_power_event(struct snd_soc_dapm_widget
*w
,
1025 struct snd_kcontrol
*kcontrol
, int event
)
1027 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
1030 case SND_SOC_DAPM_POST_PMU
:
1031 hp_amp_power_on(component
);
1040 static int rt5640_hp_post_event(struct snd_soc_dapm_widget
*w
,
1041 struct snd_kcontrol
*kcontrol
, int event
)
1043 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
1044 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
1047 case SND_SOC_DAPM_POST_PMU
:
1048 if (!rt5640
->hp_mute
)
1060 static const struct snd_soc_dapm_widget rt5640_dapm_widgets
[] = {
1062 SND_SOC_DAPM_SUPPLY_S("Stereo Filter ASRC", 1, RT5640_ASRC_1
,
1064 SND_SOC_DAPM_SUPPLY_S("I2S2 Filter ASRC", 1, RT5640_ASRC_1
,
1066 SND_SOC_DAPM_SUPPLY_S("I2S2 ASRC", 1, RT5640_ASRC_1
,
1068 SND_SOC_DAPM_SUPPLY_S("DMIC1 ASRC", 1, RT5640_ASRC_1
,
1070 SND_SOC_DAPM_SUPPLY_S("DMIC2 ASRC", 1, RT5640_ASRC_1
,
1076 SND_SOC_DAPM_SUPPLY("LDO2", RT5640_PWR_ANLG1
,
1077 RT5640_PWR_LDO2_BIT
, 0, NULL
, 0),
1078 SND_SOC_DAPM_SUPPLY("MICBIAS1", RT5640_PWR_ANLG2
,
1079 RT5640_PWR_MB1_BIT
, 0, NULL
, 0),
1081 SND_SOC_DAPM_INPUT("DMIC1"),
1082 SND_SOC_DAPM_INPUT("DMIC2"),
1083 SND_SOC_DAPM_INPUT("IN1P"),
1084 SND_SOC_DAPM_INPUT("IN1N"),
1085 SND_SOC_DAPM_INPUT("IN2P"),
1086 SND_SOC_DAPM_INPUT("IN2N"),
1087 SND_SOC_DAPM_INPUT("IN3P"),
1088 SND_SOC_DAPM_INPUT("IN3N"),
1089 SND_SOC_DAPM_PGA("DMIC L1", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1090 SND_SOC_DAPM_PGA("DMIC R1", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1091 SND_SOC_DAPM_PGA("DMIC L2", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1092 SND_SOC_DAPM_PGA("DMIC R2", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1094 SND_SOC_DAPM_SUPPLY("DMIC CLK", SND_SOC_NOPM
, 0, 0,
1095 set_dmic_clk
, SND_SOC_DAPM_PRE_PMU
),
1096 SND_SOC_DAPM_SUPPLY("DMIC1 Power", RT5640_DMIC
, RT5640_DMIC_1_EN_SFT
, 0,
1098 SND_SOC_DAPM_SUPPLY("DMIC2 Power", RT5640_DMIC
, RT5640_DMIC_2_EN_SFT
, 0,
1101 SND_SOC_DAPM_PGA("BST1", RT5640_PWR_ANLG2
,
1102 RT5640_PWR_BST1_BIT
, 0, NULL
, 0),
1103 SND_SOC_DAPM_PGA("BST2", RT5640_PWR_ANLG2
,
1104 RT5640_PWR_BST4_BIT
, 0, NULL
, 0),
1105 SND_SOC_DAPM_PGA("BST3", RT5640_PWR_ANLG2
,
1106 RT5640_PWR_BST2_BIT
, 0, NULL
, 0),
1108 SND_SOC_DAPM_PGA("INL VOL", RT5640_PWR_VOL
,
1109 RT5640_PWR_IN_L_BIT
, 0, NULL
, 0),
1110 SND_SOC_DAPM_PGA("INR VOL", RT5640_PWR_VOL
,
1111 RT5640_PWR_IN_R_BIT
, 0, NULL
, 0),
1113 SND_SOC_DAPM_MIXER("RECMIXL", RT5640_PWR_MIXER
, RT5640_PWR_RM_L_BIT
, 0,
1114 rt5640_rec_l_mix
, ARRAY_SIZE(rt5640_rec_l_mix
)),
1115 SND_SOC_DAPM_MIXER("RECMIXR", RT5640_PWR_MIXER
, RT5640_PWR_RM_R_BIT
, 0,
1116 rt5640_rec_r_mix
, ARRAY_SIZE(rt5640_rec_r_mix
)),
1118 SND_SOC_DAPM_ADC("ADC L", NULL
, RT5640_PWR_DIG1
,
1119 RT5640_PWR_ADC_L_BIT
, 0),
1120 SND_SOC_DAPM_ADC("ADC R", NULL
, RT5640_PWR_DIG1
,
1121 RT5640_PWR_ADC_R_BIT
, 0),
1123 SND_SOC_DAPM_MUX("Stereo ADC L2 Mux", SND_SOC_NOPM
, 0, 0,
1124 &rt5640_sto_adc_2_mux
),
1125 SND_SOC_DAPM_MUX("Stereo ADC R2 Mux", SND_SOC_NOPM
, 0, 0,
1126 &rt5640_sto_adc_2_mux
),
1127 SND_SOC_DAPM_MUX("Stereo ADC L1 Mux", SND_SOC_NOPM
, 0, 0,
1128 &rt5640_sto_adc_1_mux
),
1129 SND_SOC_DAPM_MUX("Stereo ADC R1 Mux", SND_SOC_NOPM
, 0, 0,
1130 &rt5640_sto_adc_1_mux
),
1131 SND_SOC_DAPM_MUX("Mono ADC L2 Mux", SND_SOC_NOPM
, 0, 0,
1132 &rt5640_mono_adc_l2_mux
),
1133 SND_SOC_DAPM_MUX("Mono ADC L1 Mux", SND_SOC_NOPM
, 0, 0,
1134 &rt5640_mono_adc_l1_mux
),
1135 SND_SOC_DAPM_MUX("Mono ADC R1 Mux", SND_SOC_NOPM
, 0, 0,
1136 &rt5640_mono_adc_r1_mux
),
1137 SND_SOC_DAPM_MUX("Mono ADC R2 Mux", SND_SOC_NOPM
, 0, 0,
1138 &rt5640_mono_adc_r2_mux
),
1140 SND_SOC_DAPM_SUPPLY("Stereo Filter", RT5640_PWR_DIG2
,
1141 RT5640_PWR_ADC_SF_BIT
, 0, NULL
, 0),
1142 SND_SOC_DAPM_MIXER("Stereo ADC MIXL", SND_SOC_NOPM
, 0, 0,
1143 rt5640_sto_adc_l_mix
, ARRAY_SIZE(rt5640_sto_adc_l_mix
)),
1144 SND_SOC_DAPM_MIXER("Stereo ADC MIXR", SND_SOC_NOPM
, 0, 0,
1145 rt5640_sto_adc_r_mix
, ARRAY_SIZE(rt5640_sto_adc_r_mix
)),
1146 SND_SOC_DAPM_SUPPLY("Mono Left Filter", RT5640_PWR_DIG2
,
1147 RT5640_PWR_ADC_MF_L_BIT
, 0, NULL
, 0),
1148 SND_SOC_DAPM_MIXER("Mono ADC MIXL", SND_SOC_NOPM
, 0, 0,
1149 rt5640_mono_adc_l_mix
, ARRAY_SIZE(rt5640_mono_adc_l_mix
)),
1150 SND_SOC_DAPM_SUPPLY("Mono Right Filter", RT5640_PWR_DIG2
,
1151 RT5640_PWR_ADC_MF_R_BIT
, 0, NULL
, 0),
1152 SND_SOC_DAPM_MIXER("Mono ADC MIXR", SND_SOC_NOPM
, 0, 0,
1153 rt5640_mono_adc_r_mix
, ARRAY_SIZE(rt5640_mono_adc_r_mix
)),
1155 /* Digital Interface */
1156 SND_SOC_DAPM_SUPPLY("I2S1", RT5640_PWR_DIG1
,
1157 RT5640_PWR_I2S1_BIT
, 0, NULL
, 0),
1158 SND_SOC_DAPM_PGA("IF1 DAC", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1159 SND_SOC_DAPM_PGA("IF1 DAC L", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1160 SND_SOC_DAPM_PGA("IF1 DAC R", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1161 SND_SOC_DAPM_PGA("IF1 ADC", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1162 SND_SOC_DAPM_PGA("IF1 ADC L", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1163 SND_SOC_DAPM_PGA("IF1 ADC R", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1164 SND_SOC_DAPM_SUPPLY("I2S2", RT5640_PWR_DIG1
,
1165 RT5640_PWR_I2S2_BIT
, 0, NULL
, 0),
1166 SND_SOC_DAPM_PGA("IF2 DAC", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1167 SND_SOC_DAPM_PGA("IF2 DAC L", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1168 SND_SOC_DAPM_PGA("IF2 DAC R", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1169 SND_SOC_DAPM_PGA("IF2 ADC", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1170 SND_SOC_DAPM_PGA("IF2 ADC L", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1171 SND_SOC_DAPM_PGA("IF2 ADC R", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1172 /* Digital Interface Select */
1173 SND_SOC_DAPM_MUX("DAI1 RX Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1174 SND_SOC_DAPM_MUX("DAI1 TX Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1175 SND_SOC_DAPM_MUX("DAI1 IF1 Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1176 SND_SOC_DAPM_MUX("DAI1 IF2 Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1177 SND_SOC_DAPM_MUX("SDI1 TX Mux", SND_SOC_NOPM
, 0, 0, &rt5640_sdi_mux
),
1178 SND_SOC_DAPM_MUX("DAI2 RX Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1179 SND_SOC_DAPM_MUX("DAI2 TX Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1180 SND_SOC_DAPM_MUX("DAI2 IF1 Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1181 SND_SOC_DAPM_MUX("DAI2 IF2 Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1182 SND_SOC_DAPM_MUX("SDI2 TX Mux", SND_SOC_NOPM
, 0, 0, &rt5640_sdi_mux
),
1183 /* Audio Interface */
1184 SND_SOC_DAPM_AIF_IN("AIF1RX", "AIF1 Playback", 0, SND_SOC_NOPM
, 0, 0),
1185 SND_SOC_DAPM_AIF_OUT("AIF1TX", "AIF1 Capture", 0, SND_SOC_NOPM
, 0, 0),
1186 SND_SOC_DAPM_AIF_IN("AIF2RX", "AIF2 Playback", 0, SND_SOC_NOPM
, 0, 0),
1187 SND_SOC_DAPM_AIF_OUT("AIF2TX", "AIF2 Capture", 0, SND_SOC_NOPM
, 0, 0),
1190 /* DAC mixer before sound effect */
1191 SND_SOC_DAPM_MIXER("DAC MIXL", SND_SOC_NOPM
, 0, 0,
1192 rt5640_dac_l_mix
, ARRAY_SIZE(rt5640_dac_l_mix
)),
1193 SND_SOC_DAPM_MIXER("DAC MIXR", SND_SOC_NOPM
, 0, 0,
1194 rt5640_dac_r_mix
, ARRAY_SIZE(rt5640_dac_r_mix
)),
1197 SND_SOC_DAPM_MIXER("Mono DAC MIXL", SND_SOC_NOPM
, 0, 0,
1198 rt5640_mono_dac_l_mix
, ARRAY_SIZE(rt5640_mono_dac_l_mix
)),
1199 SND_SOC_DAPM_MIXER("Mono DAC MIXR", SND_SOC_NOPM
, 0, 0,
1200 rt5640_mono_dac_r_mix
, ARRAY_SIZE(rt5640_mono_dac_r_mix
)),
1201 SND_SOC_DAPM_MIXER("DIG MIXL", SND_SOC_NOPM
, 0, 0,
1202 rt5640_dig_l_mix
, ARRAY_SIZE(rt5640_dig_l_mix
)),
1203 SND_SOC_DAPM_MIXER("DIG MIXR", SND_SOC_NOPM
, 0, 0,
1204 rt5640_dig_r_mix
, ARRAY_SIZE(rt5640_dig_r_mix
)),
1206 SND_SOC_DAPM_DAC("DAC L1", NULL
, SND_SOC_NOPM
,
1208 SND_SOC_DAPM_DAC("DAC R1", NULL
, SND_SOC_NOPM
,
1210 SND_SOC_DAPM_SUPPLY("DAC L1 Power", RT5640_PWR_DIG1
,
1211 RT5640_PWR_DAC_L1_BIT
, 0, NULL
, 0),
1212 SND_SOC_DAPM_SUPPLY("DAC R1 Power", RT5640_PWR_DIG1
,
1213 RT5640_PWR_DAC_R1_BIT
, 0, NULL
, 0),
1214 SND_SOC_DAPM_SUPPLY("DAC L2 Power", RT5640_PWR_DIG1
,
1215 RT5640_PWR_DAC_L2_BIT
, 0, NULL
, 0),
1216 SND_SOC_DAPM_SUPPLY("DAC R2 Power", RT5640_PWR_DIG1
,
1217 RT5640_PWR_DAC_R2_BIT
, 0, NULL
, 0),
1219 SND_SOC_DAPM_MIXER("SPK MIXL", RT5640_PWR_MIXER
, RT5640_PWR_SM_L_BIT
,
1220 0, rt5640_spk_l_mix
, ARRAY_SIZE(rt5640_spk_l_mix
)),
1221 SND_SOC_DAPM_MIXER("SPK MIXR", RT5640_PWR_MIXER
, RT5640_PWR_SM_R_BIT
,
1222 0, rt5640_spk_r_mix
, ARRAY_SIZE(rt5640_spk_r_mix
)),
1224 SND_SOC_DAPM_PGA("SPKVOL L", RT5640_PWR_VOL
,
1225 RT5640_PWR_SV_L_BIT
, 0, NULL
, 0),
1226 SND_SOC_DAPM_PGA("SPKVOL R", RT5640_PWR_VOL
,
1227 RT5640_PWR_SV_R_BIT
, 0, NULL
, 0),
1228 SND_SOC_DAPM_PGA("OUTVOL L", RT5640_PWR_VOL
,
1229 RT5640_PWR_OV_L_BIT
, 0, NULL
, 0),
1230 SND_SOC_DAPM_PGA("OUTVOL R", RT5640_PWR_VOL
,
1231 RT5640_PWR_OV_R_BIT
, 0, NULL
, 0),
1232 SND_SOC_DAPM_PGA("HPOVOL L", RT5640_PWR_VOL
,
1233 RT5640_PWR_HV_L_BIT
, 0, NULL
, 0),
1234 SND_SOC_DAPM_PGA("HPOVOL R", RT5640_PWR_VOL
,
1235 RT5640_PWR_HV_R_BIT
, 0, NULL
, 0),
1236 /* SPO/HPO/LOUT/Mono Mixer */
1237 SND_SOC_DAPM_MIXER("SPOL MIX", SND_SOC_NOPM
, 0,
1238 0, rt5640_spo_l_mix
, ARRAY_SIZE(rt5640_spo_l_mix
)),
1239 SND_SOC_DAPM_MIXER("SPOR MIX", SND_SOC_NOPM
, 0,
1240 0, rt5640_spo_r_mix
, ARRAY_SIZE(rt5640_spo_r_mix
)),
1241 SND_SOC_DAPM_MIXER("LOUT MIX", SND_SOC_NOPM
, 0, 0,
1242 rt5640_lout_mix
, ARRAY_SIZE(rt5640_lout_mix
)),
1243 SND_SOC_DAPM_SUPPLY_S("Improve HP Amp Drv", 1, SND_SOC_NOPM
,
1244 0, 0, rt5640_hp_power_event
, SND_SOC_DAPM_POST_PMU
),
1245 SND_SOC_DAPM_PGA_S("HP Amp", 1, SND_SOC_NOPM
, 0, 0,
1247 SND_SOC_DAPM_PRE_PMD
| SND_SOC_DAPM_POST_PMU
),
1248 SND_SOC_DAPM_PGA_S("LOUT amp", 1, SND_SOC_NOPM
, 0, 0,
1250 SND_SOC_DAPM_PRE_PMD
| SND_SOC_DAPM_POST_PMU
),
1251 SND_SOC_DAPM_SUPPLY("HP L Amp", RT5640_PWR_ANLG1
,
1252 RT5640_PWR_HP_L_BIT
, 0, NULL
, 0),
1253 SND_SOC_DAPM_SUPPLY("HP R Amp", RT5640_PWR_ANLG1
,
1254 RT5640_PWR_HP_R_BIT
, 0, NULL
, 0),
1255 SND_SOC_DAPM_SUPPLY("Improve SPK Amp Drv", RT5640_PWR_DIG1
,
1256 RT5640_PWR_CLS_D_BIT
, 0, NULL
, 0),
1259 SND_SOC_DAPM_SWITCH("Speaker L Playback", SND_SOC_NOPM
, 0, 0,
1260 &spk_l_enable_control
),
1261 SND_SOC_DAPM_SWITCH("Speaker R Playback", SND_SOC_NOPM
, 0, 0,
1262 &spk_r_enable_control
),
1263 SND_SOC_DAPM_SWITCH("HP L Playback", SND_SOC_NOPM
, 0, 0,
1264 &hp_l_enable_control
),
1265 SND_SOC_DAPM_SWITCH("HP R Playback", SND_SOC_NOPM
, 0, 0,
1266 &hp_r_enable_control
),
1267 SND_SOC_DAPM_POST("HP Post", rt5640_hp_post_event
),
1269 SND_SOC_DAPM_OUTPUT("SPOLP"),
1270 SND_SOC_DAPM_OUTPUT("SPOLN"),
1271 SND_SOC_DAPM_OUTPUT("SPORP"),
1272 SND_SOC_DAPM_OUTPUT("SPORN"),
1273 SND_SOC_DAPM_OUTPUT("HPOL"),
1274 SND_SOC_DAPM_OUTPUT("HPOR"),
1275 SND_SOC_DAPM_OUTPUT("LOUTL"),
1276 SND_SOC_DAPM_OUTPUT("LOUTR"),
1279 static const struct snd_soc_dapm_widget rt5640_specific_dapm_widgets
[] = {
1281 SND_SOC_DAPM_PGA("Audio DSP", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1283 SND_SOC_DAPM_PGA("ANC", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1285 /* DAC2 channel Mux */
1286 SND_SOC_DAPM_MUX("DAC L2 Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dac_l2_mux
),
1287 SND_SOC_DAPM_MUX("DAC R2 Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dac_r2_mux
),
1289 SND_SOC_DAPM_MIXER("Stereo DAC MIXL", SND_SOC_NOPM
, 0, 0,
1290 rt5640_sto_dac_l_mix
, ARRAY_SIZE(rt5640_sto_dac_l_mix
)),
1291 SND_SOC_DAPM_MIXER("Stereo DAC MIXR", SND_SOC_NOPM
, 0, 0,
1292 rt5640_sto_dac_r_mix
, ARRAY_SIZE(rt5640_sto_dac_r_mix
)),
1294 SND_SOC_DAPM_DAC("DAC R2", NULL
, SND_SOC_NOPM
, 0,
1296 SND_SOC_DAPM_DAC("DAC L2", NULL
, SND_SOC_NOPM
, 0,
1299 SND_SOC_DAPM_MIXER("OUT MIXL", RT5640_PWR_MIXER
, RT5640_PWR_OM_L_BIT
,
1300 0, rt5640_out_l_mix
, ARRAY_SIZE(rt5640_out_l_mix
)),
1301 SND_SOC_DAPM_MIXER("OUT MIXR", RT5640_PWR_MIXER
, RT5640_PWR_OM_R_BIT
,
1302 0, rt5640_out_r_mix
, ARRAY_SIZE(rt5640_out_r_mix
)),
1304 SND_SOC_DAPM_MIXER("HPO MIX L", SND_SOC_NOPM
, 0, 0,
1305 rt5640_hpo_mix
, ARRAY_SIZE(rt5640_hpo_mix
)),
1306 SND_SOC_DAPM_MIXER("HPO MIX R", SND_SOC_NOPM
, 0, 0,
1307 rt5640_hpo_mix
, ARRAY_SIZE(rt5640_hpo_mix
)),
1309 SND_SOC_DAPM_MIXER("Mono MIX", RT5640_PWR_ANLG1
, RT5640_PWR_MM_BIT
, 0,
1310 rt5640_mono_mix
, ARRAY_SIZE(rt5640_mono_mix
)),
1311 SND_SOC_DAPM_SUPPLY("Improve MONO Amp Drv", RT5640_PWR_ANLG1
,
1312 RT5640_PWR_MA_BIT
, 0, NULL
, 0),
1314 SND_SOC_DAPM_OUTPUT("MONOP"),
1315 SND_SOC_DAPM_OUTPUT("MONON"),
1318 static const struct snd_soc_dapm_widget rt5639_specific_dapm_widgets
[] = {
1319 SND_SOC_DAPM_MIXER("Stereo DAC MIXL", SND_SOC_NOPM
, 0, 0,
1320 rt5639_sto_dac_l_mix
, ARRAY_SIZE(rt5639_sto_dac_l_mix
)),
1321 SND_SOC_DAPM_MIXER("Stereo DAC MIXR", SND_SOC_NOPM
, 0, 0,
1322 rt5639_sto_dac_r_mix
, ARRAY_SIZE(rt5639_sto_dac_r_mix
)),
1324 SND_SOC_DAPM_MIXER("OUT MIXL", RT5640_PWR_MIXER
, RT5640_PWR_OM_L_BIT
,
1325 0, rt5639_out_l_mix
, ARRAY_SIZE(rt5639_out_l_mix
)),
1326 SND_SOC_DAPM_MIXER("OUT MIXR", RT5640_PWR_MIXER
, RT5640_PWR_OM_R_BIT
,
1327 0, rt5639_out_r_mix
, ARRAY_SIZE(rt5639_out_r_mix
)),
1329 SND_SOC_DAPM_MIXER("HPO MIX L", SND_SOC_NOPM
, 0, 0,
1330 rt5639_hpo_mix
, ARRAY_SIZE(rt5639_hpo_mix
)),
1331 SND_SOC_DAPM_MIXER("HPO MIX R", SND_SOC_NOPM
, 0, 0,
1332 rt5639_hpo_mix
, ARRAY_SIZE(rt5639_hpo_mix
)),
1335 static const struct snd_soc_dapm_route rt5640_dapm_routes
[] = {
1336 { "I2S1", NULL
, "Stereo Filter ASRC", is_using_asrc
},
1337 { "I2S2", NULL
, "I2S2 ASRC", is_using_asrc
},
1338 { "I2S2", NULL
, "I2S2 Filter ASRC", is_using_asrc
},
1339 { "DMIC1", NULL
, "DMIC1 ASRC", is_using_asrc
},
1340 { "DMIC2", NULL
, "DMIC2 ASRC", is_using_asrc
},
1342 {"IN1P", NULL
, "LDO2"},
1343 {"IN2P", NULL
, "LDO2"},
1344 {"IN3P", NULL
, "LDO2"},
1346 {"DMIC L1", NULL
, "DMIC1"},
1347 {"DMIC R1", NULL
, "DMIC1"},
1348 {"DMIC L2", NULL
, "DMIC2"},
1349 {"DMIC R2", NULL
, "DMIC2"},
1351 {"BST1", NULL
, "IN1P"},
1352 {"BST1", NULL
, "IN1N"},
1353 {"BST2", NULL
, "IN2P"},
1354 {"BST2", NULL
, "IN2N"},
1355 {"BST3", NULL
, "IN3P"},
1356 {"BST3", NULL
, "IN3N"},
1358 {"INL VOL", NULL
, "IN2P"},
1359 {"INR VOL", NULL
, "IN2N"},
1361 {"RECMIXL", "HPOL Switch", "HPOL"},
1362 {"RECMIXL", "INL Switch", "INL VOL"},
1363 {"RECMIXL", "BST3 Switch", "BST3"},
1364 {"RECMIXL", "BST2 Switch", "BST2"},
1365 {"RECMIXL", "BST1 Switch", "BST1"},
1366 {"RECMIXL", "OUT MIXL Switch", "OUT MIXL"},
1368 {"RECMIXR", "HPOR Switch", "HPOR"},
1369 {"RECMIXR", "INR Switch", "INR VOL"},
1370 {"RECMIXR", "BST3 Switch", "BST3"},
1371 {"RECMIXR", "BST2 Switch", "BST2"},
1372 {"RECMIXR", "BST1 Switch", "BST1"},
1373 {"RECMIXR", "OUT MIXR Switch", "OUT MIXR"},
1375 {"ADC L", NULL
, "RECMIXL"},
1376 {"ADC R", NULL
, "RECMIXR"},
1378 {"DMIC L1", NULL
, "DMIC CLK"},
1379 {"DMIC L1", NULL
, "DMIC1 Power"},
1380 {"DMIC R1", NULL
, "DMIC CLK"},
1381 {"DMIC R1", NULL
, "DMIC1 Power"},
1382 {"DMIC L2", NULL
, "DMIC CLK"},
1383 {"DMIC L2", NULL
, "DMIC2 Power"},
1384 {"DMIC R2", NULL
, "DMIC CLK"},
1385 {"DMIC R2", NULL
, "DMIC2 Power"},
1387 {"Stereo ADC L2 Mux", "DMIC1", "DMIC L1"},
1388 {"Stereo ADC L2 Mux", "DMIC2", "DMIC L2"},
1389 {"Stereo ADC L2 Mux", "DIG MIX", "DIG MIXL"},
1390 {"Stereo ADC L1 Mux", "ADC", "ADC L"},
1391 {"Stereo ADC L1 Mux", "DIG MIX", "DIG MIXL"},
1393 {"Stereo ADC R1 Mux", "ADC", "ADC R"},
1394 {"Stereo ADC R1 Mux", "DIG MIX", "DIG MIXR"},
1395 {"Stereo ADC R2 Mux", "DMIC1", "DMIC R1"},
1396 {"Stereo ADC R2 Mux", "DMIC2", "DMIC R2"},
1397 {"Stereo ADC R2 Mux", "DIG MIX", "DIG MIXR"},
1399 {"Mono ADC L2 Mux", "DMIC L1", "DMIC L1"},
1400 {"Mono ADC L2 Mux", "DMIC L2", "DMIC L2"},
1401 {"Mono ADC L2 Mux", "Mono DAC MIXL", "Mono DAC MIXL"},
1402 {"Mono ADC L1 Mux", "Mono DAC MIXL", "Mono DAC MIXL"},
1403 {"Mono ADC L1 Mux", "ADCL", "ADC L"},
1405 {"Mono ADC R1 Mux", "Mono DAC MIXR", "Mono DAC MIXR"},
1406 {"Mono ADC R1 Mux", "ADCR", "ADC R"},
1407 {"Mono ADC R2 Mux", "DMIC R1", "DMIC R1"},
1408 {"Mono ADC R2 Mux", "DMIC R2", "DMIC R2"},
1409 {"Mono ADC R2 Mux", "Mono DAC MIXR", "Mono DAC MIXR"},
1411 {"Stereo ADC MIXL", "ADC1 Switch", "Stereo ADC L1 Mux"},
1412 {"Stereo ADC MIXL", "ADC2 Switch", "Stereo ADC L2 Mux"},
1413 {"Stereo ADC MIXL", NULL
, "Stereo Filter"},
1415 {"Stereo ADC MIXR", "ADC1 Switch", "Stereo ADC R1 Mux"},
1416 {"Stereo ADC MIXR", "ADC2 Switch", "Stereo ADC R2 Mux"},
1417 {"Stereo ADC MIXR", NULL
, "Stereo Filter"},
1419 {"Mono ADC MIXL", "ADC1 Switch", "Mono ADC L1 Mux"},
1420 {"Mono ADC MIXL", "ADC2 Switch", "Mono ADC L2 Mux"},
1421 {"Mono ADC MIXL", NULL
, "Mono Left Filter"},
1423 {"Mono ADC MIXR", "ADC1 Switch", "Mono ADC R1 Mux"},
1424 {"Mono ADC MIXR", "ADC2 Switch", "Mono ADC R2 Mux"},
1425 {"Mono ADC MIXR", NULL
, "Mono Right Filter"},
1427 {"IF2 ADC L", NULL
, "Mono ADC MIXL"},
1428 {"IF2 ADC R", NULL
, "Mono ADC MIXR"},
1429 {"IF1 ADC L", NULL
, "Stereo ADC MIXL"},
1430 {"IF1 ADC R", NULL
, "Stereo ADC MIXR"},
1432 {"IF1 ADC", NULL
, "I2S1"},
1433 {"IF1 ADC", NULL
, "IF1 ADC L"},
1434 {"IF1 ADC", NULL
, "IF1 ADC R"},
1435 {"IF2 ADC", NULL
, "I2S2"},
1436 {"IF2 ADC", NULL
, "IF2 ADC L"},
1437 {"IF2 ADC", NULL
, "IF2 ADC R"},
1439 {"DAI1 TX Mux", "1:1|2:2", "IF1 ADC"},
1440 {"DAI1 TX Mux", "1:2|2:1", "IF2 ADC"},
1441 {"DAI1 IF1 Mux", "1:1|2:1", "IF1 ADC"},
1442 {"DAI1 IF2 Mux", "1:1|2:1", "IF2 ADC"},
1443 {"SDI1 TX Mux", "IF1", "DAI1 IF1 Mux"},
1444 {"SDI1 TX Mux", "IF2", "DAI1 IF2 Mux"},
1446 {"DAI2 TX Mux", "1:2|2:1", "IF1 ADC"},
1447 {"DAI2 TX Mux", "1:1|2:2", "IF2 ADC"},
1448 {"DAI2 IF1 Mux", "1:2|2:2", "IF1 ADC"},
1449 {"DAI2 IF2 Mux", "1:2|2:2", "IF2 ADC"},
1450 {"SDI2 TX Mux", "IF1", "DAI2 IF1 Mux"},
1451 {"SDI2 TX Mux", "IF2", "DAI2 IF2 Mux"},
1453 {"AIF1TX", NULL
, "DAI1 TX Mux"},
1454 {"AIF1TX", NULL
, "SDI1 TX Mux"},
1455 {"AIF2TX", NULL
, "DAI2 TX Mux"},
1456 {"AIF2TX", NULL
, "SDI2 TX Mux"},
1458 {"DAI1 RX Mux", "1:1|2:2", "AIF1RX"},
1459 {"DAI1 RX Mux", "1:1|2:1", "AIF1RX"},
1460 {"DAI1 RX Mux", "1:2|2:1", "AIF2RX"},
1461 {"DAI1 RX Mux", "1:2|2:2", "AIF2RX"},
1463 {"DAI2 RX Mux", "1:2|2:1", "AIF1RX"},
1464 {"DAI2 RX Mux", "1:1|2:1", "AIF1RX"},
1465 {"DAI2 RX Mux", "1:1|2:2", "AIF2RX"},
1466 {"DAI2 RX Mux", "1:2|2:2", "AIF2RX"},
1468 {"IF1 DAC", NULL
, "I2S1"},
1469 {"IF1 DAC", NULL
, "DAI1 RX Mux"},
1470 {"IF2 DAC", NULL
, "I2S2"},
1471 {"IF2 DAC", NULL
, "DAI2 RX Mux"},
1473 {"IF1 DAC L", NULL
, "IF1 DAC"},
1474 {"IF1 DAC R", NULL
, "IF1 DAC"},
1475 {"IF2 DAC L", NULL
, "IF2 DAC"},
1476 {"IF2 DAC R", NULL
, "IF2 DAC"},
1478 {"DAC MIXL", "Stereo ADC Switch", "Stereo ADC MIXL"},
1479 {"DAC MIXL", "INF1 Switch", "IF1 DAC L"},
1480 {"DAC MIXL", NULL
, "DAC L1 Power"},
1481 {"DAC MIXR", "Stereo ADC Switch", "Stereo ADC MIXR"},
1482 {"DAC MIXR", "INF1 Switch", "IF1 DAC R"},
1483 {"DAC MIXR", NULL
, "DAC R1 Power"},
1485 {"Stereo DAC MIXL", "DAC L1 Switch", "DAC MIXL"},
1486 {"Stereo DAC MIXR", "DAC R1 Switch", "DAC MIXR"},
1488 {"Mono DAC MIXL", "DAC L1 Switch", "DAC MIXL"},
1489 {"Mono DAC MIXR", "DAC R1 Switch", "DAC MIXR"},
1491 {"DIG MIXL", "DAC L1 Switch", "DAC MIXL"},
1492 {"DIG MIXR", "DAC R1 Switch", "DAC MIXR"},
1494 {"DAC L1", NULL
, "Stereo DAC MIXL"},
1495 {"DAC L1", NULL
, "DAC L1 Power"},
1496 {"DAC R1", NULL
, "Stereo DAC MIXR"},
1497 {"DAC R1", NULL
, "DAC R1 Power"},
1499 {"SPK MIXL", "REC MIXL Switch", "RECMIXL"},
1500 {"SPK MIXL", "INL Switch", "INL VOL"},
1501 {"SPK MIXL", "DAC L1 Switch", "DAC L1"},
1502 {"SPK MIXL", "OUT MIXL Switch", "OUT MIXL"},
1503 {"SPK MIXR", "REC MIXR Switch", "RECMIXR"},
1504 {"SPK MIXR", "INR Switch", "INR VOL"},
1505 {"SPK MIXR", "DAC R1 Switch", "DAC R1"},
1506 {"SPK MIXR", "OUT MIXR Switch", "OUT MIXR"},
1508 {"OUT MIXL", "BST1 Switch", "BST1"},
1509 {"OUT MIXL", "INL Switch", "INL VOL"},
1510 {"OUT MIXL", "REC MIXL Switch", "RECMIXL"},
1511 {"OUT MIXL", "DAC L1 Switch", "DAC L1"},
1513 {"OUT MIXR", "BST2 Switch", "BST2"},
1514 {"OUT MIXR", "BST1 Switch", "BST1"},
1515 {"OUT MIXR", "INR Switch", "INR VOL"},
1516 {"OUT MIXR", "REC MIXR Switch", "RECMIXR"},
1517 {"OUT MIXR", "DAC R1 Switch", "DAC R1"},
1519 {"SPKVOL L", NULL
, "SPK MIXL"},
1520 {"SPKVOL R", NULL
, "SPK MIXR"},
1521 {"HPOVOL L", NULL
, "OUT MIXL"},
1522 {"HPOVOL R", NULL
, "OUT MIXR"},
1523 {"OUTVOL L", NULL
, "OUT MIXL"},
1524 {"OUTVOL R", NULL
, "OUT MIXR"},
1526 {"SPOL MIX", "DAC R1 Switch", "DAC R1"},
1527 {"SPOL MIX", "DAC L1 Switch", "DAC L1"},
1528 {"SPOL MIX", "SPKVOL R Switch", "SPKVOL R"},
1529 {"SPOL MIX", "SPKVOL L Switch", "SPKVOL L"},
1530 {"SPOL MIX", "BST1 Switch", "BST1"},
1531 {"SPOR MIX", "DAC R1 Switch", "DAC R1"},
1532 {"SPOR MIX", "SPKVOL R Switch", "SPKVOL R"},
1533 {"SPOR MIX", "BST1 Switch", "BST1"},
1535 {"HPO MIX L", "HPO MIX DAC1 Switch", "DAC L1"},
1536 {"HPO MIX L", "HPO MIX HPVOL Switch", "HPOVOL L"},
1537 {"HPO MIX L", NULL
, "HP L Amp"},
1538 {"HPO MIX R", "HPO MIX DAC1 Switch", "DAC R1"},
1539 {"HPO MIX R", "HPO MIX HPVOL Switch", "HPOVOL R"},
1540 {"HPO MIX R", NULL
, "HP R Amp"},
1542 {"LOUT MIX", "DAC L1 Switch", "DAC L1"},
1543 {"LOUT MIX", "DAC R1 Switch", "DAC R1"},
1544 {"LOUT MIX", "OUTVOL L Switch", "OUTVOL L"},
1545 {"LOUT MIX", "OUTVOL R Switch", "OUTVOL R"},
1547 {"HP Amp", NULL
, "HPO MIX L"},
1548 {"HP Amp", NULL
, "HPO MIX R"},
1550 {"Speaker L Playback", "Switch", "SPOL MIX"},
1551 {"Speaker R Playback", "Switch", "SPOR MIX"},
1552 {"SPOLP", NULL
, "Speaker L Playback"},
1553 {"SPOLN", NULL
, "Speaker L Playback"},
1554 {"SPORP", NULL
, "Speaker R Playback"},
1555 {"SPORN", NULL
, "Speaker R Playback"},
1557 {"SPOLP", NULL
, "Improve SPK Amp Drv"},
1558 {"SPOLN", NULL
, "Improve SPK Amp Drv"},
1559 {"SPORP", NULL
, "Improve SPK Amp Drv"},
1560 {"SPORN", NULL
, "Improve SPK Amp Drv"},
1562 {"HPOL", NULL
, "Improve HP Amp Drv"},
1563 {"HPOR", NULL
, "Improve HP Amp Drv"},
1565 {"HP L Playback", "Switch", "HP Amp"},
1566 {"HP R Playback", "Switch", "HP Amp"},
1567 {"HPOL", NULL
, "HP L Playback"},
1568 {"HPOR", NULL
, "HP R Playback"},
1570 {"LOUT amp", NULL
, "LOUT MIX"},
1571 {"LOUTL", NULL
, "LOUT amp"},
1572 {"LOUTR", NULL
, "LOUT amp"},
1575 static const struct snd_soc_dapm_route rt5640_specific_dapm_routes
[] = {
1576 {"ANC", NULL
, "Stereo ADC MIXL"},
1577 {"ANC", NULL
, "Stereo ADC MIXR"},
1579 {"Audio DSP", NULL
, "DAC MIXL"},
1580 {"Audio DSP", NULL
, "DAC MIXR"},
1582 {"DAC L2 Mux", "IF2", "IF2 DAC L"},
1583 {"DAC L2 Mux", "Base L/R", "Audio DSP"},
1584 {"DAC L2 Mux", NULL
, "DAC L2 Power"},
1585 {"DAC R2 Mux", "IF2", "IF2 DAC R"},
1586 {"DAC R2 Mux", NULL
, "DAC R2 Power"},
1588 {"Stereo DAC MIXL", "DAC L2 Switch", "DAC L2 Mux"},
1589 {"Stereo DAC MIXL", "ANC Switch", "ANC"},
1590 {"Stereo DAC MIXR", "DAC R2 Switch", "DAC R2 Mux"},
1591 {"Stereo DAC MIXR", "ANC Switch", "ANC"},
1593 {"Mono DAC MIXL", "DAC L2 Switch", "DAC L2 Mux"},
1594 {"Mono DAC MIXL", "DAC R2 Switch", "DAC R2 Mux"},
1596 {"Mono DAC MIXR", "DAC R2 Switch", "DAC R2 Mux"},
1597 {"Mono DAC MIXR", "DAC L2 Switch", "DAC L2 Mux"},
1599 {"DIG MIXR", "DAC R2 Switch", "DAC R2 Mux"},
1600 {"DIG MIXL", "DAC L2 Switch", "DAC L2 Mux"},
1602 {"DAC L2", NULL
, "Mono DAC MIXL"},
1603 {"DAC L2", NULL
, "DAC L2 Power"},
1604 {"DAC R2", NULL
, "Mono DAC MIXR"},
1605 {"DAC R2", NULL
, "DAC R2 Power"},
1607 {"SPK MIXL", "DAC L2 Switch", "DAC L2"},
1608 {"SPK MIXR", "DAC R2 Switch", "DAC R2"},
1610 {"OUT MIXL", "SPK MIXL Switch", "SPK MIXL"},
1611 {"OUT MIXR", "SPK MIXR Switch", "SPK MIXR"},
1613 {"OUT MIXL", "DAC R2 Switch", "DAC R2"},
1614 {"OUT MIXL", "DAC L2 Switch", "DAC L2"},
1616 {"OUT MIXR", "DAC L2 Switch", "DAC L2"},
1617 {"OUT MIXR", "DAC R2 Switch", "DAC R2"},
1619 {"HPO MIX L", "HPO MIX DAC2 Switch", "DAC L2"},
1620 {"HPO MIX R", "HPO MIX DAC2 Switch", "DAC R2"},
1622 {"Mono MIX", "DAC R2 Switch", "DAC R2"},
1623 {"Mono MIX", "DAC L2 Switch", "DAC L2"},
1624 {"Mono MIX", "OUTVOL R Switch", "OUTVOL R"},
1625 {"Mono MIX", "OUTVOL L Switch", "OUTVOL L"},
1626 {"Mono MIX", "BST1 Switch", "BST1"},
1628 {"MONOP", NULL
, "Mono MIX"},
1629 {"MONON", NULL
, "Mono MIX"},
1630 {"MONOP", NULL
, "Improve MONO Amp Drv"},
1633 static const struct snd_soc_dapm_route rt5639_specific_dapm_routes
[] = {
1634 {"Stereo DAC MIXL", "DAC L2 Switch", "IF2 DAC L"},
1635 {"Stereo DAC MIXR", "DAC R2 Switch", "IF2 DAC R"},
1637 {"Mono DAC MIXL", "DAC L2 Switch", "IF2 DAC L"},
1638 {"Mono DAC MIXL", "DAC R2 Switch", "IF2 DAC R"},
1640 {"Mono DAC MIXR", "DAC R2 Switch", "IF2 DAC R"},
1641 {"Mono DAC MIXR", "DAC L2 Switch", "IF2 DAC L"},
1643 {"DIG MIXL", "DAC L2 Switch", "IF2 DAC L"},
1644 {"DIG MIXR", "DAC R2 Switch", "IF2 DAC R"},
1646 {"IF2 DAC L", NULL
, "DAC L2 Power"},
1647 {"IF2 DAC R", NULL
, "DAC R2 Power"},
1650 static int get_sdp_info(struct snd_soc_component
*component
, int dai_id
)
1654 if (component
== NULL
)
1657 val
= snd_soc_component_read32(component
, RT5640_I2S1_SDP
);
1658 val
= (val
& RT5640_I2S_IF_MASK
) >> RT5640_I2S_IF_SFT
;
1664 ret
|= RT5640_U_IF1
;
1667 ret
|= RT5640_U_IF1
;
1670 ret
|= RT5640_U_IF2
;
1679 ret
|= RT5640_U_IF1
;
1682 ret
|= RT5640_U_IF1
;
1685 ret
|= RT5640_U_IF2
;
1698 static int rt5640_hw_params(struct snd_pcm_substream
*substream
,
1699 struct snd_pcm_hw_params
*params
, struct snd_soc_dai
*dai
)
1701 struct snd_soc_component
*component
= dai
->component
;
1702 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
1703 unsigned int val_len
= 0, val_clk
, mask_clk
;
1704 int dai_sel
, pre_div
, bclk_ms
, frame_size
;
1706 rt5640
->lrck
[dai
->id
] = params_rate(params
);
1707 pre_div
= rl6231_get_clk_info(rt5640
->sysclk
, rt5640
->lrck
[dai
->id
]);
1709 dev_err(component
->dev
, "Unsupported clock setting %d for DAI %d\n",
1710 rt5640
->lrck
[dai
->id
], dai
->id
);
1713 frame_size
= snd_soc_params_to_frame_size(params
);
1714 if (frame_size
< 0) {
1715 dev_err(component
->dev
, "Unsupported frame size: %d\n", frame_size
);
1718 if (frame_size
> 32)
1722 rt5640
->bclk
[dai
->id
] = rt5640
->lrck
[dai
->id
] * (32 << bclk_ms
);
1724 dev_dbg(dai
->dev
, "bclk is %dHz and lrck is %dHz\n",
1725 rt5640
->bclk
[dai
->id
], rt5640
->lrck
[dai
->id
]);
1726 dev_dbg(dai
->dev
, "bclk_ms is %d and pre_div is %d for iis %d\n",
1727 bclk_ms
, pre_div
, dai
->id
);
1729 switch (params_width(params
)) {
1733 val_len
|= RT5640_I2S_DL_20
;
1736 val_len
|= RT5640_I2S_DL_24
;
1739 val_len
|= RT5640_I2S_DL_8
;
1745 dai_sel
= get_sdp_info(component
, dai
->id
);
1747 dev_err(component
->dev
, "Failed to get sdp info: %d\n", dai_sel
);
1750 if (dai_sel
& RT5640_U_IF1
) {
1751 mask_clk
= RT5640_I2S_BCLK_MS1_MASK
| RT5640_I2S_PD1_MASK
;
1752 val_clk
= bclk_ms
<< RT5640_I2S_BCLK_MS1_SFT
|
1753 pre_div
<< RT5640_I2S_PD1_SFT
;
1754 snd_soc_component_update_bits(component
, RT5640_I2S1_SDP
,
1755 RT5640_I2S_DL_MASK
, val_len
);
1756 snd_soc_component_update_bits(component
, RT5640_ADDA_CLK1
, mask_clk
, val_clk
);
1758 if (dai_sel
& RT5640_U_IF2
) {
1759 mask_clk
= RT5640_I2S_BCLK_MS2_MASK
| RT5640_I2S_PD2_MASK
;
1760 val_clk
= bclk_ms
<< RT5640_I2S_BCLK_MS2_SFT
|
1761 pre_div
<< RT5640_I2S_PD2_SFT
;
1762 snd_soc_component_update_bits(component
, RT5640_I2S2_SDP
,
1763 RT5640_I2S_DL_MASK
, val_len
);
1764 snd_soc_component_update_bits(component
, RT5640_ADDA_CLK1
, mask_clk
, val_clk
);
1770 static int rt5640_set_dai_fmt(struct snd_soc_dai
*dai
, unsigned int fmt
)
1772 struct snd_soc_component
*component
= dai
->component
;
1773 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
1774 unsigned int reg_val
= 0;
1777 switch (fmt
& SND_SOC_DAIFMT_MASTER_MASK
) {
1778 case SND_SOC_DAIFMT_CBM_CFM
:
1779 rt5640
->master
[dai
->id
] = 1;
1781 case SND_SOC_DAIFMT_CBS_CFS
:
1782 reg_val
|= RT5640_I2S_MS_S
;
1783 rt5640
->master
[dai
->id
] = 0;
1789 switch (fmt
& SND_SOC_DAIFMT_INV_MASK
) {
1790 case SND_SOC_DAIFMT_NB_NF
:
1792 case SND_SOC_DAIFMT_IB_NF
:
1793 reg_val
|= RT5640_I2S_BP_INV
;
1799 switch (fmt
& SND_SOC_DAIFMT_FORMAT_MASK
) {
1800 case SND_SOC_DAIFMT_I2S
:
1802 case SND_SOC_DAIFMT_LEFT_J
:
1803 reg_val
|= RT5640_I2S_DF_LEFT
;
1805 case SND_SOC_DAIFMT_DSP_A
:
1806 reg_val
|= RT5640_I2S_DF_PCM_A
;
1808 case SND_SOC_DAIFMT_DSP_B
:
1809 reg_val
|= RT5640_I2S_DF_PCM_B
;
1815 dai_sel
= get_sdp_info(component
, dai
->id
);
1817 dev_err(component
->dev
, "Failed to get sdp info: %d\n", dai_sel
);
1820 if (dai_sel
& RT5640_U_IF1
) {
1821 snd_soc_component_update_bits(component
, RT5640_I2S1_SDP
,
1822 RT5640_I2S_MS_MASK
| RT5640_I2S_BP_MASK
|
1823 RT5640_I2S_DF_MASK
, reg_val
);
1825 if (dai_sel
& RT5640_U_IF2
) {
1826 snd_soc_component_update_bits(component
, RT5640_I2S2_SDP
,
1827 RT5640_I2S_MS_MASK
| RT5640_I2S_BP_MASK
|
1828 RT5640_I2S_DF_MASK
, reg_val
);
1834 static int rt5640_set_dai_sysclk(struct snd_soc_dai
*dai
,
1835 int clk_id
, unsigned int freq
, int dir
)
1837 struct snd_soc_component
*component
= dai
->component
;
1838 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
1839 unsigned int reg_val
= 0;
1840 unsigned int pll_bit
= 0;
1842 if (freq
== rt5640
->sysclk
&& clk_id
== rt5640
->sysclk_src
)
1846 case RT5640_SCLK_S_MCLK
:
1847 reg_val
|= RT5640_SCLK_SRC_MCLK
;
1849 case RT5640_SCLK_S_PLL1
:
1850 reg_val
|= RT5640_SCLK_SRC_PLL1
;
1851 pll_bit
|= RT5640_PWR_PLL
;
1853 case RT5640_SCLK_S_RCCLK
:
1854 reg_val
|= RT5640_SCLK_SRC_RCCLK
;
1857 dev_err(component
->dev
, "Invalid clock id (%d)\n", clk_id
);
1860 snd_soc_component_update_bits(component
, RT5640_PWR_ANLG2
,
1861 RT5640_PWR_PLL
, pll_bit
);
1862 snd_soc_component_update_bits(component
, RT5640_GLB_CLK
,
1863 RT5640_SCLK_SRC_MASK
, reg_val
);
1864 rt5640
->sysclk
= freq
;
1865 rt5640
->sysclk_src
= clk_id
;
1867 dev_dbg(dai
->dev
, "Sysclk is %dHz and clock id is %d\n", freq
, clk_id
);
1871 static int rt5640_set_dai_pll(struct snd_soc_dai
*dai
, int pll_id
, int source
,
1872 unsigned int freq_in
, unsigned int freq_out
)
1874 struct snd_soc_component
*component
= dai
->component
;
1875 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
1876 struct rl6231_pll_code pll_code
;
1879 if (source
== rt5640
->pll_src
&& freq_in
== rt5640
->pll_in
&&
1880 freq_out
== rt5640
->pll_out
)
1883 if (!freq_in
|| !freq_out
) {
1884 dev_dbg(component
->dev
, "PLL disabled\n");
1887 rt5640
->pll_out
= 0;
1888 snd_soc_component_update_bits(component
, RT5640_GLB_CLK
,
1889 RT5640_SCLK_SRC_MASK
, RT5640_SCLK_SRC_MCLK
);
1894 case RT5640_PLL1_S_MCLK
:
1895 snd_soc_component_update_bits(component
, RT5640_GLB_CLK
,
1896 RT5640_PLL1_SRC_MASK
, RT5640_PLL1_SRC_MCLK
);
1898 case RT5640_PLL1_S_BCLK1
:
1899 snd_soc_component_update_bits(component
, RT5640_GLB_CLK
,
1900 RT5640_PLL1_SRC_MASK
, RT5640_PLL1_SRC_BCLK1
);
1902 case RT5640_PLL1_S_BCLK2
:
1903 snd_soc_component_update_bits(component
, RT5640_GLB_CLK
,
1904 RT5640_PLL1_SRC_MASK
, RT5640_PLL1_SRC_BCLK2
);
1907 dev_err(component
->dev
, "Unknown PLL source %d\n", source
);
1911 ret
= rl6231_pll_calc(freq_in
, freq_out
, &pll_code
);
1913 dev_err(component
->dev
, "Unsupport input clock %d\n", freq_in
);
1917 dev_dbg(component
->dev
, "bypass=%d m=%d n=%d k=%d\n",
1918 pll_code
.m_bp
, (pll_code
.m_bp
? 0 : pll_code
.m_code
),
1919 pll_code
.n_code
, pll_code
.k_code
);
1921 snd_soc_component_write(component
, RT5640_PLL_CTRL1
,
1922 pll_code
.n_code
<< RT5640_PLL_N_SFT
| pll_code
.k_code
);
1923 snd_soc_component_write(component
, RT5640_PLL_CTRL2
,
1924 (pll_code
.m_bp
? 0 : pll_code
.m_code
) << RT5640_PLL_M_SFT
|
1925 pll_code
.m_bp
<< RT5640_PLL_M_BP_SFT
);
1927 rt5640
->pll_in
= freq_in
;
1928 rt5640
->pll_out
= freq_out
;
1929 rt5640
->pll_src
= source
;
1934 static int rt5640_set_bias_level(struct snd_soc_component
*component
,
1935 enum snd_soc_bias_level level
)
1937 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
1941 case SND_SOC_BIAS_ON
:
1944 case SND_SOC_BIAS_PREPARE
:
1946 * SND_SOC_BIAS_PREPARE is called while preparing for a
1947 * transition to ON or away from ON. If current bias_level
1948 * is SND_SOC_BIAS_ON, then it is preparing for a transition
1949 * away from ON. Disable the clock in that case, otherwise
1952 if (IS_ERR(rt5640
->mclk
))
1955 if (snd_soc_component_get_bias_level(component
) == SND_SOC_BIAS_ON
) {
1956 clk_disable_unprepare(rt5640
->mclk
);
1958 ret
= clk_prepare_enable(rt5640
->mclk
);
1964 case SND_SOC_BIAS_STANDBY
:
1965 if (SND_SOC_BIAS_OFF
== snd_soc_component_get_bias_level(component
)) {
1966 snd_soc_component_update_bits(component
, RT5640_PWR_ANLG1
,
1967 RT5640_PWR_VREF1
| RT5640_PWR_MB
|
1968 RT5640_PWR_BG
| RT5640_PWR_VREF2
,
1969 RT5640_PWR_VREF1
| RT5640_PWR_MB
|
1970 RT5640_PWR_BG
| RT5640_PWR_VREF2
);
1971 usleep_range(10000, 15000);
1972 snd_soc_component_update_bits(component
, RT5640_PWR_ANLG1
,
1973 RT5640_PWR_FV1
| RT5640_PWR_FV2
,
1974 RT5640_PWR_FV1
| RT5640_PWR_FV2
);
1975 snd_soc_component_update_bits(component
, RT5640_DUMMY1
,
1977 snd_soc_component_update_bits(component
, RT5640_MICBIAS
,
1982 case SND_SOC_BIAS_OFF
:
1983 snd_soc_component_write(component
, RT5640_DEPOP_M1
, 0x0004);
1984 snd_soc_component_write(component
, RT5640_DEPOP_M2
, 0x1100);
1985 snd_soc_component_update_bits(component
, RT5640_DUMMY1
, 0x1, 0);
1986 snd_soc_component_write(component
, RT5640_PWR_DIG1
, 0x0000);
1987 snd_soc_component_write(component
, RT5640_PWR_DIG2
, 0x0000);
1988 snd_soc_component_write(component
, RT5640_PWR_VOL
, 0x0000);
1989 snd_soc_component_write(component
, RT5640_PWR_MIXER
, 0x0000);
1990 snd_soc_component_write(component
, RT5640_PWR_ANLG1
, 0x0000);
1991 snd_soc_component_write(component
, RT5640_PWR_ANLG2
, 0x0000);
2001 int rt5640_dmic_enable(struct snd_soc_component
*component
,
2002 bool dmic1_data_pin
, bool dmic2_data_pin
)
2004 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2006 regmap_update_bits(rt5640
->regmap
, RT5640_GPIO_CTRL1
,
2007 RT5640_GP2_PIN_MASK
, RT5640_GP2_PIN_DMIC1_SCL
);
2009 if (dmic1_data_pin
) {
2010 regmap_update_bits(rt5640
->regmap
, RT5640_DMIC
,
2011 RT5640_DMIC_1_DP_MASK
, RT5640_DMIC_1_DP_GPIO3
);
2012 regmap_update_bits(rt5640
->regmap
, RT5640_GPIO_CTRL1
,
2013 RT5640_GP3_PIN_MASK
, RT5640_GP3_PIN_DMIC1_SDA
);
2016 if (dmic2_data_pin
) {
2017 regmap_update_bits(rt5640
->regmap
, RT5640_DMIC
,
2018 RT5640_DMIC_2_DP_MASK
, RT5640_DMIC_2_DP_GPIO4
);
2019 regmap_update_bits(rt5640
->regmap
, RT5640_GPIO_CTRL1
,
2020 RT5640_GP4_PIN_MASK
, RT5640_GP4_PIN_DMIC2_SDA
);
2025 EXPORT_SYMBOL_GPL(rt5640_dmic_enable
);
2027 int rt5640_sel_asrc_clk_src(struct snd_soc_component
*component
,
2028 unsigned int filter_mask
, unsigned int clk_src
)
2030 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2031 unsigned int asrc2_mask
= 0;
2032 unsigned int asrc2_value
= 0;
2035 case RT5640_CLK_SEL_SYS
:
2036 case RT5640_CLK_SEL_ASRC
:
2046 if (filter_mask
& RT5640_DA_STEREO_FILTER
) {
2047 asrc2_mask
|= RT5640_STO_DAC_M_MASK
;
2048 asrc2_value
= (asrc2_value
& ~RT5640_STO_DAC_M_MASK
)
2049 | (clk_src
<< RT5640_STO_DAC_M_SFT
);
2052 if (filter_mask
& RT5640_DA_MONO_L_FILTER
) {
2053 asrc2_mask
|= RT5640_MDA_L_M_MASK
;
2054 asrc2_value
= (asrc2_value
& ~RT5640_MDA_L_M_MASK
)
2055 | (clk_src
<< RT5640_MDA_L_M_SFT
);
2058 if (filter_mask
& RT5640_DA_MONO_R_FILTER
) {
2059 asrc2_mask
|= RT5640_MDA_R_M_MASK
;
2060 asrc2_value
= (asrc2_value
& ~RT5640_MDA_R_M_MASK
)
2061 | (clk_src
<< RT5640_MDA_R_M_SFT
);
2064 if (filter_mask
& RT5640_AD_STEREO_FILTER
) {
2065 asrc2_mask
|= RT5640_ADC_M_MASK
;
2066 asrc2_value
= (asrc2_value
& ~RT5640_ADC_M_MASK
)
2067 | (clk_src
<< RT5640_ADC_M_SFT
);
2070 if (filter_mask
& RT5640_AD_MONO_L_FILTER
) {
2071 asrc2_mask
|= RT5640_MAD_L_M_MASK
;
2072 asrc2_value
= (asrc2_value
& ~RT5640_MAD_L_M_MASK
)
2073 | (clk_src
<< RT5640_MAD_L_M_SFT
);
2076 if (filter_mask
& RT5640_AD_MONO_R_FILTER
) {
2077 asrc2_mask
|= RT5640_MAD_R_M_MASK
;
2078 asrc2_value
= (asrc2_value
& ~RT5640_MAD_R_M_MASK
)
2079 | (clk_src
<< RT5640_MAD_R_M_SFT
);
2082 snd_soc_component_update_bits(component
, RT5640_ASRC_2
,
2083 asrc2_mask
, asrc2_value
);
2085 if (snd_soc_component_read32(component
, RT5640_ASRC_2
)) {
2086 rt5640
->asrc_en
= true;
2087 snd_soc_component_update_bits(component
, RT5640_JD_CTRL
, 0x3, 0x3);
2089 rt5640
->asrc_en
= false;
2090 snd_soc_component_update_bits(component
, RT5640_JD_CTRL
, 0x3, 0x0);
2095 EXPORT_SYMBOL_GPL(rt5640_sel_asrc_clk_src
);
2097 static void rt5640_enable_micbias1_for_ovcd(struct snd_soc_component
*component
)
2099 struct snd_soc_dapm_context
*dapm
= snd_soc_component_get_dapm(component
);
2101 snd_soc_dapm_mutex_lock(dapm
);
2102 snd_soc_dapm_force_enable_pin_unlocked(dapm
, "LDO2");
2103 snd_soc_dapm_force_enable_pin_unlocked(dapm
, "MICBIAS1");
2104 /* OVCD is unreliable when used with RCCLK as sysclk-source */
2105 snd_soc_dapm_force_enable_pin_unlocked(dapm
, "Platform Clock");
2106 snd_soc_dapm_sync_unlocked(dapm
);
2107 snd_soc_dapm_mutex_unlock(dapm
);
2110 static void rt5640_disable_micbias1_for_ovcd(struct snd_soc_component
*component
)
2112 struct snd_soc_dapm_context
*dapm
= snd_soc_component_get_dapm(component
);
2114 snd_soc_dapm_mutex_lock(dapm
);
2115 snd_soc_dapm_disable_pin_unlocked(dapm
, "Platform Clock");
2116 snd_soc_dapm_disable_pin_unlocked(dapm
, "MICBIAS1");
2117 snd_soc_dapm_disable_pin_unlocked(dapm
, "LDO2");
2118 snd_soc_dapm_sync_unlocked(dapm
);
2119 snd_soc_dapm_mutex_unlock(dapm
);
2122 static void rt5640_enable_micbias1_ovcd_irq(struct snd_soc_component
*component
)
2124 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2126 snd_soc_component_update_bits(component
, RT5640_IRQ_CTRL2
,
2127 RT5640_IRQ_MB1_OC_MASK
, RT5640_IRQ_MB1_OC_NOR
);
2128 rt5640
->ovcd_irq_enabled
= true;
2131 static void rt5640_disable_micbias1_ovcd_irq(struct snd_soc_component
*component
)
2133 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2135 snd_soc_component_update_bits(component
, RT5640_IRQ_CTRL2
,
2136 RT5640_IRQ_MB1_OC_MASK
, RT5640_IRQ_MB1_OC_BP
);
2137 rt5640
->ovcd_irq_enabled
= false;
2140 static void rt5640_clear_micbias1_ovcd(struct snd_soc_component
*component
)
2142 snd_soc_component_update_bits(component
, RT5640_IRQ_CTRL2
,
2143 RT5640_MB1_OC_STATUS
, 0);
2146 static bool rt5640_micbias1_ovcd(struct snd_soc_component
*component
)
2150 val
= snd_soc_component_read32(component
, RT5640_IRQ_CTRL2
);
2151 dev_dbg(component
->dev
, "irq ctrl2 %#04x\n", val
);
2153 return (val
& RT5640_MB1_OC_STATUS
);
2156 static bool rt5640_jack_inserted(struct snd_soc_component
*component
)
2158 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2161 val
= snd_soc_component_read32(component
, RT5640_INT_IRQ_ST
);
2162 dev_dbg(component
->dev
, "irq status %#04x\n", val
);
2164 if (rt5640
->jd_inverted
)
2165 return !(val
& RT5640_JD_STATUS
);
2167 return (val
& RT5640_JD_STATUS
);
2170 /* Jack detect and button-press timings */
2171 #define JACK_SETTLE_TIME 100 /* milli seconds */
2172 #define JACK_DETECT_COUNT 5
2173 #define JACK_DETECT_MAXCOUNT 20 /* Aprox. 2 seconds worth of tries */
2174 #define JACK_UNPLUG_TIME 80 /* milli seconds */
2175 #define BP_POLL_TIME 10 /* milli seconds */
2176 #define BP_POLL_MAXCOUNT 200 /* assume something is wrong after this */
2177 #define BP_THRESHOLD 3
2179 static void rt5640_start_button_press_work(struct snd_soc_component
*component
)
2181 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2183 rt5640
->poll_count
= 0;
2184 rt5640
->press_count
= 0;
2185 rt5640
->release_count
= 0;
2186 rt5640
->pressed
= false;
2187 rt5640
->press_reported
= false;
2188 rt5640_clear_micbias1_ovcd(component
);
2189 schedule_delayed_work(&rt5640
->bp_work
, msecs_to_jiffies(BP_POLL_TIME
));
2192 static void rt5640_button_press_work(struct work_struct
*work
)
2194 struct rt5640_priv
*rt5640
=
2195 container_of(work
, struct rt5640_priv
, bp_work
.work
);
2196 struct snd_soc_component
*component
= rt5640
->component
;
2198 /* Check the jack was not removed underneath us */
2199 if (!rt5640_jack_inserted(component
))
2202 if (rt5640_micbias1_ovcd(component
)) {
2203 rt5640
->release_count
= 0;
2204 rt5640
->press_count
++;
2205 /* Remember till after JACK_UNPLUG_TIME wait */
2206 if (rt5640
->press_count
>= BP_THRESHOLD
)
2207 rt5640
->pressed
= true;
2208 rt5640_clear_micbias1_ovcd(component
);
2210 rt5640
->press_count
= 0;
2211 rt5640
->release_count
++;
2215 * The pins get temporarily shorted on jack unplug, so we poll for
2216 * at least JACK_UNPLUG_TIME milli-seconds before reporting a press.
2218 rt5640
->poll_count
++;
2219 if (rt5640
->poll_count
< (JACK_UNPLUG_TIME
/ BP_POLL_TIME
)) {
2220 schedule_delayed_work(&rt5640
->bp_work
,
2221 msecs_to_jiffies(BP_POLL_TIME
));
2225 if (rt5640
->pressed
&& !rt5640
->press_reported
) {
2226 dev_dbg(component
->dev
, "headset button press\n");
2227 snd_soc_jack_report(rt5640
->jack
, SND_JACK_BTN_0
,
2229 rt5640
->press_reported
= true;
2232 if (rt5640
->release_count
>= BP_THRESHOLD
) {
2233 if (rt5640
->press_reported
) {
2234 dev_dbg(component
->dev
, "headset button release\n");
2235 snd_soc_jack_report(rt5640
->jack
, 0, SND_JACK_BTN_0
);
2237 /* Re-enable OVCD IRQ to detect next press */
2238 rt5640_enable_micbias1_ovcd_irq(component
);
2239 return; /* Stop polling */
2242 schedule_delayed_work(&rt5640
->bp_work
, msecs_to_jiffies(BP_POLL_TIME
));
2245 static int rt5640_detect_headset(struct snd_soc_component
*component
)
2247 int i
, headset_count
= 0, headphone_count
= 0;
2250 * We get the insertion event before the jack is fully inserted at which
2251 * point the second ring on a TRRS connector may short the 2nd ring and
2252 * sleeve contacts, also the overcurrent detection is not entirely
2253 * reliable. So we try several times with a wait in between until we
2254 * detect the same type JACK_DETECT_COUNT times in a row.
2256 for (i
= 0; i
< JACK_DETECT_MAXCOUNT
; i
++) {
2257 /* Clear any previous over-current status flag */
2258 rt5640_clear_micbias1_ovcd(component
);
2260 msleep(JACK_SETTLE_TIME
);
2262 /* Check the jack is still connected before checking ovcd */
2263 if (!rt5640_jack_inserted(component
))
2266 if (rt5640_micbias1_ovcd(component
)) {
2268 * Over current detected, there is a short between the
2269 * 2nd ring contact and the ground, so a TRS connector
2270 * without a mic contact and thus plain headphones.
2272 dev_dbg(component
->dev
, "jack mic-gnd shorted\n");
2275 if (headphone_count
== JACK_DETECT_COUNT
)
2276 return SND_JACK_HEADPHONE
;
2278 dev_dbg(component
->dev
, "jack mic-gnd open\n");
2279 headphone_count
= 0;
2281 if (headset_count
== JACK_DETECT_COUNT
)
2282 return SND_JACK_HEADSET
;
2286 dev_err(component
->dev
, "Error detecting headset vs headphones, bad contact?, assuming headphones\n");
2287 return SND_JACK_HEADPHONE
;
2290 static void rt5640_jack_work(struct work_struct
*work
)
2292 struct rt5640_priv
*rt5640
=
2293 container_of(work
, struct rt5640_priv
, jack_work
);
2294 struct snd_soc_component
*component
= rt5640
->component
;
2297 if (!rt5640_jack_inserted(component
)) {
2298 /* Jack removed, or spurious IRQ? */
2299 if (rt5640
->jack
->status
& SND_JACK_HEADPHONE
) {
2300 if (rt5640
->jack
->status
& SND_JACK_MICROPHONE
) {
2301 cancel_delayed_work_sync(&rt5640
->bp_work
);
2302 rt5640_disable_micbias1_ovcd_irq(component
);
2303 rt5640_disable_micbias1_for_ovcd(component
);
2305 snd_soc_jack_report(rt5640
->jack
, 0,
2306 SND_JACK_HEADSET
| SND_JACK_BTN_0
);
2307 dev_dbg(component
->dev
, "jack unplugged\n");
2309 } else if (!(rt5640
->jack
->status
& SND_JACK_HEADPHONE
)) {
2311 WARN_ON(rt5640
->ovcd_irq_enabled
);
2312 rt5640_enable_micbias1_for_ovcd(component
);
2313 status
= rt5640_detect_headset(component
);
2314 if (status
== SND_JACK_HEADSET
) {
2315 /* Enable ovcd IRQ for button press detect. */
2316 rt5640_enable_micbias1_ovcd_irq(component
);
2318 /* No more need for overcurrent detect. */
2319 rt5640_disable_micbias1_for_ovcd(component
);
2321 dev_dbg(component
->dev
, "detect status %#02x\n", status
);
2322 snd_soc_jack_report(rt5640
->jack
, status
, SND_JACK_HEADSET
);
2323 } else if (rt5640
->ovcd_irq_enabled
&& rt5640_micbias1_ovcd(component
)) {
2324 dev_dbg(component
->dev
, "OVCD IRQ\n");
2327 * The ovcd IRQ keeps firing while the button is pressed, so
2328 * we disable it and start polling the button until released.
2330 * The disable will make the IRQ pin 0 again and since we get
2331 * IRQs on both edges (so as to detect both jack plugin and
2332 * unplug) this means we will immediately get another IRQ.
2333 * The ovcd_irq_enabled check above makes the 2ND IRQ a NOP.
2335 rt5640_disable_micbias1_ovcd_irq(component
);
2336 rt5640_start_button_press_work(component
);
2339 * If the jack-detect IRQ flag goes high (unplug) after our
2340 * above rt5640_jack_inserted() check and before we have
2341 * disabled the OVCD IRQ, the IRQ pin will stay high and as
2342 * we react to edges, we miss the unplug event -> recheck.
2344 queue_work(system_long_wq
, &rt5640
->jack_work
);
2348 static irqreturn_t
rt5640_irq(int irq
, void *data
)
2350 struct rt5640_priv
*rt5640
= data
;
2353 queue_work(system_long_wq
, &rt5640
->jack_work
);
2358 static void rt5640_cancel_work(void *data
)
2360 struct rt5640_priv
*rt5640
= data
;
2362 cancel_work_sync(&rt5640
->jack_work
);
2363 cancel_delayed_work_sync(&rt5640
->bp_work
);
2366 static void rt5640_enable_jack_detect(struct snd_soc_component
*component
,
2367 struct snd_soc_jack
*jack
)
2369 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2371 /* Select JD-source */
2372 snd_soc_component_update_bits(component
, RT5640_JD_CTRL
,
2373 RT5640_JD_MASK
, rt5640
->jd_src
);
2375 /* Selecting GPIO01 as an interrupt */
2376 snd_soc_component_update_bits(component
, RT5640_GPIO_CTRL1
,
2377 RT5640_GP1_PIN_MASK
, RT5640_GP1_PIN_IRQ
);
2379 /* Set GPIO1 output */
2380 snd_soc_component_update_bits(component
, RT5640_GPIO_CTRL3
,
2381 RT5640_GP1_PF_MASK
, RT5640_GP1_PF_OUT
);
2383 /* Enabling jd2 in general control 1 */
2384 snd_soc_component_write(component
, RT5640_DUMMY1
, 0x3f41);
2386 /* Enabling jd2 in general control 2 */
2387 snd_soc_component_write(component
, RT5640_DUMMY2
, 0x4001);
2389 snd_soc_component_write(component
, RT5640_PR_BASE
+ RT5640_BIAS_CUR4
,
2390 0xa800 | rt5640
->ovcd_sf
);
2392 snd_soc_component_update_bits(component
, RT5640_MICBIAS
,
2393 RT5640_MIC1_OVTH_MASK
| RT5640_MIC1_OVCD_MASK
,
2394 rt5640
->ovcd_th
| RT5640_MIC1_OVCD_EN
);
2397 * The over-current-detect is only reliable in detecting the absence
2398 * of over-current, when the mic-contact in the jack is short-circuited,
2399 * the hardware periodically retries if it can apply the bias-current
2400 * leading to the ovcd status flip-flopping 1-0-1 with it being 0 about
2401 * 10% of the time, as we poll the ovcd status bit we might hit that
2402 * 10%, so we enable sticky mode and when checking OVCD we clear the
2403 * status, msleep() a bit and then check to get a reliable reading.
2405 snd_soc_component_update_bits(component
, RT5640_IRQ_CTRL2
,
2406 RT5640_MB1_OC_STKY_MASK
, RT5640_MB1_OC_STKY_EN
);
2409 * All IRQs get or-ed together, so we need the jack IRQ to report 0
2410 * when a jack is inserted so that the OVCD IRQ then toggles the IRQ
2411 * pin 0/1 instead of it being stuck to 1. So we invert the JD polarity
2412 * on systems where the hardware does not already do this.
2414 if (rt5640
->jd_inverted
)
2415 snd_soc_component_write(component
, RT5640_IRQ_CTRL1
,
2418 snd_soc_component_write(component
, RT5640_IRQ_CTRL1
,
2419 RT5640_IRQ_JD_NOR
| RT5640_JD_P_INV
);
2421 rt5640
->jack
= jack
;
2422 if (rt5640
->jack
->status
& SND_JACK_MICROPHONE
) {
2423 rt5640_enable_micbias1_for_ovcd(component
);
2424 rt5640_enable_micbias1_ovcd_irq(component
);
2427 enable_irq(rt5640
->irq
);
2428 /* sync initial jack state */
2429 queue_work(system_long_wq
, &rt5640
->jack_work
);
2432 static void rt5640_disable_jack_detect(struct snd_soc_component
*component
)
2434 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2436 disable_irq(rt5640
->irq
);
2437 rt5640_cancel_work(rt5640
);
2439 if (rt5640
->jack
->status
& SND_JACK_MICROPHONE
) {
2440 rt5640_disable_micbias1_ovcd_irq(component
);
2441 rt5640_disable_micbias1_for_ovcd(component
);
2442 snd_soc_jack_report(rt5640
->jack
, 0, SND_JACK_BTN_0
);
2445 rt5640
->jack
= NULL
;
2448 static int rt5640_set_jack(struct snd_soc_component
*component
,
2449 struct snd_soc_jack
*jack
, void *data
)
2452 rt5640_enable_jack_detect(component
, jack
);
2454 rt5640_disable_jack_detect(component
);
2459 static int rt5640_probe(struct snd_soc_component
*component
)
2461 struct snd_soc_dapm_context
*dapm
= snd_soc_component_get_dapm(component
);
2462 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2463 u32 dmic1_data_pin
= 0;
2464 u32 dmic2_data_pin
= 0;
2465 bool dmic_en
= false;
2468 /* Check if MCLK provided */
2469 rt5640
->mclk
= devm_clk_get(component
->dev
, "mclk");
2470 if (PTR_ERR(rt5640
->mclk
) == -EPROBE_DEFER
)
2471 return -EPROBE_DEFER
;
2473 rt5640
->component
= component
;
2475 snd_soc_component_force_bias_level(component
, SND_SOC_BIAS_OFF
);
2477 snd_soc_component_update_bits(component
, RT5640_DUMMY1
, 0x0301, 0x0301);
2478 snd_soc_component_update_bits(component
, RT5640_MICBIAS
, 0x0030, 0x0030);
2479 snd_soc_component_update_bits(component
, RT5640_DSP_PATH2
, 0xfc00, 0x0c00);
2481 switch (snd_soc_component_read32(component
, RT5640_RESET
) & RT5640_ID_MASK
) {
2482 case RT5640_ID_5640
:
2483 case RT5640_ID_5642
:
2484 snd_soc_add_component_controls(component
,
2485 rt5640_specific_snd_controls
,
2486 ARRAY_SIZE(rt5640_specific_snd_controls
));
2487 snd_soc_dapm_new_controls(dapm
,
2488 rt5640_specific_dapm_widgets
,
2489 ARRAY_SIZE(rt5640_specific_dapm_widgets
));
2490 snd_soc_dapm_add_routes(dapm
,
2491 rt5640_specific_dapm_routes
,
2492 ARRAY_SIZE(rt5640_specific_dapm_routes
));
2494 case RT5640_ID_5639
:
2495 snd_soc_dapm_new_controls(dapm
,
2496 rt5639_specific_dapm_widgets
,
2497 ARRAY_SIZE(rt5639_specific_dapm_widgets
));
2498 snd_soc_dapm_add_routes(dapm
,
2499 rt5639_specific_dapm_routes
,
2500 ARRAY_SIZE(rt5639_specific_dapm_routes
));
2503 dev_err(component
->dev
,
2504 "The driver is for RT5639 RT5640 or RT5642 only\n");
2509 * Note on some platforms the platform code may need to add device-props
2510 * rather then relying only on properties set by the firmware.
2511 * Therefor the property parsing MUST be done here, rather then from
2512 * rt5640_i2c_probe(), so that the platform-code can attach extra
2513 * properties before calling snd_soc_register_card().
2515 if (device_property_read_bool(component
->dev
, "realtek,in1-differential"))
2516 snd_soc_component_update_bits(component
, RT5640_IN1_IN2
,
2517 RT5640_IN_DF1
, RT5640_IN_DF1
);
2519 if (device_property_read_bool(component
->dev
, "realtek,in2-differential"))
2520 snd_soc_component_update_bits(component
, RT5640_IN3_IN4
,
2521 RT5640_IN_DF2
, RT5640_IN_DF2
);
2523 if (device_property_read_bool(component
->dev
, "realtek,in3-differential"))
2524 snd_soc_component_update_bits(component
, RT5640_IN1_IN2
,
2525 RT5640_IN_DF2
, RT5640_IN_DF2
);
2527 if (device_property_read_u32(component
->dev
, "realtek,dmic1-data-pin",
2528 &val
) == 0 && val
) {
2529 dmic1_data_pin
= val
- 1;
2533 if (device_property_read_u32(component
->dev
, "realtek,dmic2-data-pin",
2534 &val
) == 0 && val
) {
2535 dmic2_data_pin
= val
- 1;
2540 rt5640_dmic_enable(component
, dmic1_data_pin
, dmic2_data_pin
);
2542 if (device_property_read_u32(component
->dev
,
2543 "realtek,jack-detect-source", &val
) == 0) {
2544 if (val
<= RT5640_JD_SRC_GPIO4
)
2545 rt5640
->jd_src
= val
<< RT5640_JD_SFT
;
2547 dev_warn(component
->dev
, "Warning: Invalid jack-detect-source value: %d, leaving jack-detect disabled\n",
2551 if (!device_property_read_bool(component
->dev
, "realtek,jack-detect-not-inverted"))
2552 rt5640
->jd_inverted
= true;
2555 * Testing on various boards has shown that good defaults for the OVCD
2556 * threshold and scale-factor are 2000µA and 0.75. For an effective
2557 * limit of 1500µA, this seems to be more reliable then 1500µA and 1.0.
2559 rt5640
->ovcd_th
= RT5640_MIC1_OVTH_2000UA
;
2560 rt5640
->ovcd_sf
= RT5640_MIC_OVCD_SF_0P75
;
2562 if (device_property_read_u32(component
->dev
,
2563 "realtek,over-current-threshold-microamp", &val
) == 0) {
2566 rt5640
->ovcd_th
= RT5640_MIC1_OVTH_600UA
;
2569 rt5640
->ovcd_th
= RT5640_MIC1_OVTH_1500UA
;
2572 rt5640
->ovcd_th
= RT5640_MIC1_OVTH_2000UA
;
2575 dev_warn(component
->dev
, "Warning: Invalid over-current-threshold-microamp value: %d, defaulting to 2000uA\n",
2580 if (device_property_read_u32(component
->dev
,
2581 "realtek,over-current-scale-factor", &val
) == 0) {
2582 if (val
<= RT5640_OVCD_SF_1P5
)
2583 rt5640
->ovcd_sf
= val
<< RT5640_MIC_OVCD_SF_SFT
;
2585 dev_warn(component
->dev
, "Warning: Invalid over-current-scale-factor value: %d, defaulting to 0.75\n",
2592 static void rt5640_remove(struct snd_soc_component
*component
)
2594 rt5640_reset(component
);
2598 static int rt5640_suspend(struct snd_soc_component
*component
)
2600 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2602 snd_soc_component_force_bias_level(component
, SND_SOC_BIAS_OFF
);
2603 rt5640_reset(component
);
2604 regcache_cache_only(rt5640
->regmap
, true);
2605 regcache_mark_dirty(rt5640
->regmap
);
2606 if (gpio_is_valid(rt5640
->ldo1_en
))
2607 gpio_set_value_cansleep(rt5640
->ldo1_en
, 0);
2612 static int rt5640_resume(struct snd_soc_component
*component
)
2614 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2616 if (gpio_is_valid(rt5640
->ldo1_en
)) {
2617 gpio_set_value_cansleep(rt5640
->ldo1_en
, 1);
2621 regcache_cache_only(rt5640
->regmap
, false);
2622 regcache_sync(rt5640
->regmap
);
2627 #define rt5640_suspend NULL
2628 #define rt5640_resume NULL
2631 #define RT5640_STEREO_RATES SNDRV_PCM_RATE_8000_96000
2632 #define RT5640_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
2633 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S8)
2635 static const struct snd_soc_dai_ops rt5640_aif_dai_ops
= {
2636 .hw_params
= rt5640_hw_params
,
2637 .set_fmt
= rt5640_set_dai_fmt
,
2638 .set_sysclk
= rt5640_set_dai_sysclk
,
2639 .set_pll
= rt5640_set_dai_pll
,
2642 static struct snd_soc_dai_driver rt5640_dai
[] = {
2644 .name
= "rt5640-aif1",
2647 .stream_name
= "AIF1 Playback",
2650 .rates
= RT5640_STEREO_RATES
,
2651 .formats
= RT5640_FORMATS
,
2654 .stream_name
= "AIF1 Capture",
2657 .rates
= RT5640_STEREO_RATES
,
2658 .formats
= RT5640_FORMATS
,
2660 .ops
= &rt5640_aif_dai_ops
,
2663 .name
= "rt5640-aif2",
2666 .stream_name
= "AIF2 Playback",
2669 .rates
= RT5640_STEREO_RATES
,
2670 .formats
= RT5640_FORMATS
,
2673 .stream_name
= "AIF2 Capture",
2676 .rates
= RT5640_STEREO_RATES
,
2677 .formats
= RT5640_FORMATS
,
2679 .ops
= &rt5640_aif_dai_ops
,
2683 static const struct snd_soc_component_driver soc_component_dev_rt5640
= {
2684 .probe
= rt5640_probe
,
2685 .remove
= rt5640_remove
,
2686 .suspend
= rt5640_suspend
,
2687 .resume
= rt5640_resume
,
2688 .set_bias_level
= rt5640_set_bias_level
,
2689 .set_jack
= rt5640_set_jack
,
2690 .controls
= rt5640_snd_controls
,
2691 .num_controls
= ARRAY_SIZE(rt5640_snd_controls
),
2692 .dapm_widgets
= rt5640_dapm_widgets
,
2693 .num_dapm_widgets
= ARRAY_SIZE(rt5640_dapm_widgets
),
2694 .dapm_routes
= rt5640_dapm_routes
,
2695 .num_dapm_routes
= ARRAY_SIZE(rt5640_dapm_routes
),
2696 .use_pmdown_time
= 1,
2698 .non_legacy_dai_naming
= 1,
2702 static const struct regmap_config rt5640_regmap
= {
2705 .use_single_rw
= true,
2707 .max_register
= RT5640_VENDOR_ID2
+ 1 + (ARRAY_SIZE(rt5640_ranges
) *
2709 .volatile_reg
= rt5640_volatile_register
,
2710 .readable_reg
= rt5640_readable_register
,
2712 .cache_type
= REGCACHE_RBTREE
,
2713 .reg_defaults
= rt5640_reg
,
2714 .num_reg_defaults
= ARRAY_SIZE(rt5640_reg
),
2715 .ranges
= rt5640_ranges
,
2716 .num_ranges
= ARRAY_SIZE(rt5640_ranges
),
2719 static const struct i2c_device_id rt5640_i2c_id
[] = {
2725 MODULE_DEVICE_TABLE(i2c
, rt5640_i2c_id
);
2727 #if defined(CONFIG_OF)
2728 static const struct of_device_id rt5640_of_match
[] = {
2729 { .compatible
= "realtek,rt5639", },
2730 { .compatible
= "realtek,rt5640", },
2733 MODULE_DEVICE_TABLE(of
, rt5640_of_match
);
2737 static const struct acpi_device_id rt5640_acpi_match
[] = {
2745 MODULE_DEVICE_TABLE(acpi
, rt5640_acpi_match
);
2748 static int rt5640_parse_dt(struct rt5640_priv
*rt5640
, struct device_node
*np
)
2750 rt5640
->ldo1_en
= of_get_named_gpio(np
, "realtek,ldo1-en-gpios", 0);
2752 * LDO1_EN is optional (it may be statically tied on the board).
2753 * -ENOENT means that the property doesn't exist, i.e. there is no
2754 * GPIO, so is not an error. Any other error code means the property
2755 * exists, but could not be parsed.
2757 if (!gpio_is_valid(rt5640
->ldo1_en
) &&
2758 (rt5640
->ldo1_en
!= -ENOENT
))
2759 return rt5640
->ldo1_en
;
2764 static int rt5640_i2c_probe(struct i2c_client
*i2c
,
2765 const struct i2c_device_id
*id
)
2767 struct rt5640_priv
*rt5640
;
2771 rt5640
= devm_kzalloc(&i2c
->dev
,
2772 sizeof(struct rt5640_priv
),
2776 i2c_set_clientdata(i2c
, rt5640
);
2778 if (i2c
->dev
.of_node
) {
2779 ret
= rt5640_parse_dt(rt5640
, i2c
->dev
.of_node
);
2783 rt5640
->ldo1_en
= -EINVAL
;
2785 rt5640
->regmap
= devm_regmap_init_i2c(i2c
, &rt5640_regmap
);
2786 if (IS_ERR(rt5640
->regmap
)) {
2787 ret
= PTR_ERR(rt5640
->regmap
);
2788 dev_err(&i2c
->dev
, "Failed to allocate register map: %d\n",
2793 if (gpio_is_valid(rt5640
->ldo1_en
)) {
2794 ret
= devm_gpio_request_one(&i2c
->dev
, rt5640
->ldo1_en
,
2795 GPIOF_OUT_INIT_HIGH
,
2798 dev_err(&i2c
->dev
, "Failed to request LDO1_EN %d: %d\n",
2799 rt5640
->ldo1_en
, ret
);
2805 regmap_read(rt5640
->regmap
, RT5640_VENDOR_ID2
, &val
);
2806 if (val
!= RT5640_DEVICE_ID
) {
2808 "Device with ID register %#x is not rt5640/39\n", val
);
2812 regmap_write(rt5640
->regmap
, RT5640_RESET
, 0);
2814 ret
= regmap_register_patch(rt5640
->regmap
, init_list
,
2815 ARRAY_SIZE(init_list
));
2817 dev_warn(&i2c
->dev
, "Failed to apply regmap patch: %d\n", ret
);
2819 regmap_update_bits(rt5640
->regmap
, RT5640_DUMMY1
,
2820 RT5640_MCLK_DET
, RT5640_MCLK_DET
);
2822 rt5640
->hp_mute
= 1;
2823 rt5640
->irq
= i2c
->irq
;
2824 INIT_DELAYED_WORK(&rt5640
->bp_work
, rt5640_button_press_work
);
2825 INIT_WORK(&rt5640
->jack_work
, rt5640_jack_work
);
2827 /* Make sure work is stopped on probe-error / remove */
2828 ret
= devm_add_action_or_reset(&i2c
->dev
, rt5640_cancel_work
, rt5640
);
2832 ret
= devm_request_irq(&i2c
->dev
, rt5640
->irq
, rt5640_irq
,
2833 IRQF_TRIGGER_RISING
| IRQF_TRIGGER_FALLING
2834 | IRQF_ONESHOT
, "rt5640", rt5640
);
2836 /* Gets re-enabled by rt5640_set_jack() */
2837 disable_irq(rt5640
->irq
);
2839 dev_warn(&i2c
->dev
, "Failed to reguest IRQ %d: %d\n",
2841 rt5640
->irq
= -ENXIO
;
2844 return devm_snd_soc_register_component(&i2c
->dev
,
2845 &soc_component_dev_rt5640
,
2846 rt5640_dai
, ARRAY_SIZE(rt5640_dai
));
2849 static struct i2c_driver rt5640_i2c_driver
= {
2852 .acpi_match_table
= ACPI_PTR(rt5640_acpi_match
),
2853 .of_match_table
= of_match_ptr(rt5640_of_match
),
2855 .probe
= rt5640_i2c_probe
,
2856 .id_table
= rt5640_i2c_id
,
2858 module_i2c_driver(rt5640_i2c_driver
);
2860 MODULE_DESCRIPTION("ASoC RT5640/RT5639 driver");
2861 MODULE_AUTHOR("Johnny Hsu <johnnyhsu@realtek.com>");
2862 MODULE_LICENSE("GPL v2");