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

Revert "BugFix: time to first fix was sometimes abnormally high… (#9308)

Browse source 
Revert "BugFix: time to first fix was sometimes abnormally high due t…
This commit is contained in:
Michael Keller 2019-12-25 00:17:45 +13:00 • committed by mikeller
parent 3629edc8a9
commit 9011c4e722
2 changed files with 10 additions and 20 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -416,9 +416,16 @@ void gpsInitUblox(void)
}
if (gpsData.messageState == GPS_MESSAGE_STATE_INIT) {
if (gpsData.state_position < sizeof(ubloxInit)) {
serialWrite(gpsPort, ubloxInit[gpsData.state_position]);
if (gpsData.state_position < sizeof(ubloxAirborne)) {
#if defined(GPS_UBLOX_MODE_PEDESTRIAN)
serialWrite(gpsPort, ubloxInit[gpsData.state_position]);
#else
serialWrite(gpsPort, ubloxAirborne[gpsData.state_position]);
#endif
} else {
serialWrite(gpsPort, ubloxInit[gpsData.state_position]);
}
gpsData.state_position++;
} else {
gpsData.state_position = 0;
@ -449,7 +456,7 @@ void gpsInitUblox(void)
}
}
if (gpsData.messageState >= GPS_MESSAGE_STATE_INITIALIZED) {
if (gpsData.messageState >= GPS_MESSAGE_STATE_ENTRY_COUNT) {
// ublox should be initialised, try receiving
gpsSetState(GPS_RECEIVING_DATA);
}
@ -530,21 +537,6 @@ void gpsUpdate(timeUs_t currentTimeUs)
// remove GPS from capability
sensorsClear(SENSOR_GPS);
gpsSetState(GPS_LOST_COMMUNICATION);
#if !defined(GPS_UBLOX_MODE_PEDESTRIAN)
} else {
if ((gpsData.messageState == GPS_MESSAGE_STATE_IDLE) && STATE(GPS_FIX)) {
gpsData.messageState = GPS_MESSAGE_STATE_AIRBORNE;
gpsData.state_position = 0;
}
if (gpsData.messageState == GPS_MESSAGE_STATE_AIRBORNE) {
if (gpsData.state_position < sizeof(ubloxAirborne)) {
serialWrite(gpsPort, ubloxAirborne[gpsData.state_position]);
gpsData.state_position++;
} else {
gpsData.messageState = GPS_MESSAGE_STATE_ENTRY_COUNT;
}
}
#endif
}
break;
}

2
src/main/io/gps.h
View file

@ -106,8 +106,6 @@ typedef enum {
GPS_MESSAGE_STATE_INIT,
GPS_MESSAGE_STATE_SBAS,
GPS_MESSAGE_STATE_GALILEO,
GPS_MESSAGE_STATE_INITIALIZED,
GPS_MESSAGE_STATE_AIRBORNE,
GPS_MESSAGE_STATE_ENTRY_COUNT
} gpsMessageState_e;