fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-15 08:23:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

mission_base: make sure to always update state on mission topic update

Browse Source
This commit is contained in:
Konrad
2024-01-30 11:25:37 -05:00
committed by Daniel Agar
parent 97ce599b1f
commit 0a153efb9d
1 changed files with 13 additions and 11 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/navigator/mission_base.cpp
+13 -11
View File
@@ -111,20 +111,22 @@ void MissionBase::updateMavlinkMission()
mission_s new_mission;
_mission_sub.update(&new_mission);
if (isMissionValid(new_mission)) {
/* Relevant mission items updated externally*/
if (checkMissionDataChanged(new_mission)) {
bool mission_items_changed = (new_mission.mission_id != _mission.mission_id);
const bool mission_items_changed = (new_mission.mission_id != _mission.mission_id);
const bool mission_data_changed = checkMissionDataChanged(new_mission);
if (new_mission.current_seq < 0) {
new_mission.current_seq = math::max(math::min(_mission.current_seq, static_cast<int32_t>(new_mission.count) - 1),
INT32_C(0));
}
if (new_mission.current_seq < 0) {
new_mission.current_seq = math::max(math::min(_mission.current_seq, static_cast<int32_t>(new_mission.count) - 1),
INT32_C(0));
}
_mission = new_mission;
_mission = new_mission;
onMissionUpdate(mission_items_changed);
}
_is_current_planned_mission_item_valid = isMissionValid(_mission);
/* Relevant mission items updated externally*/
if (mission_data_changed) {
onMissionUpdate(mission_items_changed);
}
}
}