mirror of https://github.com/ArduPilot/ardupilot
4fb7beba4b
If a badly conditioned covariance matrix causes negative innovation variances, then the filter will diverge. The previous approach of increasing process noise was not effective in some cases, so a hard reset of the covariance matrix has been adopted to guarantee recovery. This fixes a numerical error observed using the replay on flight log which had significant periods of compass rejection. |
||
---|---|---|
.. | ||
Models | ||
AP_NavEKF.cpp | ||
AP_NavEKF.h | ||
AP_Nav_Common.h | ||
AP_SmallEKF.cpp | ||
AP_SmallEKF.h |