diff --git a/src/modules/navigator/rtl_mission_fast_reverse.cpp b/src/modules/navigator/rtl_mission_fast_reverse.cpp index b50d49e50a..c27cd38b56 100644 --- a/src/modules/navigator/rtl_mission_fast_reverse.cpp +++ b/src/modules/navigator/rtl_mission_fast_reverse.cpp @@ -269,6 +269,7 @@ void RtlMissionFastReverse::handleLanding(WorkItemType &new_work_item_type) _mission_item.altitude = _home_pos_sub.get().alt; _mission_item.altitude_is_relative = false; _navigator->reset_position_setpoint(pos_sp_triplet->previous); + _navigator->reset_position_setpoint(pos_sp_triplet->next); _mission_item.land_precision = _param_rtl_pld_md.get(); @@ -278,6 +279,7 @@ void RtlMissionFastReverse::handleLanding(WorkItemType &new_work_item_type) } } } + } }