From 868ead7e7e0d6dc17512808ae84964a08a05499c Mon Sep 17 00:00:00 2001 From: Viorel Suman Date: Fri, 9 Feb 2018 11:39:58 +0200 Subject: MLK-17528-3: ASoC: fsl_sai: Set clock rate in "set_sysclk" API Set the requested clock rate in "set_sysclk" for specified clock id. Signed-off-by: Viorel Suman Suggested-by: Shengjiu Wang Reviewed-by: Shengjiu Wang Reviewed-by: Daniel Baluta --- sound/soc/fsl/fsl_sai.c | 19 +++++++++++++++++++ 1 file changed, 19 insertions(+) (limited to 'sound/soc/fsl/fsl_sai.c') diff --git a/sound/soc/fsl/fsl_sai.c b/sound/soc/fsl/fsl_sai.c index d1f40636a0b9..f4b46fe69d8a 100644 --- a/sound/soc/fsl/fsl_sai.c +++ b/sound/soc/fsl/fsl_sai.c @@ -245,6 +245,25 @@ static int fsl_sai_set_dai_sysclk(struct snd_soc_dai *cpu_dai, return 0; } + if (freq > 0) { + if (clk_id < 0 || clk_id >= FSL_SAI_MCLK_MAX) { + dev_err(cpu_dai->dev, "Unknown clock id: %d\n", clk_id); + return -EINVAL; + } + + if (IS_ERR_OR_NULL(sai->mclk_clk[clk_id])) { + dev_err(cpu_dai->dev, "Unassigned clock: %d\n", clk_id); + return -EINVAL; + } + + ret = clk_set_rate(sai->mclk_clk[clk_id], freq); + if (ret < 0) { + dev_err(cpu_dai->dev, "failed to set clock rate (%u): %d\n", + freq, ret); + return ret; + } + } + ret = fsl_sai_set_dai_sysclk_tr(cpu_dai, clk_id, freq, FSL_FMT_TRANSMITTER); if (ret) { -- cgit v1.2.3