mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-31 09:51:36 +08:00
commander: improve output on gf violation
This commit is contained in:
@@ -1442,8 +1442,12 @@ int commander_thread_main(int argc, char *argv[])
|
|||||||
static bool flight_termination_printed = false;
|
static bool flight_termination_printed = false;
|
||||||
if (!flight_termination_printed) {
|
if (!flight_termination_printed) {
|
||||||
warnx("Flight termination because of navigator request or geofence");
|
warnx("Flight termination because of navigator request or geofence");
|
||||||
|
mavlink_log_critical(mavlink_fd, "GF violation: flight termination");
|
||||||
flight_termination_printed = true;
|
flight_termination_printed = true;
|
||||||
}
|
}
|
||||||
|
if (counter % (1000000 / COMMANDER_MONITORING_INTERVAL) == 0 ) {
|
||||||
|
mavlink_log_critical(mavlink_fd, "GF violation: flight termination");
|
||||||
|
}
|
||||||
} // no reset is done here on purpose, on geofence violation we want to stay in flighttermination
|
} // no reset is done here on purpose, on geofence violation we want to stay in flighttermination
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user