AP_NavEKF3: Fix one frame delay in processing yaw estimator velocity data

5 years ago · bcd23e1063
1 changed files with 1 additions and 1 deletions
--- a/libraries/AP_NavEKF3/AP_NavEKF3_Control.cpp
+++ b/libraries/AP_NavEKF3/AP_NavEKF3_Control.cpp
@ -632,7 +632,7 @@ void NavEKF3_core::runYawEstimatorCorrection()
				@@ -632,7 +632,7 @@ void NavEKF3_core::runYawEstimatorCorrection()
        if (gpsDataToFuse) {
            Vector2f gpsVelNE = Vector2f(gpsDataDelayed.vel.x, gpsDataDelayed.vel.y);
            float gpsVelAcc = fmaxf(gpsSpdAccuracy, frontend->_gpsHorizVelNoise);
-            yawEstimator->pushVelData(gpsVelNE, gpsVelAcc);
+            yawEstimator->fuseVelData(gpsVelNE, gpsVelAcc);
        }

        // action an external reset request