@@ -67,9 +67,8 @@ static int tegra_bpmp_thermal_get_temp(struct thermal_zone_device *tz, int *out_
return __tegra_bpmp_thermal_get_temp(tz->devdata, out_temp);
}
-static int tegra_bpmp_thermal_set_trips(struct thermal_zone_device *tz, int low, int high)
+static int tegra_bpmp_thermal_program_trips(struct tegra_bpmp_thermal_zone *zone)
{
- struct tegra_bpmp_thermal_zone *zone = tz->devdata;
struct mrq_thermal_host_to_bpmp_request req;
struct tegra_bpmp_message msg;
int err;
@@ -78,8 +77,10 @@ static int tegra_bpmp_thermal_set_trips(struct thermal_zone_device *tz, int low,
req.type = CMD_THERMAL_SET_TRIP;
req.set_trip.zone = zone->idx;
req.set_trip.enabled = true;
- req.set_trip.low = low;
- req.set_trip.high = high;
+ mutex_lock(&zone->tzd->lock);
+ req.set_trip.low = zone->tzd->prev_low_trip;
+ req.set_trip.high = zone->tzd->prev_high_trip;
+ mutex_unlock(&zone->tzd->lock);
memset(&msg, 0, sizeof(msg));
msg.mrq = MRQ_THERMAL;
@@ -95,14 +96,31 @@ static int tegra_bpmp_thermal_set_trips(struct thermal_zone_device *tz, int low,
return 0;
}
+static int tegra_bpmp_thermal_set_trips(struct thermal_zone_device *tz, int low, int high)
+{
+ return 0;
+}
+
static void tz_device_update_work_fn(struct work_struct *work)
{
struct tegra_bpmp_thermal_zone *zone;
+ int err;
zone = container_of(work, struct tegra_bpmp_thermal_zone,
tz_device_update_work);
+ /* Recalculates trip temperatures. */
thermal_zone_device_update(zone->tzd, THERMAL_TRIP_VIOLATED);
+
+ /*
+ * Program trip temperatures. We must do this outside `set_trips`
+ * since thermal core may skip calling it if the trip temperatures
+ * are unchanged.
+ */
+ err = tegra_bpmp_thermal_program_trips(zone);
+ if (err)
+ dev_err(zone->tegra->dev, "failed to update trip temperatures for zone '%s': %d\n",
+ zone->tzd->type, err);
}
static void bpmp_mrq_thermal(unsigned int mrq, struct tegra_bpmp_channel *ch,
@@ -293,6 +311,13 @@ static int tegra_bpmp_thermal_probe(struct platform_device *pdev)
return err;
}
+ for (i = 0; i < tegra->num_zones; i++) {
+ err = tegra_bpmp_thermal_program_trips(tegra->zones[i]);
+ if (err)
+ dev_err(&pdev->dev, "failed to set trip temperatures for zone '%s': %d\n",
+ tzd->type, err);
+ }
+
platform_set_drvdata(pdev, tegra);
return 0;