|
@@ -28,6 +28,7 @@
|
|
|
|
|
|
#include "ux500_msp_i2s.h"
|
|
|
#include "ux500_msp_dai.h"
|
|
|
+#include "ux500_pcm.h"
|
|
|
|
|
|
static int setup_pcm_multichan(struct snd_soc_dai *dai,
|
|
|
struct ux500_msp_config *msp_config)
|
|
@@ -398,11 +399,28 @@ static int ux500_msp_dai_startup(struct snd_pcm_substream *substream,
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
- /* Enable clock */
|
|
|
- dev_dbg(dai->dev, "%s: Enabling MSP-clock.\n", __func__);
|
|
|
- clk_enable(drvdata->clk);
|
|
|
+ /* Prepare and enable clocks */
|
|
|
+ dev_dbg(dai->dev, "%s: Enabling MSP-clocks.\n", __func__);
|
|
|
+ ret = clk_prepare_enable(drvdata->pclk);
|
|
|
+ if (ret) {
|
|
|
+ dev_err(drvdata->msp->dev,
|
|
|
+ "%s: Failed to prepare/enable pclk!\n", __func__);
|
|
|
+ goto err_pclk;
|
|
|
+ }
|
|
|
|
|
|
- return 0;
|
|
|
+ ret = clk_prepare_enable(drvdata->clk);
|
|
|
+ if (ret) {
|
|
|
+ dev_err(drvdata->msp->dev,
|
|
|
+ "%s: Failed to prepare/enable clk!\n", __func__);
|
|
|
+ goto err_clk;
|
|
|
+ }
|
|
|
+
|
|
|
+ return ret;
|
|
|
+err_clk:
|
|
|
+ clk_disable_unprepare(drvdata->pclk);
|
|
|
+err_pclk:
|
|
|
+ regulator_disable(drvdata->reg_vape);
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
static void ux500_msp_dai_shutdown(struct snd_pcm_substream *substream,
|
|
@@ -428,8 +446,9 @@ static void ux500_msp_dai_shutdown(struct snd_pcm_substream *substream,
|
|
|
__func__, dai->id, snd_pcm_stream_str(substream));
|
|
|
}
|
|
|
|
|
|
- /* Disable clock */
|
|
|
- clk_disable(drvdata->clk);
|
|
|
+ /* Disable and unprepare clocks */
|
|
|
+ clk_disable_unprepare(drvdata->clk);
|
|
|
+ clk_disable_unprepare(drvdata->pclk);
|
|
|
|
|
|
/* Disable regulator */
|
|
|
ret = regulator_disable(drvdata->reg_vape);
|
|
@@ -780,6 +799,14 @@ static int __devinit ux500_msp_drv_probe(struct platform_device *pdev)
|
|
|
}
|
|
|
prcmu_qos_add_requirement(PRCMU_QOS_APE_OPP, (char *)pdev->name, 50);
|
|
|
|
|
|
+ drvdata->pclk = clk_get(&pdev->dev, "apb_pclk");
|
|
|
+ if (IS_ERR(drvdata->pclk)) {
|
|
|
+ ret = (int)PTR_ERR(drvdata->pclk);
|
|
|
+ dev_err(&pdev->dev, "%s: ERROR: clk_get of pclk failed (%d)!\n",
|
|
|
+ __func__, ret);
|
|
|
+ goto err_pclk;
|
|
|
+ }
|
|
|
+
|
|
|
drvdata->clk = clk_get(&pdev->dev, NULL);
|
|
|
if (IS_ERR(drvdata->clk)) {
|
|
|
ret = (int)PTR_ERR(drvdata->clk);
|
|
@@ -806,12 +833,23 @@ static int __devinit ux500_msp_drv_probe(struct platform_device *pdev)
|
|
|
goto err_init_msp;
|
|
|
}
|
|
|
|
|
|
+ ret = ux500_pcm_register_platform(pdev);
|
|
|
+ if (ret < 0) {
|
|
|
+ dev_err(&pdev->dev,
|
|
|
+ "Error: %s: Failed to register PCM platform device!\n",
|
|
|
+ __func__);
|
|
|
+ goto err_reg_plat;
|
|
|
+ }
|
|
|
+
|
|
|
return 0;
|
|
|
|
|
|
+err_reg_plat:
|
|
|
+ snd_soc_unregister_dais(&pdev->dev, ARRAY_SIZE(ux500_msp_dai_drv));
|
|
|
err_init_msp:
|
|
|
clk_put(drvdata->clk);
|
|
|
-
|
|
|
err_clk:
|
|
|
+ clk_put(drvdata->pclk);
|
|
|
+err_pclk:
|
|
|
devm_regulator_put(drvdata->reg_vape);
|
|
|
|
|
|
return ret;
|
|
@@ -821,12 +859,15 @@ static int __devexit ux500_msp_drv_remove(struct platform_device *pdev)
|
|
|
{
|
|
|
struct ux500_msp_i2s_drvdata *drvdata = dev_get_drvdata(&pdev->dev);
|
|
|
|
|
|
+ ux500_pcm_unregister_platform(pdev);
|
|
|
+
|
|
|
snd_soc_unregister_dais(&pdev->dev, ARRAY_SIZE(ux500_msp_dai_drv));
|
|
|
|
|
|
devm_regulator_put(drvdata->reg_vape);
|
|
|
prcmu_qos_remove_requirement(PRCMU_QOS_APE_OPP, "ux500_msp_i2s");
|
|
|
|
|
|
clk_put(drvdata->clk);
|
|
|
+ clk_put(drvdata->pclk);
|
|
|
|
|
|
ux500_msp_i2s_cleanup_msp(pdev, drvdata->msp);
|
|
|
|