Browse Source

ekf2: lower fake position observation variance when at rest

master
Daniel Agar 3 years ago
parent
commit
6b1750d8be
  1. 2
      src/modules/ekf2/EKF/fake_pos_control.cpp

2
src/modules/ekf2/EKF/fake_pos_control.cpp

@ -108,7 +108,7 @@ void Ekf::fuseFakePosition() @@ -108,7 +108,7 @@ void Ekf::fuseFakePosition()
} else if (!_control_status.flags.in_air && _control_status.flags.vehicle_at_rest) {
// Accelerate tilt fine alignment by fusing more
// aggressively when the vehicle is at rest
fake_pos_obs_var(0) = fake_pos_obs_var(1) = sq(0.1f);
fake_pos_obs_var(0) = fake_pos_obs_var(1) = sq(0.01f);
} else {
fake_pos_obs_var(0) = fake_pos_obs_var(1) = sq(0.5f);

Loading…
Cancel
Save