EKF: Use correct height gate when using external vision

This commit is contained in:
Paul Riseborough
2016-05-27 11:24:53 +10:00
parent e41524ac9d
commit 6f412a73b4
+1 -1
View File
@@ -159,7 +159,7 @@ void Ekf::fuseVelPosHeight()
R[5] = fmaxf(_ev_sample_delayed.posErr, 0.01f);
R[5] = R[5] * R[5];
// innovation gate size
gate_size[5] = fmaxf(_params.baro_innov_gate, 1.0f);
gate_size[5] = fmaxf(_params.ev_innov_gate, 1.0f);
}
}