On Fri, May 25, 2012 at 05:49:44PM +0200, Cousson Benoit wrote: > On 5/25/2012 10:25 AM, Eduardo Valentin wrote: > >In the System Control Module, OMAP supplies a voltage reference > >and a temperature sensor feature that are gathered in the band > >gap voltage and temperature sensor (VBGAPTS) module. The band > >gap provides current and voltage reference for its internal > >circuits and other analog IP blocks. The analog-to-digital > >converter (ADC) produces an output value that is proportional > >to the silicon temperature. > > > >This patch provides a platform driver which expose this feature. > >It is moduled as a MFD child of the System Control Module core > >MFD driver. > > > >This driver provides only APIs to access the device properties, > >like temperature, thresholds and update rate. > > > >Signed-off-by: Eduardo Valentin<eduardo.valentin@xxxxxx> > >Signed-off-by: Keerthy<j-keerthy@xxxxxx> > >--- > > .../devicetree/bindings/thermal/omap_bandgap.txt | 27 + > > drivers/thermal/Kconfig | 13 + > > drivers/thermal/Makefile | 4 +- > > drivers/thermal/omap-bandgap.c | 1601 ++++++++++++++++++++ > > drivers/thermal/omap-bandgap.h | 63 + > > 5 files changed, 1707 insertions(+), 1 deletions(-) > > create mode 100644 Documentation/devicetree/bindings/thermal/omap_bandgap.txt > > create mode 100644 drivers/thermal/omap-bandgap.c > > create mode 100644 drivers/thermal/omap-bandgap.h > > > >diff --git a/Documentation/devicetree/bindings/thermal/omap_bandgap.txt b/Documentation/devicetree/bindings/thermal/omap_bandgap.txt > >new file mode 100644 > >index 0000000..430bcf8 > >--- /dev/null > >+++ b/Documentation/devicetree/bindings/thermal/omap_bandgap.txt > >@@ -0,0 +1,27 @@ > >+* Texas Instrument OMAP SCM bandgap bindings > >+ > >+In the System Control Module, OMAP supplies a voltage reference > >+and a temperature sensor feature that are gathered in the band > >+gap voltage and temperature sensor (VBGAPTS) module. The band > >+gap provides current and voltage reference for its internal > >+circuits and other analog IP blocks. The analog-to-digital > >+converter (ADC) produces an output value that is proportional > >+to the silicon temperature. > >+ > >+Required properties: > >+- compatible : Should be: > >+ - "ti,omap4460-control-bandgap" : for OMAP4460 bandgap > >+ - "ti,omap5430-control-bandgap" : for OMAP5430 bandgap > >+- interrupts : this entry should indicate which interrupt line > >+the talert signal is routed to; > >+Specific: > >+- ti,tshut-gpio : this entry should be used to inform which GPIO > >+line the tshut signal is routed to; > >+ > >+Example: > >+ > >+bandgap { > >+ compatible = "ti,omap4460-control-bandgap"; > >+ interrupts =<0 126 4>; /* talert */ > >+ ti,tshut-gpio =<86>; > >+}; > >diff --git a/drivers/thermal/Kconfig b/drivers/thermal/Kconfig > >index 514a691..ffdd240 100644 > >--- a/drivers/thermal/Kconfig > >+++ b/drivers/thermal/Kconfig > >@@ -26,3 +26,16 @@ config SPEAR_THERMAL > > help > > Enable this to plug the SPEAr thermal sensor driver into the Linux > > thermal framework > >+ > >+config OMAP_BANDGAP > >+ tristate "Texas Instruments OMAP4+ temperature sensor driver" > >+ depends on THERMAL > >+ depends on MFD_OMAP_CONTROL > >+ help > >+ If you say yes here you get support for the Texas Instruments > >+ OMAP4460+ on die bandgap temperature sensor support. The register > >+ set is part of system control module. > >+ > >+ This includes alert interrupts generation and also the TSHUT > >+ support. > >+ > >diff --git a/drivers/thermal/Makefile b/drivers/thermal/Makefile > >index a9fff0b..5ff1af1 100644 > >--- a/drivers/thermal/Makefile > >+++ b/drivers/thermal/Makefile > >@@ -3,4 +3,6 @@ > > # > > > > obj-$(CONFIG_THERMAL) += thermal_sys.o > >-obj-$(CONFIG_SPEAR_THERMAL) += spear_thermal.o > >\ No newline at end of file > >+obj-$(CONFIG_SPEAR_THERMAL) += spear_thermal.o > >+obj-$(CONFIG_OMAP_BANDGAP) += omap-thermal.o > >+omap-thermal-y := omap-bandgap.o > >diff --git a/drivers/thermal/omap-bandgap.c b/drivers/thermal/omap-bandgap.c > >new file mode 100644 > >index 0000000..3d5a12b > >--- /dev/null > >+++ b/drivers/thermal/omap-bandgap.c > >@@ -0,0 +1,1601 @@ > >+/* > >+ * OMAP4 Bandgap temperature sensor driver > >+ * > >+ * Copyright (C) 2011-2012 Texas Instruments Incorporated - http://www.ti.com/ > >+ * Author: J Keerthy<j-keerthy@xxxxxx> > >+ * Author: Moiz Sonasath<m-sonasath@xxxxxx> > >+ * Couple of fixes, DT and MFD adaptation: > >+ * Eduardo Valentin<eduardo.valentin@xxxxxx> > >+ * > >+ * This program is free software; you can redistribute it and/or > >+ * modify it under the terms of the GNU General Public License > >+ * version 2 as published by the Free Software Foundation. > >+ * > >+ * This program is distributed in the hope that 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. > >+ * > >+ * You should have received a copy of the GNU General Public License > >+ * along with this program; if not, write to the Free Software > >+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA > >+ * 02110-1301 USA > >+ * > >+ */ > >+ > >+#include<linux/module.h> > >+#include<linux/export.h> > >+#include<linux/init.h> > >+#include<linux/kernel.h> > >+#include<linux/interrupt.h> > >+#include<linux/clk.h> > >+#include<linux/gpio.h> > >+#include<linux/platform_device.h> > >+#include<linux/err.h> > >+#include<linux/types.h> > >+#include<linux/mutex.h> > >+#include<linux/reboot.h> > >+#include<linux/of_platform.h> > >+#include<linux/of_irq.h> > >+#include<linux/mfd/omap_control.h> > >+ > >+#include<mach/control.h> > >+ > >+#include "omap-bandgap.h" > >+ > >+/* Offsets from the base of temperature sensor registers */ > >+ > >+#define OMAP4460_TEMP_SENSOR_CTRL_OFFSET 0x32C > >+#define OMAP4460_BGAP_CTRL_OFFSET 0x378 > >+#define OMAP4460_BGAP_COUNTER_OFFSET 0x37C > >+#define OMAP4460_BGAP_THRESHOLD_OFFSET 0x380 > >+#define OMAP4460_BGAP_TSHUT_OFFSET 0x384 > >+#define OMAP4460_BGAP_STATUS_OFFSET 0x388 > >+#define OMAP4460_FUSE_OPP_BGAP 0x260 > >+ > >+#define OMAP5430_TEMP_SENSOR_MPU_OFFSET 0x32C > >+#define OMAP5430_BGAP_CTRL_OFFSET 0x380 > >+#define OMAP5430_BGAP_COUNTER_MPU_OFFSET 0x39C > >+#define OMAP5430_BGAP_THRESHOLD_MPU_OFFSET 0x384 > >+#define OMAP5430_BGAP_TSHUT_MPU_OFFSET 0x390 > >+#define OMAP5430_BGAP_STATUS_OFFSET 0x3A8 > >+#define OMAP5430_FUSE_OPP_BGAP_MPU 0x1E4 > >+ > >+#define OMAP5430_TEMP_SENSOR_GPU_OFFSET 0x330 > >+#define OMAP5430_BGAP_COUNTER_GPU_OFFSET 0x3A0 > >+#define OMAP5430_BGAP_THRESHOLD_GPU_OFFSET 0x388 > >+#define OMAP5430_BGAP_TSHUT_GPU_OFFSET 0x394 > >+#define OMAP5430_FUSE_OPP_BGAP_GPU 0x1E0 > >+ > >+#define OMAP5430_TEMP_SENSOR_CORE_OFFSET 0x334 > >+#define OMAP5430_BGAP_COUNTER_CORE_OFFSET 0x3A4 > >+#define OMAP5430_BGAP_THRESHOLD_CORE_OFFSET 0x38C > >+#define OMAP5430_BGAP_TSHUT_CORE_OFFSET 0x398 > >+#define OMAP5430_FUSE_OPP_BGAP_CORE 0x1E8 > >+ > >+#define OMAP4460_TSHUT_HOT 900 /* 122 deg C */ > >+#define OMAP4460_TSHUT_COLD 895 /* 100 deg C */ > >+#define OMAP4460_T_HOT 800 /* 73 deg C */ > >+#define OMAP4460_T_COLD 795 /* 71 deg C */ > >+#define OMAP4460_MAX_FREQ 1500000 > >+#define OMAP4460_MIN_FREQ 1000000 > >+#define OMAP4460_MIN_TEMP -40000 > >+#define OMAP4460_MAX_TEMP 123000 > >+#define OMAP4460_HYST_VAL 5000 > >+#define OMAP4460_ADC_START_VALUE 530 > >+#define OMAP4460_ADC_END_VALUE 932 > >+ > >+#define OMAP5430_MPU_TSHUT_HOT 915 > >+#define OMAP5430_MPU_TSHUT_COLD 900 > >+#define OMAP5430_MPU_T_HOT 800 > >+#define OMAP5430_MPU_T_COLD 795 > >+#define OMAP5430_MPU_MAX_FREQ 1500000 > >+#define OMAP5430_MPU_MIN_FREQ 1000000 > >+#define OMAP5430_MPU_MIN_TEMP -40000 > >+#define OMAP5430_MPU_MAX_TEMP 125000 > >+#define OMAP5430_MPU_HYST_VAL 5000 > >+#define OMAP5430_ADC_START_VALUE 532 > >+#define OMAP5430_ADC_END_VALUE 934 > >+ > >+#define OMAP5430_GPU_TSHUT_HOT 915 > >+#define OMAP5430_GPU_TSHUT_COLD 900 > >+#define OMAP5430_GPU_T_HOT 800 > >+#define OMAP5430_GPU_T_COLD 795 > >+#define OMAP5430_GPU_MAX_FREQ 1500000 > >+#define OMAP5430_GPU_MIN_FREQ 1000000 > >+#define OMAP5430_GPU_MIN_TEMP -40000 > >+#define OMAP5430_GPU_MAX_TEMP 125000 > >+#define OMAP5430_GPU_HYST_VAL 5000 > >+ > >+#define OMAP5430_CORE_TSHUT_HOT 915 > >+#define OMAP5430_CORE_TSHUT_COLD 900 > >+#define OMAP5430_CORE_T_HOT 800 > >+#define OMAP5430_CORE_T_COLD 795 > >+#define OMAP5430_CORE_MAX_FREQ 1500000 > >+#define OMAP5430_CORE_MIN_FREQ 1000000 > >+#define OMAP5430_CORE_MIN_TEMP -40000 > >+#define OMAP5430_CORE_MAX_TEMP 125000 > >+#define OMAP5430_CORE_HYST_VAL 5000 > >+ > >+/** > >+ * The register offsets and bit fields might change across > >+ * OMAP versions hence populating them in this structure. > >+ */ > >+ > >+struct temp_sensor_registers { > >+ u32 temp_sensor_ctrl; > >+ u32 bgap_tempsoff_mask; > >+ u32 bgap_soc_mask; > >+ u32 bgap_eocz_mask; > >+ u32 bgap_dtemp_mask; > >+ > >+ u32 bgap_mask_ctrl; > >+ u32 mask_hot_mask; > >+ u32 mask_cold_mask; > >+ > >+ u32 bgap_mode_ctrl; > >+ u32 mode_ctrl_mask; > >+ > >+ u32 bgap_counter; > >+ u32 counter_mask; > >+ > >+ u32 bgap_threshold; > >+ u32 threshold_thot_mask; > >+ u32 threshold_tcold_mask; > >+ > >+ u32 tshut_threshold; > >+ u32 tshut_hot_mask; > >+ u32 tshut_cold_mask; > >+ > >+ u32 bgap_status; > >+ u32 status_clean_stop_mask; > >+ u32 status_bgap_alert_mask; > >+ u32 status_hot_mask; > >+ u32 status_cold_mask; > >+ > >+ u32 bgap_efuse; > >+}; > >+ > >+/** > >+ * The thresholds and limits for temperature sensors. > >+ */ > >+struct temp_sensor_data { > >+ u32 tshut_hot; > >+ u32 tshut_cold; > >+ u32 t_hot; > >+ u32 t_cold; > >+ u32 min_freq; > >+ u32 max_freq; > >+ int max_temp; > >+ int min_temp; > >+ int hyst_val; > >+ u32 adc_start_val; > >+ u32 adc_end_val; > >+ u32 update_int1; > >+ u32 update_int2; > >+}; > >+ > >+/** > >+ * struct temp_sensor_regval - temperature sensor register values > >+ * @bg_mode_ctrl: temp sensor control register value > >+ * @bg_ctrl: bandgap ctrl register value > >+ * @bg_counter: bandgap counter value > >+ * @bg_threshold: bandgap threshold register value > >+ * @tshut_threshold: bandgap tshut register value > >+ */ > >+struct temp_sensor_regval { > >+ u32 bg_mode_ctrl; > >+ u32 bg_ctrl; > >+ u32 bg_counter; > >+ u32 bg_threshold; > >+ u32 tshut_threshold; > >+}; > >+ > >+/** > >+ * struct omap_temp_sensor - bandgap temperature sensor platform data > >+ * @ts_data: pointer to struct with thresholds, limits of temperature sensor > >+ * @registers: pointer to the list of register offsets and bitfields > >+ * @regval: temperature sensor register values > >+ * @domain: the name of the domain where the sensor is located > >+ */ > >+struct omap_temp_sensor { > >+ struct temp_sensor_data *ts_data; > >+ struct temp_sensor_registers *registers; > >+ struct temp_sensor_regval *regval; > >+ char *domain; > >+}; > >+ > >+/** > >+ * struct omap_bandgap_data - bandgap platform data structure > >+ * @has_talert: indicates if the chip has talert output line > >+ * @has_tshut: indicates if the chip has tshut output line > >+ * @conv_table: Pointer to adc to temperature conversion table > >+ * @fclock_name: clock name of the functional clock > >+ * @div_ck_nme: clock name of the clock divisor > >+ * @sensor_count: count of temperature sensor device in scm > >+ * @sensors: array of sensors present in this bandgap instance > >+ * @expose_sensor: callback to export sensor to thermal API > >+ */ > >+struct omap_bandgap_data { > >+ bool has_talert; > >+ bool has_tshut; > >+ const int *conv_table; > >+ char *fclock_name; > >+ char *div_ck_name; > >+ int sensor_count; > >+ int (*report_temperature)(struct omap_bandgap *bg_ptr, int id); > >+ int (*expose_sensor)(struct omap_bandgap *bg_ptr, int id, char *domain); > >+ > >+ /* this needs to be at the end */ > >+ struct omap_temp_sensor sensors[]; > >+}; > >+ > >+/* TODO: provide data structures for 4430 */ > >+ > >+/* > >+ * OMAP4460 has one instance of thermal sensor for MPU > >+ * need to describe the individual bit fields > >+ */ > >+static struct temp_sensor_registers > >+omap4460_mpu_temp_sensor_registers = { > >+ .temp_sensor_ctrl = OMAP4460_TEMP_SENSOR_CTRL_OFFSET, > >+ .bgap_tempsoff_mask = OMAP4460_BGAP_TEMPSOFF_MASK, > >+ .bgap_soc_mask = OMAP4460_BGAP_TEMP_SENSOR_SOC_MASK, > >+ .bgap_eocz_mask = OMAP4460_BGAP_TEMP_SENSOR_EOCZ_MASK, > >+ .bgap_dtemp_mask = OMAP4460_BGAP_TEMP_SENSOR_DTEMP_MASK, > >+ > >+ .bgap_mask_ctrl = OMAP4460_BGAP_CTRL_OFFSET, > >+ .mask_hot_mask = OMAP4460_MASK_HOT_MASK, > >+ .mask_cold_mask = OMAP4460_MASK_COLD_MASK, > >+ > >+ .bgap_mode_ctrl = OMAP4460_BGAP_CTRL_OFFSET, > >+ .mode_ctrl_mask = OMAP4460_SINGLE_MODE_MASK, > >+ > >+ .bgap_counter = OMAP4460_BGAP_COUNTER_OFFSET, > >+ .counter_mask = OMAP4460_COUNTER_MASK, > >+ > >+ .bgap_threshold = OMAP4460_BGAP_THRESHOLD_OFFSET, > >+ .threshold_thot_mask = OMAP4460_T_HOT_MASK, > >+ .threshold_tcold_mask = OMAP4460_T_COLD_MASK, > >+ > >+ .tshut_threshold = OMAP4460_BGAP_TSHUT_OFFSET, > >+ .tshut_hot_mask = OMAP4460_TSHUT_HOT_MASK, > >+ .tshut_cold_mask = OMAP4460_TSHUT_COLD_MASK, > >+ > >+ .bgap_status = OMAP4460_BGAP_STATUS_OFFSET, > >+ .status_clean_stop_mask = OMAP4460_CLEAN_STOP_MASK, > >+ .status_bgap_alert_mask = OMAP4460_BGAP_ALERT_MASK, > >+ .status_hot_mask = OMAP4460_HOT_FLAG_MASK, > >+ .status_cold_mask = OMAP4460_COLD_FLAG_MASK, > >+ > >+ .bgap_efuse = OMAP4460_FUSE_OPP_BGAP, > >+}; > >+ > >+/* > >+ * OMAP4460 has one instance of thermal sensor for MPU > > Bad copy paste. > > >+ * need to describe the individual bit fields > >+ */ > >+static struct temp_sensor_registers > >+omap5430_mpu_temp_sensor_registers = { > >+ .temp_sensor_ctrl = OMAP5430_TEMP_SENSOR_MPU_OFFSET, > >+ .bgap_tempsoff_mask = OMAP5430_BGAP_TEMPSOFF_MASK, > >+ .bgap_soc_mask = OMAP5430_BGAP_TEMP_SENSOR_SOC_MASK, > >+ .bgap_eocz_mask = OMAP5430_BGAP_TEMP_SENSOR_EOCZ_MASK, > >+ .bgap_dtemp_mask = OMAP5430_BGAP_TEMP_SENSOR_DTEMP_MASK, > >+ > >+ .bgap_mask_ctrl = OMAP5430_BGAP_CTRL_OFFSET, > >+ .mask_hot_mask = OMAP5430_MASK_HOT_MPU_MASK, > >+ .mask_cold_mask = OMAP5430_MASK_COLD_MPU_MASK, > >+ > >+ .bgap_mode_ctrl = OMAP5430_BGAP_COUNTER_MPU_OFFSET, > >+ .mode_ctrl_mask = OMAP5430_REPEAT_MODE_MASK, > >+ > >+ .bgap_counter = OMAP5430_BGAP_COUNTER_MPU_OFFSET, > >+ .counter_mask = OMAP5430_COUNTER_MASK, > >+ > >+ .bgap_threshold = OMAP5430_BGAP_THRESHOLD_MPU_OFFSET, > >+ .threshold_thot_mask = OMAP5430_T_HOT_MASK, > >+ .threshold_tcold_mask = OMAP5430_T_COLD_MASK, > >+ > >+ .tshut_threshold = OMAP5430_BGAP_TSHUT_MPU_OFFSET, > >+ .tshut_hot_mask = OMAP5430_TSHUT_HOT_MASK, > >+ .tshut_cold_mask = OMAP5430_TSHUT_COLD_MASK, > >+ > >+ .bgap_status = OMAP5430_BGAP_STATUS_OFFSET, > >+ .status_clean_stop_mask = 0x0, > >+ .status_bgap_alert_mask = OMAP5430_BGAP_ALERT_MASK, > >+ .status_hot_mask = OMAP5430_HOT_MPU_FLAG_MASK, > >+ .status_cold_mask = OMAP5430_COLD_MPU_FLAG_MASK, > >+ > >+ .bgap_efuse = OMAP5430_FUSE_OPP_BGAP_MPU, > >+}; > >+ > >+/* > >+ * OMAP4460 has one instance of thermal sensor for MPU > >+ * need to describe the individual bit fields > >+ */ > > Ditto > > >+static struct temp_sensor_registers > >+omap5430_gpu_temp_sensor_registers = { > >+ .temp_sensor_ctrl = OMAP5430_TEMP_SENSOR_GPU_OFFSET, > >+ .bgap_tempsoff_mask = OMAP5430_BGAP_TEMPSOFF_MASK, > >+ .bgap_soc_mask = OMAP5430_BGAP_TEMP_SENSOR_SOC_MASK, > >+ .bgap_eocz_mask = OMAP5430_BGAP_TEMP_SENSOR_EOCZ_MASK, > >+ .bgap_dtemp_mask = OMAP5430_BGAP_TEMP_SENSOR_DTEMP_MASK, > >+ > >+ .bgap_mask_ctrl = OMAP5430_BGAP_CTRL_OFFSET, > >+ .mask_hot_mask = OMAP5430_MASK_HOT_MM_MASK, > >+ .mask_cold_mask = OMAP5430_MASK_COLD_MM_MASK, > >+ > >+ .bgap_mode_ctrl = OMAP5430_BGAP_COUNTER_GPU_OFFSET, > >+ .mode_ctrl_mask = OMAP5430_REPEAT_MODE_MASK, > >+ > >+ .bgap_counter = OMAP5430_BGAP_COUNTER_GPU_OFFSET, > >+ .counter_mask = OMAP5430_COUNTER_MASK, > >+ > >+ .bgap_threshold = OMAP5430_BGAP_THRESHOLD_GPU_OFFSET, > >+ .threshold_thot_mask = OMAP5430_T_HOT_MASK, > >+ .threshold_tcold_mask = OMAP5430_T_COLD_MASK, > >+ > >+ .tshut_threshold = OMAP5430_BGAP_TSHUT_GPU_OFFSET, > >+ .tshut_hot_mask = OMAP5430_TSHUT_HOT_MASK, > >+ .tshut_cold_mask = OMAP5430_TSHUT_COLD_MASK, > >+ > >+ .bgap_status = OMAP5430_BGAP_STATUS_OFFSET, > >+ .status_clean_stop_mask = 0x0, > >+ .status_bgap_alert_mask = OMAP5430_BGAP_ALERT_MASK, > >+ .status_hot_mask = OMAP5430_HOT_MM_FLAG_MASK, > >+ .status_cold_mask = OMAP5430_COLD_MM_FLAG_MASK, > >+ > >+ .bgap_efuse = OMAP5430_FUSE_OPP_BGAP_GPU, > >+}; > >+ > >+/* > >+ * OMAP4460 has one instance of thermal sensor for MPU > >+ * need to describe the individual bit fields > >+ */ > > Ditto > > >+static struct temp_sensor_registers > >+omap5430_core_temp_sensor_registers = { > >+ .temp_sensor_ctrl = OMAP5430_TEMP_SENSOR_CORE_OFFSET, > >+ .bgap_tempsoff_mask = OMAP5430_BGAP_TEMPSOFF_MASK, > >+ .bgap_soc_mask = OMAP5430_BGAP_TEMP_SENSOR_SOC_MASK, > >+ .bgap_eocz_mask = OMAP5430_BGAP_TEMP_SENSOR_EOCZ_MASK, > >+ .bgap_dtemp_mask = OMAP5430_BGAP_TEMP_SENSOR_DTEMP_MASK, > >+ > >+ .bgap_mask_ctrl = OMAP5430_BGAP_CTRL_OFFSET, > >+ .mask_hot_mask = OMAP5430_MASK_HOT_CORE_MASK, > >+ .mask_cold_mask = OMAP5430_MASK_COLD_CORE_MASK, > >+ > >+ .bgap_mode_ctrl = OMAP5430_BGAP_COUNTER_CORE_OFFSET, > >+ .mode_ctrl_mask = OMAP5430_REPEAT_MODE_MASK, > >+ > >+ .bgap_counter = OMAP5430_BGAP_COUNTER_CORE_OFFSET, > >+ .counter_mask = OMAP5430_COUNTER_MASK, > >+ > >+ .bgap_threshold = OMAP5430_BGAP_THRESHOLD_CORE_OFFSET, > >+ .threshold_thot_mask = OMAP5430_T_HOT_MASK, > >+ .threshold_tcold_mask = OMAP5430_T_COLD_MASK, > >+ > >+ .tshut_threshold = OMAP5430_BGAP_TSHUT_CORE_OFFSET, > >+ .tshut_hot_mask = OMAP5430_TSHUT_HOT_MASK, > >+ .tshut_cold_mask = OMAP5430_TSHUT_COLD_MASK, > >+ > >+ .bgap_status = OMAP5430_BGAP_STATUS_OFFSET, > >+ .status_clean_stop_mask = 0x0, > >+ .status_bgap_alert_mask = OMAP5430_BGAP_ALERT_MASK, > >+ .status_hot_mask = OMAP5430_HOT_CORE_FLAG_MASK, > >+ .status_cold_mask = OMAP5430_COLD_CORE_FLAG_MASK, > >+ > >+ .bgap_efuse = OMAP5430_FUSE_OPP_BGAP_CORE, > >+}; > >+ > >+/* Thresholds and limits for OMAP4460 MPU temperature sensor */ > >+static struct temp_sensor_data omap4460_mpu_temp_sensor_data = { > >+ .tshut_hot = OMAP4460_TSHUT_HOT, > >+ .tshut_cold = OMAP4460_TSHUT_COLD, > >+ .t_hot = OMAP4460_T_HOT, > >+ .t_cold = OMAP4460_T_COLD, > >+ .min_freq = OMAP4460_MIN_FREQ, > >+ .max_freq = OMAP4460_MAX_FREQ, > >+ .max_temp = OMAP4460_MAX_TEMP, > >+ .min_temp = OMAP4460_MIN_TEMP, > >+ .hyst_val = OMAP4460_HYST_VAL, > >+ .adc_start_val = OMAP4460_ADC_START_VALUE, > >+ .adc_end_val = OMAP4460_ADC_END_VALUE, > >+ .update_int1 = 1000, > >+ .update_int2 = 2000, > >+}; > >+ > >+/* Thresholds and limits for OMAP5430 MPU temperature sensor */ > >+static struct temp_sensor_data omap5430_mpu_temp_sensor_data = { > >+ .tshut_hot = OMAP5430_MPU_TSHUT_HOT, > >+ .tshut_cold = OMAP5430_MPU_TSHUT_COLD, > >+ .t_hot = OMAP5430_MPU_T_HOT, > >+ .t_cold = OMAP5430_MPU_T_COLD, > >+ .min_freq = OMAP5430_MPU_MIN_FREQ, > >+ .max_freq = OMAP5430_MPU_MAX_FREQ, > >+ .max_temp = OMAP5430_MPU_MAX_TEMP, > >+ .min_temp = OMAP5430_MPU_MIN_TEMP, > >+ .hyst_val = OMAP5430_MPU_HYST_VAL, > >+ .adc_start_val = OMAP5430_ADC_START_VALUE, > >+ .adc_end_val = OMAP5430_ADC_END_VALUE, > >+ .update_int1 = 1000, > >+ .update_int2 = 2000, > >+}; > >+ > >+/* Thresholds and limits for OMAP5430 GPU temperature sensor */ > >+static struct temp_sensor_data omap5430_gpu_temp_sensor_data = { > >+ .tshut_hot = OMAP5430_GPU_TSHUT_HOT, > >+ .tshut_cold = OMAP5430_GPU_TSHUT_COLD, > >+ .t_hot = OMAP5430_GPU_T_HOT, > >+ .t_cold = OMAP5430_GPU_T_COLD, > >+ .min_freq = OMAP5430_GPU_MIN_FREQ, > >+ .max_freq = OMAP5430_GPU_MAX_FREQ, > >+ .max_temp = OMAP5430_GPU_MAX_TEMP, > >+ .min_temp = OMAP5430_GPU_MIN_TEMP, > >+ .hyst_val = OMAP5430_GPU_HYST_VAL, > >+ .adc_start_val = OMAP5430_ADC_START_VALUE, > >+ .adc_end_val = OMAP5430_ADC_END_VALUE, > >+ .update_int1 = 1000, > >+ .update_int2 = 2000, > >+}; > >+ > >+/* Thresholds and limits for OMAP5430 CORE temperature sensor */ > >+static struct temp_sensor_data omap5430_core_temp_sensor_data = { > >+ .tshut_hot = OMAP5430_CORE_TSHUT_HOT, > >+ .tshut_cold = OMAP5430_CORE_TSHUT_COLD, > >+ .t_hot = OMAP5430_CORE_T_HOT, > >+ .t_cold = OMAP5430_CORE_T_COLD, > >+ .min_freq = OMAP5430_CORE_MIN_FREQ, > >+ .max_freq = OMAP5430_CORE_MAX_FREQ, > >+ .max_temp = OMAP5430_CORE_MAX_TEMP, > >+ .min_temp = OMAP5430_CORE_MIN_TEMP, > >+ .hyst_val = OMAP5430_CORE_HYST_VAL, > >+ .adc_start_val = OMAP5430_ADC_START_VALUE, > >+ .adc_end_val = OMAP5430_ADC_END_VALUE, > >+ .update_int1 = 1000, > >+ .update_int2 = 2000, > >+}; > >+ > >+/* > >+ * Temperature values in milli degree celsius > >+ * ADC code values from 530 to 923 > >+ */ > >+static const int > >+omap4460_adc_to_temp[OMAP4460_ADC_END_VALUE - OMAP4460_ADC_START_VALUE + 1] = { > >+ -40000, -40000, -40000, -40000, -39800, -39400, -39000, -38600, -38200, > >+ -37800, -37300, -36800, -36400, -36000, -35600, -35200, -34800, > >+ -34300, -33800, -33400, -33000, -32600, -32200, -31800, -31300, > >+ -30800, -30400, -30000, -29600, -29200, -28700, -28200, -27800, > >+ -27400, -27000, -26600, -26200, -25700, -25200, -24800, -24400, > >+ -24000, -23600, -23200, -22700, -22200, -21800, -21400, -21000, > >+ -20600, -20200, -19700, -19200, -18800, -18400, -18000, -17600, > >+ -17200, -16700, -16200, -15800, -15400, -15000, -14600, -14200, > >+ -13700, -13200, -12800, -12400, -12000, -11600, -11200, -10700, > >+ -10200, -9800, -9400, -9000, -8600, -8200, -7700, -7200, -6800, > >+ -6400, -6000, -5600, -5200, -4800, -4300, -3800, -3400, -3000, > >+ -2600, -2200, -1800, -1300, -800, -400, 0, 400, 800, 1200, 1600, > >+ 2100, 2600, 3000, 3400, 3800, 4200, 4600, 5100, 5600, 6000, 6400, > >+ 6800, 7200, 7600, 8000, 8500, 9000, 9400, 9800, 10200, 10600, 11000, > >+ 11400, 11900, 12400, 12800, 13200, 13600, 14000, 14400, 14800, > >+ 15300, 15800, 16200, 16600, 17000, 17400, 17800, 18200, 18700, > >+ 19200, 19600, 20000, 20400, 20800, 21200, 21600, 22100, 22600, > >+ 23000, 23400, 23800, 24200, 24600, 25000, 25400, 25900, 26400, > >+ 26800, 27200, 27600, 28000, 28400, 28800, 29300, 29800, 30200, > >+ 30600, 31000, 31400, 31800, 32200, 32600, 33100, 33600, 34000, > >+ 34400, 34800, 35200, 35600, 36000, 36400, 36800, 37300, 37800, > >+ 38200, 38600, 39000, 39400, 39800, 40200, 40600, 41100, 41600, > >+ 42000, 42400, 42800, 43200, 43600, 44000, 44400, 44800, 45300, > >+ 45800, 46200, 46600, 47000, 47400, 47800, 48200, 48600, 49000, > >+ 49500, 50000, 50400, 50800, 51200, 51600, 52000, 52400, 52800, > >+ 53200, 53700, 54200, 54600, 55000, 55400, 55800, 56200, 56600, > >+ 57000, 57400, 57800, 58200, 58700, 59200, 59600, 60000, 60400, > >+ 60800, 61200, 61600, 62000, 62400, 62800, 63300, 63800, 64200, > >+ 64600, 65000, 65400, 65800, 66200, 66600, 67000, 67400, 67800, > >+ 68200, 68700, 69200, 69600, 70000, 70400, 70800, 71200, 71600, > >+ 72000, 72400, 72800, 73200, 73600, 74100, 74600, 75000, 75400, > >+ 75800, 76200, 76600, 77000, 77400, 77800, 78200, 78600, 79000, > >+ 79400, 79800, 80300, 80800, 81200, 81600, 82000, 82400, 82800, > >+ 83200, 83600, 84000, 84400, 84800, 85200, 85600, 86000, 86400, > >+ 86800, 87300, 87800, 88200, 88600, 89000, 89400, 89800, 90200, > >+ 90600, 91000, 91400, 91800, 92200, 92600, 93000, 93400, 93800, > >+ 94200, 94600, 95000, 95500, 96000, 96400, 96800, 97200, 97600, > >+ 98000, 98400, 98800, 99200, 99600, 100000, 100400, 100800, 101200, > >+ 101600, 102000, 102400, 102800, 103200, 103600, 104000, 104400, > >+ 104800, 105200, 105600, 106100, 106600, 107000, 107400, 107800, > >+ 108200, 108600, 109000, 109400, 109800, 110200, 110600, 111000, > >+ 111400, 111800, 112200, 112600, 113000, 113400, 113800, 114200, > >+ 114600, 115000, 115400, 115800, 116200, 116600, 117000, 117400, > >+ 117800, 118200, 118600, 119000, 119400, 119800, 120200, 120600, > >+ 121000, 121400, 121800, 122200, 122600, 123000, 123400, 123800, 124200, > >+ 124600, 124900, 125000, 125000, 125000, 125000 > >+}; > >+ > >+static const int > >+omap5430_adc_to_temp[OMAP5430_ADC_END_VALUE - OMAP5430_ADC_START_VALUE + 1] = { > >+ -40000, -40000, -40000, -40000, -39800, -39400, -39000, -38600, > >+ -38200, -37800, -37300, -36800, > >+ -36400, -36000, -35600, -35200, -34800, -34300, -33800, -33400, -33000, > >+ -32600, > >+ -32200, -31800, -31300, -30800, -30400, -30000, -29600, -29200, -28700, > >+ -28200, -27800, -27400, -27000, -26600, -26200, -25700, -25200, -24800, > >+ -24400, -24000, -23600, -23200, -22700, -22200, -21800, -21400, -21000, > >+ -20600, -20200, -19700, -19200, -9300, -18400, -18000, -17600, -17200, > >+ -16700, -16200, -15800, -15400, -15000, -14600, -14200, -13700, -13200, > >+ -12800, -12400, -12000, -11600, -11200, -10700, -10200, -9800, -9400, > >+ -9000, > >+ -8600, -8200, -7700, -7200, -6800, -6400, -6000, -5600, -5200, -4800, > >+ -4300, > >+ -3800, -3400, -3000, -2600, -2200, -1800, -1300, -800, -400, 0, 400, > >+ 800, > >+ 1200, 1600, 2100, 2600, 3000, 3400, 3800, 4200, 4600, 5100, 5600, 6000, > >+ 6400, 6800, 7200, 7600, 8000, 8500, 9000, 9400, 9800, 10200, 10800, > >+ 11100, > >+ 11400, 11900, 12400, 12800, 13200, 13600, 14000, 14400, 14800, 15300, > >+ 15800, > >+ 16200, 16600, 17000, 17400, 17800, 18200, 18700, 19200, 19600, 20000, > >+ 20400, > >+ 20800, 21200, 21600, 22100, 22600, 23000, 23400, 23800, 24200, 24600, > >+ 25000, > >+ 25400, 25900, 26400, 26800, 27200, 27600, 28000, 28400, 28800, 29300, > >+ 29800, > >+ 30200, 30600, 31000, 31400, 31800, 32200, 32600, 33100, 33600, 34000, > >+ 34400, > >+ 34800, 35200, 35600, 36000, 36400, 36800, 37300, 37800, 38200, 38600, > >+ 39000, > >+ 39400, 39800, 40200, 40600, 41100, 41600, 42000, 42400, 42800, 43200, > >+ 43600, > >+ 44000, 44400, 44800, 45300, 45800, 46200, 46600, 47000, 47400, 47800, > >+ 48200, > >+ 48600, 49000, 49500, 50000, 50400, 50800, 51200, 51600, 52000, 52400, > >+ 52800, > >+ 53200, 53700, 54200, 54600, 55000, 55400, 55800, 56200, 56600, 57000, > >+ 57400, > >+ 57800, 58200, 58700, 59200, 59600, 60000, 60400, 60800, 61200, 61600, > >+ 62000, > >+ 62400, 62800, 63300, 63800, 64200, 64600, 65000, 65400, 65800, 66200, > >+ 66600, > >+ 67000, 67400, 67800, 68200, 68700, 69200, 69600, 70000, 70400, 70800, > >+ 71200, > >+ 71600, 72000, 72400, 72800, 73200, 73600, 74100, 74600, 75000, 75400, > >+ 75800, > >+ 76200, 76600, 77000, 77400, 77800, 78200, 78600, 79000, 79400, 79800, > >+ 80300, > >+ 80800, 81200, 81600, 82000, 82400, 82800, 83200, 83600, 84000, 84400, > >+ 84800, > >+ 85200, 85600, 86000, 86400, 86800, 87300, 87800, 88200, 88600, 89000, > >+ 89400, > >+ 89800, 90200, 90600, 91000, 91400, 91800, 92200, 92600, 93000, 93400, > >+ 93800, > >+ 94200, 94600, 95000, 95500, 96000, 96400, 96800, 97200, 97600, 98000, > >+ 98400, > >+ 98800, 99200, 99600, 100000, 100400, 100800, 101200, 101600, 102000, > >+ 102400, > >+ 102800, 103200, 103600, 104000, 104400, 104800, 105200, 105600, 106100, > >+ 106600, 107000, 107400, 107800, 108200, 108600, 109000, 109400, 109800, > >+ 110200, 110600, 111000, 111400, 111800, 112200, 112600, 113000, 113400, > >+ 113800, 114200, 114600, 115000, 115400, 115800, 116200, 116600, 117000, > >+ 117400, 117800, 118200, 118600, 119000, 119400, 119800, 120200, 120600, > >+ 121000, 121400, 121800, 122200, 122600, 123000, 123400, 123800, 124200, > >+ 124600, 124900, 125000, 125000, 125000, 125000, > >+}; > > It might be good to store the per SoC data in dedicated files or at > least put some #ifdef around to avoid wasting memory for a non-multi > OMAP boot. Indeed, I was rewriting this stuff with that in mind when I saw your comment :-) Idea is to move all this arch dependent data structures to specific files. Here at omap-bandgap.c we would have essentially the pdriver and the local functions and APIs. The omapX-thermal.c would contain the specific data structures and the functions related to the thermal zones, and possibly the policy specifics for each case. Something like: drivers/thermal/ |- omap-bandgap.c: Bandgap platform driver specific functions and APIs (CONFIG_OMAP_BANDGAP) |- omap-bandgap.h: Common data structure definition and defines |- omap4-thermal.c: OMAP4xx data structures needed by the bandgap driver and the thermal zone definitions (CONFIG_OMAP4_THERMAL) |- omap5-thermal.c: OMAP54xx data structures needed by the bandgap driver and the thermal zone definitions (CONFIG_OMAP5_THERMAL) |- omap-thermal.ko: Module binary. It would contain the support depending on what has been selected at compile time > filename: omap-thermal.ko author: Texas Instrument Inc. alias: platform:omap-bandgap license: GPL v2 description: OMAP4+ bandgap temperature sensor driver srcversion: 937A9F9230A5025A0E9A268 alias: of:N*T*Cti,omap4460-bandgap* alias: of:N*T*Cti,omap5430-bandgap* depends: intree: Y vermagic: 3.4.0-rc6-12199-g3e31a0c-dirty SMP preempt mod_unload modversions ARMv7 p2v8 There is gonna happen some ifdefery in omap-bandgap.[c,h] in order to compose the match_id table based on what has been selected for compilation, but I at least don't see any other way around. > >+ > >+static irqreturn_t talert_irq_handler(int irq, void *data) > >+{ > >+ struct omap_bandgap *bg_ptr = data; > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 t_hot = 0, t_cold = 0, temp, ctrl; > >+ int i, r; > >+ > >+ bg_ptr = data; > >+ /* Read the status of t_hot */ > >+ for (i = 0; i< bg_ptr->pdata->sensor_count; i++) { > >+ tsr = bg_ptr->pdata->sensors[i].registers; > >+ r = omap_control_readl(cdev, tsr->bgap_status,&t_hot); > >+ t_hot&= tsr->status_hot_mask; > >+ > >+ /* Read the status of t_cold */ > >+ r |= omap_control_readl(cdev, tsr->bgap_status,&t_cold); > >+ t_cold&= tsr->status_cold_mask; > >+ > >+ if (!t_cold&& !t_hot) > >+ continue; > >+ > >+ r |= omap_control_readl(cdev, tsr->bgap_mask_ctrl,&ctrl); > >+ /* > >+ * One TALERT interrupt: Two sources > >+ * If the interrupt is due to t_hot then mask t_hot and > >+ * and unmask t_cold else mask t_cold and unmask t_hot > >+ */ > >+ if (t_hot) { > >+ ctrl&= ~tsr->mask_hot_mask; > >+ ctrl |= tsr->mask_cold_mask; > >+ } else if (t_cold) { > >+ ctrl&= ~tsr->mask_cold_mask; > >+ ctrl |= tsr->mask_hot_mask; > >+ } > >+ > >+ r |= omap_control_writel(cdev, ctrl, tsr->bgap_mask_ctrl); > >+ > >+ if (r) { > >+ dev_err(bg_ptr->dev, "failed to ack talert interrupt\n"); > >+ return IRQ_NONE; > >+ } > >+ > >+ /* read temperature */ > >+ r = omap_control_readl(cdev, tsr->temp_sensor_ctrl,&temp); > >+ temp&= tsr->bgap_dtemp_mask; > >+ > >+ /* report temperature to whom may concern */ > >+ if (bg_ptr->pdata->report_temperature) > >+ bg_ptr->pdata->report_temperature(bg_ptr, i); > >+ } > >+ > >+ return IRQ_HANDLED; > >+} > >+ > >+static irqreturn_t omap_bandgap_tshut_irq_handler(int irq, void *data) > >+{ > >+ orderly_poweroff(true); > >+ > >+ return IRQ_HANDLED; > >+} > >+ > >+static > >+int adc_to_temp_conversion(struct omap_bandgap *bg_ptr, int id, int adc_val, > >+ int *t) > >+{ > >+ struct temp_sensor_data *ts_data = bg_ptr->pdata->sensors[id].ts_data; > >+ > >+ /* look up for temperature in the table and return the temperature */ > >+ if (adc_val< ts_data->adc_start_val || adc_val> ts_data->adc_end_val) > >+ return -ERANGE; > >+ > >+ *t = bg_ptr->conv_table[adc_val - ts_data->adc_start_val]; > >+ > >+ return 0; > >+} > >+ > >+static int temp_to_adc_conversion(long temp, struct omap_bandgap *bg_ptr, int i, > >+ int *adc) > >+{ > >+ struct temp_sensor_data *ts_data = bg_ptr->pdata->sensors[i].ts_data; > >+ int high, low, mid; > >+ > >+ low = 0; > >+ high = ts_data->adc_end_val - ts_data->adc_start_val; > >+ mid = (high + low) / 2; > >+ > >+ if (temp< bg_ptr->conv_table[high] || temp> bg_ptr->conv_table[high]) > >+ return -EINVAL; > >+ > >+ while (low< high) { > >+ if (temp< bg_ptr->conv_table[mid]) > >+ high = mid - 1; > >+ else > >+ low = mid + 1; > >+ mid = (low + high) / 2; > >+ } > >+ > >+ *adc = ts_data->adc_start_val + low; > >+ > >+ return 0; > >+} > >+ > >+static int temp_sensor_unmask_interrupts(struct omap_bandgap *bg_ptr, int id, > >+ u32 t_hot, u32 t_cold) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 temp, reg_val; > >+ int err; > >+ > >+ /* Read the current on die temperature */ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ err = omap_control_readl(cdev, tsr->temp_sensor_ctrl,&temp); > >+ temp&= tsr->bgap_dtemp_mask; > >+ > >+ err |= omap_control_readl(cdev, tsr->bgap_mask_ctrl,®_val); > >+ if (temp< t_hot) > >+ reg_val |= tsr->mask_hot_mask; > >+ else > >+ reg_val&= ~tsr->mask_hot_mask; > >+ > >+ if (t_cold< temp) > >+ reg_val |= tsr->mask_cold_mask; > >+ else > >+ reg_val&= ~tsr->mask_cold_mask; > >+ err |= omap_control_writel(cdev, reg_val, tsr->bgap_mask_ctrl); > >+ > >+ if (err) { > >+ dev_err(bg_ptr->dev, "failed to unmask interrupts\n"); > >+ return -EIO; > >+ } > >+ > >+ return 0; > >+} > >+ > >+static > >+int add_hyst(int adc_val, int hyst_val, struct omap_bandgap *bg_ptr, int i, > >+ u32 *sum) > >+{ > >+ int temp, ret; > >+ > >+ ret = adc_to_temp_conversion(bg_ptr, i, adc_val,&temp); > >+ if (ret< 0) > >+ return ret; > >+ > >+ temp += hyst_val; > >+ > >+ return temp_to_adc_conversion(temp, bg_ptr, i, sum); > >+} > >+ > >+static > >+int temp_sensor_configure_thot(struct omap_bandgap *bg_ptr, int id, int t_hot) > >+{ > >+ struct temp_sensor_data *ts_data = bg_ptr->pdata->sensors[id].ts_data; > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 thresh_val, reg_val; > >+ int cold, err; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ > >+ /* obtain the T cold value */ > >+ err = omap_control_readl(cdev, tsr->bgap_threshold,&thresh_val); > >+ cold = (thresh_val& tsr->threshold_tcold_mask)>> > >+ __ffs(tsr->threshold_tcold_mask); > >+ if (t_hot<= cold) { > >+ /* change the t_cold to t_hot - 5000 millidegrees */ > >+ err |= add_hyst(t_hot, -ts_data->hyst_val, bg_ptr, id,&cold); > >+ /* write the new t_cold value */ > >+ reg_val = thresh_val& (~tsr->threshold_tcold_mask); > >+ reg_val |= cold<< __ffs(tsr->threshold_tcold_mask); > >+ err |= omap_control_writel(cdev, reg_val, tsr->bgap_threshold); > >+ thresh_val = reg_val; > >+ } > >+ > >+ /* write the new t_hot value */ > >+ reg_val = thresh_val& ~tsr->threshold_thot_mask; > >+ reg_val |= (t_hot<< __ffs(tsr->threshold_thot_mask)); > >+ err |= omap_control_writel(cdev, reg_val, tsr->bgap_threshold); > >+ if (err) { > >+ dev_err(bg_ptr->dev, "failed to reprogram thot threshold\n"); > >+ return -EIO; > >+ } > >+ > >+ return temp_sensor_unmask_interrupts(bg_ptr, id, t_hot, cold); > >+} > >+ > >+static > >+int temp_sensor_init_talert_thresholds(struct omap_bandgap *bg_ptr, int id, > >+ int t_hot, int t_cold) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 reg_val, thresh_val; > >+ int err; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ err = omap_control_readl(cdev, tsr->bgap_threshold,&thresh_val); > >+ > >+ /* write the new t_cold value */ > >+ reg_val = thresh_val& ~tsr->threshold_tcold_mask; > >+ reg_val |= (t_cold<< __ffs(tsr->threshold_tcold_mask)); > >+ err |= omap_control_writel(cdev, reg_val, tsr->bgap_threshold); > >+ if (err) { > >+ dev_err(bg_ptr->dev, "failed to reprogram tcold threshold\n"); > >+ return -EIO; > >+ } > >+ > >+ err = omap_control_readl(cdev, tsr->bgap_threshold,&thresh_val); > >+ > >+ /* write the new t_hot value */ > >+ reg_val = thresh_val& ~tsr->threshold_thot_mask; > >+ reg_val |= (t_hot<< __ffs(tsr->threshold_thot_mask)); > >+ err |= omap_control_writel(cdev, reg_val, tsr->bgap_threshold); > >+ if (err) { > >+ dev_err(bg_ptr->dev, "failed to reprogram thot threshold\n"); > >+ return -EIO; > >+ } > >+ > >+ err = omap_control_readl(cdev, tsr->bgap_mask_ctrl,®_val); > >+ reg_val |= tsr->mask_hot_mask; > >+ reg_val |= tsr->mask_cold_mask; > >+ err |= omap_control_writel(cdev, reg_val, tsr->bgap_mask_ctrl); > >+ if (err) { > >+ dev_err(bg_ptr->dev, "failed to reprogram thot threshold\n"); > >+ return -EIO; > >+ } > >+ > >+ return err; > >+} > >+ > >+static > >+int temp_sensor_configure_tcold(struct omap_bandgap *bg_ptr, int id, > >+ int t_cold) > >+{ > >+ struct temp_sensor_data *ts_data = bg_ptr->pdata->sensors[id].ts_data; > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 thresh_val, reg_val; > >+ int hot, err; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ /* obtain the T cold value */ > >+ err = omap_control_readl(cdev, tsr->bgap_threshold,&thresh_val); > >+ hot = (thresh_val& tsr->threshold_thot_mask)>> > >+ __ffs(tsr->threshold_thot_mask); > >+ > >+ if (t_cold>= hot) { > >+ /* change the t_hot to t_cold + 5000 millidegrees */ > >+ err |= add_hyst(t_cold, ts_data->hyst_val, bg_ptr, id,&hot); > >+ /* write the new t_hot value */ > >+ reg_val = thresh_val& (~tsr->threshold_thot_mask); > >+ reg_val |= hot<< __ffs(tsr->threshold_thot_mask); > >+ err |= omap_control_writel(cdev, reg_val, tsr->bgap_threshold); > >+ thresh_val = reg_val; > >+ } > >+ > >+ /* write the new t_cold value */ > >+ reg_val = thresh_val& ~tsr->threshold_tcold_mask; > >+ reg_val |= (t_cold<< __ffs(tsr->threshold_tcold_mask)); > >+ err |= omap_control_writel(cdev, reg_val, tsr->bgap_threshold); > >+ if (err) { > >+ dev_err(bg_ptr->dev, "failed to reprogram tcold threshold\n"); > >+ return -EIO; > >+ } > >+ > >+ return temp_sensor_unmask_interrupts(bg_ptr, id, hot, t_cold); > >+} > >+ > >+static int temp_sensor_configure_tshut_hot(struct omap_bandgap *bg_ptr, > >+ int id, int tshut_hot) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 reg_val; > >+ int err; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ err = omap_control_readl(cdev, tsr->tshut_threshold,®_val); > >+ reg_val&= ~tsr->tshut_hot_mask; > >+ reg_val |= tshut_hot<< __ffs(tsr->tshut_hot_mask); > >+ err |= omap_control_writel(cdev, reg_val, tsr->tshut_threshold); > >+ if (err) { > >+ dev_err(bg_ptr->dev, "failed to reprogram tshut thot\n"); > >+ return -EIO; > >+ } > >+ > >+ return 0; > >+} > >+ > >+static int temp_sensor_configure_tshut_cold(struct omap_bandgap *bg_ptr, > >+ int id, int tshut_cold) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 reg_val; > >+ int err; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ err = omap_control_readl(cdev, tsr->tshut_threshold,®_val); > >+ reg_val&= ~tsr->tshut_cold_mask; > >+ reg_val |= tshut_cold<< __ffs(tsr->tshut_cold_mask); > >+ err |= omap_control_writel(cdev, reg_val, tsr->tshut_threshold); > >+ if (err) { > >+ dev_err(bg_ptr->dev, "failed to reprogram tshut tcold\n"); > >+ return -EIO; > >+ } > >+ > >+ return 0; > >+} > >+ > >+static int configure_temp_sensor_counter(struct omap_bandgap *bg_ptr, int id, > >+ u32 counter) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 val; > >+ int err; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ err = omap_control_readl(cdev, tsr->bgap_counter,&val); > >+ val&= ~tsr->counter_mask; > >+ val |= counter<< __ffs(tsr->counter_mask); > >+ err |= omap_control_writel(cdev, val, tsr->bgap_counter); > >+ if (err) { > >+ dev_err(bg_ptr->dev, "failed to reprogram tshut tcold\n"); > >+ return -EIO; > >+ } > >+ > >+ return 0; > >+} > >+ > >+/* Exposed APIs */ > >+/** > >+ * omap_bandgap_read_thot() - reads sensor current thot > >+ * @bg_ptr - pointer to bandgap instance > >+ * @id - sensor id > >+ * @thot - resulting current thot value > >+ * > >+ * returns 0 on success or the proper error code > >+ */ > >+int omap_bandgap_read_thot(struct omap_bandgap *bg_ptr, int id, > >+ int *thot) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 temp; > >+ int ret; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ ret = omap_control_readl(cdev, tsr->bgap_threshold,&temp); > >+ temp = (temp& tsr->threshold_thot_mask)>> > >+ __ffs(tsr->threshold_thot_mask); > >+ ret |= adc_to_temp_conversion(bg_ptr, id, temp,&temp); > >+ if (ret) { > >+ dev_err(bg_ptr->dev, "failed to read thot\n"); > >+ return -EIO; > >+ } > >+ > >+ *thot = temp; > >+ > >+ return 0; > >+} > >+ > >+/** > >+ * omap_bandgap_write_thot() - sets sensor current thot > >+ * @bg_ptr - pointer to bandgap instance > >+ * @id - sensor id > >+ * @val - desired thot value > >+ * > >+ * returns 0 on success or the proper error code > >+ */ > >+int omap_bandgap_write_thot(struct omap_bandgap *bg_ptr, int id, int val) > >+{ > >+ struct temp_sensor_data *ts_data = bg_ptr->pdata->sensors[id].ts_data; > >+ struct temp_sensor_registers *tsr; > >+ u32 t_hot; > >+ int ret; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ > >+ if (val< ts_data->min_temp + ts_data->hyst_val) > >+ return -EINVAL; > >+ ret = temp_to_adc_conversion(val, bg_ptr, id,&t_hot); > >+ if (ret< 0) > >+ return ret; > >+ > >+ mutex_lock(&bg_ptr->bg_mutex); > >+ temp_sensor_configure_thot(bg_ptr, id, t_hot); > >+ mutex_unlock(&bg_ptr->bg_mutex); > >+ > >+ return 0; > >+} > >+ > >+/** > >+ * omap_bandgap_read_tcold() - reads sensor current tcold > >+ * @bg_ptr - pointer to bandgap instance > >+ * @id - sensor id > >+ * @tcold - resulting current tcold value > >+ * > >+ * returns 0 on success or the proper error code > >+ */ > >+int omap_bandgap_read_tcold(struct omap_bandgap *bg_ptr, int id, > >+ int *tcold) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 temp; > >+ int ret; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ ret = omap_control_readl(cdev, tsr->bgap_threshold,&temp); > >+ temp = (temp& tsr->threshold_tcold_mask) > >+ >> __ffs(tsr->threshold_tcold_mask); > >+ ret |= adc_to_temp_conversion(bg_ptr, id, temp,&temp); > >+ if (ret) > >+ return -EIO; > >+ > >+ *tcold = temp; > >+ > >+ return 0; > >+} > >+ > >+/** > >+ * omap_bandgap_write_tcold() - sets the sensor tcold > >+ * @bg_ptr - pointer to bandgap instance > >+ * @id - sensor id > >+ * @val - desired tcold value > >+ * > >+ * returns 0 on success or the proper error code > >+ */ > >+int omap_bandgap_write_tcold(struct omap_bandgap *bg_ptr, int id, int val) > >+{ > >+ struct temp_sensor_data *ts_data = bg_ptr->pdata->sensors[id].ts_data; > >+ struct temp_sensor_registers *tsr; > >+ u32 t_cold; > >+ int ret; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ if (val> ts_data->max_temp + ts_data->hyst_val) > >+ return -EINVAL; > >+ > >+ ret = temp_to_adc_conversion(val, bg_ptr, id,&t_cold); > >+ if (ret< 0) > >+ return ret; > >+ > >+ mutex_lock(&bg_ptr->bg_mutex); > >+ temp_sensor_configure_tcold(bg_ptr, id, t_cold); > >+ mutex_unlock(&bg_ptr->bg_mutex); > >+ > >+ return 0; > >+} > >+ > >+/** > >+ * omap_bandgap_read_update_interval() - read the sensor update interval > >+ * @bg_ptr - pointer to bandgap instance > >+ * @id - sensor id > >+ * @interval - resulting update interval in miliseconds > >+ * > >+ * returns 0 on success or the proper error code > >+ */ > >+int omap_bandgap_read_update_interval(struct omap_bandgap *bg_ptr, int id, > >+ int *interval) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 time; > >+ int ret; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ ret = omap_control_readl(cdev, tsr->bgap_counter,&time); > >+ if (ret) > >+ return ret; > >+ time = (time& tsr->counter_mask)>> __ffs(tsr->counter_mask); > >+ time = time * 1000 / bg_ptr->clk_rate; > >+ > >+ *interval = time; > >+ > >+ return 0; > >+} > >+ > >+/** > >+ * omap_bandgap_write_update_interval() - set the update interval > >+ * @bg_ptr - pointer to bandgap instance > >+ * @id - sensor id > >+ * @interval - desired update interval in miliseconds > >+ * > >+ * returns 0 on success or the proper error code > >+ */ > >+int omap_bandgap_write_update_interval(struct omap_bandgap *bg_ptr, > >+ int id, u32 interval) > >+{ > >+ interval = interval * bg_ptr->clk_rate / 1000; > >+ mutex_lock(&bg_ptr->bg_mutex); > >+ configure_temp_sensor_counter(bg_ptr, id, interval); > >+ mutex_unlock(&bg_ptr->bg_mutex); > >+ > >+ return 0; > >+} > >+ > >+/** > >+ * omap_bandgap_read_temperature() - report current temperature > >+ * @bg_ptr - pointer to bandgap instance > >+ * @id - sensor id > >+ * @temperature - resulting temperature > >+ * > >+ * returns 0 on success or the proper error code > >+ */ > >+int omap_bandgap_read_temperature(struct omap_bandgap *bg_ptr, int id, > >+ int *temperature) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 temp; > >+ int ret; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ ret = omap_control_readl(cdev, tsr->temp_sensor_ctrl,&temp); > >+ temp&= tsr->bgap_dtemp_mask; > >+ > >+ ret |= adc_to_temp_conversion(bg_ptr, id, temp,&temp); > >+ if (ret) > >+ return -EIO; > >+ > >+ *temperature = temp; > >+ > >+ return 0; > >+} > >+ > >+/** > >+ * enable_continuous_mode() - One time enabling of continuous conversion mode > >+ * @bg_ptr - pointer to scm instance > >+ */ > >+static int enable_continuous_mode(struct omap_bandgap *bg_ptr) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ int i, r; > >+ u32 val; > >+ > >+ for (i = 0; i< bg_ptr->pdata->sensor_count; i++) { > >+ tsr = bg_ptr->pdata->sensors[i].registers; > >+ r = omap_control_readl(cdev, tsr->bgap_mode_ctrl,&val); > >+ val |= 1<< __ffs(tsr->mode_ctrl_mask); > >+ r |= omap_control_writel(cdev, val, tsr->bgap_mode_ctrl); > >+ if (r) > >+ dev_err(bg_ptr->dev, "could not save sensor %d\n", i); > >+ } > >+ > >+ return r ? -EIO : 0; > >+} > >+ > >+static int omap_bandgap_tshut_init(struct omap_bandgap *bg_ptr, > >+ struct platform_device *pdev) > >+{ > >+ int gpio_nr = bg_ptr->tshut_gpio; > >+ int status; > >+ > >+ /* Request for gpio_86 line */ > >+ status = gpio_request(gpio_nr, "tshut"); > >+ if (status< 0) { > >+ dev_err(bg_ptr->dev, > >+ "Could not request for TSHUT GPIO:%i\n", 86); > >+ return status; > >+ } > >+ status = gpio_direction_input(gpio_nr); > >+ if (status) { > >+ dev_err(bg_ptr->dev, > >+ "Cannot set input TSHUT GPIO %d\n", gpio_nr); > >+ return status; > >+ } > >+ > >+ status = request_irq(gpio_to_irq(gpio_nr), > >+ omap_bandgap_tshut_irq_handler, > >+ IRQF_TRIGGER_RISING, "tshut", > >+ NULL); > >+ if (status) { > >+ gpio_free(gpio_nr); > >+ dev_err(bg_ptr->dev, "request irq failed for TSHUT"); > >+ } > >+ > >+ return 0; > >+} > >+ > >+static int omap_bandgap_talert_init(struct omap_bandgap *bg_ptr, > >+ struct platform_device *pdev) > >+{ > >+ int ret; > >+ > >+ bg_ptr->irq = platform_get_irq(pdev, 0); > >+ if (bg_ptr->irq< 0) { > >+ dev_err(&pdev->dev, "get_irq failed\n"); > >+ return bg_ptr->irq; > >+ } > >+ ret = request_threaded_irq(bg_ptr->irq, NULL, > >+ talert_irq_handler, > >+ IRQF_TRIGGER_HIGH | IRQF_ONESHOT, > >+ "talert", bg_ptr); > >+ if (ret) { > >+ dev_err(&pdev->dev, "Request threaded irq failed.\n"); > >+ return ret; > >+ } > >+ > >+ return 0; > >+} > >+ > >+static const struct omap_bandgap_data omap4460_data = { > >+ .has_talert = true, > >+ .has_tshut = true, > >+ .fclock_name = "bandgap_ts_fclk", > >+ .div_ck_name = "div_ts_ck", > > None of these clock data should be there ideally. You should ensure > that the proper device alias will be there using clkdev entries. > > Except that with DT, it will not work without the clock DT binding :-( > > I think Rob posted a latest update based on CCF... but for the > moment we are stuck :-( > > >+ .conv_table = omap4460_adc_to_temp, > >+ .sensors = { > >+ { > >+ .registers =&omap4460_mpu_temp_sensor_registers, > >+ .ts_data =&omap4460_mpu_temp_sensor_data, > >+ .domain = "cpu", > >+ }, > >+ }, > >+ .sensor_count = 1, > >+}; > >+ > >+static const struct omap_bandgap_data omap5430_data = { > >+ .has_talert = true, > >+ .has_tshut = true, > >+ .fclock_name = "ts_clk_div_ck", > >+ .div_ck_name = "ts_clk_div_ck", > >+ .conv_table = omap5430_adc_to_temp, > >+ .sensors = { > >+ { > >+ .registers =&omap5430_mpu_temp_sensor_registers, > >+ .ts_data =&omap5430_mpu_temp_sensor_data, > >+ .domain = "cpu", > >+ }, > >+ { > >+ .registers =&omap5430_gpu_temp_sensor_registers, > >+ .ts_data =&omap5430_gpu_temp_sensor_data, > >+ .domain = "gpu", > >+ }, > >+ { > >+ .registers =&omap5430_core_temp_sensor_registers, > >+ .ts_data =&omap5430_core_temp_sensor_data, > >+ .domain = "core", > >+ }, > >+ }, > >+ .sensor_count = 3, > > It can probably be replaced by a sizeof. > > >+}; > >+ > >+static const struct of_device_id of_omap_bandgap_match[] = { > >+ /* > >+ * TODO: Add support to 4430 > >+ * { .compatible = "ti,omap4430-bandgap", .data = , }, > >+ */ > >+ { > >+ .compatible = "ti,omap4460-bandgap", > >+ .data = (void *)&omap4460_data, > > No need to cast toward a void *. > > >+ }, > >+ { > >+ .compatible = "ti,omap5430-bandgap", > >+ .data = (void *)&omap5430_data, > >+ }, > >+ /* Sentinel */ > >+ { }, > >+}; > >+ > >+static struct omap_bandgap *omap_bandgap_build(struct platform_device *pdev) > >+{ > >+ struct device_node *node = pdev->dev.of_node; > >+ const struct of_device_id *of_id; > >+ struct omap_bandgap *bg_ptr; > > bg_ptr is not a super name. > > >+ u32 prop; > >+ > >+ /* just for the sake */ > >+ if (!node) { > >+ dev_err(&pdev->dev, "no platform information available\n"); > >+ return ERR_PTR(-EINVAL); > >+ } > > Not needed, just do the of_match_device here directly. > > >+ > >+ bg_ptr = devm_kzalloc(&pdev->dev, sizeof(struct omap_bandgap), > >+ GFP_KERNEL); > >+ if (!bg_ptr) { > >+ dev_err(&pdev->dev, "Unable to allocate mem for driver ref\n"); > >+ return ERR_PTR(-ENOMEM); > >+ } > >+ > >+ of_id = of_match_device(of_omap_bandgap_match,&pdev->dev); > >+ if (of_id) > >+ bg_ptr->pdata = of_id->data; > > Nit: This is not really pdata anymore, so you should maybe remove > the "p" to avoid confusion. > > >+ > >+ if (bg_ptr->pdata->has_tshut) { > >+ if (of_property_read_u32(node, "ti,tshut-gpio",&prop)< 0) { > >+ dev_err(&pdev->dev, "missing tshut gpio in device tree\n"); > >+ return ERR_PTR(-EINVAL); > >+ } > >+ bg_ptr->tshut_gpio = prop; > >+ if (!gpio_is_valid(bg_ptr->tshut_gpio)) { > >+ dev_err(&pdev->dev, "invalid gpio for tshut (%d)\n", > >+ bg_ptr->tshut_gpio); > >+ return ERR_PTR(-EINVAL); > >+ } > >+ } > >+ > >+ return bg_ptr; > >+} > >+ > >+static > >+int __devinit omap_bandgap_probe(struct platform_device *pdev) > >+{ > >+ struct device *cdev = pdev->dev.parent; > >+ struct omap_bandgap *bg_ptr; > >+ int clk_rate, ret = 0, i; > >+ > >+ if (!cdev) { > >+ dev_err(&pdev->dev, "no omap control ref in our parent\n"); > >+ return -EINVAL; > >+ } > >+ > >+ bg_ptr = omap_bandgap_build(pdev); > >+ if (IS_ERR_OR_NULL(bg_ptr)) { > >+ dev_err(&pdev->dev, "failed to fetch platform data\n"); > >+ return PTR_ERR(bg_ptr); > >+ } > >+ > >+ if (bg_ptr->pdata->has_talert) { > > Nit2: Yeah, in fact instead of pdata, "conf" or "settings" seems to > be more representative of what this structure really contain. > > >+ ret = omap_bandgap_talert_init(bg_ptr, pdev); > >+ if (ret) { > >+ dev_err(&pdev->dev, "failed to initialize Talert IRQ\n"); > >+ return ret; > >+ } > >+ } > >+ > >+ if (bg_ptr->pdata->has_tshut) { > >+ ret = omap_bandgap_tshut_init(bg_ptr, pdev); > >+ if (ret) { > >+ dev_err(&pdev->dev, > >+ "failed to initialize system tshut IRQ\n"); > >+ goto free_talert; > >+ } > >+ } > >+ > >+ bg_ptr->fclock = clk_get(NULL, bg_ptr->pdata->fclock_name); > > That's not good to get a clock without using the local dev alias. > But because of lack of clock DT binding yet, I'm not sure we have > the choice. > > >+ ret = IS_ERR_OR_NULL(bg_ptr->fclock); > >+ if (ret) { > >+ dev_err(&pdev->dev, "failed to request fclock reference\n"); > >+ goto free_irqs; > >+ } > >+ > >+ bg_ptr->div_clk = clk_get(NULL, bg_ptr->pdata->div_ck_name); > >+ ret = IS_ERR_OR_NULL(bg_ptr->div_clk); > >+ if (ret) { > >+ dev_err(&pdev->dev, > >+ "failed to request div_ts_ck clock ref\n"); > >+ goto free_irqs; > >+ } > >+ > >+ bg_ptr->conv_table = bg_ptr->pdata->conv_table; > >+ for (i = 0; i< bg_ptr->pdata->sensor_count; i++) { > >+ struct temp_sensor_registers *tsr; > >+ u32 val; > >+ > >+ tsr = bg_ptr->pdata->sensors[i].registers; > >+ /* > >+ * check if the efuse has a non-zero value if not > >+ * it is an untrimmed sample and the temperatures > >+ * may not be accurate > >+ */ > >+ ret = omap_control_readl(cdev, tsr->bgap_efuse,&val); > >+ if (ret || !val) > >+ dev_info(&pdev->dev, > >+ "Non-trimmed BGAP, Temp not accurate\n"); > >+ } > >+ > >+ clk_rate = clk_round_rate(bg_ptr->div_clk, > >+ bg_ptr->pdata->sensors[0].ts_data->max_freq); > >+ if (clk_rate< bg_ptr->pdata->sensors[0].ts_data->min_freq || > >+ clk_rate == 0xffffffff) { > >+ ret = -ENODEV; > >+ goto put_clks; > >+ } > >+ > >+ ret = clk_set_rate(bg_ptr->div_clk, clk_rate); > >+ if (ret) { > >+ dev_err(&pdev->dev, "Cannot set clock rate\n"); > >+ goto put_clks; > >+ } > >+ > >+ bg_ptr->clk_rate = clk_rate; > >+ clk_enable(bg_ptr->fclock); > >+ > >+ mutex_init(&bg_ptr->bg_mutex); > >+ bg_ptr->dev =&pdev->dev; > >+ platform_set_drvdata(pdev, bg_ptr); > >+ > >+ /* 1 clk cycle */ > > What does that mean exactly? > > Regards, > Benoit > > >+ for (i = 0; i< bg_ptr->pdata->sensor_count; i++) > >+ configure_temp_sensor_counter(bg_ptr, i, 1); > >+ > >+ for (i = 0; i< bg_ptr->pdata->sensor_count; i++) { > >+ struct temp_sensor_data *ts_data; > >+ > >+ ts_data = bg_ptr->pdata->sensors[i].ts_data; > >+ > >+ temp_sensor_init_talert_thresholds(bg_ptr, i, > >+ ts_data->t_hot, > >+ ts_data->t_cold); > >+ temp_sensor_configure_tshut_hot(bg_ptr, i, > >+ ts_data->tshut_hot); > >+ temp_sensor_configure_tshut_cold(bg_ptr, i, > >+ ts_data->tshut_cold); > >+ } > >+ > >+ enable_continuous_mode(bg_ptr); > >+ > >+ /* Set .250 seconds time as default counter */ > >+ for (i = 0; i< bg_ptr->pdata->sensor_count; i++) > >+ configure_temp_sensor_counter(bg_ptr, i, > >+ bg_ptr->clk_rate / 4); > >+ > >+ /* Every thing is good? Then expose the sensors */ > >+ for (i = 0; i< bg_ptr->pdata->sensor_count; i++) { > >+ char *domain; > >+ > >+ domain = bg_ptr->pdata->sensors[i].domain; > >+ if (bg_ptr->pdata->expose_sensor) > >+ bg_ptr->pdata->expose_sensor(bg_ptr, i, domain); > >+ } > >+ > >+ return 0; > >+ > >+put_clks: > >+ clk_disable(bg_ptr->fclock); > >+ clk_put(bg_ptr->fclock); > >+ clk_put(bg_ptr->div_clk); > >+free_irqs: > >+ free_irq(gpio_to_irq(bg_ptr->tshut_gpio), NULL); > >+ gpio_free(bg_ptr->tshut_gpio); > >+free_talert: > >+ free_irq(bg_ptr->irq, bg_ptr); > >+ > >+ return ret; > >+} > >+ > >+static > >+int __devexit omap_bandgap_remove(struct platform_device *pdev) > >+{ > >+ struct omap_bandgap *bg_ptr = platform_get_drvdata(pdev); > >+ > >+ clk_disable(bg_ptr->fclock); > >+ clk_put(bg_ptr->fclock); > >+ clk_put(bg_ptr->div_clk); > >+ free_irq(bg_ptr->irq, bg_ptr); > >+ free_irq(gpio_to_irq(bg_ptr->tshut_gpio), NULL); > >+ gpio_free(bg_ptr->tshut_gpio); > >+ > >+ return 0; > >+} > >+ > >+#ifdef CONFIG_PM > >+static int omap_bandgap_save_ctxt(struct omap_bandgap *bg_ptr) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ int err = 0; > >+ int i; > >+ > >+ for (i = 0; i< bg_ptr->pdata->sensor_count; i++) { > >+ struct temp_sensor_registers *tsr; > >+ struct temp_sensor_regval *rval; > >+ > >+ rval = bg_ptr->pdata->sensors[i].regval; > >+ tsr = bg_ptr->pdata->sensors[i].registers; > >+ > >+ err = omap_control_readl(cdev, tsr->bgap_mode_ctrl, > >+ &rval->bg_mode_ctrl); > >+ err |= omap_control_readl(cdev, tsr->bgap_mask_ctrl, > >+ &rval->bg_ctrl); > >+ err |= omap_control_readl(cdev, tsr->bgap_counter, > >+ &rval->bg_counter); > >+ err |= omap_control_readl(cdev, tsr->bgap_threshold, > >+ &rval->bg_threshold); > >+ err |= omap_control_readl(cdev, tsr->tshut_threshold, > >+ &rval->tshut_threshold); > >+ > >+ if (err) > >+ dev_err(bg_ptr->dev, "could not save sensor %d\n", i); > >+ } > >+ > >+ return err ? -EIO : 0; > >+} > >+ > >+static int > >+omap_bandgap_force_single_read(struct omap_bandgap *bg_ptr, int id) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ struct temp_sensor_registers *tsr; > >+ u32 temp = 0, counter = 1000; > >+ int err; > >+ > >+ tsr = bg_ptr->pdata->sensors[id].registers; > >+ /* Select single conversion mode */ > >+ err = omap_control_readl(cdev, tsr->bgap_mode_ctrl,&temp); > >+ temp&= ~(1<< __ffs(tsr->mode_ctrl_mask)); > >+ omap_control_writel(cdev, temp, tsr->bgap_mode_ctrl); > >+ > >+ /* Start of Conversion = 1 */ > >+ err |= omap_control_readl(cdev, tsr->temp_sensor_ctrl,&temp); > >+ temp |= 1<< __ffs(tsr->bgap_soc_mask); > >+ omap_control_writel(cdev, temp, tsr->temp_sensor_ctrl); > >+ /* Wait until DTEMP is updated */ > >+ err |= omap_control_readl(cdev, tsr->temp_sensor_ctrl,&temp); > >+ temp&= (tsr->bgap_dtemp_mask); > >+ while ((temp == 0)&& --counter) { > >+ err |= omap_control_readl(cdev, tsr->temp_sensor_ctrl,&temp); > >+ temp&= (tsr->bgap_dtemp_mask); > >+ } > >+ /* Start of Conversion = 0 */ > >+ err |= omap_control_readl(cdev, tsr->temp_sensor_ctrl,&temp); > >+ temp&= ~(1<< __ffs(tsr->bgap_soc_mask)); > >+ err |= omap_control_writel(cdev, temp, tsr->temp_sensor_ctrl); > >+ > >+ return err ? -EIO : 0; > >+} > >+ > >+static int omap_bandgap_restore_ctxt(struct omap_bandgap *bg_ptr) > >+{ > >+ struct device *cdev = bg_ptr->dev->parent; > >+ int i, err = 0; > >+ u32 temp = 0; > >+ > >+ for (i = 0; i< bg_ptr->pdata->sensor_count; i++) { > >+ struct temp_sensor_registers *tsr; > >+ struct temp_sensor_regval *rval; > >+ u32 val; > >+ > >+ rval = bg_ptr->pdata->sensors[i].regval; > >+ tsr = bg_ptr->pdata->sensors[i].registers; > >+ > >+ err = omap_control_readl(cdev, tsr->bgap_counter,&val); > >+ if (val == 0) { > >+ err |= omap_control_writel(cdev, rval->bg_threshold, > >+ tsr->bgap_threshold); > >+ err |= omap_control_writel(cdev, rval->tshut_threshold, > >+ tsr->tshut_threshold); > >+ /* Force immediate temperature measurement and update > >+ * of the DTEMP field > >+ */ > >+ omap_bandgap_force_single_read(bg_ptr, i); > >+ err |= omap_control_writel(cdev, rval->bg_counter, > >+ tsr->bgap_counter); > >+ err |= omap_control_writel(cdev, rval->bg_mode_ctrl, > >+ tsr->bgap_mode_ctrl); > >+ err |= omap_control_writel(cdev, rval->bg_ctrl, > >+ tsr->bgap_mask_ctrl); > >+ } else { > >+ err |= omap_control_readl(cdev, tsr->temp_sensor_ctrl, > >+ &temp); > >+ temp&= (tsr->bgap_dtemp_mask); > >+ if (temp == 0) { > >+ omap_bandgap_force_single_read(bg_ptr, i); > >+ err |= omap_control_readl(cdev, > >+ tsr->bgap_mask_ctrl, > >+ &temp); > >+ temp |= 1<< __ffs(tsr->mode_ctrl_mask); > >+ err |= omap_control_writel(cdev, temp, > >+ tsr->bgap_mask_ctrl); > >+ } > >+ } > >+ if (err) > >+ dev_err(bg_ptr->dev, "could not save sensor %d\n", i); > >+ } > >+ > >+ return err ? -EIO : 0; > >+} > >+ > >+static int omap_bandgap_suspend(struct device *dev) > >+{ > >+ struct omap_bandgap *bg_ptr = dev_get_drvdata(dev); > >+ int err; > >+ > >+ err = omap_bandgap_save_ctxt(bg_ptr); > >+ clk_disable(bg_ptr->fclock); > >+ > >+ return err; > >+} > >+ > >+static int omap_bandgap_resume(struct device *dev) > >+{ > >+ struct omap_bandgap *bg_ptr = dev_get_drvdata(dev); > >+ > >+ clk_enable(bg_ptr->fclock); > >+ > >+ return omap_bandgap_restore_ctxt(bg_ptr); > >+} > >+static const struct dev_pm_ops omap_bandgap_dev_pm_ops = { > >+ SET_SYSTEM_SLEEP_PM_OPS(omap_bandgap_suspend, > >+ omap_bandgap_resume) > >+}; > >+ > >+#define DEV_PM_OPS (&omap_bandgap_dev_pm_ops) > >+#else > >+#define DEV_PM_OPS NULL > >+#endif > >+ > >+static struct platform_driver omap_bandgap_sensor_driver = { > >+ .probe = omap_bandgap_probe, > >+ .remove = omap_bandgap_remove, > >+ .driver = { > >+ .name = "omap-bandgap", > >+ .pm = DEV_PM_OPS, > >+ .of_match_table = of_omap_bandgap_match, > >+ }, > >+}; > >+ > >+module_platform_driver(omap_bandgap_sensor_driver); > >+early_platform_init("early_omap_temperature",&omap_bandgap_sensor_driver); > >+ > >+MODULE_DESCRIPTION("OMAP4+ bandgap temperature sensor driver"); > >+MODULE_LICENSE("GPL v2"); > >+MODULE_ALIAS("platform:omap-bandgap"); > >+MODULE_AUTHOR("Texas Instrument Inc."); > >diff --git a/drivers/thermal/omap-bandgap.h b/drivers/thermal/omap-bandgap.h > >new file mode 100644 > >index 0000000..12e0d6b > >--- /dev/null > >+++ b/drivers/thermal/omap-bandgap.h > >@@ -0,0 +1,63 @@ > >+/* > >+ * OMAP4 Bandgap temperature sensor driver > >+ * > >+ * Copyright (C) 2011 Texas Instruments Incorporated - http://www.ti.com/ > >+ * Contact: > >+ * Eduardo Valentin<eduardo.valentin@xxxxxx> > >+ * > >+ * This program is free software; you can redistribute it and/or > >+ * modify it under the terms of the GNU General Public License > >+ * version 2 as published by the Free Software Foundation. > >+ * > >+ * This program is distributed in the hope that 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. > >+ * > >+ * You should have received a copy of the GNU General Public License > >+ * along with this program; if not, write to the Free Software > >+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA > >+ * 02110-1301 USA > >+ * > >+ */ > >+#ifndef __OMAP_BANDGAP_H > >+#define __OMAP_BANDGAP_H > >+ > >+struct omap_bandgap_data; > >+ > >+/** > >+ * struct omap_bandgap - bandgap device structure > >+ * @dev: device pointer > >+ * @pdata: platform data with sensor data > >+ * @fclock: pointer to functional clock of temperature sensor > >+ * @div_clk: pointer to parent clock of temperature sensor fclk > >+ * @conv_table: Pointer to adc to temperature conversion table > >+ * @bg_mutex: Mutex for sysfs, irq and PM > >+ * @irq: MPU Irq number for thermal alert > >+ * @tshut_gpio: GPIO where Tshut signal is routed > >+ * @clk_rate: Holds current clock rate > >+ */ > >+struct omap_bandgap { > >+ struct device *dev; > >+ const struct omap_bandgap_data *pdata; > >+ struct clk *fclock; > >+ struct clk *div_clk; > >+ const int *conv_table; > >+ struct mutex bg_mutex; /* Mutex for irq and PM */ > >+ int irq; > >+ int tshut_gpio; > >+ u32 clk_rate; > >+}; > >+ > >+int omap_bandgap_read_thot(struct omap_bandgap *bg_ptr, int id, int *thot); > >+int omap_bandgap_write_thot(struct omap_bandgap *bg_ptr, int id, int val); > >+int omap_bandgap_read_tcold(struct omap_bandgap *bg_ptr, int id, int *tcold); > >+int omap_bandgap_write_tcold(struct omap_bandgap *bg_ptr, int id, int val); > >+int omap_bandgap_read_update_interval(struct omap_bandgap *bg_ptr, int id, > >+ int *interval); > >+int omap_bandgap_write_update_interval(struct omap_bandgap *bg_ptr, int id, > >+ u32 interval); > >+int omap_bandgap_read_temperature(struct omap_bandgap *bg_ptr, int id, > >+ int *temperature); > >+ > >+#endif > -- To unsubscribe from this list: send the line "unsubscribe linux-omap" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html