2023-01-18 03:14:29 +00:00
|
|
|
From 69c17529e8418da3eec703dde31e1b01e5b0f7e8 Mon Sep 17 00:00:00 2001
|
|
|
|
|
From: Daniel Golle <daniel@makrotopia.org>
|
|
|
|
|
Date: Wed, 18 Jan 2023 02:48:41 +0000
|
|
|
|
|
Subject: [PATCH 1/2] thermal/drivers/mtk: use function pointer for
|
|
|
|
|
raw_to_mcelsius
|
|
|
|
|
|
|
|
|
|
Instead of having if-else logic selecting either raw_to_mcelsius_v1 or
|
|
|
|
|
raw_to_mcelsius_v2 in mtk_thermal_bank_temperature introduce a function
|
|
|
|
|
pointer raw_to_mcelsius to struct mtk_thermal which is initialized in the
|
|
|
|
|
probe function.
|
|
|
|
|
|
|
|
|
|
Signed-off-by: Daniel Golle <daniel@makrotopia.org>
|
|
|
|
|
---
|
|
|
|
|
drivers/thermal/mtk_thermal.c | 17 ++++++++++-------
|
|
|
|
|
1 file changed, 10 insertions(+), 7 deletions(-)
|
|
|
|
|
|
|
|
|
|
--- a/drivers/thermal/mtk_thermal.c
|
|
|
|
|
+++ b/drivers/thermal/mtk_thermal.c
|
|
|
|
|
@@ -292,6 +292,8 @@ struct mtk_thermal {
|
|
|
|
|
|
|
|
|
|
const struct mtk_thermal_data *conf;
|
|
|
|
|
struct mtk_thermal_bank banks[MAX_NUM_ZONES];
|
|
|
|
|
+
|
|
|
|
|
+ int (*raw_to_mcelsius)(struct mtk_thermal *mt, int sensno, s32 raw);
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
/* MT8183 thermal sensor data */
|
|
|
|
|
@@ -656,13 +658,9 @@ static int mtk_thermal_bank_temperature(
|
|
|
|
|
for (i = 0; i < conf->bank_data[bank->id].num_sensors; i++) {
|
|
|
|
|
raw = readl(mt->thermal_base + conf->msr[i]);
|
|
|
|
|
|
|
|
|
|
- if (mt->conf->version == MTK_THERMAL_V1) {
|
|
|
|
|
- temp = raw_to_mcelsius_v1(
|
|
|
|
|
- mt, conf->bank_data[bank->id].sensors[i], raw);
|
|
|
|
|
- } else {
|
|
|
|
|
- temp = raw_to_mcelsius_v2(
|
|
|
|
|
- mt, conf->bank_data[bank->id].sensors[i], raw);
|
|
|
|
|
- }
|
|
|
|
|
+ temp = mt->raw_to_mcelsius(
|
|
|
|
|
+ mt, conf->bank_data[bank->id].sensors[i], raw);
|
|
|
|
|
+
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* The first read of a sensor often contains very high bogus
|
2023-05-12 16:33:18 +00:00
|
|
|
@@ -1085,6 +1083,11 @@ static int mtk_thermal_probe(struct plat
|
2023-01-18 03:14:29 +00:00
|
|
|
mtk_thermal_release_periodic_ts(mt, auxadc_base);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
+ if (mt->conf->version == MTK_THERMAL_V1)
|
|
|
|
|
+ mt->raw_to_mcelsius = raw_to_mcelsius_v1;
|
|
|
|
|
+ else
|
|
|
|
|
+ mt->raw_to_mcelsius = raw_to_mcelsius_v2;
|
|
|
|
|
+
|
|
|
|
|
for (ctrl_id = 0; ctrl_id < mt->conf->num_controller ; ctrl_id++)
|
|
|
|
|
for (i = 0; i < mt->conf->num_banks; i++)
|
|
|
|
|
mtk_thermal_init_bank(mt, i, apmixed_phys_base,
|
