static int mtktsabb_get_temp(struct thermal_zone_device *thermal, unsigned long *t) { #if MTK_TS_ABB_SW_FILTER == 1 int curr_temp; int temp_temp; int ret = 0; static int last_abb_read_temp = 0; curr_temp = mtktsabb_get_hw_temp(); mtktsabb_dprintk("mtktsabb_get_temp CPU T2=%d\n", curr_temp); if ((curr_temp > (trip_temp[0] - 15000)) || (curr_temp < -30000)) // abnormal high temp printk("[Power/ABB_Thermal] ABB T=%d\n", curr_temp); temp_temp = curr_temp; if (curr_temp != 0) // not the first temp read after resume from suspension { if ((curr_temp > 150000) || (curr_temp < -20000)) // invalid range { printk("[Power/ABB_Thermal] ABB temp invalid=%d\n", curr_temp); temp_temp = 50000; ret = -1; } else if (last_abb_read_temp != 0) { if ((curr_temp - last_abb_read_temp > 20000) ||(last_abb_read_temp - curr_temp > 20000)) //delta 20C, invalid change { printk("[Power/ABB_Thermal] ABB temp float hugely temp=%d, lasttemp=%d\n", curr_temp, last_abb_read_temp); temp_temp = 50000; ret = -1; } } } last_abb_read_temp = curr_temp; curr_temp = temp_temp; *t = (unsigned long) curr_temp; return ret; #else int curr_temp; curr_temp = mtktsabb_get_hw_temp(); mtktsabb_dprintk(" mtktsabb_get_temp CPU T2=%d\n", curr_temp); if ((curr_temp > (trip_temp[0] - 15000)) || (curr_temp < -30000)) printk("[Power/ABB_Thermal] ABB T=%d\n", curr_temp); *t = curr_temp; return 0; #endif }
static int mtktsabb_get_hw_temp(void) { int t_ret = 0; t_ret = last_abb_t; mtktsabb_dprintk("[mtktsabb_get_hw_temp] T_ABB, %d\n", t_ret); return t_ret; }
static int mtktsabb_get_temp(struct thermal_zone_device *thermal, unsigned long *t) { // int curr_temp; *t = mtktsabb_get_hw_temp(); mtktsabb_dprintk(" mtktsabb_get_temp CPU T2=%d\n",*t ); return 0; }
static ssize_t mtktsabb_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) { mtktsabb_dprintk("[mtktsabb_write] mtktsabb_unregister_thermal\n"); mtktsabb_unregister_thermal(); for(i=0; i<num_trip; i++) g_THERMAL_TRIP[i] = t_type[i]; g_bind0[0]=g_bind1[0]=g_bind2[0]=g_bind3[0]=g_bind4[0]=g_bind5[0]=g_bind6[0]=g_bind7[0]=g_bind8[0]=g_bind9[0]='\0'; for(i=0; i<20; i++) { g_bind0[i]=bind0[i]; g_bind1[i]=bind1[i]; g_bind2[i]=bind2[i]; g_bind3[i]=bind3[i]; g_bind4[i]=bind4[i]; g_bind5[i]=bind5[i]; g_bind6[i]=bind6[i]; g_bind7[i]=bind7[i]; g_bind8[i]=bind8[i]; g_bind9[i]=bind9[i]; } mtktsabb_dprintk("[mtktsabb_write] 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,\ 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", 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]); mtktsabb_dprintk("[mtktsabb_write] cooldev0=%s,cooldev1=%s,cooldev2=%s,cooldev3=%s,cooldev4=%s,\ cooldev5=%s,cooldev6=%s,cooldev7=%s,cooldev8=%s,cooldev9=%s\n", g_bind0,g_bind1,g_bind2,g_bind3,g_bind4,g_bind5,g_bind6,g_bind7,g_bind8,g_bind9); for(i=0; i<num_trip; i++) { trip_temp[i]=trip[i]; } interval=time_msec / 1000; mtktsabb_dprintk("[mtktsabb_write] trip_0_temp=%d,trip_1_temp=%d,trip_2_temp=%d,trip_3_temp=%d,trip_4_temp=%d,\ trip_5_temp=%d,trip_6_temp=%d,trip_7_temp=%d,trip_8_temp=%d,trip_9_temp=%d,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],interval*1000); mtktsabb_dprintk("[mtktsabb_write] mtktsabb_register_thermal\n"); mtktsabb_register_thermal(); return count; }
static int mtktsabb_unbind(struct thermal_zone_device *thermal, struct thermal_cooling_device *cdev) { int table_val=0; if(!strcmp(cdev->type, g_bind0)) { table_val = 0; mtktsabb_dprintk("[mtktsabb_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind1)) { table_val = 1; mtktsabb_dprintk("[mtktsabb_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind2)) { table_val = 2; mtktsabb_dprintk("[mtktsabb_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind3)) { table_val = 3; mtktsabb_dprintk("[mtktsabb_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind4)) { table_val = 4; mtktsabb_dprintk("[mtktsabb_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind5)) { table_val = 5; mtktsabb_dprintk("[mtktsabb_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind6)) { table_val = 6; mtktsabb_dprintk("[mtktsabb_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind7)) { table_val = 7; mtktsabb_dprintk("[mtktsabb_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind8)) { table_val = 8; mtktsabb_dprintk("[mtktsabb_unbind] %s\n", cdev->type); } else if(!strcmp(cdev->type, g_bind9)) { table_val = 9; mtktsabb_dprintk("[mtktsabb_unbind] %s\n", cdev->type); } else return 0; if (thermal_zone_unbind_cooling_device(thermal, table_val, cdev)) { mtktsabb_dprintk("[mtktsabb_unbind] error unbinding cooling dev\n"); return -EINVAL; } else { mtktsabb_dprintk("[mtktsabb_unbind] unbinding OK\n"); } return 0; }