Hello, On Wed, Jun 27, 2012 at 10:05:03PM +0400, Konstantin Baydarov 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. > > Changes since previous version: > - Bandgap and usb phy: drivers are now independent from control module driver, > they use their own API functions. > - Bandgap and usb phy: Added private spinlocks for bandgap and usb drivers. > - Bandgap: Check the type of bandgap dynamically in bandgap driver probe > function by reading > omap core control module revision register CONTROL_GEN_CORE_REVISION. > - Parent SCM platform device IOMEM resources is used to get the base address > of SCM window. Same comment on USB-phy applies here. What do we gain by reusing same ioresource from parent on all children for ioremapping? > - SCM Dependency was removed from Kconfig. > - Bandgap masks defines were moved to drivers/thermal/omap-bandgap.c. > > Signed-off-by: Konstantin Baydarov <kbaidarov@xxxxxxxxxxxxx> > 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 | 12 + > drivers/thermal/Makefile | 4 +- > drivers/thermal/omap-bandgap.c | 1773 ++++++++++++++++++++ > drivers/thermal/omap-bandgap.h | 64 + > 5 files changed, 1879 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 Please update documentation. > +- 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..f9989e8 100644 > --- a/drivers/thermal/Kconfig > +++ b/drivers/thermal/Kconfig > @@ -26,3 +26,15 @@ 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 > + 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..c68fa1a > --- /dev/null > +++ b/drivers/thermal/omap-bandgap.c > @@ -0,0 +1,1773 @@ > +/* > + * 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 "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 > + > +/* TEMP_SENSOR OMAP4430 */ > +#define OMAP4430_BGAP_TEMPSOFF_SHIFT 12 > +#define OMAP4430_BGAP_TEMPSOFF_MASK (1 << 12) > +#define OMAP4430_BGAP_TSHUT_SHIFT 11 > +#define OMAP4430_BGAP_TSHUT_MASK (1 << 11) > +#define OMAP4430_BGAP_TEMP_SENSOR_CONTCONV_SHIFT 10 > +#define OMAP4430_BGAP_TEMP_SENSOR_CONTCONV_MASK (1 << 10) > +#define OMAP4430_BGAP_TEMP_SENSOR_SOC_SHIFT 9 > +#define OMAP4430_BGAP_TEMP_SENSOR_SOC_MASK (1 << 9) > +#define OMAP4430_BGAP_TEMP_SENSOR_EOCZ_SHIFT 8 > +#define OMAP4430_BGAP_TEMP_SENSOR_EOCZ_MASK (1 << 8) > +#define OMAP4430_BGAP_TEMP_SENSOR_DTEMP_SHIFT 0 > +#define OMAP4430_BGAP_TEMP_SENSOR_DTEMP_MASK (0xff << 0) > + > +/* TEMP_SENSOR OMAP4460 */ > +#define OMAP4460_BGAP_TEMPSOFF_SHIFT 13 > +#define OMAP4460_BGAP_TEMPSOFF_MASK (1 << 13) > +#define OMAP4460_BGAP_TEMP_SENSOR_SOC_SHIFT 11 > +#define OMAP4460_BGAP_TEMP_SENSOR_SOC_MASK (1 << 11) > +#define OMAP4460_BGAP_TEMP_SENSOR_EOCZ_SHIFT 10 > +#define OMAP4460_BGAP_TEMP_SENSOR_EOCZ_MASK (1 << 10) > +#define OMAP4460_BGAP_TEMP_SENSOR_DTEMP_SHIFT 0 > +#define OMAP4460_BGAP_TEMP_SENSOR_DTEMP_MASK (0x3ff << 0) > + > +/* BANDGAP_CTRL */ > +#define OMAP4460_SINGLE_MODE_SHIFT 31 > +#define OMAP4460_SINGLE_MODE_MASK (1 << 31) > +#define OMAP4460_MASK_HOT_SHIFT 1 > +#define OMAP4460_MASK_HOT_MASK (1 << 1) > +#define OMAP4460_MASK_COLD_SHIFT 0 > +#define OMAP4460_MASK_COLD_MASK (1 << 0) > + > +/* BANDGAP_COUNTER */ > +#define OMAP4460_COUNTER_SHIFT 0 > +#define OMAP4460_COUNTER_MASK (0xffffff << 0) > + > +/* BANDGAP_THRESHOLD */ > +#define OMAP4460_T_HOT_SHIFT 16 > +#define OMAP4460_T_HOT_MASK (0x3ff << 16) > +#define OMAP4460_T_COLD_SHIFT 0 > +#define OMAP4460_T_COLD_MASK (0x3ff << 0) > + > +/* TSHUT_THRESHOLD */ > +#define OMAP4460_TSHUT_HOT_SHIFT 16 > +#define OMAP4460_TSHUT_HOT_MASK (0x3ff << 16) > +#define OMAP4460_TSHUT_COLD_SHIFT 0 > +#define OMAP4460_TSHUT_COLD_MASK (0x3ff << 0) > + > +/* BANDGAP_STATUS */ > +#define OMAP4460_CLEAN_STOP_SHIFT 3 > +#define OMAP4460_CLEAN_STOP_MASK (1 << 3) > +#define OMAP4460_BGAP_ALERT_SHIFT 2 > +#define OMAP4460_BGAP_ALERT_MASK (1 << 2) > +#define OMAP4460_HOT_FLAG_SHIFT 1 > +#define OMAP4460_HOT_FLAG_MASK (1 << 1) > +#define OMAP4460_COLD_FLAG_SHIFT 0 > +#define OMAP4460_COLD_FLAG_MASK (1 << 0) > + > +/* TEMP_SENSOR OMAP5430 */ > +#define OMAP5430_BGAP_TEMP_SENSOR_SOC_SHIFT 12 > +#define OMAP5430_BGAP_TEMP_SENSOR_SOC_MASK (1 << 12) > +#define OMAP5430_BGAP_TEMPSOFF_SHIFT 11 > +#define OMAP5430_BGAP_TEMPSOFF_MASK (1 << 11) > +#define OMAP5430_BGAP_TEMP_SENSOR_EOCZ_SHIFT 10 > +#define OMAP5430_BGAP_TEMP_SENSOR_EOCZ_MASK (1 << 10) > +#define OMAP5430_BGAP_TEMP_SENSOR_DTEMP_SHIFT 0 > +#define OMAP5430_BGAP_TEMP_SENSOR_DTEMP_MASK (0x3ff << 0) > + > +/* BANDGAP_CTRL */ > +#define OMAP5430_MASK_HOT_CORE_SHIFT 5 > +#define OMAP5430_MASK_HOT_CORE_MASK (1 << 5) > +#define OMAP5430_MASK_COLD_CORE_SHIFT 4 > +#define OMAP5430_MASK_COLD_CORE_MASK (1 << 4) > +#define OMAP5430_MASK_HOT_MM_SHIFT 3 > +#define OMAP5430_MASK_HOT_MM_MASK (1 << 3) > +#define OMAP5430_MASK_COLD_MM_SHIFT 2 > +#define OMAP5430_MASK_COLD_MM_MASK (1 << 2) > +#define OMAP5430_MASK_HOT_MPU_SHIFT 1 > +#define OMAP5430_MASK_HOT_MPU_MASK (1 << 1) > +#define OMAP5430_MASK_COLD_MPU_SHIFT 0 > +#define OMAP5430_MASK_COLD_MPU_MASK (1 << 0) > + > +/* BANDGAP_COUNTER */ > +#define OMAP5430_REPEAT_MODE_SHIFT 31 > +#define OMAP5430_REPEAT_MODE_MASK (1 << 31) > +#define OMAP5430_COUNTER_SHIFT 0 > +#define OMAP5430_COUNTER_MASK (0xffffff << 0) > + > +/* BANDGAP_THRESHOLD */ > +#define OMAP5430_T_HOT_SHIFT 16 > +#define OMAP5430_T_HOT_MASK (0x3ff << 16) > +#define OMAP5430_T_COLD_SHIFT 0 > +#define OMAP5430_T_COLD_MASK (0x3ff << 0) > + > +/* TSHUT_THRESHOLD */ > +#define OMAP5430_TSHUT_HOT_SHIFT 16 > +#define OMAP5430_TSHUT_HOT_MASK (0x3ff << 16) > +#define OMAP5430_TSHUT_COLD_SHIFT 0 > +#define OMAP5430_TSHUT_COLD_MASK (0x3ff << 0) > + > +/* BANDGAP_STATUS */ > +#define OMAP5430_BGAP_ALERT_SHIFT 31 > +#define OMAP5430_BGAP_ALERT_MASK (1 << 31) > +#define OMAP5430_HOT_CORE_FLAG_SHIFT 5 > +#define OMAP5430_HOT_CORE_FLAG_MASK (1 << 5) > +#define OMAP5430_COLD_CORE_FLAG_SHIFT 4 > +#define OMAP5430_COLD_CORE_FLAG_MASK (1 << 4) > +#define OMAP5430_HOT_MM_FLAG_SHIFT 3 > +#define OMAP5430_HOT_MM_FLAG_MASK (1 << 3) > +#define OMAP5430_COLD_MM_FLAG_SHIFT 2 > +#define OMAP5430_COLD_MM_FLAG_MASK (1 << 2) > +#define OMAP5430_HOT_MPU_FLAG_SHIFT 1 > +#define OMAP5430_HOT_MPU_FLAG_MASK (1 << 1) > +#define OMAP5430_COLD_MPU_FLAG_SHIFT 0 > +#define OMAP5430_COLD_MPU_FLAG_MASK (1 << 0) > + > + > +/** > + * 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; > + spinlock_t bg_reg_lock; > +}; > + > +/** > + * 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; > + int tshut_gpio; > + 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); > + int irq; > + > + /* 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 > + * 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 > + */ > +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 > + */ > +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, > +}; I suppose not all comments on RFC were considered.. Anyways, I have another version of this driver which has the data structures in separated files. > + > +/* > + * TODO: Get rid from bg_readl() return value - > + * It's useless. > + */ > + > +static int bg_readl(struct omap_bandgap *bg_ptr, u32 reg, u32 *val) > +{ > + if (!bg_ptr) > + return -EINVAL; > + > + *val = __raw_readl(bg_ptr->bg_base + reg); > + return 0; > +} > + > +/* > + * TODO: Get rid from bg_writel() return value - > + * It's useless. Same thing as in usb-phy. when removing the return value, remember to leave a WARN_ON at least. > + */ > +static int bg_writel(struct omap_bandgap *bg_ptr, u32 val, u32 reg, spinlock_t *lock) > +{ > + unsigned long flags; > + > + if (!bg_ptr) > + return -EINVAL; > + > + spin_lock_irqsave(lock, flags); > + __raw_writel(val, bg_ptr->bg_base + reg); > + spin_unlock_irqrestore(lock, flags); > + return 0; > +} Please use omap_bandgap_[read/write]l. Otherwise this driver starts to have several prefix patterns (or no prefix pattern) > + > +static irqreturn_t talert_irq_handler(int irq, void *data) > +{ > + struct omap_bandgap *bg_ptr = data; > + struct temp_sensor_registers *tsr; > + u32 t_hot = 0, t_cold = 0, temp, ctrl = 0; > + 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 = bg_readl(bg_ptr, tsr->bgap_status, &t_hot); > + t_hot &= tsr->status_hot_mask; > + > + /* Read the status of t_cold */ > + r |= bg_readl(bg_ptr, tsr->bgap_status, &t_cold); > + t_cold &= tsr->status_cold_mask; > + > + if (!t_cold && !t_hot) > + continue; > + > + r |= bg_readl(bg_ptr, 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 |= bg_writel(bg_ptr, ctrl, tsr->bgap_mask_ctrl, &tsr->bg_reg_lock); > + > + if (r) { > + dev_err(bg_ptr->dev, "failed to ack talert interrupt\n"); > + return IRQ_NONE; > + } > + > + /* read temperature */ > + r = bg_readl(bg_ptr, 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 temp_sensor_registers *tsr; > + u32 temp = 0, reg_val = 0; > + int err; > + > + /* Read the current on die temperature */ > + tsr = bg_ptr->pdata->sensors[id].registers; > + err = bg_readl(bg_ptr, tsr->temp_sensor_ctrl, &temp); > + temp &= tsr->bgap_dtemp_mask; > + > + err |= bg_readl(bg_ptr, 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 |= bg_writel(bg_ptr, reg_val, tsr->bgap_mask_ctrl, &tsr->bg_reg_lock); > + > + 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 temp_sensor_registers *tsr; > + u32 thresh_val = 0, reg_val; > + int cold, err; > + > + tsr = bg_ptr->pdata->sensors[id].registers; > + > + /* obtain the T cold value */ > + err = bg_readl(bg_ptr, 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 |= bg_writel(bg_ptr, reg_val, tsr->bgap_threshold, &tsr->bg_reg_lock); > + 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 |= bg_writel(bg_ptr, reg_val, tsr->bgap_threshold, &tsr->bg_reg_lock); > + 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 temp_sensor_registers *tsr; > + u32 reg_val, thresh_val; > + int err; > + > + tsr = bg_ptr->pdata->sensors[id].registers; > + err = bg_readl(bg_ptr, 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 |= bg_writel(bg_ptr, reg_val, tsr->bgap_threshold, &tsr->bg_reg_lock); > + if (err) { > + dev_err(bg_ptr->dev, "failed to reprogram tcold threshold\n"); > + return -EIO; > + } > + > + err = bg_readl(bg_ptr, 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 |= bg_writel(bg_ptr, reg_val, tsr->bgap_threshold, &tsr->bg_reg_lock); > + if (err) { > + dev_err(bg_ptr->dev, "failed to reprogram thot threshold\n"); > + return -EIO; > + } > + > + err = bg_readl(bg_ptr, tsr->bgap_mask_ctrl, ®_val); > + reg_val |= tsr->mask_hot_mask; > + reg_val |= tsr->mask_cold_mask; > + err |= bg_writel(bg_ptr, reg_val, tsr->bgap_mask_ctrl, &tsr->bg_reg_lock); > + 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 temp_sensor_registers *tsr; > + u32 thresh_val = 0, reg_val; > + int hot, err; > + > + tsr = bg_ptr->pdata->sensors[id].registers; > + /* obtain the T cold value */ > + err = bg_readl(bg_ptr, 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 |= bg_writel(bg_ptr, reg_val, tsr->bgap_threshold, &tsr->bg_reg_lock); > + 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 |= bg_writel(bg_ptr, reg_val, tsr->bgap_threshold, &tsr->bg_reg_lock); > + 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 temp_sensor_registers *tsr; > + u32 reg_val; > + int err; > + > + tsr = bg_ptr->pdata->sensors[id].registers; > + err = bg_readl(bg_ptr, tsr->tshut_threshold, ®_val); > + reg_val &= ~tsr->tshut_hot_mask; > + reg_val |= tshut_hot << __ffs(tsr->tshut_hot_mask); > + err |= bg_writel(bg_ptr, reg_val, tsr->tshut_threshold, &tsr->bg_reg_lock); > + 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 temp_sensor_registers *tsr; > + u32 reg_val; > + int err; > + > + tsr = bg_ptr->pdata->sensors[id].registers; > + err = bg_readl(bg_ptr, tsr->tshut_threshold, ®_val); > + reg_val &= ~tsr->tshut_cold_mask; > + reg_val |= tshut_cold << __ffs(tsr->tshut_cold_mask); > + err |= bg_writel(bg_ptr, reg_val, tsr->tshut_threshold, &tsr->bg_reg_lock); > + 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 temp_sensor_registers *tsr; > + u32 val = 0; > + int err; > + > + tsr = bg_ptr->pdata->sensors[id].registers; > + err = bg_readl(bg_ptr, tsr->bgap_counter, &val); > + val &= ~tsr->counter_mask; > + val |= counter << __ffs(tsr->counter_mask); > + err |= bg_writel(bg_ptr, val, tsr->bgap_counter, &tsr->bg_reg_lock); > + 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 temp_sensor_registers *tsr; > + u32 temp; > + int ret; > + > + tsr = bg_ptr->pdata->sensors[id].registers; > + ret = bg_readl(bg_ptr, 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 temp_sensor_registers *tsr; > + u32 temp; > + int ret; > + > + tsr = bg_ptr->pdata->sensors[id].registers; > + ret = bg_readl(bg_ptr, 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 temp_sensor_registers *tsr; > + u32 time; > + int ret; > + > + tsr = bg_ptr->pdata->sensors[id].registers; > + ret = bg_readl(bg_ptr, 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 temp_sensor_registers *tsr; > + u32 temp; > + int ret; > + > + tsr = bg_ptr->pdata->sensors[id].registers; > + ret = bg_readl(bg_ptr, 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 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 = bg_readl(bg_ptr, tsr->bgap_mode_ctrl, &val); > + val |= 1 << __ffs(tsr->mode_ctrl_mask); > + r |= bg_writel(bg_ptr, val, tsr->bgap_mode_ctrl, &tsr->bg_reg_lock); > + 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, > + .tshut_gpio = 86, > + .fclock_name = "bandgap_ts_fclk", > + .div_ck_name = "div_ts_ck", > + .conv_table = omap4460_adc_to_temp, > + .irq = 126, > + .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, > + .tshut_gpio = 0, /* TODO. Fill correct tshut_gpio */ > + .fclock_name = "ts_clk_div_ck", > + .div_ck_name = "ts_clk_div_ck", > + .conv_table = omap5430_adc_to_temp, > + .irq = 0, /* TODO. Fill correct irq */ > + .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, > +}; > + > +static const struct of_device_id of_omap_bandgap_match[] = { > + /* > + * TODO: Add support to 4430 > + * { .compatible = "ti,omap4430-bandgap", .data = , }, > + */ > + { > + .compatible = "ti,omap4-bandgap", You didnt update the doc. > + }, > + /* Sentinel */ > + { }, > +}; > + > +static struct omap_bandgap *omap_bandgap_build(struct platform_device *pdev) > +{ > + struct device_node *node = pdev->dev.of_node; > + struct omap_bandgap *bg_ptr; > + u32 val; > + struct resource *io_res; > + struct platform_device *pparent; > + > + /* just for the sake */ > + if (!node) { > + dev_err(&pdev->dev, "No platform information available\n"); > + return ERR_PTR(-EINVAL); > + } > + > + 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); > + } > + > + if (!pdev->dev.parent) { > + dev_err(&pdev->dev, "No parent device!\n"); > + return ERR_PTR(-ENOMEM); > + } > + > + pparent = to_platform_device(pdev->dev.parent); > + io_res = platform_get_resource(pparent, IORESOURCE_MEM, 0); Same question on usbphy applies here. what do we want to achieve by doing this at children code? > + if (!io_res) { > + dev_err(&pdev->dev, "Failed to get IO resource\n"); > + return ERR_PTR(-ENOENT); > + } > + > + bg_ptr->bg_base = ioremap(io_res->start, resource_size(io_res)); > + if (!bg_ptr->bg_base) > + return 0; > + > + bg_readl(bg_ptr, 0x0, &val); use a macro for the offset. > + > + /* > + * Check omap control core module revision to find out > + * bandgap type > + */ > + switch ((val & 0x3ff) >> 8) { > + case 1: > + /* 4430 */ > + bg_ptr->pdata = &omap4460_data; > + break; > + case 2: > + /* 4460 */ > + bg_ptr->pdata = &omap4460_data; > + break; 3 would be 4470. But O5 has exactly same register value as 4430. So, I think this won't work just the way it is. We can either go back to the previous "compatible" approach. Or we can have a match function mixed with compatible and register value. Meaning, when omap4- is passed in compatible, you match in the above way. But when omap5- is passed in compatible, you match in a way which fits to o5 register value. This is getting overcomplicated though... > + default: > + /* Unknown omap control core module revision */ > + return 0; > + } > + > + if (bg_ptr->pdata->has_tshut) { > + bg_ptr->tshut_gpio = bg_ptr->pdata->tshut_gpio; > + 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; > +} > + > +struct resource *platform_get_resource_dbg(struct platform_device *dev, > + unsigned int type, unsigned int num); > + > +static > +int __devinit omap_bandgap_probe(struct platform_device *pdev) > +{ > + struct omap_bandgap *bg_ptr; > + int clk_rate, ret = 0, i; > + > + 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) { > + 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); > + 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; > + /* Initialize register lock */ > + spin_lock_init(&tsr->bg_reg_lock); > + > + /* > + * check if the efuse has a non-zero value if not > + * it is an untrimmed sample and the temperatures > + * may not be accurate > + */ > + ret = bg_readl(bg_ptr, 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 */ > + 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) > +{ > + 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 = bg_readl(bg_ptr, tsr->bgap_mode_ctrl, > + &rval->bg_mode_ctrl); > + err |= bg_readl(bg_ptr, tsr->bgap_mask_ctrl, > + &rval->bg_ctrl); > + err |= bg_readl(bg_ptr, tsr->bgap_counter, > + &rval->bg_counter); > + err |= bg_readl(bg_ptr, tsr->bgap_threshold, > + &rval->bg_threshold); > + err |= bg_readl(bg_ptr, 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 temp_sensor_registers *tsr; > + u32 temp = 0, counter = 1000; > + int err; > + > + tsr = bg_ptr->pdata->sensors[id].registers; > + /* Select single conversion mode */ > + err = bg_readl(bg_ptr, tsr->bgap_mode_ctrl, &temp); > + temp &= ~(1 << __ffs(tsr->mode_ctrl_mask)); > + bg_writel(bg_ptr, temp, tsr->bgap_mode_ctrl, &tsr->bg_reg_lock); > + > + /* Start of Conversion = 1 */ > + err |= bg_readl(bg_ptr, tsr->temp_sensor_ctrl, &temp); > + temp |= 1 << __ffs(tsr->bgap_soc_mask); > + bg_writel(bg_ptr, temp, tsr->temp_sensor_ctrl, &tsr->bg_reg_lock); > + /* Wait until DTEMP is updated */ > + err |= bg_readl(bg_ptr, tsr->temp_sensor_ctrl, &temp); > + temp &= (tsr->bgap_dtemp_mask); > + while ((temp == 0) && --counter) { > + err |= bg_readl(bg_ptr, tsr->temp_sensor_ctrl, &temp); > + temp &= (tsr->bgap_dtemp_mask); > + } > + /* Start of Conversion = 0 */ > + err |= bg_readl(bg_ptr, tsr->temp_sensor_ctrl, &temp); > + temp &= ~(1 << __ffs(tsr->bgap_soc_mask)); > + err |= bg_writel(bg_ptr, temp, tsr->temp_sensor_ctrl, &tsr->bg_reg_lock); > + > + return err ? -EIO : 0; > +} > + > +static int omap_bandgap_restore_ctxt(struct omap_bandgap *bg_ptr) > +{ > + 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 = 0; > + > + rval = bg_ptr->pdata->sensors[i].regval; > + tsr = bg_ptr->pdata->sensors[i].registers; > + > + err = bg_readl(bg_ptr, tsr->bgap_counter, &val); > + if (val == 0) { > + err |= bg_writel(bg_ptr, rval->bg_threshold, > + tsr->bgap_threshold, &tsr->bg_reg_lock); > + err |= bg_writel(bg_ptr, rval->tshut_threshold, > + tsr->tshut_threshold, &tsr->bg_reg_lock); > + /* Force immediate temperature measurement and update > + * of the DTEMP field > + */ > + omap_bandgap_force_single_read(bg_ptr, i); > + err |= bg_writel(bg_ptr, rval->bg_counter, > + tsr->bgap_counter, &tsr->bg_reg_lock); > + err |= bg_writel(bg_ptr, rval->bg_mode_ctrl, > + tsr->bgap_mode_ctrl, &tsr->bg_reg_lock); > + err |= bg_writel(bg_ptr, rval->bg_ctrl, > + tsr->bgap_mask_ctrl, &tsr->bg_reg_lock); > + } else { > + err |= bg_readl(bg_ptr, tsr->temp_sensor_ctrl, > + &temp); > + temp &= (tsr->bgap_dtemp_mask); > + if (temp == 0) { > + omap_bandgap_force_single_read(bg_ptr, i); > + err |= bg_readl(bg_ptr, tsr->bgap_mask_ctrl, > + &temp); > + temp |= 1 << __ffs(tsr->mode_ctrl_mask); > + err |= bg_writel(bg_ptr, temp, > + tsr->bgap_mask_ctrl, &tsr->bg_reg_lock); > + } > + } > + 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); > + > +static int __init bg_init(void) > +{ > + return platform_driver_register(&omap_bandgap_sensor_driver); > +} > + > +static void __exit bg_exit(void) > +{ > + platform_driver_unregister(&omap_bandgap_sensor_driver); > +} > + > +module_init(bg_init); > +module_exit(bg_exit); > + > +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..41f25ff > --- /dev/null > +++ b/drivers/thermal/omap-bandgap.h > @@ -0,0 +1,64 @@ > +/* > + * 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; > + void __iomem *bg_base; > +}; > + > +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 > -- > 1.7.7.6 > > -- 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