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 Matthias Grob
parent 32a74afbb8
commit 6c69d86d7e

View File

@ -556,7 +556,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 {