EKF: Improve robustness to initial gyro bias errors

Allows for ~6 deg/sec of startup bias
This commit is contained in:
Paul Riseborough
2016-05-05 21:23:03 +10:00
parent 7530e30012
commit 26a51c667d
+1 -1
View File
@@ -72,7 +72,7 @@ void Ekf::initialiseCovariance()
P[9][9] = sq(fmaxf(_params.baro_noise, 0.01f));
// gyro bias
P[10][10] = sq(0.035f * dt);
P[10][10] = sq(0.1f * dt);
P[11][11] = P[10][10];
P[12][12] = P[10][10];