diff options
| author | Thomas Gubler <thomasgubler@gmail.com> | 2014-08-16 10:52:01 +0200 |
|---|---|---|
| committer | Thomas Gubler <thomasgubler@gmail.com> | 2014-08-16 10:52:01 +0200 |
| commit | 35daef948bb6dac06900d7bc74aa09fe35aceabd (patch) | |
| tree | 53a66f59ca592f7d03be9cb398d6069b5c7a1392 | |
| parent | 2791a7097686d327e91ac31c20716bb602011d65 (diff) | |
| download | px4-firmware-35daef948bb6dac06900d7bc74aa09fe35aceabd.tar.gz px4-firmware-35daef948bb6dac06900d7bc74aa09fe35aceabd.tar.bz2 px4-firmware-35daef948bb6dac06900d7bc74aa09fe35aceabd.zip | |
fix datalink loss detection logic
| -rw-r--r-- | src/modules/commander/commander.cpp | 4 |
1 files changed, 4 insertions, 0 deletions
diff --git a/src/modules/commander/commander.cpp b/src/modules/commander/commander.cpp index 28aba759f..8a12e16ca 100644 --- a/src/modules/commander/commander.cpp +++ b/src/modules/commander/commander.cpp @@ -1534,6 +1534,10 @@ int commander_thread_main(int argc, char *argv[]) mavlink_log_critical(mavlink_fd, "data link %i regained", i); telemetry_lost[i] = false; have_link = true; + } else if (!telemetry_lost[i]) { + /* telemetry was healthy also in last iteration + * we don't have to check a timeout */ + have_link = true; } } else { |