1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-20 06:45:16 +03:00

Disable HEADFREE flight mode when GPS Rescue is active

The GPS Rescue flight control model doesn't work in HEADFREE mode.
This commit is contained in:
Bruce Luckcuck 2020-10-27 12:50:41 -04:00
parent ae62f46958
commit 9c575d9353

View file

@ -1020,14 +1020,14 @@ bool processRx(timeUs_t currentTimeUs)
DISABLE_FLIGHT_MODE(MAG_MODE);
}
#endif
if (IS_RC_MODE_ACTIVE(BOXHEADFREE)) {
if (IS_RC_MODE_ACTIVE(BOXHEADFREE) && !FLIGHT_MODE(GPS_RESCUE_MODE)) {
if (!FLIGHT_MODE(HEADFREE_MODE)) {
ENABLE_FLIGHT_MODE(HEADFREE_MODE);
}
} else {
DISABLE_FLIGHT_MODE(HEADFREE_MODE);
}
if (IS_RC_MODE_ACTIVE(BOXHEADADJ)) {
if (IS_RC_MODE_ACTIVE(BOXHEADADJ) && !FLIGHT_MODE(GPS_RESCUE_MODE)) {
if (imuQuaternionHeadfreeOffsetSet()) {
beeper(BEEPER_RX_SET);
}