static int tsallts_get_temp1(struct thermal_zone_device *thermal,
unsigned long *t)
{
#if MTK_ALLTS_SW_FILTER == 1
int curr_temp;
int temp_temp;
int ret = 0;
static int last_abb_read_temp = 0;
curr_temp = tsallts_get_ts1_temp();
tsallts_dprintk("tsallts_get_temp1 CPU TS1(MCU4)=%d\n", curr_temp);
if ((curr_temp > (trip_temp[0] - 15000)) || (curr_temp < -30000) || (curr_temp > 85000)) // abnormal high temp
tsallts_printk("TS1(MCU4) =%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
{
tsallts_printk("TS1(MCU4) 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
{
tsallts_printk("TS1(MCU4) 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 = tsallts_get_ts1_temp();
tsallts_dprintk("tsallts_get_temp TS1(MCU4)=%d\n", curr_temp);
if ((curr_temp > (trip_temp[0] - 15000)) || (curr_temp < -30000))
tsallts_printk("TS1(MCU4)=%d\n", curr_temp);
*t = curr_temp;
return 0;
#endif
}
static int tsallts_get_temp(struct thermal_zone_device *thermal, unsigned long *t)
{
#if MTK_ALLTS_SW_FILTER == 1
int curr_temp;
int temp_temp;
int ret = 0;
static int last_abb_read_temp;
curr_temp = get_immediate_ts2_wrap();
tsallts_dprintk("tsallts_get_temp CPU ts2 =%d\n", curr_temp);
/* abnormal high temp */
if ((curr_temp > (trip_temp[0] - 15000)) || (curr_temp < -30000) || (curr_temp > 85000))
tsallts_printk("ts2 =%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 */
tsallts_printk("ts2 temp invalid=%d\n", curr_temp);
temp_temp = 50000;
ret = -1;
} else if (last_abb_read_temp != 0) {
/* delta 20C, invalid change */
if ((curr_temp - last_abb_read_temp > 20000) || (last_abb_read_temp - curr_temp > 20000)) {
tsallts_printk("ts2 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 = get_immediate_ts2_wrap();
tsallts_dprintk("tsallts_get_temp ts2 =%d\n", curr_temp);
if ((curr_temp > (trip_temp[0] - 15000)) || (curr_temp < -30000))
tsallts_printk("ts2 =%d\n", curr_temp);
*t = curr_temp;
return 0;
#endif
}
static int tsallts_get_ts3_temp(void)
{
int t_ret = 0;
t_ret = get_immediate_ts3_wrap();
tsallts_dprintk("[tsallts_get_ts3_temp] TS3(MCU1) =%d\n", t_ret);
return t_ret;
}
static void tsallts_unregister_thermal(void)
{
tsallts_dprintk("[tsallts_unregister_thermal]\n");
if (thz_dev) {
mtk_thermal_zone_device_unregister(thz_dev);
thz_dev = NULL;
}
}
static int __init tsallts_init(void)
{
struct proc_dir_entry *entry = NULL;
struct proc_dir_entry *tsallts_dir = NULL;
tsallts_dprintk("[tsallts_init] ts2\n");
tsallts_dir = mtk_thermal_get_proc_drv_therm_dir_entry();
if (!tsallts_dir) {
tsallts_dprintk("[%s]: mkdir /proc/driver/thermal failed\n", __func__);
} else {
entry =
proc_create("tzts2", S_IRUGO | S_IWUSR | S_IWGRP, tsallts_dir, &tsallts_fops);
if (entry)
proc_set_user(entry, uid, gid);
}
return 0;
}
static int tsallts_read3(struct seq_file *m, void *v)
{
tsallts_dprintk( "tsallts_read3\n");
seq_printf(m, "[ tsallts_read3] 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);
return 0;
}
static void __exit tsallts_exit(void)
{
tsallts_dprintk("[tsallts_exit] ts2\n");
tsallts_unregister_thermal();
}
static ssize_t tsallts_write(struct file *file, const char __user *buffer, size_t count,
loff_t *data)
{
int len = 0, i;
struct temp_data {
int trip[10];
int t_type[10];
char bind0[20], bind1[20], bind2[20], bind3[20], bind4[20];
char bind5[20], bind6[20], bind7[20], bind8[20], bind9[20];
int time_msec;
char desc[512];
};
struct temp_data *ptr_temp_data = kmalloc(sizeof(*ptr_temp_data), GFP_KERNEL);
tsallts_printk("[tsallts_write_ts2]\n");
if (ptr_temp_data == NULL) {
pr_warn("[%s] kmalloc fail\n\n", __func__);
return -ENOMEM;
}
len = (count < (sizeof(ptr_temp_data->desc) - 1)) ? count : (sizeof(ptr_temp_data->desc) - 1);
if (copy_from_user(ptr_temp_data->desc, buffer, len)) {
kfree(ptr_temp_data);
return 0;
}
ptr_temp_data->desc[len] = '\0';
if (sscanf
(ptr_temp_data->desc,
"%d %d %d %19s %d %d %19s %d %d %19s %d %d %19s %d %d %19s %d %d %19s %d %d %19s %d %d %19s %d %d %19s %d %d %19s %d",
&num_trip,
&ptr_temp_data->trip[0], &ptr_temp_data->t_type[0], ptr_temp_data->bind0,
&ptr_temp_data->trip[1], &ptr_temp_data->t_type[1], ptr_temp_data->bind1,
&ptr_temp_data->trip[2], &ptr_temp_data->t_type[2], ptr_temp_data->bind2,
&ptr_temp_data->trip[3], &ptr_temp_data->t_type[3], ptr_temp_data->bind3,
&ptr_temp_data->trip[4], &ptr_temp_data->t_type[4], ptr_temp_data->bind4,
&ptr_temp_data->trip[5], &ptr_temp_data->t_type[5], ptr_temp_data->bind5,
&ptr_temp_data->trip[6], &ptr_temp_data->t_type[6], ptr_temp_data->bind6,
&ptr_temp_data->trip[7], &ptr_temp_data->t_type[7], ptr_temp_data->bind7,
&ptr_temp_data->trip[8], &ptr_temp_data->t_type[8], ptr_temp_data->bind8,
&ptr_temp_data->trip[9], &ptr_temp_data->t_type[9], ptr_temp_data->bind9,
&ptr_temp_data->time_msec) == 32) {
tsallts_dprintk("[tsallts_write_ts2] tsallts_unregister_thermal\n");
if (thz_dev) {
mtk_thermal_zone_device_unregister(thz_dev);
thz_dev = NULL;
}
if (num_trip < 0 || num_trip > 10) {
aee_kernel_warning_api(__FILE__, __LINE__, DB_OPT_DEFAULT, "tsallts_write2",
"Bad argument");
tsallts_dprintk("[tsallts_write2] bad argument\n");
kfree(ptr_temp_data);
return -EINVAL;
}
for (i = 0; i < num_trip; i++)
g_THERMAL_TRIP[i] = ptr_temp_data->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] = ptr_temp_data->bind0[i];
g_bind1[i] = ptr_temp_data->bind1[i];
g_bind2[i] = ptr_temp_data->bind2[i];
g_bind3[i] = ptr_temp_data->bind3[i];
g_bind4[i] = ptr_temp_data->bind4[i];
g_bind5[i] = ptr_temp_data->bind5[i];
g_bind6[i] = ptr_temp_data->bind6[i];
g_bind7[i] = ptr_temp_data->bind7[i];
g_bind8[i] = ptr_temp_data->bind8[i];
g_bind9[i] = ptr_temp_data->bind9[i];
}
tsallts_dprintk("[tsallts_write1] g_THERMAL_TRIP_0=%d,g_THERMAL_TRIP_1=%d,g_THERMAL_TRIP_2=%d,",
g_THERMAL_TRIP[0], g_THERMAL_TRIP[1], g_THERMAL_TRIP[2]);
tsallts_dprintk("g_THERMAL_TRIP_3=%d,g_THERMAL_TRIP_4=%d,g_THERMAL_TRIP_5=%d,g_THERMAL_TRIP_6=%d,",
g_THERMAL_TRIP[3], g_THERMAL_TRIP[4], g_THERMAL_TRIP[5], g_THERMAL_TRIP[6]);
tsallts_dprintk("g_THERMAL_TRIP_7=%d,g_THERMAL_TRIP_8=%d,g_THERMAL_TRIP_9=%d,\n",
g_THERMAL_TRIP[7], g_THERMAL_TRIP[8], g_THERMAL_TRIP[9]);
tsallts_dprintk("[tsallts_write1] cooldev0=%s,cooldev1=%s,cooldev2=%s,cooldev3=%s,",
g_bind0, g_bind1, g_bind2, g_bind3);
tsallts_dprintk("cooldev4=%s,cooldev5=%s,cooldev6=%s,cooldev7=%s,cooldev8=%s,cooldev9=%s\n",
g_bind4, g_bind5, g_bind6, g_bind7, g_bind8, g_bind9);
for (i = 0; i < num_trip; i++)
trip_temp[i] = ptr_temp_data->trip[i];
interval = ptr_temp_data->time_msec;
tsallts_dprintk("[tsallts_write] trip_0_temp=%d,trip_1_temp=%d,trip_2_temp=%d,trip_3_temp=%d,",
trip_temp[0], trip_temp[1], trip_temp[2], trip_temp[3]);
tsallts_dprintk("trip_4_temp=%d,trip_5_temp=%d,trip_6_temp=%d,trip_7_temp=%d,trip_8_temp=%d,",
trip_temp[4], trip_temp[5], trip_temp[6], trip_temp[7], trip_temp[8]);
tsallts_dprintk("trip_9_temp=%d,time_ms=%d\n", trip_temp[9], interval);
tsallts_dprintk("[tsallts_write1] tsallts_register_thermal\n");
if (NULL == thz_dev) {
thz_dev = mtk_thermal_zone_device_register("mtkts2", num_trip, NULL,
&tsallts_dev_ops, 0, 0, 0,
interval);
}
kfree(ptr_temp_data);
return count;
}
tsallts_dprintk("[tsallts_write1] bad argument\n");
aee_kernel_warning_api(__FILE__, __LINE__, DB_OPT_DEFAULT, "tsallts_write2",
"Bad argument");
kfree(ptr_temp_data);
return -EINVAL;
}
static int tsallts_unbind(struct thermal_zone_device *thermal, struct thermal_cooling_device *cdev)
{
int table_val = 0;
tsallts_dprintk("[tsallts_unbind_ts2]\n");
if (!strcmp(cdev->type, g_bind0)) {
table_val = 0;
tsallts_dprintk("[tsallts_unbind] %s\n", cdev->type);
} else if (!strcmp(cdev->type, g_bind1)) {
table_val = 1;
tsallts_dprintk("[tsallts_unbind] %s\n", cdev->type);
} else if (!strcmp(cdev->type, g_bind2)) {
table_val = 2;
tsallts_dprintk("[tsallts_unbind] %s\n", cdev->type);
} else if (!strcmp(cdev->type, g_bind3)) {
table_val = 3;
tsallts_dprintk("[tsallts_unbind] %s\n", cdev->type);
} else if (!strcmp(cdev->type, g_bind4)) {
table_val = 4;
tsallts_dprintk("[tsallts_unbind] %s\n", cdev->type);
} else if (!strcmp(cdev->type, g_bind5)) {
table_val = 5;
tsallts_dprintk("[tsallts_unbind] %s\n", cdev->type);
} else if (!strcmp(cdev->type, g_bind6)) {
table_val = 6;
tsallts_dprintk("[tsallts_unbind] %s\n", cdev->type);
} else if (!strcmp(cdev->type, g_bind7)) {
table_val = 7;
tsallts_dprintk("[tsallts_unbind] %s\n", cdev->type);
} else if (!strcmp(cdev->type, g_bind8)) {
table_val = 8;
tsallts_dprintk("[tsallts_unbind] %s\n", cdev->type);
} else if (!strcmp(cdev->type, g_bind9)) {
table_val = 9;
tsallts_dprintk("[tsallts_unbind] %s\n", cdev->type);
} else
return 0;
if (thermal_zone_unbind_cooling_device(thermal, table_val, cdev)) {
tsallts_dprintk("[tsallts_unbind_ts2] error unbinding cooling dev\n");
return -EINVAL;
}
tsallts_dprintk("[tsallts_unbind_ts2] unbinding OK\n");
return 0;
}
static ssize_t tsallts_write1(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];
tsallts_printk("[tsallts_write1] \n");
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 %19s %d %d %19s %d %d %19s %d %d %19s %d %d %19s %d %d %19s %d %d %19s %d %d %19s %d %d %19s %d %d %19s %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)
{
tsallts_dprintk("[tsallts_write1] tsallts_unregister_thermal\n");
tsallts_unregister_thermal();
if(num_trip<0) return -EINVAL;
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];
}
tsallts_dprintk("[tsallts_write1] 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]);
tsallts_dprintk("[tsallts_write1] 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;
tsallts_dprintk("[tsallts_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);
tsallts_dprintk("[tsallts_write1] tsallts_register_thermal\n");
tsallts_register_thermal();
return count;
}