622 lines
18 KiB
C
622 lines
18 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright (C) 2019 MediaTek Inc.
|
|
*/
|
|
#include <linux/version.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/dmi.h>
|
|
#include <linux/acpi.h>
|
|
#include <linux/thermal.h>
|
|
#include <linux/platform_device.h>
|
|
#include <mt-plat/aee.h>
|
|
#include <linux/types.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/proc_fs.h>
|
|
#include <linux/seq_file.h>
|
|
#include "mt-plat/mtk_thermal_monitor.h"
|
|
#include "mach/mtk_thermal.h"
|
|
#include "mtk_thermal_timer.h"
|
|
//#include <mt-plat/upmu_common.h>
|
|
#include <tspmic_settings.h>
|
|
#include <linux/uidgid.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/mfd/mt6397/core.h>/* PMIC MFD core header */
|
|
#include <linux/regmap.h>
|
|
|
|
/*=============================================================
|
|
*Local variable definition
|
|
*=============================================================
|
|
*/
|
|
static kuid_t uid = KUIDT_INIT(0);
|
|
static kgid_t gid = KGIDT_INIT(1000);
|
|
static DEFINE_SEMAPHORE(sem_mutex);
|
|
static int isTimerCancelled;
|
|
|
|
/**
|
|
* 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;
|
|
|
|
static unsigned int interval = 1; /* seconds, 0 : no auto polling */
|
|
static unsigned int trip_temp[10] = {150000, 110000, 100000, 90000, 80000,
|
|
70000, 65000, 60000, 55000, 50000 };
|
|
|
|
static unsigned int cl_dev_sysrst_state;
|
|
static struct thermal_zone_device *thz_dev;
|
|
|
|
static struct thermal_cooling_device *cl_dev_sysrst;
|
|
static int kernelmode;
|
|
|
|
static int g_THERMAL_TRIP[10] = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
|
|
|
|
static int num_trip = 1;
|
|
static char g_bind0[20] = "sysrst.6357buck1";
|
|
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 };
|
|
|
|
static long mt6357tsbuck1_cur_temp;
|
|
/*
|
|
*static long int mt6357tsbuck1_start_temp;
|
|
*static long int mt6357tsbuck1_end_temp;
|
|
*/
|
|
/*=============================================================*/
|
|
|
|
static int mt6357tsbuck1_get_temp(struct thermal_zone_device *thermal, int *t)
|
|
{
|
|
*t = mt6357tsbuck1_get_hw_temp();
|
|
mt6357tsbuck1_cur_temp = *t;
|
|
|
|
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 mt6357tsbuck1_bind
|
|
(struct thermal_zone_device *thermal,
|
|
struct thermal_cooling_device *cdev)
|
|
{
|
|
int table_val = 0;
|
|
|
|
if (!strcmp(cdev->type, g_bind0)) {
|
|
table_val = 0;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind1)) {
|
|
table_val = 1;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind2)) {
|
|
table_val = 2;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind3)) {
|
|
table_val = 3;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind4)) {
|
|
table_val = 4;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind5)) {
|
|
table_val = 5;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind6)) {
|
|
table_val = 6;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind7)) {
|
|
table_val = 7;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind8)) {
|
|
table_val = 8;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind9)) {
|
|
table_val = 9;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else {
|
|
return 0;
|
|
}
|
|
|
|
if (mtk_thermal_zone_bind_cooling_device(thermal, table_val, cdev)) {
|
|
mtktspmic_info("[%s] error binding cooling dev\n", __func__);
|
|
return -EINVAL;
|
|
}
|
|
|
|
mtktspmic_dprintk("[%s] binding OK, %d\n", __func__, table_val);
|
|
return 0;
|
|
}
|
|
|
|
static int mt6357tsbuck1_unbind(struct thermal_zone_device *thermal,
|
|
struct thermal_cooling_device *cdev)
|
|
{
|
|
int table_val = 0;
|
|
|
|
if (!strcmp(cdev->type, g_bind0)) {
|
|
table_val = 0;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind1)) {
|
|
table_val = 1;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind2)) {
|
|
table_val = 2;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind3)) {
|
|
table_val = 3;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind4)) {
|
|
table_val = 4;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind5)) {
|
|
table_val = 5;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind6)) {
|
|
table_val = 6;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind7)) {
|
|
table_val = 7;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind8)) {
|
|
table_val = 8;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else if (!strcmp(cdev->type, g_bind9)) {
|
|
table_val = 9;
|
|
mtktspmic_dprintk("[%s] %s\n", __func__, cdev->type);
|
|
} else
|
|
return 0;
|
|
|
|
if (thermal_zone_unbind_cooling_device(thermal, table_val, cdev)) {
|
|
mtktspmic_info("[%s] error unbinding cooling dev\n", __func__);
|
|
return -EINVAL;
|
|
}
|
|
|
|
mtktspmic_dprintk("[%s] unbinding OK\n", __func__);
|
|
return 0;
|
|
}
|
|
|
|
static int mt6357tsbuck1_get_mode
|
|
(struct thermal_zone_device *thermal,
|
|
enum thermal_device_mode *mode)
|
|
{
|
|
*mode = (kernelmode) ? THERMAL_DEVICE_ENABLED : THERMAL_DEVICE_DISABLED;
|
|
return 0;
|
|
}
|
|
|
|
static int mt6357tsbuck1_set_mode
|
|
(struct thermal_zone_device *thermal,
|
|
enum thermal_device_mode mode)
|
|
{
|
|
kernelmode = mode;
|
|
return 0;
|
|
}
|
|
|
|
static int mt6357tsbuck1_get_trip_type
|
|
(struct thermal_zone_device *thermal, int trip,
|
|
enum thermal_trip_type *type)
|
|
{
|
|
*type = g_THERMAL_TRIP[trip];
|
|
return 0;
|
|
}
|
|
|
|
static int mt6357tsbuck1_get_trip_temp
|
|
(struct thermal_zone_device *thermal, int trip,
|
|
int *temp)
|
|
{
|
|
*temp = trip_temp[trip];
|
|
return 0;
|
|
}
|
|
|
|
static int mt6357tsbuck1_get_crit_temp(
|
|
struct thermal_zone_device *thermal, int *temperature)
|
|
{
|
|
*temperature = mtktspmic_TEMP_CRIT;
|
|
return 0;
|
|
}
|
|
|
|
/* bind callback functions to thermalzone */
|
|
static struct thermal_zone_device_ops mt6357tsbuck1_dev_ops = {
|
|
.bind = mt6357tsbuck1_bind,
|
|
.unbind = mt6357tsbuck1_unbind,
|
|
.get_temp = mt6357tsbuck1_get_temp,
|
|
.get_mode = mt6357tsbuck1_get_mode,
|
|
.set_mode = mt6357tsbuck1_set_mode,
|
|
.get_trip_type = mt6357tsbuck1_get_trip_type,
|
|
.get_trip_temp = mt6357tsbuck1_get_trip_temp,
|
|
.get_crit_temp = mt6357tsbuck1_get_crit_temp,
|
|
};
|
|
|
|
static int mt6357tsbuck1_sysrst_get_max_state
|
|
(struct thermal_cooling_device *cdev, unsigned long *state)
|
|
{
|
|
*state = 1;
|
|
return 0;
|
|
}
|
|
|
|
static int mt6357tsbuck1_sysrst_get_cur_state(
|
|
struct thermal_cooling_device *cdev, unsigned long *state)
|
|
{
|
|
*state = cl_dev_sysrst_state;
|
|
return 0;
|
|
}
|
|
|
|
static int mt6357tsbuck1_sysrst_set_cur_state(
|
|
struct thermal_cooling_device *cdev, unsigned long state)
|
|
{
|
|
cl_dev_sysrst_state = state;
|
|
if (cl_dev_sysrst_state == 1) {
|
|
mtktspmic_info("MT6357TSBUCK1 OT: reset, reset, reset!!!");
|
|
mtktspmic_info("@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@");
|
|
mtktspmic_info("*****************************************");
|
|
mtktspmic_info("@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@");
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static struct thermal_cooling_device_ops mt6357tsbuck1_cooling_sysrst_ops = {
|
|
.get_max_state = mt6357tsbuck1_sysrst_get_max_state,
|
|
.get_cur_state = mt6357tsbuck1_sysrst_get_cur_state,
|
|
.set_cur_state = mt6357tsbuck1_sysrst_set_cur_state,
|
|
};
|
|
|
|
static int mt6357tsbuck1_read(struct seq_file *m, void *v)
|
|
{
|
|
seq_printf(m,
|
|
"[%s] trip_0_temp=%d,trip_1_temp=%d,trip_2_temp=%d,trip_3_temp=%d,\n",
|
|
__func__,
|
|
trip_temp[0], trip_temp[1], trip_temp[2], trip_temp[3]);
|
|
seq_printf(m,
|
|
"trip_4_temp=%d,trip_5_temp=%d,trip_6_temp=%d,trip_7_temp=%d, trip_8_temp=%d,trip_9_temp=%d,\n",
|
|
trip_temp[4], trip_temp[5], trip_temp[6], trip_temp[7],
|
|
trip_temp[8], trip_temp[9]);
|
|
seq_printf(m,
|
|
"g_THERMAL_TRIP_0=%d,g_THERMAL_TRIP_1=%d,g_THERMAL_TRIP_2=%d, g_THERMAL_TRIP_3=%d,\n",
|
|
g_THERMAL_TRIP[0], g_THERMAL_TRIP[1], g_THERMAL_TRIP[2],
|
|
g_THERMAL_TRIP[3]);
|
|
seq_printf(m,
|
|
"g_THERMAL_TRIP_4=%d,g_THERMAL_TRIP_5=%d,g_THERMAL_TRIP_6=%d, g_THERMAL_TRIP_7=%d,\n",
|
|
g_THERMAL_TRIP[4], g_THERMAL_TRIP[5], g_THERMAL_TRIP[6],
|
|
g_THERMAL_TRIP[7]);
|
|
seq_printf(m,
|
|
"g_THERMAL_TRIP_8=%d,g_THERMAL_TRIP_9=%d,\n", g_THERMAL_TRIP[8],
|
|
g_THERMAL_TRIP[9]);
|
|
seq_printf(m,
|
|
"cooldev0=%s,cooldev1=%s,cooldev2=%s,cooldev3=%s,cooldev4=%s,\n",
|
|
g_bind0, g_bind1, g_bind2, g_bind3, g_bind4);
|
|
seq_printf(m,
|
|
"cooldev5=%s,cooldev6=%s,cooldev7=%s,cooldev8=%s,cooldev9=%s, time_ms=%d\n",
|
|
g_bind5, g_bind6, g_bind7, g_bind8, g_bind9, interval * 1000);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int mt6357tsbuck1_register_thermal(void);
|
|
static void mt6357tsbuck1_unregister_thermal(void);
|
|
|
|
static ssize_t mt6357tsbuck1_write(struct file *file,
|
|
const char __user *buffer, size_t count, loff_t *data)
|
|
{
|
|
int len = 0;
|
|
int i;
|
|
|
|
struct mt6357tsbuck1_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 mt6357tsbuck1_data *ptr_mt6357tsbuck1_data;
|
|
|
|
ptr_mt6357tsbuck1_data = kmalloc(sizeof(*ptr_mt6357tsbuck1_data),
|
|
GFP_KERNEL);
|
|
|
|
if (ptr_mt6357tsbuck1_data == NULL)
|
|
return -ENOMEM;
|
|
|
|
len = (count < (sizeof(ptr_mt6357tsbuck1_data->desc) - 1)) ? count :
|
|
(sizeof(ptr_mt6357tsbuck1_data->desc) - 1);
|
|
if (copy_from_user(ptr_mt6357tsbuck1_data->desc, buffer, len)) {
|
|
kfree(ptr_mt6357tsbuck1_data);
|
|
return 0;
|
|
}
|
|
|
|
ptr_mt6357tsbuck1_data->desc[len] = '\0';
|
|
|
|
if (sscanf
|
|
(ptr_mt6357tsbuck1_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_mt6357tsbuck1_data->trip[0], &ptr_mt6357tsbuck1_data->t_type[0],
|
|
ptr_mt6357tsbuck1_data->bind0,
|
|
&ptr_mt6357tsbuck1_data->trip[1], &ptr_mt6357tsbuck1_data->t_type[1],
|
|
ptr_mt6357tsbuck1_data->bind1,
|
|
&ptr_mt6357tsbuck1_data->trip[2], &ptr_mt6357tsbuck1_data->t_type[2],
|
|
ptr_mt6357tsbuck1_data->bind2,
|
|
&ptr_mt6357tsbuck1_data->trip[3], &ptr_mt6357tsbuck1_data->t_type[3],
|
|
ptr_mt6357tsbuck1_data->bind3,
|
|
&ptr_mt6357tsbuck1_data->trip[4], &ptr_mt6357tsbuck1_data->t_type[4],
|
|
ptr_mt6357tsbuck1_data->bind4,
|
|
&ptr_mt6357tsbuck1_data->trip[5], &ptr_mt6357tsbuck1_data->t_type[5],
|
|
ptr_mt6357tsbuck1_data->bind5,
|
|
&ptr_mt6357tsbuck1_data->trip[6], &ptr_mt6357tsbuck1_data->t_type[6],
|
|
ptr_mt6357tsbuck1_data->bind6,
|
|
&ptr_mt6357tsbuck1_data->trip[7], &ptr_mt6357tsbuck1_data->t_type[7],
|
|
ptr_mt6357tsbuck1_data->bind7,
|
|
&ptr_mt6357tsbuck1_data->trip[8], &ptr_mt6357tsbuck1_data->t_type[8],
|
|
ptr_mt6357tsbuck1_data->bind8,
|
|
&ptr_mt6357tsbuck1_data->trip[9], &ptr_mt6357tsbuck1_data->t_type[9],
|
|
ptr_mt6357tsbuck1_data->bind9,
|
|
&ptr_mt6357tsbuck1_data->time_msec) == 32) {
|
|
|
|
down(&sem_mutex);
|
|
mtktspmic_dprintk(
|
|
"[%s] mt6357tsbuck1_unregister_thermal\n", __func__);
|
|
mt6357tsbuck1_unregister_thermal();
|
|
|
|
if (num_trip < 0 || num_trip > 10) {
|
|
#ifdef CONFIG_MTK_AEE_FEATURE
|
|
aee_kernel_warning_api(
|
|
__FILE__, __LINE__, DB_OPT_DEFAULT,
|
|
"mt6357tsbuck1_write", "Bad argument");
|
|
#endif
|
|
mtktspmic_dprintk(
|
|
"[%s] bad argument\n", __func__);
|
|
kfree(ptr_mt6357tsbuck1_data);
|
|
up(&sem_mutex);
|
|
return -EINVAL;
|
|
}
|
|
|
|
|
|
for (i = 0; i < num_trip; i++)
|
|
g_THERMAL_TRIP[i] = ptr_mt6357tsbuck1_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_mt6357tsbuck1_data->bind0[i];
|
|
g_bind1[i] = ptr_mt6357tsbuck1_data->bind1[i];
|
|
g_bind2[i] = ptr_mt6357tsbuck1_data->bind2[i];
|
|
g_bind3[i] = ptr_mt6357tsbuck1_data->bind3[i];
|
|
g_bind4[i] = ptr_mt6357tsbuck1_data->bind4[i];
|
|
g_bind5[i] = ptr_mt6357tsbuck1_data->bind5[i];
|
|
g_bind6[i] = ptr_mt6357tsbuck1_data->bind6[i];
|
|
g_bind7[i] = ptr_mt6357tsbuck1_data->bind7[i];
|
|
g_bind8[i] = ptr_mt6357tsbuck1_data->bind8[i];
|
|
g_bind9[i] = ptr_mt6357tsbuck1_data->bind9[i];
|
|
}
|
|
|
|
mtktspmic_dprintk(
|
|
"[%s] g_THERMAL_TRIP_0=%d,g_THERMAL_TRIP_1=%d,g_THERMAL_TRIP_2=%d,",
|
|
__func__, g_THERMAL_TRIP[0], g_THERMAL_TRIP[1],
|
|
g_THERMAL_TRIP[2]);
|
|
mtktspmic_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]);
|
|
mtktspmic_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]);
|
|
mtktspmic_dprintk(
|
|
"[%s] cooldev0=%s,cooldev1=%s,cooldev2=%s,cooldev3=%s,cooldev4=%s,",
|
|
__func__, g_bind0, g_bind1, g_bind2, g_bind3, g_bind4);
|
|
mtktspmic_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] = ptr_mt6357tsbuck1_data->trip[i];
|
|
|
|
interval = ptr_mt6357tsbuck1_data->time_msec / 1000;
|
|
|
|
mtktspmic_dprintk(
|
|
"[%s] trip_0_temp=%d,trip_1_temp=%d,trip_2_temp=%d,trip_3_temp=%d,",
|
|
__func__,
|
|
trip_temp[0], trip_temp[1], trip_temp[2], trip_temp[3]);
|
|
mtktspmic_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]);
|
|
mtktspmic_dprintk(
|
|
"trip_9_temp=%d,time_ms=%d\n", trip_temp[9],
|
|
interval * 1000);
|
|
|
|
mtktspmic_dprintk(
|
|
"[%s]mt6357tsbuck1_register_thermal\n", __func__);
|
|
mt6357tsbuck1_register_thermal();
|
|
up(&sem_mutex);
|
|
kfree(ptr_mt6357tsbuck1_data);
|
|
return count;
|
|
}
|
|
|
|
mtktspmic_dprintk("[%s] bad argument\n", __func__);
|
|
#ifdef CONFIG_MTK_AEE_FEATURE
|
|
aee_kernel_warning_api(__FILE__, __LINE__, DB_OPT_DEFAULT,
|
|
"mt6357tsbuck1_write", "Bad argument");
|
|
#endif
|
|
kfree(ptr_mt6357tsbuck1_data);
|
|
return -EINVAL;
|
|
}
|
|
|
|
static void mt6357tsbuck1_cancel_thermal_timer(void)
|
|
{
|
|
/* cancel timer */
|
|
/* pr_debug("mtkts_pmic_cancel_thermal_timer\n"); */
|
|
|
|
/* stop thermal framework polling when entering deep idle */
|
|
if (down_trylock(&sem_mutex))
|
|
return;
|
|
|
|
if (thz_dev) {
|
|
cancel_delayed_work(&(thz_dev->poll_queue));
|
|
isTimerCancelled = 1;
|
|
}
|
|
|
|
up(&sem_mutex);
|
|
}
|
|
|
|
static void mt6357tsbuck1_start_thermal_timer(void)
|
|
{
|
|
/* pr_debug("mtkts_pmic_start_thermal_timer\n"); */
|
|
/* resume thermal framework polling when leaving deep idle */
|
|
|
|
if (!isTimerCancelled)
|
|
return;
|
|
|
|
isTimerCancelled = 0;
|
|
|
|
if (down_trylock(&sem_mutex))
|
|
return;
|
|
|
|
if (thz_dev != NULL && interval != 0)
|
|
mod_delayed_work(system_freezable_power_efficient_wq,
|
|
&(thz_dev->poll_queue),
|
|
round_jiffies(msecs_to_jiffies(1000)));
|
|
|
|
up(&sem_mutex);
|
|
}
|
|
|
|
static int mt6357tsbuck1_register_cooler(void)
|
|
{
|
|
cl_dev_sysrst = mtk_thermal_cooling_device_register(
|
|
"sysrst.6357buck1", NULL, &mt6357tsbuck1_cooling_sysrst_ops);
|
|
return 0;
|
|
}
|
|
|
|
static int mt6357tsbuck1_register_thermal(void)
|
|
{
|
|
mtktspmic_dprintk("[%s]\n", __func__);
|
|
|
|
/* trips : trip 0~2 */
|
|
thz_dev = mtk_thermal_zone_device_register(
|
|
"mt6357tsbuck1", num_trip, NULL, &mt6357tsbuck1_dev_ops,
|
|
0, 0, 0, interval * 1000);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void mt6357tsbuck1_unregister_cooler(void)
|
|
{
|
|
if (cl_dev_sysrst) {
|
|
mtk_thermal_cooling_device_unregister(cl_dev_sysrst);
|
|
cl_dev_sysrst = NULL;
|
|
}
|
|
}
|
|
|
|
static void mt6357tsbuck1_unregister_thermal(void)
|
|
{
|
|
mtktspmic_dprintk("[%s]\n", __func__);
|
|
|
|
if (thz_dev) {
|
|
mtk_thermal_zone_device_unregister(thz_dev);
|
|
thz_dev = NULL;
|
|
}
|
|
}
|
|
|
|
static int mt6357tsbuck1_open(struct inode *inode, struct file *file)
|
|
{
|
|
return single_open(file, mt6357tsbuck1_read, NULL);
|
|
}
|
|
|
|
static const struct file_operations mt6357tsbuck1_fops = {
|
|
.owner = THIS_MODULE,
|
|
.open = mt6357tsbuck1_open,
|
|
.read = seq_read,
|
|
.llseek = seq_lseek,
|
|
.write = mt6357tsbuck1_write,
|
|
.release = single_release,
|
|
};
|
|
static int mt6357_ts_buck1_probe(struct platform_device *pdev)
|
|
{
|
|
int err = 0;
|
|
struct proc_dir_entry *entry = NULL;
|
|
struct proc_dir_entry *mt6357tsbuck1_dir = NULL;
|
|
struct mt6397_chip *chip;
|
|
|
|
chip = (struct mt6397_chip *)dev_get_drvdata(pdev->dev.parent);
|
|
mtktspmic_info("[%s]\n", __func__);
|
|
mtktspmic_cali_prepare(chip->regmap);
|
|
mtktspmic_cali_prepare2();
|
|
|
|
err = mt6357tsbuck1_register_cooler();
|
|
if (err)
|
|
return err;
|
|
err = mt6357tsbuck1_register_thermal();
|
|
if (err)
|
|
goto err_unreg;
|
|
|
|
mt6357tsbuck1_dir = mtk_thermal_get_proc_drv_therm_dir_entry();
|
|
if (!mt6357tsbuck1_dir) {
|
|
mtktspmic_info("[%s]: mkdir /proc/driver/thermal failed\n",
|
|
__func__);
|
|
} else {
|
|
entry =
|
|
proc_create("tz6357buck1", 0664,
|
|
mt6357tsbuck1_dir, &mt6357tsbuck1_fops);
|
|
if (entry)
|
|
proc_set_user(entry, uid, gid);
|
|
}
|
|
mtkTTimer_register("mt6357tsbuck1",
|
|
mt6357tsbuck1_start_thermal_timer,
|
|
mt6357tsbuck1_cancel_thermal_timer);
|
|
|
|
return 0;
|
|
|
|
err_unreg:
|
|
mt6357tsbuck1_unregister_cooler();
|
|
return err;
|
|
|
|
}
|
|
|
|
static const struct of_device_id mt6357_ts_buck1_of_match[] = {
|
|
{.compatible = "mediatek,mt6357_ts_buck1",},
|
|
{},
|
|
};
|
|
|
|
|
|
MODULE_DEVICE_TABLE(of, mt6357_ts_buck1_of_match);
|
|
|
|
static struct platform_driver mt6357_ts_buck1_driver = {
|
|
.probe = mt6357_ts_buck1_probe,
|
|
.driver = {
|
|
.name = "mt6357_ts_buck1",
|
|
.of_match_table = mt6357_ts_buck1_of_match,
|
|
},
|
|
};
|
|
|
|
static int __init mt6357tsbuck1_init(void)
|
|
{
|
|
return platform_driver_register(&mt6357_ts_buck1_driver);
|
|
}
|
|
|
|
static void __exit mt6357tsbuck1_exit(void)
|
|
{
|
|
mtktspmic_info("[%s]\n", __func__);
|
|
mt6357tsbuck1_unregister_thermal();
|
|
mt6357tsbuck1_unregister_cooler();
|
|
mtkTTimer_unregister("mt6357tsbuck1");
|
|
platform_driver_unregister(&mt6357_ts_buck1_driver);
|
|
}
|
|
module_init(mt6357tsbuck1_init);
|
|
module_exit(mt6357tsbuck1_exit);
|
|
|
|
MODULE_DESCRIPTION("MEDIATEK Thermal zone PMIC buck1 temperature sensor");
|
|
MODULE_LICENSE("GPL v2");
|