Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-16 21:05:35 +03:00
Code Issues Wiki Activity

Fix READY_BEEP

Browse source
This commit is contained in:
Hans Christian Olaussen 2022-04-13 21:08:29 +02:00
parent f4775292b6
commit 0bb5bca5a7
1 changed files with 16 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

16
src/main/io/gps.c
View file

@ -43,6 +43,7 @@
#include "drivers/light_led.h" #include "drivers/light_led.h"
#include "drivers/time.h" #include "drivers/time.h"
#include "io/beeper.h"
#include "io/dashboard.h" #include "io/dashboard.h"
#include "io/gps.h" #include "io/gps.h"
#include "io/serial.h" #include "io/serial.h"
@ -872,11 +873,26 @@ void gpsUpdate(timeUs_t currentTimeUs)
if (!ARMING_FLAG(ARMED) && !gpsConfig()->gps_set_home_point_once) { if (!ARMING_FLAG(ARMED) && !gpsConfig()->gps_set_home_point_once) {
DISABLE_STATE(GPS_FIX_HOME); DISABLE_STATE(GPS_FIX_HOME);
} }
uint8_t minSats = 5;
#if defined(USE_GPS_RESCUE) #if defined(USE_GPS_RESCUE)
if (gpsRescueIsConfigured()) { if (gpsRescueIsConfigured()) {
updateGPSRescueState(); updateGPSRescueState();
minSats = gpsRescueConfig()->minSats;
} }
#endif #endif
static bool hasFix = false;
if (STATE(GPS_FIX)) {
if (gpsIsHealthy() && gpsSol.numSat >= minSats && !hasFix) {
// ready beep sequence on fix or requirements for gps rescue met.
beeper(BEEPER_READY_BEEP);
hasFix = true;
}
} else {
hasFix = false;
}
} }
static void gpsNewData(uint16_t c) static void gpsNewData(uint16_t c)