70 static void rt5631_write_index(struct snd_soc_component *component,  in rt5631_write_index()  argument
73 	snd_soc_component_write(component, RT5631_INDEX_ADD, reg);  in rt5631_write_index()
74 	snd_soc_component_write(component, RT5631_INDEX_DATA, value);  in rt5631_write_index()
80 static unsigned int rt5631_read_index(struct snd_soc_component *component,  in rt5631_read_index()  argument
85 	snd_soc_component_write(component, RT5631_INDEX_ADD, reg);  in rt5631_read_index()
86 	value = snd_soc_component_read32(component, RT5631_INDEX_DATA);  in rt5631_read_index()
91 static int rt5631_reset(struct snd_soc_component *component)  in rt5631_reset()  argument
93 	return snd_soc_component_write(component, RT5631_RESET, 0);  in rt5631_reset()
186 	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);  in rt5631_dmic_get()  local
187 	struct rt5631_priv *rt5631 = snd_soc_component_get_drvdata(component);  in rt5631_dmic_get()
197 	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);  in rt5631_dmic_put()  local
198 	struct rt5631_priv *rt5631 = snd_soc_component_get_drvdata(component);  in rt5631_dmic_put()
285 	struct snd_soc_component *component = snd_soc_dapm_to_component(source->dapm);  in check_sysclk1_source()  local
288 	reg = snd_soc_component_read32(component, RT5631_GLOBAL_CLK_CTRL);  in check_sysclk1_source()
295 	struct snd_soc_component *component = snd_soc_dapm_to_component(source->dapm);  in check_dmic_used()  local
296 	struct rt5631_priv *rt5631 = snd_soc_component_get_drvdata(component);  in check_dmic_used()
303 	struct snd_soc_component *component = snd_soc_dapm_to_component(source->dapm);  in check_dacl_to_outmixl()  local
306 	reg = snd_soc_component_read32(component, RT5631_OUTMIXER_L_CTRL);  in check_dacl_to_outmixl()
313 	struct snd_soc_component *component = snd_soc_dapm_to_component(source->dapm);  in check_dacr_to_outmixr()  local
316 	reg = snd_soc_component_read32(component, RT5631_OUTMIXER_R_CTRL);  in check_dacr_to_outmixr()
323 	struct snd_soc_component *component = snd_soc_dapm_to_component(source->dapm);  in check_dacl_to_spkmixl()  local
326 	reg = snd_soc_component_read32(component, RT5631_SPK_MIXER_CTRL);  in check_dacl_to_spkmixl()
333 	struct snd_soc_component *component = snd_soc_dapm_to_component(source->dapm);  in check_dacr_to_spkmixr()  local
336 	reg = snd_soc_component_read32(component, RT5631_SPK_MIXER_CTRL);  in check_dacr_to_spkmixr()
343 	struct snd_soc_component *component = snd_soc_dapm_to_component(source->dapm);  in check_adcl_select()  local
346 	reg = snd_soc_component_read32(component, RT5631_ADC_REC_MIXER);  in check_adcl_select()
353 	struct snd_soc_component *component = snd_soc_dapm_to_component(source->dapm);  in check_adcr_select()  local
356 	reg = snd_soc_component_read32(component, RT5631_ADC_REC_MIXER);  in check_adcr_select()
366 static void onebit_depop_power_stage(struct snd_soc_component *component, int enable)  in onebit_depop_power_stage()  argument
371 	snd_soc_component_update_bits(component, RT5631_DEPOP_FUN_CTRL_2,  in onebit_depop_power_stage()
375 	soft_vol = snd_soc_component_read32(component, RT5631_SOFT_VOL_CTRL);  in onebit_depop_power_stage()
376 	snd_soc_component_write(component, RT5631_SOFT_VOL_CTRL, 0);  in onebit_depop_power_stage()
377 	hp_zc = snd_soc_component_read32(component, RT5631_INT_ST_IRQ_CTRL_2);  in onebit_depop_power_stage()
378 	snd_soc_component_write(component, RT5631_INT_ST_IRQ_CTRL_2, hp_zc & 0xf7ff);  in onebit_depop_power_stage()
381 		rt5631_write_index(component, RT5631_TEST_MODE_CTRL, 0x84c0);  in onebit_depop_power_stage()
382 		rt5631_write_index(component, RT5631_SPK_INTL_CTRL, 0x309f);  in onebit_depop_power_stage()
383 		rt5631_write_index(component, RT5631_CP_INTL_REG2, 0x6530);  in onebit_depop_power_stage()
385 		snd_soc_component_write(component, RT5631_DEPOP_FUN_CTRL_2,  in onebit_depop_power_stage()
389 		snd_soc_component_write(component, RT5631_DEPOP_FUN_CTRL_2, 0);  in onebit_depop_power_stage()
394 	snd_soc_component_write(component, RT5631_SOFT_VOL_CTRL, soft_vol);  in onebit_depop_power_stage()
395 	snd_soc_component_write(component, RT5631_INT_ST_IRQ_CTRL_2, hp_zc);  in onebit_depop_power_stage()
404 static void onebit_depop_mute_stage(struct snd_soc_component *component, int enable)  in onebit_depop_mute_stage()  argument
409 	snd_soc_component_update_bits(component, RT5631_DEPOP_FUN_CTRL_2,  in onebit_depop_mute_stage()
413 	soft_vol = snd_soc_component_read32(component, RT5631_SOFT_VOL_CTRL);  in onebit_depop_mute_stage()
414 	snd_soc_component_write(component, RT5631_SOFT_VOL_CTRL, 0);  in onebit_depop_mute_stage()
415 	hp_zc = snd_soc_component_read32(component, RT5631_INT_ST_IRQ_CTRL_2);  in onebit_depop_mute_stage()
416 	snd_soc_component_write(component, RT5631_INT_ST_IRQ_CTRL_2, hp_zc & 0xf7ff);  in onebit_depop_mute_stage()
420 		rt5631_write_index(component, RT5631_SPK_INTL_CTRL, 0x307f);  in onebit_depop_mute_stage()
421 		snd_soc_component_update_bits(component, RT5631_HP_OUT_VOL,  in onebit_depop_mute_stage()
425 		snd_soc_component_update_bits(component, RT5631_HP_OUT_VOL,  in onebit_depop_mute_stage()
432 	snd_soc_component_write(component, RT5631_SOFT_VOL_CTRL, soft_vol);  in onebit_depop_mute_stage()
433 	snd_soc_component_write(component, RT5631_INT_ST_IRQ_CTRL_2, hp_zc);  in onebit_depop_mute_stage()
442 static void depop_seq_power_stage(struct snd_soc_component *component, int enable)  in depop_seq_power_stage()  argument
447 	snd_soc_component_update_bits(component, RT5631_DEPOP_FUN_CTRL_2,  in depop_seq_power_stage()
451 	soft_vol = snd_soc_component_read32(component, RT5631_SOFT_VOL_CTRL);  in depop_seq_power_stage()
452 	snd_soc_component_write(component, RT5631_SOFT_VOL_CTRL, 0);  in depop_seq_power_stage()
453 	hp_zc = snd_soc_component_read32(component, RT5631_INT_ST_IRQ_CTRL_2);  in depop_seq_power_stage()
454 	snd_soc_component_write(component, RT5631_INT_ST_IRQ_CTRL_2, hp_zc & 0xf7ff);  in depop_seq_power_stage()
457 		rt5631_write_index(component, RT5631_SPK_INTL_CTRL, 0x303e);  in depop_seq_power_stage()
460 		snd_soc_component_update_bits(component, RT5631_PWR_MANAG_ADD3,  in depop_seq_power_stage()
467 		snd_soc_component_write(component, RT5631_DEPOP_FUN_CTRL_1,  in depop_seq_power_stage()
472 		snd_soc_component_update_bits(component, RT5631_PWR_MANAG_ADD3,  in depop_seq_power_stage()
476 		rt5631_write_index(component, RT5631_SPK_INTL_CTRL, 0x303F);  in depop_seq_power_stage()
477 		snd_soc_component_write(component, RT5631_DEPOP_FUN_CTRL_1,  in depop_seq_power_stage()
481 		snd_soc_component_write(component, RT5631_DEPOP_FUN_CTRL_1,  in depop_seq_power_stage()
486 		snd_soc_component_update_bits(component, RT5631_PWR_MANAG_ADD3,  in depop_seq_power_stage()
490 		snd_soc_component_write(component, RT5631_DEPOP_FUN_CTRL_1,  in depop_seq_power_stage()
494 		snd_soc_component_write(component, RT5631_DEPOP_FUN_CTRL_1,  in depop_seq_power_stage()
498 		snd_soc_component_update_bits(component, RT5631_PWR_MANAG_ADD3,  in depop_seq_power_stage()
504 	snd_soc_component_write(component, RT5631_SOFT_VOL_CTRL, soft_vol);  in depop_seq_power_stage()
505 	snd_soc_component_write(component, RT5631_INT_ST_IRQ_CTRL_2, hp_zc);  in depop_seq_power_stage()
514 static void depop_seq_mute_stage(struct snd_soc_component *component, int enable)  in depop_seq_mute_stage()  argument
519 	snd_soc_component_update_bits(component, RT5631_DEPOP_FUN_CTRL_2,  in depop_seq_mute_stage()
523 	soft_vol = snd_soc_component_read32(component, RT5631_SOFT_VOL_CTRL);  in depop_seq_mute_stage()
524 	snd_soc_component_write(component, RT5631_SOFT_VOL_CTRL, 0);  in depop_seq_mute_stage()
525 	hp_zc = snd_soc_component_read32(component, RT5631_INT_ST_IRQ_CTRL_2);  in depop_seq_mute_stage()
526 	snd_soc_component_write(component, RT5631_INT_ST_IRQ_CTRL_2, hp_zc & 0xf7ff);  in depop_seq_mute_stage()
531 		rt5631_write_index(component, RT5631_SPK_INTL_CTRL, 0x302f);  in depop_seq_mute_stage()
532 		snd_soc_component_write(component, RT5631_DEPOP_FUN_CTRL_1,  in depop_seq_mute_stage()
537 		snd_soc_component_update_bits(component, RT5631_HP_OUT_VOL,  in depop_seq_mute_stage()
542 		rt5631_write_index(component, RT5631_SPK_INTL_CTRL, 0x302f);  in depop_seq_mute_stage()
543 		snd_soc_component_write(component, RT5631_DEPOP_FUN_CTRL_1,  in depop_seq_mute_stage()
548 		snd_soc_component_update_bits(component, RT5631_HP_OUT_VOL,  in depop_seq_mute_stage()
555 	snd_soc_component_write(component, RT5631_SOFT_VOL_CTRL, soft_vol);  in depop_seq_mute_stage()
556 	snd_soc_component_write(component, RT5631_INT_ST_IRQ_CTRL_2, hp_zc);  in depop_seq_mute_stage()
562 	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);  in hp_event()  local
563 	struct rt5631_priv *rt5631 = snd_soc_component_get_drvdata(component);  in hp_event()
568 			onebit_depop_mute_stage(component, 0);  in hp_event()
569 			onebit_depop_power_stage(component, 0);  in hp_event()
571 			depop_seq_mute_stage(component, 0);  in hp_event()
572 			depop_seq_power_stage(component, 0);  in hp_event()
578 			onebit_depop_power_stage(component, 1);  in hp_event()
579 			onebit_depop_mute_stage(component, 1);  in hp_event()
581 			depop_seq_power_stage(component, 1);  in hp_event()
582 			depop_seq_mute_stage(component, 1);  in hp_event()
596 	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);  in set_dmic_params()  local
597 	struct rt5631_priv *rt5631 = snd_soc_component_get_drvdata(component);  in set_dmic_params()
602 		snd_soc_component_update_bits(component, RT5631_DIG_MIC_CTRL,  in set_dmic_params()
609 		snd_soc_component_update_bits(component, RT5631_DIG_MIC_CTRL,  in set_dmic_params()
617 		snd_soc_component_update_bits(component, RT5631_DIG_MIC_CTRL,  in set_dmic_params()
1351 	struct snd_soc_component *component = dai->component;  in rt5631_hifi_pcm_params()  local
1352 	struct rt5631_priv *rt5631 = snd_soc_component_get_drvdata(component);  in rt5631_hifi_pcm_params()
1356 	dev_dbg(component->dev, "enter %s\n", __func__);  in rt5631_hifi_pcm_params()
1360 		dev_err(component->dev, "Fail to get BCLK rate\n");  in rt5631_hifi_pcm_params()
1372 		dev_err(component->dev, "Fail to get coeff\n");  in rt5631_hifi_pcm_params()
1392 	snd_soc_component_update_bits(component, RT5631_SDP_CTRL,  in rt5631_hifi_pcm_params()
1394 	snd_soc_component_write(component, RT5631_STEREO_AD_DA_CLK_CTRL,  in rt5631_hifi_pcm_params()
1403 	struct snd_soc_component *component = codec_dai->component;  in rt5631_hifi_codec_set_dai_fmt()  local
1404 	struct rt5631_priv *rt5631 = snd_soc_component_get_drvdata(component);  in rt5631_hifi_codec_set_dai_fmt()
1407 	dev_dbg(component->dev, "enter %s\n", __func__);  in rt5631_hifi_codec_set_dai_fmt()
1447 	snd_soc_component_write(component, RT5631_SDP_CTRL, iface);  in rt5631_hifi_codec_set_dai_fmt()
1455 	struct snd_soc_component *component = codec_dai->component;  in rt5631_hifi_codec_set_dai_sysclk()  local
1456 	struct rt5631_priv *rt5631 = snd_soc_component_get_drvdata(component);  in rt5631_hifi_codec_set_dai_sysclk()
1458 	dev_dbg(component->dev, "enter %s, syclk=%d\n", __func__, freq);  in rt5631_hifi_codec_set_dai_sysclk()
1471 	struct snd_soc_component *component = codec_dai->component;  in rt5631_codec_set_dai_pll()  local
1472 	struct rt5631_priv *rt5631 = snd_soc_component_get_drvdata(component);  in rt5631_codec_set_dai_pll()
1475 	dev_dbg(component->dev, "enter %s\n", __func__);  in rt5631_codec_set_dai_pll()
1478 		dev_dbg(component->dev, "PLL disabled\n");  in rt5631_codec_set_dai_pll()
1480 		snd_soc_component_update_bits(component, RT5631_GLOBAL_CLK_CTRL,  in rt5631_codec_set_dai_pll()
1491 				dev_info(component->dev,  in rt5631_codec_set_dai_pll()
1493 				snd_soc_component_write(component, RT5631_PLL_CTRL,  in rt5631_codec_set_dai_pll()
1497 				snd_soc_component_update_bits(component,  in rt5631_codec_set_dai_pll()
1510 				dev_info(component->dev,  in rt5631_codec_set_dai_pll()
1512 				snd_soc_component_write(component, RT5631_PLL_CTRL,  in rt5631_codec_set_dai_pll()
1516 				snd_soc_component_update_bits(component,  in rt5631_codec_set_dai_pll()
1530 static int rt5631_set_bias_level(struct snd_soc_component *component,  in rt5631_set_bias_level()  argument
1533 	struct rt5631_priv *rt5631 = snd_soc_component_get_drvdata(component);  in rt5631_set_bias_level()
1538 		snd_soc_component_update_bits(component, RT5631_PWR_MANAG_ADD2,  in rt5631_set_bias_level()
1544 		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {  in rt5631_set_bias_level()
1545 			snd_soc_component_update_bits(component, RT5631_PWR_MANAG_ADD3,  in rt5631_set_bias_level()
1549 			snd_soc_component_update_bits(component, RT5631_PWR_MANAG_ADD3,  in rt5631_set_bias_level()
1558 		snd_soc_component_write(component, RT5631_PWR_MANAG_ADD1, 0x0000);  in rt5631_set_bias_level()
1559 		snd_soc_component_write(component, RT5631_PWR_MANAG_ADD2, 0x0000);  in rt5631_set_bias_level()
1560 		snd_soc_component_write(component, RT5631_PWR_MANAG_ADD3, 0x0000);  in rt5631_set_bias_level()
1561 		snd_soc_component_write(component, RT5631_PWR_MANAG_ADD4, 0x0000);  in rt5631_set_bias_level()
1571 static int rt5631_probe(struct snd_soc_component *component)  in rt5631_probe()  argument
1573 	struct rt5631_priv *rt5631 = snd_soc_component_get_drvdata(component);  in rt5631_probe()
1576 	val = rt5631_read_index(component, RT5631_ADDA_MIXER_INTL_REG3);  in rt5631_probe()
1582 	rt5631_reset(component);  in rt5631_probe()
1583 	snd_soc_component_update_bits(component, RT5631_PWR_MANAG_ADD3,  in rt5631_probe()
1587 	snd_soc_component_update_bits(component, RT5631_PWR_MANAG_ADD3,  in rt5631_probe()
1590 	snd_soc_component_write(component, RT5631_INT_ST_IRQ_CTRL_2, 0x0f18);  in rt5631_probe()
1593 		snd_soc_component_update_bits(component, RT5631_INT_ST_IRQ_CTRL_2,  in rt5631_probe()
1596 		snd_soc_component_update_bits(component, RT5631_INT_ST_IRQ_CTRL_2,  in rt5631_probe()
1600 		snd_soc_component_update_bits(component, RT5631_GPIO_CTRL,  in rt5631_probe()
1605 		snd_soc_component_update_bits(component, RT5631_DIG_MIC_CTRL,  in rt5631_probe()
1612 	snd_soc_component_init_bias_level(component, SND_SOC_BIAS_STANDBY);  in rt5631_probe()