From 7d2e2c22aa2a6e95bc30aacfc84ab32a61dcc9a0 Mon Sep 17 00:00:00 2001
From: treymarc <trey.marc@gmail.com>
Date: Sat, 12 Apr 2014 02:55:21 +0000
Subject: [PATCH] taskorder

---
 src/mw.c | 4 +---
 1 file changed, 1 insertion(+), 3 deletions(-)

diff --git a/src/mw.c b/src/mw.c
index b75cca42ed..237296d370 100755
--- a/src/mw.c
+++ b/src/mw.c
@@ -770,8 +770,6 @@ void loop(void)
         }
     } else {                    // not in rc loop
         static int taskOrder = 0;    // never call all function in the same loop, to avoid high delay spikes
-        if (taskOrder > 4)
-            taskOrder -= 5;
         switch (taskOrder) {
         case 0:
             taskOrder++;
@@ -801,7 +799,7 @@ void loop(void)
                 break;
             }
         case 4:
-            taskOrder++;
+            taskOrder = 0;
 #ifdef SONAR
             if (sensors(SENSOR_SONAR)) {
                 Sonar_update();