mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-23 14:47:35 +08:00
EKF: Add console notification for accel bias covariance reset
This commit is contained in:
committed by
Lorenz Meier
parent
8511754094
commit
b51abf4aff
@@ -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");
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user