Commit 7d8e00c7 authored by oder_chiou@realtek.com's avatar oder_chiou@realtek.com Committed by Mark Brown
Browse files

ASoC: rt5663: Update the calibration funciton 



The patch updates the calibration funciton for getting the correct DC
offset of headphone output.

Signed-off-by: default avatarOder Chiou <oder_chiou@realtek.com>
Signed-off-by: default avatarMark Brown <broonie@kernel.org>
parent 5771a8c0

sound/soc/codecs/rt5663.c

+79 −21
Original line number Diff line number Diff line
@@ -2986,47 +2986,75 @@ static void rt5663_calibrate(struct rt5663_priv *rt5663) 
{

	int value, count;



	regmap_write(rt5663->regmap, RT5663_RC_CLK, 0x0280);

	regmap_write(rt5663->regmap, RT5663_RESET, 0x0000);

	msleep(20);

	regmap_write(rt5663->regmap, RT5663_ANA_BIAS_CUR_4, 0x00a1);

	regmap_write(rt5663->regmap, RT5663_RC_CLK, 0x0380);

	regmap_write(rt5663->regmap, RT5663_GLB_CLK, 0x8000);

	regmap_write(rt5663->regmap, RT5663_DIG_MISC, 0x8001);

	regmap_write(rt5663->regmap, RT5663_ADDA_CLK_1, 0x1000);

	regmap_write(rt5663->regmap, RT5663_VREF_RECMIX, 0x0032);

	regmap_write(rt5663->regmap, RT5663_PWR_ANLG_1, 0xa2be);

	msleep(20);

	regmap_write(rt5663->regmap, RT5663_PWR_ANLG_1, 0xf2be);

	regmap_write(rt5663->regmap, RT5663_PWR_DIG_2, 0x8400);

	regmap_write(rt5663->regmap, RT5663_CHOP_ADC, 0x3000);

	regmap_write(rt5663->regmap, RT5663_DEPOP_1, 0x003b);

	regmap_write(rt5663->regmap, RT5663_PWR_DIG_1, 0x8df8);

	regmap_write(rt5663->regmap, RT5663_PWR_ANLG_2, 0x0003);

	regmap_write(rt5663->regmap, RT5663_PWR_ANLG_3, 0x018c);

	regmap_write(rt5663->regmap, RT5663_ADDA_CLK_1, 0x1111);

	regmap_write(rt5663->regmap, RT5663_HP_IMP_SEN_19, 0x000c);

	regmap_write(rt5663->regmap, RT5663_DUMMY_1, 0x0324);

	regmap_write(rt5663->regmap, RT5663_DIG_MISC, 0x8001);

	regmap_write(rt5663->regmap, RT5663_PWR_ANLG_1, 0xa23b);

	msleep(30);

	regmap_write(rt5663->regmap, RT5663_PWR_ANLG_1, 0xf23b);

	regmap_write(rt5663->regmap, RT5663_PWR_ANLG_2, 0x8000);

	regmap_write(rt5663->regmap, RT5663_PWR_ANLG_3, 0x0008);

	regmap_write(rt5663->regmap, RT5663_PRE_DIV_GATING_1, 0xffff);

	regmap_write(rt5663->regmap, RT5663_PRE_DIV_GATING_2, 0xffff);

	regmap_write(rt5663->regmap, RT5663_CBJ_1, 0x8c10);

	regmap_write(rt5663->regmap, RT5663_IL_CMD_2, 0x00c1);

	regmap_write(rt5663->regmap, RT5663_EM_JACK_TYPE_1, 0xb880);

	regmap_write(rt5663->regmap, RT5663_EM_JACK_TYPE_2, 0x4110);

	regmap_write(rt5663->regmap, RT5663_EM_JACK_TYPE_2, 0x4118);



	count = 0;

	while (true) {

		regmap_read(rt5663->regmap, RT5663_INT_ST_2, &value);

		if (!(value & 0x80))

			usleep_range(10000, 10005);

		else

			break;



		if (count > 200)

			break;

	}



	regmap_write(rt5663->regmap, RT5663_HP_IMP_SEN_19, 0x0000);

	regmap_write(rt5663->regmap, RT5663_DEPOP_2, 0x3003);

	regmap_write(rt5663->regmap, RT5663_DEPOP_1, 0x0038);

	regmap_write(rt5663->regmap, RT5663_DEPOP_1, 0x003b);

	regmap_write(rt5663->regmap, RT5663_PWR_DIG_2, 0x8400);

	regmap_write(rt5663->regmap, RT5663_PWR_DIG_1, 0x8df8);

	regmap_write(rt5663->regmap, RT5663_PWR_ANLG_2, 0x8003);

	regmap_write(rt5663->regmap, RT5663_PWR_ANLG_3, 0x018c);

	regmap_write(rt5663->regmap, RT5663_HP_CHARGE_PUMP_1, 0x1e32);

	regmap_write(rt5663->regmap, RT5663_HP_CHARGE_PUMP_2, 0x1371);

	regmap_write(rt5663->regmap, RT5663_DACREF_LDO, 0x3b0b);

	regmap_write(rt5663->regmap, RT5663_STO_DAC_MIXER, 0x2080);

	regmap_write(rt5663->regmap, RT5663_STO_DAC_MIXER, 0x0000);

	regmap_write(rt5663->regmap, RT5663_BYPASS_STO_DAC, 0x000c);

	regmap_write(rt5663->regmap, RT5663_HP_BIAS, 0xabba);

	regmap_write(rt5663->regmap, RT5663_HP_BIAS, 0xafaa);

	regmap_write(rt5663->regmap, RT5663_CHARGE_PUMP_1, 0x2224);

	regmap_write(rt5663->regmap, RT5663_HP_OUT_EN, 0x8088);

	regmap_write(rt5663->regmap, RT5663_STO_DRE_9, 0x0017);

	regmap_write(rt5663->regmap, RT5663_STO_DRE_10, 0x0017);

	regmap_write(rt5663->regmap, RT5663_STO1_ADC_MIXER, 0x4040);

	regmap_write(rt5663->regmap, RT5663_CHOP_ADC, 0x3000);

	regmap_write(rt5663->regmap, RT5663_RECMIX, 0x0005);

	regmap_write(rt5663->regmap, RT5663_ADDA_RST, 0xc000);

	regmap_write(rt5663->regmap, RT5663_STO1_HPF_ADJ1, 0x3320);

	regmap_write(rt5663->regmap, RT5663_HP_CALIB_2, 0x00c9);

	regmap_write(rt5663->regmap, RT5663_DUMMY_1, 0x004c);

	regmap_write(rt5663->regmap, RT5663_ANA_BIAS_CUR_1, 0x7766);

	regmap_write(rt5663->regmap, RT5663_BIAS_CUR_8, 0x4702);

	msleep(200);

	regmap_write(rt5663->regmap, RT5663_ANA_BIAS_CUR_1, 0x1111);

	regmap_write(rt5663->regmap, RT5663_BIAS_CUR_8, 0x4402);

	regmap_write(rt5663->regmap, RT5663_CHARGE_PUMP_2, 0x3311);

	regmap_write(rt5663->regmap, RT5663_HP_CALIB_1, 0x0069);

	regmap_write(rt5663->regmap, RT5663_HP_CALIB_3, 0x06c2);

	regmap_write(rt5663->regmap, RT5663_HP_CALIB_1_1, 0x7b00);

	regmap_write(rt5663->regmap, RT5663_HP_CALIB_1_1, 0xfb00);

	regmap_write(rt5663->regmap, RT5663_HP_CALIB_3, 0x06ce);

	regmap_write(rt5663->regmap, RT5663_HP_CALIB_1_1, 0x6800);

	regmap_write(rt5663->regmap, RT5663_CHARGE_PUMP_2, 0x1100);

	regmap_write(rt5663->regmap, RT5663_HP_CALIB_7, 0x0057);

	regmap_write(rt5663->regmap, RT5663_HP_CALIB_1_1, 0xe800);



	count = 0;

	while (true) {

		regmap_read(rt5663->regmap, RT5663_HP_CALIB_1_1, &value);
@@ -3039,6 +3067,36 @@ static void rt5663_calibrate(struct rt5663_priv *rt5663) 
			return;

		count++;

	}



	regmap_write(rt5663->regmap, RT5663_HP_CALIB_1_1, 0x6200);

	regmap_write(rt5663->regmap, RT5663_HP_CALIB_7, 0x0059);

	regmap_write(rt5663->regmap, RT5663_HP_CALIB_1_1, 0xe200);



	count = 0;

	while (true) {

		regmap_read(rt5663->regmap, RT5663_HP_CALIB_1_1, &value);

		if (value & 0x8000)

			usleep_range(10000, 10005);

		else

			break;



		if (count > 200)

			return;

		count++;

	}



	regmap_write(rt5663->regmap, RT5663_EM_JACK_TYPE_1, 0xb8e0);

	usleep_range(10000, 10005);

	regmap_write(rt5663->regmap, RT5663_PWR_ANLG_1, 0x003b);

	usleep_range(10000, 10005);

	regmap_write(rt5663->regmap, RT5663_PWR_DIG_1, 0x0000);

	usleep_range(10000, 10005);

	regmap_write(rt5663->regmap, RT5663_DEPOP_1, 0x000b);

	usleep_range(10000, 10005);

	regmap_write(rt5663->regmap, RT5663_DEPOP_1, 0x0008);

	usleep_range(10000, 10005);

	regmap_write(rt5663->regmap, RT5663_PWR_ANLG_2, 0x0000);

	usleep_range(10000, 10005);

}



static int rt5663_i2c_probe(struct i2c_client *i2c,