Alvee Ahmed / virgo3_imuHandler

Fork of virgo3_imuHandler_Orion_PCB by Van Nguyen

Revision:
2:3ab5d5ee2160
Parent:
1:927f1b3e4bf4
--- a/imuHandler.cpp	Tue Apr 26 10:40:59 2016 +0000
+++ b/imuHandler.cpp	Fri Apr 29 01:29:34 2016 +0000
@@ -20,7 +20,8 @@
 
     unstable_readings = MPU6050_StabilizationReadings;
         
-    imu_stabilized=false;
+    imu_stabilized[0]=0;
+    imu_stabilized[1]=0;
 
     if(movWindowSize_Pose <= movWindow_lenMax) movWindow_len_Pose = movWindowSize_Pose;
     else movWindow_len_Pose = movWindow_lenMax;
@@ -106,7 +107,7 @@
                     mpu_timer.start();
                     unstable_readings --;
 
-                    imu_stabilized = true;
+                    imu_stabilized[1] = 1;
                     //debug_printf("\nIMU stabilized\n");
                 }
             }