Modification of test-model-base-ekf-flex-estimator-imu
Fixing innovation by fixing AccAngular and Fc optimization