gps: wait for gps write buffer to empty before writing more

2013-11-01 23:19:36 +02:00 · 2013-11-01 23:19:36 +02:00 · 091c77592a
parent 567e7f7cc8
commit 091c77592a
1 changed files with 5 additions and 0 deletions
--- a/src/gps.c
+++ b/src/gps.c
@ -117,6 +117,11 @@ void gpsInitHardware(void)

        case GPS_UBLOX:
            // UBX will run at mcfg.baudrate, it shouldn't be "autodetected". So here we force it to that rate
+
+                // Wait until GPS transmit buffer is empty
+                if (!isSerialTransmitBufferEmpty(core.gpsport))
+                    break;
+
            if (gpsData.state == GPS_INITIALIZING) {
                gpsData.state_position++;
                if (gpsData.state_position <= GPS_INIT_ENTRIES) {