From ef4198bcb4de40fe4e6aba03600b7b6c32722810 Mon Sep 17 00:00:00 2001
From: Andrew Tridgell <tridge@samba.org>
Date: Fri, 3 May 2013 09:45:15 +1000
Subject: [PATCH] Rover: don't do failsafe if throttle is below failsafe level

---
 APMrover2/failsafe.pde | 3 ++-
 1 file changed, 2 insertions(+), 1 deletion(-)

diff --git a/APMrover2/failsafe.pde b/APMrover2/failsafe.pde
index 69092608a4..605d78ddbb 100644
--- a/APMrover2/failsafe.pde
+++ b/APMrover2/failsafe.pde
@@ -35,7 +35,8 @@ void failsafe_check(uint32_t tnow)
         in_failsafe = true;
     }
 
-    if (in_failsafe && tnow - last_timestamp > 20000) {
+    if (in_failsafe && tnow - last_timestamp > 20000 && 
+        hal.rcin->read(CH_3) >= (uint16_t)g.fs_throttle_value) {
         // pass RC inputs to outputs every 20ms        
         last_timestamp = tnow;
         hal.rcin->clear_overrides();