diff options
author | Anton Babushkin <anton.babushkin@me.com> | 2014-07-16 14:22:48 +0200 |
---|---|---|
committer | Anton Babushkin <anton.babushkin@me.com> | 2014-07-16 14:22:48 +0200 |
commit | 698fcb6b8687b5901145ec90462297c398fbf5c3 (patch) | |
tree | 04ca7c4fdd9b15f8344d4a7e7876d988a449d15b /src/modules/commander | |
parent | 0c5ce3d3a23a32556b38bb0936b315d12290e4ba (diff) | |
download | px4-firmware-698fcb6b8687b5901145ec90462297c398fbf5c3.tar.gz px4-firmware-698fcb6b8687b5901145ec90462297c398fbf5c3.tar.bz2 px4-firmware-698fcb6b8687b5901145ec90462297c398fbf5c3.zip |
commander: only warn about lost link if link was working before
Diffstat (limited to 'src/modules/commander')
-rw-r--r-- | src/modules/commander/commander.cpp | 2 |
1 files changed, 1 insertions, 1 deletions
diff --git a/src/modules/commander/commander.cpp b/src/modules/commander/commander.cpp index 0c4d48dea..953feec2a 100644 --- a/src/modules/commander/commander.cpp +++ b/src/modules/commander/commander.cpp @@ -1441,7 +1441,7 @@ int commander_thread_main(int argc, char *argv[]) /* data links check */ bool have_link = false; for (int i = 0; i < TELEMETRY_STATUS_ORB_ID_NUM; i++) { - if (hrt_elapsed_time(&telemetry_last_heartbeat[i]) < DL_TIMEOUT) { + if (telemetry_last_heartbeat[i] != 0 && hrt_elapsed_time(&telemetry_last_heartbeat[i]) < DL_TIMEOUT) { /* handle the case where data link was regained */ if (telemetry_lost[i]) { mavlink_log_critical(mavlink_fd, "data link %i regained", i); |