Browse Source

AP_NavEKF3: Reset yaw estimator bias states at start of flight

Enables yaw bias to be learned when sitting stationary on ground.
zr-v5.1
Paul Riseborough 5 years ago committed by Peter Barker
parent
commit
f7c8ee807c
  1. 3
      libraries/AP_NavEKF3/AP_NavEKF3_VehicleStatus.cpp

3
libraries/AP_NavEKF3/AP_NavEKF3_VehicleStatus.cpp

@ -418,6 +418,9 @@ void NavEKF3_core::detectFlight()
EKFGSF_yaw_reset_request_ms = 0; EKFGSF_yaw_reset_request_ms = 0;
EKFGSF_yaw_reset_count = 0; EKFGSF_yaw_reset_count = 0;
EKFGSF_run_filterbank = true; EKFGSF_run_filterbank = true;
Vector3f gyroBias;
getGyroBias(gyroBias);
yawEstimator->setGyroBias(gyroBias);
} }
// store current on-ground and in-air status for next time // store current on-ground and in-air status for next time

Loading…
Cancel
Save