solaESKF_EIGEN

Dependencies:   mbed LPS25HB_I2C LSM9DS1 PIDcontroller LoopTicker GPSUBX_UART_Eigen SBUS_without_mainfile MedianFilter Eigen UsaPack solaESKF_Eigen Vector3 CalibrateMagneto FastPWM

Revision:
89:c9f64bd655d9
Parent:
88:be349faa1976
Child:
90:96c2b0ed4b96
--- a/run.cpp	Thu Oct 21 06:41:03 2021 +0000
+++ b/run.cpp	Mon Oct 25 05:39:34 2021 +0000
@@ -47,11 +47,11 @@
         }else{
             //ekf.updateGPSVelocity(vi.x,vi.y,vi.z,acc,accref);
             //ekf.updateAccMeasures(acc,accref);
-            
+            ekf.updateGPSVelocity(vi.x,vi.y,vi.z,acc,accref);
             if(ekf.determinDynStatus(acc,accref)){
-                ekf.updateAccMeasures(acc,accref);
+                //ekf.updateAccMeasures(acc,accref);
             }else{   
-                ekf.updateAccMeasures(acc,accref);
+                //ekf.updateAccMeasures(acc,accref);
             }
             
             obsCount += 1;