1
2
3
4
5
6
7
8
9
10
11
12#include <linux/thermal.h>
13
14#include "thermal_core.h"
15
16static void thermal_zone_trip_update(struct thermal_zone_device *tz, int trip)
17{
18 int trip_temp, trip_hyst;
19 struct thermal_instance *instance;
20
21 tz->ops->get_trip_temp(tz, trip, &trip_temp);
22
23 if (!tz->ops->get_trip_hyst) {
24 pr_warn_once("Undefined get_trip_hyst for thermal zone %s - "
25 "running with default hysteresis zero\n", tz->type);
26 trip_hyst = 0;
27 } else
28 tz->ops->get_trip_hyst(tz, trip, &trip_hyst);
29
30 dev_dbg(&tz->device, "Trip%d[temp=%d]:temp=%d:hyst=%d\n",
31 trip, trip_temp, tz->temperature,
32 trip_hyst);
33
34 mutex_lock(&tz->lock);
35
36 list_for_each_entry(instance, &tz->thermal_instances, tz_node) {
37 if (instance->trip != trip)
38 continue;
39
40
41 if (instance->target == THERMAL_NO_TARGET)
42 instance->target = 0;
43
44
45 if (instance->target != 0 && instance->target != 1) {
46 pr_warn("Thermal instance %s controlled by bang-bang has unexpected state: %ld\n",
47 instance->name, instance->target);
48 instance->target = 1;
49 }
50
51
52
53
54
55 if (instance->target == 0 && tz->temperature >= trip_temp)
56 instance->target = 1;
57 else if (instance->target == 1 &&
58 tz->temperature <= trip_temp - trip_hyst)
59 instance->target = 0;
60
61 dev_dbg(&instance->cdev->device, "target=%d\n",
62 (int)instance->target);
63
64 mutex_lock(&instance->cdev->lock);
65 instance->cdev->updated = false;
66 mutex_unlock(&instance->cdev->lock);
67 }
68
69 mutex_unlock(&tz->lock);
70}
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99static int bang_bang_control(struct thermal_zone_device *tz, int trip)
100{
101 struct thermal_instance *instance;
102
103 thermal_zone_trip_update(tz, trip);
104
105 mutex_lock(&tz->lock);
106
107 list_for_each_entry(instance, &tz->thermal_instances, tz_node)
108 thermal_cdev_update(instance->cdev);
109
110 mutex_unlock(&tz->lock);
111
112 return 0;
113}
114
115static struct thermal_governor thermal_gov_bang_bang = {
116 .name = "bang_bang",
117 .throttle = bang_bang_control,
118};
119THERMAL_GOVERNOR_DECLARE(thermal_gov_bang_bang);
120