AP_NavEKF3: use set_and_defualt when changing imu mask

2024-03-24 15:42:57 +00:00 · 2024-03-24 15:42:57 +00:00 · 21df26de75
commit 21df26de75
parent b95b51f1a1
1 changed files with 1 additions and 1 deletions
--- a/libraries/AP_NavEKF3/AP_NavEKF3.cpp
+++ b/libraries/AP_NavEKF3/AP_NavEKF3.cpp
@ -781,7 +781,7 @@ bool NavEKF3::InitialiseFilter(void)

        // don't run multiple filters for 1 IMU
        uint8_t mask = (1U<<ins.get_accel_count())-1;
-        _imuMask.set(_imuMask.get() & mask);
+        _imuMask.set_and_default(_imuMask.get() & mask);
        
        // initialise the setup variables
        for (uint8_t i=0; i<MAX_EKF_CORES; i++) {