#include #include #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" #include "mach/mtk_mdm_monitor.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 unsigned int trip_temp[10] = {85000,80000,70000,60000,50000,40000,30000,20000,10000,5000}; static int g_THERMAL_TRIP[10] = {0,0,0,0,0,0,0,0,0,0}; static unsigned int cl_dev_sysrst_state = 0; static struct thermal_zone_device *thz_dev; static struct thermal_cooling_device *cl_dev_sysrst; static int mtktspa_debug_log = 0; static int kernelmode = 0; static int num_trip=0; static char g_bind0[20]="mtktspa-sysrst"; 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; #define mtktspa_TEMP_CRIT 85000 /* 85.000 degree Celsius */ #define mtktspa_dprintk(fmt, args...) \ do { \ if (mtktspa_debug_log) { \ pr_notice("Power/PA_Thermal" fmt, ##args); \ } \ } while(0) /* struct md_info{ char *attribute; int value; char *unit; int invalid_value; int index; }; struct md_info g_pinfo_list[] = {{"TXPWR_MD1", -127, "db", -127, 0}, {"TXPWR_MD2", -127, "db", -127, 1}, {"RFTEMP_2G_MD1", -32767, "¢XC", -32767, 2}, {"RFTEMP_2G_MD2", -32767, "¢XC", -32767, 3}, {"RFTEMP_3G_MD1", -32767, "¢XC", -32767, 4}, {"RFTEMP_3G_MD2", -32767, "¢XC", -32767, 5}}; */ static DEFINE_MUTEX(TSPA_lock); static int mtktspa_get_hw_temp(void) { struct md_info *p_info; int size, i; mutex_lock(&TSPA_lock); mtk_mdm_get_md_info(&p_info, &size); for(i=0; i100000) || (p_info[i].value<-30000)) printk("[Power/PA_Thermal] PA T=%d\n",p_info[i].value); mutex_unlock(&TSPA_lock); return (p_info[i].value); } } static int mtktspa_get_temp(struct thermal_zone_device *thermal, unsigned long *t) { *t = mtktspa_get_hw_temp(); if ((int) *t >= polling_trip_temp1) thermal->polling_delay = interval*1000; else if ((int) *t < polling_trip_temp2) thermal->polling_delay = interval * polling_factor2; else thermal->polling_delay = interval * polling_factor1; return 0; } static int mtktspa_bind(struct thermal_zone_device *thermal, struct thermal_cooling_device *cdev) { int table_val=0; if(!strcmp(cdev->type, g_bind0)) { table_val = 0; mtktspa_dprintk("[mtktspa_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind1)) { table_val = 1; mtktspa_dprintk("[mtktspa_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind2)) { table_val = 2; mtktspa_dprintk("[mtktspa_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind3)) { table_val = 3; mtktspa_dprintk("[mtktspa_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind4)) { table_val = 4; mtktspa_dprintk("[mtktspa_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind5)) { table_val = 5; mtktspa_dprintk("[mtktspa_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind6)) { table_val = 6; mtktspa_dprintk("[mtktspa_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind7)) { table_val = 7; mtktspa_dprintk("[mtktspa_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind8)) { table_val = 8; mtktspa_dprintk("[mtktspa_bind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind9)) { table_val = 9; mtktspa_dprintk("[mtktspa_bind] %s\n", cdev->type); } else return 0; if (mtk_thermal_zone_bind_cooling_device(thermal, table_val, cdev)) { mtktspa_dprintk("[mtktspa_bind] error binding cooling dev\n"); return -EINVAL; } else { mtktspa_dprintk("[mtktspa_bind] binding OK\n"); } return 0; } static int mtktspa_unbind(struct thermal_zone_device *thermal, struct thermal_cooling_device *cdev) { int table_val=0; if(!strcmp(cdev->type, g_bind0)) { table_val = 0; mtktspa_dprintk("[mtktspa_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind1)) { table_val = 1; mtktspa_dprintk("[mtktspa_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind2)) { table_val = 2; mtktspa_dprintk("[mtktspa_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind3)) { table_val = 3; mtktspa_dprintk("[mtktspa_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind4)) { table_val = 4; mtktspa_dprintk("[mtktspa_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind5)) { table_val = 5; mtktspa_dprintk("[mtktspa_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind6)) { table_val = 6; mtktspa_dprintk("[mtktspa_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind7)) { table_val = 7; mtktspa_dprintk("[mtktspa_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind8)) { table_val = 8; mtktspa_dprintk("[mtktspa_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind9)) { table_val = 9; mtktspa_dprintk("[mtktspa_unbind] %s\n", cdev->type); } else return 0; if (thermal_zone_unbind_cooling_device(thermal, table_val, cdev)) { mtktspa_dprintk("[mtktspa_unbind] error unbinding cooling dev\n"); return -EINVAL; } else { mtktspa_dprintk("[mtktspa_unbind] unbinding OK\n"); } return 0; } static int mtktspa_get_mode(struct thermal_zone_device *thermal, enum thermal_device_mode *mode) { *mode = (kernelmode) ? THERMAL_DEVICE_ENABLED : THERMAL_DEVICE_DISABLED; return 0; } static int mtktspa_set_mode(struct thermal_zone_device *thermal, enum thermal_device_mode mode) { kernelmode = mode; return 0; } static int mtktspa_get_trip_type(struct thermal_zone_device *thermal, int trip, enum thermal_trip_type *type) { *type = g_THERMAL_TRIP[trip]; return 0; } static int mtktspa_get_trip_temp(struct thermal_zone_device *thermal, int trip, unsigned long *temp) { *temp = trip_temp[trip]; return 0; } static int mtktspa_get_crit_temp(struct thermal_zone_device *thermal, unsigned long *temperature) { *temperature = mtktspa_TEMP_CRIT; return 0; } /* bind callback functions to thermalzone */ static struct thermal_zone_device_ops mtktspa_dev_ops = { .bind = mtktspa_bind, .unbind = mtktspa_unbind, .get_temp = mtktspa_get_temp, .get_mode = mtktspa_get_mode, .set_mode = mtktspa_set_mode, .get_trip_type = mtktspa_get_trip_type, .get_trip_temp = mtktspa_get_trip_temp, .get_crit_temp = mtktspa_get_crit_temp, }; /* * cooling device callback functions (mtktspa_cooling_sysrst_ops) * 1 : ON and 0 : OFF */ static int tspa_sysrst_get_max_state(struct thermal_cooling_device *cdev, unsigned long *state) { *state = 1; return 0; } static int tspa_sysrst_get_cur_state(struct thermal_cooling_device *cdev, unsigned long *state) { *state = cl_dev_sysrst_state; return 0; } static int tspa_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/PA_Thermal: reset, reset, reset!!!"); printk("@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@"); printk("*****************************************"); printk("@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@"); // BUG(); *(unsigned int*) 0x0 = 0xdead; // To trigger data abort to reset the system for thermal protection. //arch_reset(0,NULL); } return 0; } /* bind fan callbacks to fan device */ static struct thermal_cooling_device_ops mtktspa_cooling_sysrst_ops = { .get_max_state = tspa_sysrst_get_max_state, .get_cur_state = tspa_sysrst_get_cur_state, .set_cur_state = tspa_sysrst_set_cur_state, }; int mtktspa_register_thermal(void); void mtktspa_unregister_thermal(void); static int mtktspa_read(struct seq_file *m, void *v) { seq_printf(m, "[ mtktspa_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; } static ssize_t mtktspa_write(struct file *file, const char __user *buffer, size_t count, loff_t *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) { mtktspa_dprintk("[mtktspa_write] mtktspa_unregister_thermal\n"); mtktspa_unregister_thermal(); for(i=0; ipoll_queue)); } void mtkts_pa_start_thermal_timer(void) { //printk("mtkts_pa_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))); // 3sec } int mtktspa_register_cooler(void) { /* cooling devices */ cl_dev_sysrst = mtk_thermal_cooling_device_register("mtktspa-sysrst", NULL, &mtktspa_cooling_sysrst_ops); return 0; } int mtktspa_register_thermal(void) { mtktspa_dprintk("[mtktspa_register_thermal] \n"); /* trips */ thz_dev = mtk_thermal_zone_device_register("mtktspa", num_trip, NULL, &mtktspa_dev_ops, 0, 0, 0, interval*1000); mtk_mdm_set_md1_signal_period(interval); return 0; } void mtktspa_unregister_cooler(void) { if (cl_dev_sysrst) { mtk_thermal_cooling_device_unregister(cl_dev_sysrst); cl_dev_sysrst = NULL; } } void mtktspa_unregister_thermal(void) { mtktspa_dprintk("[mtktspa_unregister_thermal] \n"); if (thz_dev) { mtk_thermal_zone_device_unregister(thz_dev); thz_dev = NULL; } } static int __init mtktspa_init(void) { int err = 0; struct proc_dir_entry *entry = NULL; struct proc_dir_entry *mtktspa_dir = NULL; mtktspa_dprintk("[%s]\n", __func__); err = mtktspa_register_cooler(); if(err) return err; err = mtktspa_register_thermal(); if (err) goto err_unreg; mtktspa_dir = mtk_thermal_get_proc_drv_therm_dir_entry(); if (!mtktspa_dir) { mtktspa_dprintk("[%s]: mkdir /proc/driver/thermal failed\n", __func__); } else { entry = proc_create("tzpa", S_IRUGO | S_IWUSR | S_IWGRP, mtktspa_dir, &mtktspa_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: mtktspa_unregister_cooler(); return err; } static void __exit mtktspa_exit(void) { mtktspa_dprintk("[mtktspa_exit] \n"); mtktspa_unregister_thermal(); mtktspa_unregister_cooler(); } module_init(mtktspa_init); module_exit(mtktspa_exit);