Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-23 08:15:26 +03:00
Code Issues Wiki Activity

Merge pull request #3647 from teckel12/te_nav_cruise_mode_frsky_telemetry

Browse source 
Add `NAV_CRUISE_MODE` to FrSky/S.Port Telemetry
This commit is contained in:
Konstantin Sharlaimov 2018-07-25 20:58:28 +02:00 • committed by GitHub
commit 1456e12979
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23
1 changed files with 8 additions and 6 deletions
Download patch file Download diff file Expand all files Collapse all files

14
src/main/telemetry/frsky.c
View file

@ -27,7 +27,7 @@ uint16_t frskyGetFlightMode(void)
tmpi += 2;
if (ARMING_FLAG(ARMED))
tmpi += 4;
// tens column
if (FLIGHT_MODE(ANGLE_MODE))
tmpi += 10;
@ -35,7 +35,7 @@ uint16_t frskyGetFlightMode(void)
tmpi += 20;
if (FLIGHT_MODE(MANUAL_MODE))
tmpi += 40;
// hundreds column
if (FLIGHT_MODE(HEADING_MODE))
tmpi += 100;
@ -43,15 +43,17 @@ uint16_t frskyGetFlightMode(void)
tmpi += 200;
if (FLIGHT_MODE(NAV_POSHOLD_MODE))
tmpi += 400;
// thousands column
if (FLIGHT_MODE(NAV_RTH_MODE))
tmpi += 1000;
if (FLIGHT_MODE(NAV_WP_MODE))
if (FLIGHT_MODE(NAV_CRUISE_MODE)) // intentionally out of order and 'else-ifs' to prevent column overflow
tmpi += 8000;
else if (FLIGHT_MODE(NAV_WP_MODE))
tmpi += 2000;
if (FLIGHT_MODE(HEADFREE_MODE))
else if (FLIGHT_MODE(HEADFREE_MODE))
tmpi += 4000;
// ten thousands column
if (FLIGHT_MODE(FLAPERON))
tmpi += 10000;