From 2778ad0c5d9fc5f6eeec7fc122efe19a75702d07 Mon Sep 17 00:00:00 2001 From: Dominic Clifton Date: Thu, 11 Dec 2014 16:31:14 +0000 Subject: [PATCH] Fix gps error counter so that it is meaningful, it was being reset each time the gps unit was reinitialised leading users to think there were no GPS errors. --- src/main/io/display.c | 5 +++++ src/main/io/gps.c | 6 +++--- 2 files changed, 8 insertions(+), 3 deletions(-) diff --git a/src/main/io/display.c b/src/main/io/display.c index 448d9d400d..8be950e7df 100644 --- a/src/main/io/display.c +++ b/src/main/io/display.c @@ -321,6 +321,11 @@ void showGpsPage() { padLineBuffer(); i2c_OLED_set_line(rowIndex++); i2c_OLED_send_string(lineBuffer); + + tfp_sprintf(lineBuffer, "%d cm/s, gc: %d", GPS_speed, GPS_ground_course); + padLineBuffer(); + i2c_OLED_set_line(rowIndex++); + i2c_OLED_send_string(lineBuffer); } void showBatteryPage(void) diff --git a/src/main/io/gps.c b/src/main/io/gps.c index 39bde4ed17..81b8319f7f 100644 --- a/src/main/io/gps.c +++ b/src/main/io/gps.c @@ -179,6 +179,9 @@ void gpsInit(serialConfig_t *initialSerialConfig, gpsConfig_t *initialGpsConfig) } } + // clear error counter + gpsData.errors = 0; + gpsConfig = initialGpsConfig; // init gpsData structure. if we're not actually enabled, don't bother doing anything else @@ -297,9 +300,6 @@ void gpsInitHardware(void) gpsInitUblox(); break; } - - // clear error counter - gpsData.errors = 0; } void gpsThread(void)