1 files changed, 3 insertions, 1 deletions
diff --git a/firmware/thread.c b/firmware/thread.c
index 39880f2..49fd4c3 100644
--- a/firmware/thread.c
+++ b/firmware/thread.c
@@ -306,7 +306,9 @@ static inline void sleep_core(void)
            interrupts */
         CPU_CTL = 0x80000000;
 #elif CONFIG_CPU == S3C2440
-        CLKCON |= 2;
+        CLKCON |= (1 << 2); /* set IDLE bit */
+        for(i=0; i<10; i++); /* wait for IDLE */
+        CLKCON &= ~(1 << 2); /* reset IDLE bit when wake up */
 #endif
     }
 }