From 7eba1c52404002002523093d34296491854d8fc9 Mon Sep 17 00:00:00 2001
From: Stefan `Sec` Zehl <sec@42.org>
Date: Tue, 26 Jul 2011 01:04:34 +0200
Subject: [PATCH] Fix delayms_power to do proper timecounting

---
 firmware/basic/idle.c | 6 +++---
 1 file changed, 3 insertions(+), 3 deletions(-)

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)){