Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_NavEKF3: fixed constrain indexing bug 

fixes #20180

thanks to @liyue75 for spotting this!
This commit is contained in:
Andrew Tridgell 2022-03-01 11:24:44 +11:00 committed by Randy Mackay
parent 7765399e49
commit a4da65ea05
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_NavEKF3/AP_NavEKF3_core.cpp
View File

@ -1945,7 +1945,7 @@ void NavEKF3_core::ConstrainVariances()
zeroCols(P,13,15);
zeroRows(P,13,15);
for (uint8_t i=0; i<=2; i++) {
const uint8_t stateIndex = 1 + 13;
const uint8_t stateIndex = i + 13;
P[stateIndex][stateIndex] = fmaxF(P[stateIndex][stateIndex], minStateVarTarget);
}
}