ASoC: codecs: rx-macro: add runtime pm support

Signed-off-by: Srinivas Kandagatla <srinivas.kandagatla@linaro.org>
Link: https://lore.kernel.org/r/20220224111718.6264-13-srinivas.kandagatla@linaro.org
Signed-off-by: Mark Brown <broonie@kernel.org>

diff --git a/sound/soc/codecs/lpass-rx-macro.c b/sound/soc/codecs/lpass-rx-macro.c
index 65fc3698492f3cf40fdf079332d06dce1d3e7cd2..58dc8675680484e153ae142784ef5e05d053085c 100644 (file)
--- a/sound/soc/codecs/lpass-rx-macro.c
+++ b/sound/soc/codecs/lpass-rx-macro.c
@@ -5,6 +5,7 @@
 #include <linux/init.h>
 #include <linux/io.h>
 #include <linux/platform_device.h>
+#include <linux/pm_runtime.h>
 #include <linux/clk.h>
 #include <sound/soc.h>
 #include <sound/pcm.h>
@@ -3601,6 +3602,13 @@ static int rx_macro_probe(struct platform_device *pdev)
        if (ret)
                goto err_clkout;
 
+
+       pm_runtime_set_autosuspend_delay(dev, 3000);
+       pm_runtime_use_autosuspend(dev);
+       pm_runtime_mark_last_busy(dev);
+       pm_runtime_set_active(dev);
+       pm_runtime_enable(dev);
+
        return 0;
 
 err_clkout:
@@ -3637,11 +3645,65 @@ static const struct of_device_id rx_macro_dt_match[] = {
 };
 MODULE_DEVICE_TABLE(of, rx_macro_dt_match);
 
+static int __maybe_unused rx_macro_runtime_suspend(struct device *dev)
+{
+       struct rx_macro *rx = dev_get_drvdata(dev);
+
+       regcache_cache_only(rx->regmap, true);
+       regcache_mark_dirty(rx->regmap);
+
+       clk_disable_unprepare(rx->mclk);
+       clk_disable_unprepare(rx->npl);
+       clk_disable_unprepare(rx->fsgen);
+
+       return 0;
+}
+
+static int __maybe_unused rx_macro_runtime_resume(struct device *dev)
+{
+       struct rx_macro *rx = dev_get_drvdata(dev);
+       int ret;
+
+       ret = clk_prepare_enable(rx->mclk);
+       if (ret) {
+               dev_err(dev, "unable to prepare mclk\n");
+               return ret;
+       }
+
+       ret = clk_prepare_enable(rx->npl);
+       if (ret) {
+               dev_err(dev, "unable to prepare mclkx2\n");
+               goto err_npl;
+       }
+
+       ret = clk_prepare_enable(rx->fsgen);
+       if (ret) {
+               dev_err(dev, "unable to prepare fsgen\n");
+               goto err_fsgen;
+       }
+       regcache_cache_only(rx->regmap, false);
+       regcache_sync(rx->regmap);
+       rx->reset_swr = true;
+
+       return 0;
+err_fsgen:
+       clk_disable_unprepare(rx->npl);
+err_npl:
+       clk_disable_unprepare(rx->mclk);
+
+       return ret;
+}
+
+static const struct dev_pm_ops rx_macro_pm_ops = {
+       SET_RUNTIME_PM_OPS(rx_macro_runtime_suspend, rx_macro_runtime_resume, NULL)
+};
+
 static struct platform_driver rx_macro_driver = {
        .driver = {
                .name = "rx_macro",
                .of_match_table = rx_macro_dt_match,
                .suppress_bind_attrs = true,
+               .pm = &rx_macro_pm_ops,
        },
        .probe = rx_macro_probe,
        .remove = rx_macro_remove,