Skip to content

Commit

Permalink
AP_NavEKF: Fix incorrect units in gimbal EKF covariance prediction
Browse files Browse the repository at this point in the history
This change does not change the tuning with the current time step, but means that any future changes to update rate will be less likely to cause problem with filter tuning.
  • Loading branch information
Paul Riseborough authored and jschall committed Aug 25, 2015
1 parent 5bc7555 commit e18a0fa
Showing 1 changed file with 1 addition and 1 deletion.
2 changes: 1 addition & 1 deletion libraries/AP_NavEKF/AP_SmallEKF.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -197,7 +197,7 @@ void SmallEKF::predictStates()
// gyro_bias_state_noise
void SmallEKF::predictCovariance()
{
float delAngBiasVariance = sq(dtIMU*dtIMU*5E-4f);
float delAngBiasVariance = sq(dtIMU*5E-6f);

float daxNoise = sq(dtIMU*0.0087f);
float dayNoise = sq(dtIMU*0.0087f);
Expand Down

0 comments on commit e18a0fa

Please sign in to comment.