diff --git a/firmware/basic/idle.c b/firmware/basic/idle.c
index 7625abb..c640f13 100644
--- a/firmware/basic/idle.c
+++ b/firmware/basic/idle.c
@@ -41,12 +41,12 @@ void delayms_queue(uint32_t ms){
 };
 
 void delayms_power(uint32_t ms){
+    ms+=_timectr;
 	do {
-		ms-=10;
 #ifdef ARM
-		__asm volatile ("WFI");
+			__asm volatile ("WFI");
 #endif
-	} while(ms>10);
+	} while (ms >_timectr);
 };
 
 int push_queue(void (*new)(void)){