From a1bc46e4732507ef0544a076ec9b2bf5aa4a1ad9 Mon Sep 17 00:00:00 2001
From: Andre Bernet <andre@andrebernet.ch>
Date: Sat, 1 Aug 2015 17:47:34 +0200
Subject: [PATCH] Fix SBUS trainer failsafe detection

---
 radio/src/sbus.cpp | 5 ++---
 1 file changed, 2 insertions(+), 3 deletions(-)

diff --git a/radio/src/sbus.cpp b/radio/src/sbus.cpp
index 16f9fd50f..ca2fdafa6 100644
--- a/radio/src/sbus.cpp
+++ b/radio/src/sbus.cpp
@@ -69,9 +69,8 @@ void processSbusFrame(uint8_t *sbus, int16_t *pulses, uint32_t size)
     return;
   }
 
-  if (size > SBUS_FLAGS_IDX &&
-      (sbus[SBUS_FLAGS_IDX-1] & (1<<SBUS_FAILSAFE_BIT))) {
-    return; // SBUS failsafe mode
+  if (size > SBUS_FLAGS_IDX && ((sbus[SBUS_FLAGS_IDX] & (1<<SBUS_FAILSAFE_BIT)) || (sbus[SBUS_FLAGS_IDX] & (1<<SBUS_FRAMELOST_BIT)))) {
+    return; // SBUS invalid frame or failsafe mode
   }
 
   // Skip start byte