diff options
| -rw-r--r-- | sound/soc/starfive/starfive_pwmdac.c | 119 |
1 files changed, 91 insertions, 28 deletions
diff --git a/sound/soc/starfive/starfive_pwmdac.c b/sound/soc/starfive/starfive_pwmdac.c index 2287cf43eefd..1e7a4384e6cb 100644 --- a/sound/soc/starfive/starfive_pwmdac.c +++ b/sound/soc/starfive/starfive_pwmdac.c @@ -1,3 +1,4 @@ +// SPDX-License-Identifier: GPL-2.0 /* * PWMDAC driver for the StarFive JH7110 SoC * @@ -623,12 +624,6 @@ static int sf_pwmdac_hw_params(struct snd_pcm_substream *substream, mclk_dac_value = mclk_dac_value + 64; pwmdac_set(dev); - ret = clk_prepare_enable(dev->clk_pwmdac_core); - if (ret) { - dev_err(dai->dev, "failed to prepare enable clk_pwmdac_core\n"); - goto err_clk_pwmdac; - } - ret = clk_set_rate(dev->clk_pwmdac_core, mclk_dac_value); if (ret) { dev_err(dai->dev, "failed to set rate for clk_pwmdac_core %lu\n", mclk_dac_value); @@ -678,28 +673,61 @@ static int sf_pwmdac_resets_get(struct platform_device *pdev, return 0; } -static int sf_pwmdac_clk_init(struct platform_device *pdev, - struct sf_pwmdac_dev *dev) +static int starfive_pwmdac_crg_enable(struct sf_pwmdac_dev *dev, bool enable) { int ret = 0; - ret = clk_prepare_enable(dev->clk_apb0); - if (ret) { - dev_err(&pdev->dev, "failed to prepare enable clk_apb0\n"); - goto err_clk_pwmdac; - } + dev_dbg(dev->dev, "starfive_pwmdac clk&rst %sable.\n", enable ? "en":"dis"); + if (enable) { + ret = clk_prepare_enable(dev->clk_apb0); + if (ret) { + dev_err(dev->dev, "failed to prepare enable clk_apb0\n"); + goto err_clk_apb0; + } - ret = clk_prepare_enable(dev->clk_pwmdac_apb); - if (ret) { - dev_err(&pdev->dev, "failed to prepare enable clk_pwmdac_apb\n"); - goto err_clk_pwmdac; + ret = clk_prepare_enable(dev->clk_pwmdac_apb); + if (ret) { + dev_err(dev->dev, "failed to prepare enable clk_pwmdac_apb\n"); + goto err_clk_apb; + } + + ret = clk_prepare_enable(dev->clk_pwmdac_core); + if (ret) { + dev_err(dev->dev, "failed to prepare enable clk_pwmdac_core\n"); + goto err_clk_core; + } + + ret = reset_control_deassert(dev->rst_apb); + if (ret) { + dev_err(dev->dev, "failed to deassert apb\n"); + goto err_rst_apb; + } + } else { + clk_disable_unprepare(dev->clk_pwmdac_core); + clk_disable_unprepare(dev->clk_pwmdac_apb); + clk_disable_unprepare(dev->clk_apb0); } - ret = clk_prepare_enable(dev->clk_pwmdac_core); - if (ret) { - dev_err(&pdev->dev, "failed to prepare enable clk_pwmdac_core\n"); + return 0; + +err_rst_apb: + clk_disable_unprepare(dev->clk_pwmdac_core); +err_clk_core: + clk_disable_unprepare(dev->clk_pwmdac_apb); +err_clk_apb: + clk_disable_unprepare(dev->clk_apb0); +err_clk_apb0: + return ret; +} + +static int sf_pwmdac_clk_init(struct platform_device *pdev, + struct sf_pwmdac_dev *dev) +{ + int ret = 0; + + ret = starfive_pwmdac_crg_enable(dev, true); + if (ret) goto err_clk_pwmdac; - } ret = clk_set_rate(dev->clk_pwmdac_core, 4096000); if (ret) { @@ -711,12 +739,6 @@ static int sf_pwmdac_clk_init(struct platform_device *pdev, clk_get_rate(dev->clk_apb0), clk_get_rate(dev->clk_pwmdac_apb), clk_get_rate(dev->clk_pwmdac_core)); - ret = reset_control_deassert(dev->rst_apb); - if (ret) { - dev_err(&pdev->dev, "failed to deassert apb\n"); - goto err_clk_pwmdac; - } - err_clk_pwmdac: return ret; } @@ -736,6 +758,39 @@ static int sf_pwmdac_dai_probe(struct snd_soc_dai *dai) return 0; } +#ifdef CONFIG_PM_SLEEP +static int starfive_pwmdac_system_suspend(struct device *dev) +{ + return pm_runtime_force_suspend(dev); +} + +static int starfive_pwmdac_system_resume(struct device *dev) +{ + return pm_runtime_force_resume(dev); +} +#endif + +#ifdef CONFIG_PM +static int starfive_pwmdac_runtime_suspend(struct device *dev) +{ + struct sf_pwmdac_dev *pwmdac = dev_get_drvdata(dev); + + return starfive_pwmdac_crg_enable(pwmdac, false); +} + +static int starfive_pwmdac_runtime_resume(struct device *dev) +{ + struct sf_pwmdac_dev *pwmdac = dev_get_drvdata(dev); + + return starfive_pwmdac_crg_enable(pwmdac, true); +} +#endif + +static const struct dev_pm_ops starfive_pwmdac_pm_ops = { + SET_RUNTIME_PM_OPS(starfive_pwmdac_runtime_suspend, starfive_pwmdac_runtime_resume, NULL) + SET_SYSTEM_SLEEP_PM_OPS(starfive_pwmdac_system_suspend, starfive_pwmdac_system_resume) +}; + #define SOC_PWMDAC_ENUM_DECL(xname, xinfo, xget, xput) \ { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \ .info = xinfo, .get = xget, .put = xput,} @@ -825,6 +880,7 @@ static int sf_pwmdac_probe(struct platform_device *pdev) return PTR_ERR(dev->pwmdac_base); dev->mapbase = res->start; + dev->dev = &pdev->dev; ret = sf_pwmdac_clks_get(pdev, dev); if (ret) { @@ -844,7 +900,6 @@ static int sf_pwmdac_probe(struct platform_device *pdev) return ret; } - dev->dev = &pdev->dev; dev->mode = shift_8Bit_inverter; dev->fifo_th = 1;//8byte pwmdac_config(dev); @@ -865,6 +920,12 @@ static int sf_pwmdac_probe(struct platform_device *pdev) 0); } +#ifdef CONFIG_PM + starfive_pwmdac_crg_enable(dev, false); +#endif + + pm_runtime_enable(dev->dev); + return 0; } @@ -890,6 +951,7 @@ static struct platform_driver sf_pwmdac_driver = { .driver = { .name = "starfive-pwmdac", .of_match_table = of_match_ptr(sf_pwmdac_of_match), + .pm = &starfive_pwmdac_pm_ops, }, }; @@ -908,6 +970,7 @@ late_initcall(pwmdac_driver_init); module_exit(pwmdac_driver_exit); MODULE_AUTHOR("curry.zhang <curry.zhang@starfivetech.com>"); +MODULE_AUTHOR("Xingyu Wu <xingyu.wu@starfivetech.com>"); MODULE_LICENSE("GPL v2"); MODULE_DESCRIPTION("starfive pwmdac SoC Interface"); MODULE_ALIAS("platform:starfive-pwmdac"); |