Browse Source

AP_NavEKF : Make initial height variance consistent with baro noise

This makes sense to do because we initialise the state to the instantaneous baro reading
master
Paul Riseborough 10 years ago committed by Andrew Tridgell
parent
commit
fe76cb4c0b
  1. 2
      libraries/AP_NavEKF/AP_NavEKF.cpp

2
libraries/AP_NavEKF/AP_NavEKF.cpp

@ -3831,7 +3831,7 @@ void NavEKF::CovarianceInit()
// positions // positions
P[7][7] = sq(15.0f); P[7][7] = sq(15.0f);
P[8][8] = P[7][7]; P[8][8] = P[7][7];
P[9][9] = sq(5.0f); P[9][9] = sq(_baroAltNoise);
// delta angle biases // delta angle biases
P[10][10] = sq(radians(INIT_GYRO_BIAS_UNCERTAINTY * dtIMU)); P[10][10] = sq(radians(INIT_GYRO_BIAS_UNCERTAINTY * dtIMU));
P[11][11] = P[10][10]; P[11][11] = P[10][10];

Loading…
Cancel
Save