AP_NavEKF3: Add missing covariance row reset

2021-12-16 07:08:36 +11:00 · 2021-12-16 07:08:36 +11:00 · 5178f4a7d0
parent 8527fd42d1
commit 5178f4a7d0
1 changed files with 1 additions and 0 deletions
--- a/libraries/AP_NavEKF3/AP_NavEKF3_core.cpp
+++ b/libraries/AP_NavEKF3/AP_NavEKF3_core.cpp
@ -1940,6 +1940,7 @@ void NavEKF3_core::ConstrainVariances()
            }
            // reset all delta velocity bias covariances
            zeroCols(P,13,15);
+            zeroRows(P,13,15);
            // restore all delta velocity bias variances
            for (uint8_t i=0; i<=2; i++) {
                P[i+13][i+13] = delVelBiasVar[i];