Browse Source

EKF: Set initial optical flow fusion monitor outputs to zero

master
Paul Riseborough 9 years ago
parent
commit
ffebaf384f
  1. 2
      EKF/ekf.cpp

2
EKF/ekf.cpp

@ -86,8 +86,10 @@ Ekf::Ekf(): @@ -86,8 +86,10 @@ Ekf::Ekf():
_R_prev = matrix::Dcm<float>();
memset(_vel_pos_innov, 0, sizeof(_vel_pos_innov));
memset(_mag_innov, 0, sizeof(_mag_innov));
memset(_flow_innov, 0, sizeof(_flow_innov));
memset(_vel_pos_innov_var, 0, sizeof(_vel_pos_innov_var));
memset(_mag_innov_var, 0, sizeof(_mag_innov_var));
memset(_flow_innov_var, 0, sizeof(_flow_innov_var));
_delta_angle_corr.setZero();
_delta_vel_corr.setZero();
_vel_corr.setZero();

Loading…
Cancel
Save