Browse Source

AP_NavEKF3: check GPS used before resetting pos due to GPS receiver change

c415-sdk
Randy Mackay 5 years ago
parent
commit
183ce50138
  1. 2
      libraries/AP_NavEKF3/AP_NavEKF3_PosVelFusion.cpp

2
libraries/AP_NavEKF3/AP_NavEKF3_PosVelFusion.cpp

@ -431,7 +431,7 @@ void NavEKF3_core::SelectVelPosFusion() @@ -431,7 +431,7 @@ void NavEKF3_core::SelectVelPosFusion()
selectHeightForFusion();
// if we are using GPS, check for a change in receiver and reset position and height
if (gpsDataToFuse && PV_AidingMode == AID_ABSOLUTE && gpsDataDelayed.sensor_idx != last_gps_idx) {
if (gpsDataToFuse && (PV_AidingMode == AID_ABSOLUTE) && (frontend->_fusionModeGPS != 3) && (gpsDataDelayed.sensor_idx != last_gps_idx)) {
// record the ID of the GPS that we are using for the reset
last_gps_idx = gpsDataDelayed.sensor_idx;

Loading…
Cancel
Save