solaESKF_EIGEN
Dependencies: mbed LPS25HB_I2C LSM9DS1 PIDcontroller LoopTicker GPSUBX_UART_Eigen SBUS_without_mainfile MedianFilter Eigen UsaPack solaESKF_Eigen Vector3 CalibrateMagneto FastPWM
Diff: run.cpp
- 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;