set vel_pos_test_ratio to zero if no fusion happens

This commit is contained in:
kamilritz
2019-09-24 07:48:46 +10:00
committed by Paul Riseborough
parent 4b30de587f
commit bd8f05567a
+2
View File
@@ -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;
}
}