Mirrors_Framework/ardupilot
1
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot.git synced 2026-10-06 19:00:27 +08:00
Code Issues Packages Projects Releases Wiki Activity

AP_NavEKF3: Remove unnecessary baro limiting

Browse Source
This commit is contained in:
Paul Riseborough
2021-06-02 11:13:16 +09:00
committed by Randy Mackay
parent 124f016e5b
commit a5a25411da
1 changed files with 0 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
libraries/AP_NavEKF3/AP_NavEKF3_PosVelFusion.cpp
-5
View File
@@ -1181,11 +1181,6 @@ void NavEKF3_core::selectHeightForFusion()
if (dal.get_takeoff_expected() || dal.get_touchdown_expected()) {
posDownObsNoise *= frontend->gndEffectBaroScaler;
}
// If we are in takeoff mode, the height measurement is limited to be no less than the measurement at start of takeoff
// This prevents negative baro disturbances due to rotor wash ground interaction corrupting the EKF altitude during initial ascent
if (motorsArmed && dal.get_takeoff_expected() && !assume_zero_sideslip()) {
hgtMea = MAX(hgtMea, meaHgtAtTakeOff);
}
velPosObs[5] = -hgtMea;
} else {
fuseHgtData = false;