1 // SPDX-License-Identifier: GPL-2.0-only
3 * rt5640.c -- RT5640/RT5639 ALSA SoC audio codec driver
5 * Copyright 2011 Realtek Semiconductor Corp.
6 * Author: Johnny Hsu <johnnyhsu@realtek.com>
7 * Copyright (c) 2013, NVIDIA CORPORATION. All rights reserved.
10 #include <linux/module.h>
11 #include <linux/moduleparam.h>
12 #include <linux/init.h>
13 #include <linux/delay.h>
15 #include <linux/gpio/consumer.h>
16 #include <linux/i2c.h>
17 #include <linux/regmap.h>
19 #include <linux/platform_device.h>
20 #include <linux/spi/spi.h>
21 #include <linux/acpi.h>
22 #include <sound/core.h>
23 #include <sound/jack.h>
24 #include <sound/pcm.h>
25 #include <sound/pcm_params.h>
26 #include <sound/soc.h>
27 #include <sound/soc-dapm.h>
28 #include <sound/initval.h>
29 #include <sound/tlv.h>
34 #define RT5640_DEVICE_ID 0x6231
36 #define RT5640_PR_RANGE_BASE (0xff + 1)
37 #define RT5640_PR_SPACING 0x100
39 #define RT5640_PR_BASE (RT5640_PR_RANGE_BASE + (0 * RT5640_PR_SPACING))
41 static const struct regmap_range_cfg rt5640_ranges
[] = {
42 { .name
= "PR", .range_min
= RT5640_PR_BASE
,
43 .range_max
= RT5640_PR_BASE
+ 0xb4,
44 .selector_reg
= RT5640_PRIV_INDEX
,
45 .selector_mask
= 0xff,
46 .selector_shift
= 0x0,
47 .window_start
= RT5640_PRIV_DATA
,
51 static const struct reg_sequence init_list
[] = {
52 {RT5640_PR_BASE
+ 0x3d, 0x3600},
53 {RT5640_PR_BASE
+ 0x12, 0x0aa8},
54 {RT5640_PR_BASE
+ 0x14, 0x0aaa},
55 {RT5640_PR_BASE
+ 0x21, 0xe0e0},
56 {RT5640_PR_BASE
+ 0x23, 0x1804},
59 static const struct reg_default rt5640_reg
[] = {
165 static int rt5640_reset(struct snd_soc_component
*component
)
167 return snd_soc_component_write(component
, RT5640_RESET
, 0);
170 static bool rt5640_volatile_register(struct device
*dev
, unsigned int reg
)
174 for (i
= 0; i
< ARRAY_SIZE(rt5640_ranges
); i
++)
175 if ((reg
>= rt5640_ranges
[i
].window_start
&&
176 reg
<= rt5640_ranges
[i
].window_start
+
177 rt5640_ranges
[i
].window_len
) ||
178 (reg
>= rt5640_ranges
[i
].range_min
&&
179 reg
<= rt5640_ranges
[i
].range_max
))
185 case RT5640_EQ_CTRL1
:
186 case RT5640_DRC_AGC_1
:
187 case RT5640_ANC_CTRL1
:
188 case RT5640_IRQ_CTRL2
:
189 case RT5640_INT_IRQ_ST
:
190 case RT5640_DSP_CTRL2
:
191 case RT5640_DSP_CTRL3
:
192 case RT5640_PRIV_INDEX
:
193 case RT5640_PRIV_DATA
:
194 case RT5640_PGM_REG_ARR1
:
195 case RT5640_PGM_REG_ARR3
:
197 case RT5640_VENDOR_ID
:
198 case RT5640_VENDOR_ID1
:
199 case RT5640_VENDOR_ID2
:
206 static bool rt5640_readable_register(struct device
*dev
, unsigned int reg
)
210 for (i
= 0; i
< ARRAY_SIZE(rt5640_ranges
); i
++)
211 if ((reg
>= rt5640_ranges
[i
].window_start
&&
212 reg
<= rt5640_ranges
[i
].window_start
+
213 rt5640_ranges
[i
].window_len
) ||
214 (reg
>= rt5640_ranges
[i
].range_min
&&
215 reg
<= rt5640_ranges
[i
].range_max
))
223 case RT5640_MONO_OUT
:
226 case RT5640_INL_INR_VOL
:
227 case RT5640_DAC1_DIG_VOL
:
228 case RT5640_DAC2_DIG_VOL
:
229 case RT5640_DAC2_CTRL
:
230 case RT5640_ADC_DIG_VOL
:
231 case RT5640_ADC_DATA
:
232 case RT5640_ADC_BST_VOL
:
233 case RT5640_STO_ADC_MIXER
:
234 case RT5640_MONO_ADC_MIXER
:
235 case RT5640_AD_DA_MIXER
:
236 case RT5640_STO_DAC_MIXER
:
237 case RT5640_MONO_DAC_MIXER
:
238 case RT5640_DIG_MIXER
:
239 case RT5640_DSP_PATH1
:
240 case RT5640_DSP_PATH2
:
241 case RT5640_DIG_INF_DATA
:
242 case RT5640_REC_L1_MIXER
:
243 case RT5640_REC_L2_MIXER
:
244 case RT5640_REC_R1_MIXER
:
245 case RT5640_REC_R2_MIXER
:
246 case RT5640_HPO_MIXER
:
247 case RT5640_SPK_L_MIXER
:
248 case RT5640_SPK_R_MIXER
:
249 case RT5640_SPO_L_MIXER
:
250 case RT5640_SPO_R_MIXER
:
251 case RT5640_SPO_CLSD_RATIO
:
252 case RT5640_MONO_MIXER
:
253 case RT5640_OUT_L1_MIXER
:
254 case RT5640_OUT_L2_MIXER
:
255 case RT5640_OUT_L3_MIXER
:
256 case RT5640_OUT_R1_MIXER
:
257 case RT5640_OUT_R2_MIXER
:
258 case RT5640_OUT_R3_MIXER
:
259 case RT5640_LOUT_MIXER
:
260 case RT5640_PWR_DIG1
:
261 case RT5640_PWR_DIG2
:
262 case RT5640_PWR_ANLG1
:
263 case RT5640_PWR_ANLG2
:
264 case RT5640_PWR_MIXER
:
266 case RT5640_PRIV_INDEX
:
267 case RT5640_PRIV_DATA
:
268 case RT5640_I2S1_SDP
:
269 case RT5640_I2S2_SDP
:
270 case RT5640_ADDA_CLK1
:
271 case RT5640_ADDA_CLK2
:
274 case RT5640_PLL_CTRL1
:
275 case RT5640_PLL_CTRL2
:
282 case RT5640_CLS_D_OVCD
:
283 case RT5640_CLS_D_OUT
:
284 case RT5640_DEPOP_M1
:
285 case RT5640_DEPOP_M2
:
286 case RT5640_DEPOP_M3
:
287 case RT5640_CHARGE_PUMP
:
288 case RT5640_PV_DET_SPK_G
:
290 case RT5640_EQ_CTRL1
:
291 case RT5640_EQ_CTRL2
:
292 case RT5640_WIND_FILTER
:
293 case RT5640_DRC_AGC_1
:
294 case RT5640_DRC_AGC_2
:
295 case RT5640_DRC_AGC_3
:
297 case RT5640_ANC_CTRL1
:
298 case RT5640_ANC_CTRL2
:
299 case RT5640_ANC_CTRL3
:
302 case RT5640_IRQ_CTRL1
:
303 case RT5640_IRQ_CTRL2
:
304 case RT5640_INT_IRQ_ST
:
305 case RT5640_GPIO_CTRL1
:
306 case RT5640_GPIO_CTRL2
:
307 case RT5640_GPIO_CTRL3
:
308 case RT5640_DSP_CTRL1
:
309 case RT5640_DSP_CTRL2
:
310 case RT5640_DSP_CTRL3
:
311 case RT5640_DSP_CTRL4
:
312 case RT5640_PGM_REG_ARR1
:
313 case RT5640_PGM_REG_ARR2
:
314 case RT5640_PGM_REG_ARR3
:
315 case RT5640_PGM_REG_ARR4
:
316 case RT5640_PGM_REG_ARR5
:
317 case RT5640_SCB_FUNC
:
318 case RT5640_SCB_CTRL
:
319 case RT5640_BASE_BACK
:
320 case RT5640_MP3_PLUS1
:
321 case RT5640_MP3_PLUS2
:
324 case RT5640_HP_CALIB_AMP_DET
:
325 case RT5640_HP_CALIB2
:
331 case RT5640_VENDOR_ID
:
332 case RT5640_VENDOR_ID1
:
333 case RT5640_VENDOR_ID2
:
340 static const DECLARE_TLV_DB_SCALE(out_vol_tlv
, -4650, 150, 0);
341 static const DECLARE_TLV_DB_MINMAX(dac_vol_tlv
, -6562, 0);
342 static const DECLARE_TLV_DB_SCALE(in_vol_tlv
, -3450, 150, 0);
343 static const DECLARE_TLV_DB_MINMAX(adc_vol_tlv
, -1762, 3000);
344 static const DECLARE_TLV_DB_SCALE(adc_bst_tlv
, 0, 1200, 0);
346 /* {0, +20, +24, +30, +35, +40, +44, +50, +52} dB */
347 static const DECLARE_TLV_DB_RANGE(bst_tlv
,
348 0, 0, TLV_DB_SCALE_ITEM(0, 0, 0),
349 1, 1, TLV_DB_SCALE_ITEM(2000, 0, 0),
350 2, 2, TLV_DB_SCALE_ITEM(2400, 0, 0),
351 3, 5, TLV_DB_SCALE_ITEM(3000, 500, 0),
352 6, 6, TLV_DB_SCALE_ITEM(4400, 0, 0),
353 7, 7, TLV_DB_SCALE_ITEM(5000, 0, 0),
354 8, 8, TLV_DB_SCALE_ITEM(5200, 0, 0)
357 /* Interface data select */
358 static const char * const rt5640_data_select
[] = {
359 "Normal", "Swap", "left copy to right", "right copy to left"};
361 static SOC_ENUM_SINGLE_DECL(rt5640_if1_dac_enum
, RT5640_DIG_INF_DATA
,
362 RT5640_IF1_DAC_SEL_SFT
, rt5640_data_select
);
364 static SOC_ENUM_SINGLE_DECL(rt5640_if1_adc_enum
, RT5640_DIG_INF_DATA
,
365 RT5640_IF1_ADC_SEL_SFT
, rt5640_data_select
);
367 static SOC_ENUM_SINGLE_DECL(rt5640_if2_dac_enum
, RT5640_DIG_INF_DATA
,
368 RT5640_IF2_DAC_SEL_SFT
, rt5640_data_select
);
370 static SOC_ENUM_SINGLE_DECL(rt5640_if2_adc_enum
, RT5640_DIG_INF_DATA
,
371 RT5640_IF2_ADC_SEL_SFT
, rt5640_data_select
);
373 /* Class D speaker gain ratio */
374 static const char * const rt5640_clsd_spk_ratio
[] = {"1.66x", "1.83x", "1.94x",
375 "2x", "2.11x", "2.22x", "2.33x", "2.44x", "2.55x", "2.66x", "2.77x"};
377 static SOC_ENUM_SINGLE_DECL(rt5640_clsd_spk_ratio_enum
, RT5640_CLS_D_OUT
,
378 RT5640_CLSD_RATIO_SFT
, rt5640_clsd_spk_ratio
);
380 static const struct snd_kcontrol_new rt5640_snd_controls
[] = {
381 /* Speaker Output Volume */
382 SOC_DOUBLE("Speaker Channel Switch", RT5640_SPK_VOL
,
383 RT5640_VOL_L_SFT
, RT5640_VOL_R_SFT
, 1, 1),
384 SOC_DOUBLE_TLV("Speaker Playback Volume", RT5640_SPK_VOL
,
385 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
, 39, 1, out_vol_tlv
),
386 /* Headphone Output Volume */
387 SOC_DOUBLE("HP Channel Switch", RT5640_HP_VOL
,
388 RT5640_VOL_L_SFT
, RT5640_VOL_R_SFT
, 1, 1),
389 SOC_DOUBLE_TLV("HP Playback Volume", RT5640_HP_VOL
,
390 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
, 39, 1, out_vol_tlv
),
392 SOC_DOUBLE("OUT Playback Switch", RT5640_OUTPUT
,
393 RT5640_L_MUTE_SFT
, RT5640_R_MUTE_SFT
, 1, 1),
394 SOC_DOUBLE("OUT Channel Switch", RT5640_OUTPUT
,
395 RT5640_VOL_L_SFT
, RT5640_VOL_R_SFT
, 1, 1),
396 SOC_DOUBLE_TLV("OUT Playback Volume", RT5640_OUTPUT
,
397 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
, 39, 1, out_vol_tlv
),
399 /* DAC Digital Volume */
400 SOC_DOUBLE("DAC2 Playback Switch", RT5640_DAC2_CTRL
,
401 RT5640_M_DAC_L2_VOL_SFT
, RT5640_M_DAC_R2_VOL_SFT
, 1, 1),
402 SOC_DOUBLE_TLV("DAC2 Playback Volume", RT5640_DAC2_DIG_VOL
,
403 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
,
404 175, 0, dac_vol_tlv
),
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/IN3 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 SOC_SINGLE_TLV("IN3 Boost", RT5640_IN1_IN2
,
414 RT5640_BST_SFT2
, 8, 0, bst_tlv
),
416 /* INL/INR Volume Control */
417 SOC_DOUBLE_TLV("IN Capture Volume", RT5640_INL_INR_VOL
,
418 RT5640_INL_VOL_SFT
, RT5640_INR_VOL_SFT
,
420 /* ADC Digital Volume Control */
421 SOC_DOUBLE("ADC Capture Switch", RT5640_ADC_DIG_VOL
,
422 RT5640_L_MUTE_SFT
, RT5640_R_MUTE_SFT
, 1, 1),
423 SOC_DOUBLE_TLV("ADC Capture Volume", RT5640_ADC_DIG_VOL
,
424 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
,
425 127, 0, adc_vol_tlv
),
426 SOC_DOUBLE("Mono ADC Capture Switch", RT5640_DUMMY1
,
427 RT5640_M_MONO_ADC_L_SFT
, RT5640_M_MONO_ADC_R_SFT
, 1, 1),
428 SOC_DOUBLE_TLV("Mono ADC Capture Volume", RT5640_ADC_DATA
,
429 RT5640_L_VOL_SFT
, RT5640_R_VOL_SFT
,
430 127, 0, adc_vol_tlv
),
431 /* ADC Boost Volume Control */
432 SOC_DOUBLE_TLV("ADC Boost Gain", RT5640_ADC_BST_VOL
,
433 RT5640_ADC_L_BST_SFT
, RT5640_ADC_R_BST_SFT
,
435 /* Class D speaker gain ratio */
436 SOC_ENUM("Class D SPK Ratio Control", rt5640_clsd_spk_ratio_enum
),
438 SOC_ENUM("ADC IF1 Data Switch", rt5640_if1_adc_enum
),
439 SOC_ENUM("DAC IF1 Data Switch", rt5640_if1_dac_enum
),
440 SOC_ENUM("ADC IF2 Data Switch", rt5640_if2_adc_enum
),
441 SOC_ENUM("DAC IF2 Data Switch", rt5640_if2_dac_enum
),
444 static const struct snd_kcontrol_new rt5640_specific_snd_controls
[] = {
445 /* MONO Output Control */
446 SOC_SINGLE("Mono Playback Switch", RT5640_MONO_OUT
, RT5640_L_MUTE_SFT
,
451 * set_dmic_clk - Set parameter of dmic.
454 * @kcontrol: The kcontrol of this widget.
458 static int set_dmic_clk(struct snd_soc_dapm_widget
*w
,
459 struct snd_kcontrol
*kcontrol
, int event
)
461 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
462 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
465 rate
= rt5640
->sysclk
/ rl6231_get_pre_div(rt5640
->regmap
,
466 RT5640_ADDA_CLK1
, RT5640_I2S_PD1_SFT
);
467 idx
= rl6231_calc_dmic_clk(rate
);
469 dev_err(component
->dev
, "Failed to set DMIC clock\n");
471 snd_soc_component_update_bits(component
, RT5640_DMIC
, RT5640_DMIC_CLK_MASK
,
472 idx
<< RT5640_DMIC_CLK_SFT
);
476 static int is_using_asrc(struct snd_soc_dapm_widget
*source
,
477 struct snd_soc_dapm_widget
*sink
)
479 struct snd_soc_component
*component
= snd_soc_dapm_to_component(source
->dapm
);
480 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
482 if (!rt5640
->asrc_en
)
489 static const struct snd_kcontrol_new rt5640_sto_adc_l_mix
[] = {
490 SOC_DAPM_SINGLE("ADC1 Switch", RT5640_STO_ADC_MIXER
,
491 RT5640_M_ADC_L1_SFT
, 1, 1),
492 SOC_DAPM_SINGLE("ADC2 Switch", RT5640_STO_ADC_MIXER
,
493 RT5640_M_ADC_L2_SFT
, 1, 1),
496 static const struct snd_kcontrol_new rt5640_sto_adc_r_mix
[] = {
497 SOC_DAPM_SINGLE("ADC1 Switch", RT5640_STO_ADC_MIXER
,
498 RT5640_M_ADC_R1_SFT
, 1, 1),
499 SOC_DAPM_SINGLE("ADC2 Switch", RT5640_STO_ADC_MIXER
,
500 RT5640_M_ADC_R2_SFT
, 1, 1),
503 static const struct snd_kcontrol_new rt5640_mono_adc_l_mix
[] = {
504 SOC_DAPM_SINGLE("ADC1 Switch", RT5640_MONO_ADC_MIXER
,
505 RT5640_M_MONO_ADC_L1_SFT
, 1, 1),
506 SOC_DAPM_SINGLE("ADC2 Switch", RT5640_MONO_ADC_MIXER
,
507 RT5640_M_MONO_ADC_L2_SFT
, 1, 1),
510 static const struct snd_kcontrol_new rt5640_mono_adc_r_mix
[] = {
511 SOC_DAPM_SINGLE("ADC1 Switch", RT5640_MONO_ADC_MIXER
,
512 RT5640_M_MONO_ADC_R1_SFT
, 1, 1),
513 SOC_DAPM_SINGLE("ADC2 Switch", RT5640_MONO_ADC_MIXER
,
514 RT5640_M_MONO_ADC_R2_SFT
, 1, 1),
517 static const struct snd_kcontrol_new rt5640_dac_l_mix
[] = {
518 SOC_DAPM_SINGLE("Stereo ADC Switch", RT5640_AD_DA_MIXER
,
519 RT5640_M_ADCMIX_L_SFT
, 1, 1),
520 SOC_DAPM_SINGLE("INF1 Switch", RT5640_AD_DA_MIXER
,
521 RT5640_M_IF1_DAC_L_SFT
, 1, 1),
524 static const struct snd_kcontrol_new rt5640_dac_r_mix
[] = {
525 SOC_DAPM_SINGLE("Stereo ADC Switch", RT5640_AD_DA_MIXER
,
526 RT5640_M_ADCMIX_R_SFT
, 1, 1),
527 SOC_DAPM_SINGLE("INF1 Switch", RT5640_AD_DA_MIXER
,
528 RT5640_M_IF1_DAC_R_SFT
, 1, 1),
531 static const struct snd_kcontrol_new rt5640_sto_dac_l_mix
[] = {
532 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_STO_DAC_MIXER
,
533 RT5640_M_DAC_L1_SFT
, 1, 1),
534 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_STO_DAC_MIXER
,
535 RT5640_M_DAC_L2_SFT
, 1, 1),
536 SOC_DAPM_SINGLE("ANC Switch", RT5640_STO_DAC_MIXER
,
537 RT5640_M_ANC_DAC_L_SFT
, 1, 1),
540 static const struct snd_kcontrol_new rt5640_sto_dac_r_mix
[] = {
541 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_STO_DAC_MIXER
,
542 RT5640_M_DAC_R1_SFT
, 1, 1),
543 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_STO_DAC_MIXER
,
544 RT5640_M_DAC_R2_SFT
, 1, 1),
545 SOC_DAPM_SINGLE("ANC Switch", RT5640_STO_DAC_MIXER
,
546 RT5640_M_ANC_DAC_R_SFT
, 1, 1),
549 static const struct snd_kcontrol_new rt5639_sto_dac_l_mix
[] = {
550 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_STO_DAC_MIXER
,
551 RT5640_M_DAC_L1_SFT
, 1, 1),
552 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_STO_DAC_MIXER
,
553 RT5640_M_DAC_L2_SFT
, 1, 1),
556 static const struct snd_kcontrol_new rt5639_sto_dac_r_mix
[] = {
557 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_STO_DAC_MIXER
,
558 RT5640_M_DAC_R1_SFT
, 1, 1),
559 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_STO_DAC_MIXER
,
560 RT5640_M_DAC_R2_SFT
, 1, 1),
563 static const struct snd_kcontrol_new rt5640_mono_dac_l_mix
[] = {
564 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_MONO_DAC_MIXER
,
565 RT5640_M_DAC_L1_MONO_L_SFT
, 1, 1),
566 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_MONO_DAC_MIXER
,
567 RT5640_M_DAC_L2_MONO_L_SFT
, 1, 1),
568 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_MONO_DAC_MIXER
,
569 RT5640_M_DAC_R2_MONO_L_SFT
, 1, 1),
572 static const struct snd_kcontrol_new rt5640_mono_dac_r_mix
[] = {
573 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_MONO_DAC_MIXER
,
574 RT5640_M_DAC_R1_MONO_R_SFT
, 1, 1),
575 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_MONO_DAC_MIXER
,
576 RT5640_M_DAC_R2_MONO_R_SFT
, 1, 1),
577 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_MONO_DAC_MIXER
,
578 RT5640_M_DAC_L2_MONO_R_SFT
, 1, 1),
581 static const struct snd_kcontrol_new rt5640_dig_l_mix
[] = {
582 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_DIG_MIXER
,
583 RT5640_M_STO_L_DAC_L_SFT
, 1, 1),
584 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_DIG_MIXER
,
585 RT5640_M_DAC_L2_DAC_L_SFT
, 1, 1),
588 static const struct snd_kcontrol_new rt5640_dig_r_mix
[] = {
589 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_DIG_MIXER
,
590 RT5640_M_STO_R_DAC_R_SFT
, 1, 1),
591 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_DIG_MIXER
,
592 RT5640_M_DAC_R2_DAC_R_SFT
, 1, 1),
595 /* Analog Input Mixer */
596 static const struct snd_kcontrol_new rt5640_rec_l_mix
[] = {
597 SOC_DAPM_SINGLE("HPOL Switch", RT5640_REC_L2_MIXER
,
598 RT5640_M_HP_L_RM_L_SFT
, 1, 1),
599 SOC_DAPM_SINGLE("INL Switch", RT5640_REC_L2_MIXER
,
600 RT5640_M_IN_L_RM_L_SFT
, 1, 1),
601 SOC_DAPM_SINGLE("BST3 Switch", RT5640_REC_L2_MIXER
,
602 RT5640_M_BST2_RM_L_SFT
, 1, 1),
603 SOC_DAPM_SINGLE("BST2 Switch", RT5640_REC_L2_MIXER
,
604 RT5640_M_BST4_RM_L_SFT
, 1, 1),
605 SOC_DAPM_SINGLE("BST1 Switch", RT5640_REC_L2_MIXER
,
606 RT5640_M_BST1_RM_L_SFT
, 1, 1),
607 SOC_DAPM_SINGLE("OUT MIXL Switch", RT5640_REC_L2_MIXER
,
608 RT5640_M_OM_L_RM_L_SFT
, 1, 1),
611 static const struct snd_kcontrol_new rt5640_rec_r_mix
[] = {
612 SOC_DAPM_SINGLE("HPOR Switch", RT5640_REC_R2_MIXER
,
613 RT5640_M_HP_R_RM_R_SFT
, 1, 1),
614 SOC_DAPM_SINGLE("INR Switch", RT5640_REC_R2_MIXER
,
615 RT5640_M_IN_R_RM_R_SFT
, 1, 1),
616 SOC_DAPM_SINGLE("BST3 Switch", RT5640_REC_R2_MIXER
,
617 RT5640_M_BST2_RM_R_SFT
, 1, 1),
618 SOC_DAPM_SINGLE("BST2 Switch", RT5640_REC_R2_MIXER
,
619 RT5640_M_BST4_RM_R_SFT
, 1, 1),
620 SOC_DAPM_SINGLE("BST1 Switch", RT5640_REC_R2_MIXER
,
621 RT5640_M_BST1_RM_R_SFT
, 1, 1),
622 SOC_DAPM_SINGLE("OUT MIXR Switch", RT5640_REC_R2_MIXER
,
623 RT5640_M_OM_R_RM_R_SFT
, 1, 1),
626 /* Analog Output Mixer */
627 static const struct snd_kcontrol_new rt5640_spk_l_mix
[] = {
628 SOC_DAPM_SINGLE("REC MIXL Switch", RT5640_SPK_L_MIXER
,
629 RT5640_M_RM_L_SM_L_SFT
, 1, 1),
630 SOC_DAPM_SINGLE("INL Switch", RT5640_SPK_L_MIXER
,
631 RT5640_M_IN_L_SM_L_SFT
, 1, 1),
632 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_SPK_L_MIXER
,
633 RT5640_M_DAC_L1_SM_L_SFT
, 1, 1),
634 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_SPK_L_MIXER
,
635 RT5640_M_DAC_L2_SM_L_SFT
, 1, 1),
636 SOC_DAPM_SINGLE("OUT MIXL Switch", RT5640_SPK_L_MIXER
,
637 RT5640_M_OM_L_SM_L_SFT
, 1, 1),
640 static const struct snd_kcontrol_new rt5640_spk_r_mix
[] = {
641 SOC_DAPM_SINGLE("REC MIXR Switch", RT5640_SPK_R_MIXER
,
642 RT5640_M_RM_R_SM_R_SFT
, 1, 1),
643 SOC_DAPM_SINGLE("INR Switch", RT5640_SPK_R_MIXER
,
644 RT5640_M_IN_R_SM_R_SFT
, 1, 1),
645 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_SPK_R_MIXER
,
646 RT5640_M_DAC_R1_SM_R_SFT
, 1, 1),
647 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_SPK_R_MIXER
,
648 RT5640_M_DAC_R2_SM_R_SFT
, 1, 1),
649 SOC_DAPM_SINGLE("OUT MIXR Switch", RT5640_SPK_R_MIXER
,
650 RT5640_M_OM_R_SM_R_SFT
, 1, 1),
653 static const struct snd_kcontrol_new rt5640_out_l_mix
[] = {
654 SOC_DAPM_SINGLE("SPK MIXL Switch", RT5640_OUT_L3_MIXER
,
655 RT5640_M_SM_L_OM_L_SFT
, 1, 1),
656 SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_L3_MIXER
,
657 RT5640_M_BST1_OM_L_SFT
, 1, 1),
658 SOC_DAPM_SINGLE("INL Switch", RT5640_OUT_L3_MIXER
,
659 RT5640_M_IN_L_OM_L_SFT
, 1, 1),
660 SOC_DAPM_SINGLE("REC MIXL Switch", RT5640_OUT_L3_MIXER
,
661 RT5640_M_RM_L_OM_L_SFT
, 1, 1),
662 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_OUT_L3_MIXER
,
663 RT5640_M_DAC_R2_OM_L_SFT
, 1, 1),
664 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_OUT_L3_MIXER
,
665 RT5640_M_DAC_L2_OM_L_SFT
, 1, 1),
666 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_OUT_L3_MIXER
,
667 RT5640_M_DAC_L1_OM_L_SFT
, 1, 1),
670 static const struct snd_kcontrol_new rt5640_out_r_mix
[] = {
671 SOC_DAPM_SINGLE("SPK MIXR Switch", RT5640_OUT_R3_MIXER
,
672 RT5640_M_SM_L_OM_R_SFT
, 1, 1),
673 SOC_DAPM_SINGLE("BST2 Switch", RT5640_OUT_R3_MIXER
,
674 RT5640_M_BST4_OM_R_SFT
, 1, 1),
675 SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_R3_MIXER
,
676 RT5640_M_BST1_OM_R_SFT
, 1, 1),
677 SOC_DAPM_SINGLE("INR Switch", RT5640_OUT_R3_MIXER
,
678 RT5640_M_IN_R_OM_R_SFT
, 1, 1),
679 SOC_DAPM_SINGLE("REC MIXR Switch", RT5640_OUT_R3_MIXER
,
680 RT5640_M_RM_R_OM_R_SFT
, 1, 1),
681 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_OUT_R3_MIXER
,
682 RT5640_M_DAC_L2_OM_R_SFT
, 1, 1),
683 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_OUT_R3_MIXER
,
684 RT5640_M_DAC_R2_OM_R_SFT
, 1, 1),
685 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_OUT_R3_MIXER
,
686 RT5640_M_DAC_R1_OM_R_SFT
, 1, 1),
689 static const struct snd_kcontrol_new rt5639_out_l_mix
[] = {
690 SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_L3_MIXER
,
691 RT5640_M_BST1_OM_L_SFT
, 1, 1),
692 SOC_DAPM_SINGLE("INL Switch", RT5640_OUT_L3_MIXER
,
693 RT5640_M_IN_L_OM_L_SFT
, 1, 1),
694 SOC_DAPM_SINGLE("REC MIXL Switch", RT5640_OUT_L3_MIXER
,
695 RT5640_M_RM_L_OM_L_SFT
, 1, 1),
696 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_OUT_L3_MIXER
,
697 RT5640_M_DAC_L1_OM_L_SFT
, 1, 1),
700 static const struct snd_kcontrol_new rt5639_out_r_mix
[] = {
701 SOC_DAPM_SINGLE("BST2 Switch", RT5640_OUT_R3_MIXER
,
702 RT5640_M_BST4_OM_R_SFT
, 1, 1),
703 SOC_DAPM_SINGLE("BST1 Switch", RT5640_OUT_R3_MIXER
,
704 RT5640_M_BST1_OM_R_SFT
, 1, 1),
705 SOC_DAPM_SINGLE("INR Switch", RT5640_OUT_R3_MIXER
,
706 RT5640_M_IN_R_OM_R_SFT
, 1, 1),
707 SOC_DAPM_SINGLE("REC MIXR Switch", RT5640_OUT_R3_MIXER
,
708 RT5640_M_RM_R_OM_R_SFT
, 1, 1),
709 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_OUT_R3_MIXER
,
710 RT5640_M_DAC_R1_OM_R_SFT
, 1, 1),
713 static const struct snd_kcontrol_new rt5640_spo_l_mix
[] = {
714 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_SPO_L_MIXER
,
715 RT5640_M_DAC_R1_SPM_L_SFT
, 1, 1),
716 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_SPO_L_MIXER
,
717 RT5640_M_DAC_L1_SPM_L_SFT
, 1, 1),
718 SOC_DAPM_SINGLE("SPKVOL R Switch", RT5640_SPO_L_MIXER
,
719 RT5640_M_SV_R_SPM_L_SFT
, 1, 1),
720 SOC_DAPM_SINGLE("SPKVOL L Switch", RT5640_SPO_L_MIXER
,
721 RT5640_M_SV_L_SPM_L_SFT
, 1, 1),
722 SOC_DAPM_SINGLE("BST1 Switch", RT5640_SPO_L_MIXER
,
723 RT5640_M_BST1_SPM_L_SFT
, 1, 1),
726 static const struct snd_kcontrol_new rt5640_spo_r_mix
[] = {
727 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_SPO_R_MIXER
,
728 RT5640_M_DAC_R1_SPM_R_SFT
, 1, 1),
729 SOC_DAPM_SINGLE("SPKVOL R Switch", RT5640_SPO_R_MIXER
,
730 RT5640_M_SV_R_SPM_R_SFT
, 1, 1),
731 SOC_DAPM_SINGLE("BST1 Switch", RT5640_SPO_R_MIXER
,
732 RT5640_M_BST1_SPM_R_SFT
, 1, 1),
735 static const struct snd_kcontrol_new rt5640_hpo_mix
[] = {
736 SOC_DAPM_SINGLE("HPO MIX DAC2 Switch", RT5640_HPO_MIXER
,
737 RT5640_M_DAC2_HM_SFT
, 1, 1),
738 SOC_DAPM_SINGLE("HPO MIX DAC1 Switch", RT5640_HPO_MIXER
,
739 RT5640_M_DAC1_HM_SFT
, 1, 1),
740 SOC_DAPM_SINGLE("HPO MIX HPVOL Switch", RT5640_HPO_MIXER
,
741 RT5640_M_HPVOL_HM_SFT
, 1, 1),
744 static const struct snd_kcontrol_new rt5639_hpo_mix
[] = {
745 SOC_DAPM_SINGLE("HPO MIX DAC1 Switch", RT5640_HPO_MIXER
,
746 RT5640_M_DAC1_HM_SFT
, 1, 1),
747 SOC_DAPM_SINGLE("HPO MIX HPVOL Switch", RT5640_HPO_MIXER
,
748 RT5640_M_HPVOL_HM_SFT
, 1, 1),
751 static const struct snd_kcontrol_new rt5640_lout_mix
[] = {
752 SOC_DAPM_SINGLE("DAC L1 Switch", RT5640_LOUT_MIXER
,
753 RT5640_M_DAC_L1_LM_SFT
, 1, 1),
754 SOC_DAPM_SINGLE("DAC R1 Switch", RT5640_LOUT_MIXER
,
755 RT5640_M_DAC_R1_LM_SFT
, 1, 1),
756 SOC_DAPM_SINGLE("OUTVOL L Switch", RT5640_LOUT_MIXER
,
757 RT5640_M_OV_L_LM_SFT
, 1, 1),
758 SOC_DAPM_SINGLE("OUTVOL R Switch", RT5640_LOUT_MIXER
,
759 RT5640_M_OV_R_LM_SFT
, 1, 1),
762 static const struct snd_kcontrol_new rt5640_mono_mix
[] = {
763 SOC_DAPM_SINGLE("DAC R2 Switch", RT5640_MONO_MIXER
,
764 RT5640_M_DAC_R2_MM_SFT
, 1, 1),
765 SOC_DAPM_SINGLE("DAC L2 Switch", RT5640_MONO_MIXER
,
766 RT5640_M_DAC_L2_MM_SFT
, 1, 1),
767 SOC_DAPM_SINGLE("OUTVOL R Switch", RT5640_MONO_MIXER
,
768 RT5640_M_OV_R_MM_SFT
, 1, 1),
769 SOC_DAPM_SINGLE("OUTVOL L Switch", RT5640_MONO_MIXER
,
770 RT5640_M_OV_L_MM_SFT
, 1, 1),
771 SOC_DAPM_SINGLE("BST1 Switch", RT5640_MONO_MIXER
,
772 RT5640_M_BST1_MM_SFT
, 1, 1),
775 static const struct snd_kcontrol_new spk_l_enable_control
=
776 SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_SPK_VOL
,
777 RT5640_L_MUTE_SFT
, 1, 1);
779 static const struct snd_kcontrol_new spk_r_enable_control
=
780 SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_SPK_VOL
,
781 RT5640_R_MUTE_SFT
, 1, 1);
783 static const struct snd_kcontrol_new hp_l_enable_control
=
784 SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_HP_VOL
,
785 RT5640_L_MUTE_SFT
, 1, 1);
787 static const struct snd_kcontrol_new hp_r_enable_control
=
788 SOC_DAPM_SINGLE_AUTODISABLE("Switch", RT5640_HP_VOL
,
789 RT5640_R_MUTE_SFT
, 1, 1);
791 /* Stereo ADC source */
792 static const char * const rt5640_stereo_adc1_src
[] = {
796 static SOC_ENUM_SINGLE_DECL(rt5640_stereo_adc1_enum
, RT5640_STO_ADC_MIXER
,
797 RT5640_ADC_1_SRC_SFT
, rt5640_stereo_adc1_src
);
799 static const struct snd_kcontrol_new rt5640_sto_adc_1_mux
=
800 SOC_DAPM_ENUM("Stereo ADC1 Mux", rt5640_stereo_adc1_enum
);
802 static const char * const rt5640_stereo_adc2_src
[] = {
803 "DMIC1", "DMIC2", "DIG MIX"
806 static SOC_ENUM_SINGLE_DECL(rt5640_stereo_adc2_enum
, RT5640_STO_ADC_MIXER
,
807 RT5640_ADC_2_SRC_SFT
, rt5640_stereo_adc2_src
);
809 static const struct snd_kcontrol_new rt5640_sto_adc_2_mux
=
810 SOC_DAPM_ENUM("Stereo ADC2 Mux", rt5640_stereo_adc2_enum
);
812 /* Mono ADC source */
813 static const char * const rt5640_mono_adc_l1_src
[] = {
814 "Mono DAC MIXL", "ADCL"
817 static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_l1_enum
, RT5640_MONO_ADC_MIXER
,
818 RT5640_MONO_ADC_L1_SRC_SFT
, rt5640_mono_adc_l1_src
);
820 static const struct snd_kcontrol_new rt5640_mono_adc_l1_mux
=
821 SOC_DAPM_ENUM("Mono ADC1 left source", rt5640_mono_adc_l1_enum
);
823 static const char * const rt5640_mono_adc_l2_src
[] = {
824 "DMIC L1", "DMIC L2", "Mono DAC MIXL"
827 static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_l2_enum
, RT5640_MONO_ADC_MIXER
,
828 RT5640_MONO_ADC_L2_SRC_SFT
, rt5640_mono_adc_l2_src
);
830 static const struct snd_kcontrol_new rt5640_mono_adc_l2_mux
=
831 SOC_DAPM_ENUM("Mono ADC2 left source", rt5640_mono_adc_l2_enum
);
833 static const char * const rt5640_mono_adc_r1_src
[] = {
834 "Mono DAC MIXR", "ADCR"
837 static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_r1_enum
, RT5640_MONO_ADC_MIXER
,
838 RT5640_MONO_ADC_R1_SRC_SFT
, rt5640_mono_adc_r1_src
);
840 static const struct snd_kcontrol_new rt5640_mono_adc_r1_mux
=
841 SOC_DAPM_ENUM("Mono ADC1 right source", rt5640_mono_adc_r1_enum
);
843 static const char * const rt5640_mono_adc_r2_src
[] = {
844 "DMIC R1", "DMIC R2", "Mono DAC MIXR"
847 static SOC_ENUM_SINGLE_DECL(rt5640_mono_adc_r2_enum
, RT5640_MONO_ADC_MIXER
,
848 RT5640_MONO_ADC_R2_SRC_SFT
, rt5640_mono_adc_r2_src
);
850 static const struct snd_kcontrol_new rt5640_mono_adc_r2_mux
=
851 SOC_DAPM_ENUM("Mono ADC2 right source", rt5640_mono_adc_r2_enum
);
853 /* DAC2 channel source */
854 static const char * const rt5640_dac_l2_src
[] = {
858 static int rt5640_dac_l2_values
[] = {
863 static SOC_VALUE_ENUM_SINGLE_DECL(rt5640_dac_l2_enum
,
864 RT5640_DSP_PATH2
, RT5640_DAC_L2_SEL_SFT
,
865 0x3, rt5640_dac_l2_src
, rt5640_dac_l2_values
);
867 static const struct snd_kcontrol_new rt5640_dac_l2_mux
=
868 SOC_DAPM_ENUM("DAC2 left channel source", rt5640_dac_l2_enum
);
870 static const char * const rt5640_dac_r2_src
[] = {
874 static int rt5640_dac_r2_values
[] = {
878 static SOC_VALUE_ENUM_SINGLE_DECL(rt5640_dac_r2_enum
,
879 RT5640_DSP_PATH2
, RT5640_DAC_R2_SEL_SFT
,
880 0x3, rt5640_dac_r2_src
, rt5640_dac_r2_values
);
882 static const struct snd_kcontrol_new rt5640_dac_r2_mux
=
883 SOC_DAPM_ENUM("DAC2 right channel source", rt5640_dac_r2_enum
);
885 /* digital interface and iis interface map */
886 static const char * const rt5640_dai_iis_map
[] = {
887 "1:1|2:2", "1:2|2:1", "1:1|2:1", "1:2|2:2"
890 static int rt5640_dai_iis_map_values
[] = {
897 static SOC_VALUE_ENUM_SINGLE_DECL(rt5640_dai_iis_map_enum
,
898 RT5640_I2S1_SDP
, RT5640_I2S_IF_SFT
,
899 0x7, rt5640_dai_iis_map
,
900 rt5640_dai_iis_map_values
);
902 static const struct snd_kcontrol_new rt5640_dai_mux
=
903 SOC_DAPM_ENUM("DAI select", rt5640_dai_iis_map_enum
);
906 static const char * const rt5640_sdi_sel
[] = {
910 static SOC_ENUM_SINGLE_DECL(rt5640_sdi_sel_enum
, RT5640_I2S2_SDP
,
911 RT5640_I2S2_SDI_SFT
, rt5640_sdi_sel
);
913 static const struct snd_kcontrol_new rt5640_sdi_mux
=
914 SOC_DAPM_ENUM("SDI select", rt5640_sdi_sel_enum
);
916 static void hp_amp_power_on(struct snd_soc_component
*component
)
918 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
920 /* depop parameters */
921 regmap_update_bits(rt5640
->regmap
, RT5640_PR_BASE
+
922 RT5640_CHPUMP_INT_REG1
, 0x0700, 0x0200);
923 regmap_update_bits(rt5640
->regmap
, RT5640_DEPOP_M2
,
924 RT5640_DEPOP_MASK
, RT5640_DEPOP_MAN
);
925 regmap_update_bits(rt5640
->regmap
, RT5640_DEPOP_M1
,
926 RT5640_HP_CP_MASK
| RT5640_HP_SG_MASK
| RT5640_HP_CB_MASK
,
927 RT5640_HP_CP_PU
| RT5640_HP_SG_DIS
| RT5640_HP_CB_PU
);
928 regmap_write(rt5640
->regmap
, RT5640_PR_BASE
+ RT5640_HP_DCC_INT1
,
930 /* headphone amp power on */
931 regmap_update_bits(rt5640
->regmap
, RT5640_PWR_ANLG1
,
932 RT5640_PWR_FV1
| RT5640_PWR_FV2
, 0);
933 regmap_update_bits(rt5640
->regmap
, RT5640_PWR_ANLG1
,
936 usleep_range(10000, 15000);
937 regmap_update_bits(rt5640
->regmap
, RT5640_PWR_ANLG1
,
938 RT5640_PWR_FV1
| RT5640_PWR_FV2
,
939 RT5640_PWR_FV1
| RT5640_PWR_FV2
);
942 static void rt5640_pmu_depop(struct snd_soc_component
*component
)
944 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
946 regmap_update_bits(rt5640
->regmap
, RT5640_DEPOP_M2
,
947 RT5640_DEPOP_MASK
| RT5640_DIG_DP_MASK
,
948 RT5640_DEPOP_AUTO
| RT5640_DIG_DP_EN
);
949 regmap_update_bits(rt5640
->regmap
, RT5640_CHARGE_PUMP
,
950 RT5640_PM_HP_MASK
, RT5640_PM_HP_HV
);
952 regmap_update_bits(rt5640
->regmap
, RT5640_DEPOP_M3
,
953 RT5640_CP_FQ1_MASK
| RT5640_CP_FQ2_MASK
| RT5640_CP_FQ3_MASK
,
954 (RT5640_CP_FQ_192_KHZ
<< RT5640_CP_FQ1_SFT
) |
955 (RT5640_CP_FQ_12_KHZ
<< RT5640_CP_FQ2_SFT
) |
956 (RT5640_CP_FQ_192_KHZ
<< RT5640_CP_FQ3_SFT
));
958 regmap_write(rt5640
->regmap
, RT5640_PR_BASE
+
959 RT5640_MAMP_INT_REG2
, 0x1c00);
960 regmap_update_bits(rt5640
->regmap
, RT5640_DEPOP_M1
,
961 RT5640_HP_CP_MASK
| RT5640_HP_SG_MASK
,
962 RT5640_HP_CP_PD
| RT5640_HP_SG_EN
);
963 regmap_update_bits(rt5640
->regmap
, RT5640_PR_BASE
+
964 RT5640_CHPUMP_INT_REG1
, 0x0700, 0x0400);
967 static int rt5640_hp_event(struct snd_soc_dapm_widget
*w
,
968 struct snd_kcontrol
*kcontrol
, int event
)
970 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
971 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
974 case SND_SOC_DAPM_POST_PMU
:
975 rt5640_pmu_depop(component
);
976 rt5640
->hp_mute
= false;
979 case SND_SOC_DAPM_PRE_PMD
:
980 rt5640
->hp_mute
= true;
991 static int rt5640_lout_event(struct snd_soc_dapm_widget
*w
,
992 struct snd_kcontrol
*kcontrol
, int event
)
994 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
997 case SND_SOC_DAPM_POST_PMU
:
998 hp_amp_power_on(component
);
999 snd_soc_component_update_bits(component
, RT5640_PWR_ANLG1
,
1000 RT5640_PWR_LM
, RT5640_PWR_LM
);
1001 snd_soc_component_update_bits(component
, RT5640_OUTPUT
,
1002 RT5640_L_MUTE
| RT5640_R_MUTE
, 0);
1005 case SND_SOC_DAPM_PRE_PMD
:
1006 snd_soc_component_update_bits(component
, RT5640_OUTPUT
,
1007 RT5640_L_MUTE
| RT5640_R_MUTE
,
1008 RT5640_L_MUTE
| RT5640_R_MUTE
);
1009 snd_soc_component_update_bits(component
, RT5640_PWR_ANLG1
,
1020 static int rt5640_hp_power_event(struct snd_soc_dapm_widget
*w
,
1021 struct snd_kcontrol
*kcontrol
, int event
)
1023 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
1026 case SND_SOC_DAPM_POST_PMU
:
1027 hp_amp_power_on(component
);
1036 static int rt5640_hp_post_event(struct snd_soc_dapm_widget
*w
,
1037 struct snd_kcontrol
*kcontrol
, int event
)
1039 struct snd_soc_component
*component
= snd_soc_dapm_to_component(w
->dapm
);
1040 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
1043 case SND_SOC_DAPM_POST_PMU
:
1044 if (!rt5640
->hp_mute
)
1056 static const struct snd_soc_dapm_widget rt5640_dapm_widgets
[] = {
1058 SND_SOC_DAPM_SUPPLY_S("Stereo Filter ASRC", 1, RT5640_ASRC_1
,
1060 SND_SOC_DAPM_SUPPLY_S("I2S2 Filter ASRC", 1, RT5640_ASRC_1
,
1062 SND_SOC_DAPM_SUPPLY_S("I2S2 ASRC", 1, RT5640_ASRC_1
,
1064 SND_SOC_DAPM_SUPPLY_S("DMIC1 ASRC", 1, RT5640_ASRC_1
,
1066 SND_SOC_DAPM_SUPPLY_S("DMIC2 ASRC", 1, RT5640_ASRC_1
,
1072 SND_SOC_DAPM_SUPPLY("LDO2", RT5640_PWR_ANLG1
,
1073 RT5640_PWR_LDO2_BIT
, 0, NULL
, 0),
1074 SND_SOC_DAPM_SUPPLY("MICBIAS1", RT5640_PWR_ANLG2
,
1075 RT5640_PWR_MB1_BIT
, 0, NULL
, 0),
1077 SND_SOC_DAPM_INPUT("DMIC1"),
1078 SND_SOC_DAPM_INPUT("DMIC2"),
1079 SND_SOC_DAPM_INPUT("IN1P"),
1080 SND_SOC_DAPM_INPUT("IN1N"),
1081 SND_SOC_DAPM_INPUT("IN2P"),
1082 SND_SOC_DAPM_INPUT("IN2N"),
1083 SND_SOC_DAPM_INPUT("IN3P"),
1084 SND_SOC_DAPM_INPUT("IN3N"),
1085 SND_SOC_DAPM_PGA("DMIC L1", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1086 SND_SOC_DAPM_PGA("DMIC R1", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1087 SND_SOC_DAPM_PGA("DMIC L2", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1088 SND_SOC_DAPM_PGA("DMIC R2", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1090 SND_SOC_DAPM_SUPPLY("DMIC CLK", SND_SOC_NOPM
, 0, 0,
1091 set_dmic_clk
, SND_SOC_DAPM_PRE_PMU
),
1092 SND_SOC_DAPM_SUPPLY("DMIC1 Power", RT5640_DMIC
, RT5640_DMIC_1_EN_SFT
, 0,
1094 SND_SOC_DAPM_SUPPLY("DMIC2 Power", RT5640_DMIC
, RT5640_DMIC_2_EN_SFT
, 0,
1097 SND_SOC_DAPM_PGA("BST1", RT5640_PWR_ANLG2
,
1098 RT5640_PWR_BST1_BIT
, 0, NULL
, 0),
1099 SND_SOC_DAPM_PGA("BST2", RT5640_PWR_ANLG2
,
1100 RT5640_PWR_BST4_BIT
, 0, NULL
, 0),
1101 SND_SOC_DAPM_PGA("BST3", RT5640_PWR_ANLG2
,
1102 RT5640_PWR_BST2_BIT
, 0, NULL
, 0),
1104 SND_SOC_DAPM_PGA("INL VOL", RT5640_PWR_VOL
,
1105 RT5640_PWR_IN_L_BIT
, 0, NULL
, 0),
1106 SND_SOC_DAPM_PGA("INR VOL", RT5640_PWR_VOL
,
1107 RT5640_PWR_IN_R_BIT
, 0, NULL
, 0),
1109 SND_SOC_DAPM_MIXER("RECMIXL", RT5640_PWR_MIXER
, RT5640_PWR_RM_L_BIT
, 0,
1110 rt5640_rec_l_mix
, ARRAY_SIZE(rt5640_rec_l_mix
)),
1111 SND_SOC_DAPM_MIXER("RECMIXR", RT5640_PWR_MIXER
, RT5640_PWR_RM_R_BIT
, 0,
1112 rt5640_rec_r_mix
, ARRAY_SIZE(rt5640_rec_r_mix
)),
1114 SND_SOC_DAPM_ADC("ADC L", NULL
, RT5640_PWR_DIG1
,
1115 RT5640_PWR_ADC_L_BIT
, 0),
1116 SND_SOC_DAPM_ADC("ADC R", NULL
, RT5640_PWR_DIG1
,
1117 RT5640_PWR_ADC_R_BIT
, 0),
1119 SND_SOC_DAPM_MUX("Stereo ADC L2 Mux", SND_SOC_NOPM
, 0, 0,
1120 &rt5640_sto_adc_2_mux
),
1121 SND_SOC_DAPM_MUX("Stereo ADC R2 Mux", SND_SOC_NOPM
, 0, 0,
1122 &rt5640_sto_adc_2_mux
),
1123 SND_SOC_DAPM_MUX("Stereo ADC L1 Mux", SND_SOC_NOPM
, 0, 0,
1124 &rt5640_sto_adc_1_mux
),
1125 SND_SOC_DAPM_MUX("Stereo ADC R1 Mux", SND_SOC_NOPM
, 0, 0,
1126 &rt5640_sto_adc_1_mux
),
1127 SND_SOC_DAPM_MUX("Mono ADC L2 Mux", SND_SOC_NOPM
, 0, 0,
1128 &rt5640_mono_adc_l2_mux
),
1129 SND_SOC_DAPM_MUX("Mono ADC L1 Mux", SND_SOC_NOPM
, 0, 0,
1130 &rt5640_mono_adc_l1_mux
),
1131 SND_SOC_DAPM_MUX("Mono ADC R1 Mux", SND_SOC_NOPM
, 0, 0,
1132 &rt5640_mono_adc_r1_mux
),
1133 SND_SOC_DAPM_MUX("Mono ADC R2 Mux", SND_SOC_NOPM
, 0, 0,
1134 &rt5640_mono_adc_r2_mux
),
1136 SND_SOC_DAPM_SUPPLY("Stereo Filter", RT5640_PWR_DIG2
,
1137 RT5640_PWR_ADC_SF_BIT
, 0, NULL
, 0),
1138 SND_SOC_DAPM_MIXER("Stereo ADC MIXL", SND_SOC_NOPM
, 0, 0,
1139 rt5640_sto_adc_l_mix
, ARRAY_SIZE(rt5640_sto_adc_l_mix
)),
1140 SND_SOC_DAPM_MIXER("Stereo ADC MIXR", SND_SOC_NOPM
, 0, 0,
1141 rt5640_sto_adc_r_mix
, ARRAY_SIZE(rt5640_sto_adc_r_mix
)),
1142 SND_SOC_DAPM_SUPPLY("Mono Left Filter", RT5640_PWR_DIG2
,
1143 RT5640_PWR_ADC_MF_L_BIT
, 0, NULL
, 0),
1144 SND_SOC_DAPM_MIXER("Mono ADC MIXL", SND_SOC_NOPM
, 0, 0,
1145 rt5640_mono_adc_l_mix
, ARRAY_SIZE(rt5640_mono_adc_l_mix
)),
1146 SND_SOC_DAPM_SUPPLY("Mono Right Filter", RT5640_PWR_DIG2
,
1147 RT5640_PWR_ADC_MF_R_BIT
, 0, NULL
, 0),
1148 SND_SOC_DAPM_MIXER("Mono ADC MIXR", SND_SOC_NOPM
, 0, 0,
1149 rt5640_mono_adc_r_mix
, ARRAY_SIZE(rt5640_mono_adc_r_mix
)),
1151 /* Digital Interface */
1152 SND_SOC_DAPM_SUPPLY("I2S1", RT5640_PWR_DIG1
,
1153 RT5640_PWR_I2S1_BIT
, 0, NULL
, 0),
1154 SND_SOC_DAPM_PGA("IF1 DAC", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1155 SND_SOC_DAPM_PGA("IF1 DAC L", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1156 SND_SOC_DAPM_PGA("IF1 DAC R", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1157 SND_SOC_DAPM_PGA("IF1 ADC", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1158 SND_SOC_DAPM_PGA("IF1 ADC L", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1159 SND_SOC_DAPM_PGA("IF1 ADC R", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1160 SND_SOC_DAPM_SUPPLY("I2S2", RT5640_PWR_DIG1
,
1161 RT5640_PWR_I2S2_BIT
, 0, NULL
, 0),
1162 SND_SOC_DAPM_PGA("IF2 DAC", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1163 SND_SOC_DAPM_PGA("IF2 DAC L", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1164 SND_SOC_DAPM_PGA("IF2 DAC R", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1165 SND_SOC_DAPM_PGA("IF2 ADC", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1166 SND_SOC_DAPM_PGA("IF2 ADC L", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1167 SND_SOC_DAPM_PGA("IF2 ADC R", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1168 /* Digital Interface Select */
1169 SND_SOC_DAPM_MUX("DAI1 RX Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1170 SND_SOC_DAPM_MUX("DAI1 TX Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1171 SND_SOC_DAPM_MUX("DAI1 IF1 Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1172 SND_SOC_DAPM_MUX("DAI1 IF2 Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1173 SND_SOC_DAPM_MUX("SDI1 TX Mux", SND_SOC_NOPM
, 0, 0, &rt5640_sdi_mux
),
1174 SND_SOC_DAPM_MUX("DAI2 RX Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1175 SND_SOC_DAPM_MUX("DAI2 TX Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1176 SND_SOC_DAPM_MUX("DAI2 IF1 Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1177 SND_SOC_DAPM_MUX("DAI2 IF2 Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dai_mux
),
1178 SND_SOC_DAPM_MUX("SDI2 TX Mux", SND_SOC_NOPM
, 0, 0, &rt5640_sdi_mux
),
1179 /* Audio Interface */
1180 SND_SOC_DAPM_AIF_IN("AIF1RX", "AIF1 Playback", 0, SND_SOC_NOPM
, 0, 0),
1181 SND_SOC_DAPM_AIF_OUT("AIF1TX", "AIF1 Capture", 0, SND_SOC_NOPM
, 0, 0),
1182 SND_SOC_DAPM_AIF_IN("AIF2RX", "AIF2 Playback", 0, SND_SOC_NOPM
, 0, 0),
1183 SND_SOC_DAPM_AIF_OUT("AIF2TX", "AIF2 Capture", 0, SND_SOC_NOPM
, 0, 0),
1186 /* DAC mixer before sound effect */
1187 SND_SOC_DAPM_MIXER("DAC MIXL", SND_SOC_NOPM
, 0, 0,
1188 rt5640_dac_l_mix
, ARRAY_SIZE(rt5640_dac_l_mix
)),
1189 SND_SOC_DAPM_MIXER("DAC MIXR", SND_SOC_NOPM
, 0, 0,
1190 rt5640_dac_r_mix
, ARRAY_SIZE(rt5640_dac_r_mix
)),
1193 SND_SOC_DAPM_MIXER("Mono DAC MIXL", SND_SOC_NOPM
, 0, 0,
1194 rt5640_mono_dac_l_mix
, ARRAY_SIZE(rt5640_mono_dac_l_mix
)),
1195 SND_SOC_DAPM_MIXER("Mono DAC MIXR", SND_SOC_NOPM
, 0, 0,
1196 rt5640_mono_dac_r_mix
, ARRAY_SIZE(rt5640_mono_dac_r_mix
)),
1197 SND_SOC_DAPM_MIXER("DIG MIXL", SND_SOC_NOPM
, 0, 0,
1198 rt5640_dig_l_mix
, ARRAY_SIZE(rt5640_dig_l_mix
)),
1199 SND_SOC_DAPM_MIXER("DIG MIXR", SND_SOC_NOPM
, 0, 0,
1200 rt5640_dig_r_mix
, ARRAY_SIZE(rt5640_dig_r_mix
)),
1202 SND_SOC_DAPM_DAC("DAC L1", NULL
, SND_SOC_NOPM
,
1204 SND_SOC_DAPM_DAC("DAC R1", NULL
, SND_SOC_NOPM
,
1206 SND_SOC_DAPM_SUPPLY("DAC L1 Power", RT5640_PWR_DIG1
,
1207 RT5640_PWR_DAC_L1_BIT
, 0, NULL
, 0),
1208 SND_SOC_DAPM_SUPPLY("DAC R1 Power", RT5640_PWR_DIG1
,
1209 RT5640_PWR_DAC_R1_BIT
, 0, NULL
, 0),
1210 SND_SOC_DAPM_SUPPLY("DAC L2 Power", RT5640_PWR_DIG1
,
1211 RT5640_PWR_DAC_L2_BIT
, 0, NULL
, 0),
1212 SND_SOC_DAPM_SUPPLY("DAC R2 Power", RT5640_PWR_DIG1
,
1213 RT5640_PWR_DAC_R2_BIT
, 0, NULL
, 0),
1215 SND_SOC_DAPM_MIXER("SPK MIXL", RT5640_PWR_MIXER
, RT5640_PWR_SM_L_BIT
,
1216 0, rt5640_spk_l_mix
, ARRAY_SIZE(rt5640_spk_l_mix
)),
1217 SND_SOC_DAPM_MIXER("SPK MIXR", RT5640_PWR_MIXER
, RT5640_PWR_SM_R_BIT
,
1218 0, rt5640_spk_r_mix
, ARRAY_SIZE(rt5640_spk_r_mix
)),
1220 SND_SOC_DAPM_PGA("SPKVOL L", RT5640_PWR_VOL
,
1221 RT5640_PWR_SV_L_BIT
, 0, NULL
, 0),
1222 SND_SOC_DAPM_PGA("SPKVOL R", RT5640_PWR_VOL
,
1223 RT5640_PWR_SV_R_BIT
, 0, NULL
, 0),
1224 SND_SOC_DAPM_PGA("OUTVOL L", RT5640_PWR_VOL
,
1225 RT5640_PWR_OV_L_BIT
, 0, NULL
, 0),
1226 SND_SOC_DAPM_PGA("OUTVOL R", RT5640_PWR_VOL
,
1227 RT5640_PWR_OV_R_BIT
, 0, NULL
, 0),
1228 SND_SOC_DAPM_PGA("HPOVOL L", RT5640_PWR_VOL
,
1229 RT5640_PWR_HV_L_BIT
, 0, NULL
, 0),
1230 SND_SOC_DAPM_PGA("HPOVOL R", RT5640_PWR_VOL
,
1231 RT5640_PWR_HV_R_BIT
, 0, NULL
, 0),
1232 /* SPO/HPO/LOUT/Mono Mixer */
1233 SND_SOC_DAPM_MIXER("SPOL MIX", SND_SOC_NOPM
, 0,
1234 0, rt5640_spo_l_mix
, ARRAY_SIZE(rt5640_spo_l_mix
)),
1235 SND_SOC_DAPM_MIXER("SPOR MIX", SND_SOC_NOPM
, 0,
1236 0, rt5640_spo_r_mix
, ARRAY_SIZE(rt5640_spo_r_mix
)),
1237 SND_SOC_DAPM_MIXER("LOUT MIX", SND_SOC_NOPM
, 0, 0,
1238 rt5640_lout_mix
, ARRAY_SIZE(rt5640_lout_mix
)),
1239 SND_SOC_DAPM_SUPPLY_S("Improve HP Amp Drv", 1, SND_SOC_NOPM
,
1240 0, 0, rt5640_hp_power_event
, SND_SOC_DAPM_POST_PMU
),
1241 SND_SOC_DAPM_PGA_S("HP Amp", 1, SND_SOC_NOPM
, 0, 0,
1243 SND_SOC_DAPM_PRE_PMD
| SND_SOC_DAPM_POST_PMU
),
1244 SND_SOC_DAPM_PGA_S("LOUT amp", 1, SND_SOC_NOPM
, 0, 0,
1246 SND_SOC_DAPM_PRE_PMD
| SND_SOC_DAPM_POST_PMU
),
1247 SND_SOC_DAPM_SUPPLY("HP L Amp", RT5640_PWR_ANLG1
,
1248 RT5640_PWR_HP_L_BIT
, 0, NULL
, 0),
1249 SND_SOC_DAPM_SUPPLY("HP R Amp", RT5640_PWR_ANLG1
,
1250 RT5640_PWR_HP_R_BIT
, 0, NULL
, 0),
1251 SND_SOC_DAPM_SUPPLY("Improve SPK Amp Drv", RT5640_PWR_DIG1
,
1252 RT5640_PWR_CLS_D_BIT
, 0, NULL
, 0),
1255 SND_SOC_DAPM_SWITCH("Speaker L Playback", SND_SOC_NOPM
, 0, 0,
1256 &spk_l_enable_control
),
1257 SND_SOC_DAPM_SWITCH("Speaker R Playback", SND_SOC_NOPM
, 0, 0,
1258 &spk_r_enable_control
),
1259 SND_SOC_DAPM_SWITCH("HP L Playback", SND_SOC_NOPM
, 0, 0,
1260 &hp_l_enable_control
),
1261 SND_SOC_DAPM_SWITCH("HP R Playback", SND_SOC_NOPM
, 0, 0,
1262 &hp_r_enable_control
),
1263 SND_SOC_DAPM_POST("HP Post", rt5640_hp_post_event
),
1265 SND_SOC_DAPM_OUTPUT("SPOLP"),
1266 SND_SOC_DAPM_OUTPUT("SPOLN"),
1267 SND_SOC_DAPM_OUTPUT("SPORP"),
1268 SND_SOC_DAPM_OUTPUT("SPORN"),
1269 SND_SOC_DAPM_OUTPUT("HPOL"),
1270 SND_SOC_DAPM_OUTPUT("HPOR"),
1271 SND_SOC_DAPM_OUTPUT("LOUTL"),
1272 SND_SOC_DAPM_OUTPUT("LOUTR"),
1275 static const struct snd_soc_dapm_widget rt5640_specific_dapm_widgets
[] = {
1277 SND_SOC_DAPM_PGA("Audio DSP", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1279 SND_SOC_DAPM_PGA("ANC", SND_SOC_NOPM
, 0, 0, NULL
, 0),
1281 /* DAC2 channel Mux */
1282 SND_SOC_DAPM_MUX("DAC L2 Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dac_l2_mux
),
1283 SND_SOC_DAPM_MUX("DAC R2 Mux", SND_SOC_NOPM
, 0, 0, &rt5640_dac_r2_mux
),
1285 SND_SOC_DAPM_MIXER("Stereo DAC MIXL", SND_SOC_NOPM
, 0, 0,
1286 rt5640_sto_dac_l_mix
, ARRAY_SIZE(rt5640_sto_dac_l_mix
)),
1287 SND_SOC_DAPM_MIXER("Stereo DAC MIXR", SND_SOC_NOPM
, 0, 0,
1288 rt5640_sto_dac_r_mix
, ARRAY_SIZE(rt5640_sto_dac_r_mix
)),
1290 SND_SOC_DAPM_DAC("DAC R2", NULL
, SND_SOC_NOPM
, 0,
1292 SND_SOC_DAPM_DAC("DAC L2", NULL
, SND_SOC_NOPM
, 0,
1295 SND_SOC_DAPM_MIXER("OUT MIXL", RT5640_PWR_MIXER
, RT5640_PWR_OM_L_BIT
,
1296 0, rt5640_out_l_mix
, ARRAY_SIZE(rt5640_out_l_mix
)),
1297 SND_SOC_DAPM_MIXER("OUT MIXR", RT5640_PWR_MIXER
, RT5640_PWR_OM_R_BIT
,
1298 0, rt5640_out_r_mix
, ARRAY_SIZE(rt5640_out_r_mix
)),
1300 SND_SOC_DAPM_MIXER("HPO MIX L", SND_SOC_NOPM
, 0, 0,
1301 rt5640_hpo_mix
, ARRAY_SIZE(rt5640_hpo_mix
)),
1302 SND_SOC_DAPM_MIXER("HPO MIX R", SND_SOC_NOPM
, 0, 0,
1303 rt5640_hpo_mix
, ARRAY_SIZE(rt5640_hpo_mix
)),
1305 SND_SOC_DAPM_MIXER("Mono MIX", RT5640_PWR_ANLG1
, RT5640_PWR_MM_BIT
, 0,
1306 rt5640_mono_mix
, ARRAY_SIZE(rt5640_mono_mix
)),
1307 SND_SOC_DAPM_SUPPLY("Improve MONO Amp Drv", RT5640_PWR_ANLG1
,
1308 RT5640_PWR_MA_BIT
, 0, NULL
, 0),
1310 SND_SOC_DAPM_OUTPUT("MONOP"),
1311 SND_SOC_DAPM_OUTPUT("MONON"),
1314 static const struct snd_soc_dapm_widget rt5639_specific_dapm_widgets
[] = {
1315 SND_SOC_DAPM_MIXER("Stereo DAC MIXL", SND_SOC_NOPM
, 0, 0,
1316 rt5639_sto_dac_l_mix
, ARRAY_SIZE(rt5639_sto_dac_l_mix
)),
1317 SND_SOC_DAPM_MIXER("Stereo DAC MIXR", SND_SOC_NOPM
, 0, 0,
1318 rt5639_sto_dac_r_mix
, ARRAY_SIZE(rt5639_sto_dac_r_mix
)),
1320 SND_SOC_DAPM_MIXER("OUT MIXL", RT5640_PWR_MIXER
, RT5640_PWR_OM_L_BIT
,
1321 0, rt5639_out_l_mix
, ARRAY_SIZE(rt5639_out_l_mix
)),
1322 SND_SOC_DAPM_MIXER("OUT MIXR", RT5640_PWR_MIXER
, RT5640_PWR_OM_R_BIT
,
1323 0, rt5639_out_r_mix
, ARRAY_SIZE(rt5639_out_r_mix
)),
1325 SND_SOC_DAPM_MIXER("HPO MIX L", SND_SOC_NOPM
, 0, 0,
1326 rt5639_hpo_mix
, ARRAY_SIZE(rt5639_hpo_mix
)),
1327 SND_SOC_DAPM_MIXER("HPO MIX R", SND_SOC_NOPM
, 0, 0,
1328 rt5639_hpo_mix
, ARRAY_SIZE(rt5639_hpo_mix
)),
1331 static const struct snd_soc_dapm_route rt5640_dapm_routes
[] = {
1332 { "I2S1", NULL
, "Stereo Filter ASRC", is_using_asrc
},
1333 { "I2S2", NULL
, "I2S2 ASRC", is_using_asrc
},
1334 { "I2S2", NULL
, "I2S2 Filter ASRC", is_using_asrc
},
1335 { "DMIC1", NULL
, "DMIC1 ASRC", is_using_asrc
},
1336 { "DMIC2", NULL
, "DMIC2 ASRC", is_using_asrc
},
1338 {"IN1P", NULL
, "LDO2"},
1339 {"IN2P", NULL
, "LDO2"},
1340 {"IN3P", NULL
, "LDO2"},
1342 {"DMIC L1", NULL
, "DMIC1"},
1343 {"DMIC R1", NULL
, "DMIC1"},
1344 {"DMIC L2", NULL
, "DMIC2"},
1345 {"DMIC R2", NULL
, "DMIC2"},
1347 {"BST1", NULL
, "IN1P"},
1348 {"BST1", NULL
, "IN1N"},
1349 {"BST2", NULL
, "IN2P"},
1350 {"BST2", NULL
, "IN2N"},
1351 {"BST3", NULL
, "IN3P"},
1352 {"BST3", NULL
, "IN3N"},
1354 {"INL VOL", NULL
, "IN2P"},
1355 {"INR VOL", NULL
, "IN2N"},
1357 {"RECMIXL", "HPOL Switch", "HPOL"},
1358 {"RECMIXL", "INL Switch", "INL VOL"},
1359 {"RECMIXL", "BST3 Switch", "BST3"},
1360 {"RECMIXL", "BST2 Switch", "BST2"},
1361 {"RECMIXL", "BST1 Switch", "BST1"},
1362 {"RECMIXL", "OUT MIXL Switch", "OUT MIXL"},
1364 {"RECMIXR", "HPOR Switch", "HPOR"},
1365 {"RECMIXR", "INR Switch", "INR VOL"},
1366 {"RECMIXR", "BST3 Switch", "BST3"},
1367 {"RECMIXR", "BST2 Switch", "BST2"},
1368 {"RECMIXR", "BST1 Switch", "BST1"},
1369 {"RECMIXR", "OUT MIXR Switch", "OUT MIXR"},
1371 {"ADC L", NULL
, "RECMIXL"},
1372 {"ADC R", NULL
, "RECMIXR"},
1374 {"DMIC L1", NULL
, "DMIC CLK"},
1375 {"DMIC L1", NULL
, "DMIC1 Power"},
1376 {"DMIC R1", NULL
, "DMIC CLK"},
1377 {"DMIC R1", NULL
, "DMIC1 Power"},
1378 {"DMIC L2", NULL
, "DMIC CLK"},
1379 {"DMIC L2", NULL
, "DMIC2 Power"},
1380 {"DMIC R2", NULL
, "DMIC CLK"},
1381 {"DMIC R2", NULL
, "DMIC2 Power"},
1383 {"Stereo ADC L2 Mux", "DMIC1", "DMIC L1"},
1384 {"Stereo ADC L2 Mux", "DMIC2", "DMIC L2"},
1385 {"Stereo ADC L2 Mux", "DIG MIX", "DIG MIXL"},
1386 {"Stereo ADC L1 Mux", "ADC", "ADC L"},
1387 {"Stereo ADC L1 Mux", "DIG MIX", "DIG MIXL"},
1389 {"Stereo ADC R1 Mux", "ADC", "ADC R"},
1390 {"Stereo ADC R1 Mux", "DIG MIX", "DIG MIXR"},
1391 {"Stereo ADC R2 Mux", "DMIC1", "DMIC R1"},
1392 {"Stereo ADC R2 Mux", "DMIC2", "DMIC R2"},
1393 {"Stereo ADC R2 Mux", "DIG MIX", "DIG MIXR"},
1395 {"Mono ADC L2 Mux", "DMIC L1", "DMIC L1"},
1396 {"Mono ADC L2 Mux", "DMIC L2", "DMIC L2"},
1397 {"Mono ADC L2 Mux", "Mono DAC MIXL", "Mono DAC MIXL"},
1398 {"Mono ADC L1 Mux", "Mono DAC MIXL", "Mono DAC MIXL"},
1399 {"Mono ADC L1 Mux", "ADCL", "ADC L"},
1401 {"Mono ADC R1 Mux", "Mono DAC MIXR", "Mono DAC MIXR"},
1402 {"Mono ADC R1 Mux", "ADCR", "ADC R"},
1403 {"Mono ADC R2 Mux", "DMIC R1", "DMIC R1"},
1404 {"Mono ADC R2 Mux", "DMIC R2", "DMIC R2"},
1405 {"Mono ADC R2 Mux", "Mono DAC MIXR", "Mono DAC MIXR"},
1407 {"Stereo ADC MIXL", "ADC1 Switch", "Stereo ADC L1 Mux"},
1408 {"Stereo ADC MIXL", "ADC2 Switch", "Stereo ADC L2 Mux"},
1409 {"Stereo ADC MIXL", NULL
, "Stereo Filter"},
1411 {"Stereo ADC MIXR", "ADC1 Switch", "Stereo ADC R1 Mux"},
1412 {"Stereo ADC MIXR", "ADC2 Switch", "Stereo ADC R2 Mux"},
1413 {"Stereo ADC MIXR", NULL
, "Stereo Filter"},
1415 {"Mono ADC MIXL", "ADC1 Switch", "Mono ADC L1 Mux"},
1416 {"Mono ADC MIXL", "ADC2 Switch", "Mono ADC L2 Mux"},
1417 {"Mono ADC MIXL", NULL
, "Mono Left Filter"},
1419 {"Mono ADC MIXR", "ADC1 Switch", "Mono ADC R1 Mux"},
1420 {"Mono ADC MIXR", "ADC2 Switch", "Mono ADC R2 Mux"},
1421 {"Mono ADC MIXR", NULL
, "Mono Right Filter"},
1423 {"IF2 ADC L", NULL
, "Mono ADC MIXL"},
1424 {"IF2 ADC R", NULL
, "Mono ADC MIXR"},
1425 {"IF1 ADC L", NULL
, "Stereo ADC MIXL"},
1426 {"IF1 ADC R", NULL
, "Stereo ADC MIXR"},
1428 {"IF1 ADC", NULL
, "I2S1"},
1429 {"IF1 ADC", NULL
, "IF1 ADC L"},
1430 {"IF1 ADC", NULL
, "IF1 ADC R"},
1431 {"IF2 ADC", NULL
, "I2S2"},
1432 {"IF2 ADC", NULL
, "IF2 ADC L"},
1433 {"IF2 ADC", NULL
, "IF2 ADC R"},
1435 {"DAI1 TX Mux", "1:1|2:2", "IF1 ADC"},
1436 {"DAI1 TX Mux", "1:2|2:1", "IF2 ADC"},
1437 {"DAI1 IF1 Mux", "1:1|2:1", "IF1 ADC"},
1438 {"DAI1 IF2 Mux", "1:1|2:1", "IF2 ADC"},
1439 {"SDI1 TX Mux", "IF1", "DAI1 IF1 Mux"},
1440 {"SDI1 TX Mux", "IF2", "DAI1 IF2 Mux"},
1442 {"DAI2 TX Mux", "1:2|2:1", "IF1 ADC"},
1443 {"DAI2 TX Mux", "1:1|2:2", "IF2 ADC"},
1444 {"DAI2 IF1 Mux", "1:2|2:2", "IF1 ADC"},
1445 {"DAI2 IF2 Mux", "1:2|2:2", "IF2 ADC"},
1446 {"SDI2 TX Mux", "IF1", "DAI2 IF1 Mux"},
1447 {"SDI2 TX Mux", "IF2", "DAI2 IF2 Mux"},
1449 {"AIF1TX", NULL
, "DAI1 TX Mux"},
1450 {"AIF1TX", NULL
, "SDI1 TX Mux"},
1451 {"AIF2TX", NULL
, "DAI2 TX Mux"},
1452 {"AIF2TX", NULL
, "SDI2 TX Mux"},
1454 {"DAI1 RX Mux", "1:1|2:2", "AIF1RX"},
1455 {"DAI1 RX Mux", "1:1|2:1", "AIF1RX"},
1456 {"DAI1 RX Mux", "1:2|2:1", "AIF2RX"},
1457 {"DAI1 RX Mux", "1:2|2:2", "AIF2RX"},
1459 {"DAI2 RX Mux", "1:2|2:1", "AIF1RX"},
1460 {"DAI2 RX Mux", "1:1|2:1", "AIF1RX"},
1461 {"DAI2 RX Mux", "1:1|2:2", "AIF2RX"},
1462 {"DAI2 RX Mux", "1:2|2:2", "AIF2RX"},
1464 {"IF1 DAC", NULL
, "I2S1"},
1465 {"IF1 DAC", NULL
, "DAI1 RX Mux"},
1466 {"IF2 DAC", NULL
, "I2S2"},
1467 {"IF2 DAC", NULL
, "DAI2 RX Mux"},
1469 {"IF1 DAC L", NULL
, "IF1 DAC"},
1470 {"IF1 DAC R", NULL
, "IF1 DAC"},
1471 {"IF2 DAC L", NULL
, "IF2 DAC"},
1472 {"IF2 DAC R", NULL
, "IF2 DAC"},
1474 {"DAC MIXL", "Stereo ADC Switch", "Stereo ADC MIXL"},
1475 {"DAC MIXL", "INF1 Switch", "IF1 DAC L"},
1476 {"DAC MIXL", NULL
, "DAC L1 Power"},
1477 {"DAC MIXR", "Stereo ADC Switch", "Stereo ADC MIXR"},
1478 {"DAC MIXR", "INF1 Switch", "IF1 DAC R"},
1479 {"DAC MIXR", NULL
, "DAC R1 Power"},
1481 {"Stereo DAC MIXL", "DAC L1 Switch", "DAC MIXL"},
1482 {"Stereo DAC MIXR", "DAC R1 Switch", "DAC MIXR"},
1484 {"Mono DAC MIXL", "DAC L1 Switch", "DAC MIXL"},
1485 {"Mono DAC MIXR", "DAC R1 Switch", "DAC MIXR"},
1487 {"DIG MIXL", "DAC L1 Switch", "DAC MIXL"},
1488 {"DIG MIXR", "DAC R1 Switch", "DAC MIXR"},
1490 {"DAC L1", NULL
, "Stereo DAC MIXL"},
1491 {"DAC L1", NULL
, "DAC L1 Power"},
1492 {"DAC R1", NULL
, "Stereo DAC MIXR"},
1493 {"DAC R1", NULL
, "DAC R1 Power"},
1495 {"SPK MIXL", "REC MIXL Switch", "RECMIXL"},
1496 {"SPK MIXL", "INL Switch", "INL VOL"},
1497 {"SPK MIXL", "DAC L1 Switch", "DAC L1"},
1498 {"SPK MIXL", "OUT MIXL Switch", "OUT MIXL"},
1499 {"SPK MIXR", "REC MIXR Switch", "RECMIXR"},
1500 {"SPK MIXR", "INR Switch", "INR VOL"},
1501 {"SPK MIXR", "DAC R1 Switch", "DAC R1"},
1502 {"SPK MIXR", "OUT MIXR Switch", "OUT MIXR"},
1504 {"OUT MIXL", "BST1 Switch", "BST1"},
1505 {"OUT MIXL", "INL Switch", "INL VOL"},
1506 {"OUT MIXL", "REC MIXL Switch", "RECMIXL"},
1507 {"OUT MIXL", "DAC L1 Switch", "DAC L1"},
1509 {"OUT MIXR", "BST2 Switch", "BST2"},
1510 {"OUT MIXR", "BST1 Switch", "BST1"},
1511 {"OUT MIXR", "INR Switch", "INR VOL"},
1512 {"OUT MIXR", "REC MIXR Switch", "RECMIXR"},
1513 {"OUT MIXR", "DAC R1 Switch", "DAC R1"},
1515 {"SPKVOL L", NULL
, "SPK MIXL"},
1516 {"SPKVOL R", NULL
, "SPK MIXR"},
1517 {"HPOVOL L", NULL
, "OUT MIXL"},
1518 {"HPOVOL R", NULL
, "OUT MIXR"},
1519 {"OUTVOL L", NULL
, "OUT MIXL"},
1520 {"OUTVOL R", NULL
, "OUT MIXR"},
1522 {"SPOL MIX", "DAC R1 Switch", "DAC R1"},
1523 {"SPOL MIX", "DAC L1 Switch", "DAC L1"},
1524 {"SPOL MIX", "SPKVOL R Switch", "SPKVOL R"},
1525 {"SPOL MIX", "SPKVOL L Switch", "SPKVOL L"},
1526 {"SPOL MIX", "BST1 Switch", "BST1"},
1527 {"SPOR MIX", "DAC R1 Switch", "DAC R1"},
1528 {"SPOR MIX", "SPKVOL R Switch", "SPKVOL R"},
1529 {"SPOR MIX", "BST1 Switch", "BST1"},
1531 {"HPO MIX L", "HPO MIX DAC1 Switch", "DAC L1"},
1532 {"HPO MIX L", "HPO MIX HPVOL Switch", "HPOVOL L"},
1533 {"HPO MIX L", NULL
, "HP L Amp"},
1534 {"HPO MIX R", "HPO MIX DAC1 Switch", "DAC R1"},
1535 {"HPO MIX R", "HPO MIX HPVOL Switch", "HPOVOL R"},
1536 {"HPO MIX R", NULL
, "HP R Amp"},
1538 {"LOUT MIX", "DAC L1 Switch", "DAC L1"},
1539 {"LOUT MIX", "DAC R1 Switch", "DAC R1"},
1540 {"LOUT MIX", "OUTVOL L Switch", "OUTVOL L"},
1541 {"LOUT MIX", "OUTVOL R Switch", "OUTVOL R"},
1543 {"HP Amp", NULL
, "HPO MIX L"},
1544 {"HP Amp", NULL
, "HPO MIX R"},
1546 {"Speaker L Playback", "Switch", "SPOL MIX"},
1547 {"Speaker R Playback", "Switch", "SPOR MIX"},
1548 {"SPOLP", NULL
, "Speaker L Playback"},
1549 {"SPOLN", NULL
, "Speaker L Playback"},
1550 {"SPORP", NULL
, "Speaker R Playback"},
1551 {"SPORN", NULL
, "Speaker R Playback"},
1553 {"SPOLP", NULL
, "Improve SPK Amp Drv"},
1554 {"SPOLN", NULL
, "Improve SPK Amp Drv"},
1555 {"SPORP", NULL
, "Improve SPK Amp Drv"},
1556 {"SPORN", NULL
, "Improve SPK Amp Drv"},
1558 {"HPOL", NULL
, "Improve HP Amp Drv"},
1559 {"HPOR", NULL
, "Improve HP Amp Drv"},
1561 {"HP L Playback", "Switch", "HP Amp"},
1562 {"HP R Playback", "Switch", "HP Amp"},
1563 {"HPOL", NULL
, "HP L Playback"},
1564 {"HPOR", NULL
, "HP R Playback"},
1566 {"LOUT amp", NULL
, "LOUT MIX"},
1567 {"LOUTL", NULL
, "LOUT amp"},
1568 {"LOUTR", NULL
, "LOUT amp"},
1571 static const struct snd_soc_dapm_route rt5640_specific_dapm_routes
[] = {
1572 {"ANC", NULL
, "Stereo ADC MIXL"},
1573 {"ANC", NULL
, "Stereo ADC MIXR"},
1575 {"Audio DSP", NULL
, "DAC MIXL"},
1576 {"Audio DSP", NULL
, "DAC MIXR"},
1578 {"DAC L2 Mux", "IF2", "IF2 DAC L"},
1579 {"DAC L2 Mux", "Base L/R", "Audio DSP"},
1580 {"DAC L2 Mux", NULL
, "DAC L2 Power"},
1581 {"DAC R2 Mux", "IF2", "IF2 DAC R"},
1582 {"DAC R2 Mux", NULL
, "DAC R2 Power"},
1584 {"Stereo DAC MIXL", "DAC L2 Switch", "DAC L2 Mux"},
1585 {"Stereo DAC MIXL", "ANC Switch", "ANC"},
1586 {"Stereo DAC MIXR", "DAC R2 Switch", "DAC R2 Mux"},
1587 {"Stereo DAC MIXR", "ANC Switch", "ANC"},
1589 {"Mono DAC MIXL", "DAC L2 Switch", "DAC L2 Mux"},
1590 {"Mono DAC MIXL", "DAC R2 Switch", "DAC R2 Mux"},
1592 {"Mono DAC MIXR", "DAC R2 Switch", "DAC R2 Mux"},
1593 {"Mono DAC MIXR", "DAC L2 Switch", "DAC L2 Mux"},
1595 {"DIG MIXR", "DAC R2 Switch", "DAC R2 Mux"},
1596 {"DIG MIXL", "DAC L2 Switch", "DAC L2 Mux"},
1598 {"DAC L2", NULL
, "Mono DAC MIXL"},
1599 {"DAC L2", NULL
, "DAC L2 Power"},
1600 {"DAC R2", NULL
, "Mono DAC MIXR"},
1601 {"DAC R2", NULL
, "DAC R2 Power"},
1603 {"SPK MIXL", "DAC L2 Switch", "DAC L2"},
1604 {"SPK MIXR", "DAC R2 Switch", "DAC R2"},
1606 {"OUT MIXL", "SPK MIXL Switch", "SPK MIXL"},
1607 {"OUT MIXR", "SPK MIXR Switch", "SPK MIXR"},
1609 {"OUT MIXL", "DAC R2 Switch", "DAC R2"},
1610 {"OUT MIXL", "DAC L2 Switch", "DAC L2"},
1612 {"OUT MIXR", "DAC L2 Switch", "DAC L2"},
1613 {"OUT MIXR", "DAC R2 Switch", "DAC R2"},
1615 {"HPO MIX L", "HPO MIX DAC2 Switch", "DAC L2"},
1616 {"HPO MIX R", "HPO MIX DAC2 Switch", "DAC R2"},
1618 {"Mono MIX", "DAC R2 Switch", "DAC R2"},
1619 {"Mono MIX", "DAC L2 Switch", "DAC L2"},
1620 {"Mono MIX", "OUTVOL R Switch", "OUTVOL R"},
1621 {"Mono MIX", "OUTVOL L Switch", "OUTVOL L"},
1622 {"Mono MIX", "BST1 Switch", "BST1"},
1624 {"MONOP", NULL
, "Mono MIX"},
1625 {"MONON", NULL
, "Mono MIX"},
1626 {"MONOP", NULL
, "Improve MONO Amp Drv"},
1629 static const struct snd_soc_dapm_route rt5639_specific_dapm_routes
[] = {
1630 {"Stereo DAC MIXL", "DAC L2 Switch", "IF2 DAC L"},
1631 {"Stereo DAC MIXR", "DAC R2 Switch", "IF2 DAC R"},
1633 {"Mono DAC MIXL", "DAC L2 Switch", "IF2 DAC L"},
1634 {"Mono DAC MIXL", "DAC R2 Switch", "IF2 DAC R"},
1636 {"Mono DAC MIXR", "DAC R2 Switch", "IF2 DAC R"},
1637 {"Mono DAC MIXR", "DAC L2 Switch", "IF2 DAC L"},
1639 {"DIG MIXL", "DAC L2 Switch", "IF2 DAC L"},
1640 {"DIG MIXR", "DAC R2 Switch", "IF2 DAC R"},
1642 {"IF2 DAC L", NULL
, "DAC L2 Power"},
1643 {"IF2 DAC R", NULL
, "DAC R2 Power"},
1646 static int get_sdp_info(struct snd_soc_component
*component
, int dai_id
)
1650 if (component
== NULL
)
1653 val
= snd_soc_component_read(component
, RT5640_I2S1_SDP
);
1654 val
= (val
& RT5640_I2S_IF_MASK
) >> RT5640_I2S_IF_SFT
;
1660 ret
|= RT5640_U_IF1
;
1663 ret
|= RT5640_U_IF1
;
1667 ret
|= RT5640_U_IF2
;
1676 ret
|= RT5640_U_IF1
;
1679 ret
|= RT5640_U_IF1
;
1683 ret
|= RT5640_U_IF2
;
1696 static int rt5640_hw_params(struct snd_pcm_substream
*substream
,
1697 struct snd_pcm_hw_params
*params
, struct snd_soc_dai
*dai
)
1699 struct snd_soc_component
*component
= dai
->component
;
1700 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
1701 unsigned int val_len
= 0, val_clk
, mask_clk
;
1702 int dai_sel
, pre_div
, bclk_ms
, frame_size
;
1704 rt5640
->lrck
[dai
->id
] = params_rate(params
);
1705 pre_div
= rl6231_get_clk_info(rt5640
->sysclk
, rt5640
->lrck
[dai
->id
]);
1707 dev_err(component
->dev
, "Unsupported clock setting %d for DAI %d\n",
1708 rt5640
->lrck
[dai
->id
], dai
->id
);
1711 frame_size
= snd_soc_params_to_frame_size(params
);
1712 if (frame_size
< 0) {
1713 dev_err(component
->dev
, "Unsupported frame size: %d\n", frame_size
);
1716 if (frame_size
> 32)
1720 rt5640
->bclk
[dai
->id
] = rt5640
->lrck
[dai
->id
] * (32 << bclk_ms
);
1722 dev_dbg(dai
->dev
, "bclk is %dHz and lrck is %dHz\n",
1723 rt5640
->bclk
[dai
->id
], rt5640
->lrck
[dai
->id
]);
1724 dev_dbg(dai
->dev
, "bclk_ms is %d and pre_div is %d for iis %d\n",
1725 bclk_ms
, pre_div
, dai
->id
);
1727 switch (params_width(params
)) {
1731 val_len
|= RT5640_I2S_DL_20
;
1734 val_len
|= RT5640_I2S_DL_24
;
1737 val_len
|= RT5640_I2S_DL_8
;
1743 dai_sel
= get_sdp_info(component
, dai
->id
);
1745 dev_err(component
->dev
, "Failed to get sdp info: %d\n", dai_sel
);
1748 if (dai_sel
& RT5640_U_IF1
) {
1749 mask_clk
= RT5640_I2S_BCLK_MS1_MASK
| RT5640_I2S_PD1_MASK
;
1750 val_clk
= bclk_ms
<< RT5640_I2S_BCLK_MS1_SFT
|
1751 pre_div
<< RT5640_I2S_PD1_SFT
;
1752 snd_soc_component_update_bits(component
, RT5640_I2S1_SDP
,
1753 RT5640_I2S_DL_MASK
, val_len
);
1754 snd_soc_component_update_bits(component
, RT5640_ADDA_CLK1
, mask_clk
, val_clk
);
1756 if (dai_sel
& RT5640_U_IF2
) {
1757 mask_clk
= RT5640_I2S_BCLK_MS2_MASK
| RT5640_I2S_PD2_MASK
;
1758 val_clk
= bclk_ms
<< RT5640_I2S_BCLK_MS2_SFT
|
1759 pre_div
<< RT5640_I2S_PD2_SFT
;
1760 snd_soc_component_update_bits(component
, RT5640_I2S2_SDP
,
1761 RT5640_I2S_DL_MASK
, val_len
);
1762 snd_soc_component_update_bits(component
, RT5640_ADDA_CLK1
, mask_clk
, val_clk
);
1768 static int rt5640_set_dai_fmt(struct snd_soc_dai
*dai
, unsigned int fmt
)
1770 struct snd_soc_component
*component
= dai
->component
;
1771 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
1772 unsigned int reg_val
= 0;
1775 switch (fmt
& SND_SOC_DAIFMT_MASTER_MASK
) {
1776 case SND_SOC_DAIFMT_CBM_CFM
:
1777 rt5640
->master
[dai
->id
] = 1;
1779 case SND_SOC_DAIFMT_CBS_CFS
:
1780 reg_val
|= RT5640_I2S_MS_S
;
1781 rt5640
->master
[dai
->id
] = 0;
1787 switch (fmt
& SND_SOC_DAIFMT_INV_MASK
) {
1788 case SND_SOC_DAIFMT_NB_NF
:
1790 case SND_SOC_DAIFMT_IB_NF
:
1791 reg_val
|= RT5640_I2S_BP_INV
;
1797 switch (fmt
& SND_SOC_DAIFMT_FORMAT_MASK
) {
1798 case SND_SOC_DAIFMT_I2S
:
1800 case SND_SOC_DAIFMT_LEFT_J
:
1801 reg_val
|= RT5640_I2S_DF_LEFT
;
1803 case SND_SOC_DAIFMT_DSP_A
:
1804 reg_val
|= RT5640_I2S_DF_PCM_A
;
1806 case SND_SOC_DAIFMT_DSP_B
:
1807 reg_val
|= RT5640_I2S_DF_PCM_B
;
1813 dai_sel
= get_sdp_info(component
, dai
->id
);
1815 dev_err(component
->dev
, "Failed to get sdp info: %d\n", dai_sel
);
1818 if (dai_sel
& RT5640_U_IF1
) {
1819 snd_soc_component_update_bits(component
, RT5640_I2S1_SDP
,
1820 RT5640_I2S_MS_MASK
| RT5640_I2S_BP_MASK
|
1821 RT5640_I2S_DF_MASK
, reg_val
);
1823 if (dai_sel
& RT5640_U_IF2
) {
1824 snd_soc_component_update_bits(component
, RT5640_I2S2_SDP
,
1825 RT5640_I2S_MS_MASK
| RT5640_I2S_BP_MASK
|
1826 RT5640_I2S_DF_MASK
, reg_val
);
1832 static int rt5640_set_dai_sysclk(struct snd_soc_dai
*dai
,
1833 int clk_id
, unsigned int freq
, int dir
)
1835 struct snd_soc_component
*component
= dai
->component
;
1836 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
1837 unsigned int reg_val
= 0;
1838 unsigned int pll_bit
= 0;
1842 case RT5640_SCLK_S_MCLK
:
1843 ret
= clk_set_rate(rt5640
->mclk
, freq
);
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
, "Unsupported 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 if (rt5640
->jd_src
== RT5640_JD_SRC_HDA_HEADER
)
1991 snd_soc_component_write(component
, RT5640_PWR_ANLG1
,
1994 snd_soc_component_write(component
, RT5640_PWR_ANLG1
,
1996 snd_soc_component_write(component
, RT5640_PWR_ANLG2
, 0x0000);
2006 int rt5640_dmic_enable(struct snd_soc_component
*component
,
2007 bool dmic1_data_pin
, bool dmic2_data_pin
)
2009 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2011 regmap_update_bits(rt5640
->regmap
, RT5640_GPIO_CTRL1
,
2012 RT5640_GP2_PIN_MASK
, RT5640_GP2_PIN_DMIC1_SCL
);
2014 if (dmic1_data_pin
) {
2015 regmap_update_bits(rt5640
->regmap
, RT5640_DMIC
,
2016 RT5640_DMIC_1_DP_MASK
, RT5640_DMIC_1_DP_GPIO3
);
2017 regmap_update_bits(rt5640
->regmap
, RT5640_GPIO_CTRL1
,
2018 RT5640_GP3_PIN_MASK
, RT5640_GP3_PIN_DMIC1_SDA
);
2021 if (dmic2_data_pin
) {
2022 regmap_update_bits(rt5640
->regmap
, RT5640_DMIC
,
2023 RT5640_DMIC_2_DP_MASK
, RT5640_DMIC_2_DP_GPIO4
);
2024 regmap_update_bits(rt5640
->regmap
, RT5640_GPIO_CTRL1
,
2025 RT5640_GP4_PIN_MASK
, RT5640_GP4_PIN_DMIC2_SDA
);
2030 EXPORT_SYMBOL_GPL(rt5640_dmic_enable
);
2032 int rt5640_sel_asrc_clk_src(struct snd_soc_component
*component
,
2033 unsigned int filter_mask
, unsigned int clk_src
)
2035 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2036 unsigned int asrc2_mask
= 0;
2037 unsigned int asrc2_value
= 0;
2040 case RT5640_CLK_SEL_SYS
:
2041 case RT5640_CLK_SEL_ASRC
:
2051 if (filter_mask
& RT5640_DA_STEREO_FILTER
) {
2052 asrc2_mask
|= RT5640_STO_DAC_M_MASK
;
2053 asrc2_value
= (asrc2_value
& ~RT5640_STO_DAC_M_MASK
)
2054 | (clk_src
<< RT5640_STO_DAC_M_SFT
);
2057 if (filter_mask
& RT5640_DA_MONO_L_FILTER
) {
2058 asrc2_mask
|= RT5640_MDA_L_M_MASK
;
2059 asrc2_value
= (asrc2_value
& ~RT5640_MDA_L_M_MASK
)
2060 | (clk_src
<< RT5640_MDA_L_M_SFT
);
2063 if (filter_mask
& RT5640_DA_MONO_R_FILTER
) {
2064 asrc2_mask
|= RT5640_MDA_R_M_MASK
;
2065 asrc2_value
= (asrc2_value
& ~RT5640_MDA_R_M_MASK
)
2066 | (clk_src
<< RT5640_MDA_R_M_SFT
);
2069 if (filter_mask
& RT5640_AD_STEREO_FILTER
) {
2070 asrc2_mask
|= RT5640_ADC_M_MASK
;
2071 asrc2_value
= (asrc2_value
& ~RT5640_ADC_M_MASK
)
2072 | (clk_src
<< RT5640_ADC_M_SFT
);
2075 if (filter_mask
& RT5640_AD_MONO_L_FILTER
) {
2076 asrc2_mask
|= RT5640_MAD_L_M_MASK
;
2077 asrc2_value
= (asrc2_value
& ~RT5640_MAD_L_M_MASK
)
2078 | (clk_src
<< RT5640_MAD_L_M_SFT
);
2081 if (filter_mask
& RT5640_AD_MONO_R_FILTER
) {
2082 asrc2_mask
|= RT5640_MAD_R_M_MASK
;
2083 asrc2_value
= (asrc2_value
& ~RT5640_MAD_R_M_MASK
)
2084 | (clk_src
<< RT5640_MAD_R_M_SFT
);
2087 snd_soc_component_update_bits(component
, RT5640_ASRC_2
,
2088 asrc2_mask
, asrc2_value
);
2090 if (snd_soc_component_read(component
, RT5640_ASRC_2
)) {
2091 rt5640
->asrc_en
= true;
2092 snd_soc_component_update_bits(component
, RT5640_JD_CTRL
, 0x3, 0x3);
2094 rt5640
->asrc_en
= false;
2095 snd_soc_component_update_bits(component
, RT5640_JD_CTRL
, 0x3, 0x0);
2100 EXPORT_SYMBOL_GPL(rt5640_sel_asrc_clk_src
);
2102 void rt5640_enable_micbias1_for_ovcd(struct snd_soc_component
*component
)
2104 struct snd_soc_dapm_context
*dapm
= snd_soc_component_get_dapm(component
);
2105 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2107 snd_soc_dapm_mutex_lock(dapm
);
2108 snd_soc_dapm_force_enable_pin_unlocked(dapm
, "LDO2");
2109 snd_soc_dapm_force_enable_pin_unlocked(dapm
, "MICBIAS1");
2110 /* OVCD is unreliable when used with RCCLK as sysclk-source */
2111 if (rt5640
->use_platform_clock
)
2112 snd_soc_dapm_force_enable_pin_unlocked(dapm
, "Platform Clock");
2113 snd_soc_dapm_sync_unlocked(dapm
);
2114 snd_soc_dapm_mutex_unlock(dapm
);
2116 EXPORT_SYMBOL_GPL(rt5640_enable_micbias1_for_ovcd
);
2118 void rt5640_disable_micbias1_for_ovcd(struct snd_soc_component
*component
)
2120 struct snd_soc_dapm_context
*dapm
= snd_soc_component_get_dapm(component
);
2121 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2123 snd_soc_dapm_mutex_lock(dapm
);
2124 if (rt5640
->use_platform_clock
)
2125 snd_soc_dapm_disable_pin_unlocked(dapm
, "Platform Clock");
2126 snd_soc_dapm_disable_pin_unlocked(dapm
, "MICBIAS1");
2127 snd_soc_dapm_disable_pin_unlocked(dapm
, "LDO2");
2128 snd_soc_dapm_sync_unlocked(dapm
);
2129 snd_soc_dapm_mutex_unlock(dapm
);
2131 EXPORT_SYMBOL_GPL(rt5640_disable_micbias1_for_ovcd
);
2133 static void rt5640_enable_micbias1_ovcd_irq(struct snd_soc_component
*component
)
2135 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2137 snd_soc_component_update_bits(component
, RT5640_IRQ_CTRL2
,
2138 RT5640_IRQ_MB1_OC_MASK
, RT5640_IRQ_MB1_OC_NOR
);
2139 rt5640
->ovcd_irq_enabled
= true;
2142 static void rt5640_disable_micbias1_ovcd_irq(struct snd_soc_component
*component
)
2144 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2146 snd_soc_component_update_bits(component
, RT5640_IRQ_CTRL2
,
2147 RT5640_IRQ_MB1_OC_MASK
, RT5640_IRQ_MB1_OC_BP
);
2148 rt5640
->ovcd_irq_enabled
= false;
2151 static void rt5640_clear_micbias1_ovcd(struct snd_soc_component
*component
)
2153 snd_soc_component_update_bits(component
, RT5640_IRQ_CTRL2
,
2154 RT5640_MB1_OC_STATUS
, 0);
2157 static bool rt5640_micbias1_ovcd(struct snd_soc_component
*component
)
2161 val
= snd_soc_component_read(component
, RT5640_IRQ_CTRL2
);
2162 dev_dbg(component
->dev
, "irq ctrl2 %#04x\n", val
);
2164 return (val
& RT5640_MB1_OC_STATUS
);
2167 static bool rt5640_jack_inserted(struct snd_soc_component
*component
)
2169 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2172 if (rt5640
->jd_gpio
)
2173 val
= gpiod_get_value(rt5640
->jd_gpio
) ? RT5640_JD_STATUS
: 0;
2175 val
= snd_soc_component_read(component
, RT5640_INT_IRQ_ST
);
2177 dev_dbg(component
->dev
, "irq status %#04x\n", val
);
2179 if (rt5640
->jd_inverted
)
2180 return !(val
& RT5640_JD_STATUS
);
2182 return (val
& RT5640_JD_STATUS
);
2185 /* Jack detect and button-press timings */
2186 #define JACK_SETTLE_TIME 100 /* milli seconds */
2187 #define JACK_DETECT_COUNT 5
2188 #define JACK_DETECT_MAXCOUNT 20 /* Aprox. 2 seconds worth of tries */
2189 #define JACK_UNPLUG_TIME 80 /* milli seconds */
2190 #define BP_POLL_TIME 10 /* milli seconds */
2191 #define BP_POLL_MAXCOUNT 200 /* assume something is wrong after this */
2192 #define BP_THRESHOLD 3
2194 static void rt5640_start_button_press_work(struct snd_soc_component
*component
)
2196 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2198 rt5640
->poll_count
= 0;
2199 rt5640
->press_count
= 0;
2200 rt5640
->release_count
= 0;
2201 rt5640
->pressed
= false;
2202 rt5640
->press_reported
= false;
2203 rt5640_clear_micbias1_ovcd(component
);
2204 schedule_delayed_work(&rt5640
->bp_work
, msecs_to_jiffies(BP_POLL_TIME
));
2207 static void rt5640_button_press_work(struct work_struct
*work
)
2209 struct rt5640_priv
*rt5640
=
2210 container_of(work
, struct rt5640_priv
, bp_work
.work
);
2211 struct snd_soc_component
*component
= rt5640
->component
;
2213 /* Check the jack was not removed underneath us */
2214 if (!rt5640_jack_inserted(component
))
2217 if (rt5640_micbias1_ovcd(component
)) {
2218 rt5640
->release_count
= 0;
2219 rt5640
->press_count
++;
2220 /* Remember till after JACK_UNPLUG_TIME wait */
2221 if (rt5640
->press_count
>= BP_THRESHOLD
)
2222 rt5640
->pressed
= true;
2223 rt5640_clear_micbias1_ovcd(component
);
2225 rt5640
->press_count
= 0;
2226 rt5640
->release_count
++;
2230 * The pins get temporarily shorted on jack unplug, so we poll for
2231 * at least JACK_UNPLUG_TIME milli-seconds before reporting a press.
2233 rt5640
->poll_count
++;
2234 if (rt5640
->poll_count
< (JACK_UNPLUG_TIME
/ BP_POLL_TIME
)) {
2235 schedule_delayed_work(&rt5640
->bp_work
,
2236 msecs_to_jiffies(BP_POLL_TIME
));
2240 if (rt5640
->pressed
&& !rt5640
->press_reported
) {
2241 dev_dbg(component
->dev
, "headset button press\n");
2242 snd_soc_jack_report(rt5640
->jack
, SND_JACK_BTN_0
,
2244 rt5640
->press_reported
= true;
2247 if (rt5640
->release_count
>= BP_THRESHOLD
) {
2248 if (rt5640
->press_reported
) {
2249 dev_dbg(component
->dev
, "headset button release\n");
2250 snd_soc_jack_report(rt5640
->jack
, 0, SND_JACK_BTN_0
);
2252 /* Re-enable OVCD IRQ to detect next press */
2253 rt5640_enable_micbias1_ovcd_irq(component
);
2254 return; /* Stop polling */
2257 schedule_delayed_work(&rt5640
->bp_work
, msecs_to_jiffies(BP_POLL_TIME
));
2260 int rt5640_detect_headset(struct snd_soc_component
*component
, struct gpio_desc
*hp_det_gpio
)
2262 int i
, headset_count
= 0, headphone_count
= 0;
2265 * We get the insertion event before the jack is fully inserted at which
2266 * point the second ring on a TRRS connector may short the 2nd ring and
2267 * sleeve contacts, also the overcurrent detection is not entirely
2268 * reliable. So we try several times with a wait in between until we
2269 * detect the same type JACK_DETECT_COUNT times in a row.
2271 for (i
= 0; i
< JACK_DETECT_MAXCOUNT
; i
++) {
2272 /* Clear any previous over-current status flag */
2273 rt5640_clear_micbias1_ovcd(component
);
2275 msleep(JACK_SETTLE_TIME
);
2277 /* Check the jack is still connected before checking ovcd */
2279 if (gpiod_get_value_cansleep(hp_det_gpio
))
2282 if (!rt5640_jack_inserted(component
))
2286 if (rt5640_micbias1_ovcd(component
)) {
2288 * Over current detected, there is a short between the
2289 * 2nd ring contact and the ground, so a TRS connector
2290 * without a mic contact and thus plain headphones.
2292 dev_dbg(component
->dev
, "jack mic-gnd shorted\n");
2295 if (headphone_count
== JACK_DETECT_COUNT
)
2296 return SND_JACK_HEADPHONE
;
2298 dev_dbg(component
->dev
, "jack mic-gnd open\n");
2299 headphone_count
= 0;
2301 if (headset_count
== JACK_DETECT_COUNT
)
2302 return SND_JACK_HEADSET
;
2306 dev_err(component
->dev
, "Error detecting headset vs headphones, bad contact?, assuming headphones\n");
2307 return SND_JACK_HEADPHONE
;
2309 EXPORT_SYMBOL_GPL(rt5640_detect_headset
);
2311 static void rt5640_jack_work(struct work_struct
*work
)
2313 struct rt5640_priv
*rt5640
=
2314 container_of(work
, struct rt5640_priv
, jack_work
.work
);
2315 struct snd_soc_component
*component
= rt5640
->component
;
2318 if (rt5640
->jd_src
== RT5640_JD_SRC_HDA_HEADER
) {
2319 int val
, jack_type
= 0, hda_mic_plugged
, hda_hp_plugged
;
2322 val
= snd_soc_component_read(component
, RT5640_INT_IRQ_ST
);
2323 hda_mic_plugged
= !(val
& RT5640_JD_STATUS
);
2324 dev_dbg(component
->dev
, "mic jack status %d\n",
2327 snd_soc_component_update_bits(component
, RT5640_IRQ_CTRL1
,
2328 RT5640_JD_P_MASK
, !hda_mic_plugged
<< RT5640_JD_P_SFT
);
2330 if (hda_mic_plugged
)
2331 jack_type
|= SND_JACK_MICROPHONE
;
2333 /* headphone jack */
2334 val
= snd_soc_component_read(component
, RT5640_DUMMY2
);
2335 hda_hp_plugged
= !(val
& (0x1 << 11));
2336 dev_dbg(component
->dev
, "headphone jack status %d\n",
2339 snd_soc_component_update_bits(component
, RT5640_DUMMY2
,
2340 (0x1 << 10), !hda_hp_plugged
<< 10);
2343 jack_type
|= SND_JACK_HEADPHONE
;
2345 snd_soc_jack_report(rt5640
->jack
, jack_type
, SND_JACK_HEADSET
);
2350 if (!rt5640_jack_inserted(component
)) {
2351 /* Jack removed, or spurious IRQ? */
2352 if (rt5640
->jack
->status
& SND_JACK_HEADPHONE
) {
2353 if (rt5640
->jack
->status
& SND_JACK_MICROPHONE
) {
2354 cancel_delayed_work_sync(&rt5640
->bp_work
);
2355 rt5640_disable_micbias1_ovcd_irq(component
);
2356 rt5640_disable_micbias1_for_ovcd(component
);
2358 snd_soc_jack_report(rt5640
->jack
, 0,
2359 SND_JACK_HEADSET
| SND_JACK_BTN_0
);
2360 dev_dbg(component
->dev
, "jack unplugged\n");
2362 } else if (!(rt5640
->jack
->status
& SND_JACK_HEADPHONE
)) {
2364 WARN_ON(rt5640
->ovcd_irq_enabled
);
2365 rt5640_enable_micbias1_for_ovcd(component
);
2366 status
= rt5640_detect_headset(component
, NULL
);
2367 if (status
== SND_JACK_HEADSET
) {
2368 /* Enable ovcd IRQ for button press detect. */
2369 rt5640_enable_micbias1_ovcd_irq(component
);
2371 /* No more need for overcurrent detect. */
2372 rt5640_disable_micbias1_for_ovcd(component
);
2374 dev_dbg(component
->dev
, "detect status %#02x\n", status
);
2375 snd_soc_jack_report(rt5640
->jack
, status
, SND_JACK_HEADSET
);
2376 } else if (rt5640
->ovcd_irq_enabled
&& rt5640_micbias1_ovcd(component
)) {
2377 dev_dbg(component
->dev
, "OVCD IRQ\n");
2380 * The ovcd IRQ keeps firing while the button is pressed, so
2381 * we disable it and start polling the button until released.
2383 * The disable will make the IRQ pin 0 again and since we get
2384 * IRQs on both edges (so as to detect both jack plugin and
2385 * unplug) this means we will immediately get another IRQ.
2386 * The ovcd_irq_enabled check above makes the 2ND IRQ a NOP.
2388 rt5640_disable_micbias1_ovcd_irq(component
);
2389 rt5640_start_button_press_work(component
);
2392 * If the jack-detect IRQ flag goes high (unplug) after our
2393 * above rt5640_jack_inserted() check and before we have
2394 * disabled the OVCD IRQ, the IRQ pin will stay high and as
2395 * we react to edges, we miss the unplug event -> recheck.
2397 queue_delayed_work(system_long_wq
, &rt5640
->jack_work
, 0);
2401 static irqreturn_t
rt5640_irq(int irq
, void *data
)
2403 struct rt5640_priv
*rt5640
= data
;
2406 if (rt5640
->jd_src
== RT5640_JD_SRC_HDA_HEADER
) {
2407 cancel_delayed_work_sync(&rt5640
->jack_work
);
2412 queue_delayed_work(system_long_wq
, &rt5640
->jack_work
, delay
);
2417 static irqreturn_t
rt5640_jd_gpio_irq(int irq
, void *data
)
2419 struct rt5640_priv
*rt5640
= data
;
2421 queue_delayed_work(system_long_wq
, &rt5640
->jack_work
,
2422 msecs_to_jiffies(JACK_SETTLE_TIME
));
2427 static void rt5640_cancel_work(void *data
)
2429 struct rt5640_priv
*rt5640
= data
;
2431 cancel_delayed_work_sync(&rt5640
->jack_work
);
2432 cancel_delayed_work_sync(&rt5640
->bp_work
);
2435 void rt5640_set_ovcd_params(struct snd_soc_component
*component
)
2437 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2439 snd_soc_component_write(component
, RT5640_PR_BASE
+ RT5640_BIAS_CUR4
,
2440 0xa800 | rt5640
->ovcd_sf
);
2442 snd_soc_component_update_bits(component
, RT5640_MICBIAS
,
2443 RT5640_MIC1_OVTH_MASK
| RT5640_MIC1_OVCD_MASK
,
2444 rt5640
->ovcd_th
| RT5640_MIC1_OVCD_EN
);
2447 * The over-current-detect is only reliable in detecting the absence
2448 * of over-current, when the mic-contact in the jack is short-circuited,
2449 * the hardware periodically retries if it can apply the bias-current
2450 * leading to the ovcd status flip-flopping 1-0-1 with it being 0 about
2451 * 10% of the time, as we poll the ovcd status bit we might hit that
2452 * 10%, so we enable sticky mode and when checking OVCD we clear the
2453 * status, msleep() a bit and then check to get a reliable reading.
2455 snd_soc_component_update_bits(component
, RT5640_IRQ_CTRL2
,
2456 RT5640_MB1_OC_STKY_MASK
, RT5640_MB1_OC_STKY_EN
);
2458 EXPORT_SYMBOL_GPL(rt5640_set_ovcd_params
);
2460 static void rt5640_disable_jack_detect(struct snd_soc_component
*component
)
2462 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2465 * soc_remove_component() force-disables jack and thus rt5640->jack
2466 * could be NULL at the time of driver's module unloading.
2471 if (rt5640
->jd_gpio_irq_requested
)
2472 free_irq(rt5640
->jd_gpio_irq
, rt5640
);
2474 if (rt5640
->irq_requested
)
2475 free_irq(rt5640
->irq
, rt5640
);
2477 rt5640_cancel_work(rt5640
);
2479 if (rt5640
->jack
->status
& SND_JACK_MICROPHONE
) {
2480 rt5640_disable_micbias1_ovcd_irq(component
);
2481 rt5640_disable_micbias1_for_ovcd(component
);
2482 snd_soc_jack_report(rt5640
->jack
, 0, SND_JACK_BTN_0
);
2485 rt5640
->jd_gpio_irq_requested
= false;
2486 rt5640
->irq_requested
= false;
2487 rt5640
->jd_gpio
= NULL
;
2488 rt5640
->jack
= NULL
;
2491 static void rt5640_enable_jack_detect(struct snd_soc_component
*component
,
2492 struct snd_soc_jack
*jack
,
2493 struct rt5640_set_jack_data
*jack_data
)
2495 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2498 /* Select JD-source */
2499 snd_soc_component_update_bits(component
, RT5640_JD_CTRL
,
2500 RT5640_JD_MASK
, rt5640
->jd_src
<< RT5640_JD_SFT
);
2502 /* Selecting GPIO01 as an interrupt */
2503 snd_soc_component_update_bits(component
, RT5640_GPIO_CTRL1
,
2504 RT5640_GP1_PIN_MASK
, RT5640_GP1_PIN_IRQ
);
2506 /* Set GPIO1 output */
2507 snd_soc_component_update_bits(component
, RT5640_GPIO_CTRL3
,
2508 RT5640_GP1_PF_MASK
, RT5640_GP1_PF_OUT
);
2510 snd_soc_component_write(component
, RT5640_DUMMY1
, 0x3f41);
2512 rt5640_set_ovcd_params(component
);
2515 * All IRQs get or-ed together, so we need the jack IRQ to report 0
2516 * when a jack is inserted so that the OVCD IRQ then toggles the IRQ
2517 * pin 0/1 instead of it being stuck to 1. So we invert the JD polarity
2518 * on systems where the hardware does not already do this.
2520 if (rt5640
->jd_inverted
) {
2521 if (rt5640
->jd_src
== RT5640_JD_SRC_JD1_IN4P
)
2522 snd_soc_component_write(component
, RT5640_IRQ_CTRL1
,
2524 else if (rt5640
->jd_src
== RT5640_JD_SRC_JD2_IN4N
)
2525 snd_soc_component_update_bits(component
, RT5640_DUMMY2
,
2526 RT5640_IRQ_JD2_MASK
| RT5640_JD2_MASK
,
2527 RT5640_IRQ_JD2_NOR
| RT5640_JD2_EN
);
2529 if (rt5640
->jd_src
== RT5640_JD_SRC_JD1_IN4P
)
2530 snd_soc_component_write(component
, RT5640_IRQ_CTRL1
,
2531 RT5640_IRQ_JD_NOR
| RT5640_JD_P_INV
);
2532 else if (rt5640
->jd_src
== RT5640_JD_SRC_JD2_IN4N
)
2533 snd_soc_component_update_bits(component
, RT5640_DUMMY2
,
2534 RT5640_IRQ_JD2_MASK
| RT5640_JD2_P_MASK
|
2536 RT5640_IRQ_JD2_NOR
| RT5640_JD2_P_INV
|
2540 rt5640
->jack
= jack
;
2541 if (rt5640
->jack
->status
& SND_JACK_MICROPHONE
) {
2542 rt5640_enable_micbias1_for_ovcd(component
);
2543 rt5640_enable_micbias1_ovcd_irq(component
);
2546 if (jack_data
&& jack_data
->codec_irq_override
)
2547 rt5640
->irq
= jack_data
->codec_irq_override
;
2549 if (jack_data
&& jack_data
->jd_gpio
) {
2550 rt5640
->jd_gpio
= jack_data
->jd_gpio
;
2551 rt5640
->jd_gpio_irq
= gpiod_to_irq(rt5640
->jd_gpio
);
2553 ret
= request_irq(rt5640
->jd_gpio_irq
, rt5640_jd_gpio_irq
,
2554 IRQF_TRIGGER_RISING
| IRQF_TRIGGER_FALLING
,
2555 "rt5640-jd-gpio", rt5640
);
2557 dev_warn(component
->dev
, "Failed to request jd GPIO IRQ %d: %d\n",
2558 rt5640
->jd_gpio_irq
, ret
);
2559 rt5640_disable_jack_detect(component
);
2562 rt5640
->jd_gpio_irq_requested
= true;
2565 if (jack_data
&& jack_data
->use_platform_clock
)
2566 rt5640
->use_platform_clock
= jack_data
->use_platform_clock
;
2568 ret
= devm_request_threaded_irq(component
->dev
, rt5640
->irq
,
2570 IRQF_TRIGGER_RISING
| IRQF_TRIGGER_FALLING
| IRQF_ONESHOT
,
2573 dev_warn(component
->dev
, "Failed to request IRQ %d: %d\n", rt5640
->irq
, ret
);
2574 rt5640_disable_jack_detect(component
);
2577 rt5640
->irq_requested
= true;
2579 /* sync initial jack state */
2580 queue_delayed_work(system_long_wq
, &rt5640
->jack_work
, 0);
2583 static const struct snd_soc_dapm_route rt5640_hda_jack_dapm_routes
[] = {
2584 {"IN1P", NULL
, "MICBIAS1"},
2585 {"IN2P", NULL
, "MICBIAS1"},
2586 {"IN3P", NULL
, "MICBIAS1"},
2589 static void rt5640_enable_hda_jack_detect(
2590 struct snd_soc_component
*component
, struct snd_soc_jack
*jack
)
2592 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2593 struct snd_soc_dapm_context
*dapm
=
2594 snd_soc_component_get_dapm(component
);
2597 /* Select JD1 for Mic */
2598 snd_soc_component_update_bits(component
, RT5640_JD_CTRL
,
2599 RT5640_JD_MASK
, RT5640_JD_JD1_IN4P
);
2600 snd_soc_component_write(component
, RT5640_IRQ_CTRL1
, RT5640_IRQ_JD_NOR
);
2602 /* Select JD2 for Headphone */
2603 snd_soc_component_update_bits(component
, RT5640_DUMMY2
, 0x1100, 0x1100);
2605 /* Selecting GPIO01 as an interrupt */
2606 snd_soc_component_update_bits(component
, RT5640_GPIO_CTRL1
,
2607 RT5640_GP1_PIN_MASK
, RT5640_GP1_PIN_IRQ
);
2609 /* Set GPIO1 output */
2610 snd_soc_component_update_bits(component
, RT5640_GPIO_CTRL3
,
2611 RT5640_GP1_PF_MASK
, RT5640_GP1_PF_OUT
);
2613 snd_soc_component_update_bits(component
, RT5640_DUMMY1
, 0x400, 0x0);
2615 snd_soc_component_update_bits(component
, RT5640_PWR_ANLG1
,
2616 RT5640_PWR_VREF2
| RT5640_PWR_MB
| RT5640_PWR_BG
,
2617 RT5640_PWR_VREF2
| RT5640_PWR_MB
| RT5640_PWR_BG
);
2618 usleep_range(10000, 15000);
2619 snd_soc_component_update_bits(component
, RT5640_PWR_ANLG1
,
2620 RT5640_PWR_FV2
, RT5640_PWR_FV2
);
2622 rt5640
->jack
= jack
;
2624 ret
= devm_request_threaded_irq(component
->dev
, rt5640
->irq
,
2625 NULL
, rt5640_irq
, IRQF_TRIGGER_RISING
| IRQF_ONESHOT
,
2628 dev_warn(component
->dev
, "Failed to request IRQ %d: %d\n", rt5640
->irq
, ret
);
2629 rt5640
->irq
= -ENXIO
;
2633 /* sync initial jack state */
2634 queue_delayed_work(system_long_wq
, &rt5640
->jack_work
, 0);
2636 snd_soc_dapm_add_routes(dapm
, rt5640_hda_jack_dapm_routes
,
2637 ARRAY_SIZE(rt5640_hda_jack_dapm_routes
));
2640 static int rt5640_set_jack(struct snd_soc_component
*component
,
2641 struct snd_soc_jack
*jack
, void *data
)
2643 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2646 if (rt5640
->jd_src
== RT5640_JD_SRC_HDA_HEADER
)
2647 rt5640_enable_hda_jack_detect(component
, jack
);
2649 rt5640_enable_jack_detect(component
, jack
, data
);
2651 rt5640_disable_jack_detect(component
);
2657 static int rt5640_probe(struct snd_soc_component
*component
)
2659 struct snd_soc_dapm_context
*dapm
= snd_soc_component_get_dapm(component
);
2660 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2661 u32 dmic1_data_pin
= 0;
2662 u32 dmic2_data_pin
= 0;
2663 bool dmic_en
= false;
2666 /* Check if MCLK provided */
2667 rt5640
->mclk
= devm_clk_get(component
->dev
, "mclk");
2668 if (PTR_ERR(rt5640
->mclk
) == -EPROBE_DEFER
)
2669 return -EPROBE_DEFER
;
2671 rt5640
->component
= component
;
2673 snd_soc_component_force_bias_level(component
, SND_SOC_BIAS_OFF
);
2675 snd_soc_component_update_bits(component
, RT5640_DUMMY1
, 0x0301, 0x0301);
2676 snd_soc_component_update_bits(component
, RT5640_MICBIAS
, 0x0030, 0x0030);
2677 snd_soc_component_update_bits(component
, RT5640_DSP_PATH2
, 0xfc00, 0x0c00);
2679 switch (snd_soc_component_read(component
, RT5640_RESET
) & RT5640_ID_MASK
) {
2680 case RT5640_ID_5640
:
2681 case RT5640_ID_5642
:
2682 snd_soc_add_component_controls(component
,
2683 rt5640_specific_snd_controls
,
2684 ARRAY_SIZE(rt5640_specific_snd_controls
));
2685 snd_soc_dapm_new_controls(dapm
,
2686 rt5640_specific_dapm_widgets
,
2687 ARRAY_SIZE(rt5640_specific_dapm_widgets
));
2688 snd_soc_dapm_add_routes(dapm
,
2689 rt5640_specific_dapm_routes
,
2690 ARRAY_SIZE(rt5640_specific_dapm_routes
));
2692 case RT5640_ID_5639
:
2693 snd_soc_dapm_new_controls(dapm
,
2694 rt5639_specific_dapm_widgets
,
2695 ARRAY_SIZE(rt5639_specific_dapm_widgets
));
2696 snd_soc_dapm_add_routes(dapm
,
2697 rt5639_specific_dapm_routes
,
2698 ARRAY_SIZE(rt5639_specific_dapm_routes
));
2701 dev_err(component
->dev
,
2702 "The driver is for RT5639 RT5640 or RT5642 only\n");
2707 * Note on some platforms the platform code may need to add device-props
2708 * rather then relying only on properties set by the firmware.
2709 * Therefor the property parsing MUST be done here, rather then from
2710 * rt5640_i2c_probe(), so that the platform-code can attach extra
2711 * properties before calling snd_soc_register_card().
2713 if (device_property_read_bool(component
->dev
, "realtek,in1-differential"))
2714 snd_soc_component_update_bits(component
, RT5640_IN1_IN2
,
2715 RT5640_IN_DF1
, RT5640_IN_DF1
);
2717 if (device_property_read_bool(component
->dev
, "realtek,in2-differential"))
2718 snd_soc_component_update_bits(component
, RT5640_IN3_IN4
,
2719 RT5640_IN_DF2
, RT5640_IN_DF2
);
2721 if (device_property_read_bool(component
->dev
, "realtek,in3-differential"))
2722 snd_soc_component_update_bits(component
, RT5640_IN1_IN2
,
2723 RT5640_IN_DF2
, RT5640_IN_DF2
);
2725 if (device_property_read_bool(component
->dev
, "realtek,lout-differential"))
2726 snd_soc_component_update_bits(component
, RT5640_DUMMY1
,
2727 RT5640_EN_LOUT_DF
, RT5640_EN_LOUT_DF
);
2729 if (device_property_read_u32(component
->dev
, "realtek,dmic1-data-pin",
2730 &val
) == 0 && val
) {
2731 dmic1_data_pin
= val
- 1;
2735 if (device_property_read_u32(component
->dev
, "realtek,dmic2-data-pin",
2736 &val
) == 0 && val
) {
2737 dmic2_data_pin
= val
- 1;
2742 rt5640_dmic_enable(component
, dmic1_data_pin
, dmic2_data_pin
);
2744 if (device_property_read_u32(component
->dev
,
2745 "realtek,jack-detect-source", &val
) == 0) {
2746 if (val
<= RT5640_JD_SRC_HDA_HEADER
)
2747 rt5640
->jd_src
= val
;
2749 dev_warn(component
->dev
, "Warning: Invalid jack-detect-source value: %d, leaving jack-detect disabled\n",
2753 if (!device_property_read_bool(component
->dev
, "realtek,jack-detect-not-inverted"))
2754 rt5640
->jd_inverted
= true;
2757 * Testing on various boards has shown that good defaults for the OVCD
2758 * threshold and scale-factor are 2000µA and 0.75. For an effective
2759 * limit of 1500µA, this seems to be more reliable then 1500µA and 1.0.
2761 rt5640
->ovcd_th
= RT5640_MIC1_OVTH_2000UA
;
2762 rt5640
->ovcd_sf
= RT5640_MIC_OVCD_SF_0P75
;
2764 if (device_property_read_u32(component
->dev
,
2765 "realtek,over-current-threshold-microamp", &val
) == 0) {
2768 rt5640
->ovcd_th
= RT5640_MIC1_OVTH_600UA
;
2771 rt5640
->ovcd_th
= RT5640_MIC1_OVTH_1500UA
;
2774 rt5640
->ovcd_th
= RT5640_MIC1_OVTH_2000UA
;
2777 dev_warn(component
->dev
, "Warning: Invalid over-current-threshold-microamp value: %d, defaulting to 2000uA\n",
2782 if (device_property_read_u32(component
->dev
,
2783 "realtek,over-current-scale-factor", &val
) == 0) {
2784 if (val
<= RT5640_OVCD_SF_1P5
)
2785 rt5640
->ovcd_sf
= val
<< RT5640_MIC_OVCD_SF_SFT
;
2787 dev_warn(component
->dev
, "Warning: Invalid over-current-scale-factor value: %d, defaulting to 0.75\n",
2794 static void rt5640_remove(struct snd_soc_component
*component
)
2796 rt5640_reset(component
);
2800 static int rt5640_suspend(struct snd_soc_component
*component
)
2802 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2805 /* disable jack interrupts during system suspend */
2806 disable_irq(rt5640
->irq
);
2809 rt5640_cancel_work(rt5640
);
2810 snd_soc_component_force_bias_level(component
, SND_SOC_BIAS_OFF
);
2811 rt5640_reset(component
);
2812 regcache_cache_only(rt5640
->regmap
, true);
2813 regcache_mark_dirty(rt5640
->regmap
);
2814 if (rt5640
->ldo1_en
)
2815 gpiod_set_value_cansleep(rt5640
->ldo1_en
, 0);
2820 static int rt5640_resume(struct snd_soc_component
*component
)
2822 struct rt5640_priv
*rt5640
= snd_soc_component_get_drvdata(component
);
2824 if (rt5640
->ldo1_en
) {
2825 gpiod_set_value_cansleep(rt5640
->ldo1_en
, 1);
2829 regcache_cache_only(rt5640
->regmap
, false);
2830 regcache_sync(rt5640
->regmap
);
2833 enable_irq(rt5640
->irq
);
2836 if (rt5640
->jd_src
== RT5640_JD_SRC_HDA_HEADER
) {
2837 snd_soc_component_update_bits(component
,
2838 RT5640_DUMMY2
, 0x1100, 0x1100);
2840 if (rt5640
->jd_inverted
) {
2841 if (rt5640
->jd_src
== RT5640_JD_SRC_JD2_IN4N
)
2842 snd_soc_component_update_bits(
2843 component
, RT5640_DUMMY2
,
2844 RT5640_IRQ_JD2_MASK
|
2846 RT5640_IRQ_JD2_NOR
|
2850 if (rt5640
->jd_src
== RT5640_JD_SRC_JD2_IN4N
)
2851 snd_soc_component_update_bits(
2852 component
, RT5640_DUMMY2
,
2853 RT5640_IRQ_JD2_MASK
|
2856 RT5640_IRQ_JD2_NOR
|
2862 queue_delayed_work(system_long_wq
, &rt5640
->jack_work
, 0);
2868 #define rt5640_suspend NULL
2869 #define rt5640_resume NULL
2872 #define RT5640_STEREO_RATES SNDRV_PCM_RATE_8000_96000
2873 #define RT5640_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
2874 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S8)
2876 static const struct snd_soc_dai_ops rt5640_aif_dai_ops
= {
2877 .hw_params
= rt5640_hw_params
,
2878 .set_fmt
= rt5640_set_dai_fmt
,
2879 .set_sysclk
= rt5640_set_dai_sysclk
,
2880 .set_pll
= rt5640_set_dai_pll
,
2883 static struct snd_soc_dai_driver rt5640_dai
[] = {
2885 .name
= "rt5640-aif1",
2888 .stream_name
= "AIF1 Playback",
2891 .rates
= RT5640_STEREO_RATES
,
2892 .formats
= RT5640_FORMATS
,
2895 .stream_name
= "AIF1 Capture",
2898 .rates
= RT5640_STEREO_RATES
,
2899 .formats
= RT5640_FORMATS
,
2901 .ops
= &rt5640_aif_dai_ops
,
2904 .name
= "rt5640-aif2",
2907 .stream_name
= "AIF2 Playback",
2910 .rates
= RT5640_STEREO_RATES
,
2911 .formats
= RT5640_FORMATS
,
2914 .stream_name
= "AIF2 Capture",
2917 .rates
= RT5640_STEREO_RATES
,
2918 .formats
= RT5640_FORMATS
,
2920 .ops
= &rt5640_aif_dai_ops
,
2924 static const struct snd_soc_component_driver soc_component_dev_rt5640
= {
2925 .probe
= rt5640_probe
,
2926 .remove
= rt5640_remove
,
2927 .suspend
= rt5640_suspend
,
2928 .resume
= rt5640_resume
,
2929 .set_bias_level
= rt5640_set_bias_level
,
2930 .set_jack
= rt5640_set_jack
,
2931 .controls
= rt5640_snd_controls
,
2932 .num_controls
= ARRAY_SIZE(rt5640_snd_controls
),
2933 .dapm_widgets
= rt5640_dapm_widgets
,
2934 .num_dapm_widgets
= ARRAY_SIZE(rt5640_dapm_widgets
),
2935 .dapm_routes
= rt5640_dapm_routes
,
2936 .num_dapm_routes
= ARRAY_SIZE(rt5640_dapm_routes
),
2937 .use_pmdown_time
= 1,
2941 static const struct regmap_config rt5640_regmap
= {
2944 .use_single_read
= true,
2945 .use_single_write
= true,
2947 .max_register
= RT5640_VENDOR_ID2
+ 1 + (ARRAY_SIZE(rt5640_ranges
) *
2949 .volatile_reg
= rt5640_volatile_register
,
2950 .readable_reg
= rt5640_readable_register
,
2952 .cache_type
= REGCACHE_MAPLE
,
2953 .reg_defaults
= rt5640_reg
,
2954 .num_reg_defaults
= ARRAY_SIZE(rt5640_reg
),
2955 .ranges
= rt5640_ranges
,
2956 .num_ranges
= ARRAY_SIZE(rt5640_ranges
),
2959 static const struct i2c_device_id rt5640_i2c_id
[] = {
2965 MODULE_DEVICE_TABLE(i2c
, rt5640_i2c_id
);
2967 #if defined(CONFIG_OF)
2968 static const struct of_device_id rt5640_of_match
[] = {
2969 { .compatible
= "realtek,rt5639", },
2970 { .compatible
= "realtek,rt5640", },
2973 MODULE_DEVICE_TABLE(of
, rt5640_of_match
);
2977 static const struct acpi_device_id rt5640_acpi_match
[] = {
2985 MODULE_DEVICE_TABLE(acpi
, rt5640_acpi_match
);
2988 static int rt5640_i2c_probe(struct i2c_client
*i2c
)
2990 struct rt5640_priv
*rt5640
;
2994 rt5640
= devm_kzalloc(&i2c
->dev
,
2995 sizeof(struct rt5640_priv
),
2999 i2c_set_clientdata(i2c
, rt5640
);
3001 rt5640
->ldo1_en
= devm_gpiod_get_optional(&i2c
->dev
,
3004 if (IS_ERR(rt5640
->ldo1_en
))
3005 return PTR_ERR(rt5640
->ldo1_en
);
3007 if (rt5640
->ldo1_en
) {
3008 gpiod_set_consumer_name(rt5640
->ldo1_en
, "RT5640 LDO1_EN");
3012 rt5640
->regmap
= devm_regmap_init_i2c(i2c
, &rt5640_regmap
);
3013 if (IS_ERR(rt5640
->regmap
)) {
3014 ret
= PTR_ERR(rt5640
->regmap
);
3015 dev_err(&i2c
->dev
, "Failed to allocate register map: %d\n",
3020 regmap_read(rt5640
->regmap
, RT5640_VENDOR_ID2
, &val
);
3021 if (val
!= RT5640_DEVICE_ID
) {
3023 "Device with ID register %#x is not rt5640/39\n", val
);
3027 regmap_write(rt5640
->regmap
, RT5640_RESET
, 0);
3029 ret
= regmap_register_patch(rt5640
->regmap
, init_list
,
3030 ARRAY_SIZE(init_list
));
3032 dev_warn(&i2c
->dev
, "Failed to apply regmap patch: %d\n", ret
);
3034 regmap_update_bits(rt5640
->regmap
, RT5640_DUMMY1
,
3035 RT5640_MCLK_DET
, RT5640_MCLK_DET
);
3037 rt5640
->hp_mute
= true;
3038 rt5640
->irq
= i2c
->irq
;
3039 INIT_DELAYED_WORK(&rt5640
->bp_work
, rt5640_button_press_work
);
3040 INIT_DELAYED_WORK(&rt5640
->jack_work
, rt5640_jack_work
);
3042 /* Make sure work is stopped on probe-error / remove */
3043 ret
= devm_add_action_or_reset(&i2c
->dev
, rt5640_cancel_work
, rt5640
);
3047 return devm_snd_soc_register_component(&i2c
->dev
,
3048 &soc_component_dev_rt5640
,
3049 rt5640_dai
, ARRAY_SIZE(rt5640_dai
));
3052 static struct i2c_driver rt5640_i2c_driver
= {
3055 .acpi_match_table
= ACPI_PTR(rt5640_acpi_match
),
3056 .of_match_table
= of_match_ptr(rt5640_of_match
),
3058 .probe
= rt5640_i2c_probe
,
3059 .id_table
= rt5640_i2c_id
,
3061 module_i2c_driver(rt5640_i2c_driver
);
3063 MODULE_DESCRIPTION("ASoC RT5640/RT5639 driver");
3064 MODULE_AUTHOR("Johnny Hsu <johnnyhsu@realtek.com>");
3065 MODULE_LICENSE("GPL v2");