Unverified Commit 682c5a72 authored by Jiaxin Yu's avatar Jiaxin Yu Committed by Mark Brown
Browse files

ASoC: mediatek: mt6359: add the calibration functions 



Add the calibraion functions for initializing the codec when registering
the machine driver.

Signed-off-by: default avatarJiaxin Yu <jiaxin.yu@mediatek.com>
Link: https://lore.kernel.org/r/1604390378-23993-2-git-send-email-jiaxin.yu@mediatek.com


Signed-off-by: default avatarMark Brown <broonie@kernel.org>
parent 32c5dca1

sound/soc/codecs/mt6359.c

+110 −0
Original line number Diff line number Diff line
@@ -68,6 +68,38 @@ static void mt6359_reset_capture_gpio(struct mt6359_priv *priv) 
			   0x3 << 0, 0x0);

}



/* use only when doing mtkaif calibraiton at the boot time */

static void mt6359_set_dcxo(struct mt6359_priv *priv, bool enable)

{

	regmap_update_bits(priv->regmap, MT6359_DCXO_CW12,

			   0x1 << RG_XO_AUDIO_EN_M_SFT,

			   (enable ? 1 : 0) << RG_XO_AUDIO_EN_M_SFT);

}



/* use only when doing mtkaif calibraiton at the boot time */

static void mt6359_set_clksq(struct mt6359_priv *priv, bool enable)

{

	/* Enable/disable CLKSQ 26MHz */

	regmap_update_bits(priv->regmap, MT6359_AUDENC_ANA_CON23,

			   RG_CLKSQ_EN_MASK_SFT,

			   (enable ? 1 : 0) << RG_CLKSQ_EN_SFT);

}



/* use only when doing mtkaif calibraiton at the boot time */

static void mt6359_set_aud_global_bias(struct mt6359_priv *priv, bool enable)

{

	regmap_update_bits(priv->regmap, MT6359_AUDDEC_ANA_CON13,

			   RG_AUDGLB_PWRDN_VA32_MASK_SFT,

			   (enable ? 0 : 1) << RG_AUDGLB_PWRDN_VA32_SFT);

}



/* use only when doing mtkaif calibraiton at the boot time */

static void mt6359_set_topck(struct mt6359_priv *priv, bool enable)

{

	regmap_update_bits(priv->regmap, MT6359_AUD_TOP_CKPDN_CON0,

			   0x0066, enable ? 0x0 : 0x66);

}



static void mt6359_set_decoder_clk(struct mt6359_priv *priv, bool enable)

{

	regmap_update_bits(priv->regmap, MT6359_AUDDEC_ANA_CON13,
@@ -122,6 +154,84 @@ static void mt6359_mtkaif_tx_disable(struct mt6359_priv *priv) 
			   0xff00, 0x3000);

}



void mt6359_set_mtkaif_protocol(struct snd_soc_component *cmpnt,

				int mtkaif_protocol)

{

	struct mt6359_priv *priv = snd_soc_component_get_drvdata(cmpnt);



	priv->mtkaif_protocol = mtkaif_protocol;

}

EXPORT_SYMBOL_GPL(mt6359_set_mtkaif_protocol);



void mt6359_mtkaif_calibration_enable(struct snd_soc_component *cmpnt)

{

	struct mt6359_priv *priv = snd_soc_component_get_drvdata(cmpnt);



	mt6359_set_playback_gpio(priv);

	mt6359_set_capture_gpio(priv);

	mt6359_mtkaif_tx_enable(priv);



	mt6359_set_dcxo(priv, true);

	mt6359_set_aud_global_bias(priv, true);

	mt6359_set_clksq(priv, true);

	mt6359_set_topck(priv, true);



	/* set dat_miso_loopback on */

	regmap_update_bits(priv->regmap, MT6359_AUDIO_DIG_CFG,

			   RG_AUD_PAD_TOP_DAT_MISO2_LOOPBACK_MASK_SFT,

			   1 << RG_AUD_PAD_TOP_DAT_MISO2_LOOPBACK_SFT);

	regmap_update_bits(priv->regmap, MT6359_AUDIO_DIG_CFG,

			   RG_AUD_PAD_TOP_DAT_MISO_LOOPBACK_MASK_SFT,

			   1 << RG_AUD_PAD_TOP_DAT_MISO_LOOPBACK_SFT);

	regmap_update_bits(priv->regmap, MT6359_AUDIO_DIG_CFG1,

			   RG_AUD_PAD_TOP_DAT_MISO3_LOOPBACK_MASK_SFT,

			   1 << RG_AUD_PAD_TOP_DAT_MISO3_LOOPBACK_SFT);

}

EXPORT_SYMBOL_GPL(mt6359_mtkaif_calibration_enable);



void mt6359_mtkaif_calibration_disable(struct snd_soc_component *cmpnt)

{

	struct mt6359_priv *priv = snd_soc_component_get_drvdata(cmpnt);



	/* set dat_miso_loopback off */

	regmap_update_bits(priv->regmap, MT6359_AUDIO_DIG_CFG,

			   RG_AUD_PAD_TOP_DAT_MISO2_LOOPBACK_MASK_SFT,

			   0 << RG_AUD_PAD_TOP_DAT_MISO2_LOOPBACK_SFT);

	regmap_update_bits(priv->regmap, MT6359_AUDIO_DIG_CFG,

			   RG_AUD_PAD_TOP_DAT_MISO_LOOPBACK_MASK_SFT,

			   0 << RG_AUD_PAD_TOP_DAT_MISO_LOOPBACK_SFT);

	regmap_update_bits(priv->regmap, MT6359_AUDIO_DIG_CFG1,

			   RG_AUD_PAD_TOP_DAT_MISO3_LOOPBACK_MASK_SFT,

			   0 << RG_AUD_PAD_TOP_DAT_MISO3_LOOPBACK_SFT);



	mt6359_set_topck(priv, false);

	mt6359_set_clksq(priv, false);

	mt6359_set_aud_global_bias(priv, false);

	mt6359_set_dcxo(priv, false);



	mt6359_mtkaif_tx_disable(priv);

	mt6359_reset_playback_gpio(priv);

	mt6359_reset_capture_gpio(priv);

}

EXPORT_SYMBOL_GPL(mt6359_mtkaif_calibration_disable);



void mt6359_set_mtkaif_calibration_phase(struct snd_soc_component *cmpnt,

					 int phase_1, int phase_2, int phase_3)

{

	struct mt6359_priv *priv = snd_soc_component_get_drvdata(cmpnt);



	regmap_update_bits(priv->regmap, MT6359_AUDIO_DIG_CFG,

			   RG_AUD_PAD_TOP_PHASE_MODE_MASK_SFT,

			   phase_1 << RG_AUD_PAD_TOP_PHASE_MODE_SFT);

	regmap_update_bits(priv->regmap, MT6359_AUDIO_DIG_CFG,

			   RG_AUD_PAD_TOP_PHASE_MODE2_MASK_SFT,

			   phase_2 << RG_AUD_PAD_TOP_PHASE_MODE2_SFT);

	regmap_update_bits(priv->regmap, MT6359_AUDIO_DIG_CFG1,

			   RG_AUD_PAD_TOP_PHASE_MODE3_MASK_SFT,

			   phase_3 << RG_AUD_PAD_TOP_PHASE_MODE3_SFT);

}

EXPORT_SYMBOL_GPL(mt6359_set_mtkaif_calibration_phase);



static void zcd_disable(struct mt6359_priv *priv)

{

	regmap_write(priv->regmap, MT6359_ZCD_CON0, 0x0000);

sound/soc/codecs/mt6359.h

+7 −0
Original line number Diff line number Diff line
@@ -2637,4 +2637,11 @@ struct mt6359_priv { 
			   (type) == MIC_TYPE_MUX_DCC_ECM_DIFF || \

			   (type) == MIC_TYPE_MUX_DCC_ECM_SINGLE)



void mt6359_set_mtkaif_protocol(struct snd_soc_component *cmpnt,

				int mtkaif_protocol);

void mt6359_mtkaif_calibration_enable(struct snd_soc_component *cmpnt);

void mt6359_mtkaif_calibration_disable(struct snd_soc_component *cmpnt);

void mt6359_set_mtkaif_calibration_phase(struct snd_soc_component *cmpnt,

					 int phase_1, int phase_2, int phase_3);



#endif/* end _MT6359_H_ */

CRA Git | Maintained and supported by SUSTech CRA and CCSE