From 8deba6971542dcb1d60cbc2036417205420cb0e3 Mon Sep 17 00:00:00 2001 From: floaledm 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)<