Blame view

drivers/thermal/int340x_thermal/int340x_thermal_zone.c 7.85 KB
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
  /*
   * int340x_thermal_zone.c
   * Copyright (c) 2015, Intel Corporation.
   *
   * This program is free software; you can redistribute it and/or modify it
   * under the terms and conditions of the GNU General Public License,
   * version 2, as published by the Free Software Foundation.
   *
   * This program is distributed in the hope it will be useful, but WITHOUT
   * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
   * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
   * more details.
   *
   */
  #include <linux/kernel.h>
  #include <linux/module.h>
  #include <linux/init.h>
  #include <linux/acpi.h>
  #include <linux/thermal.h>
  #include "int340x_thermal_zone.h"
  
  static int int340x_thermal_get_zone_temp(struct thermal_zone_device *zone,
17e8351a7   Sascha Hauer   thermal: consiste...
23
  					 int *temp)
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
24
25
26
27
28
29
30
31
32
33
34
  {
  	struct int34x_thermal_zone *d = zone->devdata;
  	unsigned long long tmp;
  	acpi_status status;
  
  	if (d->override_ops && d->override_ops->get_temp)
  		return d->override_ops->get_temp(zone, temp);
  
  	status = acpi_evaluate_integer(d->adev->handle, "_TMP", NULL, &tmp);
  	if (ACPI_FAILURE(status))
  		return -EIO;
317d9dda0   Srinivas Pandruvada   Thermal/int340x: ...
35
36
37
38
39
40
41
42
43
44
45
  	if (d->lpat_table) {
  		int conv_temp;
  
  		conv_temp = acpi_lpat_raw_to_temp(d->lpat_table, (int)tmp);
  		if (conv_temp < 0)
  			return conv_temp;
  
  		*temp = (unsigned long)conv_temp * 10;
  	} else
  		/* _TMP returns the temperature in tenths of degrees Kelvin */
  		*temp = DECI_KELVIN_TO_MILLICELSIUS(tmp);
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
46
47
48
49
50
  
  	return 0;
  }
  
  static int int340x_thermal_get_trip_temp(struct thermal_zone_device *zone,
17e8351a7   Sascha Hauer   thermal: consiste...
51
  					 int trip, int *temp)
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
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
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
  {
  	struct int34x_thermal_zone *d = zone->devdata;
  	int i;
  
  	if (d->override_ops && d->override_ops->get_trip_temp)
  		return d->override_ops->get_trip_temp(zone, trip, temp);
  
  	if (trip < d->aux_trip_nr)
  		*temp = d->aux_trips[trip];
  	else if (trip == d->crt_trip_id)
  		*temp = d->crt_temp;
  	else if (trip == d->psv_trip_id)
  		*temp = d->psv_temp;
  	else if (trip == d->hot_trip_id)
  		*temp = d->hot_temp;
  	else {
  		for (i = 0; i < INT340X_THERMAL_MAX_ACT_TRIP_COUNT; i++) {
  			if (d->act_trips[i].valid &&
  			    d->act_trips[i].id == trip) {
  				*temp = d->act_trips[i].temp;
  				break;
  			}
  		}
  		if (i == INT340X_THERMAL_MAX_ACT_TRIP_COUNT)
  			return -EINVAL;
  	}
  
  	return 0;
  }
  
  static int int340x_thermal_get_trip_type(struct thermal_zone_device *zone,
  					 int trip,
  					 enum thermal_trip_type *type)
  {
  	struct int34x_thermal_zone *d = zone->devdata;
  	int i;
  
  	if (d->override_ops && d->override_ops->get_trip_type)
  		return d->override_ops->get_trip_type(zone, trip, type);
  
  	if (trip < d->aux_trip_nr)
  		*type = THERMAL_TRIP_PASSIVE;
  	else if (trip == d->crt_trip_id)
  		*type = THERMAL_TRIP_CRITICAL;
  	else if (trip == d->hot_trip_id)
  		*type = THERMAL_TRIP_HOT;
  	else if (trip == d->psv_trip_id)
  		*type = THERMAL_TRIP_PASSIVE;
  	else {
  		for (i = 0; i < INT340X_THERMAL_MAX_ACT_TRIP_COUNT; i++) {
  			if (d->act_trips[i].valid &&
  			    d->act_trips[i].id == trip) {
  				*type = THERMAL_TRIP_ACTIVE;
  				break;
  			}
  		}
  		if (i == INT340X_THERMAL_MAX_ACT_TRIP_COUNT)
  			return -EINVAL;
  	}
  
  	return 0;
  }
  
  static int int340x_thermal_set_trip_temp(struct thermal_zone_device *zone,
17e8351a7   Sascha Hauer   thermal: consiste...
116
  				      int trip, int temp)
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
  {
  	struct int34x_thermal_zone *d = zone->devdata;
  	acpi_status status;
  	char name[10];
  
  	if (d->override_ops && d->override_ops->set_trip_temp)
  		return d->override_ops->set_trip_temp(zone, trip, temp);
  
  	snprintf(name, sizeof(name), "PAT%d", trip);
  	status = acpi_execute_simple_method(d->adev->handle, name,
  			MILLICELSIUS_TO_DECI_KELVIN(temp));
  	if (ACPI_FAILURE(status))
  		return -EIO;
  
  	d->aux_trips[trip] = temp;
  
  	return 0;
  }
  
  
  static int int340x_thermal_get_trip_hyst(struct thermal_zone_device *zone,
17e8351a7   Sascha Hauer   thermal: consiste...
138
  		int trip, int *temp)
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
  {
  	struct int34x_thermal_zone *d = zone->devdata;
  	acpi_status status;
  	unsigned long long hyst;
  
  	if (d->override_ops && d->override_ops->get_trip_hyst)
  		return d->override_ops->get_trip_hyst(zone, trip, temp);
  
  	status = acpi_evaluate_integer(d->adev->handle, "GTSH", NULL, &hyst);
  	if (ACPI_FAILURE(status))
  		return -EIO;
  
  	*temp = hyst * 100;
  
  	return 0;
  }
  
  static struct thermal_zone_device_ops int340x_thermal_zone_ops = {
  	.get_temp       = int340x_thermal_get_zone_temp,
  	.get_trip_temp	= int340x_thermal_get_trip_temp,
  	.get_trip_type	= int340x_thermal_get_trip_type,
  	.set_trip_temp	= int340x_thermal_set_trip_temp,
  	.get_trip_hyst =  int340x_thermal_get_trip_hyst,
  };
  
  static int int340x_thermal_get_trip_config(acpi_handle handle, char *name,
17e8351a7   Sascha Hauer   thermal: consiste...
165
  				      int *temp)
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
166
167
168
169
170
171
172
173
174
175
176
177
  {
  	unsigned long long r;
  	acpi_status status;
  
  	status = acpi_evaluate_integer(handle, name, NULL, &r);
  	if (ACPI_FAILURE(status))
  		return -EIO;
  
  	*temp = DECI_KELVIN_TO_MILLICELSIUS(r);
  
  	return 0;
  }
9176ae866   Srinivas Pandruvada   thermal: int340x:...
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
  int int340x_thermal_read_trips(struct int34x_thermal_zone *int34x_zone)
  {
  	int trip_cnt = int34x_zone->aux_trip_nr;
  	int i;
  
  	int34x_zone->crt_trip_id = -1;
  	if (!int340x_thermal_get_trip_config(int34x_zone->adev->handle, "_CRT",
  					     &int34x_zone->crt_temp))
  		int34x_zone->crt_trip_id = trip_cnt++;
  
  	int34x_zone->hot_trip_id = -1;
  	if (!int340x_thermal_get_trip_config(int34x_zone->adev->handle, "_HOT",
  					     &int34x_zone->hot_temp))
  		int34x_zone->hot_trip_id = trip_cnt++;
  
  	int34x_zone->psv_trip_id = -1;
  	if (!int340x_thermal_get_trip_config(int34x_zone->adev->handle, "_PSV",
  					     &int34x_zone->psv_temp))
  		int34x_zone->psv_trip_id = trip_cnt++;
  
  	for (i = 0; i < INT340X_THERMAL_MAX_ACT_TRIP_COUNT; i++) {
  		char name[5] = { '_', 'A', 'C', '0' + i, '\0' };
  
  		if (int340x_thermal_get_trip_config(int34x_zone->adev->handle,
  					name,
  					&int34x_zone->act_trips[i].temp))
  			break;
  
  		int34x_zone->act_trips[i].id = trip_cnt++;
  		int34x_zone->act_trips[i].valid = true;
  	}
  
  	return trip_cnt;
  }
  EXPORT_SYMBOL_GPL(int340x_thermal_read_trips);
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
213
214
215
216
217
218
219
220
221
222
223
  static struct thermal_zone_params int340x_thermal_params = {
  	.governor_name = "user_space",
  	.no_hwmon = true,
  };
  
  struct int34x_thermal_zone *int340x_thermal_zone_add(struct acpi_device *adev,
  				struct thermal_zone_device_ops *override_ops)
  {
  	struct int34x_thermal_zone *int34x_thermal_zone;
  	acpi_status status;
  	unsigned long long trip_cnt;
9176ae866   Srinivas Pandruvada   thermal: int340x:...
224
  	int trip_mask = 0;
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
  	int ret;
  
  	int34x_thermal_zone = kzalloc(sizeof(*int34x_thermal_zone),
  				      GFP_KERNEL);
  	if (!int34x_thermal_zone)
  		return ERR_PTR(-ENOMEM);
  
  	int34x_thermal_zone->adev = adev;
  	int34x_thermal_zone->override_ops = override_ops;
  
  	status = acpi_evaluate_integer(adev->handle, "PATC", NULL, &trip_cnt);
  	if (ACPI_FAILURE(status))
  		trip_cnt = 0;
  	else {
  		int34x_thermal_zone->aux_trips = kzalloc(
  				sizeof(*int34x_thermal_zone->aux_trips) *
  				trip_cnt, GFP_KERNEL);
  		if (!int34x_thermal_zone->aux_trips) {
  			ret = -ENOMEM;
d5bce8677   Srinivas Pandruvada   Thermal/int340x: ...
244
  			goto err_trip_alloc;
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
245
246
247
248
  		}
  		trip_mask = BIT(trip_cnt) - 1;
  		int34x_thermal_zone->aux_trip_nr = trip_cnt;
  	}
9176ae866   Srinivas Pandruvada   thermal: int340x:...
249
  	trip_cnt = int340x_thermal_read_trips(int34x_thermal_zone);
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
250

317d9dda0   Srinivas Pandruvada   Thermal/int340x: ...
251
252
  	int34x_thermal_zone->lpat_table = acpi_lpat_get_conversion_table(
  								adev->handle);
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
253
254
255
256
257
258
259
260
261
262
  
  	int34x_thermal_zone->zone = thermal_zone_device_register(
  						acpi_device_bid(adev),
  						trip_cnt,
  						trip_mask, int34x_thermal_zone,
  						&int340x_thermal_zone_ops,
  						&int340x_thermal_params,
  						0, 0);
  	if (IS_ERR(int34x_thermal_zone->zone)) {
  		ret = PTR_ERR(int34x_thermal_zone->zone);
d5bce8677   Srinivas Pandruvada   Thermal/int340x: ...
263
  		goto err_thermal_zone;
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
264
265
266
  	}
  
  	return int34x_thermal_zone;
d5bce8677   Srinivas Pandruvada   Thermal/int340x: ...
267
  err_thermal_zone:
317d9dda0   Srinivas Pandruvada   Thermal/int340x: ...
268
  	acpi_lpat_free_conversion_table(int34x_thermal_zone->lpat_table);
d5bce8677   Srinivas Pandruvada   Thermal/int340x: ...
269
270
  	kfree(int34x_thermal_zone->aux_trips);
  err_trip_alloc:
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
271
272
273
274
275
276
277
278
279
  	kfree(int34x_thermal_zone);
  	return ERR_PTR(ret);
  }
  EXPORT_SYMBOL_GPL(int340x_thermal_zone_add);
  
  void int340x_thermal_zone_remove(struct int34x_thermal_zone
  				 *int34x_thermal_zone)
  {
  	thermal_zone_device_unregister(int34x_thermal_zone->zone);
317d9dda0   Srinivas Pandruvada   Thermal/int340x: ...
280
  	acpi_lpat_free_conversion_table(int34x_thermal_zone->lpat_table);
d5bce8677   Srinivas Pandruvada   Thermal/int340x: ...
281
  	kfree(int34x_thermal_zone->aux_trips);
5fbf7f27f   Srinivas Pandruvada   Thermal/int340x: ...
282
283
284
285
286
287
288
289
  	kfree(int34x_thermal_zone);
  }
  EXPORT_SYMBOL_GPL(int340x_thermal_zone_remove);
  
  MODULE_AUTHOR("Aaron Lu <aaron.lu@intel.com>");
  MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
  MODULE_DESCRIPTION("Intel INT340x common thermal zone handler");
  MODULE_LICENSE("GPL v2");