|
|
@@ -33,7 +33,7 @@ static int lpass_cpu_daiops_set_sysclk(struct snd_soc_dai *dai, int clk_id,
|
|
|
struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai);
|
|
|
int ret;
|
|
|
|
|
|
- ret = clk_set_rate(drvdata->mi2s_osr_clk, freq);
|
|
|
+ ret = clk_set_rate(drvdata->mi2s_osr_clk[dai->driver->id], freq);
|
|
|
if (ret)
|
|
|
dev_err(dai->dev, "%s() error setting mi2s osrclk to %u: %d\n",
|
|
|
__func__, freq, ret);
|
|
|
@@ -47,18 +47,18 @@ static int lpass_cpu_daiops_startup(struct snd_pcm_substream *substream,
|
|
|
struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai);
|
|
|
int ret;
|
|
|
|
|
|
- ret = clk_prepare_enable(drvdata->mi2s_osr_clk);
|
|
|
+ ret = clk_prepare_enable(drvdata->mi2s_osr_clk[dai->diver->id]);
|
|
|
if (ret) {
|
|
|
dev_err(dai->dev, "%s() error in enabling mi2s osr clk: %d\n",
|
|
|
__func__, ret);
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
- ret = clk_prepare_enable(drvdata->mi2s_bit_clk);
|
|
|
+ ret = clk_prepare_enable(drvdata->mi2s_bit_clk[dai->driver->id]);
|
|
|
if (ret) {
|
|
|
dev_err(dai->dev, "%s() error in enabling mi2s bit clk: %d\n",
|
|
|
__func__, ret);
|
|
|
- clk_disable_unprepare(drvdata->mi2s_osr_clk);
|
|
|
+ clk_disable_unprepare(drvdata->mi2s_osr_clk[dai->driver->id]);
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
@@ -70,8 +70,8 @@ static void lpass_cpu_daiops_shutdown(struct snd_pcm_substream *substream,
|
|
|
{
|
|
|
struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai);
|
|
|
|
|
|
- clk_disable_unprepare(drvdata->mi2s_bit_clk);
|
|
|
- clk_disable_unprepare(drvdata->mi2s_osr_clk);
|
|
|
+ clk_disable_unprepare(drvdata->mi2s_bit_clk[dai->driver->id]);
|
|
|
+ clk_disable_unprepare(drvdata->mi2s_osr_clk[dai->driver->id]);
|
|
|
}
|
|
|
|
|
|
static int lpass_cpu_daiops_hw_params(struct snd_pcm_substream *substream,
|
|
|
@@ -146,7 +146,8 @@ static int lpass_cpu_daiops_hw_params(struct snd_pcm_substream *substream,
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
- ret = clk_set_rate(drvdata->mi2s_bit_clk, rate * bitwidth * 2);
|
|
|
+ ret = clk_set_rate(drvdata->mi2s_bit_clk[dai->driver->id],
|
|
|
+ rate * bitwidth * 2);
|
|
|
if (ret) {
|
|
|
dev_err(dai->dev, "%s() error setting mi2s bitclk to %u: %d\n",
|
|
|
__func__, rate * bitwidth * 2, ret);
|
|
|
@@ -354,7 +355,8 @@ int asoc_qcom_lpass_cpu_platform_probe(struct platform_device *pdev)
|
|
|
struct lpass_variant *variant;
|
|
|
struct device *dev = &pdev->dev;
|
|
|
const struct of_device_id *match;
|
|
|
- int ret;
|
|
|
+ char clk_name[16];
|
|
|
+ int ret, i, dai_id;
|
|
|
|
|
|
dsp_of_node = of_parse_phandle(pdev->dev.of_node, "qcom,adsp", 0);
|
|
|
if (dsp_of_node) {
|
|
|
@@ -400,18 +402,36 @@ int asoc_qcom_lpass_cpu_platform_probe(struct platform_device *pdev)
|
|
|
if (variant->init)
|
|
|
variant->init(pdev);
|
|
|
|
|
|
- drvdata->mi2s_osr_clk = devm_clk_get(&pdev->dev, "mi2s-osr-clk");
|
|
|
- if (IS_ERR(drvdata->mi2s_osr_clk)) {
|
|
|
- dev_err(&pdev->dev, "%s() error getting mi2s-osr-clk: %ld\n",
|
|
|
- __func__, PTR_ERR(drvdata->mi2s_osr_clk));
|
|
|
- return PTR_ERR(drvdata->mi2s_osr_clk);
|
|
|
- }
|
|
|
-
|
|
|
- drvdata->mi2s_bit_clk = devm_clk_get(&pdev->dev, "mi2s-bit-clk");
|
|
|
- if (IS_ERR(drvdata->mi2s_bit_clk)) {
|
|
|
- dev_err(&pdev->dev, "%s() error getting mi2s-bit-clk: %ld\n",
|
|
|
- __func__, PTR_ERR(drvdata->mi2s_bit_clk));
|
|
|
- return PTR_ERR(drvdata->mi2s_bit_clk);
|
|
|
+ for (i = 0; i < variant->num_dai; i++) {
|
|
|
+ dai_id = variant->dai_driver[i].id;
|
|
|
+ if (variant->num_dai > 1)
|
|
|
+ sprintf(clk_name, "mi2s-osr-clk%d", i);
|
|
|
+ else
|
|
|
+ sprintf(clk_name, "mi2s-osr-clk");
|
|
|
+
|
|
|
+ drvdata->mi2s_osr_clk[dai_id] = devm_clk_get(&pdev->dev,
|
|
|
+ clk_name);
|
|
|
+ if (IS_ERR(drvdata->mi2s_osr_clk[dai_id])) {
|
|
|
+ dev_err(&pdev->dev,
|
|
|
+ "%s() error getting mi2s-osr-clk: %ld\n",
|
|
|
+ __func__,
|
|
|
+ PTR_ERR(drvdata->mi2s_osr_clk[dai_id]));
|
|
|
+ return PTR_ERR(drvdata->mi2s_osr_clk[dai_id]);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (variant->num_dai > 1)
|
|
|
+ sprintf(clk_name, "mi2s-bit-clk%d", i);
|
|
|
+ else
|
|
|
+ sprintf(clk_name, "mi2s-bit-clk");
|
|
|
+
|
|
|
+ drvdata->mi2s_bit_clk[dai_id] = devm_clk_get(&pdev->dev,
|
|
|
+ clk_name);
|
|
|
+ if (IS_ERR(drvdata->mi2s_bit_clk[dai_id])) {
|
|
|
+ dev_err(&pdev->dev,
|
|
|
+ "%s() error getting mi2s-bit-clk: %ld\n",
|
|
|
+ __func__, PTR_ERR(drvdata->mi2s_bit_clk[i]));
|
|
|
+ return PTR_ERR(drvdata->mi2s_bit_clk[dai_id]);
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
drvdata->ahbix_clk = devm_clk_get(&pdev->dev, "ahbix-clk");
|