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 <viorel.suman@nxp.com>
Suggested-by: Shengjiu Wang <shengjiu.wang@nxp.com>
Reviewed-by: Shengjiu Wang <shengjiu.wang@nxp.com>
Reviewed-by: Daniel Baluta <daniel.baluta@nxp.com>

diff --git a/sound/soc/fsl/fsl_sai.c b/sound/soc/fsl/fsl_sai.c
index 57b13a5..0f2b1b7 100644 (file)
--- a/sound/soc/fsl/fsl_sai.c
+++ b/sound/soc/fsl/fsl_sai.c
@@ -251,6 +251,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) {