commander: improve output on gf violation

This commit is contained in:
Thomas Gubler 2014-09-21 18:03:31 +02:00
parent e65ec1b98b
commit 4b8a385658
1 changed files with 4 additions and 0 deletions

View File

@ -1449,8 +1449,12 @@ int commander_thread_main(int argc, char *argv[])
static bool flight_termination_printed = false;
if (!flight_termination_printed) {
warnx("Flight termination because of navigator request or geofence");
mavlink_log_critical(mavlink_fd, "GF violation: flight termination");
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
}