navigator: Fix RTL_TYPE 2 by reloading mission (#23855)

This commit is contained in:
Potaito
2024-11-04 19:19:59 -09:00
committed by GitHub
parent f516b41b59
commit 098a3378cc
5 changed files with 10 additions and 8 deletions
+4 -2
View File
@@ -585,6 +585,8 @@ void RTL::init_rtl_mission_type()
_set_rtl_mission_type = RtlType::NONE;
}
mission_s new_mission = _mission_sub.get();
switch (new_rtl_mission_type) {
case RtlType::RTL_DIRECT_MISSION_LAND:
_rtl_mission_type_handle = new RtlDirectMissionLand(_navigator);
@@ -593,13 +595,13 @@ void RTL::init_rtl_mission_type()
break;
case RtlType::RTL_MISSION_FAST:
_rtl_mission_type_handle = new RtlMissionFast(_navigator);
_rtl_mission_type_handle = new RtlMissionFast(_navigator, new_mission);
_set_rtl_mission_type = RtlType::RTL_MISSION_FAST;
_rtl_type = RtlType::RTL_MISSION_FAST;
break;
case RtlType::RTL_MISSION_FAST_REVERSE:
_rtl_mission_type_handle = new RtlMissionFastReverse(_navigator);
_rtl_mission_type_handle = new RtlMissionFastReverse(_navigator, new_mission);
_set_rtl_mission_type = RtlType::RTL_MISSION_FAST_REVERSE;
_rtl_type = RtlType::RTL_MISSION_FAST_REVERSE;
break;