ekf2: use global definition of quaternion error

This commit is contained in:
bresch
2024-03-01 18:57:19 +01:00
committed by Daniel Agar
parent 3931379efe
commit 12fefbcfbd
23 changed files with 1345 additions and 1168 deletions
+1 -1
View File
@@ -1658,7 +1658,7 @@ void EKF2::PublishOdometry(const hrt_abstime &timestamp, const imuSample &imu_sa
_ekf.getPositionVariance().copyTo(odom.position_variance);
// orientation covariance
_ekf.getQuaternionVariance().copyTo(odom.orientation_variance);
_ekf.getRotVarBody().copyTo(odom.orientation_variance);
odom.reset_counter = _ekf.get_quat_reset_count()
+ _ekf.get_velNE_reset_count() + _ekf.get_velD_reset_count()