solaESKF_EIGEN

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

Revision:
70:99f974d8960e
Parent:
68:b9f6938fab9d
Child:
73:84ffa0166e6c
--- a/run.cpp	Mon Jun 28 01:45:12 2021 +0000
+++ b/run.cpp	Tue Jun 29 08:07:55 2021 +0000
@@ -7,7 +7,9 @@
     Timer _t;
     _t.start();
     magCalibrator.setExtremes(magbiasMin,magbiasMax);
-    getIMUval();
+    for(int i = 0; i < 1000; i++){
+        getIMUval();
+    }
     //ekf.triad(acc/acc.Norm(), accref/accref.Norm(), mag/mag.Norm(), magref/magref.Norm());
     ekf.defineQhat(rpy_align);
     float sum2accnorm = 0;