Update AP_GPS_UBLOX.cpp

Patch "unhealthy GPS" warning on LOCOSYS RTK_DUAL driver
ArduPilot · Feb 11, 2025 · fdf6a8c · fdf6a8c
1 parent 1a10241
commit fdf6a8c
Showing 1 changed file with 20 additions and 0 deletions.
diff --git a/libraries/AP_GPS/AP_GPS_UBLOX.cpp b/libraries/AP_GPS/AP_GPS_UBLOX.cpp
@@ -20,6 +20,8 @@
 //
 #include "AP_GPS_UBLOX.h"
 
+#define SUPPORT_LX_RTK_DUAL_PATCH       20240314_20250211_unhealth_gps_patch
+
 #if AP_GPS_UBLOX_ENABLED
 
 #include "AP_GPS.h"
@@ -1616,6 +1618,9 @@ AP_GPS_UBLOX::_parse_gps(void)
                                           static_cast<uint32_t>(RELPOSNED::refObsMiss) |
                                           static_cast<uint32_t>(RELPOSNED::carrSolnFloat);
 
+#ifdef  SUPPORT_LX_RTK_DUAL_PATCH       
+            state.gps_yaw_configured = true; // ++ LXX YAW config  patch 20221015  in MSG_RELPOSNED:  ++ 
+#endif            
             _check_new_itow(_buffer.relposned.iTOW);
             if (_buffer.relposned.iTOW != _last_relposned_itow+200) {
                 // useful for looking at packet loss on links
@@ -2279,6 +2284,21 @@ bool AP_GPS_UBLOX::is_healthy(void) const
     }
 #endif
 #if GPS_MOVING_BASELINE
+
+#ifdef  SUPPORT_LX_RTK_DUAL_PATCH             
+ if (gps._auto_config == AP_GPS::GPS_AUTO_CONFIG_DISABLE) { 
+     // since  GPS_AUTO_CONFIG =0    //  _hardware_generation is not available 
+        return true;                                       
+    }       
+else if ((role == AP_GPS::GPS_ROLE_MB_BASE ||
+           role == AP_GPS::GPS_ROLE_MB_ROVER) 
+          && _hardware_generation ==  LX_RTK_DUAL)
+    return true;   // in case GPS_AUTO_CONFIG enabled  
+#endif 
+
+
+
+
     if ((role == AP_GPS::GPS_ROLE_MB_BASE ||
         role == AP_GPS::GPS_ROLE_MB_ROVER) &&
         !supports_F9_config()) {