Team Design project 3 main file

Dependencies:   LocalPositionSystem MMA8451Q Motor_Driver Sensors mbed

Fork of TDP_main by Yelfie

Revision:
23:9b53c72fcd38
Parent:
22:902c3086394e
Child:
24:ecc3fbaf2824
--- a/main.cpp	Sat Mar 21 13:08:53 2015 +0000
+++ b/main.cpp	Sun Mar 22 23:32:36 2015 +0000
@@ -41,7 +41,7 @@
 int sensorsCheckSum; //varibale used for sensors mapping access
 int passedTime1,passedTime2;
 int values_old[5] = {0};
-int k = 0;
+int cursor = 0;
 
 
 void measureSensors () {
@@ -56,11 +56,9 @@
             sensorsCheckSum += (i+1)*(i+1);
         }
     }
-    if (values_old[0] != sensorsCheckSum) {
-        for (k = 5; k > 0; k--) {
-            values_old[k] = values_old[k-1];
-        }
-        values_old[0] = sensorsCheckSum;
+    if (values_old[cursor] != sensorsCheckSum) { //why only if different ??
+        values_old[cursor] = sensorsCheckSum;
+        cursor = (cursor+1)%5;
     }
     //pc.printf("sensorsCheckSum is %i",sensorsCheckSum);
 }