rusefi
/
atbetaflight
mirror of https://github.com/rusefi/atbetaflight.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

GPS Rescue: sanity check counters are now always in positive seconds

This commit is contained in:
Tony Cabello 2018-11-04 07:59:35 +01:00
parent 3492bcff3d
commit 35f6c30289
1 changed files with 6 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
src/main/flight/gps_rescue.c
View File

@ -314,8 +314,8 @@ static void performSanityChecks()
// Initialize internal variables each time GPS Rescue is started // Initialize internal variables each time GPS Rescue is started
const uint32_t currentTimeUs = micros(); const uint32_t currentTimeUs = micros();
previousTimeUs = currentTimeUs; previousTimeUs = currentTimeUs;
secondsStalled = 0; secondsStalled = 10; // Start the count at 10 to be less forgiving at the beginning
secondsLowSats = 0; secondsLowSats = 5; // Start the count at 5 to be less forgiving at the beginning
return; return;
} }
@ -344,15 +344,15 @@ static void performSanityChecks()
previousTimeUs = currentTimeUs; previousTimeUs = currentTimeUs;
secondsStalled = constrain(secondsStalled + (rescueState.sensor.groundSpeed < 150) ? 1 : -1, -10, 10); secondsStalled = constrain(secondsStalled + (rescueState.sensor.groundSpeed < 150) ? 1 : -1, 0, 20);
if (secondsStalled == 10) { if (secondsStalled == 20) {
rescueState.failure = RESCUE_STALLED; rescueState.failure = RESCUE_STALLED;
} }
secondsLowSats = constrain(secondsLowSats + (rescueState.sensor.numSat < gpsRescueConfig()->minSats) ? 1 : -1, -5, 5); secondsLowSats = constrain(secondsLowSats + (rescueState.sensor.numSat < gpsRescueConfig()->minSats) ? 1 : -1, 0, 10);
if (secondsLowSats == 5) { if (secondsLowSats == 10) {
rescueState.failure = RESCUE_FLYAWAY; rescueState.failure = RESCUE_FLYAWAY;
} }
} }