thermal/drivers/mediatek/lvts: Add support for ATP mode

MT8196/MT6991 uses ATP (Abnormal Temperature Prevention) mode to detect
abnormal temperature conditions, which involves reading temperature data
from a dedicated set of registers separate from the ones used for
immediate and filtered modes.

Add support for ATP mode and its relative registers to ensure accurate
temperature readings and proper thermal management on MT8196/MT6991
devices.

While at it, convert mode defines to enum.

Reviewed-by: Chen-Yu Tsai <wenst@chromium.org>
Reviewed-by: AngeloGioacchino Del Regno <angelogioacchino.delregno@collabora.com>
Reviewed-by: Fei Shao <fshao@chromium.org>
Tested-by: AngeloGioacchino Del Regno <angelogioacchino.delregno@collabora.com>
Tested-by: Frank Wunderlich <frank-w@public-files.de>
Signed-off-by: Laura Nao <laura.nao@collabora.com>
Link: https://patch.msgid.link/20251125-mt8196-lvts-v4-v5-5-6db7eb903fb7@collabora.com
Signed-off-by: Daniel Lezcano <daniel.lezcano@linaro.org>

diff --git a/drivers/thermal/mediatek/lvts_thermal.c b/drivers/thermal/mediatek/lvts_thermal.c
index e9b9c1c35020498c7741dcdbb12d176d5105bf79..b53d6a4a7474ae42ea692d2cce5664ccfeae31bf 100644 (file)
--- a/drivers/thermal/mediatek/lvts_thermal.c
+++ b/drivers/thermal/mediatek/lvts_thermal.c
@@ -44,6 +44,10 @@
 #define LVTS_EDATA01(__base)   (__base + 0x0058)
 #define LVTS_EDATA02(__base)   (__base + 0x005C)
 #define LVTS_EDATA03(__base)   (__base + 0x0060)
+#define LVTS_ATP0(__base)              (__base + 0x0070)
+#define LVTS_ATP1(__base)              (__base + 0x0074)
+#define LVTS_ATP2(__base)              (__base + 0x0078)
+#define LVTS_ATP3(__base)              (__base + 0x007C)
 #define LVTS_MSR0(__base)              (__base + 0x0090)
 #define LVTS_MSR1(__base)              (__base + 0x0094)
 #define LVTS_MSR2(__base)              (__base + 0x0098)
@@ -88,9 +92,6 @@
 #define LVTS_COEFF_A_MT7988                    -204650
 #define LVTS_COEFF_B_MT7988                    204650
 
-#define LVTS_MSR_IMMEDIATE_MODE                0
-#define LVTS_MSR_FILTERED_MODE         1
-
 #define LVTS_MSR_READ_TIMEOUT_US       400
 #define LVTS_MSR_READ_WAIT_US          (LVTS_MSR_READ_TIMEOUT_US / 2)
 
@@ -102,6 +103,12 @@
 static int golden_temp = LVTS_GOLDEN_TEMP_DEFAULT;
 static int golden_temp_offset;
 
+enum lvts_msr_mode {
+       LVTS_MSR_IMMEDIATE_MODE,
+       LVTS_MSR_FILTERED_MODE,
+       LVTS_MSR_ATP_MODE,
+};
+
 struct lvts_sensor_data {
        int dt_id;
        u8 cal_offsets[LVTS_MAX_CAL_OFFSETS];
@@ -111,7 +118,7 @@ struct lvts_ctrl_data {
        struct lvts_sensor_data lvts_sensor[LVTS_SENSOR_MAX];
        u8 valid_sensor_mask;
        int offset;
-       int mode;
+       enum lvts_msr_mode mode;
 };
 
 #define VALID_SENSOR_MAP(s0, s1, s2, s3) \
@@ -212,6 +219,10 @@ static const struct debugfs_reg32 lvts_regs[] = {
        LVTS_DEBUG_FS_REGS(LVTS_EDATA01),
        LVTS_DEBUG_FS_REGS(LVTS_EDATA02),
        LVTS_DEBUG_FS_REGS(LVTS_EDATA03),
+       LVTS_DEBUG_FS_REGS(LVTS_ATP0),
+       LVTS_DEBUG_FS_REGS(LVTS_ATP1),
+       LVTS_DEBUG_FS_REGS(LVTS_ATP2),
+       LVTS_DEBUG_FS_REGS(LVTS_ATP3),
        LVTS_DEBUG_FS_REGS(LVTS_MSR0),
        LVTS_DEBUG_FS_REGS(LVTS_MSR1),
        LVTS_DEBUG_FS_REGS(LVTS_MSR2),
@@ -628,6 +639,13 @@ static int lvts_sensor_init(struct device *dev, struct lvts_ctrl *lvts_ctrl,
                LVTS_IMMD3(lvts_ctrl->base)
        };
 
+       void __iomem *atp_regs[] = {
+               LVTS_ATP0(lvts_ctrl->base),
+               LVTS_ATP1(lvts_ctrl->base),
+               LVTS_ATP2(lvts_ctrl->base),
+               LVTS_ATP3(lvts_ctrl->base)
+       };
+
        int i;
 
        lvts_for_each_valid_sensor(i, lvts_ctrl_data) {
@@ -663,8 +681,20 @@ static int lvts_sensor_init(struct device *dev, struct lvts_ctrl *lvts_ctrl,
                /*
                 * Each sensor has its own register address to read from.
                 */
-               lvts_sensor[i].msr = lvts_ctrl_data->mode == LVTS_MSR_IMMEDIATE_MODE ?
-                       imm_regs[i] : msr_regs[i];
+               switch (lvts_ctrl_data->mode) {
+               case LVTS_MSR_IMMEDIATE_MODE:
+                       lvts_sensor[i].msr = imm_regs[i];
+                       break;
+               case LVTS_MSR_FILTERED_MODE:
+                       lvts_sensor[i].msr = msr_regs[i];
+                       break;
+               case LVTS_MSR_ATP_MODE:
+                       lvts_sensor[i].msr = atp_regs[i];
+                       break;
+               default:
+                       lvts_sensor[i].msr = imm_regs[i];
+                       break;
+               }
 
                lvts_sensor[i].low_thresh = INT_MIN;
                lvts_sensor[i].high_thresh = INT_MIN;
@@ -934,7 +964,7 @@ static void lvts_ctrl_monitor_enable(struct device *dev, struct lvts_ctrl *lvts_
        u32 sensor_map = 0;
        int i;
 
-       if (lvts_ctrl->mode != LVTS_MSR_FILTERED_MODE)
+       if (lvts_ctrl->mode == LVTS_MSR_IMMEDIATE_MODE)
                return;
 
        if (enable) {