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; i < size; i++) {
mtktspa_dprintk("PA temperature: name:%s, vaule:%d, invalid_value=%d\n",
p_info[i].attribute, p_info[i].value, p_info[i].invalid_value);
if (!strcmp(p_info[i].attribute, "RFTEMP_2G_MD1")) {
mtktspa_dprintk("PA temperature: RFTEMP_2G_MD1\n");
if (p_info[i].value != p_info[i].invalid_value)
break;
} else if (!strcmp(p_info[i].attribute, "RFTEMP_3G_MD1")) {
mtktspa_dprintk("PA temperature: RFTEMP_3G_MD1\n");
if (p_info[i].value != p_info[i].invalid_value)
break;
}
}
if (i == size) {
mtktspa_dprintk("PA temperature: not ready\n");
mutex_unlock(&TSPA_lock);
return -127000;
} else {
mtktspa_dprintk("PA temperature: %d\n", p_info[i].value);
if ((p_info[i].value > 100000) || (p_info[i].value < -30000))
pr_debug("[Power/PA_Thermal] PA T=%d\n", p_info[i].value);
mutex_unlock(&TSPA_lock);
return (p_info[i].value);
}
}
static int mtktspa_get_hw_temp(void)
{
kal_int32 t_ret=0;
if(ts_pa_at_boot_time==0){
ts_pa_at_boot_time=1;
mtktspa_dprintk("[mtktspa_get_hw_temp] at boot time, return 25000 as default\n");
return 25000;
}
t_ret = last_pa_t;
mtktspa_dprintk("[mtktspa_get_hw_temp] T_PA, %d\n", t_ret);
return t_ret;
}
void mtktspa_unregister_thermal(void)
{
mtktspa_dprintk("[mtktspa_unregister_thermal]\n");
if (thz_dev) {
mtk_thermal_zone_device_unregister(thz_dev);
thz_dev = NULL;
}
}
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;
}
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 int ntc6290_get_temp(struct thermal_zone_device *thermal,
unsigned long *t)
{
*t = ntc6290_get_hw_temp();
// set new threshold
{
int i = ntc6290_num_trip - 1;
for (; i >= 0; i--)
{
if (ntc6290_trip_temp[i] > *t)
{
mtk_mdm_set_mdinfoex_threshold(0, ntc6290_trip_temp[i]/1000);
break;
}
}
}
if (*t > 85000)
mtktspa_dprintk("%s temp=%lu\n", __func__, *t);
return 0;
}
static void __exit mtktspa_exit(void)
{
mtktspa_dprintk("[mtktspa_exit]\n");
mtktspa_unregister_thermal();
mtktspa_unregister_cooler();
}
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; 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];
}
mtktspa_dprintk("[mtktspa_write] 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]);
mtktspa_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]);
mtktspa_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]);
mtktspa_dprintk("[mtktspa_write] cooldev0=%s,cooldev1=%s,cooldev2=%s,cooldev3=%s,cooldev4=%s,",
g_bind0, g_bind1, g_bind2, g_bind3, g_bind4);
mtktspa_dprintk("cooldev5=%s,cooldev6=%s,cooldev7=%s,cooldev8=%s,cooldev9=%s\n",
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;
mtktspa_dprintk("[mtktspa_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]);
mtktspa_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]);
mtktspa_dprintk("trip_9_temp=%d,time_ms=%d\n", trip_temp[9], interval * 1000);
mtktspa_dprintk("[mtktspa_write] mtktspa_register_thermal\n");
mtktspa_register_thermal();
return count;
} else {
mtktspa_dprintk("[mtktspa_write] bad argument\n");
}
return -EINVAL;
}
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 ntc6290_bind(struct thermal_zone_device *thermal,
struct thermal_cooling_device *cdev)
{
int table_val=0;
if(!strcmp(cdev->type, ntc6290_bind0))
{
table_val = 0;
mtktspa_dprintk("[%s] %s\n", __func__, cdev->type);
}
else if(!strcmp(cdev->type, ntc6290_bind1))
{
table_val = 1;
mtktspa_dprintk("[%s] %s\n", __func__, cdev->type);
}
else if(!strcmp(cdev->type, ntc6290_bind2))
{
table_val = 2;
mtktspa_dprintk("[%s] %s\n", __func__, cdev->type);
}
else if(!strcmp(cdev->type, ntc6290_bind3))
{
table_val = 3;
mtktspa_dprintk("[%s] %s\n", __func__, cdev->type);
}
else if(!strcmp(cdev->type, ntc6290_bind4))
{
table_val = 4;
mtktspa_dprintk("[%s] %s\n", __func__, cdev->type);
}
else if(!strcmp(cdev->type, ntc6290_bind5))
{
table_val = 5;
mtktspa_dprintk("[%s] %s\n", __func__, cdev->type);
}
else if(!strcmp(cdev->type, ntc6290_bind6))
{
table_val = 6;
mtktspa_dprintk("[%s] %s\n", __func__, cdev->type);
}
else if(!strcmp(cdev->type, ntc6290_bind7))
{
table_val = 7;
mtktspa_dprintk("[%s] %s\n", __func__, cdev->type);
}
else if(!strcmp(cdev->type, ntc6290_bind8))
{
table_val = 8;
mtktspa_dprintk("[%s] %s\n", __func__, cdev->type);
}
else if(!strcmp(cdev->type, ntc6290_bind9))
{
table_val = 9;
mtktspa_dprintk("[%s] %s\n", __func__, cdev->type);
}
else
return 0;
if (mtk_thermal_zone_bind_cooling_device(thermal, table_val, cdev))
{
mtktspa_dprintk("[%s] error binding cooling dev\n", __func__);
return -EINVAL;
}
else
{
mtktspa_dprintk("[%s] binding OK\n", __func__);
}
return 0;
}