thermal/drivers/mediatek: Control buffer enablement tweaks

Add logic in order to be able to turn on the control buffer on MT8365.
This change now allows to have control buffer support for MTK_THERMAL_V1,
and it allows to define the register offset, and mask used to enable it.

Signed-off-by: Markus Schneider-Pargmann <msp@baylibre.com>
Signed-off-by: Fabien Parent <fparent@baylibre.com>
Signed-off-by: Amjad Ouled-Ameur <aouledameur@baylibre.com>
Reviewed-by: AngeloGioacchino Del Regno <angelogioacchino.delregno@collabora.com>
Link: https://lore.kernel.org/r/20221018-up-i350-thermal-bringup-v9-2-55a1ae14af74@baylibre.com
Signed-off-by: Daniel Lezcano <daniel.lezcano@linaro.org>

diff --git a/drivers/thermal/mediatek/auxadc_thermal.c b/drivers/thermal/mediatek/auxadc_thermal.c
index 7b146350050d680d7b76f3e2c1b6b8647f40a1e6..2b6186c150be7c7726b15e3bc6fb23a69d0792d3 100644 (file)
--- a/drivers/thermal/mediatek/auxadc_thermal.c
+++ b/drivers/thermal/mediatek/auxadc_thermal.c
@@ -307,6 +307,9 @@ struct mtk_thermal_data {
        bool need_switch_bank;
        struct thermal_bank_cfg bank_data[MAX_NUM_ZONES];
        enum mtk_thermal_version version;
+       u32 apmixed_buffer_ctl_reg;
+       u32 apmixed_buffer_ctl_mask;
+       u32 apmixed_buffer_ctl_set;
 };
 
 struct mtk_thermal {
@@ -560,6 +563,9 @@ static const struct mtk_thermal_data mt7622_thermal_data = {
        .adcpnp = mt7622_adcpnp,
        .sensor_mux_values = mt7622_mux_values,
        .version = MTK_THERMAL_V2,
+       .apmixed_buffer_ctl_reg = APMIXED_SYS_TS_CON1,
+       .apmixed_buffer_ctl_mask = GENMASK(31, 6) | BIT(3),
+       .apmixed_buffer_ctl_set = BIT(0),
 };
 
 /*
@@ -1079,14 +1085,18 @@ static const struct of_device_id mtk_thermal_of_match[] = {
 };
 MODULE_DEVICE_TABLE(of, mtk_thermal_of_match);
 
-static void mtk_thermal_turn_on_buffer(void __iomem *apmixed_base)
+static void mtk_thermal_turn_on_buffer(struct mtk_thermal *mt,
+                                      void __iomem *apmixed_base)
 {
-       int tmp;
+       u32 tmp;
+
+       if (!mt->conf->apmixed_buffer_ctl_reg)
+               return;
 
-       tmp = readl(apmixed_base + APMIXED_SYS_TS_CON1);
-       tmp &= ~(0x37);
-       tmp |= 0x1;
-       writel(tmp, apmixed_base + APMIXED_SYS_TS_CON1);
+       tmp = readl(apmixed_base + mt->conf->apmixed_buffer_ctl_reg);
+       tmp &= mt->conf->apmixed_buffer_ctl_mask;
+       tmp |= mt->conf->apmixed_buffer_ctl_set;
+       writel(tmp, apmixed_base + mt->conf->apmixed_buffer_ctl_reg);
        udelay(200);
 }
 
@@ -1184,10 +1194,10 @@ static int mtk_thermal_probe(struct platform_device *pdev)
                goto err_disable_clk_auxadc;
        }
 
-       if (mt->conf->version != MTK_THERMAL_V1) {
-               mtk_thermal_turn_on_buffer(apmixed_base);
+       mtk_thermal_turn_on_buffer(mt, apmixed_base);
+
+       if (mt->conf->version != MTK_THERMAL_V2)
                mtk_thermal_release_periodic_ts(mt, auxadc_base);
-       }
 
        if (mt->conf->version == MTK_THERMAL_V1)
                mt->raw_to_mcelsius = raw_to_mcelsius_v1;