1 files changed, 4 insertions, 0 deletions

diff --git a/drivers/thermal/samsung/exynos_tmu.c b/drivers/thermal/samsung/exynos_tmu.c
index 0d96a510389f..ffccc894f0f8 100644
--- a/drivers/thermal/samsung/exynos_tmu.c
+++ b/drivers/thermal/samsung/exynos_tmu.c
@@ -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);