Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit f09d6984 authored by Wei Ni's avatar Wei Ni Committed by Eduardo Valentin
Browse files

thermal: tegra: add PM support 



Add suspend/resume function in soctherm driver.

Signed-off-by: default avatarWei Ni <wni@nvidia.com>
Signed-off-by: default avatarEduardo Valentin <edubezval@gmail.com>
parent 1ed895c2

drivers/thermal/tegra/soctherm.c

+46 −0
Original line number Diff line number Diff line
@@ -88,6 +88,7 @@ struct tegra_soctherm { 
	struct clk *clock_tsensor;

	struct clk *clock_soctherm;

	void __iomem *regs;

	struct thermal_zone_device **thermctl_tzs;



	u32 *calib;

	struct tegra_soctherm_soc *soc;
@@ -566,6 +567,12 @@ static int tegra_soctherm_probe(struct platform_device *pdev) 
			return err;

	}



	tegra->thermctl_tzs = devm_kzalloc(&pdev->dev,

					   sizeof(*z) * soc->num_ttgs,

					   GFP_KERNEL);

	if (!tegra->thermctl_tzs)

		return -ENOMEM;



	err = soctherm_clk_enable(pdev, true);

	if (err)

		return err;
@@ -595,6 +602,7 @@ static int tegra_soctherm_probe(struct platform_device *pdev) 
		}



		zone->tz = z;

		tegra->thermctl_tzs[soc->ttgs[i]->id] = z;



		/* Configure hw trip points */

		tegra_soctherm_set_hwtrips(&pdev->dev, soc->ttgs[i], z);
@@ -621,11 +629,49 @@ static int tegra_soctherm_remove(struct platform_device *pdev) 
	return 0;

}



static int soctherm_suspend(struct device *dev)

{

	struct platform_device *pdev = to_platform_device(dev);



	soctherm_clk_enable(pdev, false);



	return 0;

}



static int soctherm_resume(struct device *dev)

{

	struct platform_device *pdev = to_platform_device(dev);

	struct tegra_soctherm *tegra = platform_get_drvdata(pdev);

	struct tegra_soctherm_soc *soc = tegra->soc;

	int err, i;



	err = soctherm_clk_enable(pdev, true);

	if (err) {

		dev_err(&pdev->dev,

			"Resume failed: enable clocks failed\n");

		return err;

	}



	soctherm_init(pdev);



	for (i = 0; i < soc->num_ttgs; ++i) {

		struct thermal_zone_device *tz;



		tz = tegra->thermctl_tzs[soc->ttgs[i]->id];

		tegra_soctherm_set_hwtrips(dev, soc->ttgs[i], tz);

	}



	return 0;

}



static SIMPLE_DEV_PM_OPS(tegra_soctherm_pm, soctherm_suspend, soctherm_resume);



static struct platform_driver tegra_soctherm_driver = {

	.probe = tegra_soctherm_probe,

	.remove = tegra_soctherm_remove,

	.driver = {

		.name = "tegra_soctherm",

		.pm = &tegra_soctherm_pm,

		.of_match_table = tegra_soctherm_of_match,

	},

};