cregit-Linux how code gets into the kernel

Release 4.7 drivers/thermal/int340x_thermal/processor_thermal_device.c

/*
 * 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/interrupt.h>
#include <linux/platform_device.h>
#include <linux/acpi.h>
#include <linux/thermal.h>
#include "int340x_thermal_zone.h"
#include "../intel_soc_dts_iosf.h"

/* Broadwell-U/HSB thermal reporting device */

#define PCI_DEVICE_ID_PROC_BDW_THERMAL	0x1603

#define PCI_DEVICE_ID_PROC_HSB_THERMAL	0x0A03

/* Skylake thermal reporting device */

#define PCI_DEVICE_ID_PROC_SKL_THERMAL	0x1903

/* Braswell thermal reporting device */

#define PCI_DEVICE_ID_PROC_BSW_THERMAL	0x22DC

/* Broxton thermal reporting device */

#define PCI_DEVICE_ID_PROC_BXT0_THERMAL  0x0A8C

#define PCI_DEVICE_ID_PROC_BXT1_THERMAL  0x1A8C

#define PCI_DEVICE_ID_PROC_BXTX_THERMAL  0x4A8C

#define PCI_DEVICE_ID_PROC_BXTP_THERMAL  0x5A8C


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];
	
struct int34x_thermal_zone *int340x_zone;
	
struct intel_soc_dts_sensors *soc_dts;
};


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 stored_tjmax; 
/* since it is fixed, we can have local storage */


static int get_tjmax(void) { u32 eax, edx; u32 val; int err; err = rdmsr_safe(MSR_IA32_TEMPERATURE_TARGET, &eax, &edx); if (err) return err; val = (eax >> 16) & 0xff; if (val) return val; return -EINVAL; }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada60100.00%1100.00%
Total60100.00%1100.00%


static int read_temp_msr(int *temp) { int cpu; u32 eax, edx; int err; unsigned long curr_temp_off = 0; *temp = 0; for_each_online_cpu(cpu) { err = rdmsr_safe_on_cpu(cpu, MSR_IA32_THERM_STATUS, &eax, &edx); if (err) goto err_ret; else { if (eax & 0x80000000) { curr_temp_off = (eax >> 16) & 0x7f; if (!*temp || curr_temp_off < *temp) *temp = curr_temp_off; } else { err = -EINVAL; goto err_ret; } } } return 0; err_ret: return err; }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada11599.14%150.00%
sascha hauersascha hauer10.86%150.00%
Total116100.00%2100.00%


static int proc_thermal_get_zone_temp(struct thermal_zone_device *zone, int *temp) { int ret; ret = read_temp_msr(temp); if (!ret) *temp = (stored_tjmax - *temp) * 1000; return ret; }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada4497.78%150.00%
sascha hauersascha hauer12.22%150.00%
Total45100.00%2100.00%

static struct thermal_zone_device_ops proc_thermal_local_ops = { .get_temp = proc_thermal_get_zone_temp, };
static int proc_thermal_read_ppcc(struct proc_thermal_device *proc_priv) { int i; acpi_status status; struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER, NULL }; union acpi_object *elements, *ppcc; union acpi_object *p; int ret = 0; status = acpi_evaluate_object(proc_priv->adev->handle, "PPCC", NULL, &buf); if (ACPI_FAILURE(status)) return -ENODEV; p = buf.pointer; if (!p || (p->type != ACPI_TYPE_PACKAGE)) { dev_err(proc_priv->dev, "Invalid PPCC data\n"); ret = -EFAULT; goto free_buffer; } if (!p->package.count) { dev_err(proc_priv->dev, "Invalid PPCC package size\n"); ret = -EFAULT; goto free_buffer; } 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; } free_buffer: kfree(buf.pointer); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada339100.00%3100.00%
Total339100.00%3100.00%

#define PROC_POWER_CAPABILITY_CHANGED 0x83
static void proc_thermal_notify(acpi_handle handle, u32 event, void *data) { struct proc_thermal_device *proc_priv = data; if (!proc_priv) return; switch (event) { case PROC_POWER_CAPABILITY_CHANGED: proc_thermal_read_ppcc(proc_priv); int340x_thermal_zone_device_update(proc_priv->int340x_zone); break; default: dev_err(proc_priv->dev, "Unsupported event [0x%x]\n", event); break; } }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada64100.00%1100.00%
Total64100.00%1100.00%


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; unsigned long long tmp; struct thermal_zone_device_ops *ops = NULL; int ret; adev = ACPI_COMPANION(dev); if (!adev) return -ENODEV; proc_priv = devm_kzalloc(dev, sizeof(*proc_priv), GFP_KERNEL); if (!proc_priv) return -ENOMEM; proc_priv->dev = dev; proc_priv->adev = adev; *priv = proc_priv; ret = proc_thermal_read_ppcc(proc_priv); if (!ret) { ret = sysfs_create_group(&dev->kobj, &power_limit_attribute_group); } if (ret) return ret; status = acpi_evaluate_integer(adev->handle, "_TMP", NULL, &tmp); if (ACPI_FAILURE(status)) { /* there is no _TMP method, add local method */ stored_tjmax = get_tjmax(); if (stored_tjmax > 0) ops = &proc_thermal_local_ops; } proc_priv->int340x_zone = int340x_thermal_zone_add(adev, ops); if (IS_ERR(proc_priv->int340x_zone)) { ret = PTR_ERR(proc_priv->int340x_zone); goto remove_group; } else ret = 0; ret = acpi_install_notify_handler(adev->handle, ACPI_DEVICE_NOTIFY, proc_thermal_notify, (void *)proc_priv); if (ret) goto remove_zone; return 0; remove_zone: int340x_thermal_zone_remove(proc_priv->int340x_zone); remove_group: sysfs_remove_group(&proc_priv->dev->kobj, &power_limit_attribute_group); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada273100.00%4100.00%
Total273100.00%4100.00%


static void proc_thermal_remove(struct proc_thermal_device *proc_priv) { acpi_remove_notify_handler(proc_priv->adev->handle, ACPI_DEVICE_NOTIFY, proc_thermal_notify); int340x_thermal_zone_remove(proc_priv->int340x_zone); sysfs_remove_group(&proc_priv->dev->kobj, &power_limit_attribute_group); }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada4397.73%375.00%
prabhakar ladprabhakar lad12.27%125.00%
Total44100.00%4100.00%


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; }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada75100.00%1100.00%
Total75100.00%1100.00%


static int int3401_remove(struct platform_device *pdev) { proc_thermal_remove(platform_get_drvdata(pdev)); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada22100.00%1100.00%
Total22100.00%1100.00%


static irqreturn_t proc_thermal_pci_msi_irq(int irq, void *devid) { struct proc_thermal_device *proc_priv; struct pci_dev *pdev = devid; proc_priv = pci_get_drvdata(pdev); intel_soc_dts_iosf_interrupt_handler(proc_priv->soc_dts); return IRQ_HANDLED; }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada42100.00%1100.00%
Total42100.00%1100.00%


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; if (pdev->device == PCI_DEVICE_ID_PROC_BSW_THERMAL) { /* * Enumerate additional DTS sensors available via IOSF. * But we are not treating as a failure condition, if * there are no aux DTSs enabled or fails. This driver * already exposes sensors, which can be accessed via * ACPI/MSR. So we don't want to fail for auxiliary DTSs. */ proc_priv->soc_dts = intel_soc_dts_iosf_init( INTEL_SOC_DTS_INTERRUPT_MSI, 2, 0); if (proc_priv->soc_dts && pdev->irq) { ret = pci_enable_msi(pdev); if (!ret) { ret = request_threaded_irq(pdev->irq, NULL, proc_thermal_pci_msi_irq, IRQF_ONESHOT, "proc_thermal", pdev); if (ret) { intel_soc_dts_iosf_exit( proc_priv->soc_dts); pci_disable_msi(pdev); proc_priv->soc_dts = NULL; } } } else dev_err(&pdev->dev, "No auxiliary DTSs enabled\n"); } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada220100.00%2100.00%
Total220100.00%2100.00%


static void proc_thermal_pci_remove(struct pci_dev *pdev) { struct proc_thermal_device *proc_priv = pci_get_drvdata(pdev); if (proc_priv->soc_dts) { intel_soc_dts_iosf_exit(proc_priv->soc_dts); if (pdev->irq) { free_irq(pdev->irq, pdev); pci_disable_msi(pdev); } } proc_thermal_remove(proc_priv); pci_disable_device(pdev); }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada68100.00%2100.00%
Total68100.00%2100.00%

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_SKL_THERMAL)}, { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BSW_THERMAL)}, { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BXT0_THERMAL)}, { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BXT1_THERMAL)}, { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BXTX_THERMAL)}, { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_PROC_BXTP_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; }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada38100.00%1100.00%
Total38100.00%1100.00%


static void __exit proc_thermal_exit(void) { platform_driver_unregister(&int3401_driver); pci_unregister_driver(&proc_thermal_pci_driver); }

Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada21100.00%1100.00%
Total21100.00%1100.00%

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");

Overall Contributors

PersonTokensPropCommitsCommitProp
srinivas pandruvadasrinivas pandruvada193096.50%555.56%
amy wilesamy wiles532.65%111.11%
brian bianbrian bian140.70%111.11%
sascha hauersascha hauer20.10%111.11%
prabhakar ladprabhakar lad10.05%111.11%
Total2000100.00%9100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
{% endraw %}