diff --git a/src/lib/FlightTasks/tasks/AutoMapper/FlightTaskAutoMapper.cpp b/src/lib/FlightTasks/tasks/AutoMapper/FlightTaskAutoMapper.cpp index f50d95e87e..b2e75e956e 100644 --- a/src/lib/FlightTasks/tasks/AutoMapper/FlightTaskAutoMapper.cpp +++ b/src/lib/FlightTasks/tasks/AutoMapper/FlightTaskAutoMapper.cpp @@ -69,6 +69,12 @@ bool FlightTaskAutoMapper::update() if (_type_previous == WaypointType::idle) { _thrust_setpoint = Vector3f(NAN, NAN, NAN); } + + // during mission and reposition, raise the landing gears but only + // if altitude is high enough + if (_highEnoughForLandingGear()) { + _gear.landing_gear = _mission_gear; + } if (_type == WaypointType::idle) { _generateIdleSetpoints(); @@ -92,12 +98,6 @@ bool FlightTaskAutoMapper::update() _yawspeed_setpoint); } - // during mission and reposition, raise the landing gears but only - // if altitude is high enough - if (_highEnoughForLandingGear()) { - _gear.landing_gear = _mission_gear; - } - // update previous type _type_previous = _type; diff --git a/src/lib/FlightTasks/tasks/AutoMapper2/FlightTaskAutoMapper2.cpp b/src/lib/FlightTasks/tasks/AutoMapper2/FlightTaskAutoMapper2.cpp index 34fdc1ad4e..1ccf4c0ae1 100644 --- a/src/lib/FlightTasks/tasks/AutoMapper2/FlightTaskAutoMapper2.cpp +++ b/src/lib/FlightTasks/tasks/AutoMapper2/FlightTaskAutoMapper2.cpp @@ -61,6 +61,12 @@ bool FlightTaskAutoMapper2::update() if (_type_previous == WaypointType::idle) { _thrust_setpoint = Vector3f(NAN, NAN, NAN); } + + // during mission and reposition, raise the landing gears but only + // if altitude is high enough + if (_highEnoughForLandingGear()) { + _gear.landing_gear = landing_gear_s::GEAR_UP; + } switch (_type) { case WaypointType::idle: @@ -100,12 +106,6 @@ bool FlightTaskAutoMapper2::update() _generateSetpoints(); - // during mission and reposition, raise the landing gears but only - // if altitude is high enough - if (_highEnoughForLandingGear()) { - _gear.landing_gear = landing_gear_s::GEAR_UP; - } - // update previous type _type_previous = _type;