From 8deba6971542dcb1d60cbc2036417205420cb0e3 Mon Sep 17 00:00:00 2001
From: floaledm <flomartel@gmail.com>
Date: Thu, 1 Sep 2016 12:05:42 -0500
Subject: [PATCH] AP_Frsky_Telem: added 1 to control_mode passed on Frsky link

---
 libraries/AP_Frsky_Telem/AP_Frsky_Telem.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/libraries/AP_Frsky_Telem/AP_Frsky_Telem.cpp b/libraries/AP_Frsky_Telem/AP_Frsky_Telem.cpp
index 18e621de99..e510cfc858 100644
--- a/libraries/AP_Frsky_Telem/AP_Frsky_Telem.cpp
+++ b/libraries/AP_Frsky_Telem/AP_Frsky_Telem.cpp
@@ -635,7 +635,7 @@ uint32_t AP_Frsky_Telem::calc_ap_status(void)
     uint32_t ap_status;
 
     // control/flight mode number (limit to 31 (0x1F) since the value is stored on 5 bits)
-    ap_status = (uint8_t)(_ap.control_mode & AP_CONTROL_MODE_LIMIT);
+    ap_status = (uint8_t)((_ap.control_mode+1) & AP_CONTROL_MODE_LIMIT);
     // simple/super simple modes flags
     ap_status |= (uint8_t)(*_ap.value & AP_SSIMPLE_FLAGS)<<AP_SSIMPLE_OFFSET;
     // land complete flag