1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * int340x_thermal_zone.c
4 * Copyright (c) 2015, Intel Corporation.
5 */
6 #include <linux/kernel.h>
7 #include <linux/module.h>
8 #include <linux/init.h>
9 #include <linux/acpi.h>
10 #include <linux/thermal.h>
11 #include <linux/units.h>
12 #include "int340x_thermal_zone.h"
13
int340x_thermal_get_zone_temp(struct thermal_zone_device * zone,int * temp)14 static int int340x_thermal_get_zone_temp(struct thermal_zone_device *zone,
15 int *temp)
16 {
17 struct int34x_thermal_zone *d = zone->devdata;
18 unsigned long long tmp;
19 acpi_status status;
20
21 status = acpi_evaluate_integer(d->adev->handle, "_TMP", NULL, &tmp);
22 if (ACPI_FAILURE(status))
23 return -EIO;
24
25 if (d->lpat_table) {
26 int conv_temp;
27
28 conv_temp = acpi_lpat_raw_to_temp(d->lpat_table, (int)tmp);
29 if (conv_temp < 0)
30 return conv_temp;
31
32 *temp = conv_temp * 10;
33 } else {
34 /* _TMP returns the temperature in tenths of degrees Kelvin */
35 *temp = deci_kelvin_to_millicelsius(tmp);
36 }
37
38 return 0;
39 }
40
int340x_thermal_set_trip_temp(struct thermal_zone_device * zone,int trip,int temp)41 static int int340x_thermal_set_trip_temp(struct thermal_zone_device *zone,
42 int trip, int temp)
43 {
44 struct int34x_thermal_zone *d = zone->devdata;
45 char name[] = {'P', 'A', 'T', '0' + trip, '\0'};
46 acpi_status status;
47
48 if (trip > 9)
49 return -EINVAL;
50
51 status = acpi_execute_simple_method(d->adev->handle, name,
52 millicelsius_to_deci_kelvin(temp));
53 if (ACPI_FAILURE(status))
54 return -EIO;
55
56 return 0;
57 }
58
int340x_thermal_critical(struct thermal_zone_device * zone)59 static void int340x_thermal_critical(struct thermal_zone_device *zone)
60 {
61 dev_dbg(&zone->device, "%s: critical temperature reached\n", zone->type);
62 }
63
64 static struct thermal_zone_device_ops int340x_thermal_zone_ops = {
65 .get_temp = int340x_thermal_get_zone_temp,
66 .set_trip_temp = int340x_thermal_set_trip_temp,
67 .critical = int340x_thermal_critical,
68 };
69
int340x_thermal_read_trips(struct acpi_device * zone_adev,struct thermal_trip * zone_trips,int trip_cnt)70 static int int340x_thermal_read_trips(struct acpi_device *zone_adev,
71 struct thermal_trip *zone_trips,
72 int trip_cnt)
73 {
74 int i, ret;
75
76 ret = thermal_acpi_critical_trip_temp(zone_adev,
77 &zone_trips[trip_cnt].temperature);
78 if (!ret) {
79 zone_trips[trip_cnt].type = THERMAL_TRIP_CRITICAL;
80 trip_cnt++;
81 }
82
83 ret = thermal_acpi_hot_trip_temp(zone_adev,
84 &zone_trips[trip_cnt].temperature);
85 if (!ret) {
86 zone_trips[trip_cnt].type = THERMAL_TRIP_HOT;
87 trip_cnt++;
88 }
89
90 ret = thermal_acpi_passive_trip_temp(zone_adev,
91 &zone_trips[trip_cnt].temperature);
92 if (!ret) {
93 zone_trips[trip_cnt].type = THERMAL_TRIP_PASSIVE;
94 trip_cnt++;
95 }
96
97 for (i = 0; i < INT340X_THERMAL_MAX_ACT_TRIP_COUNT; i++) {
98 ret = thermal_acpi_active_trip_temp(zone_adev, i,
99 &zone_trips[trip_cnt].temperature);
100 if (ret)
101 break;
102
103 zone_trips[trip_cnt].type = THERMAL_TRIP_ACTIVE;
104 trip_cnt++;
105 }
106
107 return trip_cnt;
108 }
109
110 static struct thermal_zone_params int340x_thermal_params = {
111 .governor_name = "user_space",
112 .no_hwmon = true,
113 };
114
int340x_thermal_zone_add(struct acpi_device * adev,int (* get_temp)(struct thermal_zone_device *,int *))115 struct int34x_thermal_zone *int340x_thermal_zone_add(struct acpi_device *adev,
116 int (*get_temp) (struct thermal_zone_device *, int *))
117 {
118 struct int34x_thermal_zone *int34x_zone;
119 struct thermal_trip *zone_trips;
120 unsigned long long trip_cnt = 0;
121 unsigned long long hyst;
122 int trip_mask = 0;
123 acpi_status status;
124 int i, ret;
125
126 int34x_zone = kzalloc(sizeof(*int34x_zone), GFP_KERNEL);
127 if (!int34x_zone)
128 return ERR_PTR(-ENOMEM);
129
130 int34x_zone->adev = adev;
131
132 int34x_zone->ops = kmemdup(&int340x_thermal_zone_ops,
133 sizeof(int340x_thermal_zone_ops), GFP_KERNEL);
134 if (!int34x_zone->ops) {
135 ret = -ENOMEM;
136 goto err_ops_alloc;
137 }
138
139 if (get_temp)
140 int34x_zone->ops->get_temp = get_temp;
141
142 status = acpi_evaluate_integer(adev->handle, "PATC", NULL, &trip_cnt);
143 if (ACPI_SUCCESS(status)) {
144 int34x_zone->aux_trip_nr = trip_cnt;
145 trip_mask = BIT(trip_cnt) - 1;
146 }
147
148 zone_trips = kzalloc(sizeof(*zone_trips) * (trip_cnt + INT340X_THERMAL_MAX_TRIP_COUNT),
149 GFP_KERNEL);
150 if (!zone_trips) {
151 ret = -ENOMEM;
152 goto err_trips_alloc;
153 }
154
155 for (i = 0; i < trip_cnt; i++) {
156 zone_trips[i].type = THERMAL_TRIP_PASSIVE;
157 zone_trips[i].temperature = THERMAL_TEMP_INVALID;
158 }
159
160 trip_cnt = int340x_thermal_read_trips(adev, zone_trips, trip_cnt);
161
162 status = acpi_evaluate_integer(adev->handle, "GTSH", NULL, &hyst);
163 if (ACPI_SUCCESS(status))
164 hyst *= 100;
165 else
166 hyst = 0;
167
168 for (i = 0; i < trip_cnt; ++i)
169 zone_trips[i].hysteresis = hyst;
170
171 int34x_zone->trips = zone_trips;
172
173 int34x_zone->lpat_table = acpi_lpat_get_conversion_table(adev->handle);
174
175 int34x_zone->zone = thermal_zone_device_register_with_trips(
176 acpi_device_bid(adev),
177 zone_trips, trip_cnt,
178 trip_mask, int34x_zone,
179 int34x_zone->ops,
180 &int340x_thermal_params,
181 0, 0);
182 if (IS_ERR(int34x_zone->zone)) {
183 ret = PTR_ERR(int34x_zone->zone);
184 goto err_thermal_zone;
185 }
186 ret = thermal_zone_device_enable(int34x_zone->zone);
187 if (ret)
188 goto err_enable;
189
190 return int34x_zone;
191
192 err_enable:
193 thermal_zone_device_unregister(int34x_zone->zone);
194 err_thermal_zone:
195 kfree(int34x_zone->trips);
196 acpi_lpat_free_conversion_table(int34x_zone->lpat_table);
197 err_trips_alloc:
198 kfree(int34x_zone->ops);
199 err_ops_alloc:
200 kfree(int34x_zone);
201 return ERR_PTR(ret);
202 }
203 EXPORT_SYMBOL_GPL(int340x_thermal_zone_add);
204
int340x_thermal_zone_remove(struct int34x_thermal_zone * int34x_zone)205 void int340x_thermal_zone_remove(struct int34x_thermal_zone *int34x_zone)
206 {
207 thermal_zone_device_unregister(int34x_zone->zone);
208 acpi_lpat_free_conversion_table(int34x_zone->lpat_table);
209 kfree(int34x_zone->trips);
210 kfree(int34x_zone->ops);
211 kfree(int34x_zone);
212 }
213 EXPORT_SYMBOL_GPL(int340x_thermal_zone_remove);
214
int340x_thermal_update_trips(struct int34x_thermal_zone * int34x_zone)215 void int340x_thermal_update_trips(struct int34x_thermal_zone *int34x_zone)
216 {
217 struct acpi_device *zone_adev = int34x_zone->adev;
218 struct thermal_trip *zone_trips = int34x_zone->trips;
219 int trip_cnt = int34x_zone->zone->num_trips;
220 int act_trip_nr = 0;
221 int i;
222
223 mutex_lock(&int34x_zone->zone->lock);
224
225 for (i = int34x_zone->aux_trip_nr; i < trip_cnt; i++) {
226 int temp, err;
227
228 switch (zone_trips[i].type) {
229 case THERMAL_TRIP_CRITICAL:
230 err = thermal_acpi_critical_trip_temp(zone_adev, &temp);
231 break;
232 case THERMAL_TRIP_HOT:
233 err = thermal_acpi_hot_trip_temp(zone_adev, &temp);
234 break;
235 case THERMAL_TRIP_PASSIVE:
236 err = thermal_acpi_passive_trip_temp(zone_adev, &temp);
237 break;
238 case THERMAL_TRIP_ACTIVE:
239 err = thermal_acpi_active_trip_temp(zone_adev, act_trip_nr++,
240 &temp);
241 break;
242 default:
243 err = -ENODEV;
244 }
245 if (err) {
246 zone_trips[i].temperature = THERMAL_TEMP_INVALID;
247 continue;
248 }
249
250 zone_trips[i].temperature = temp;
251 }
252
253 mutex_unlock(&int34x_zone->zone->lock);
254 }
255 EXPORT_SYMBOL_GPL(int340x_thermal_update_trips);
256
257 MODULE_AUTHOR("Aaron Lu <aaron.lu@intel.com>");
258 MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
259 MODULE_DESCRIPTION("Intel INT340x common thermal zone handler");
260 MODULE_LICENSE("GPL v2");
261