diff --git a/ArduPlane/ArduPlane.cpp b/ArduPlane/ArduPlane.cpp index 7d27791de5..1f6d0c6159 100644 --- a/ArduPlane/ArduPlane.cpp +++ b/ArduPlane/ArduPlane.cpp @@ -789,7 +789,16 @@ float Plane::tecs_hgt_afe(void) coming. */ float hgt_afe; + if (flight_stage == AP_FixedWing::FlightStage::LAND) { + + #if AP_MAVLINK_MAV_CMD_SET_HAGL_ENABLED + // if external HAGL is active use that + if (get_external_HAGL(hgt_afe)) { + return hgt_afe; + } + #endif + hgt_afe = height_above_target(); #if AP_RANGEFINDER_ENABLED hgt_afe -= rangefinder_correction();