leandrof/linux
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

thermal: qoriq: Add clock operations

Browse Source 
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: Anson Huang <Anson.Huang@nxp.com>
Reviewed-by: Guido Günther <agx@sigxcpu.org>
Reviewed-by: Dong Aisheng <aisheng.dong@nxp.com>
Signed-off-by: Zhang Rui <rui.zhang@intel.com>
This commit is contained in:
Anson Huang
2019-07-30 10:21:22 +08:00
committed by Zhang Rui
parent d1abaeb3be
commit 51904045d4
1 changed files with 23 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

23
drivers/thermal/qoriq_thermal.c
View File

@@ -2,6 +2,7 @@
// //
// Copyright 2016 Freescale Semiconductor, Inc. // Copyright 2016 Freescale Semiconductor, Inc.
#include <linux/clk.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/err.h> #include <linux/err.h>
@@ -72,6 +73,7 @@ struct qoriq_sensor {
struct qoriq_tmu_data { struct qoriq_tmu_data {
struct qoriq_tmu_regs __iomem *regs; struct qoriq_tmu_regs __iomem *regs;
struct clk *clk;
bool little_endian; bool little_endian;
struct qoriq_sensor *sensor[SITES_MAX]; struct qoriq_sensor *sensor[SITES_MAX];
}; };
@@ -209,6 +211,16 @@ static int qoriq_tmu_probe(struct platform_device *pdev)
goto err_iomap; 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 */ qoriq_tmu_init_device(data); /* TMU initialization */
ret = qoriq_tmu_calibration(pdev); /* TMU calibration */ ret = qoriq_tmu_calibration(pdev); /* TMU calibration */
@@ -225,6 +237,7 @@ static int qoriq_tmu_probe(struct platform_device *pdev)
return 0; return 0;
err_tmu: err_tmu:
clk_disable_unprepare(data->clk);
iounmap(data->regs); iounmap(data->regs);
err_iomap: err_iomap:
@@ -241,6 +254,9 @@ static int qoriq_tmu_remove(struct platform_device *pdev)
tmu_write(data, TMR_DISABLE, &data->regs->tmr); tmu_write(data, TMR_DISABLE, &data->regs->tmr);
iounmap(data->regs); iounmap(data->regs);
clk_disable_unprepare(data->clk);
platform_set_drvdata(pdev, NULL); platform_set_drvdata(pdev, NULL);
return 0; return 0;
@@ -257,14 +273,21 @@ static int qoriq_tmu_suspend(struct device *dev)
tmr &= ~TMR_ME; tmr &= ~TMR_ME;
tmu_write(data, tmr, &data->regs->tmr); tmu_write(data, tmr, &data->regs->tmr);
clk_disable_unprepare(data->clk);
return 0; return 0;
} }
static int qoriq_tmu_resume(struct device *dev) static int qoriq_tmu_resume(struct device *dev)
{ {
u32 tmr; u32 tmr;
int ret;
struct qoriq_tmu_data *data = dev_get_drvdata(dev); struct qoriq_tmu_data *data = dev_get_drvdata(dev);
ret = clk_prepare_enable(data->clk);
if (ret)
return ret;
/* Enable monitoring */ /* Enable monitoring */
tmr = tmu_read(data, &data->regs->tmr); tmr = tmu_read(data, &data->regs->tmr);
tmr |= TMR_ME; tmr |= TMR_ME;