Eigen Revision

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

Revision:
82:c183c29d2427
Parent:
77:2bf856e3eca4
Child:
83:e69ab831031c
--- a/run.cpp	Tue Sep 07 08:22:39 2021 +0000
+++ b/run.cpp	Thu Sep 16 09:30:21 2021 +0000
@@ -69,6 +69,7 @@
         }
         
         ekf.updateGyroBiasConstraints(gyro);
+        ekf.updateVelocity(vi.y,vi.x,vi.z);
         //ekf.updateVelocityConstraints();
         //ekf.updateMagMeasures(mag);
         ekf.fuseErr2Nominal();