Browse Source

EKF: Ensure filter control modes are correctly initialised

master
Paul Riseborough 9 years ago
parent
commit
c23d72ba29
  1. 5
      EKF/ekf.cpp

5
EKF/ekf.cpp

@ -84,8 +84,6 @@ Ekf::Ekf():
_rng_hgt_faulty(false), _rng_hgt_faulty(false),
_baro_hgt_offset(0.0f) _baro_hgt_offset(0.0f)
{ {
_control_status = {};
_control_status_prev = {};
_state = {}; _state = {};
_last_known_posNE.setZero(); _last_known_posNE.setZero();
_earth_rate_NED.setZero(); _earth_rate_NED.setZero();
@ -156,6 +154,9 @@ bool Ekf::init(uint64_t timestamp)
_filter_initialised = false; _filter_initialised = false;
_terrain_initialised = false; _terrain_initialised = false;
_control_status.value = 0;
_control_status_prev.value = 0;
return ret; return ret;
} }

Loading…
Cancel
Save