thermal/drivers/mediatek/lvts_thermal: Add suspend and resume

Add suspend and resume support to LVTS driver.

Signed-off-by: Balsam CHIHI <bchihi@baylibre.com>
[bero@baylibre.com: suspend/resume in noirq phase]
Co-developed-by: Bernhard Rosenkränzer <bero@baylibre.com>
Signed-off-by: Bernhard Rosenkränzer <bero@baylibre.com>
Reviewed-by: Matthias Brugger <matthias.bgg@gmail.com>
Reviewed-by: Alexandre Mergnat <amergnat@baylibre.com>
Reviewed-by: AngeloGioacchino Del Regno <angelogioacchino.delregno@collabora.com>
Signed-off-by: Daniel Lezcano <daniel.lezcano@linaro.org>
Link: https://lore.kernel.org/r/20231017190545.157282-3-bero@baylibre.com

diff --git a/drivers/thermal/mediatek/lvts_thermal.c b/drivers/thermal/mediatek/lvts_thermal.c
index 704b22d12e274e29846201f7bf59ba54005ee3dd..4ac6ae37a1ee397d43fa1044d6aa58f4a870479a 100644 (file)
--- a/drivers/thermal/mediatek/lvts_thermal.c
+++ b/drivers/thermal/mediatek/lvts_thermal.c
@@ -1297,6 +1297,38 @@ static const struct lvts_ctrl_data mt7988_lvts_ap_data_ctrl[] = {
        }
 };
 
+static int lvts_suspend(struct device *dev)
+{
+       struct lvts_domain *lvts_td;
+       int i;
+
+       lvts_td = dev_get_drvdata(dev);
+
+       for (i = 0; i < lvts_td->num_lvts_ctrl; i++)
+               lvts_ctrl_set_enable(&lvts_td->lvts_ctrl[i], false);
+
+       clk_disable_unprepare(lvts_td->clk);
+
+       return 0;
+}
+
+static int lvts_resume(struct device *dev)
+{
+       struct lvts_domain *lvts_td;
+       int i, ret;
+
+       lvts_td = dev_get_drvdata(dev);
+
+       ret = clk_prepare_enable(lvts_td->clk);
+       if (ret)
+               return ret;
+
+       for (i = 0; i < lvts_td->num_lvts_ctrl; i++)
+               lvts_ctrl_set_enable(&lvts_td->lvts_ctrl[i], true);
+
+       return 0;
+}
+
 static const struct lvts_ctrl_data mt8195_lvts_mcu_data_ctrl[] = {
        {
                .cal_offset = { 0x04, 0x07 },
@@ -1405,12 +1437,17 @@ static const struct of_device_id lvts_of_match[] = {
 };
 MODULE_DEVICE_TABLE(of, lvts_of_match);
 
+static const struct dev_pm_ops lvts_pm_ops = {
+       NOIRQ_SYSTEM_SLEEP_PM_OPS(lvts_suspend, lvts_resume)
+};
+
 static struct platform_driver lvts_driver = {
        .probe = lvts_probe,
        .remove_new = lvts_remove,
        .driver = {
                .name = "mtk-lvts-thermal",
                .of_match_table = lvts_of_match,
+               .pm = &lvts_pm_ops,
        },
 };
 module_platform_driver(lvts_driver);