AP_Frsky_Telem: added 1 to control_mode passed on Frsky link

This commit is contained in:
floaledm 2016-09-01 12:05:42 -05:00 committed by Andrew Tridgell
parent 4f8cea6844
commit 8deba69715
1 changed files with 1 additions and 1 deletions

View File

@ -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