X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=bertos%2Fdrv%2Ftimer.c;h=e3043da49a7014f5294a138081d5825dc9cff8e6;hb=a0ba2de64a3964445b392a269ac820c03c5b8385;hp=4d1309466da6b37fb870ad244aa4f802df57f74a;hpb=9d47a03d8251b57383a391325022b7890f463f09;p=bertos.git

diff --git a/bertos/drv/timer.c b/bertos/drv/timer.c
index 4d130946..e3043da4 100644
--- a/bertos/drv/timer.c
+++ b/bertos/drv/timer.c
@@ -252,7 +252,7 @@ void timer_delayTicks(ticks_t delay)
 
 #if CONFIG_KERN_SIGNALS
 	Timer t;
-
+	DB(t.magic = TIMER_MAGIC_INACTIVE;)
 	if (proc_preemptAllowed())
 	{
 		ASSERT(!sig_check(SIG_SINGLE));
@@ -289,7 +289,27 @@ void timer_busyWait(hptime_t delay)
 	for (;;)
 	{
 		now = timer_hw_hpread();
-		delta = (now < prev) ? (TIMER_HW_CNT - prev + now) : (now - prev);
+		/*
+		 * The timer counter may wrap here and "prev" can become
+		 * greater than "now". So, be sure to always evaluate a
+		 * coherent timer difference:
+		 *
+		 * 0     prev            now   TIMER_HW_CNT
+		 * |_____|_______________|_____|
+		 *        ^^^^^^^^^^^^^^^
+		 * delta = now - prev
+		 *
+		 * 0     now             prev  TIMER_HW_CNT
+		 * |_____|_______________|_____|
+		 *  ^^^^^                 ^^^^^
+		 * delta = (TIMER_HW_CNT - prev) + now
+		 *
+		 * NOTE: TIMER_HW_CNT can be any value, not necessarily a power
+		 * of 2. For this reason the "%" operator is not suitable for
+		 * the generic case.
+		 */
+		delta = (now < prev) ? ((hptime_t)TIMER_HW_CNT - prev + now) :
+						(now - prev);
 		if (delta >= delay)
 			break;
 		delay -= delta;