EKF: Add console notification for accel bias covariance reset

This commit is contained in:
Paul Riseborough
2017-02-28 11:41:34 +11:00
committed by Lorenz Meier
parent 8511754094
commit b51abf4aff
+3
View File
@@ -40,6 +40,7 @@
*
*/
#include "../ecl.h"
#include "ekf.h"
#include <math.h>
#include "mathlib.h"
@@ -730,6 +731,8 @@ void Ekf::fixCovarianceErrors()
P[13][13] = varX;
P[14][14] = varY;
P[15][15] = varZ;
_time_acc_bias_check = _time_last_imu;
ECL_WARN("EKF invalid accel bias - resetting covariance");
}
}