Browse Source

moved init

master
CarlOlsson 9 years ago committed by Roman Bapst
parent
commit
f5a9afd278
  1. 4
      EKF/ekf.cpp

4
EKF/ekf.cpp

@ -57,6 +57,8 @@ Ekf::Ekf():
_time_last_hgt_fuse(0), _time_last_hgt_fuse(0),
_time_last_of_fuse(0), _time_last_of_fuse(0),
_last_disarmed_posD(0.0f), _last_disarmed_posD(0.0f),
_airspeed_innov(0.0f),
_airspeed_innov_var(0.0f),
_heading_innov(0.0f), _heading_innov(0.0f),
_heading_innov_var(0.0f), _heading_innov_var(0.0f),
_delta_time_of(0.0f), _delta_time_of(0.0f),
@ -93,8 +95,6 @@ Ekf::Ekf():
memset(_flow_innov, 0, sizeof(_flow_innov)); memset(_flow_innov, 0, sizeof(_flow_innov));
memset(_vel_pos_innov_var, 0, sizeof(_vel_pos_innov_var)); memset(_vel_pos_innov_var, 0, sizeof(_vel_pos_innov_var));
memset(_mag_innov_var, 0, sizeof(_mag_innov_var)); memset(_mag_innov_var, 0, sizeof(_mag_innov_var));
memset(_airspeed_innov, 0, sizeof(_airspeed_innov));
memset(_airspeed_innov_var, 0, sizeof(_airspeed_innov_var));
memset(_flow_innov_var, 0, sizeof(_flow_innov_var)); memset(_flow_innov_var, 0, sizeof(_flow_innov_var));
_delta_angle_corr.setZero(); _delta_angle_corr.setZero();
_delta_vel_corr.setZero(); _delta_vel_corr.setZero();

Loading…
Cancel
Save