msm_thermal: fix the clusterfuck of code with simple routines to check for temperature differences and act accordingly.

Signed-off-by: franciscofranco <franciscofranco.1990@gmail.com>