mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-25 17:43:34 +08:00
EKF: Fix bug causing incorrect covariance initialisation
The covariance initialisation should not be performed before the quaternion states are initialised.
This commit is contained in:
committed by
Lorenz Meier
parent
ed260c4f1d
commit
21054a4236
@@ -1480,6 +1480,7 @@ Vector3f Ekf::calcRotVecVariances()
|
||||
}
|
||||
|
||||
// initialise the quaternion covariances using rotation vector variances
|
||||
// do not call before quaternion states are initialised
|
||||
void Ekf::initialiseQuatCovariances(Vector3f &rot_vec_var)
|
||||
{
|
||||
// calculate an equivalent rotation vector from the quaternion
|
||||
|
||||
Reference in New Issue
Block a user