EKF : allow init without external vision measurements (#464)

This commit is contained in:
Kabir Mohammed
2018-07-12 11:36:47 +10:00
committed by Paul Riseborough
parent a0ed08967e
commit e1661a92c3
2 changed files with 6 additions and 9 deletions
+5
View File
@@ -175,6 +175,11 @@ void Ekf::controlExternalVisionFusion()
_control_status.flags.ev_pos = true;
ECL_INFO("EKF commencing external vision position fusion");
if ((_params.fusion_mode & MASK_ROTATE_EV) && !(_params.fusion_mode & MASK_USE_EVYAW)) {
// Reset transformation between EV and EKF navigation frames when starting fusion
resetExtVisRotMat();
}
// reset the position if we are not already aiding using GPS, else use a relative position
// method for fusing the position data
if (_control_status.flags.gps) {