1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/kernel.h>
16#include <linux/module.h>
17#include <linux/init.h>
18#include <linux/types.h>
19#include <linux/acpi.h>
20#include <linux/thermal.h>
21#include <linux/platform_device.h>
22#include "int340x_thermal_zone.h"
23
24#define INT3403_TYPE_SENSOR 0x03
25#define INT3403_TYPE_CHARGER 0x0B
26#define INT3403_TYPE_BATTERY 0x0C
27#define INT3403_PERF_CHANGED_EVENT 0x80
28#define INT3403_PERF_TRIP_POINT_CHANGED 0x81
29#define INT3403_THERMAL_EVENT 0x90
30
31
32struct int3403_sensor {
33 struct int34x_thermal_zone *int340x_zone;
34};
35
36struct int3403_performance_state {
37 u64 performance;
38 u64 power;
39 u64 latency;
40 u64 linear;
41 u64 control;
42 u64 raw_performace;
43 char *raw_unit;
44 int reserved;
45};
46
47struct int3403_cdev {
48 struct thermal_cooling_device *cdev;
49 unsigned long max_state;
50};
51
52struct int3403_priv {
53 struct platform_device *pdev;
54 struct acpi_device *adev;
55 unsigned long long type;
56 void *priv;
57};
58
59static void int3403_notify(acpi_handle handle,
60 u32 event, void *data)
61{
62 struct int3403_priv *priv = data;
63 struct int3403_sensor *obj;
64
65 if (!priv)
66 return;
67
68 obj = priv->priv;
69 if (priv->type != INT3403_TYPE_SENSOR || !obj)
70 return;
71
72 switch (event) {
73 case INT3403_PERF_CHANGED_EVENT:
74 break;
75 case INT3403_THERMAL_EVENT:
76 int340x_thermal_zone_device_update(obj->int340x_zone,
77 THERMAL_TRIP_VIOLATED);
78 break;
79 case INT3403_PERF_TRIP_POINT_CHANGED:
80 int340x_thermal_read_trips(obj->int340x_zone);
81 int340x_thermal_zone_device_update(obj->int340x_zone,
82 THERMAL_TRIP_CHANGED);
83 break;
84 default:
85 dev_err(&priv->pdev->dev, "Unsupported event [0x%x]\n", event);
86 break;
87 }
88}
89
90static int int3403_sensor_add(struct int3403_priv *priv)
91{
92 int result = 0;
93 struct int3403_sensor *obj;
94
95 obj = devm_kzalloc(&priv->pdev->dev, sizeof(*obj), GFP_KERNEL);
96 if (!obj)
97 return -ENOMEM;
98
99 priv->priv = obj;
100
101 obj->int340x_zone = int340x_thermal_zone_add(priv->adev, NULL);
102 if (IS_ERR(obj->int340x_zone))
103 return PTR_ERR(obj->int340x_zone);
104
105 result = acpi_install_notify_handler(priv->adev->handle,
106 ACPI_DEVICE_NOTIFY, int3403_notify,
107 (void *)priv);
108 if (result)
109 goto err_free_obj;
110
111 return 0;
112
113 err_free_obj:
114 int340x_thermal_zone_remove(obj->int340x_zone);
115 return result;
116}
117
118static int int3403_sensor_remove(struct int3403_priv *priv)
119{
120 struct int3403_sensor *obj = priv->priv;
121
122 acpi_remove_notify_handler(priv->adev->handle,
123 ACPI_DEVICE_NOTIFY, int3403_notify);
124 int340x_thermal_zone_remove(obj->int340x_zone);
125
126 return 0;
127}
128
129
130static int int3403_get_max_state(struct thermal_cooling_device *cdev,
131 unsigned long *state)
132{
133 struct int3403_priv *priv = cdev->devdata;
134 struct int3403_cdev *obj = priv->priv;
135
136 *state = obj->max_state;
137 return 0;
138}
139
140static int int3403_get_cur_state(struct thermal_cooling_device *cdev,
141 unsigned long *state)
142{
143 struct int3403_priv *priv = cdev->devdata;
144 unsigned long long level;
145 acpi_status status;
146
147 status = acpi_evaluate_integer(priv->adev->handle, "PPPC", NULL, &level);
148 if (ACPI_SUCCESS(status)) {
149 *state = level;
150 return 0;
151 } else
152 return -EINVAL;
153}
154
155static int
156int3403_set_cur_state(struct thermal_cooling_device *cdev, unsigned long state)
157{
158 struct int3403_priv *priv = cdev->devdata;
159 acpi_status status;
160
161 status = acpi_execute_simple_method(priv->adev->handle, "SPPC", state);
162 if (ACPI_SUCCESS(status))
163 return 0;
164 else
165 return -EINVAL;
166}
167
168static const struct thermal_cooling_device_ops int3403_cooling_ops = {
169 .get_max_state = int3403_get_max_state,
170 .get_cur_state = int3403_get_cur_state,
171 .set_cur_state = int3403_set_cur_state,
172};
173
174static int int3403_cdev_add(struct int3403_priv *priv)
175{
176 int result = 0;
177 acpi_status status;
178 struct int3403_cdev *obj;
179 struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER, NULL };
180 union acpi_object *p;
181
182 obj = devm_kzalloc(&priv->pdev->dev, sizeof(*obj), GFP_KERNEL);
183 if (!obj)
184 return -ENOMEM;
185
186 status = acpi_evaluate_object(priv->adev->handle, "PPSS", NULL, &buf);
187 if (ACPI_FAILURE(status))
188 return -ENODEV;
189
190 p = buf.pointer;
191 if (!p || (p->type != ACPI_TYPE_PACKAGE)) {
192 printk(KERN_WARNING "Invalid PPSS data\n");
193 kfree(buf.pointer);
194 return -EFAULT;
195 }
196
197 obj->max_state = p->package.count - 1;
198 obj->cdev =
199 thermal_cooling_device_register(acpi_device_bid(priv->adev),
200 priv, &int3403_cooling_ops);
201 if (IS_ERR(obj->cdev))
202 result = PTR_ERR(obj->cdev);
203
204 priv->priv = obj;
205
206 kfree(buf.pointer);
207
208
209 return result;
210}
211
212static int int3403_cdev_remove(struct int3403_priv *priv)
213{
214 struct int3403_cdev *obj = priv->priv;
215
216 thermal_cooling_device_unregister(obj->cdev);
217 return 0;
218}
219
220static int int3403_add(struct platform_device *pdev)
221{
222 struct int3403_priv *priv;
223 int result = 0;
224 acpi_status status;
225
226 priv = devm_kzalloc(&pdev->dev, sizeof(struct int3403_priv),
227 GFP_KERNEL);
228 if (!priv)
229 return -ENOMEM;
230
231 priv->pdev = pdev;
232 priv->adev = ACPI_COMPANION(&(pdev->dev));
233 if (!priv->adev) {
234 result = -EINVAL;
235 goto err;
236 }
237
238 status = acpi_evaluate_integer(priv->adev->handle, "PTYP",
239 NULL, &priv->type);
240 if (ACPI_FAILURE(status)) {
241 unsigned long long tmp;
242
243 status = acpi_evaluate_integer(priv->adev->handle, "_TMP",
244 NULL, &tmp);
245 if (ACPI_FAILURE(status)) {
246 result = -EINVAL;
247 goto err;
248 } else {
249 priv->type = INT3403_TYPE_SENSOR;
250 }
251 }
252
253 platform_set_drvdata(pdev, priv);
254 switch (priv->type) {
255 case INT3403_TYPE_SENSOR:
256 result = int3403_sensor_add(priv);
257 break;
258 case INT3403_TYPE_CHARGER:
259 case INT3403_TYPE_BATTERY:
260 result = int3403_cdev_add(priv);
261 break;
262 default:
263 result = -EINVAL;
264 }
265
266 if (result)
267 goto err;
268 return result;
269
270err:
271 return result;
272}
273
274static int int3403_remove(struct platform_device *pdev)
275{
276 struct int3403_priv *priv = platform_get_drvdata(pdev);
277
278 switch (priv->type) {
279 case INT3403_TYPE_SENSOR:
280 int3403_sensor_remove(priv);
281 break;
282 case INT3403_TYPE_CHARGER:
283 case INT3403_TYPE_BATTERY:
284 int3403_cdev_remove(priv);
285 break;
286 default:
287 break;
288 }
289
290 return 0;
291}
292
293static const struct acpi_device_id int3403_device_ids[] = {
294 {"INT3403", 0},
295 {"", 0},
296};
297MODULE_DEVICE_TABLE(acpi, int3403_device_ids);
298
299static struct platform_driver int3403_driver = {
300 .probe = int3403_add,
301 .remove = int3403_remove,
302 .driver = {
303 .name = "int3403 thermal",
304 .acpi_match_table = int3403_device_ids,
305 },
306};
307
308module_platform_driver(int3403_driver);
309
310MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
311MODULE_LICENSE("GPL v2");
312MODULE_DESCRIPTION("ACPI INT3403 thermal driver");
313
