|
|
|
@ -1096,7 +1096,7 @@ void NavEKF2_core::selectHeightForFusion()
@@ -1096,7 +1096,7 @@ void NavEKF2_core::selectHeightForFusion()
|
|
|
|
|
} |
|
|
|
|
// 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 copter downwash corrupting the EKF altitude during initial ascent
|
|
|
|
|
if (motorsArmed && dal.get_takeoff_expected()) { |
|
|
|
|
if (motorsArmed && dal.get_takeoff_expected() && !assume_zero_sideslip()) { |
|
|
|
|
hgtMea = MAX(hgtMea, meaHgtAtTakeOff); |
|
|
|
|
} |
|
|
|
|
} else { |
|
|
|
|