fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-07-08 13:50:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

ekf2_ev: do not reset learned bias

Browse Source 
When ev resets without GNSS currently active, still consider the
position bias that was learned so far (GNSS fusion was maybe used in the
past and a meaningful bias was esimated).
This commit is contained in:
bresch
2023-06-05 16:10:14 +02:00
parent 4bb2c6e758
commit 3e4e4b8561
1 changed files with 1 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/ekf2/EKF/ev_pos_control.cpp
+1 -2
View File
@@ -230,8 +230,7 @@ void Ekf::updateEvPosFusion(const Vector2f &measurement, const Vector2f &measure
if (!_control_status.flags.gps) {
ECL_INFO("reset to %s", EV_AID_SRC_NAME);
_information_events.flags.reset_pos_to_vision = true;
resetHorizontalPositionTo(measurement, measurement_var);
_ev_pos_b_est.reset();
resetHorizontalPositionTo(measurement - _ev_pos_b_est.getBias(), measurement_var);
} else {
_ev_pos_b_est.setBias(-Vector2f(_state.pos.xy()) + measurement);