OSDN Git Service

thermal/drivers/imx: Use generic thermal_zone_get_trip() function
authorDaniel Lezcano <daniel.lezcano@linaro.org>
Mon, 3 Oct 2022 09:25:54 +0000 (11:25 +0200)
committerDaniel Lezcano <daniel.lezcano@kernel.org>
Fri, 6 Jan 2023 13:14:48 +0000 (14:14 +0100)
The thermal framework gives the possibility to register the trip
points with the thermal zone. When that is done, no get_trip_* ops are
needed and they can be removed.

Convert ops content logic into generic trip points and register them with the
thermal zone.

Signed-off-by: Daniel Lezcano <daniel.lezcano@linaro.org>
Link: https://lore.kernel.org/r/20221003092602.1323944-22-daniel.lezcano@linaro.org
drivers/thermal/imx_thermal.c

index 1666337..fb0d5ca 100644 (file)
@@ -76,7 +76,6 @@
 enum imx_thermal_trip {
        IMX_TRIP_PASSIVE,
        IMX_TRIP_CRITICAL,
-       IMX_TRIP_NUM,
 };
 
 #define IMX_POLLING_DELAY              2000 /* millisecond */
@@ -115,6 +114,11 @@ struct thermal_soc_data {
        u32 low_alarm_shift;
 };
 
+static struct thermal_trip trips[] = {
+       [IMX_TRIP_PASSIVE]  = { .type = THERMAL_TRIP_PASSIVE  },
+       [IMX_TRIP_CRITICAL] = { .type = THERMAL_TRIP_CRITICAL },
+};
+
 static struct thermal_soc_data thermal_imx6q_data = {
        .version = TEMPMON_IMX6Q,
 
@@ -201,8 +205,6 @@ struct imx_thermal_data {
        struct thermal_cooling_device *cdev;
        struct regmap *tempmon;
        u32 c1, c2; /* See formula in imx_init_calib() */
-       int temp_passive;
-       int temp_critical;
        int temp_max;
        int alarm_temp;
        int last_temp;
@@ -279,12 +281,12 @@ static int imx_get_temp(struct thermal_zone_device *tz, int *temp)
 
        /* Update alarm value to next higher trip point for TEMPMON_IMX6Q */
        if (data->socdata->version == TEMPMON_IMX6Q) {
-               if (data->alarm_temp == data->temp_passive &&
-                       *temp >= data->temp_passive)
-                       imx_set_alarm_temp(data, data->temp_critical);
-               if (data->alarm_temp == data->temp_critical &&
-                       *temp < data->temp_passive) {
-                       imx_set_alarm_temp(data, data->temp_passive);
+               if (data->alarm_temp == trips[IMX_TRIP_PASSIVE].temperature &&
+                       *temp >= trips[IMX_TRIP_PASSIVE].temperature)
+                       imx_set_alarm_temp(data, trips[IMX_TRIP_CRITICAL].temperature);
+               if (data->alarm_temp == trips[IMX_TRIP_CRITICAL].temperature &&
+                       *temp < trips[IMX_TRIP_PASSIVE].temperature) {
+                       imx_set_alarm_temp(data, trips[IMX_TRIP_PASSIVE].temperature);
                        dev_dbg(&tz->device, "thermal alarm off: T < %d\n",
                                data->alarm_temp / 1000);
                }
@@ -330,29 +332,10 @@ static int imx_change_mode(struct thermal_zone_device *tz,
        return 0;
 }
 
-static int imx_get_trip_type(struct thermal_zone_device *tz, int trip,
-                            enum thermal_trip_type *type)
-{
-       *type = (trip == IMX_TRIP_PASSIVE) ? THERMAL_TRIP_PASSIVE :
-                                            THERMAL_TRIP_CRITICAL;
-       return 0;
-}
-
 static int imx_get_crit_temp(struct thermal_zone_device *tz, int *temp)
 {
-       struct imx_thermal_data *data = tz->devdata;
-
-       *temp = data->temp_critical;
-       return 0;
-}
-
-static int imx_get_trip_temp(struct thermal_zone_device *tz, int trip,
-                            int *temp)
-{
-       struct imx_thermal_data *data = tz->devdata;
+       *temp = trips[IMX_TRIP_CRITICAL].temperature;
 
-       *temp = (trip == IMX_TRIP_PASSIVE) ? data->temp_passive :
-                                            data->temp_critical;
        return 0;
 }
 
@@ -371,10 +354,10 @@ static int imx_set_trip_temp(struct thermal_zone_device *tz, int trip,
                return -EPERM;
 
        /* do not allow passive to be set higher than critical */
-       if (temp < 0 || temp > data->temp_critical)
+       if (temp < 0 || temp > trips[IMX_TRIP_CRITICAL].temperature)
                return -EINVAL;
 
-       data->temp_passive = temp;
+       trips[IMX_TRIP_PASSIVE].temperature = temp;
 
        imx_set_alarm_temp(data, temp);
 
@@ -423,8 +406,6 @@ static struct thermal_zone_device_ops imx_tz_ops = {
        .unbind = imx_unbind,
        .get_temp = imx_get_temp,
        .change_mode = imx_change_mode,
-       .get_trip_type = imx_get_trip_type,
-       .get_trip_temp = imx_get_trip_temp,
        .get_crit_temp = imx_get_crit_temp,
        .set_trip_temp = imx_set_trip_temp,
 };
@@ -507,8 +488,8 @@ static void imx_init_temp_grade(struct platform_device *pdev, u32 ocotp_mem0)
         * Set the critical trip point at 5 °C under max
         * Set the passive trip point at 10 °C under max (changeable via sysfs)
         */
-       data->temp_critical = data->temp_max - (1000 * 5);
-       data->temp_passive = data->temp_max - (1000 * 10);
+       trips[IMX_TRIP_PASSIVE].temperature = data->temp_max - (1000 * 10);
+       trips[IMX_TRIP_CRITICAL].temperature = data->temp_max - (1000 * 5);
 }
 
 static int imx_init_from_tempmon_data(struct platform_device *pdev)
@@ -743,12 +724,13 @@ static int imx_thermal_probe(struct platform_device *pdev)
                goto legacy_cleanup;
        }
 
-       data->tz = thermal_zone_device_register("imx_thermal_zone",
-                                               IMX_TRIP_NUM,
-                                               BIT(IMX_TRIP_PASSIVE), data,
-                                               &imx_tz_ops, NULL,
-                                               IMX_PASSIVE_DELAY,
-                                               IMX_POLLING_DELAY);
+       data->tz = thermal_zone_device_register_with_trips("imx_thermal_zone",
+                                                          trips,
+                                                          ARRAY_SIZE(trips),
+                                                          BIT(IMX_TRIP_PASSIVE), data,
+                                                          &imx_tz_ops, NULL,
+                                                          IMX_PASSIVE_DELAY,
+                                                          IMX_POLLING_DELAY);
        if (IS_ERR(data->tz)) {
                ret = PTR_ERR(data->tz);
                dev_err(&pdev->dev,
@@ -758,8 +740,8 @@ static int imx_thermal_probe(struct platform_device *pdev)
 
        dev_info(&pdev->dev, "%s CPU temperature grade - max:%dC"
                 " critical:%dC passive:%dC\n", data->temp_grade,
-                data->temp_max / 1000, data->temp_critical / 1000,
-                data->temp_passive / 1000);
+                data->temp_max / 1000, trips[IMX_TRIP_CRITICAL].temperature / 1000,
+                trips[IMX_TRIP_PASSIVE].temperature / 1000);
 
        /* Enable measurements at ~ 10 Hz */
        regmap_write(map, data->socdata->measure_freq_ctrl + REG_CLR,
@@ -767,10 +749,10 @@ static int imx_thermal_probe(struct platform_device *pdev)
        measure_freq = DIV_ROUND_UP(32768, 10); /* 10 Hz */
        regmap_write(map, data->socdata->measure_freq_ctrl + REG_SET,
                     measure_freq << data->socdata->measure_freq_shift);
-       imx_set_alarm_temp(data, data->temp_passive);
+       imx_set_alarm_temp(data, trips[IMX_TRIP_PASSIVE].temperature);
 
        if (data->socdata->version == TEMPMON_IMX6SX)
-               imx_set_panic_temp(data, data->temp_critical);
+               imx_set_panic_temp(data, trips[IMX_TRIP_CRITICAL].temperature);
 
        regmap_write(map, data->socdata->sensor_ctrl + REG_CLR,
                     data->socdata->power_down_mask);