1 /*
2 * processor_thermal_device.c
3 * Copyright (c) 2014, 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/pci.h>
19 #include <linux/platform_device.h>
20 #include <linux/acpi.h>
21 #include <linux/thermal.h>
22 #include "int340x_thermal_zone.h"
23
24 /* Broadwell-U/HSB thermal reporting device */
25 #define PCI_DEVICE_ID_PROC_BDW_THERMAL 0x1603
26 #define PCI_DEVICE_ID_PROC_HSB_THERMAL 0x0A03
27
28 /* Braswell thermal reporting device */
29 #define PCI_DEVICE_ID_PROC_BSW_THERMAL 0x22DC
30
31 struct power_config {
32 u32 index;
33 u32 min_uw;
34 u32 max_uw;
35 u32 tmin_us;
36 u32 tmax_us;
37 u32 step_uw;
38 };
39
40 struct proc_thermal_device {
41 struct device *dev;
42 struct acpi_device *adev;
43 struct power_config power_limits[2];
44 struct int34x_thermal_zone *int340x_zone;
45 };
46
47 enum proc_thermal_emum_mode_type {
48 PROC_THERMAL_NONE,
49 PROC_THERMAL_PCI,
50 PROC_THERMAL_PLATFORM_DEV
51 };
52
53 /*
54 * We can have only one type of enumeration, PCI or Platform,
55 * not both. So we don't need instance specific data.
56 */
57 static enum proc_thermal_emum_mode_type proc_thermal_emum_mode =
58 PROC_THERMAL_NONE;
59
60 #define POWER_LIMIT_SHOW(index, suffix) \
61 static ssize_t power_limit_##index##_##suffix##_show(struct device *dev, \
62 struct device_attribute *attr, \
63 char *buf) \
64 { \
65 struct pci_dev *pci_dev; \
66 struct platform_device *pdev; \
67 struct proc_thermal_device *proc_dev; \
68 \
69 if (proc_thermal_emum_mode == PROC_THERMAL_PLATFORM_DEV) { \
70 pdev = to_platform_device(dev); \
71 proc_dev = platform_get_drvdata(pdev); \
72 } else { \
73 pci_dev = to_pci_dev(dev); \
74 proc_dev = pci_get_drvdata(pci_dev); \
75 } \
76 return sprintf(buf, "%lu\n",\
77 (unsigned long)proc_dev->power_limits[index].suffix * 1000); \
78 }
79
80 POWER_LIMIT_SHOW(0, min_uw)
81 POWER_LIMIT_SHOW(0, max_uw)
82 POWER_LIMIT_SHOW(0, step_uw)
83 POWER_LIMIT_SHOW(0, tmin_us)
84 POWER_LIMIT_SHOW(0, tmax_us)
85
86 POWER_LIMIT_SHOW(1, min_uw)
87 POWER_LIMIT_SHOW(1, max_uw)
88 POWER_LIMIT_SHOW(1, step_uw)
89 POWER_LIMIT_SHOW(1, tmin_us)
90 POWER_LIMIT_SHOW(1, tmax_us)
91
92 static DEVICE_ATTR_RO(power_limit_0_min_uw);
93 static DEVICE_ATTR_RO(power_limit_0_max_uw);
94 static DEVICE_ATTR_RO(power_limit_0_step_uw);
95 static DEVICE_ATTR_RO(power_limit_0_tmin_us);
96 static DEVICE_ATTR_RO(power_limit_0_tmax_us);
97
98 static DEVICE_ATTR_RO(power_limit_1_min_uw);
99 static DEVICE_ATTR_RO(power_limit_1_max_uw);
100 static DEVICE_ATTR_RO(power_limit_1_step_uw);
101 static DEVICE_ATTR_RO(power_limit_1_tmin_us);
102 static DEVICE_ATTR_RO(power_limit_1_tmax_us);
103
104 static struct attribute *power_limit_attrs[] = {
105 &dev_attr_power_limit_0_min_uw.attr,
106 &dev_attr_power_limit_1_min_uw.attr,
107 &dev_attr_power_limit_0_max_uw.attr,
108 &dev_attr_power_limit_1_max_uw.attr,
109 &dev_attr_power_limit_0_step_uw.attr,
110 &dev_attr_power_limit_1_step_uw.attr,
111 &dev_attr_power_limit_0_tmin_us.attr,
112 &dev_attr_power_limit_1_tmin_us.attr,
113 &dev_attr_power_limit_0_tmax_us.attr,
114 &dev_attr_power_limit_1_tmax_us.attr,
115 NULL
116 };
117
118 static struct attribute_group power_limit_attribute_group = {
119 .attrs = power_limit_attrs,
120 .name = "power_limits"
121 };
122
123 static int stored_tjmax; /* since it is fixed, we can have local storage */
124
get_tjmax(void)125 static int get_tjmax(void)
126 {
127 u32 eax, edx;
128 u32 val;
129 int err;
130
131 err = rdmsr_safe(MSR_IA32_TEMPERATURE_TARGET, &eax, &edx);
132 if (err)
133 return err;
134
135 val = (eax >> 16) & 0xff;
136 if (val)
137 return val;
138
139 return -EINVAL;
140 }
141
read_temp_msr(unsigned long * temp)142 static int read_temp_msr(unsigned long *temp)
143 {
144 int cpu;
145 u32 eax, edx;
146 int err;
147 unsigned long curr_temp_off = 0;
148
149 *temp = 0;
150
151 for_each_online_cpu(cpu) {
152 err = rdmsr_safe_on_cpu(cpu, MSR_IA32_THERM_STATUS, &eax,
153 &edx);
154 if (err)
155 goto err_ret;
156 else {
157 if (eax & 0x80000000) {
158 curr_temp_off = (eax >> 16) & 0x7f;
159 if (!*temp || curr_temp_off < *temp)
160 *temp = curr_temp_off;
161 } else {
162 err = -EINVAL;
163 goto err_ret;
164 }
165 }
166 }
167
168 return 0;
169 err_ret:
170 return err;
171 }
172
proc_thermal_get_zone_temp(struct thermal_zone_device * zone,unsigned long * temp)173 static int proc_thermal_get_zone_temp(struct thermal_zone_device *zone,
174 unsigned long *temp)
175 {
176 int ret;
177
178 ret = read_temp_msr(temp);
179 if (!ret)
180 *temp = (stored_tjmax - *temp) * 1000;
181
182 return ret;
183 }
184
185 static struct thermal_zone_device_ops proc_thermal_local_ops = {
186 .get_temp = proc_thermal_get_zone_temp,
187 };
188
proc_thermal_add(struct device * dev,struct proc_thermal_device ** priv)189 static int proc_thermal_add(struct device *dev,
190 struct proc_thermal_device **priv)
191 {
192 struct proc_thermal_device *proc_priv;
193 struct acpi_device *adev;
194 acpi_status status;
195 struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER, NULL };
196 union acpi_object *elements, *ppcc;
197 union acpi_object *p;
198 unsigned long long tmp;
199 struct thermal_zone_device_ops *ops = NULL;
200 int i;
201 int ret;
202
203 adev = ACPI_COMPANION(dev);
204 if (!adev)
205 return -ENODEV;
206
207 status = acpi_evaluate_object(adev->handle, "PPCC", NULL, &buf);
208 if (ACPI_FAILURE(status))
209 return -ENODEV;
210
211 p = buf.pointer;
212 if (!p || (p->type != ACPI_TYPE_PACKAGE)) {
213 dev_err(dev, "Invalid PPCC data\n");
214 ret = -EFAULT;
215 goto free_buffer;
216 }
217 if (!p->package.count) {
218 dev_err(dev, "Invalid PPCC package size\n");
219 ret = -EFAULT;
220 goto free_buffer;
221 }
222
223 proc_priv = devm_kzalloc(dev, sizeof(*proc_priv), GFP_KERNEL);
224 if (!proc_priv) {
225 ret = -ENOMEM;
226 goto free_buffer;
227 }
228
229 proc_priv->dev = dev;
230 proc_priv->adev = adev;
231
232 for (i = 0; i < min((int)p->package.count - 1, 2); ++i) {
233 elements = &(p->package.elements[i+1]);
234 if (elements->type != ACPI_TYPE_PACKAGE ||
235 elements->package.count != 6) {
236 ret = -EFAULT;
237 goto free_buffer;
238 }
239 ppcc = elements->package.elements;
240 proc_priv->power_limits[i].index = ppcc[0].integer.value;
241 proc_priv->power_limits[i].min_uw = ppcc[1].integer.value;
242 proc_priv->power_limits[i].max_uw = ppcc[2].integer.value;
243 proc_priv->power_limits[i].tmin_us = ppcc[3].integer.value;
244 proc_priv->power_limits[i].tmax_us = ppcc[4].integer.value;
245 proc_priv->power_limits[i].step_uw = ppcc[5].integer.value;
246 }
247
248 *priv = proc_priv;
249
250 ret = sysfs_create_group(&dev->kobj,
251 &power_limit_attribute_group);
252 if (ret)
253 goto free_buffer;
254
255 status = acpi_evaluate_integer(adev->handle, "_TMP", NULL, &tmp);
256 if (ACPI_FAILURE(status)) {
257 /* there is no _TMP method, add local method */
258 stored_tjmax = get_tjmax();
259 if (stored_tjmax > 0)
260 ops = &proc_thermal_local_ops;
261 }
262
263 proc_priv->int340x_zone = int340x_thermal_zone_add(adev, ops);
264 if (IS_ERR(proc_priv->int340x_zone)) {
265 sysfs_remove_group(&proc_priv->dev->kobj,
266 &power_limit_attribute_group);
267 ret = PTR_ERR(proc_priv->int340x_zone);
268 } else
269 ret = 0;
270
271 free_buffer:
272 kfree(buf.pointer);
273
274 return ret;
275 }
276
proc_thermal_remove(struct proc_thermal_device * proc_priv)277 static void proc_thermal_remove(struct proc_thermal_device *proc_priv)
278 {
279 int340x_thermal_zone_remove(proc_priv->int340x_zone);
280 sysfs_remove_group(&proc_priv->dev->kobj,
281 &power_limit_attribute_group);
282 }
283
int3401_add(struct platform_device * pdev)284 static int int3401_add(struct platform_device *pdev)
285 {
286 struct proc_thermal_device *proc_priv;
287 int ret;
288
289 if (proc_thermal_emum_mode == PROC_THERMAL_PCI) {
290 dev_err(&pdev->dev, "error: enumerated as PCI dev\n");
291 return -ENODEV;
292 }
293
294 ret = proc_thermal_add(&pdev->dev, &proc_priv);
295 if (ret)
296 return ret;
297
298 platform_set_drvdata(pdev, proc_priv);
299 proc_thermal_emum_mode = PROC_THERMAL_PLATFORM_DEV;
300
301 return 0;
302 }
303
int3401_remove(struct platform_device * pdev)304 static int int3401_remove(struct platform_device *pdev)
305 {
306 proc_thermal_remove(platform_get_drvdata(pdev));
307
308 return 0;
309 }
310
proc_thermal_pci_probe(struct pci_dev * pdev,const struct pci_device_id * unused)311 static int proc_thermal_pci_probe(struct pci_dev *pdev,
312 const struct pci_device_id *unused)
313 {
314 struct proc_thermal_device *proc_priv;
315 int ret;
316
317 if (proc_thermal_emum_mode == PROC_THERMAL_PLATFORM_DEV) {
318 dev_err(&pdev->dev, "error: enumerated as platform dev\n");
319 return -ENODEV;
320 }
321
322 ret = pci_enable_device(pdev);
323 if (ret < 0) {
324 dev_err(&pdev->dev, "error: could not enable device\n");
325 return ret;
326 }
327
328 ret = proc_thermal_add(&pdev->dev, &proc_priv);
329 if (ret) {
330 pci_disable_device(pdev);
331 return ret;
332 }
333
334 pci_set_drvdata(pdev, proc_priv);
335 proc_thermal_emum_mode = PROC_THERMAL_PCI;
336
337 return 0;
338 }
339
proc_thermal_pci_remove(struct pci_dev * pdev)340 static void proc_thermal_pci_remove(struct pci_dev *pdev)
341 {
342 proc_thermal_remove(pci_get_drvdata(pdev));
343 pci_disable_device(pdev);
344 }
345
346 static const struct pci_device_id proc_thermal_pci_ids[] = {
347 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BDW_THERMAL)},
348 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_HSB_THERMAL)},
349 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BSW_THERMAL)},
350 { 0, },
351 };
352
353 MODULE_DEVICE_TABLE(pci, proc_thermal_pci_ids);
354
355 static struct pci_driver proc_thermal_pci_driver = {
356 .name = "proc_thermal",
357 .probe = proc_thermal_pci_probe,
358 .remove = proc_thermal_pci_remove,
359 .id_table = proc_thermal_pci_ids,
360 };
361
362 static const struct acpi_device_id int3401_device_ids[] = {
363 {"INT3401", 0},
364 {"", 0},
365 };
366 MODULE_DEVICE_TABLE(acpi, int3401_device_ids);
367
368 static struct platform_driver int3401_driver = {
369 .probe = int3401_add,
370 .remove = int3401_remove,
371 .driver = {
372 .name = "int3401 thermal",
373 .acpi_match_table = int3401_device_ids,
374 },
375 };
376
proc_thermal_init(void)377 static int __init proc_thermal_init(void)
378 {
379 int ret;
380
381 ret = platform_driver_register(&int3401_driver);
382 if (ret)
383 return ret;
384
385 ret = pci_register_driver(&proc_thermal_pci_driver);
386
387 return ret;
388 }
389
proc_thermal_exit(void)390 static void __exit proc_thermal_exit(void)
391 {
392 platform_driver_unregister(&int3401_driver);
393 pci_unregister_driver(&proc_thermal_pci_driver);
394 }
395
396 module_init(proc_thermal_init);
397 module_exit(proc_thermal_exit);
398
399 MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
400 MODULE_DESCRIPTION("Processor Thermal Reporting Device Driver");
401 MODULE_LICENSE("GPL v2");
402