diff --git a/src/modules/navigator/navigator_main.cpp b/src/modules/navigator/navigator_main.cpp index 30cf417c48..8e2f24e157 100644 --- a/src/modules/navigator/navigator_main.cpp +++ b/src/modules/navigator/navigator_main.cpp @@ -783,17 +783,7 @@ void Navigator::run() _pos_sp_triplet_published_invalid_once = false; } -#if CONFIG_MODE_NAVIGATOR_VTOL_TAKEOFF - - // If we are in VTOL takeoff, do not switch until it is finished. - if (_navigation_mode == &_vtol_takeoff && !get_mission_result()->finished) { - navigation_mode_new = &_vtol_takeoff; - - } else -#endif //CONFIG_MODE_NAVIGATOR_VTOL_TAKEOFF - { - navigation_mode_new = &_rtl; - } + navigation_mode_new = &_rtl; break;