| /* |
| * processor_thermal_device.c |
| * Copyright (c) 2014, 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/pci.h> |
| #include <linux/platform_device.h> |
| #include <linux/acpi.h> |
| |
| /* Broadwell-U/HSB thermal reporting device */ |
| #define PCI_DEVICE_ID_PROC_BDW_THERMAL 0x1603 |
| #define PCI_DEVICE_ID_PROC_HSB_THERMAL 0x0A03 |
| |
| /* Braswell thermal reporting device */ |
| #define PCI_DEVICE_ID_PROC_BSW_THERMAL 0x22DC |
| |
| struct power_config { |
| u32 index; |
| u32 min_uw; |
| u32 max_uw; |
| u32 tmin_us; |
| u32 tmax_us; |
| u32 step_uw; |
| }; |
| |
| struct proc_thermal_device { |
| struct device *dev; |
| struct acpi_device *adev; |
| struct power_config power_limits[2]; |
| }; |
| |
| enum proc_thermal_emum_mode_type { |
| PROC_THERMAL_NONE, |
| PROC_THERMAL_PCI, |
| PROC_THERMAL_PLATFORM_DEV |
| }; |
| |
| /* |
| * We can have only one type of enumeration, PCI or Platform, |
| * not both. So we don't need instance specific data. |
| */ |
| static enum proc_thermal_emum_mode_type proc_thermal_emum_mode = |
| PROC_THERMAL_NONE; |
| |
| #define POWER_LIMIT_SHOW(index, suffix) \ |
| static ssize_t power_limit_##index##_##suffix##_show(struct device *dev, \ |
| struct device_attribute *attr, \ |
| char *buf) \ |
| { \ |
| struct pci_dev *pci_dev; \ |
| struct platform_device *pdev; \ |
| struct proc_thermal_device *proc_dev; \ |
| \ |
| if (proc_thermal_emum_mode == PROC_THERMAL_PLATFORM_DEV) { \ |
| pdev = to_platform_device(dev); \ |
| proc_dev = platform_get_drvdata(pdev); \ |
| } else { \ |
| pci_dev = to_pci_dev(dev); \ |
| proc_dev = pci_get_drvdata(pci_dev); \ |
| } \ |
| return sprintf(buf, "%lu\n",\ |
| (unsigned long)proc_dev->power_limits[index].suffix * 1000); \ |
| } |
| |
| POWER_LIMIT_SHOW(0, min_uw) |
| POWER_LIMIT_SHOW(0, max_uw) |
| POWER_LIMIT_SHOW(0, step_uw) |
| POWER_LIMIT_SHOW(0, tmin_us) |
| POWER_LIMIT_SHOW(0, tmax_us) |
| |
| POWER_LIMIT_SHOW(1, min_uw) |
| POWER_LIMIT_SHOW(1, max_uw) |
| POWER_LIMIT_SHOW(1, step_uw) |
| POWER_LIMIT_SHOW(1, tmin_us) |
| POWER_LIMIT_SHOW(1, tmax_us) |
| |
| static DEVICE_ATTR_RO(power_limit_0_min_uw); |
| static DEVICE_ATTR_RO(power_limit_0_max_uw); |
| static DEVICE_ATTR_RO(power_limit_0_step_uw); |
| static DEVICE_ATTR_RO(power_limit_0_tmin_us); |
| static DEVICE_ATTR_RO(power_limit_0_tmax_us); |
| |
| static DEVICE_ATTR_RO(power_limit_1_min_uw); |
| static DEVICE_ATTR_RO(power_limit_1_max_uw); |
| static DEVICE_ATTR_RO(power_limit_1_step_uw); |
| static DEVICE_ATTR_RO(power_limit_1_tmin_us); |
| static DEVICE_ATTR_RO(power_limit_1_tmax_us); |
| |
| static struct attribute *power_limit_attrs[] = { |
| &dev_attr_power_limit_0_min_uw.attr, |
| &dev_attr_power_limit_1_min_uw.attr, |
| &dev_attr_power_limit_0_max_uw.attr, |
| &dev_attr_power_limit_1_max_uw.attr, |
| &dev_attr_power_limit_0_step_uw.attr, |
| &dev_attr_power_limit_1_step_uw.attr, |
| &dev_attr_power_limit_0_tmin_us.attr, |
| &dev_attr_power_limit_1_tmin_us.attr, |
| &dev_attr_power_limit_0_tmax_us.attr, |
| &dev_attr_power_limit_1_tmax_us.attr, |
| NULL |
| }; |
| |
| static struct attribute_group power_limit_attribute_group = { |
| .attrs = power_limit_attrs, |
| .name = "power_limits" |
| }; |
| |
| static int proc_thermal_add(struct device *dev, |
| struct proc_thermal_device **priv) |
| { |
| struct proc_thermal_device *proc_priv; |
| struct acpi_device *adev; |
| acpi_status status; |
| struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER, NULL }; |
| union acpi_object *elements, *ppcc; |
| union acpi_object *p; |
| int i; |
| int ret; |
| |
| adev = ACPI_COMPANION(dev); |
| |
| status = acpi_evaluate_object(adev->handle, "PPCC", NULL, &buf); |
| if (ACPI_FAILURE(status)) |
| return -ENODEV; |
| |
| p = buf.pointer; |
| if (!p || (p->type != ACPI_TYPE_PACKAGE)) { |
| dev_err(dev, "Invalid PPCC data\n"); |
| ret = -EFAULT; |
| goto free_buffer; |
| } |
| if (!p->package.count) { |
| dev_err(dev, "Invalid PPCC package size\n"); |
| ret = -EFAULT; |
| goto free_buffer; |
| } |
| |
| proc_priv = devm_kzalloc(dev, sizeof(*proc_priv), GFP_KERNEL); |
| if (!proc_priv) { |
| ret = -ENOMEM; |
| goto free_buffer; |
| } |
| |
| proc_priv->dev = dev; |
| proc_priv->adev = adev; |
| |
| for (i = 0; i < min((int)p->package.count - 1, 2); ++i) { |
| elements = &(p->package.elements[i+1]); |
| if (elements->type != ACPI_TYPE_PACKAGE || |
| elements->package.count != 6) { |
| ret = -EFAULT; |
| goto free_buffer; |
| } |
| ppcc = elements->package.elements; |
| proc_priv->power_limits[i].index = ppcc[0].integer.value; |
| proc_priv->power_limits[i].min_uw = ppcc[1].integer.value; |
| proc_priv->power_limits[i].max_uw = ppcc[2].integer.value; |
| proc_priv->power_limits[i].tmin_us = ppcc[3].integer.value; |
| proc_priv->power_limits[i].tmax_us = ppcc[4].integer.value; |
| proc_priv->power_limits[i].step_uw = ppcc[5].integer.value; |
| } |
| |
| *priv = proc_priv; |
| |
| ret = sysfs_create_group(&dev->kobj, |
| &power_limit_attribute_group); |
| |
| free_buffer: |
| kfree(buf.pointer); |
| |
| return ret; |
| } |
| |
| void proc_thermal_remove(struct proc_thermal_device *proc_priv) |
| { |
| sysfs_remove_group(&proc_priv->dev->kobj, |
| &power_limit_attribute_group); |
| } |
| |
| static int int3401_add(struct platform_device *pdev) |
| { |
| struct proc_thermal_device *proc_priv; |
| int ret; |
| |
| if (proc_thermal_emum_mode == PROC_THERMAL_PCI) { |
| dev_err(&pdev->dev, "error: enumerated as PCI dev\n"); |
| return -ENODEV; |
| } |
| |
| ret = proc_thermal_add(&pdev->dev, &proc_priv); |
| if (ret) |
| return ret; |
| |
| platform_set_drvdata(pdev, proc_priv); |
| proc_thermal_emum_mode = PROC_THERMAL_PLATFORM_DEV; |
| |
| return 0; |
| } |
| |
| static int int3401_remove(struct platform_device *pdev) |
| { |
| proc_thermal_remove(platform_get_drvdata(pdev)); |
| |
| return 0; |
| } |
| |
| static int proc_thermal_pci_probe(struct pci_dev *pdev, |
| const struct pci_device_id *unused) |
| { |
| struct proc_thermal_device *proc_priv; |
| int ret; |
| |
| if (proc_thermal_emum_mode == PROC_THERMAL_PLATFORM_DEV) { |
| dev_err(&pdev->dev, "error: enumerated as platform dev\n"); |
| return -ENODEV; |
| } |
| |
| ret = pci_enable_device(pdev); |
| if (ret < 0) { |
| dev_err(&pdev->dev, "error: could not enable device\n"); |
| return ret; |
| } |
| |
| ret = proc_thermal_add(&pdev->dev, &proc_priv); |
| if (ret) { |
| pci_disable_device(pdev); |
| return ret; |
| } |
| |
| pci_set_drvdata(pdev, proc_priv); |
| proc_thermal_emum_mode = PROC_THERMAL_PCI; |
| |
| return 0; |
| } |
| |
| static void proc_thermal_pci_remove(struct pci_dev *pdev) |
| { |
| proc_thermal_remove(pci_get_drvdata(pdev)); |
| pci_disable_device(pdev); |
| } |
| |
| static const struct pci_device_id proc_thermal_pci_ids[] = { |
| { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BDW_THERMAL)}, |
| { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_HSB_THERMAL)}, |
| { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BSW_THERMAL)}, |
| { 0, }, |
| }; |
| |
| MODULE_DEVICE_TABLE(pci, proc_thermal_pci_ids); |
| |
| static struct pci_driver proc_thermal_pci_driver = { |
| .name = "proc_thermal", |
| .probe = proc_thermal_pci_probe, |
| .remove = proc_thermal_pci_remove, |
| .id_table = proc_thermal_pci_ids, |
| }; |
| |
| static const struct acpi_device_id int3401_device_ids[] = { |
| {"INT3401", 0}, |
| {"", 0}, |
| }; |
| MODULE_DEVICE_TABLE(acpi, int3401_device_ids); |
| |
| static struct platform_driver int3401_driver = { |
| .probe = int3401_add, |
| .remove = int3401_remove, |
| .driver = { |
| .name = "int3401 thermal", |
| .acpi_match_table = int3401_device_ids, |
| }, |
| }; |
| |
| static int __init proc_thermal_init(void) |
| { |
| int ret; |
| |
| ret = platform_driver_register(&int3401_driver); |
| if (ret) |
| return ret; |
| |
| ret = pci_register_driver(&proc_thermal_pci_driver); |
| |
| return ret; |
| } |
| |
| static void __exit proc_thermal_exit(void) |
| { |
| platform_driver_unregister(&int3401_driver); |
| pci_unregister_driver(&proc_thermal_pci_driver); |
| } |
| |
| module_init(proc_thermal_init); |
| module_exit(proc_thermal_exit); |
| |
| MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>"); |
| MODULE_DESCRIPTION("Processor Thermal Reporting Device Driver"); |
| MODULE_LICENSE("GPL v2"); |