Browse Source

AP_NavEKF2: remove unnecessary PV_AidingMode check

Thanks to OXINARF for catching this
mission-4.1.18
Randy Mackay 9 years ago
parent
commit
4d458833dc
  1. 2
      libraries/AP_NavEKF2/AP_NavEKF2_PosVelFusion.cpp

2
libraries/AP_NavEKF2/AP_NavEKF2_PosVelFusion.cpp

@ -379,7 +379,7 @@ void NavEKF2_core::FuseVelPosNED()
// declare a timeout if we have not fused velocity data for too long or not aiding // declare a timeout if we have not fused velocity data for too long or not aiding
velTimeout = (((imuSampleTime_ms - lastVelPassTime_ms) > gpsRetryTime) || PV_AidingMode == AID_NONE); velTimeout = (((imuSampleTime_ms - lastVelPassTime_ms) > gpsRetryTime) || PV_AidingMode == AID_NONE);
// use velocity data if healthy, timed out, or in constant position mode // use velocity data if healthy, timed out, or in constant position mode
if (velHealth || velTimeout || (PV_AidingMode == AID_NONE)) { if (velHealth || velTimeout) {
velHealth = true; velHealth = true;
// restart the timeout count // restart the timeout count
lastVelPassTime_ms = imuSampleTime_ms; lastVelPassTime_ms = imuSampleTime_ms;

Loading…
Cancel
Save