Browse Source

avoid changing the reset logic

sbg
Lorenz Meier 11 years ago
parent
commit
92cc44fe1e
  1. 7
      src/modules/ekf_att_pos_estimator/ekf_att_pos_estimator_main.cpp

7
src/modules/ekf_att_pos_estimator/ekf_att_pos_estimator_main.cpp

@ -1221,7 +1221,12 @@ FixedwingEstimator::task_main() @@ -1221,7 +1221,12 @@ FixedwingEstimator::task_main()
// We're apparently initialized in this case now
// check (and reset the filter as needed)
(void)check_filter_state();
int check = check_filter_state();
if (check) {
// Let the system re-initialize itself
continue;
}
// Run the strapdown INS equations every IMU update
_ekf->UpdateStrapdownEquationsNED();

Loading…
Cancel
Save