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/pci.h>
19#include <linux/interrupt.h>
20#include <linux/platform_device.h>
21#include <linux/acpi.h>
22#include <linux/thermal.h>
23#include "int340x_thermal_zone.h"
24#include "../intel_soc_dts_iosf.h"
25
26
27#define PCI_DEVICE_ID_PROC_BDW_THERMAL 0x1603
28#define PCI_DEVICE_ID_PROC_HSB_THERMAL 0x0A03
29
30
31#define PCI_DEVICE_ID_PROC_SKL_THERMAL 0x1903
32
33
34#define PCI_DEVICE_ID_PROC_BSW_THERMAL 0x22DC
35
36
37#define PCI_DEVICE_ID_PROC_BXT0_THERMAL 0x0A8C
38#define PCI_DEVICE_ID_PROC_BXT1_THERMAL 0x1A8C
39#define PCI_DEVICE_ID_PROC_BXTX_THERMAL 0x4A8C
40#define PCI_DEVICE_ID_PROC_BXTP_THERMAL 0x5A8C
41
42struct power_config {
43 u32 index;
44 u32 min_uw;
45 u32 max_uw;
46 u32 tmin_us;
47 u32 tmax_us;
48 u32 step_uw;
49};
50
51struct proc_thermal_device {
52 struct device *dev;
53 struct acpi_device *adev;
54 struct power_config power_limits[2];
55 struct int34x_thermal_zone *int340x_zone;
56 struct intel_soc_dts_sensors *soc_dts;
57};
58
59enum proc_thermal_emum_mode_type {
60 PROC_THERMAL_NONE,
61 PROC_THERMAL_PCI,
62 PROC_THERMAL_PLATFORM_DEV
63};
64
65
66
67
68
69static enum proc_thermal_emum_mode_type proc_thermal_emum_mode =
70 PROC_THERMAL_NONE;
71
72#define POWER_LIMIT_SHOW(index, suffix) \
73static ssize_t power_limit_##index##_##suffix##_show(struct device *dev, \
74 struct device_attribute *attr, \
75 char *buf) \
76{ \
77 struct pci_dev *pci_dev; \
78 struct platform_device *pdev; \
79 struct proc_thermal_device *proc_dev; \
80\
81 if (proc_thermal_emum_mode == PROC_THERMAL_PLATFORM_DEV) { \
82 pdev = to_platform_device(dev); \
83 proc_dev = platform_get_drvdata(pdev); \
84 } else { \
85 pci_dev = to_pci_dev(dev); \
86 proc_dev = pci_get_drvdata(pci_dev); \
87 } \
88 return sprintf(buf, "%lu\n",\
89 (unsigned long)proc_dev->power_limits[index].suffix * 1000); \
90}
91
92POWER_LIMIT_SHOW(0, min_uw)
93POWER_LIMIT_SHOW(0, max_uw)
94POWER_LIMIT_SHOW(0, step_uw)
95POWER_LIMIT_SHOW(0, tmin_us)
96POWER_LIMIT_SHOW(0, tmax_us)
97
98POWER_LIMIT_SHOW(1, min_uw)
99POWER_LIMIT_SHOW(1, max_uw)
100POWER_LIMIT_SHOW(1, step_uw)
101POWER_LIMIT_SHOW(1, tmin_us)
102POWER_LIMIT_SHOW(1, tmax_us)
103
104static DEVICE_ATTR_RO(power_limit_0_min_uw);
105static DEVICE_ATTR_RO(power_limit_0_max_uw);
106static DEVICE_ATTR_RO(power_limit_0_step_uw);
107static DEVICE_ATTR_RO(power_limit_0_tmin_us);
108static DEVICE_ATTR_RO(power_limit_0_tmax_us);
109
110static DEVICE_ATTR_RO(power_limit_1_min_uw);
111static DEVICE_ATTR_RO(power_limit_1_max_uw);
112static DEVICE_ATTR_RO(power_limit_1_step_uw);
113static DEVICE_ATTR_RO(power_limit_1_tmin_us);
114static DEVICE_ATTR_RO(power_limit_1_tmax_us);
115
116static struct attribute *power_limit_attrs[] = {
117 &dev_attr_power_limit_0_min_uw.attr,
118 &dev_attr_power_limit_1_min_uw.attr,
119 &dev_attr_power_limit_0_max_uw.attr,
120 &dev_attr_power_limit_1_max_uw.attr,
121 &dev_attr_power_limit_0_step_uw.attr,
122 &dev_attr_power_limit_1_step_uw.attr,
123 &dev_attr_power_limit_0_tmin_us.attr,
124 &dev_attr_power_limit_1_tmin_us.attr,
125 &dev_attr_power_limit_0_tmax_us.attr,
126 &dev_attr_power_limit_1_tmax_us.attr,
127 NULL
128};
129
130static struct attribute_group power_limit_attribute_group = {
131 .attrs = power_limit_attrs,
132 .name = "power_limits"
133};
134
135static int stored_tjmax;
136
137static int get_tjmax(void)
138{
139 u32 eax, edx;
140 u32 val;
141 int err;
142
143 err = rdmsr_safe(MSR_IA32_TEMPERATURE_TARGET, &eax, &edx);
144 if (err)
145 return err;
146
147 val = (eax >> 16) & 0xff;
148 if (val)
149 return val;
150
151 return -EINVAL;
152}
153
154static int read_temp_msr(int *temp)
155{
156 int cpu;
157 u32 eax, edx;
158 int err;
159 unsigned long curr_temp_off = 0;
160
161 *temp = 0;
162
163 for_each_online_cpu(cpu) {
164 err = rdmsr_safe_on_cpu(cpu, MSR_IA32_THERM_STATUS, &eax,
165 &edx);
166 if (err)
167 goto err_ret;
168 else {
169 if (eax & 0x80000000) {
170 curr_temp_off = (eax >> 16) & 0x7f;
171 if (!*temp || curr_temp_off < *temp)
172 *temp = curr_temp_off;
173 } else {
174 err = -EINVAL;
175 goto err_ret;
176 }
177 }
178 }
179
180 return 0;
181err_ret:
182 return err;
183}
184
185static int proc_thermal_get_zone_temp(struct thermal_zone_device *zone,
186 int *temp)
187{
188 int ret;
189
190 ret = read_temp_msr(temp);
191 if (!ret)
192 *temp = (stored_tjmax - *temp) * 1000;
193
194 return ret;
195}
196
197static struct thermal_zone_device_ops proc_thermal_local_ops = {
198 .get_temp = proc_thermal_get_zone_temp,
199};
200
201static int proc_thermal_read_ppcc(struct proc_thermal_device *proc_priv)
202{
203 int i;
204 acpi_status status;
205 struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER, NULL };
206 union acpi_object *elements, *ppcc;
207 union acpi_object *p;
208 int ret = 0;
209
210 status = acpi_evaluate_object(proc_priv->adev->handle, "PPCC",
211 NULL, &buf);
212 if (ACPI_FAILURE(status))
213 return -ENODEV;
214
215 p = buf.pointer;
216 if (!p || (p->type != ACPI_TYPE_PACKAGE)) {
217 dev_err(proc_priv->dev, "Invalid PPCC data\n");
218 ret = -EFAULT;
219 goto free_buffer;
220 }
221
222 if (!p->package.count) {
223 dev_err(proc_priv->dev, "Invalid PPCC package size\n");
224 ret = -EFAULT;
225 goto free_buffer;
226 }
227
228 for (i = 0; i < min((int)p->package.count - 1, 2); ++i) {
229 elements = &(p->package.elements[i+1]);
230 if (elements->type != ACPI_TYPE_PACKAGE ||
231 elements->package.count != 6) {
232 ret = -EFAULT;
233 goto free_buffer;
234 }
235 ppcc = elements->package.elements;
236 proc_priv->power_limits[i].index = ppcc[0].integer.value;
237 proc_priv->power_limits[i].min_uw = ppcc[1].integer.value;
238 proc_priv->power_limits[i].max_uw = ppcc[2].integer.value;
239 proc_priv->power_limits[i].tmin_us = ppcc[3].integer.value;
240 proc_priv->power_limits[i].tmax_us = ppcc[4].integer.value;
241 proc_priv->power_limits[i].step_uw = ppcc[5].integer.value;
242 }
243
244free_buffer:
245 kfree(buf.pointer);
246
247 return ret;
248}
249
250#define PROC_POWER_CAPABILITY_CHANGED 0x83
251static void proc_thermal_notify(acpi_handle handle, u32 event, void *data)
252{
253 struct proc_thermal_device *proc_priv = data;
254
255 if (!proc_priv)
256 return;
257
258 switch (event) {
259 case PROC_POWER_CAPABILITY_CHANGED:
260 proc_thermal_read_ppcc(proc_priv);
261 int340x_thermal_zone_device_update(proc_priv->int340x_zone,
262 THERMAL_DEVICE_POWER_CAPABILITY_CHANGED);
263 break;
264 default:
265 dev_err(proc_priv->dev, "Unsupported event [0x%x]\n", event);
266 break;
267 }
268}
269
270
271static int proc_thermal_add(struct device *dev,
272 struct proc_thermal_device **priv)
273{
274 struct proc_thermal_device *proc_priv;
275 struct acpi_device *adev;
276 acpi_status status;
277 unsigned long long tmp;
278 struct thermal_zone_device_ops *ops = NULL;
279 int ret;
280
281 adev = ACPI_COMPANION(dev);
282 if (!adev)
283 return -ENODEV;
284
285 proc_priv = devm_kzalloc(dev, sizeof(*proc_priv), GFP_KERNEL);
286 if (!proc_priv)
287 return -ENOMEM;
288
289 proc_priv->dev = dev;
290 proc_priv->adev = adev;
291 *priv = proc_priv;
292
293 ret = proc_thermal_read_ppcc(proc_priv);
294 if (!ret) {
295 ret = sysfs_create_group(&dev->kobj,
296 &power_limit_attribute_group);
297
298 }
299 if (ret)
300 return ret;
301
302 status = acpi_evaluate_integer(adev->handle, "_TMP", NULL, &tmp);
303 if (ACPI_FAILURE(status)) {
304
305 stored_tjmax = get_tjmax();
306 if (stored_tjmax > 0)
307 ops = &proc_thermal_local_ops;
308 }
309
310 proc_priv->int340x_zone = int340x_thermal_zone_add(adev, ops);
311 if (IS_ERR(proc_priv->int340x_zone)) {
312 ret = PTR_ERR(proc_priv->int340x_zone);
313 goto remove_group;
314 } else
315 ret = 0;
316
317 ret = acpi_install_notify_handler(adev->handle, ACPI_DEVICE_NOTIFY,
318 proc_thermal_notify,
319 (void *)proc_priv);
320 if (ret)
321 goto remove_zone;
322
323 return 0;
324
325remove_zone:
326 int340x_thermal_zone_remove(proc_priv->int340x_zone);
327remove_group:
328 sysfs_remove_group(&proc_priv->dev->kobj,
329 &power_limit_attribute_group);
330
331 return ret;
332}
333
334static void proc_thermal_remove(struct proc_thermal_device *proc_priv)
335{
336 acpi_remove_notify_handler(proc_priv->adev->handle,
337 ACPI_DEVICE_NOTIFY, proc_thermal_notify);
338 int340x_thermal_zone_remove(proc_priv->int340x_zone);
339 sysfs_remove_group(&proc_priv->dev->kobj,
340 &power_limit_attribute_group);
341}
342
343static int int3401_add(struct platform_device *pdev)
344{
345 struct proc_thermal_device *proc_priv;
346 int ret;
347
348 if (proc_thermal_emum_mode == PROC_THERMAL_PCI) {
349 dev_err(&pdev->dev, "error: enumerated as PCI dev\n");
350 return -ENODEV;
351 }
352
353 ret = proc_thermal_add(&pdev->dev, &proc_priv);
354 if (ret)
355 return ret;
356
357 platform_set_drvdata(pdev, proc_priv);
358 proc_thermal_emum_mode = PROC_THERMAL_PLATFORM_DEV;
359
360 return 0;
361}
362
363static int int3401_remove(struct platform_device *pdev)
364{
365 proc_thermal_remove(platform_get_drvdata(pdev));
366
367 return 0;
368}
369
370static irqreturn_t proc_thermal_pci_msi_irq(int irq, void *devid)
371{
372 struct proc_thermal_device *proc_priv;
373 struct pci_dev *pdev = devid;
374
375 proc_priv = pci_get_drvdata(pdev);
376
377 intel_soc_dts_iosf_interrupt_handler(proc_priv->soc_dts);
378
379 return IRQ_HANDLED;
380}
381
382static int proc_thermal_pci_probe(struct pci_dev *pdev,
383 const struct pci_device_id *unused)
384{
385 struct proc_thermal_device *proc_priv;
386 int ret;
387
388 if (proc_thermal_emum_mode == PROC_THERMAL_PLATFORM_DEV) {
389 dev_err(&pdev->dev, "error: enumerated as platform dev\n");
390 return -ENODEV;
391 }
392
393 ret = pci_enable_device(pdev);
394 if (ret < 0) {
395 dev_err(&pdev->dev, "error: could not enable device\n");
396 return ret;
397 }
398
399 ret = proc_thermal_add(&pdev->dev, &proc_priv);
400 if (ret) {
401 pci_disable_device(pdev);
402 return ret;
403 }
404
405 pci_set_drvdata(pdev, proc_priv);
406 proc_thermal_emum_mode = PROC_THERMAL_PCI;
407
408 if (pdev->device == PCI_DEVICE_ID_PROC_BSW_THERMAL) {
409
410
411
412
413
414
415
416 proc_priv->soc_dts = intel_soc_dts_iosf_init(
417 INTEL_SOC_DTS_INTERRUPT_MSI, 2, 0);
418
419 if (proc_priv->soc_dts && pdev->irq) {
420 ret = pci_enable_msi(pdev);
421 if (!ret) {
422 ret = request_threaded_irq(pdev->irq, NULL,
423 proc_thermal_pci_msi_irq,
424 IRQF_ONESHOT, "proc_thermal",
425 pdev);
426 if (ret) {
427 intel_soc_dts_iosf_exit(
428 proc_priv->soc_dts);
429 pci_disable_msi(pdev);
430 proc_priv->soc_dts = NULL;
431 }
432 }
433 } else
434 dev_err(&pdev->dev, "No auxiliary DTSs enabled\n");
435 }
436
437 return 0;
438}
439
440static void proc_thermal_pci_remove(struct pci_dev *pdev)
441{
442 struct proc_thermal_device *proc_priv = pci_get_drvdata(pdev);
443
444 if (proc_priv->soc_dts) {
445 intel_soc_dts_iosf_exit(proc_priv->soc_dts);
446 if (pdev->irq) {
447 free_irq(pdev->irq, pdev);
448 pci_disable_msi(pdev);
449 }
450 }
451 proc_thermal_remove(proc_priv);
452 pci_disable_device(pdev);
453}
454
455static const struct pci_device_id proc_thermal_pci_ids[] = {
456 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BDW_THERMAL)},
457 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_HSB_THERMAL)},
458 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_SKL_THERMAL)},
459 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BSW_THERMAL)},
460 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BXT0_THERMAL)},
461 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BXT1_THERMAL)},
462 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BXTX_THERMAL)},
463 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BXTP_THERMAL)},
464 { 0, },
465};
466
467MODULE_DEVICE_TABLE(pci, proc_thermal_pci_ids);
468
469static struct pci_driver proc_thermal_pci_driver = {
470 .name = "proc_thermal",
471 .probe = proc_thermal_pci_probe,
472 .remove = proc_thermal_pci_remove,
473 .id_table = proc_thermal_pci_ids,
474};
475
476static const struct acpi_device_id int3401_device_ids[] = {
477 {"INT3401", 0},
478 {"", 0},
479};
480MODULE_DEVICE_TABLE(acpi, int3401_device_ids);
481
482static struct platform_driver int3401_driver = {
483 .probe = int3401_add,
484 .remove = int3401_remove,
485 .driver = {
486 .name = "int3401 thermal",
487 .acpi_match_table = int3401_device_ids,
488 },
489};
490
491static int __init proc_thermal_init(void)
492{
493 int ret;
494
495 ret = platform_driver_register(&int3401_driver);
496 if (ret)
497 return ret;
498
499 ret = pci_register_driver(&proc_thermal_pci_driver);
500
501 return ret;
502}
503
504static void __exit proc_thermal_exit(void)
505{
506 platform_driver_unregister(&int3401_driver);
507 pci_unregister_driver(&proc_thermal_pci_driver);
508}
509
510module_init(proc_thermal_init);
511module_exit(proc_thermal_exit);
512
513MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
514MODULE_DESCRIPTION("Processor Thermal Reporting Device Driver");
515MODULE_LICENSE("GPL v2");
516