Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-14 03:50:02 +03:00
Code Issues Wiki Activity

Merge pull request #7254 from TonyBlit/gps_crosstrack_checks

Browse source 
Sanity checks flyaway/stalled only done in crosstrack phase
This commit is contained in:
Michael Keller 2018-12-21 20:55:28 +13:00 • committed by GitHub
commit 27dda737ad
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23
1 changed files with 10 additions and 8 deletions
Download patch file Download diff file Expand all files Collapse all files

2
src/main/flight/gps_rescue.c
View file

@ -353,6 +353,7 @@ static void performSanityChecks()
previousTimeUs = currentTimeUs;
if (rescueState.phase == RESCUE_CROSSTRACK) {
secondsStalled = constrain(secondsStalled + ((rescueState.sensor.groundSpeed < 150) ? 1 : -1), 0, 20);
if (secondsStalled == 20) {
@ -365,6 +366,7 @@ static void performSanityChecks()
if (secondsFlyingAway == 10) {
rescueState.failure = RESCUE_FLYAWAY;
}
}
secondsLowSats = constrain(secondsLowSats + ((rescueState.sensor.numSat < gpsRescueConfig()->minSats) ? 1 : -1), 0, 10);