1 // SPDX-License-Identifier: GPL-2.0
3 * R-Car Gen3 THS thermal sensor driver
4 * Based on rcar_thermal.c and work from Hien Dang and Khiem Nguyen.
6 * Copyright (C) 2016 Renesas Electronics Corporation.
7 * Copyright (C) 2016 Sang Engineering
9 #include <linux/delay.h>
10 #include <linux/err.h>
11 #include <linux/interrupt.h>
13 #include <linux/module.h>
14 #include <linux/of_device.h>
15 #include <linux/platform_device.h>
16 #include <linux/pm_runtime.h>
17 #include <linux/sys_soc.h>
18 #include <linux/thermal.h>
20 #include "thermal_core.h"
21 #include "thermal_hwmon.h"
23 /* Register offsets */
24 #define REG_GEN3_IRQSTR 0x04
25 #define REG_GEN3_IRQMSK 0x08
26 #define REG_GEN3_IRQCTL 0x0C
27 #define REG_GEN3_IRQEN 0x10
28 #define REG_GEN3_IRQTEMP1 0x14
29 #define REG_GEN3_IRQTEMP2 0x18
30 #define REG_GEN3_IRQTEMP3 0x1C
31 #define REG_GEN3_CTSR 0x20
32 #define REG_GEN3_THCTR 0x20
33 #define REG_GEN3_TEMP 0x28
34 #define REG_GEN3_THCODE1 0x50
35 #define REG_GEN3_THCODE2 0x54
36 #define REG_GEN3_THCODE3 0x58
38 /* IRQ{STR,MSK,EN} bits */
39 #define IRQ_TEMP1 BIT(0)
40 #define IRQ_TEMP2 BIT(1)
41 #define IRQ_TEMP3 BIT(2)
42 #define IRQ_TEMPD1 BIT(3)
43 #define IRQ_TEMPD2 BIT(4)
44 #define IRQ_TEMPD3 BIT(5)
47 #define CTSR_PONM BIT(8)
48 #define CTSR_AOUT BIT(7)
49 #define CTSR_THBGR BIT(5)
50 #define CTSR_VMEN BIT(4)
51 #define CTSR_VMST BIT(1)
52 #define CTSR_THSST BIT(0)
55 #define THCTR_PONM BIT(6)
56 #define THCTR_THSST BIT(0)
58 #define CTEMP_MASK 0xFFF
60 #define MCELSIUS(temp) ((temp) * 1000)
61 #define GEN3_FUSE_MASK 0xFFF
65 /* default THCODE values if FUSEs are missing */
66 static const int thcodes
[TSC_MAX_NUM
][3] = {
74 /* Structure for thermal temperature calculation */
75 struct equation_coefs
{
82 struct rcar_gen3_thermal_tsc
{
84 struct thermal_zone_device
*zone
;
85 struct equation_coefs coef
;
87 int id
; /* thermal channel id */
90 struct rcar_gen3_thermal_priv
{
91 struct rcar_gen3_thermal_tsc
*tscs
[TSC_MAX_NUM
];
92 unsigned int num_tscs
;
93 void (*thermal_init
)(struct rcar_gen3_thermal_tsc
*tsc
);
96 static inline u32
rcar_gen3_thermal_read(struct rcar_gen3_thermal_tsc
*tsc
,
99 return ioread32(tsc
->base
+ reg
);
102 static inline void rcar_gen3_thermal_write(struct rcar_gen3_thermal_tsc
*tsc
,
105 iowrite32(data
, tsc
->base
+ reg
);
109 * Linear approximation for temperature
111 * [reg] = [temp] * a + b => [temp] = ([reg] - b) / a
113 * The constants a and b are calculated using two triplets of int values PTAT
114 * and THCODE. PTAT and THCODE can either be read from hardware or use hard
115 * coded values from driver. The formula to calculate a and b are taken from
116 * BSP and sparsely documented and understood.
118 * Examining the linear formula and the formula used to calculate constants a
119 * and b while knowing that the span for PTAT and THCODE values are between
120 * 0x000 and 0xfff the largest integer possible is 0xfff * 0xfff == 0xffe001.
121 * Integer also needs to be signed so that leaves 7 bits for binary
122 * fixed point scaling.
125 #define FIXPT_SHIFT 7
126 #define FIXPT_INT(_x) ((_x) << FIXPT_SHIFT)
127 #define INT_FIXPT(_x) ((_x) >> FIXPT_SHIFT)
128 #define FIXPT_DIV(_a, _b) DIV_ROUND_CLOSEST(((_a) << FIXPT_SHIFT), (_b))
129 #define FIXPT_TO_MCELSIUS(_x) ((_x) * 1000 >> FIXPT_SHIFT)
131 #define RCAR3_THERMAL_GRAN 500 /* mili Celsius */
133 /* no idea where these constants come from */
136 static void rcar_gen3_thermal_calc_coefs(struct rcar_gen3_thermal_tsc
*tsc
,
137 int *ptat
, const int *thcode
,
140 /* TODO: Find documentation and document constant calculation formula */
143 * Division is not scaled in BSP and if scaled it might overflow
144 * the dividend (4095 * 4095 << 14 > INT_MAX) so keep it unscaled
146 tsc
->tj_t
= (FIXPT_INT((ptat
[1] - ptat
[2]) * 157)
147 / (ptat
[0] - ptat
[2])) + FIXPT_INT(TJ_3
);
149 tsc
->coef
.a1
= FIXPT_DIV(FIXPT_INT(thcode
[1] - thcode
[2]),
150 tsc
->tj_t
- FIXPT_INT(TJ_3
));
151 tsc
->coef
.b1
= FIXPT_INT(thcode
[2]) - tsc
->coef
.a1
* TJ_3
;
153 tsc
->coef
.a2
= FIXPT_DIV(FIXPT_INT(thcode
[1] - thcode
[0]),
154 tsc
->tj_t
- FIXPT_INT(ths_tj_1
));
155 tsc
->coef
.b2
= FIXPT_INT(thcode
[0]) - tsc
->coef
.a2
* ths_tj_1
;
158 static int rcar_gen3_thermal_round(int temp
)
160 int result
, round_offs
;
162 round_offs
= temp
>= 0 ? RCAR3_THERMAL_GRAN
/ 2 :
163 -RCAR3_THERMAL_GRAN
/ 2;
164 result
= (temp
+ round_offs
) / RCAR3_THERMAL_GRAN
;
165 return result
* RCAR3_THERMAL_GRAN
;
168 static int rcar_gen3_thermal_get_temp(void *devdata
, int *temp
)
170 struct rcar_gen3_thermal_tsc
*tsc
= devdata
;
174 /* Read register and convert to mili Celsius */
175 reg
= rcar_gen3_thermal_read(tsc
, REG_GEN3_TEMP
) & CTEMP_MASK
;
177 if (reg
<= thcodes
[tsc
->id
][1])
178 val
= FIXPT_DIV(FIXPT_INT(reg
) - tsc
->coef
.b1
,
181 val
= FIXPT_DIV(FIXPT_INT(reg
) - tsc
->coef
.b2
,
183 mcelsius
= FIXPT_TO_MCELSIUS(val
);
185 /* Guaranteed operating range is -40C to 125C. */
187 /* Round value to device granularity setting */
188 *temp
= rcar_gen3_thermal_round(mcelsius
);
193 static const struct thermal_zone_of_device_ops rcar_gen3_tz_of_ops
= {
194 .get_temp
= rcar_gen3_thermal_get_temp
,
197 static const struct soc_device_attribute r8a7795es1
[] = {
198 { .soc_id
= "r8a7795", .revision
= "ES1.*" },
202 static void rcar_gen3_thermal_init_r8a7795es1(struct rcar_gen3_thermal_tsc
*tsc
)
204 rcar_gen3_thermal_write(tsc
, REG_GEN3_CTSR
, CTSR_THBGR
);
205 rcar_gen3_thermal_write(tsc
, REG_GEN3_CTSR
, 0x0);
207 usleep_range(1000, 2000);
209 rcar_gen3_thermal_write(tsc
, REG_GEN3_CTSR
, CTSR_PONM
);
211 rcar_gen3_thermal_write(tsc
, REG_GEN3_IRQCTL
, 0x3F);
212 rcar_gen3_thermal_write(tsc
, REG_GEN3_IRQMSK
, 0);
214 rcar_gen3_thermal_write(tsc
, REG_GEN3_CTSR
,
215 CTSR_PONM
| CTSR_AOUT
| CTSR_THBGR
| CTSR_VMEN
);
217 usleep_range(100, 200);
219 rcar_gen3_thermal_write(tsc
, REG_GEN3_CTSR
,
220 CTSR_PONM
| CTSR_AOUT
| CTSR_THBGR
| CTSR_VMEN
|
221 CTSR_VMST
| CTSR_THSST
);
223 usleep_range(1000, 2000);
226 static void rcar_gen3_thermal_init(struct rcar_gen3_thermal_tsc
*tsc
)
230 reg_val
= rcar_gen3_thermal_read(tsc
, REG_GEN3_THCTR
);
231 reg_val
&= ~THCTR_PONM
;
232 rcar_gen3_thermal_write(tsc
, REG_GEN3_THCTR
, reg_val
);
234 usleep_range(1000, 2000);
236 rcar_gen3_thermal_write(tsc
, REG_GEN3_IRQCTL
, 0);
237 rcar_gen3_thermal_write(tsc
, REG_GEN3_IRQMSK
, 0);
239 reg_val
= rcar_gen3_thermal_read(tsc
, REG_GEN3_THCTR
);
240 reg_val
|= THCTR_THSST
;
241 rcar_gen3_thermal_write(tsc
, REG_GEN3_THCTR
, reg_val
);
243 usleep_range(1000, 2000);
246 static const int rcar_gen3_ths_tj_1
= 126;
247 static const int rcar_gen3_ths_tj_1_m3_w
= 116;
248 static const struct of_device_id rcar_gen3_thermal_dt_ids
[] = {
250 .compatible
= "renesas,r8a774a1-thermal",
251 .data
= &rcar_gen3_ths_tj_1_m3_w
,
254 .compatible
= "renesas,r8a774b1-thermal",
255 .data
= &rcar_gen3_ths_tj_1
,
258 .compatible
= "renesas,r8a774e1-thermal",
259 .data
= &rcar_gen3_ths_tj_1
,
262 .compatible
= "renesas,r8a7795-thermal",
263 .data
= &rcar_gen3_ths_tj_1
,
266 .compatible
= "renesas,r8a7796-thermal",
267 .data
= &rcar_gen3_ths_tj_1_m3_w
,
270 .compatible
= "renesas,r8a77961-thermal",
271 .data
= &rcar_gen3_ths_tj_1_m3_w
,
274 .compatible
= "renesas,r8a77965-thermal",
275 .data
= &rcar_gen3_ths_tj_1
,
278 .compatible
= "renesas,r8a77980-thermal",
279 .data
= &rcar_gen3_ths_tj_1
,
282 .compatible
= "renesas,r8a779a0-thermal",
283 .data
= &rcar_gen3_ths_tj_1
,
287 MODULE_DEVICE_TABLE(of
, rcar_gen3_thermal_dt_ids
);
289 static int rcar_gen3_thermal_remove(struct platform_device
*pdev
)
291 struct device
*dev
= &pdev
->dev
;
294 pm_runtime_disable(dev
);
299 static void rcar_gen3_hwmon_action(void *data
)
301 struct thermal_zone_device
*zone
= data
;
303 thermal_remove_hwmon_sysfs(zone
);
306 static int rcar_gen3_thermal_probe(struct platform_device
*pdev
)
308 struct rcar_gen3_thermal_priv
*priv
;
309 struct device
*dev
= &pdev
->dev
;
310 const int *rcar_gen3_ths_tj_1
= of_device_get_match_data(dev
);
311 struct resource
*res
;
312 struct thermal_zone_device
*zone
;
315 /* default values if FUSEs are missing */
316 /* TODO: Read values from hardware on supported platforms */
317 int ptat
[3] = { 2631, 1509, 435 };
319 priv
= devm_kzalloc(dev
, sizeof(*priv
), GFP_KERNEL
);
323 priv
->thermal_init
= rcar_gen3_thermal_init
;
324 if (soc_device_match(r8a7795es1
))
325 priv
->thermal_init
= rcar_gen3_thermal_init_r8a7795es1
;
327 platform_set_drvdata(pdev
, priv
);
329 pm_runtime_enable(dev
);
330 pm_runtime_get_sync(dev
);
332 for (i
= 0; i
< TSC_MAX_NUM
; i
++) {
333 struct rcar_gen3_thermal_tsc
*tsc
;
335 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, i
);
339 tsc
= devm_kzalloc(dev
, sizeof(*tsc
), GFP_KERNEL
);
342 goto error_unregister
;
345 tsc
->base
= devm_ioremap_resource(dev
, res
);
346 if (IS_ERR(tsc
->base
)) {
347 ret
= PTR_ERR(tsc
->base
);
348 goto error_unregister
;
354 priv
->thermal_init(tsc
);
355 rcar_gen3_thermal_calc_coefs(tsc
, ptat
, thcodes
[i
],
356 *rcar_gen3_ths_tj_1
);
358 zone
= devm_thermal_zone_of_sensor_register(dev
, i
, tsc
,
359 &rcar_gen3_tz_of_ops
);
361 dev_err(dev
, "Can't register thermal zone\n");
363 goto error_unregister
;
367 tsc
->zone
->tzp
->no_hwmon
= false;
368 ret
= thermal_add_hwmon_sysfs(tsc
->zone
);
370 goto error_unregister
;
372 ret
= devm_add_action_or_reset(dev
, rcar_gen3_hwmon_action
, zone
);
374 goto error_unregister
;
376 ret
= of_thermal_get_ntrips(tsc
->zone
);
378 goto error_unregister
;
380 dev_info(dev
, "TSC%d: Loaded %d trip points\n", i
, ret
);
385 if (!priv
->num_tscs
) {
387 goto error_unregister
;
393 rcar_gen3_thermal_remove(pdev
);
398 static int __maybe_unused
rcar_gen3_thermal_resume(struct device
*dev
)
400 struct rcar_gen3_thermal_priv
*priv
= dev_get_drvdata(dev
);
403 for (i
= 0; i
< priv
->num_tscs
; i
++) {
404 struct rcar_gen3_thermal_tsc
*tsc
= priv
->tscs
[i
];
406 priv
->thermal_init(tsc
);
412 static SIMPLE_DEV_PM_OPS(rcar_gen3_thermal_pm_ops
, NULL
,
413 rcar_gen3_thermal_resume
);
415 static struct platform_driver rcar_gen3_thermal_driver
= {
417 .name
= "rcar_gen3_thermal",
418 .pm
= &rcar_gen3_thermal_pm_ops
,
419 .of_match_table
= rcar_gen3_thermal_dt_ids
,
421 .probe
= rcar_gen3_thermal_probe
,
422 .remove
= rcar_gen3_thermal_remove
,
424 module_platform_driver(rcar_gen3_thermal_driver
);
426 MODULE_LICENSE("GPL v2");
427 MODULE_DESCRIPTION("R-Car Gen3 THS thermal sensor driver");
428 MODULE_AUTHOR("Wolfram Sang <wsa+renesas@sang-engineering.com>");