EKF: inhibit accelerometer bias learning if manoeuvre levels are excessive

This prevents bad scale factors and other errors associated with rapid manoeuvres corrupting the accelerometer bias estimates.
This commit is contained in:
Paul Riseborough
2017-03-10 10:14:06 +01:00
committed by Lorenz Meier
parent 5fb24c3032
commit 588b27bde7
4 changed files with 36 additions and 5 deletions
+3
View File
@@ -196,6 +196,9 @@ bool Ekf::init(uint64_t timestamp)
_fault_status.value = 0;
_innov_check_fail_status.value = 0;
_accel_mag_filt = 0.0f;
_ang_rate_mag_filt = 0.0f;
return ret;
}