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