Making altitude NaN if in 2D fix mode

swri-robotics · May 9, 2024 · 93d2edd · 93d2edd
1 parent e6ee597
commit 93d2edd
Showing 1 changed file with 8 additions and 1 deletion.
diff --git a/gpsd_client/src/client.cpp b/gpsd_client/src/client.cpp
@@ -208,7 +208,14 @@ namespace gpsd_client
 #endif
         fix.latitude = p->fix.latitude;
         fix.longitude = p->fix.longitude;
-        fix.altitude = p->fix.altitude;
+        if (p->fix.mode == MODE_3D)
+        {
+          fix.altitude = p->fix.altitude;
+        }
+        else
+        {
+          fix.altitude = std::nan("");
+        }
         fix.track = p->fix.track;
         fix.speed = p->fix.speed;
         fix.climb = p->fix.climb;