1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-25 01:05:27 +03:00

Added disabling of GPS_RESCUE when 3D is enabled.

This commit is contained in:
mikeller 2018-07-01 19:10:08 +12:00
parent 7936d2ec57
commit 93ab648183
8 changed files with 70 additions and 13 deletions

View file

@ -125,3 +125,27 @@ bool isModeActivationConditionPresent(boxId_e modeId)
return false;
}
void removeModeActivationCondition(const boxId_e modeId)
{
unsigned offset = 0;
for (unsigned i = 0; i < MAX_MODE_ACTIVATION_CONDITION_COUNT; i++) {
modeActivationCondition_t *mac = modeActivationConditionsMutable(i);
if (mac->modeId == modeId && !offset) {
offset++;
}
if (offset) {
while (i + offset < MAX_MODE_ACTIVATION_CONDITION_COUNT && modeActivationConditions(i + offset)->modeId == modeId) {
offset++;
}
if (i + offset < MAX_MODE_ACTIVATION_CONDITION_COUNT) {
memcpy(mac, modeActivationConditions(i + offset), sizeof(modeActivationCondition_t));
} else {
memset(mac, 0, sizeof(modeActivationCondition_t));
}
}
}
}