nav: check valid flag on PositionGeodetic measurement (#22858)

selfdrive/ui/navd/route_engine.cc

@@ -131,14 +131,14 @@ void RouteEngine::timerUpdate() {
   }
 
   auto location = (*sm)["liveLocationKalman"].getLiveLocationKalman();
+  auto pos = location.getPositionGeodetic();
+  auto orientation = location.getCalibratedOrientationNED();
+
   gps_ok = location.getGpsOK();
 
-  localizer_valid = location.getStatus() == cereal::LiveLocationKalman::Status::VALID;
+  localizer_valid = (location.getStatus() == cereal::LiveLocationKalman::Status::VALID) && pos.getValid();
 
   if (localizer_valid) {
-    auto pos = location.getPositionGeodetic();
-    auto orientation = location.getCalibratedOrientationNED();
-
     last_bearing = RAD2DEG(orientation.getValue()[2]);
     last_position = QMapbox::Coordinate(pos.getValue()[0], pos.getValue()[1]);
   }

selfdrive/ui/qt/maps/map.cc

@@ -112,13 +112,12 @@ void MapWindow::timerUpdate() {
   sm->update(0);
   if (sm->updated("liveLocationKalman")) {
     auto location = (*sm)["liveLocationKalman"].getLiveLocationKalman();
-
-    localizer_valid = location.getStatus() == cereal::LiveLocationKalman::Status::VALID;
-
-    if (localizer_valid) {
     auto pos = location.getPositionGeodetic();
     auto orientation = location.getCalibratedOrientationNED();
 
+    localizer_valid = (location.getStatus() == cereal::LiveLocationKalman::Status::VALID) && pos.getValid();
+
+    if (localizer_valid) {
       float velocity = location.getVelocityCalibrated().getValue()[0];
       float bearing = RAD2DEG(orientation.getValue()[2]);
       auto coordinate = QMapbox::Coordinate(pos.getValue()[0], pos.getValue()[1]);