Initial file dump from open source releaseHEADmaster

1 files changed, 500 insertions, 0 deletions

diff --git a/drivers/thermal/sprd_2713_thm.c b/drivers/thermal/sprd_2713_thm.c
new file mode 100644
index 00000000..cdb96ae9
--- /dev/null
+++ b/drivers/thermal/sprd_2713_thm.c
@@ -0,0 +1,500 @@
+/*
+ * Copyright (C) 2013 Spreadtrum Communications Inc.
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ *
+ * 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.
+ *
+ */
+
+#include <linux/kernel.h>
+#include <linux/err.h>
+#include <mach/hardware.h>
+#include <soc/sprd/sci.h>
+#include <soc/sprd/sci_glb_regs.h>
+#include <linux/io.h>
+#include <soc/sprd/adi.h>
+#include "thm.h"
+#include <linux/sprd_thm.h>
+#include <mach/arch_misc.h>
+
+#define SPRD_THM_DEBUG
+#ifdef SPRD_THM_DEBUG
+#define THM_DEBUG(format, arg...) printk("sprd thm: " "@@@" format, ## arg)
+#else
+#define THM_DEBUG(format, arg...)
+#endif
+
+#define THM_CTRL            (0x0000)
+#define THM_INT_CTRL       (0x0004)
+#define SENSOR_CTRL         (0x0020)
+#define SENSOR_DET_PERI     (0x0024)
+#define SENSOR_INT_CTRL     (0x0028)
+#define SENSOR_INT_STS      (0x002C)
+#define SENSOR_INT_RAW_STS      (0x0030)
+#define SENSOR_INT_CLR      (0x0034)
+#define SENSOR_OVERHEAT_HOT_THRES   (0X0040)
+#define SENSOR_HOT2NOR__HIGHOFF_THRES   (0X0044)
+#define SENSOR_LOWOFF__COLD_THRES   (0X0048)
+#define SENSOR_TEMPER0_READ	(0x0058)
+
+#define SEN_OVERHEAT_INT_BIT (1 << 5)
+#define SEN_HOT_INT_BIT      (1 << 4)
+#define SEN_HOT2NOR_INT_BIT  (1 << 3)
+#define SEN_HIGHOFF_BIT  (1 << 2)
+#define SEN_LOWOFF_INT_BIT  (1 << 1)
+
+#define RAW_TEMP_OFFSET 8
+#define RAW_TEMP_RANGE_MSK  0x7F
+
+#define HIGH_BITS_OFFSET   4
+
+#define HIGH_TAB_SZ 8
+#define LOW_TAB_SZ  16
+
+#define HOT2NOR_RANGE   15
+#define LOCAL_SENSOR_ADDR_OFF 0x100
+#define DELAY_TEMPERATURE 3
+#define INTOFFSET 3
+
+#define TSMC_DOLPHINW4T_CHIP_ID_1  0x7715A001
+#define TSMC_DOLPHINW4T_CHIP_ID_2  0x7715A003
+#define TSMC_DOLPHINWT4T_CHIP_ID_1 0x8815A001
+
+static const short temp_search_high_40nm[HIGH_TAB_SZ] =
+    { -41, -14, 14, 41, 68, 95, 122, 150 };
+static const short temp_search_low_40nm[LOW_TAB_SZ] =
+    { 0, 2, 4, 5, 7, 8, 10, 12, 14, 15, 17, 19, 20, 22, 24, 26 };
+static const short temp_search_high_152nm[HIGH_TAB_SZ] =
+    { -45, -19, 7, 33, 59, 85, 111, 137 };
+static const short temp_search_low_152nm[LOW_TAB_SZ] =
+    { 0, 2, 3, 5, 6, 8, 10, 11, 13, 14, 16, 18, 19, 21, 22, 24 };
+
+static u32 current_trip_num = 0;
+static int arm_sen_cal_offset = 0;
+static int pmic_sen_cal_offset = 0;
+
+extern unsigned long SPRD_THM_BASE;
+extern unsigned int SPRD_THM_SIZE;
+
+static inline int __thm_reg_write(u32 reg, u16 bits, u16 clear_msk);
+static inline u32 __thm_reg_read(u32 reg);
+int sprd_thm_set_active_trip(struct sprd_thermal_zone *pzone, int trip );
+u32 sprd_thm_temp2rawdata(u32 sensor, int temp);
+
+static inline int __thm_reg_write(u32 reg, u16 bits, u16 clear_msk)
+{
+	if (reg >= SPRD_THM_BASE && reg <= (SPRD_THM_BASE + SPRD_THM_SIZE)) {
+		__raw_writel(((__raw_readl((volatile void *)reg) & ~clear_msk) | bits), (volatile void *)(reg));
+	} else if (reg >= ANA_THM_BASE && reg <= (ANA_THM_BASE + SPRD_THM_SIZE)) {
+		sci_adi_write(reg, bits, clear_msk);
+	} else {
+		printk(KERN_ERR "error thm reg0x:%x \n", reg);
+	}
+	return 0;
+}
+
+static inline u32 __thm_reg_read(u32 reg)
+{
+	if (reg >= SPRD_THM_BASE && reg <= (SPRD_THM_BASE + SPRD_THM_SIZE)) {
+		return __raw_readl((volatile void *)reg);
+	} else if (reg >= ANA_THM_BASE && reg <= (ANA_THM_BASE + SPRD_THM_SIZE)) {
+		return sci_adi_read(reg);
+	} else {
+		printk(KERN_ERR "error thm reg0x:%x \n", reg);
+	}
+	return 0;
+}
+
+int sprd_thm_set_active_trip(struct sprd_thermal_zone *pzone, int trip )
+{
+	u32 raw_temp = 0;
+	u32 local_sen_id = 0;
+	u32 local_sensor_addr = 0;
+	struct sprd_thm_platform_data *trip_tab = pzone->trip_tab;
+
+	THM_DEBUG("thm sensor id:%d, trip:%d  \n", pzone->sensor_id, trip);
+	if (trip < 0 || trip > (trip_tab->num_trips - 1))
+		return -1;
+	if (trip_tab->trip_points[trip].type != THERMAL_TRIP_ACTIVE)
+		return -1;
+
+	local_sen_id = pzone->sensor_id;
+	local_sensor_addr =
+		(u32) pzone->reg_base + local_sen_id * LOCAL_SENSOR_ADDR_OFF;
+
+	//Disable sensor int
+	__thm_reg_write((local_sensor_addr + SENSOR_INT_CTRL),0,(0x7F & (~SEN_OVERHEAT_INT_BIT)));
+
+	//set hot int temp value
+	THM_DEBUG("thm sensor trip:%d, temperature:%d  \n", trip, trip_tab->trip_points[trip].temp);
+	raw_temp =
+		sprd_thm_temp2rawdata(pzone->sensor_id,
+				              trip_tab->trip_points[trip].temp - pmic_sen_cal_offset - INTOFFSET);
+	if (raw_temp < RAW_TEMP_RANGE_MSK) {
+		raw_temp++;
+	}
+	__thm_reg_write((local_sensor_addr + SENSOR_OVERHEAT_HOT_THRES),
+				     raw_temp,
+					 RAW_TEMP_RANGE_MSK);
+
+	//set Hot2Normal int temp value
+	raw_temp =
+		sprd_thm_temp2rawdata(pzone->sensor_id, trip_tab->trip_points[trip].lowoff - INTOFFSET - pmic_sen_cal_offset);
+	__thm_reg_write((local_sensor_addr + SENSOR_HOT2NOR__HIGHOFF_THRES),
+					raw_temp << RAW_TEMP_OFFSET,
+					RAW_TEMP_RANGE_MSK << RAW_TEMP_OFFSET);
+
+	//set cold int temp value
+	raw_temp =
+		sprd_thm_temp2rawdata(pzone->sensor_id, trip_tab->trip_points[trip].lowoff - INTOFFSET - pmic_sen_cal_offset);
+	__thm_reg_write((local_sensor_addr + SENSOR_LOWOFF__COLD_THRES),
+					raw_temp << RAW_TEMP_OFFSET,
+					RAW_TEMP_RANGE_MSK << RAW_TEMP_OFFSET);
+
+	THM_DEBUG("thm OVERHEAT_HOT:0x%x, HOT2NOR__HIGHOFF:0x%x, LOWOFF__COLD:0x%x\n", __thm_reg_read(local_sensor_addr + SENSOR_OVERHEAT_HOT_THRES),
+		  __thm_reg_read(local_sensor_addr + SENSOR_HOT2NOR__HIGHOFF_THRES), __thm_reg_read(local_sensor_addr + SENSOR_LOWOFF__COLD_THRES));
+
+    // Restart sensor to enable new paramter
+	__thm_reg_write((local_sensor_addr + SENSOR_CTRL), 0x9, 0x9);
+
+	if (trip > 0)
+	{
+		//enable Hot int and Lowoff int
+		__thm_reg_write((local_sensor_addr + SENSOR_INT_CTRL),
+				SEN_HOT_INT_BIT | SEN_LOWOFF_INT_BIT,
+				SEN_HOT_INT_BIT | SEN_LOWOFF_INT_BIT);
+	}
+	else
+	{
+		//enable Hot int and disable LOWOFF int
+		__thm_reg_write((local_sensor_addr + SENSOR_INT_CTRL),
+				SEN_HOT_INT_BIT,
+				SEN_HOT_INT_BIT | SEN_LOWOFF_INT_BIT);
+	}
+
+	return 0;
+}
+
+u32 sprd_thm_temp2rawdata(u32 sensor, int temp)
+{
+	u32 high_bits, low_bits;
+	int i;
+	const short *high_tab;
+	const short *low_tab;
+
+	if (SPRD_ARM_SENSOR == sensor) {
+		high_tab = temp_search_high_40nm;
+		low_tab = temp_search_low_40nm;
+	} else if (SPRD_PMIC_SENSOR == sensor) {
+		high_tab = temp_search_high_152nm;
+		low_tab = temp_search_low_152nm;
+	} else {
+		printk(KERN_ERR "error thm sensor id:%d \n", sensor);
+		return 0;
+	}
+
+	if (temp < high_tab[0]) {
+		printk(KERN_ERR "temp over low temp:%d \n", temp);
+		return 0;
+	}
+
+	for (i = HIGH_TAB_SZ - 1; i >= 0; i--) {
+		if (high_tab[i] <= temp)
+			break;
+	}
+	if (i < 0) {
+		i = 0;
+	}
+	temp -= high_tab[i];
+	high_bits = i;
+
+	for (i = LOW_TAB_SZ - 1; i >= 0; i--) {
+		if (low_tab[i] <= temp)
+			break;
+	}
+	if (i < 0) {
+		i = 0;
+	}
+	low_bits = i;
+	return ((high_bits << HIGH_BITS_OFFSET) | low_bits);
+
+}
+
+int sprd_thm_rawdata2temp(u32 sensor, int rawdata)
+{
+	const short *high_tab;
+	const short *low_tab;
+
+	if (SPRD_ARM_SENSOR == sensor) {
+		high_tab = temp_search_high_40nm;
+		low_tab = temp_search_low_40nm;
+	} else if (SPRD_PMIC_SENSOR == sensor) {
+		high_tab = temp_search_high_152nm;
+		low_tab = temp_search_low_152nm;
+	} else {
+		printk(KERN_ERR "error thm sensor id:%d \n", sensor);
+		return 0;
+	}
+
+	return high_tab[(rawdata >> HIGH_BITS_OFFSET) & 0x07] +
+	    low_tab[rawdata & 0x0F];
+}
+
+int sprd_thm_temp_read(struct sprd_thermal_zone *pzone)
+{
+	u32 rawdata = 0;
+	int cal_offset = 0;
+	u32 sensor = pzone->sensor_id;
+
+	if (SPRD_ARM_SENSOR == sensor) {
+		rawdata = __thm_reg_read((SPRD_THM_BASE + SENSOR_TEMPER0_READ));
+		cal_offset = arm_sen_cal_offset;
+	} else if (SPRD_PMIC_SENSOR == sensor) {
+		rawdata = __thm_reg_read(ANA_THM_BASE + SENSOR_TEMPER0_READ);
+		cal_offset = pmic_sen_cal_offset;
+	} else {
+		printk(KERN_ERR "error thm sensor id:%d \n", sensor);
+		return 0;
+	}
+	THM_DEBUG("thm sensor id:%d, cal_offset:%d, rawdata:0x%x\n", sensor,
+		  cal_offset, rawdata);
+	return sprd_thm_rawdata2temp(sensor, rawdata) + cal_offset;
+}
+int sprd_thm_chip_id_check(void)
+{
+	u32 chip_id_tmp;
+
+	chip_id_tmp = sci_get_chip_id();
+
+#if !defined(CONFIG_ARCH_SCX15)
+	return 0;
+#else
+	if ((TSMC_DOLPHINW4T_CHIP_ID_1 == chip_id_tmp) || (TSMC_DOLPHINW4T_CHIP_ID_2 == chip_id_tmp) ||
+	   (TSMC_DOLPHINWT4T_CHIP_ID_1 == chip_id_tmp)) {
+		//printk("Sprd thm the chip support thermal CHIP_ID:0x%x \n",chip_id_tmp);
+		return 0;
+	} else {
+		printk("Sprd thm the chip don't support thermal CHIP_ID:0x%x \n",chip_id_tmp);
+		return -1;
+	}
+#endif
+}
+int sprd_thm_hw_init(struct sprd_thermal_zone *pzone)
+{
+	u32 local_sensor_addr, base_addr = 0;
+	u32 local_sen_id = 0;
+	u32 raw_temp = 0;
+	int cal_offset = 0;
+	struct sprd_thm_platform_data *trip_tab = pzone->trip_tab;
+
+	base_addr = (u32) pzone->reg_base;
+
+	printk(KERN_NOTICE "sprd_thm_hw_init 2713_thm id:%d,base 0x%x\n",
+	       pzone->sensor_id, base_addr);
+
+	if (SPRD_ARM_SENSOR == pzone->sensor_id) {
+		//ddie thm en
+		sci_glb_set(REG_AON_APB_APB_EB1, BIT_THM_EB);
+		sci_glb_set(REG_AON_APB_APB_RTC_EB,
+			    (BIT_THM_RTC_EB | BIT_ARM_THMA_RTC_EB |
+			     BIT_ARM_THMA_RTC_AUTO_EN));
+		cal_offset = arm_sen_cal_offset = 0;
+		local_sen_id = 0;
+	} else if (SPRD_PMIC_SENSOR == pzone->sensor_id) {
+		//adie thm en
+		sci_adi_set(ANA_REG_GLB_ARM_MODULE_EN, BIT_ANA_THM_EN);
+		sci_adi_set(ANA_REG_GLB_RTC_CLK_EN,
+			    BIT_RTC_THMA_AUTO_EN | BIT_RTC_THMA_EN |
+			    BIT_RTC_THM_EN);
+		cal_offset = pmic_sen_cal_offset = 0;
+		local_sen_id = 0;
+	} else {
+		printk(KERN_ERR "error thm sensor id:%d \n", pzone->sensor_id);
+		return -EINVAL;
+	}
+	__thm_reg_write((base_addr + THM_CTRL), 0x1 >> local_sen_id, 0);
+	__thm_reg_write((base_addr + THM_INT_CTRL), 0x3, 0);	//enable top int
+
+	local_sensor_addr = base_addr + local_sen_id * LOCAL_SENSOR_ADDR_OFF;
+
+	__thm_reg_write((local_sensor_addr + SENSOR_INT_CTRL), 0, ~0);	//disable all int
+	__thm_reg_write((local_sensor_addr + SENSOR_INT_CLR), ~0, 0);	//clr all int
+
+	//set int
+	if (trip_tab->num_trips > 0) {
+#if 0
+		//set hot
+		if (trip_tab->trip_points[0].type == THERMAL_TRIP_ACTIVE) {
+			raw_temp =
+			    sprd_thm_temp2rawdata(pzone->sensor_id,
+						  trip_tab->trip_points[0].
+						  temp - cal_offset);
+			if (raw_temp < RAW_TEMP_RANGE_MSK) {
+				raw_temp++;
+			}
+			//set hot int temp value
+			__thm_reg_write((local_sensor_addr +
+					 SENSOR_OVERHEAD_HOT_THRES), raw_temp,
+					RAW_TEMP_RANGE_MSK);
+			raw_temp =
+			    sprd_thm_temp2rawdata(pzone->sensor_id,
+						  trip_tab->trip_points[0].
+						  temp - HOT2NOR_RANGE -
+						  cal_offset);
+			//set hot2nor int temp value
+			__thm_reg_write((local_sensor_addr +
+					 SENSOR_HOT2NOR__HIGHOFF_THRES),
+					raw_temp << RAW_TEMP_OFFSET,
+					RAW_TEMP_RANGE_MSK << RAW_TEMP_OFFSET);
+			__thm_reg_write((local_sensor_addr + SENSOR_INT_CTRL),	//enable int
+					SEN_HOT2NOR_INT_BIT | SEN_HOT_INT_BIT,
+					0);
+		}
+#else
+		current_trip_num = 0;
+		sprd_thm_set_active_trip(pzone,current_trip_num);
+#endif
+		//set overheat
+		if (trip_tab->trip_points[trip_tab->num_trips - 1].type ==
+		    THERMAL_TRIP_CRITICAL) {
+			raw_temp =
+			    sprd_thm_temp2rawdata(pzone->sensor_id,
+						  trip_tab->trip_points
+						  [trip_tab->num_trips -
+						   1].temp - cal_offset);
+			//set overheat int temp value
+			__thm_reg_write((local_sensor_addr +
+					 SENSOR_OVERHEAT_HOT_THRES),
+					raw_temp << RAW_TEMP_OFFSET,
+					RAW_TEMP_RANGE_MSK << RAW_TEMP_OFFSET);
+			__thm_reg_write((local_sensor_addr + SENSOR_INT_CTRL),	//enable int
+					SEN_OVERHEAT_INT_BIT, 0);
+		}
+	}
+
+	printk(KERN_NOTICE "sprd_thm_hw_init addr 0x:%x,int ctrl 0x%x\n",
+	       local_sensor_addr,
+	       __thm_reg_read((local_sensor_addr + SENSOR_INT_CTRL)));
+
+	// Set sensor det period is 2.25S
+	__thm_reg_write((local_sensor_addr + SENSOR_DET_PERI), 0x2000, 0x2000);
+	__thm_reg_write((local_sensor_addr + SENSOR_CTRL), 0x101, 0x101);
+
+	// Start the sensor by set Sen_set_rdy(bit3)
+	__thm_reg_write((local_sensor_addr + SENSOR_CTRL), 0x8, 0x8);
+
+	return 0;
+
+}
+
+int sprd_thm_hw_disable_sensor(struct sprd_thermal_zone *pzone)
+{
+	int ret = 0;
+	// Sensor minitor disable
+	if(SPRD_ARM_SENSOR == pzone->sensor_id){
+		__thm_reg_write((u32)(pzone->reg_base + SENSOR_CTRL), 0x0, 0x8);
+		__thm_reg_write((u32)(pzone->reg_base + SENSOR_CTRL), 0x00, 0x01);
+	}
+	return ret;
+
+}
+
+int sprd_thm_hw_enable_sensor(struct sprd_thermal_zone *pzone)
+{
+	int ret = 0;
+	// Sensor minitor enable
+	THM_DEBUG("sprd_2713_thm enable sensor sensor_ID:0x%x \n",pzone->sensor_id);
+	if(SPRD_ARM_SENSOR == pzone->sensor_id){
+		__thm_reg_write((u32)(pzone->reg_base + SENSOR_CTRL), 0x01, 0x01);
+		__thm_reg_write((u32)(pzone->reg_base + SENSOR_CTRL), 0x8, 0x8);
+	}
+	return ret;
+
+}
+
+
+u16 int_ctrl_reg[SPRD_MAX_SENSOR];
+int sprd_thm_hw_suspend(struct sprd_thermal_zone *pzone)
+{
+	u32 local_sen_id = 0;
+	u32 local_sensor_addr;
+	int ret = 0;
+
+	local_sensor_addr =
+	    (u32) pzone->reg_base + local_sen_id * LOCAL_SENSOR_ADDR_OFF;
+	int_ctrl_reg[pzone->sensor_id] = __thm_reg_read((local_sensor_addr + SENSOR_INT_CTRL));
+
+	sprd_thm_hw_disable_sensor(pzone);
+	__thm_reg_write((local_sensor_addr + SENSOR_INT_CTRL), 0, ~0);	//disable all int
+	__thm_reg_write((local_sensor_addr + SENSOR_INT_CLR), ~0, 0);	//clr all int
+	return ret;
+}
+int sprd_thm_hw_resume(struct sprd_thermal_zone *pzone)
+{
+	u32 local_sen_id = 0;
+	u32 local_sensor_addr;
+	int ret = 0;
+
+	local_sensor_addr =
+	    (u32) pzone->reg_base + local_sen_id * LOCAL_SENSOR_ADDR_OFF;
+
+	sprd_thm_hw_enable_sensor(pzone);
+	if(SPRD_ARM_SENSOR == pzone->sensor_id){
+		__thm_reg_write((local_sensor_addr + SENSOR_INT_CLR), ~0, 0);	//clr all int
+		__thm_reg_write((local_sensor_addr + SENSOR_INT_CTRL), int_ctrl_reg[pzone->sensor_id], ~0);	//enable int of saved
+		__thm_reg_write((local_sensor_addr + SENSOR_CTRL), 0x9, 0);
+	}
+	return ret;
+}
+
+int sprd_thm_hw_irq_handle(struct sprd_thermal_zone *pzone)
+{
+	u32 local_sen_id = 0;
+	u32 local_sensor_addr;
+	u32 int_sts;
+	int ret = 0;
+	u32 overhead_hot_tem_cur = 0;
+	struct sprd_thm_platform_data *trip_tab = pzone->trip_tab;
+	int temp;
+
+	local_sensor_addr =
+	    (u32) pzone->reg_base + local_sen_id * LOCAL_SENSOR_ADDR_OFF;
+	int_sts = __thm_reg_read(local_sensor_addr + SENSOR_INT_STS);
+
+	__thm_reg_write((local_sensor_addr + SENSOR_INT_CLR), int_sts, ~0);	//CLR INT
+	temp = sprd_thm_temp_read(pzone->sensor_id);
+
+	printk("sprd_thm_hw_irq_handle --------@@@------id:%d, int_sts :0x%x \n",
+	     pzone->sensor_id, int_sts);
+	printk("sprd_thm_hw_irq_handle ------$$$--------temp:%d\n", temp);
+
+	overhead_hot_tem_cur = __thm_reg_read((local_sensor_addr + SENSOR_OVERHEAT_HOT_THRES))
+								& RAW_TEMP_RANGE_MSK;
+
+	if (int_sts & SEN_HOT_INT_BIT){
+		if ((current_trip_num) >= (trip_tab->num_trips - 2)){
+			current_trip_num = trip_tab->num_trips - 2;
+			return ret;
+		}
+		if (temp >= trip_tab->trip_points[current_trip_num].temp - INTOFFSET){
+			current_trip_num++;
+			sprd_thm_set_active_trip(pzone,current_trip_num);
+		}
+	}else if (int_sts & SEN_LOWOFF_INT_BIT){
+		if (temp < trip_tab->trip_points[current_trip_num].lowoff + INTOFFSET){
+			current_trip_num--;
+			sprd_thm_set_active_trip(pzone,current_trip_num);
+		}
+	}else{
+		THM_DEBUG("sprd_thm_hw_irq_handle NOT a HOT or LOWOFF interrupt \n");
+		return ret;
+	}
+	return ret;
+}