mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-06-28 19:10:34 +08:00
transition alignment will force heading now and go to RTL if it cannot reach it in time, handle mission failure correctly, reset after mission update, issue message with actual problem
This commit is contained in:
@@ -2043,6 +2043,15 @@ int commander_thread_main(int argc, char *argv[])
|
||||
|
||||
if (updated) {
|
||||
orb_copy(ORB_ID(mission_result), mission_result_sub, &mission_result);
|
||||
|
||||
if (status.mission_failure != mission_result.mission_failure) {
|
||||
status.mission_failure = mission_result.mission_failure;
|
||||
status_changed = true;
|
||||
|
||||
if (status.mission_failure) {
|
||||
mavlink_log_critical(mavlink_fd, "mission cannot be completed");
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* start geofence result check */
|
||||
|
||||
Reference in New Issue
Block a user