[linux-yocto] [[PATCH 1/1] thermal: Intel SoC DTS thermal
chong.yi.chai at intel.com
chong.yi.chai at intel.com
Wed Mar 30 20:17:37 PDT 2016
From: "Chai, Chong Yi" <chong.yi.chai at intel.com>
---
features/soc/baytrail/baytrail.scc | 2 +
...el-SoC-DTS-Don-t-do-thermal-zone-update-i.patch | 88 ++++
.../baytrail/thermal-Intel-SoC-DTS-thermal.patch | 555 +++++++++++++++++++++
3 files changed, 645 insertions(+)
create mode 100644 features/soc/baytrail/thermal-Intel-SoC-DTS-Don-t-do-thermal-zone-update-i.patch
create mode 100644 features/soc/baytrail/thermal-Intel-SoC-DTS-thermal.patch
diff --git a/features/soc/baytrail/baytrail.scc b/features/soc/baytrail/baytrail.scc
index a1d8688..df1f83b 100644
--- a/features/soc/baytrail/baytrail.scc
+++ b/features/soc/baytrail/baytrail.scc
@@ -74,3 +74,5 @@ patch pinctrl-baytrail-setup-IOAPIC-interrupt-for-GPIO-clu.patch
patch pinctrl-baytrail-Serialize-GPIO-registers-access-wit.patch
patch pwm-Add-freq_hz-and-duty_percent.patch
patch scsi-add-extended-information-to-MEDIA_CHANGE.patch
+patch thermal-Intel-SoC-DTS-thermal.patch
+patch thermal-Intel-SoC-DTS-Don-t-do-thermal-zone-update-i.patch
diff --git a/features/soc/baytrail/thermal-Intel-SoC-DTS-Don-t-do-thermal-zone-update-i.patch b/features/soc/baytrail/thermal-Intel-SoC-DTS-Don-t-do-thermal-zone-update-i.patch
new file mode 100644
index 0000000..4b1e0cc
--- /dev/null
+++ b/features/soc/baytrail/thermal-Intel-SoC-DTS-Don-t-do-thermal-zone-update-i.patch
@@ -0,0 +1,88 @@
+From fd4bdc940c44e6e88d9e9383c5743e828aa0bb49 Mon Sep 17 00:00:00 2001
+From: Maurice Petallo <mauricex.r.petallo at intel.com>
+Date: Fri, 28 Nov 2014 10:11:41 +0800
+Subject: [PATCH 089/164] thermal: Intel SoC DTS: Don't do thermal zone update
+ inside spin_lock
+
+The driver calls spin_lock_irqsave during DTS interrupt. The interrupt
+handle then calls thermal_zone_device_update which implicitly calls
+a sleep function and produce the following bug:
+
+BUG: sleeping function called from invalid context at kernel/locking/mutex.c:97
+in_atomic(): 1, irqs_disabled(): 1, pid: 920, name: irq/86-soc_dts
+CPU: 0 PID: 920 Comm: irq/86-soc_dts Tainted: G E 3.17.0-rc2+ #1
+Hardware name: Intel Corp. VALLEYVIEW B3 PLATFORM/NOTEBOOK, BIOS BYTICRB1.86C.0092.R31.1408290850 08/29/2014
+ 00000000 00000000 c25dbe74 c1818cfd f3cc488c c25dbe9c c1059305 c1b4063b
+ 00000001 00000001 00000398 f3cc488c f6817644 f6817644 f3ecc6c0 c25dbea8
+ c18208f2 f6817400 c25dbebc c159b0bb c25dbedc f6817400 f32a2300 c25dbee8
+Call Trace:
+ [<c1818cfd>] dump_stack+0x48/0x60
+ [<c1059305>] __might_sleep+0xec/0xf4
+ [<c18208f2>] mutex_lock+0x1c/0x34
+ [<c159b0bb>] thermal_zone_get_temp+0x34/0x59
+ [<c159bde5>] thermal_zone_device_update+0x2d/0xcb
+ [<f85da16a>] ? iosf_mbi_write+0x6c/0x74 [iosf_mbi]
+ [<f7c7445d>] soc_irq_thread_fn+0x10c/0x163 [intel_soc_dts_thermal]
+ [<c107b72b>] irq_thread_fn+0x18/0x2a
+ [<c107bedb>] irq_thread+0x81/0x11f
+ [<c107b713>] ? irq_finalize_oneshot+0x7c/0x7c
+ [<c107bf79>] ? irq_thread+0x11f/0x11f
+ [<c107be5a>] ? wake_threads_waitq+0x31/0x31
+ [<c1054217>] kthread+0x87/0x8c
+ [<c1821e41>] ret_from_kernel_thread+0x21/0x30
+ [<c1054190>] ? __kthread_parkme+0x55/0x55
+
+Signed-off-by: Maurice Petallo <mauricex.r.petallo at intel.com>
+Acked-by: Srinivas Pandruvada <srinivas.pandruvada at linux.intel.com>
+Acked-by: Eduardo Valentin <edubezval at gmail.com>
+CC: Kweh, Hock Leong <hock.leong.kweh at intel.com>
+Signed-off-by: Zhang Rui <rui.zhang at intel.com>
+(cherry picked from commit 05629296eec7e18038ca90ca4d5fa03824026429)
+Signed-off-by: Ooi, Joyce <joyce.ooi at intel.com>
+---
+ drivers/thermal/intel_soc_dts_thermal.c | 12 +++++++-----
+ 1 files changed, 7 insertions(+), 5 deletions(-)
+
+diff --git a/drivers/thermal/intel_soc_dts_thermal.c b/drivers/thermal/intel_soc_dts_thermal.c
+index a6a0a18..5580f5b 100644
+--- a/drivers/thermal/intel_soc_dts_thermal.c
++++ b/drivers/thermal/intel_soc_dts_thermal.c
+@@ -360,6 +360,9 @@ static void proc_thermal_interrupt(void)
+ u32 sticky_out;
+ int status;
+ u32 ptmc_out;
++ unsigned long flags;
++
++ spin_lock_irqsave(&intr_notify_lock, flags);
+
+ /* Clear APIC interrupt */
+ status = iosf_mbi_read(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_READ,
+@@ -378,21 +381,20 @@ static void proc_thermal_interrupt(void)
+ /* reset sticky bit */
+ status = iosf_mbi_write(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_WRITE,
+ SOC_DTS_OFFSET_PTTSS, sticky_out);
++ spin_unlock_irqrestore(&intr_notify_lock, flags);
++
+ for (i = 0; i < SOC_MAX_DTS_SENSORS; ++i) {
+ pr_debug("TZD update for zone %d\n", i);
+ thermal_zone_device_update(soc_dts[i]->tzone);
+ }
+- }
++ } else
++ spin_unlock_irqrestore(&intr_notify_lock, flags);
+
+ }
+
+ static irqreturn_t soc_irq_thread_fn(int irq, void *dev_data)
+ {
+- unsigned long flags;
+-
+- spin_lock_irqsave(&intr_notify_lock, flags);
+ proc_thermal_interrupt();
+- spin_unlock_irqrestore(&intr_notify_lock, flags);
+ pr_debug("proc_thermal_interrupt\n");
+
+ return IRQ_HANDLED;
+--
+1.7.7.6
+
diff --git a/features/soc/baytrail/thermal-Intel-SoC-DTS-thermal.patch b/features/soc/baytrail/thermal-Intel-SoC-DTS-thermal.patch
new file mode 100644
index 0000000..24a4ceb
--- /dev/null
+++ b/features/soc/baytrail/thermal-Intel-SoC-DTS-thermal.patch
@@ -0,0 +1,555 @@
+From d1358730bdf5a98aa2bb66bf28ee5265900d1d22 Mon Sep 17 00:00:00 2001
+From: Srinivas Pandruvada <srinivas.pandruvada at linux.intel.com>
+Date: Mon, 7 Apr 2014 13:57:15 -0700
+Subject: [PATCH 088/164] thermal: Intel SoC DTS thermal
+
+In the Intel SoCs like Bay Trail, there are 2 additional digital temperature
+sensors(DTS), in addition to the standard DTSs in the core. Also they support
+4 programmable thresholds, out of which two can be used by OSPM. These
+thresholds can be used by OSPM thermal control. Out of these two thresholds,
+one is used by driver and one user mode can change via thermal sysfs to get
+notifications on threshold violations.
+
+The driver defines one critical trip points, which is set to TJ MAX - offset.
+The offset can be changed via module parameter (default 5C). Also it uses
+one of the thresholds to get notification for this temperature violation.
+This is very important for orderly shutdown as the many of these devices don't
+have ACPI thermal zone, and expects that there is some other thermal control
+mechanism present in OSPM. When a Linux distro is used without additional
+specialized thermal control program, BIOS can do force shutdown when thermals
+are not under control. When temperature reaches critical, the Linux thermal
+core will initiate an orderly shutdown.
+
+Signed-off-by: Srinivas Pandruvada <srinivas.pandruvada at linux.intel.com>
+Signed-off-by: Zhang Rui <rui.zhang at intel.com>
+(cherry picked from commit bc40b5e320dfe4a691a6cf09ac5c8005d561eebd)
+Signed-off-by: Ooi, Joyce <joyce.ooi at intel.com>
+---
+ drivers/thermal/Kconfig | 12 +
+ drivers/thermal/Makefile | 1 +
+ drivers/thermal/intel_soc_dts_thermal.c | 479 +++++++++++++++++++++++++++++++
+ 3 files changed, 492 insertions(+), 0 deletions(-)
+ create mode 100644 drivers/thermal/intel_soc_dts_thermal.c
+
+diff --git a/drivers/thermal/Kconfig b/drivers/thermal/Kconfig
+index 5f88d76..87117e5 100644
+--- a/drivers/thermal/Kconfig
++++ b/drivers/thermal/Kconfig
+@@ -222,6 +222,18 @@ config ACPI_INT3403_THERMAL
+ the Intel Thermal Daemon can use this information to allow the user
+ to select his laptop to run without turning on the fans.
+
++config INTEL_SOC_DTS_THERMAL
++ tristate "Intel SoCs DTS thermal driver"
++ depends on X86 && IOSF_MBI
++ help
++ Enable this to register Intel SoCs (e.g. Bay Trail) platform digital
++ temperature sensor (DTS). These SoCs have two additional DTSs in
++ addition to DTSs on CPU cores. Each DTS will be registered as a
++ thermal zone. There are two trip points. One of the trip point can
++ be set by user mode programs to get notifications via Linux thermal
++ notification methods.The other trip is a critical trip point, which
++ was set by the driver based on the TJ MAX temperature.
++
+ menu "Texas Instruments thermal drivers"
+ source "drivers/thermal/ti-soc-thermal/Kconfig"
+ endmenu
+diff --git a/drivers/thermal/Makefile b/drivers/thermal/Makefile
+index 54e4ec9..de0636a 100644
+--- a/drivers/thermal/Makefile
++++ b/drivers/thermal/Makefile
+@@ -29,5 +29,6 @@ obj-$(CONFIG_IMX_THERMAL) += imx_thermal.o
+ obj-$(CONFIG_DB8500_CPUFREQ_COOLING) += db8500_cpufreq_cooling.o
+ obj-$(CONFIG_INTEL_POWERCLAMP) += intel_powerclamp.o
+ obj-$(CONFIG_X86_PKG_TEMP_THERMAL) += x86_pkg_temp_thermal.o
++obj-$(CONFIG_INTEL_SOC_DTS_THERMAL) += intel_soc_dts_thermal.o
+ obj-$(CONFIG_TI_SOC_THERMAL) += ti-soc-thermal/
+ obj-$(CONFIG_ACPI_INT3403_THERMAL) += int3403_thermal.o
+diff --git a/drivers/thermal/intel_soc_dts_thermal.c b/drivers/thermal/intel_soc_dts_thermal.c
+new file mode 100644
+index 0000000..a6a0a18
+--- /dev/null
++++ b/drivers/thermal/intel_soc_dts_thermal.c
+@@ -0,0 +1,479 @@
++/*
++ * intel_soc_dts_thermal.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.
++ *
++ */
++
++#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
++
++#include <linux/module.h>
++#include <linux/slab.h>
++#include <linux/interrupt.h>
++#include <linux/thermal.h>
++#include <asm/cpu_device_id.h>
++#include <asm/iosf_mbi.h>
++
++#define SOC_DTS_OFFSET_ENABLE 0xB0
++#define SOC_DTS_OFFSET_TEMP 0xB1
++
++#define SOC_DTS_OFFSET_PTPS 0xB2
++#define SOC_DTS_OFFSET_PTTS 0xB3
++#define SOC_DTS_OFFSET_PTTSS 0xB4
++#define SOC_DTS_OFFSET_PTMC 0x80
++#define SOC_DTS_TE_AUX0 0xB5
++#define SOC_DTS_TE_AUX1 0xB6
++
++#define SOC_DTS_AUX0_ENABLE_BIT BIT(0)
++#define SOC_DTS_AUX1_ENABLE_BIT BIT(1)
++#define SOC_DTS_CPU_MODULE0_ENABLE_BIT BIT(16)
++#define SOC_DTS_CPU_MODULE1_ENABLE_BIT BIT(17)
++#define SOC_DTS_TE_SCI_ENABLE BIT(9)
++#define SOC_DTS_TE_SMI_ENABLE BIT(10)
++#define SOC_DTS_TE_MSI_ENABLE BIT(11)
++#define SOC_DTS_TE_APICA_ENABLE BIT(14)
++#define SOC_DTS_PTMC_APIC_DEASSERT_BIT BIT(4)
++
++/* DTS encoding for TJ MAX temperature */
++#define SOC_DTS_TJMAX_ENCODING 0x7F
++
++/* IRQ 86 is a fixed APIC interrupt for BYT DTS Aux threshold notifications */
++#define BYT_SOC_DTS_APIC_IRQ 86
++
++/* Only 2 out of 4 is allowed for OSPM */
++#define SOC_MAX_DTS_TRIPS 2
++
++/* Mask for two trips in status bits */
++#define SOC_DTS_TRIP_MASK 0x03
++
++/* DTS0 and DTS 1 */
++#define SOC_MAX_DTS_SENSORS 2
++
++#define CRITICAL_OFFSET_FROM_TJ_MAX 5000
++
++struct soc_sensor_entry {
++ int id;
++ u32 tj_max;
++ u32 temp_mask;
++ u32 temp_shift;
++ u32 store_status;
++ struct thermal_zone_device *tzone;
++};
++
++static struct soc_sensor_entry *soc_dts[SOC_MAX_DTS_SENSORS];
++
++static int crit_offset = CRITICAL_OFFSET_FROM_TJ_MAX;
++module_param(crit_offset, int, 0644);
++MODULE_PARM_DESC(crit_offset,
++ "Critical Temperature offset from tj max in millidegree Celsius.");
++
++static DEFINE_MUTEX(aux_update_mutex);
++static spinlock_t intr_notify_lock;
++static int soc_dts_thres_irq;
++
++static int get_tj_max(u32 *tj_max)
++{
++ u32 eax, edx;
++ u32 val;
++ int err;
++
++ err = rdmsr_safe(MSR_IA32_TEMPERATURE_TARGET, &eax, &edx);
++ if (err)
++ goto err_ret;
++ else {
++ val = (eax >> 16) & 0xff;
++ if (val)
++ *tj_max = val * 1000;
++ else {
++ err = -EINVAL;
++ goto err_ret;
++ }
++ }
++
++ return 0;
++err_ret:
++ *tj_max = 0;
++
++ return err;
++}
++
++static int sys_get_trip_temp(struct thermal_zone_device *tzd,
++ int trip, unsigned long *temp)
++{
++ int status;
++ u32 out;
++ struct soc_sensor_entry *aux_entry;
++
++ aux_entry = tzd->devdata;
++
++ if (!trip) {
++ /* Just return the critical temp */
++ *temp = aux_entry->tj_max - crit_offset;
++ return 0;
++ }
++
++ mutex_lock(&aux_update_mutex);
++ status = iosf_mbi_read(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_READ,
++ SOC_DTS_OFFSET_PTPS, &out);
++ mutex_unlock(&aux_update_mutex);
++ if (status)
++ return status;
++
++ out = (out >> (trip * 8)) & SOC_DTS_TJMAX_ENCODING;
++
++ if (!out)
++ *temp = 0;
++ else
++ *temp = aux_entry->tj_max - out * 1000;
++
++ return 0;
++}
++
++static int update_trip_temp(struct soc_sensor_entry *aux_entry,
++ int thres_index, unsigned long temp)
++{
++ int status;
++ u32 temp_out;
++ u32 out;
++ u32 store_ptps;
++ u32 store_ptmc;
++ u32 store_te_out;
++ u32 te_out;
++
++ u32 int_enable_bit = SOC_DTS_TE_APICA_ENABLE |
++ SOC_DTS_TE_MSI_ENABLE;
++
++ temp_out = (aux_entry->tj_max - temp) / 1000;
++
++ status = iosf_mbi_read(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_READ,
++ SOC_DTS_OFFSET_PTPS, &store_ptps);
++ if (status)
++ return status;
++
++ out = (store_ptps & ~(0xFF << (thres_index * 8)));
++ out |= (temp_out & 0xFF) << (thres_index * 8);
++ status = iosf_mbi_write(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_WRITE,
++ SOC_DTS_OFFSET_PTPS, out);
++ if (status)
++ return status;
++ pr_debug("update_trip_temp PTPS = %x\n", out);
++ status = iosf_mbi_read(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_READ,
++ SOC_DTS_OFFSET_PTMC, &out);
++ if (status)
++ goto err_restore_ptps;
++
++ store_ptmc = out;
++
++ status = iosf_mbi_read(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_READ,
++ SOC_DTS_TE_AUX0 + thres_index,
++ &te_out);
++ if (status)
++ goto err_restore_ptmc;
++
++ store_te_out = te_out;
++
++ /* Enable for CPU module 0 and module 1 */
++ out |= (SOC_DTS_CPU_MODULE0_ENABLE_BIT |
++ SOC_DTS_CPU_MODULE1_ENABLE_BIT);
++ if (temp) {
++ if (thres_index)
++ out |= SOC_DTS_AUX1_ENABLE_BIT;
++ else
++ out |= SOC_DTS_AUX0_ENABLE_BIT;
++ te_out |= int_enable_bit;
++ } else {
++ if (thres_index)
++ out &= ~SOC_DTS_AUX1_ENABLE_BIT;
++ else
++ out &= ~SOC_DTS_AUX0_ENABLE_BIT;
++ te_out &= ~int_enable_bit;
++ }
++ status = iosf_mbi_write(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_WRITE,
++ SOC_DTS_OFFSET_PTMC, out);
++ if (status)
++ goto err_restore_te_out;
++
++ status = iosf_mbi_write(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_WRITE,
++ SOC_DTS_TE_AUX0 + thres_index,
++ te_out);
++ if (status)
++ goto err_restore_te_out;
++
++ return 0;
++
++err_restore_te_out:
++ iosf_mbi_write(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_WRITE,
++ SOC_DTS_OFFSET_PTMC, store_te_out);
++err_restore_ptmc:
++ iosf_mbi_write(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_WRITE,
++ SOC_DTS_OFFSET_PTMC, store_ptmc);
++err_restore_ptps:
++ iosf_mbi_write(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_WRITE,
++ SOC_DTS_OFFSET_PTPS, store_ptps);
++ /* Nothing we can do if restore fails */
++
++ return status;
++}
++
++static int sys_set_trip_temp(struct thermal_zone_device *tzd, int trip,
++ unsigned long temp)
++{
++ struct soc_sensor_entry *aux_entry = tzd->devdata;
++ int status;
++
++ if (temp > (aux_entry->tj_max - crit_offset))
++ return -EINVAL;
++
++ mutex_lock(&aux_update_mutex);
++ status = update_trip_temp(tzd->devdata, trip, temp);
++ mutex_unlock(&aux_update_mutex);
++
++ return status;
++}
++
++static int sys_get_trip_type(struct thermal_zone_device *thermal,
++ int trip, enum thermal_trip_type *type)
++{
++ if (trip)
++ *type = THERMAL_TRIP_PASSIVE;
++ else
++ *type = THERMAL_TRIP_CRITICAL;
++
++ return 0;
++}
++
++static int sys_get_curr_temp(struct thermal_zone_device *tzd,
++ unsigned long *temp)
++{
++ int status;
++ u32 out;
++ struct soc_sensor_entry *aux_entry;
++
++ aux_entry = tzd->devdata;
++
++ status = iosf_mbi_read(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_READ,
++ SOC_DTS_OFFSET_TEMP, &out);
++ if (status)
++ return status;
++
++ out = (out & aux_entry->temp_mask) >> aux_entry->temp_shift;
++ out -= SOC_DTS_TJMAX_ENCODING;
++ *temp = aux_entry->tj_max - out * 1000;
++
++ return 0;
++}
++
++static struct thermal_zone_device_ops tzone_ops = {
++ .get_temp = sys_get_curr_temp,
++ .get_trip_temp = sys_get_trip_temp,
++ .get_trip_type = sys_get_trip_type,
++ .set_trip_temp = sys_set_trip_temp,
++};
++
++static void free_soc_dts(struct soc_sensor_entry *aux_entry)
++{
++ if (aux_entry) {
++ iosf_mbi_write(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_WRITE,
++ SOC_DTS_OFFSET_ENABLE, aux_entry->store_status);
++ thermal_zone_device_unregister(aux_entry->tzone);
++ kfree(aux_entry);
++ }
++}
++
++static int soc_dts_enable(int id)
++{
++ u32 out;
++ int ret;
++
++ ret = iosf_mbi_read(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_READ,
++ SOC_DTS_OFFSET_ENABLE, &out);
++ if (ret)
++ return ret;
++
++ if (!(out & BIT(id))) {
++ out |= BIT(id);
++ ret = iosf_mbi_write(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_WRITE,
++ SOC_DTS_OFFSET_ENABLE, out);
++ if (ret)
++ return ret;
++ }
++
++ return ret;
++}
++
++static struct soc_sensor_entry *alloc_soc_dts(int id, u32 tj_max)
++{
++ struct soc_sensor_entry *aux_entry;
++ char name[10];
++ int err;
++
++ aux_entry = kzalloc(sizeof(*aux_entry), GFP_KERNEL);
++ if (!aux_entry) {
++ err = -ENOMEM;
++ return ERR_PTR(-ENOMEM);
++ }
++
++ /* Store status to restor on exit */
++ err = iosf_mbi_read(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_READ,
++ SOC_DTS_OFFSET_ENABLE,
++ &aux_entry->store_status);
++ if (err)
++ goto err_ret;
++
++ aux_entry->id = id;
++ aux_entry->tj_max = tj_max;
++ aux_entry->temp_mask = 0x00FF << (id * 8);
++ aux_entry->temp_shift = id * 8;
++ snprintf(name, sizeof(name), "soc_dts%d", id);
++ aux_entry->tzone = thermal_zone_device_register(name,
++ SOC_MAX_DTS_TRIPS,
++ 0x02,
++ aux_entry, &tzone_ops, NULL, 0, 0);
++ if (IS_ERR(aux_entry->tzone)) {
++ err = PTR_ERR(aux_entry->tzone);
++ goto err_ret;
++ }
++
++ err = soc_dts_enable(id);
++ if (err)
++ goto err_aux_status;
++
++ return aux_entry;
++
++err_aux_status:
++ thermal_zone_device_unregister(aux_entry->tzone);
++err_ret:
++ kfree(aux_entry);
++ return ERR_PTR(err);
++}
++
++static void proc_thermal_interrupt(void)
++{
++ u32 sticky_out;
++ int status;
++ u32 ptmc_out;
++
++ /* Clear APIC interrupt */
++ status = iosf_mbi_read(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_READ,
++ SOC_DTS_OFFSET_PTMC, &ptmc_out);
++
++ ptmc_out |= SOC_DTS_PTMC_APIC_DEASSERT_BIT;
++ status = iosf_mbi_write(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_WRITE,
++ SOC_DTS_OFFSET_PTMC, ptmc_out);
++
++ /* Read status here */
++ status = iosf_mbi_read(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_READ,
++ SOC_DTS_OFFSET_PTTSS, &sticky_out);
++ pr_debug("status %d PTTSS %x\n", status, sticky_out);
++ if (sticky_out & SOC_DTS_TRIP_MASK) {
++ int i;
++ /* reset sticky bit */
++ status = iosf_mbi_write(BT_MBI_UNIT_PMC, BT_MBI_BUNIT_WRITE,
++ SOC_DTS_OFFSET_PTTSS, sticky_out);
++ for (i = 0; i < SOC_MAX_DTS_SENSORS; ++i) {
++ pr_debug("TZD update for zone %d\n", i);
++ thermal_zone_device_update(soc_dts[i]->tzone);
++ }
++ }
++
++}
++
++static irqreturn_t soc_irq_thread_fn(int irq, void *dev_data)
++{
++ unsigned long flags;
++
++ spin_lock_irqsave(&intr_notify_lock, flags);
++ proc_thermal_interrupt();
++ spin_unlock_irqrestore(&intr_notify_lock, flags);
++ pr_debug("proc_thermal_interrupt\n");
++
++ return IRQ_HANDLED;
++}
++
++static const struct x86_cpu_id soc_thermal_ids[] = {
++ { X86_VENDOR_INTEL, X86_FAMILY_ANY, 0x37, 0, BYT_SOC_DTS_APIC_IRQ},
++ {}
++};
++MODULE_DEVICE_TABLE(x86cpu, soc_thermal_ids);
++
++static int __init intel_soc_thermal_init(void)
++{
++ u32 tj_max;
++ int err = 0;
++ int i;
++ const struct x86_cpu_id *match_cpu;
++
++ match_cpu = x86_match_cpu(soc_thermal_ids);
++ if (!match_cpu)
++ return -ENODEV;
++
++ if (get_tj_max(&tj_max))
++ return -EINVAL;
++
++ for (i = 0; i < SOC_MAX_DTS_SENSORS; ++i) {
++ soc_dts[i] = alloc_soc_dts(i, tj_max);
++ if (IS_ERR(soc_dts[i])) {
++ err = PTR_ERR(soc_dts[i]);
++ goto err_free;
++ }
++ }
++
++ spin_lock_init(&intr_notify_lock);
++
++ soc_dts_thres_irq = (int)match_cpu->driver_data;
++
++ err = request_threaded_irq(soc_dts_thres_irq, NULL,
++ soc_irq_thread_fn,
++ IRQF_TRIGGER_RISING | IRQF_ONESHOT,
++ "soc_dts", soc_dts);
++ if (err) {
++ pr_err("request_threaded_irq ret %d\n", err);
++ goto err_free;
++ }
++
++ for (i = 0; i < SOC_MAX_DTS_SENSORS; ++i) {
++ err = update_trip_temp(soc_dts[i], 0, tj_max - crit_offset);
++ if (err)
++ goto err_trip_temp;
++ }
++
++ return 0;
++
++err_trip_temp:
++ i = SOC_MAX_DTS_SENSORS;
++ free_irq(soc_dts_thres_irq, soc_dts);
++err_free:
++ while (--i >= 0)
++ free_soc_dts(soc_dts[i]);
++
++ return err;
++}
++
++static void __exit intel_soc_thermal_exit(void)
++{
++ int i;
++
++ for (i = 0; i < SOC_MAX_DTS_SENSORS; ++i)
++ update_trip_temp(soc_dts[i], 0, 0);
++
++ free_irq(soc_dts_thres_irq, soc_dts);
++
++ for (i = 0; i < SOC_MAX_DTS_SENSORS; ++i)
++ free_soc_dts(soc_dts[i]);
++
++}
++
++module_init(intel_soc_thermal_init)
++module_exit(intel_soc_thermal_exit)
++
++MODULE_DESCRIPTION("Intel SoC DTS Thermal Driver");
++MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada at linux.intel.com>");
++MODULE_LICENSE("GPL v2");
+--
+1.7.7.6
+
--
1.9.1
More information about the linux-yocto
mailing list