THERMALD: update (and fix) thermald daemon

file:f39b330b391ab1390e78c038ef65bf3f70644945 -> file:944e6a3bcff0d1996bb7de1ba82ad197e83d010e
--- a/drivers/thermal/msm_thermal.c
+++ b/drivers/thermal/msm_thermal.c
@@ -21,25 +21,26 @@
#include <linux/cpu.h>
#include <linux/reboot.h>
-#define DEF_TEMP_SENSOR 0
+#define DEF_TEMP_SENSOR0 0
+#define DEF_TEMP_SENSOR1 1
//shutdown temp
#define DEF_SHUTDOWNTEMP 80
//max thermal limit
-#define DEF_ALLOWED_MAX_HIGH 76
+#define DEF_ALLOWED_MAX_HIGH 75
#define DEF_ALLOWED_MAX_FREQ 384000
//mid thermal limit
#define DEF_ALLOWED_MID_HIGH 72
-#define DEF_ALLOWED_MID_FREQ 1026000
+#define DEF_ALLOWED_MID_FREQ 810000
//low thermal limit
#define DEF_ALLOWED_LOW_HIGH 70
#define DEF_ALLOWED_LOW_FREQ 1350000
//Sampling interval
-#define DEF_THERMAL_CHECK_MS 250
+#define DEF_THERMAL_CHECK_MS 100
static DEFINE_MUTEX(emergency_shutdown_mutex);
@@ -48,7 +49,7 @@ static int enabled;
//Throttling indicator, 0=not throttled, 1=low, 2=mid, 3=max
static int thermal_throttled = 0;
-//Safe the cpu max freq before throttling
+//Save the cpu max freq before throttling
static int pre_throttled_max = 0;
static struct delayed_work check_temp_work;
@@ -74,7 +75,7 @@ static struct msm_thermal_tuners {
.shutdown_temp = DEF_SHUTDOWNTEMP,
.allowed_max_high = DEF_ALLOWED_MAX_HIGH,
- .allowed_max_low = (DEF_ALLOWED_MAX_HIGH - 5),
+ .allowed_max_low = (DEF_ALLOWED_MAX_HIGH - 4),
.allowed_max_freq = DEF_ALLOWED_MAX_FREQ,
.allowed_mid_high = DEF_ALLOWED_MID_HIGH,
@@ -111,22 +112,25 @@ static int update_cpu_max_freq(struct cp
static void check_temp(struct work_struct *work)
{
struct cpufreq_policy *cpu_policy = NULL;
- struct tsens_device tsens_dev;
- unsigned long temp = 0;
+ struct tsens_device tsens_dev0;
+ struct tsens_device tsens_dev1;
+ unsigned long temp0 = 0, temp1 = 0;
unsigned int max_freq = 0;
- int update_policy = 0;
- int cpu = 0;
- int ret = 0;
-
- tsens_dev.sensor_num = DEF_TEMP_SENSOR;
- ret = tsens_get_temp(&tsens_dev, &temp);
- if (ret) {
- pr_debug("msm_thermal: Unable to read TSENS sensor %d\n",
- tsens_dev.sensor_num);
+ bool update_policy = false;
+ int i = 0, cpu = 0;
+ int ret0 = 0, ret1 = 0;
+
+ tsens_dev0.sensor_num = DEF_TEMP_SENSOR0;
+ ret0 = tsens_get_temp(&tsens_dev0, &temp0);
+ tsens_dev1.sensor_num = DEF_TEMP_SENSOR1;
+ ret1 = tsens_get_temp(&tsens_dev1, &temp1);
+ if (ret0 && ret1) {
+ pr_err("msm_thermal: FATAL: Unable to read TSENS sensor %d & %d\n",
+ tsens_dev0.sensor_num, tsens_dev1.sensor_num);
goto reschedule;
}
- if (temp >= (msm_thermal_tuners_ins.shutdown_temp)) {
+ if ((max(temp0, temp1)) >= (msm_thermal_tuners_ins.shutdown_temp)) {
mutex_lock(&emergency_shutdown_mutex);
pr_warn("################################\n");
pr_warn("################################\n");
@@ -136,12 +140,18 @@ static void check_temp(struct work_struc
/* orderly poweroff tries to power down gracefully
if it fails it will force it. */
orderly_poweroff(true);
- cancel_delayed_work_sync(&check_temp_work);
+ for_each_possible_cpu(cpu) {
+ update_policy = true;
+ max_freq = msm_thermal_tuners_ins.allowed_max_freq;
+ thermal_throttled = 3;
+ pr_warn("msm_thermal: Emergency throttled CPU%i to %u! temp:%lu\n",
+ cpu, msm_thermal_tuners_ins.allowed_max_freq, (max(temp0, temp1)));
+ }
mutex_unlock(&emergency_shutdown_mutex);
}
for_each_possible_cpu(cpu) {
- update_policy = 0;
+ update_policy = false;
cpu_policy = cpufreq_cpu_get(cpu);
if (!cpu_policy) {
pr_debug("msm_thermal: NULL policy on cpu %d\n", cpu);
@@ -149,69 +159,79 @@ static void check_temp(struct work_struc
}
/* save pre-throttled max freq value */
- if (thermal_throttled == 0)
+ if ((thermal_throttled == 0) && (cpu == 0))
pre_throttled_max = cpu_policy->max;
//low trip point
- if ((temp >= msm_thermal_tuners_ins.allowed_low_high) &&
- (temp < msm_thermal_tuners_ins.allowed_mid_high) &&
- (cpu_policy->max > msm_thermal_tuners_ins.allowed_low_freq)) {
- update_policy = 1;
+ if (((max(temp0, temp1)) >= msm_thermal_tuners_ins.allowed_low_high) &&
+ ((max(temp0, temp1)) < msm_thermal_tuners_ins.allowed_mid_high) &&
+ (thermal_throttled < 1)) {
+ update_policy = true;
max_freq = msm_thermal_tuners_ins.allowed_low_freq;
- thermal_throttled = 1;
- pr_warn("msm_thermal: Thermal Throttled (low)! temp: %lu\n", temp);
+ if (cpu == (CONFIG_NR_CPUS-1)) {
+ thermal_throttled = 1;
+ pr_warn("msm_thermal: Thermal Throttled (low)! temp:%lu by:%s\n",
+ (max(temp0, temp1)), (temp0>temp1) ? "0" : "1");
+ }
//low clr point
- } else if ((temp < msm_thermal_tuners_ins.allowed_low_low) &&
+ } else if (((max(temp0, temp1)) < msm_thermal_tuners_ins.allowed_low_low) &&
(thermal_throttled > 0)) {
- if (cpu_policy->max < cpu_policy->cpuinfo.max_freq) {
- if (pre_throttled_max != 0)
- max_freq = pre_throttled_max;
- else {
+ if (pre_throttled_max != 0)
+ max_freq = pre_throttled_max;
+ else {
max_freq = 1728000;
pr_warn("msm_thermal: ERROR! pre_throttled_max=0, falling back to %u\n", max_freq);
- }
- update_policy = 1;
- /* wait until 4th core is unthrottled */
- if (cpu == 3)
- thermal_throttled = 0;
- pr_warn("msm_thermal: Low Thermal Throttling Ended! temp: %lu\n", temp);
+ }
+ update_policy = true;
+ for (i = 1; i < CONFIG_NR_CPUS; i++) {
+ if (cpu_online(i))
+ continue;
+ cpu_up(i);
+ }
+ if (cpu == (CONFIG_NR_CPUS-1)) {
+ thermal_throttled = 0;
+ pr_warn("msm_thermal: Low thermal throttle ended! temp:%lu by:%s\n",
+ (max(temp0, temp1)), (temp0>temp1) ? "0" : "1");
}
//mid trip point
- } else if ((temp >= msm_thermal_tuners_ins.allowed_low_high) &&
- (temp < msm_thermal_tuners_ins.allowed_mid_low) &&
- (cpu_policy->max > msm_thermal_tuners_ins.allowed_mid_freq)) {
- update_policy = 1;
- max_freq = msm_thermal_tuners_ins.allowed_low_freq;
- thermal_throttled = 2;
- pr_warn("msm_thermal: Thermal Throttled (mid)! temp: %lu\n", temp);
+ } else if (((max(temp0, temp1)) >= msm_thermal_tuners_ins.allowed_mid_high) &&
+ ((max(temp0, temp1)) < msm_thermal_tuners_ins.allowed_max_high) &&
+ (thermal_throttled < 2)) {
+ update_policy = true;
+ max_freq = msm_thermal_tuners_ins.allowed_mid_freq;
+ if (cpu == (CONFIG_NR_CPUS-1)) {
+ thermal_throttled = 2;
+ pr_warn("msm_thermal: Thermal Throttled (mid)! temp:%lu by:%s\n",
+ (max(temp0, temp1)), (temp0>temp1) ? "0" : "1");
+ }
//mid clr point
- } else if ( (temp < msm_thermal_tuners_ins.allowed_mid_low) &&
+ } else if (((max(temp0, temp1)) < msm_thermal_tuners_ins.allowed_mid_low) &&
(thermal_throttled > 1)) {
- if (cpu_policy->max < cpu_policy->cpuinfo.max_freq) {
- max_freq = msm_thermal_tuners_ins.allowed_low_freq;
- update_policy = 1;
- /* wait until 4th core is unthrottled */
- if (cpu == 3)
- thermal_throttled = 1;
- pr_warn("msm_thermal: Mid Thermal Throttling Ended! temp: %lu\n", temp);
+ max_freq = msm_thermal_tuners_ins.allowed_low_freq;
+ update_policy = true;
+ if (cpu == (CONFIG_NR_CPUS-1)) {
+ thermal_throttled = 1;
+ pr_warn("msm_thermal: Mid thermal throttle ended! temp:%lu by:%s\n",
+ (max(temp0, temp1)), (temp0>temp1) ? "0" : "1");
}
//max trip point
- } else if ((temp >= msm_thermal_tuners_ins.allowed_max_high) &&
- (cpu_policy->max > msm_thermal_tuners_ins.allowed_max_freq)) {
- update_policy = 1;
+ } else if ((max(temp0, temp1)) >= msm_thermal_tuners_ins.allowed_max_high) {
+ update_policy = true;
max_freq = msm_thermal_tuners_ins.allowed_max_freq;
- thermal_throttled = 3;
- pr_warn("msm_thermal: Thermal Throttled (max)! temp: %lu\n", temp);
+ if (cpu == (CONFIG_NR_CPUS-1)) {
+ thermal_throttled = 3;
+ pr_warn("msm_thermal: Thermal Throttled (max)! temp:%lu by:%s\n",
+ (max(temp0, temp1)), (temp0>temp1) ? "0" : "1");
+ }
//max clr point
- } else if ((temp < msm_thermal_tuners_ins.allowed_max_low) &&
+ } else if (((max(temp0, temp1)) < msm_thermal_tuners_ins.allowed_max_low) &&
(thermal_throttled > 2)) {
- if (cpu_policy->max < cpu_policy->cpuinfo.max_freq) {
- max_freq = msm_thermal_tuners_ins.allowed_mid_freq;
- update_policy = 1;
- /* wait until 4th core is unthrottled */
- if (cpu == 3)
- thermal_throttled = 2;
- pr_warn("msm_thermal: Max Thermal Throttling Ended! temp: %lu\n", temp);
+ max_freq = msm_thermal_tuners_ins.allowed_mid_freq;
+ update_policy = true;
+ if (cpu == (CONFIG_NR_CPUS-1)) {
+ thermal_throttled = 2;
+ pr_warn("msm_thermal: Max thermal throttle ended! temp:%lu by:%s\n",
+ (max(temp0, temp1)), (temp0>temp1) ? "0" : "1");
}
}
@@ -225,6 +245,7 @@ reschedule:
if (enabled)
queue_delayed_work(check_temp_workq, &check_temp_work,
msecs_to_jiffies(msm_thermal_tuners_ins.check_interval_ms));
+ return;
}
static void disable_msm_thermal(void)