mission_base: on mission end, set loiter position from previous position type setpoint

This commit is contained in:
Luka Filipović 2025-09-24 13:32:41 +02:00 committed by Alex Klimaj
parent 150dd0bff0
commit f3979c0fcf

View File

@ -553,7 +553,9 @@ void MissionBase::setEndOfMissionItems()
_mission_item.nav_cmd = NAV_CMD_IDLE;
} else {
if (pos_sp_triplet->current.valid && pos_sp_triplet->current.type == position_setpoint_s::SETPOINT_TYPE_LOITER) {
if (pos_sp_triplet->current.valid &&
(pos_sp_triplet->current.type == position_setpoint_s::SETPOINT_TYPE_LOITER ||
pos_sp_triplet->current.type == position_setpoint_s::SETPOINT_TYPE_POSITION)) {
setLoiterItemFromCurrentPositionSetpoint(&_mission_item);
} else {