#include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "mach/mtk_thermal_monitor.h" #include "mach/mt_typedefs.h" #include "mach/mt_thermal.h" extern struct proc_dir_entry * mtk_thermal_get_proc_drv_therm_dir_entry(void); static unsigned int interval = 0; /* seconds, 0 : no auto polling */ static int trip_temp[10] = {120000,110000,100000,90000,80000,70000,65000,60000,55000,50000}; //static unsigned int cl_dev_dis_charge_state = 0; static unsigned int cl_dev_sysrst_state = 0; static struct thermal_zone_device *thz_dev; //static struct thermal_cooling_device *cl_dev_dis_charge; static struct thermal_cooling_device *cl_dev_sysrst; static int mtktsbattery_debug_log = 0; static int kernelmode = 0; static int g_THERMAL_TRIP[10] = {0,0,0,0,0,0,0,0,0,0}; static int num_trip=0; static char g_bind0[20]={0}; static char g_bind1[20]={0}; static char g_bind2[20]={0}; static char g_bind3[20]={0}; static char g_bind4[20]={0}; static char g_bind5[20]={0}; static char g_bind6[20]={0}; static char g_bind7[20]={0}; static char g_bind8[20]={0}; static char g_bind9[20]={0}; /** * If curr_temp >= polling_trip_temp1, use interval * else if cur_temp >= polling_trip_temp2 && curr_temp < polling_trip_temp1, use interval*polling_factor1 * else, use interval*polling_factor2 */ static int polling_trip_temp1 = 40000; static int polling_trip_temp2 = 20000; static int polling_factor1 = 5000; static int polling_factor2 = 10000; extern int read_tbat_value(void); //static int battery_write_flag=0; #define mtktsbattery_TEMP_CRIT 60000 /* 60.000 degree Celsius */ #define mtktsbattery_dprintk(fmt, args...) \ do { \ if (mtktsbattery_debug_log) { \ pr_notice("Power/Battery_Thermal" fmt, ##args); \ } \ } while(0) /* * kernel fopen/fclose */ /* static mm_segment_t oldfs; static void my_close(int fd) { set_fs(oldfs); sys_close(fd); } static int my_open(char *fname, int flag) { oldfs = get_fs(); set_fs(KERNEL_DS); return sys_open(fname, flag, 0); } */ static int get_hw_battery_temp(void) { /* int fd; char buf[64]; char *pmtdbufp = NULL; ssize_t pmtdsize; char *pvalue = NULL; int got_value=0; //open file and read current value fd = my_open("/sys/class/power_supply/battery/batt_temp", O_RDONLY); if (fd < 0) { mtktsbattery_dprintk("[get_hw_battery_temp]: open file fail"); return 0; } mtktsbattery_dprintk("[get_hw_battery_temp]: open file ok"); buf[sizeof(buf) - 1] = '\0'; pmtdsize = sys_read(fd, buf, sizeof(buf) - 1); pmtdbufp = buf; got_value = simple_strtol(pmtdbufp,&pvalue,10); // close file my_close(fd); // debug mtktsbattery_dprintk("[get_hw_battery_temp]: got_value=%d\n", got_value); return got_value; */ int ret=0; #if defined(CONFIG_POWER_EXT) //EVB ret = -1270; #else //Phone ret = read_tbat_value(); ret = ret * 10; #endif return ret; } static DEFINE_MUTEX(Battery_lock); int ts_battery_at_boot_time=0; static int mtktsbattery_get_hw_temp(void) { int t_ret=0; static int battery[60]={0}; static int counter=0, first_time=0; if(ts_battery_at_boot_time==0) { ts_battery_at_boot_time=1; mtktsbattery_dprintk("[mtktsbattery_get_hw_temp] at boot time, return 25000 as default\n"); battery[counter]=25000; counter++; return 25000; } mutex_lock(&Battery_lock); //get HW battery temp (TSBATTERY) //cat /sys/class/power_supply/battery/batt_temp t_ret = get_hw_battery_temp(); t_ret = t_ret * 100; mutex_unlock(&Battery_lock); if(t_ret) mtktsbattery_dprintk("[mtktsbattery_get_hw_temp] counter=%d, first_time =%d\n", counter, first_time); mtktsbattery_dprintk("[mtktsbattery_get_hw_temp] T_Battery, %d\n", t_ret); return t_ret; } static int mtktsbattery_get_temp(struct thermal_zone_device *thermal, unsigned long *t) { *t = mtktsbattery_get_hw_temp(); if ((int) *t >= polling_trip_temp1) thermal->polling_delay = interval*1000; else if ((int) *t < polling_trip_temp2) #ifdef MEIZU_M81 thermal->polling_delay = 0; #else thermal->polling_delay = interval * polling_factor2; #endif else #ifdef MEIZU_M81 thermal->polling_delay = 0; #else thermal->polling_delay = interval * polling_factor1; #endif return 0; } static int mtktsbattery_bind(struct thermal_zone_device *thermal, struct thermal_cooling_device *cdev) { int table_val=0; if(!strcmp(cdev->type, g_bind0)) { table_val = 0; mtktsbattery_dprintk("[mtktsbattery_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind1)) { table_val = 1; mtktsbattery_dprintk("[mtktsbattery_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind2)) { table_val = 2; mtktsbattery_dprintk("[mtktsbattery_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind3)) { table_val = 3; mtktsbattery_dprintk("[mtktsbattery_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind4)) { table_val = 4; mtktsbattery_dprintk("[mtktsbattery_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind5)) { table_val = 5; mtktsbattery_dprintk("[mtktsbattery_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind6)) { table_val = 6; mtktsbattery_dprintk("[mtktsbattery_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind7)) { table_val = 7; mtktsbattery_dprintk("[mtktsbattery_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind8)) { table_val = 8; mtktsbattery_dprintk("[mtktsbattery_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind9)) { table_val = 9; mtktsbattery_dprintk("[mtktsbattery_bind] %s\n", cdev->type); } else { return 0; } if (mtk_thermal_zone_bind_cooling_device(thermal, table_val, cdev)) { mtktsbattery_dprintk("[mtktsbattery_bind] error binding cooling dev\n"); return -EINVAL; } else { mtktsbattery_dprintk("[mtktsbattery_bind] binding OK, %d\n", table_val); } return 0; } static int mtktsbattery_unbind(struct thermal_zone_device *thermal, struct thermal_cooling_device *cdev) { int table_val=0; if(!strcmp(cdev->type, g_bind0)) { table_val = 0; mtktsbattery_dprintk("[mtktsbattery_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind1)) { table_val = 1; mtktsbattery_dprintk("[mtktsbattery_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind2)) { table_val = 2; mtktsbattery_dprintk("[mtktsbattery_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind3)) { table_val = 3; mtktsbattery_dprintk("[mtktsbattery_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind4)) { table_val = 4; mtktsbattery_dprintk("[mtktsbattery_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind5)) { table_val = 5; mtktsbattery_dprintk("[mtktsbattery_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind6)) { table_val = 6; mtktsbattery_dprintk("[mtktsbattery_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind7)) { table_val = 7; mtktsbattery_dprintk("[mtktsbattery_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind8)) { table_val = 8; mtktsbattery_dprintk("[mtktsbattery_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind9)) { table_val = 9; mtktsbattery_dprintk("[mtktsbattery_unbind] %s\n", cdev->type); } else return 0; if (thermal_zone_unbind_cooling_device(thermal, table_val, cdev)) { mtktsbattery_dprintk("[mtktsbattery_unbind] error unbinding cooling dev\n"); return -EINVAL; } else { mtktsbattery_dprintk("[mtktsbattery_unbind] unbinding OK\n"); } return 0; } static int mtktsbattery_get_mode(struct thermal_zone_device *thermal, enum thermal_device_mode *mode) { *mode = (kernelmode) ? THERMAL_DEVICE_ENABLED : THERMAL_DEVICE_DISABLED; return 0; } static int mtktsbattery_set_mode(struct thermal_zone_device *thermal, enum thermal_device_mode mode) { kernelmode = mode; return 0; } static int mtktsbattery_get_trip_type(struct thermal_zone_device *thermal, int trip, enum thermal_trip_type *type) { *type = g_THERMAL_TRIP[trip]; return 0; } static int mtktsbattery_get_trip_temp(struct thermal_zone_device *thermal, int trip, unsigned long *temp) { *temp = trip_temp[trip]; return 0; } static int mtktsbattery_get_crit_temp(struct thermal_zone_device *thermal, unsigned long *temperature) { *temperature = mtktsbattery_TEMP_CRIT; return 0; } /* bind callback functions to thermalzone */ static struct thermal_zone_device_ops mtktsbattery_dev_ops = { .bind = mtktsbattery_bind, .unbind = mtktsbattery_unbind, .get_temp = mtktsbattery_get_temp, .get_mode = mtktsbattery_get_mode, .set_mode = mtktsbattery_set_mode, .get_trip_type = mtktsbattery_get_trip_type, .get_trip_temp = mtktsbattery_get_trip_temp, .get_crit_temp = mtktsbattery_get_crit_temp, }; /* static int dis_charge_get_max_state(struct thermal_cooling_device *cdev, unsigned long *state) { *state = 1; return 0; } static int dis_charge_get_cur_state(struct thermal_cooling_device *cdev, unsigned long *state) { *state = cl_dev_dis_charge_state; return 0; } static int dis_charge_set_cur_state(struct thermal_cooling_device *cdev, unsigned long state) { cl_dev_dis_charge_state = state; if(cl_dev_dis_charge_state == 1) { mtktsbattery_dprintk("[dis_charge_set_cur_state] disable charging\n"); } return 0; } */ static int tsbat_sysrst_get_max_state(struct thermal_cooling_device *cdev, unsigned long *state) { *state = 1; return 0; } static int tsbat_sysrst_get_cur_state(struct thermal_cooling_device *cdev, unsigned long *state) { *state = cl_dev_sysrst_state; return 0; } static int tsbat_sysrst_set_cur_state(struct thermal_cooling_device *cdev, unsigned long state) { cl_dev_sysrst_state = state; if(cl_dev_sysrst_state == 1) { printk("Power/battery_Thermal: reset, reset, reset!!!"); printk("@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@"); printk("*****************************************"); printk("@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@"); // BUG(); //arch_reset(0,NULL); *(unsigned int*) 0x0 = 0xdead; // To trigger data abort to reset the system for thermal protection. } return 0; } /* static struct thermal_cooling_device_ops mtktsbattery_cooling_dis_charge_ops = { .get_max_state = dis_charge_get_max_state, .get_cur_state = dis_charge_get_cur_state, .set_cur_state = dis_charge_set_cur_state, };*/ static struct thermal_cooling_device_ops mtktsbattery_cooling_sysrst_ops = { .get_max_state = tsbat_sysrst_get_max_state, .get_cur_state = tsbat_sysrst_get_cur_state, .set_cur_state = tsbat_sysrst_set_cur_state, }; static int mtktsbattery_read(struct seq_file *m, void *v) //static int mtktsbattery_read(char *buf, char **start, off_t off, int count, int *eof, void *data) { seq_printf(m, "[mtktsbattery_read] trip_0_temp=%d,trip_1_temp=%d,trip_2_temp=%d,trip_3_temp=%d,trip_4_temp=%d,\n\ trip_5_temp=%d,trip_6_temp=%d,trip_7_temp=%d,trip_8_temp=%d,trip_9_temp=%d,\n\ g_THERMAL_TRIP_0=%d,g_THERMAL_TRIP_1=%d,g_THERMAL_TRIP_2=%d,g_THERMAL_TRIP_3=%d,g_THERMAL_TRIP_4=%d,\n\ g_THERMAL_TRIP_5=%d,g_THERMAL_TRIP_6=%d,g_THERMAL_TRIP_7=%d,g_THERMAL_TRIP_8=%d,g_THERMAL_TRIP_9=%d,\n\ cooldev0=%s,cooldev1=%s,cooldev2=%s,cooldev3=%s,cooldev4=%s,\n\ cooldev5=%s,cooldev6=%s,cooldev7=%s,cooldev8=%s,cooldev9=%s,time_ms=%d\n", trip_temp[0],trip_temp[1],trip_temp[2],trip_temp[3],trip_temp[4], trip_temp[5],trip_temp[6],trip_temp[7],trip_temp[8],trip_temp[9], g_THERMAL_TRIP[0],g_THERMAL_TRIP[1],g_THERMAL_TRIP[2],g_THERMAL_TRIP[3],g_THERMAL_TRIP[4], g_THERMAL_TRIP[5],g_THERMAL_TRIP[6],g_THERMAL_TRIP[7],g_THERMAL_TRIP[8],g_THERMAL_TRIP[9], g_bind0,g_bind1,g_bind2,g_bind3,g_bind4,g_bind5,g_bind6,g_bind7,g_bind8,g_bind9, interval*1000); return 0; } int mtktsbattery_register_thermal(void); void mtktsbattery_unregister_thermal(void); static ssize_t mtktsbattery_write(struct file *file, const char __user *buffer, size_t count, loff_t *data) //static ssize_t mtktsbattery_write(struct file *file, const char *buffer, unsigned long count, void *data) { int len=0,time_msec=0; int trip[10]={0}; int t_type[10]={0}; int i; char bind0[20],bind1[20],bind2[20],bind3[20],bind4[20]; char bind5[20],bind6[20],bind7[20],bind8[20],bind9[20]; char desc[512]; len = (count < (sizeof(desc) - 1)) ? count : (sizeof(desc) - 1); if (copy_from_user(desc, buffer, len)) { return 0; } desc[len] = '\0'; if (sscanf(desc, "%d %d %d %s %d %d %s %d %d %s %d %d %s %d %d %s %d %d %s %d %d %s %d %d %s %d %d %s %d %d %s %d", &num_trip, &trip[0],&t_type[0],bind0, &trip[1],&t_type[1],bind1, &trip[2],&t_type[2],bind2, &trip[3],&t_type[3],bind3, &trip[4],&t_type[4],bind4, &trip[5],&t_type[5],bind5, &trip[6],&t_type[6],bind6, &trip[7],&t_type[7],bind7, &trip[8],&t_type[8],bind8, &trip[9],&t_type[9],bind9, &time_msec) == 32) { mtktsbattery_dprintk("[mtktsbattery_write] mtktsbattery_unregister_thermal\n"); mtktsbattery_unregister_thermal(); for(i=0; ipoll_queue)); } void mtkts_battery_start_thermal_timer(void) { //printk("mtkts_battery_start_thermal_timer \n"); // resume thermal framework polling when leaving deep idle if (thz_dev != NULL && interval != 0) mod_delayed_work(system_freezable_wq, &(thz_dev->poll_queue), round_jiffies(msecs_to_jiffies(3000))); // 2sec } int mtktsbattery_register_cooler(void) { /* cooling devices */ cl_dev_sysrst = mtk_thermal_cooling_device_register("mtktsbattery-sysrst", NULL, &mtktsbattery_cooling_sysrst_ops); return 0; } int mtktsbattery_register_thermal(void) { mtktsbattery_dprintk("[mtktsbattery_register_thermal] \n"); /* trips : trip 0~1 */ thz_dev = mtk_thermal_zone_device_register("mtktsbattery", num_trip, NULL, &mtktsbattery_dev_ops, 0, 0, 0, interval*1000); return 0; } void mtktsbattery_unregister_cooler(void) { if (cl_dev_sysrst) { mtk_thermal_cooling_device_unregister(cl_dev_sysrst); cl_dev_sysrst = NULL; } } void mtktsbattery_unregister_thermal(void) { mtktsbattery_dprintk("[mtktsbattery_unregister_thermal] \n"); if (thz_dev) { mtk_thermal_zone_device_unregister(thz_dev); thz_dev = NULL; } } static int mtkts_battery_open(struct inode *inode, struct file *file) { return single_open(file, mtktsbattery_read, NULL); } static const struct file_operations mtkts_battery_fops = { .owner = THIS_MODULE, .open = mtkts_battery_open, .read = seq_read, .llseek = seq_lseek, .write = mtktsbattery_write, .release = single_release, }; static int __init mtktsbattery_init(void) { int err = 0; struct proc_dir_entry *entry = NULL; struct proc_dir_entry *mtktsbattery_dir = NULL; mtktsbattery_dprintk("[mtktsbattery_init] \n"); err = mtktsbattery_register_cooler(); if(err) return err; err = mtktsbattery_register_thermal(); if (err) goto err_unreg; mtktsbattery_dir = mtk_thermal_get_proc_drv_therm_dir_entry(); if (!mtktsbattery_dir) { mtktsbattery_dprintk("%s mkdir /proc/driver/thermal failed\n", __func__); } else { entry = proc_create("tzbattery", S_IRUGO | S_IWUSR | S_IWGRP, mtktsbattery_dir, &mtkts_battery_fops); if (entry) { #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0) proc_set_user(entry, 0, 1000); #else entry->gid = 1000; #endif } } return 0; err_unreg: mtktsbattery_unregister_cooler(); return err; } static void __exit mtktsbattery_exit(void) { mtktsbattery_dprintk("[mtktsbattery_exit] \n"); mtktsbattery_unregister_thermal(); mtktsbattery_unregister_cooler(); } module_init(mtktsbattery_init); module_exit(mtktsbattery_exit);