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
const uint32_t currentTimeUs = micros();
previousTimeUs = currentTimeUs;
secondsStalled = 0;
secondsLowSats = 0;
secondsStalled = 10; // Start the count at 10 to be less forgiving at the beginning
secondsLowSats = 5; // Start the count at 5 to be less forgiving at the beginning
return;
}
@ -344,15 +344,15 @@ static void performSanityChecks()
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;
}
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;
}
}