fakePosFusion: reset _last_known_posNE to current state when starting (#943)

* [AUTO COMMIT] update change indication
This commit is contained in:
Mathieu Bresciani
2020-12-15 10:09:01 +01:00
committed by GitHub
parent 9d22f140dd
commit 5ccb8b457d
3 changed files with 729 additions and 728 deletions
+1
View File
@@ -1263,6 +1263,7 @@ void Ekf::controlFakePosFusion()
// Reset position and velocity states if we re-commence this aiding method
if (isTimedOut(_time_last_fake_pos, (uint64_t)4e5)) {
_last_known_posNE = _state.pos.xy();
resetHorizontalPosition();
resetVelocity();
_fuse_hpos_as_odom = false;