commander: Added duration of rc-loss to mavlink_log_critical message

This commit is contained in:
philipoe
2014-10-20 16:25:38 +02:00
parent 5c77fc0012
commit 4afa864583
2 changed files with 3 additions and 1 deletions

View File

@@ -1499,7 +1499,7 @@ int commander_thread_main(int argc, char *argv[])
} else {
if (status.rc_signal_lost) {
mavlink_log_critical(mavlink_fd, "RC SIGNAL REGAINED (at t=%.3fs)",(double)(hrt_absolute_time())/1.0e6);
mavlink_log_critical(mavlink_fd, "RC SIGNAL REGAINED after %.3fs (at t=%.3fs)",(double)(hrt_absolute_time()-status.rc_signal_lost_timestamp)/1.0e6,(double)(hrt_absolute_time())/1.0e6);
status_changed = true;
}
}
@@ -1594,6 +1594,7 @@ int commander_thread_main(int argc, char *argv[])
if (!status.rc_signal_lost) {
mavlink_log_critical(mavlink_fd, "RC SIGNAL LOST (at t=%.3fs)",(double)(hrt_absolute_time())/1.0e6);
status.rc_signal_lost = true;
status.rc_signal_lost_timestamp=sp_man.timestamp;
status_changed = true;
}
}