1 // SPDX-License-Identifier: GPL-2.0
5 * Author: Anson Huang <Anson.Huang@nxp.com>
8 #include <linux/bitfield.h>
10 #include <linux/err.h>
12 #include <linux/module.h>
14 #include <linux/of_device.h>
15 #include <linux/platform_device.h>
16 #include <linux/thermal.h>
18 #include "thermal_core.h"
20 #define TER 0x0 /* TMU enable */
22 #define TRITSR 0x20 /* TMU immediate temp */
24 #define TER_ADC_PD BIT(30)
25 #define TER_EN BIT(31)
26 #define TRITSR_TEMP0_VAL_MASK 0xff
27 #define TRITSR_TEMP1_VAL_MASK 0xff0000
29 #define PROBE_SEL_ALL GENMASK(31, 30)
31 #define probe_status_offset(x) (30 + x)
32 #define SIGN_BIT BIT(7)
33 #define TEMP_VAL_MASK GENMASK(6, 0)
35 #define VER1_TEMP_LOW_LIMIT 10000
36 #define VER2_TEMP_LOW_LIMIT -40000
37 #define VER2_TEMP_HIGH_LIMIT 125000
42 struct thermal_soc_data
{
45 int (*get_temp
)(void *, int *);
49 struct imx8mm_tmu
*priv
;
51 struct thermal_zone_device
*tzd
;
57 const struct thermal_soc_data
*socdata
;
58 struct tmu_sensor sensors
[];
61 static int imx8mm_tmu_get_temp(void *data
, int *temp
)
63 struct tmu_sensor
*sensor
= data
;
64 struct imx8mm_tmu
*tmu
= sensor
->priv
;
67 val
= readl_relaxed(tmu
->base
+ TRITSR
) & TRITSR_TEMP0_VAL_MASK
;
69 if (*temp
< VER1_TEMP_LOW_LIMIT
)
75 static int imx8mp_tmu_get_temp(void *data
, int *temp
)
77 struct tmu_sensor
*sensor
= data
;
78 struct imx8mm_tmu
*tmu
= sensor
->priv
;
82 val
= readl_relaxed(tmu
->base
+ TRITSR
);
83 ready
= test_bit(probe_status_offset(sensor
->hw_id
), &val
);
87 val
= sensor
->hw_id
? FIELD_GET(TRITSR_TEMP1_VAL_MASK
, val
) :
88 FIELD_GET(TRITSR_TEMP0_VAL_MASK
, val
);
89 if (val
& SIGN_BIT
) /* negative */
90 val
= (~(val
& TEMP_VAL_MASK
) + 1);
93 if (*temp
< VER2_TEMP_LOW_LIMIT
|| *temp
> VER2_TEMP_HIGH_LIMIT
)
99 static int tmu_get_temp(void *data
, int *temp
)
101 struct tmu_sensor
*sensor
= data
;
102 struct imx8mm_tmu
*tmu
= sensor
->priv
;
104 return tmu
->socdata
->get_temp(data
, temp
);
107 static struct thermal_zone_of_device_ops tmu_tz_ops
= {
108 .get_temp
= tmu_get_temp
,
111 static void imx8mm_tmu_enable(struct imx8mm_tmu
*tmu
, bool enable
)
115 val
= readl_relaxed(tmu
->base
+ TER
);
116 val
= enable
? (val
| TER_EN
) : (val
& ~TER_EN
);
117 if (tmu
->socdata
->version
== TMU_VER2
)
118 val
= enable
? (val
& ~TER_ADC_PD
) : (val
| TER_ADC_PD
);
119 writel_relaxed(val
, tmu
->base
+ TER
);
122 static void imx8mm_tmu_probe_sel_all(struct imx8mm_tmu
*tmu
)
126 val
= readl_relaxed(tmu
->base
+ TPS
);
127 val
|= PROBE_SEL_ALL
;
128 writel_relaxed(val
, tmu
->base
+ TPS
);
131 static int imx8mm_tmu_probe(struct platform_device
*pdev
)
133 const struct thermal_soc_data
*data
;
134 struct imx8mm_tmu
*tmu
;
138 data
= of_device_get_match_data(&pdev
->dev
);
140 tmu
= devm_kzalloc(&pdev
->dev
, struct_size(tmu
, sensors
,
141 data
->num_sensors
), GFP_KERNEL
);
147 tmu
->base
= devm_platform_ioremap_resource(pdev
, 0);
148 if (IS_ERR(tmu
->base
))
149 return PTR_ERR(tmu
->base
);
151 tmu
->clk
= devm_clk_get(&pdev
->dev
, NULL
);
152 if (IS_ERR(tmu
->clk
))
153 return dev_err_probe(&pdev
->dev
, PTR_ERR(tmu
->clk
),
154 "failed to get tmu clock\n");
156 ret
= clk_prepare_enable(tmu
->clk
);
158 dev_err(&pdev
->dev
, "failed to enable tmu clock: %d\n", ret
);
162 /* disable the monitor during initialization */
163 imx8mm_tmu_enable(tmu
, false);
165 for (i
= 0; i
< data
->num_sensors
; i
++) {
166 tmu
->sensors
[i
].priv
= tmu
;
167 tmu
->sensors
[i
].tzd
=
168 devm_thermal_zone_of_sensor_register(&pdev
->dev
, i
,
171 if (IS_ERR(tmu
->sensors
[i
].tzd
)) {
172 ret
= PTR_ERR(tmu
->sensors
[i
].tzd
);
174 "failed to register thermal zone sensor[%d]: %d\n",
178 tmu
->sensors
[i
].hw_id
= i
;
181 platform_set_drvdata(pdev
, tmu
);
183 /* enable all the probes for V2 TMU */
184 if (tmu
->socdata
->version
== TMU_VER2
)
185 imx8mm_tmu_probe_sel_all(tmu
);
187 /* enable the monitor */
188 imx8mm_tmu_enable(tmu
, true);
193 clk_disable_unprepare(tmu
->clk
);
197 static int imx8mm_tmu_remove(struct platform_device
*pdev
)
199 struct imx8mm_tmu
*tmu
= platform_get_drvdata(pdev
);
202 imx8mm_tmu_enable(tmu
, false);
204 clk_disable_unprepare(tmu
->clk
);
205 platform_set_drvdata(pdev
, NULL
);
210 static struct thermal_soc_data imx8mm_tmu_data
= {
213 .get_temp
= imx8mm_tmu_get_temp
,
216 static struct thermal_soc_data imx8mp_tmu_data
= {
219 .get_temp
= imx8mp_tmu_get_temp
,
222 static const struct of_device_id imx8mm_tmu_table
[] = {
223 { .compatible
= "fsl,imx8mm-tmu", .data
= &imx8mm_tmu_data
, },
224 { .compatible
= "fsl,imx8mp-tmu", .data
= &imx8mp_tmu_data
, },
227 MODULE_DEVICE_TABLE(of
, imx8mm_tmu_table
);
229 static struct platform_driver imx8mm_tmu
= {
231 .name
= "i.mx8mm_thermal",
232 .of_match_table
= imx8mm_tmu_table
,
234 .probe
= imx8mm_tmu_probe
,
235 .remove
= imx8mm_tmu_remove
,
237 module_platform_driver(imx8mm_tmu
);
239 MODULE_AUTHOR("Anson Huang <Anson.Huang@nxp.com>");
240 MODULE_DESCRIPTION("i.MX8MM Thermal Monitor Unit driver");
241 MODULE_LICENSE("GPL v2");