1 files changed, 24 insertions, 0 deletions

diff --git a/drivers/thermal/of-thermal.c b/drivers/thermal/of-thermal.c
index e062bf59ab6c..e145b66df444 100644
--- a/drivers/thermal/of-thermal.c
+++ b/drivers/thermal/of-thermal.c
@@ -161,6 +161,28 @@ of_thermal_get_trip_points(struct thermal_zone_device *tz)
 }
 EXPORT_SYMBOL_GPL(of_thermal_get_trip_points);
 
+/**
+ * of_thermal_set_emul_temp - function to set emulated temperature
+ *
+ * @tz: pointer to a thermal zone
+ * @temp:       temperature to set
+ *
+ * This function gives the ability to set emulated value of temperature,
+ * which is handy for debugging
+ *
+ * Return: zero on success, error code otherwise
+ */
+static int of_thermal_set_emul_temp(struct thermal_zone_device *tz,
+                                    unsigned long temp)
+{
+        struct __thermal_zone *data = tz->devdata;
+
+        if (!data->ops || !data->ops->set_emul_temp)
+                return -EINVAL;
+
+        return data->ops->set_emul_temp(data->sensor_data, temp);
+}
+
 static int of_thermal_get_trend(struct thermal_zone_device *tz, int trip,
                                 enum thermal_trend *trend)
 {
@@ -392,6 +414,7 @@ thermal_zone_of_add_sensor(struct device_node *zone,
 
         tzd->ops->get_temp = of_thermal_get_temp;
         tzd->ops->get_trend = of_thermal_get_trend;
+        tzd->ops->set_emul_temp = of_thermal_set_emul_temp;
         mutex_unlock(&tzd->lock);
 
         return tzd;
@@ -520,6 +543,7 @@ void thermal_zone_of_sensor_unregister(struct device *dev,
         mutex_lock(&tzd->lock);
         tzd->ops->get_temp = NULL;
         tzd->ops->get_trend = NULL;
+        tzd->ops->set_emul_temp = NULL;
 
         tz->ops = NULL;
         tz->sensor_data = NULL;