Browse Source

set vel_pos_test_ratio to zero if no fusion happens

master
kamilritz 5 years ago committed by Paul Riseborough
parent
commit
bd8f05567a
  1. 2
      EKF/vel_pos_fusion.cpp

2
EKF/vel_pos_fusion.cpp

@ -168,6 +168,8 @@ void Ekf::fuseVelPosHeight() @@ -168,6 +168,8 @@ void Ekf::fuseVelPosHeight()
// Compute the ratio of innovation to gate size
_vel_pos_test_ratio[obs_index] = sq(innovation[obs_index]) / (sq(gate_size[obs_index]) *
_vel_pos_innov_var[obs_index]);
}else{
_vel_pos_test_ratio[obs_index] = 0;
}
}

Loading…
Cancel
Save