|
@@ -225,6 +225,8 @@ skip_calib_data:
|
|
|
trigger_levs++;
|
|
|
}
|
|
|
|
|
|
+ rising_threshold = readl(data->base + reg->threshold_th0);
|
|
|
+
|
|
|
if (data->soc == SOC_ARCH_EXYNOS4210) {
|
|
|
/* Write temperature code for threshold */
|
|
|
threshold_code = temp_to_code(data, pdata->threshold);
|
|
@@ -249,6 +251,7 @@ skip_calib_data:
|
|
|
ret = threshold_code;
|
|
|
goto out;
|
|
|
}
|
|
|
+ rising_threshold &= ~(0xff << 8 * i);
|
|
|
rising_threshold |= threshold_code << 8 * i;
|
|
|
if (pdata->threshold_falling) {
|
|
|
threshold_code = temp_to_code(data,
|
|
@@ -281,6 +284,7 @@ skip_calib_data:
|
|
|
}
|
|
|
if (i == EXYNOS_MAX_TRIGGER_PER_REG - 1) {
|
|
|
/* 1-4 level to be assigned in th0 reg */
|
|
|
+ rising_threshold &= ~(0xff << 8 * i);
|
|
|
rising_threshold |= threshold_code << 8 * i;
|
|
|
writel(rising_threshold,
|
|
|
data->base + reg->threshold_th0);
|