mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-10-02 07:04:24 +00:00
- Fix PM issue on the iMX driver when suspend/resume is happening by
implementing PM runtime support (Oleksij Rempel) - Add 'const' annotation to the thermal_cooling_ops in the Intel powerclamp driver (Rikard Falkeborn) - Add TSU driver and bindings for the RZ/G2L platform (Biju Das) - Fix the missing ADC bit set on iMX8MP to enable the sensor (Paul Gerber) - Fix missing check when calling reset_control_deassert() (Biju Das) -----BEGIN PGP SIGNATURE----- iQEzBAABCAAdFiEEGn3N4YVz0WNVyHskqDIjiipP6E8FAmHEmTsACgkQqDIjiipP 6E/KMgf+MdzK/OTuxP+pf0yVqpC3WpH6lrNhBRC+mO4S0yAe8ZlYCFVVtvMftSrn M2H8uxw74XlVkD8yi1kSYa1iVeD9jF+5ZViOybc83SKwryYEFI7tjxsjpaPFotxe ZnL8y55hDC63YpwNeafGgW9M/JFehBP09zafakdVsvzzNGP8XKoYQcgyeofwNIrX CRwU95K85k0eS2h9gPFPRWaNwZS4ubVEYr857oiGArX4/hEycvJ2UO+cH+zEmGjQ QKJIEh5gQEBs2lKgcqUwzNbitm5lUG+rYRWD9omQ4QLtHK/fxZw2CMMVnNso/G5z lslc8pLLwLh5QdR3v9tX4+OAxsV38A== =uIVF -----END PGP SIGNATURE----- Merge tag 'thermal-v5.17-rc1' of https://git.kernel.org/pub/scm/linux/kernel/git/thermal/linux Pull thermal control material for 5.17-rc1 from Daniel Lezcano: - Fix PM issue on the iMX driver when suspend/resume is happening by implementing PM runtime support (Oleksij Rempel) - Add 'const' annotation to the thermal_cooling_ops in the Intel powerclamp driver (Rikard Falkeborn) - Add TSU driver and bindings for the RZ/G2L platform (Biju Das) - Fix missing ADC bit set on iMX8MP to enable the sensor (Paul Gerber) - Fix missing check when calling reset_control_deassert() (Biju Das) * tag 'thermal-v5.17-rc1' of https://git.kernel.org/pub/scm/linux/kernel/git/thermal/linux: thermal/drivers/rz2gl: Add error check for reset_control_deassert() thermal/drivers/imx8mm: Enable ADC when enabling monitor thermal/drivers: Add TSU driver for RZ/G2L dt-bindings: thermal: Document Renesas RZ/G2L TSU thermal/drivers/intel_powerclamp: Constify static thermal_cooling_device_ops thermal/drivers/imx: Implement runtime PM support
This commit is contained in:
commit
125521addc
7 changed files with 424 additions and 56 deletions
76
Documentation/devicetree/bindings/thermal/rzg2l-thermal.yaml
Normal file
76
Documentation/devicetree/bindings/thermal/rzg2l-thermal.yaml
Normal file
|
@ -0,0 +1,76 @@
|
|||
# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
|
||||
%YAML 1.2
|
||||
---
|
||||
$id: http://devicetree.org/schemas/thermal/rzg2l-thermal.yaml#
|
||||
$schema: http://devicetree.org/meta-schemas/core.yaml#
|
||||
|
||||
title: Renesas RZ/G2L Thermal Sensor Unit
|
||||
|
||||
description:
|
||||
On RZ/G2L SoCs, the thermal sensor unit (TSU) measures the
|
||||
temperature(Tj) inside the LSI.
|
||||
|
||||
maintainers:
|
||||
- Biju Das <biju.das.jz@bp.renesas.com>
|
||||
|
||||
properties:
|
||||
compatible:
|
||||
items:
|
||||
- enum:
|
||||
- renesas,r9a07g044-tsu # RZ/G2{L,LC}
|
||||
- const: renesas,rzg2l-tsu
|
||||
|
||||
reg:
|
||||
maxItems: 1
|
||||
|
||||
clocks:
|
||||
maxItems: 1
|
||||
|
||||
power-domains:
|
||||
maxItems: 1
|
||||
|
||||
resets:
|
||||
maxItems: 1
|
||||
|
||||
"#thermal-sensor-cells":
|
||||
const: 1
|
||||
|
||||
required:
|
||||
- compatible
|
||||
- reg
|
||||
- clocks
|
||||
- power-domains
|
||||
- resets
|
||||
- "#thermal-sensor-cells"
|
||||
|
||||
additionalProperties: false
|
||||
|
||||
examples:
|
||||
- |
|
||||
#include <dt-bindings/clock/r9a07g044-cpg.h>
|
||||
|
||||
tsu: thermal@10059400 {
|
||||
compatible = "renesas,r9a07g044-tsu",
|
||||
"renesas,rzg2l-tsu";
|
||||
reg = <0x10059400 0x400>;
|
||||
clocks = <&cpg CPG_MOD R9A07G044_TSU_PCLK>;
|
||||
resets = <&cpg R9A07G044_TSU_PRESETN>;
|
||||
power-domains = <&cpg>;
|
||||
#thermal-sensor-cells = <1>;
|
||||
};
|
||||
|
||||
thermal-zones {
|
||||
cpu-thermal {
|
||||
polling-delay-passive = <250>;
|
||||
polling-delay = <1000>;
|
||||
thermal-sensors = <&tsu 0>;
|
||||
|
||||
trips {
|
||||
sensor_crit: sensor-crit {
|
||||
temperature = <125000>;
|
||||
hysteresis = <1000>;
|
||||
type = "critical";
|
||||
};
|
||||
};
|
||||
};
|
||||
};
|
|
@ -354,6 +354,15 @@ config RCAR_GEN3_THERMAL
|
|||
Enable this to plug the R-Car Gen3 or RZ/G2 thermal sensor driver into
|
||||
the Linux thermal framework.
|
||||
|
||||
config RZG2L_THERMAL
|
||||
tristate "Renesas RZ/G2L thermal driver"
|
||||
depends on ARCH_RENESAS || COMPILE_TEST
|
||||
depends on HAS_IOMEM
|
||||
depends on OF
|
||||
help
|
||||
Enable this to plug the RZ/G2L thermal sensor driver into the Linux
|
||||
thermal framework.
|
||||
|
||||
config KIRKWOOD_THERMAL
|
||||
tristate "Temperature sensor on Marvell Kirkwood SoCs"
|
||||
depends on MACH_KIRKWOOD || COMPILE_TEST
|
||||
|
|
|
@ -37,6 +37,7 @@ obj-$(CONFIG_SUN8I_THERMAL) += sun8i_thermal.o
|
|||
obj-$(CONFIG_ROCKCHIP_THERMAL) += rockchip_thermal.o
|
||||
obj-$(CONFIG_RCAR_THERMAL) += rcar_thermal.o
|
||||
obj-$(CONFIG_RCAR_GEN3_THERMAL) += rcar_gen3_thermal.o
|
||||
obj-$(CONFIG_RZG2L_THERMAL) += rzg2l_thermal.o
|
||||
obj-$(CONFIG_KIRKWOOD_THERMAL) += kirkwood_thermal.o
|
||||
obj-y += samsung/
|
||||
obj-$(CONFIG_DOVE_THERMAL) += dove_thermal.o
|
||||
|
|
|
@ -21,6 +21,7 @@
|
|||
#define TPS 0x4
|
||||
#define TRITSR 0x20 /* TMU immediate temp */
|
||||
|
||||
#define TER_ADC_PD BIT(30)
|
||||
#define TER_EN BIT(31)
|
||||
#define TRITSR_TEMP0_VAL_MASK 0xff
|
||||
#define TRITSR_TEMP1_VAL_MASK 0xff0000
|
||||
|
@ -113,6 +114,8 @@ static void imx8mm_tmu_enable(struct imx8mm_tmu *tmu, bool enable)
|
|||
|
||||
val = readl_relaxed(tmu->base + TER);
|
||||
val = enable ? (val | TER_EN) : (val & ~TER_EN);
|
||||
if (tmu->socdata->version == TMU_VER2)
|
||||
val = enable ? (val & ~TER_ADC_PD) : (val | TER_ADC_PD);
|
||||
writel_relaxed(val, tmu->base + TER);
|
||||
}
|
||||
|
||||
|
|
|
@ -15,6 +15,7 @@
|
|||
#include <linux/regmap.h>
|
||||
#include <linux/thermal.h>
|
||||
#include <linux/nvmem-consumer.h>
|
||||
#include <linux/pm_runtime.h>
|
||||
|
||||
#define REG_SET 0x4
|
||||
#define REG_CLR 0x8
|
||||
|
@ -194,6 +195,7 @@ static struct thermal_soc_data thermal_imx7d_data = {
|
|||
};
|
||||
|
||||
struct imx_thermal_data {
|
||||
struct device *dev;
|
||||
struct cpufreq_policy *policy;
|
||||
struct thermal_zone_device *tz;
|
||||
struct thermal_cooling_device *cdev;
|
||||
|
@ -252,44 +254,15 @@ static int imx_get_temp(struct thermal_zone_device *tz, int *temp)
|
|||
const struct thermal_soc_data *soc_data = data->socdata;
|
||||
struct regmap *map = data->tempmon;
|
||||
unsigned int n_meas;
|
||||
bool wait, run_measurement;
|
||||
u32 val;
|
||||
int ret;
|
||||
|
||||
run_measurement = !data->irq_enabled;
|
||||
if (!run_measurement) {
|
||||
/* Check if a measurement is currently in progress */
|
||||
regmap_read(map, soc_data->temp_data, &val);
|
||||
wait = !(val & soc_data->temp_valid_mask);
|
||||
} else {
|
||||
/*
|
||||
* Every time we measure the temperature, we will power on the
|
||||
* temperature sensor, enable measurements, take a reading,
|
||||
* disable measurements, power off the temperature sensor.
|
||||
*/
|
||||
regmap_write(map, soc_data->sensor_ctrl + REG_CLR,
|
||||
soc_data->power_down_mask);
|
||||
regmap_write(map, soc_data->sensor_ctrl + REG_SET,
|
||||
soc_data->measure_temp_mask);
|
||||
|
||||
wait = true;
|
||||
}
|
||||
|
||||
/*
|
||||
* According to the temp sensor designers, it may require up to ~17us
|
||||
* to complete a measurement.
|
||||
*/
|
||||
if (wait)
|
||||
usleep_range(20, 50);
|
||||
ret = pm_runtime_resume_and_get(data->dev);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
regmap_read(map, soc_data->temp_data, &val);
|
||||
|
||||
if (run_measurement) {
|
||||
regmap_write(map, soc_data->sensor_ctrl + REG_CLR,
|
||||
soc_data->measure_temp_mask);
|
||||
regmap_write(map, soc_data->sensor_ctrl + REG_SET,
|
||||
soc_data->power_down_mask);
|
||||
}
|
||||
|
||||
if ((val & soc_data->temp_valid_mask) == 0) {
|
||||
dev_dbg(&tz->device, "temp measurement never finished\n");
|
||||
return -EAGAIN;
|
||||
|
@ -328,6 +301,8 @@ static int imx_get_temp(struct thermal_zone_device *tz, int *temp)
|
|||
enable_irq(data->irq);
|
||||
}
|
||||
|
||||
pm_runtime_put(data->dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
@ -335,24 +310,16 @@ static int imx_change_mode(struct thermal_zone_device *tz,
|
|||
enum thermal_device_mode mode)
|
||||
{
|
||||
struct imx_thermal_data *data = tz->devdata;
|
||||
struct regmap *map = data->tempmon;
|
||||
const struct thermal_soc_data *soc_data = data->socdata;
|
||||
|
||||
if (mode == THERMAL_DEVICE_ENABLED) {
|
||||
regmap_write(map, soc_data->sensor_ctrl + REG_CLR,
|
||||
soc_data->power_down_mask);
|
||||
regmap_write(map, soc_data->sensor_ctrl + REG_SET,
|
||||
soc_data->measure_temp_mask);
|
||||
pm_runtime_get(data->dev);
|
||||
|
||||
if (!data->irq_enabled) {
|
||||
data->irq_enabled = true;
|
||||
enable_irq(data->irq);
|
||||
}
|
||||
} else {
|
||||
regmap_write(map, soc_data->sensor_ctrl + REG_CLR,
|
||||
soc_data->measure_temp_mask);
|
||||
regmap_write(map, soc_data->sensor_ctrl + REG_SET,
|
||||
soc_data->power_down_mask);
|
||||
pm_runtime_put(data->dev);
|
||||
|
||||
if (data->irq_enabled) {
|
||||
disable_irq(data->irq);
|
||||
|
@ -393,6 +360,11 @@ static int imx_set_trip_temp(struct thermal_zone_device *tz, int trip,
|
|||
int temp)
|
||||
{
|
||||
struct imx_thermal_data *data = tz->devdata;
|
||||
int ret;
|
||||
|
||||
ret = pm_runtime_resume_and_get(data->dev);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
/* do not allow changing critical threshold */
|
||||
if (trip == IMX_TRIP_CRITICAL)
|
||||
|
@ -406,6 +378,8 @@ static int imx_set_trip_temp(struct thermal_zone_device *tz, int trip,
|
|||
|
||||
imx_set_alarm_temp(data, temp);
|
||||
|
||||
pm_runtime_put(data->dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
@ -681,6 +655,8 @@ static int imx_thermal_probe(struct platform_device *pdev)
|
|||
if (!data)
|
||||
return -ENOMEM;
|
||||
|
||||
data->dev = &pdev->dev;
|
||||
|
||||
map = syscon_regmap_lookup_by_phandle(pdev->dev.of_node, "fsl,tempmon");
|
||||
if (IS_ERR(map)) {
|
||||
ret = PTR_ERR(map);
|
||||
|
@ -800,6 +776,16 @@ static int imx_thermal_probe(struct platform_device *pdev)
|
|||
data->socdata->power_down_mask);
|
||||
regmap_write(map, data->socdata->sensor_ctrl + REG_SET,
|
||||
data->socdata->measure_temp_mask);
|
||||
/* After power up, we need a delay before first access can be done. */
|
||||
usleep_range(20, 50);
|
||||
|
||||
/* the core was configured and enabled just before */
|
||||
pm_runtime_set_active(&pdev->dev);
|
||||
pm_runtime_enable(data->dev);
|
||||
|
||||
ret = pm_runtime_resume_and_get(data->dev);
|
||||
if (ret < 0)
|
||||
goto disable_runtime_pm;
|
||||
|
||||
data->irq_enabled = true;
|
||||
ret = thermal_zone_device_enable(data->tz);
|
||||
|
@ -814,10 +800,15 @@ static int imx_thermal_probe(struct platform_device *pdev)
|
|||
goto thermal_zone_unregister;
|
||||
}
|
||||
|
||||
pm_runtime_put(data->dev);
|
||||
|
||||
return 0;
|
||||
|
||||
thermal_zone_unregister:
|
||||
thermal_zone_device_unregister(data->tz);
|
||||
disable_runtime_pm:
|
||||
pm_runtime_put_noidle(data->dev);
|
||||
pm_runtime_disable(data->dev);
|
||||
clk_disable:
|
||||
clk_disable_unprepare(data->thermal_clk);
|
||||
legacy_cleanup:
|
||||
|
@ -829,13 +820,9 @@ static int imx_thermal_probe(struct platform_device *pdev)
|
|||
static int imx_thermal_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct imx_thermal_data *data = platform_get_drvdata(pdev);
|
||||
struct regmap *map = data->tempmon;
|
||||
|
||||
/* Disable measurements */
|
||||
regmap_write(map, data->socdata->sensor_ctrl + REG_SET,
|
||||
data->socdata->power_down_mask);
|
||||
if (!IS_ERR(data->thermal_clk))
|
||||
clk_disable_unprepare(data->thermal_clk);
|
||||
pm_runtime_put_noidle(data->dev);
|
||||
pm_runtime_disable(data->dev);
|
||||
|
||||
thermal_zone_device_unregister(data->tz);
|
||||
imx_thermal_unregister_legacy_cooling(data);
|
||||
|
@ -858,9 +845,8 @@ static int __maybe_unused imx_thermal_suspend(struct device *dev)
|
|||
ret = thermal_zone_device_disable(data->tz);
|
||||
if (ret)
|
||||
return ret;
|
||||
clk_disable_unprepare(data->thermal_clk);
|
||||
|
||||
return 0;
|
||||
return pm_runtime_force_suspend(data->dev);
|
||||
}
|
||||
|
||||
static int __maybe_unused imx_thermal_resume(struct device *dev)
|
||||
|
@ -868,19 +854,70 @@ static int __maybe_unused imx_thermal_resume(struct device *dev)
|
|||
struct imx_thermal_data *data = dev_get_drvdata(dev);
|
||||
int ret;
|
||||
|
||||
ret = clk_prepare_enable(data->thermal_clk);
|
||||
ret = pm_runtime_force_resume(data->dev);
|
||||
if (ret)
|
||||
return ret;
|
||||
/* Enabled thermal sensor after resume */
|
||||
ret = thermal_zone_device_enable(data->tz);
|
||||
return thermal_zone_device_enable(data->tz);
|
||||
}
|
||||
|
||||
static int __maybe_unused imx_thermal_runtime_suspend(struct device *dev)
|
||||
{
|
||||
struct imx_thermal_data *data = dev_get_drvdata(dev);
|
||||
const struct thermal_soc_data *socdata = data->socdata;
|
||||
struct regmap *map = data->tempmon;
|
||||
int ret;
|
||||
|
||||
ret = regmap_write(map, socdata->sensor_ctrl + REG_CLR,
|
||||
socdata->measure_temp_mask);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = regmap_write(map, socdata->sensor_ctrl + REG_SET,
|
||||
socdata->power_down_mask);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
clk_disable_unprepare(data->thermal_clk);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static SIMPLE_DEV_PM_OPS(imx_thermal_pm_ops,
|
||||
imx_thermal_suspend, imx_thermal_resume);
|
||||
static int __maybe_unused imx_thermal_runtime_resume(struct device *dev)
|
||||
{
|
||||
struct imx_thermal_data *data = dev_get_drvdata(dev);
|
||||
const struct thermal_soc_data *socdata = data->socdata;
|
||||
struct regmap *map = data->tempmon;
|
||||
int ret;
|
||||
|
||||
ret = clk_prepare_enable(data->thermal_clk);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = regmap_write(map, socdata->sensor_ctrl + REG_CLR,
|
||||
socdata->power_down_mask);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = regmap_write(map, socdata->sensor_ctrl + REG_SET,
|
||||
socdata->measure_temp_mask);
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
/*
|
||||
* According to the temp sensor designers, it may require up to ~17us
|
||||
* to complete a measurement.
|
||||
*/
|
||||
usleep_range(20, 50);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct dev_pm_ops imx_thermal_pm_ops = {
|
||||
SET_SYSTEM_SLEEP_PM_OPS(imx_thermal_suspend, imx_thermal_resume)
|
||||
SET_RUNTIME_PM_OPS(imx_thermal_runtime_suspend,
|
||||
imx_thermal_runtime_resume, NULL)
|
||||
};
|
||||
|
||||
static struct platform_driver imx_thermal = {
|
||||
.driver = {
|
||||
|
|
|
@ -641,7 +641,7 @@ static int powerclamp_set_cur_state(struct thermal_cooling_device *cdev,
|
|||
}
|
||||
|
||||
/* bind to generic thermal layer as cooling device*/
|
||||
static struct thermal_cooling_device_ops powerclamp_cooling_ops = {
|
||||
static const struct thermal_cooling_device_ops powerclamp_cooling_ops = {
|
||||
.get_max_state = powerclamp_get_max_state,
|
||||
.get_cur_state = powerclamp_get_cur_state,
|
||||
.set_cur_state = powerclamp_set_cur_state,
|
||||
|
|
242
drivers/thermal/rzg2l_thermal.c
Normal file
242
drivers/thermal/rzg2l_thermal.c
Normal file
|
@ -0,0 +1,242 @@
|
|||
// SPDX-License-Identifier: GPL-2.0
|
||||
/*
|
||||
* Renesas RZ/G2L TSU Thermal Sensor Driver
|
||||
*
|
||||
* Copyright (C) 2021 Renesas Electronics Corporation
|
||||
*/
|
||||
#include <linux/delay.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/iopoll.h>
|
||||
#include <linux/math.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/of_device.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/pm_runtime.h>
|
||||
#include <linux/reset.h>
|
||||
#include <linux/thermal.h>
|
||||
#include <linux/units.h>
|
||||
|
||||
#include "thermal_hwmon.h"
|
||||
|
||||
#define CTEMP_MASK 0xFFF
|
||||
|
||||
/* default calibration values, if FUSE values are missing */
|
||||
#define SW_CALIB0_VAL 3148
|
||||
#define SW_CALIB1_VAL 503
|
||||
|
||||
/* Register offsets */
|
||||
#define TSU_SM 0x00
|
||||
#define TSU_ST 0x04
|
||||
#define TSU_SAD 0x0C
|
||||
#define TSU_SS 0x10
|
||||
|
||||
#define OTPTSUTRIM_REG(n) (0x18 + ((n) * 0x4))
|
||||
|
||||
/* Sensor Mode Register(TSU_SM) */
|
||||
#define TSU_SM_EN_TS BIT(0)
|
||||
#define TSU_SM_ADC_EN_TS BIT(1)
|
||||
#define TSU_SM_NORMAL_MODE (TSU_SM_EN_TS | TSU_SM_ADC_EN_TS)
|
||||
|
||||
/* TSU_ST bits */
|
||||
#define TSU_ST_START BIT(0)
|
||||
|
||||
#define TSU_SS_CONV_RUNNING BIT(0)
|
||||
|
||||
#define TS_CODE_AVE_SCALE(x) ((x) * 1000000)
|
||||
#define MCELSIUS(temp) ((temp) * MILLIDEGREE_PER_DEGREE)
|
||||
#define TS_CODE_CAP_TIMES 8 /* Capture times */
|
||||
|
||||
#define RZG2L_THERMAL_GRAN 500 /* milli Celsius */
|
||||
#define RZG2L_TSU_SS_TIMEOUT_US 1000
|
||||
|
||||
#define CURVATURE_CORRECTION_CONST 13
|
||||
|
||||
struct rzg2l_thermal_priv {
|
||||
struct device *dev;
|
||||
void __iomem *base;
|
||||
struct thermal_zone_device *zone;
|
||||
struct reset_control *rstc;
|
||||
u32 calib0, calib1;
|
||||
};
|
||||
|
||||
static inline u32 rzg2l_thermal_read(struct rzg2l_thermal_priv *priv, u32 reg)
|
||||
{
|
||||
return ioread32(priv->base + reg);
|
||||
}
|
||||
|
||||
static inline void rzg2l_thermal_write(struct rzg2l_thermal_priv *priv, u32 reg,
|
||||
u32 data)
|
||||
{
|
||||
iowrite32(data, priv->base + reg);
|
||||
}
|
||||
|
||||
static int rzg2l_thermal_get_temp(void *devdata, int *temp)
|
||||
{
|
||||
struct rzg2l_thermal_priv *priv = devdata;
|
||||
u32 result = 0, dsensor, ts_code_ave;
|
||||
int val, i;
|
||||
|
||||
for (i = 0; i < TS_CODE_CAP_TIMES ; i++) {
|
||||
/* TSU repeats measurement at 20 microseconds intervals and
|
||||
* automatically updates the results of measurement. As per
|
||||
* the HW manual for measuring temperature we need to read 8
|
||||
* values consecutively and then take the average.
|
||||
* ts_code_ave = (ts_code[0] + ⋯ + ts_code[7]) / 8
|
||||
*/
|
||||
result += rzg2l_thermal_read(priv, TSU_SAD) & CTEMP_MASK;
|
||||
usleep_range(20, 30);
|
||||
}
|
||||
|
||||
ts_code_ave = result / TS_CODE_CAP_TIMES;
|
||||
|
||||
/* Calculate actual sensor value by applying curvature correction formula
|
||||
* dsensor = ts_code_ave / (1 + ts_code_ave * 0.000013). Here we are doing
|
||||
* integer calculation by scaling all the values by 1000000.
|
||||
*/
|
||||
dsensor = TS_CODE_AVE_SCALE(ts_code_ave) /
|
||||
(TS_CODE_AVE_SCALE(1) + (ts_code_ave * CURVATURE_CORRECTION_CONST));
|
||||
|
||||
/* The temperature Tj is calculated by the formula
|
||||
* Tj = (dsensor − calib1) * 165/ (calib0 − calib1) − 40
|
||||
* where calib0 and calib1 are the caliberation values.
|
||||
*/
|
||||
val = ((dsensor - priv->calib1) * (MCELSIUS(165) /
|
||||
(priv->calib0 - priv->calib1))) - MCELSIUS(40);
|
||||
|
||||
*temp = roundup(val, RZG2L_THERMAL_GRAN);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct thermal_zone_of_device_ops rzg2l_tz_of_ops = {
|
||||
.get_temp = rzg2l_thermal_get_temp,
|
||||
};
|
||||
|
||||
static int rzg2l_thermal_init(struct rzg2l_thermal_priv *priv)
|
||||
{
|
||||
u32 reg_val;
|
||||
|
||||
rzg2l_thermal_write(priv, TSU_SM, TSU_SM_NORMAL_MODE);
|
||||
rzg2l_thermal_write(priv, TSU_ST, 0);
|
||||
|
||||
/* Before setting the START bit, TSU should be in normal operating
|
||||
* mode. As per the HW manual, it will take 60 µs to place the TSU
|
||||
* into normal operating mode.
|
||||
*/
|
||||
usleep_range(60, 80);
|
||||
|
||||
reg_val = rzg2l_thermal_read(priv, TSU_ST);
|
||||
reg_val |= TSU_ST_START;
|
||||
rzg2l_thermal_write(priv, TSU_ST, reg_val);
|
||||
|
||||
return readl_poll_timeout(priv->base + TSU_SS, reg_val,
|
||||
reg_val == TSU_SS_CONV_RUNNING, 50,
|
||||
RZG2L_TSU_SS_TIMEOUT_US);
|
||||
}
|
||||
|
||||
static void rzg2l_thermal_reset_assert_pm_disable_put(struct platform_device *pdev)
|
||||
{
|
||||
struct rzg2l_thermal_priv *priv = dev_get_drvdata(&pdev->dev);
|
||||
|
||||
pm_runtime_put(&pdev->dev);
|
||||
pm_runtime_disable(&pdev->dev);
|
||||
reset_control_assert(priv->rstc);
|
||||
}
|
||||
|
||||
static int rzg2l_thermal_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct rzg2l_thermal_priv *priv = dev_get_drvdata(&pdev->dev);
|
||||
|
||||
thermal_remove_hwmon_sysfs(priv->zone);
|
||||
rzg2l_thermal_reset_assert_pm_disable_put(pdev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int rzg2l_thermal_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct thermal_zone_device *zone;
|
||||
struct rzg2l_thermal_priv *priv;
|
||||
struct device *dev = &pdev->dev;
|
||||
int ret;
|
||||
|
||||
priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
|
||||
if (!priv)
|
||||
return -ENOMEM;
|
||||
|
||||
priv->base = devm_platform_ioremap_resource(pdev, 0);
|
||||
if (IS_ERR(priv->base))
|
||||
return PTR_ERR(priv->base);
|
||||
|
||||
priv->dev = dev;
|
||||
priv->rstc = devm_reset_control_get_exclusive(dev, NULL);
|
||||
if (IS_ERR(priv->rstc))
|
||||
return dev_err_probe(dev, PTR_ERR(priv->rstc),
|
||||
"failed to get cpg reset");
|
||||
|
||||
ret = reset_control_deassert(priv->rstc);
|
||||
if (ret)
|
||||
return dev_err_probe(dev, ret, "failed to deassert");
|
||||
|
||||
pm_runtime_enable(dev);
|
||||
pm_runtime_get_sync(dev);
|
||||
|
||||
priv->calib0 = rzg2l_thermal_read(priv, OTPTSUTRIM_REG(0));
|
||||
if (!priv->calib0)
|
||||
priv->calib0 = SW_CALIB0_VAL;
|
||||
|
||||
priv->calib1 = rzg2l_thermal_read(priv, OTPTSUTRIM_REG(1));
|
||||
if (!priv->calib1)
|
||||
priv->calib1 = SW_CALIB1_VAL;
|
||||
|
||||
platform_set_drvdata(pdev, priv);
|
||||
ret = rzg2l_thermal_init(priv);
|
||||
if (ret) {
|
||||
dev_err(dev, "Failed to start TSU");
|
||||
goto err;
|
||||
}
|
||||
|
||||
zone = devm_thermal_zone_of_sensor_register(dev, 0, priv,
|
||||
&rzg2l_tz_of_ops);
|
||||
if (IS_ERR(zone)) {
|
||||
dev_err(dev, "Can't register thermal zone");
|
||||
ret = PTR_ERR(zone);
|
||||
goto err;
|
||||
}
|
||||
|
||||
priv->zone = zone;
|
||||
priv->zone->tzp->no_hwmon = false;
|
||||
ret = thermal_add_hwmon_sysfs(priv->zone);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
dev_dbg(dev, "TSU probed with %s caliberation values",
|
||||
rzg2l_thermal_read(priv, OTPTSUTRIM_REG(0)) ? "hw" : "sw");
|
||||
|
||||
return 0;
|
||||
|
||||
err:
|
||||
rzg2l_thermal_reset_assert_pm_disable_put(pdev);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static const struct of_device_id rzg2l_thermal_dt_ids[] = {
|
||||
{ .compatible = "renesas,rzg2l-tsu", },
|
||||
{ /* sentinel */ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, rzg2l_thermal_dt_ids);
|
||||
|
||||
static struct platform_driver rzg2l_thermal_driver = {
|
||||
.driver = {
|
||||
.name = "rzg2l_thermal",
|
||||
.of_match_table = rzg2l_thermal_dt_ids,
|
||||
},
|
||||
.probe = rzg2l_thermal_probe,
|
||||
.remove = rzg2l_thermal_remove,
|
||||
};
|
||||
module_platform_driver(rzg2l_thermal_driver);
|
||||
|
||||
MODULE_DESCRIPTION("Renesas RZ/G2L TSU Thermal Sensor Driver");
|
||||
MODULE_AUTHOR("Biju Das <biju.das.jz@bp.renesas.com>");
|
||||
MODULE_LICENSE("GPL v2");
|
Loading…
Reference in a new issue