From 35daef948bb6dac06900d7bc74aa09fe35aceabd Mon Sep 17 00:00:00 2001
From: Thomas Gubler <thomasgubler@gmail.com>
Date: Sat, 16 Aug 2014 10:52:01 +0200
Subject: [PATCH] fix datalink loss detection logic

---
 src/modules/commander/commander.cpp | 4 ++++
 1 file changed, 4 insertions(+)

diff --git a/src/modules/commander/commander.cpp b/src/modules/commander/commander.cpp
index 28aba759fd..8a12e16ca6 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 {