Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 2b6adc8b authored by Cong Tang's avatar Cong Tang Committed by Xiaoyu Ye
Browse files

ASoC: add support to configure TDM dai clk attribute and clk freq 



TDM dai driver supports optional clk attribute configuration and
clk freq update. To configure TDM interface as PCM mode, the clk
attribute should be Q6AFE_LPASS_CLK_ATTRIBUTE_INVERT_COUPLE_NO.
Implement set_sysclk callback function to update Quaternary TDM
RX and TX clk freq.

Change-Id: I41edaa8d99325e9582e04ddb81a6ad5b5e4435bc
Signed-off-by: default avatarCong Tang <congt@codeaurora.org>
Signed-off-by: default avatarXiaoyu Ye <benyxy@codeaurora.org>
parent 8f7ccc2e

asoc/msm-dai-q6-v2.c

+54 −0
Original line number Diff line number Diff line
@@ -5127,6 +5127,25 @@ static int msm_dai_tdm_q6_probe(struct platform_device *pdev) 
	dev_dbg(&pdev->dev, "%s: Clk Rate from DT file %d\n",

		__func__, tdm_clk_set.clk_freq_in_hz);



	/* initialize static tdm clk attribute to default value */

	tdm_clk_set.clk_attri = Q6AFE_LPASS_CLK_ATTRIBUTE_INVERT_COUPLE_NO;



	/* extract tdm clk attribute into static */

	if (of_find_property(pdev->dev.of_node,

			"qcom,msm-cpudai-tdm-clk-attribute", NULL)) {

		rc = of_property_read_u16(pdev->dev.of_node,

			"qcom,msm-cpudai-tdm-clk-attribute",

			&tdm_clk_set.clk_attri);

		if (rc) {

			dev_err(&pdev->dev, "%s: value for clk attribute not found %s\n",

				__func__, "qcom,msm-cpudai-tdm-clk-attribute");

			goto rtn;

		}

		dev_dbg(&pdev->dev, "%s: clk attribute from DT file %d\n",

			__func__, tdm_clk_set.clk_attri);

	} else

		dev_dbg(&pdev->dev, "%s: clk attribute not found\n", __func__);



	/* extract tdm clk src master/slave info into static */

	rc = of_property_read_u32(pdev->dev.of_node,

		"qcom,msm-cpudai-tdm-clk-internal",
@@ -6203,6 +6222,40 @@ static int msm_dai_q6_tdm_set_tdm_slot(struct snd_soc_dai *dai, 
	return rc;

}



static int msm_dai_q6_tdm_set_sysclk(struct snd_soc_dai *dai,

				int clk_id, unsigned int freq, int dir)

{

	struct msm_dai_q6_tdm_dai_data *dai_data =

		dev_get_drvdata(dai->dev);



	switch (dai->id) {

	case AFE_PORT_ID_QUATERNARY_TDM_RX:

	case AFE_PORT_ID_QUATERNARY_TDM_RX_1:

	case AFE_PORT_ID_QUATERNARY_TDM_RX_2:

	case AFE_PORT_ID_QUATERNARY_TDM_RX_3:

	case AFE_PORT_ID_QUATERNARY_TDM_RX_4:

	case AFE_PORT_ID_QUATERNARY_TDM_RX_5:

	case AFE_PORT_ID_QUATERNARY_TDM_RX_6:

	case AFE_PORT_ID_QUATERNARY_TDM_RX_7:

	case AFE_PORT_ID_QUATERNARY_TDM_TX:

	case AFE_PORT_ID_QUATERNARY_TDM_TX_1:

	case AFE_PORT_ID_QUATERNARY_TDM_TX_2:

	case AFE_PORT_ID_QUATERNARY_TDM_TX_3:

	case AFE_PORT_ID_QUATERNARY_TDM_TX_4:

	case AFE_PORT_ID_QUATERNARY_TDM_TX_5:

	case AFE_PORT_ID_QUATERNARY_TDM_TX_6:

	case AFE_PORT_ID_QUATERNARY_TDM_TX_7:

		dai_data->clk_set.clk_freq_in_hz = freq;

		break;

	default:

		return -EINVAL;

	}



	dev_dbg(dai->dev, "%s: dai id = 0x%x, group clk_freq = %d\n",

			__func__, dai->id, freq);

	return 0;

}



static int msm_dai_q6_tdm_set_channel_map(struct snd_soc_dai *dai,

				unsigned int tx_num, unsigned int *tx_slot,

				unsigned int rx_num, unsigned int *rx_slot)
@@ -6632,6 +6685,7 @@ static struct snd_soc_dai_ops msm_dai_q6_tdm_ops = { 
	.hw_params        = msm_dai_q6_tdm_hw_params,

	.set_tdm_slot     = msm_dai_q6_tdm_set_tdm_slot,

	.set_channel_map  = msm_dai_q6_tdm_set_channel_map,

	.set_sysclk       = msm_dai_q6_tdm_set_sysclk,

	.shutdown         = msm_dai_q6_tdm_shutdown,

};