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

Commit 51904045 authored by Anson Huang's avatar Anson Huang Committed by Zhang Rui
Browse files

thermal: qoriq: Add clock operations 



Some platforms like i.MX8MQ has clock control for this module,
need to add clock operations to make sure the driver is working
properly.

Signed-off-by: default avatarAnson Huang <Anson.Huang@nxp.com>
Reviewed-by: default avatarGuido Günther <agx@sigxcpu.org>
Reviewed-by: default avatarDong Aisheng <aisheng.dong@nxp.com>
Signed-off-by: default avatarZhang Rui <rui.zhang@intel.com>
parent d1abaeb3

drivers/thermal/qoriq_thermal.c

+23 −0
Original line number Diff line number Diff line
@@ -2,6 +2,7 @@ 
//

// Copyright 2016 Freescale Semiconductor, Inc.



#include <linux/clk.h>

#include <linux/module.h>

#include <linux/platform_device.h>

#include <linux/err.h>
@@ -72,6 +73,7 @@ struct qoriq_sensor { 


struct qoriq_tmu_data {

	struct qoriq_tmu_regs __iomem *regs;

	struct clk *clk;

	bool little_endian;

	struct qoriq_sensor	*sensor[SITES_MAX];

};
@@ -209,6 +211,16 @@ static int qoriq_tmu_probe(struct platform_device *pdev) 
		goto err_iomap;

	}



	data->clk = devm_clk_get_optional(&pdev->dev, NULL);

	if (IS_ERR(data->clk))

		return PTR_ERR(data->clk);



	ret = clk_prepare_enable(data->clk);

	if (ret) {

		dev_err(&pdev->dev, "Failed to enable clock\n");

		return ret;

	}



	qoriq_tmu_init_device(data);	/* TMU initialization */



	ret = qoriq_tmu_calibration(pdev);	/* TMU calibration */
@@ -225,6 +237,7 @@ static int qoriq_tmu_probe(struct platform_device *pdev) 
	return 0;



err_tmu:

	clk_disable_unprepare(data->clk);

	iounmap(data->regs);



err_iomap:
@@ -241,6 +254,9 @@ static int qoriq_tmu_remove(struct platform_device *pdev) 
	tmu_write(data, TMR_DISABLE, &data->regs->tmr);



	iounmap(data->regs);



	clk_disable_unprepare(data->clk);



	platform_set_drvdata(pdev, NULL);



	return 0;
@@ -257,14 +273,21 @@ static int qoriq_tmu_suspend(struct device *dev) 
	tmr &= ~TMR_ME;

	tmu_write(data, tmr, &data->regs->tmr);



	clk_disable_unprepare(data->clk);



	return 0;

}



static int qoriq_tmu_resume(struct device *dev)

{

	u32 tmr;

	int ret;

	struct qoriq_tmu_data *data = dev_get_drvdata(dev);



	ret = clk_prepare_enable(data->clk);

	if (ret)

		return ret;



	/* Enable monitoring */

	tmr = tmu_read(data, &data->regs->tmr);

	tmr |= TMR_ME;