Commit 8137bb90 authored by Balsam CHIHI's avatar Balsam CHIHI Committed by Daniel Lezcano
Browse files

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



Add suspend and resume support to LVTS driver.

Signed-off-by: default avatarBalsam CHIHI <bchihi@baylibre.com>
[bero@baylibre.com: suspend/resume in noirq phase]
Co-developed-by: default avatarBernhard Rosenkränzer <bero@baylibre.com>
Signed-off-by: default avatarBernhard Rosenkränzer <bero@baylibre.com>
Reviewed-by: default avatarMatthias Brugger <matthias.bgg@gmail.com>
Reviewed-by: default avatarAlexandre Mergnat <amergnat@baylibre.com>
Reviewed-by: default avatarAngeloGioacchino Del Regno <angelogioacchino.delregno@collabora.com>
Signed-off-by: default avatarDaniel Lezcano <daniel.lezcano@linaro.org>
Link: https://lore.kernel.org/r/20231017190545.157282-3-bero@baylibre.com
parent 0bb4937b

drivers/thermal/mediatek/lvts_thermal.c

+37 −0
Original line number Diff line number Diff line
@@ -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);