Fix queue build up issue in gpsd_client (#89)

swri-robotics · Oct 26, 2023 · 113782d · 113782d
1 parent bec832e
commit 113782d
Showing 1 changed file with 7 additions and 1 deletion.
diff --git a/gpsd_client/src/client.cpp b/gpsd_client/src/client.cpp
@@ -86,7 +86,13 @@ namespace gpsd_client
       if (!gps_->waiting(1e6))
         return;
 
-      gps_data_t* p = gps_->read();
+      // Read out all queued data and only act on the latest
+      gps_data_t* p = NULL;
+      while (gps_->waiting(0))
+      {
+        p = gps_->read();
+      }
+
 #else
       gps_data_t *p = gps->poll();
 #endif