gps: flush uart buffer before waiting for time

This addresses a bug only on the master branch.
Also turn off the servo sensor, its too long a delay.
We will need to conditionally enable this in a later commit.

1 files changed, 2 insertions, 1 deletions

diff --git a/host/lib/usrp/gps_ctrl.cpp b/host/lib/usrp/gps_ctrl.cpp
index 917f115f3..8c177382a 100644
--- a/host/lib/usrp/gps_ctrl.cpp
+++ b/host/lib/usrp/gps_ctrl.cpp
@@ -201,7 +201,7 @@ private:
      sleep(milliseconds(FIREFLY_STUPID_DELAY_MS));
     _send("GPS:GPRMC 1\n");
      sleep(milliseconds(FIREFLY_STUPID_DELAY_MS));
-    _send("SERV:TRAC 1\n");                        // enable servo trace message
+    _send("SERV:TRAC 0\n");
      sleep(milliseconds(FIREFLY_STUPID_DELAY_MS));
   }
 
@@ -240,6 +240,7 @@ private:
   }
 
   ptime get_time(void) {
+    _flush();
     int error_cnt = 0;
     ptime gps_time;
     while(error_cnt < 2) {