AP_NavEKF3: Reset yaw estimator bias states at start of flight

Enables yaw bias to be learned when sitting stationary on ground.
This commit is contained in:
Paul Riseborough 2020-06-08 08:43:51 +10:00 committed by Peter Barker
parent ea4589ea94
commit f7c8ee807c

View File

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