GNU Linux-libre 4.9.283-gnu1
[releases.git] / drivers / thermal / int340x_thermal / int3403_thermal.c
1 /*
2  * ACPI INT3403 thermal driver
3  * Copyright (c) 2013, Intel Corporation.
4  *
5  * This program is free software; you can redistribute it and/or modify it
6  * under the terms and conditions of the GNU General Public License,
7  * version 2, as published by the Free Software Foundation.
8  *
9  * This program is distributed in the hope it will be useful, but WITHOUT
10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
12  * more details.
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 /* Preserved structure for future expandbility */
32 struct int3403_sensor {
33         struct int34x_thermal_zone *int340x_zone;
34 };
35
36 struct 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
47 struct int3403_cdev {
48         struct thermal_cooling_device *cdev;
49         unsigned long max_state;
50 };
51
52 struct int3403_priv {
53         struct platform_device *pdev;
54         struct acpi_device *adev;
55         unsigned long long type;
56         void *priv;
57 };
58
59 static 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
90 static 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
118 static 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 /* INT3403 Cooling devices */
130 static 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
140 static 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
155 static int
156 int3403_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
168 static 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
174 static 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         /* TODO: add ACPI notification support */
208
209         return result;
210 }
211
212 static 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
220 static 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                 result = -EINVAL;
242                 goto err;
243         }
244
245         platform_set_drvdata(pdev, priv);
246         switch (priv->type) {
247         case INT3403_TYPE_SENSOR:
248                 result = int3403_sensor_add(priv);
249                 break;
250         case INT3403_TYPE_CHARGER:
251         case INT3403_TYPE_BATTERY:
252                 result = int3403_cdev_add(priv);
253                 break;
254         default:
255                 result = -EINVAL;
256         }
257
258         if (result)
259                 goto err;
260         return result;
261
262 err:
263         return result;
264 }
265
266 static int int3403_remove(struct platform_device *pdev)
267 {
268         struct int3403_priv *priv = platform_get_drvdata(pdev);
269
270         switch (priv->type) {
271         case INT3403_TYPE_SENSOR:
272                 int3403_sensor_remove(priv);
273                 break;
274         case INT3403_TYPE_CHARGER:
275         case INT3403_TYPE_BATTERY:
276                 int3403_cdev_remove(priv);
277                 break;
278         default:
279                 break;
280         }
281
282         return 0;
283 }
284
285 static const struct acpi_device_id int3403_device_ids[] = {
286         {"INT3403", 0},
287         {"", 0},
288 };
289 MODULE_DEVICE_TABLE(acpi, int3403_device_ids);
290
291 static struct platform_driver int3403_driver = {
292         .probe = int3403_add,
293         .remove = int3403_remove,
294         .driver = {
295                 .name = "int3403 thermal",
296                 .acpi_match_table = int3403_device_ids,
297         },
298 };
299
300 module_platform_driver(int3403_driver);
301
302 MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
303 MODULE_LICENSE("GPL v2");
304 MODULE_DESCRIPTION("ACPI INT3403 thermal driver");