mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-03 08:38:53 +08:00
ekf2: Use ecl library with recent bug fixes and enhancements.
Bug Fixes: https://github.com/PX4/ecl/pull/586 - EKF: fix covariance and output filter buffer initialization https://github.com/PX4/ecl/pull/590 - EKF: Fix innovation in fuseDeclination() Enhancements: https://github.com/PX4/ecl/pull/543 - ekf_helper: add more useful methods to interface with the covariances https://github.com/PX4/ecl/pull/588 - Add unit tests for DataValidator Note: https://github.com/PX4/ecl/pull/543 has required a change to how the state variances are accessed .
This commit is contained in:
committed by
Paul Riseborough
parent
edad4c40c3
commit
f8ae8ba502
+1
-1
Submodule src/lib/ecl updated: a85d3a43ed...a892ececf8
@@ -1423,7 +1423,7 @@ void Ekf2::run()
|
||||
|
||||
// Get covariances to vehicle odometry
|
||||
float covariances[24];
|
||||
_ekf.get_covariances(covariances);
|
||||
_ekf.covariances_diagonal().copyTo(covariances);
|
||||
|
||||
// get the covariance matrix size
|
||||
const size_t POS_URT_SIZE = sizeof(odom.pose_covariance) / sizeof(odom.pose_covariance[0]);
|
||||
@@ -1540,7 +1540,7 @@ void Ekf2::run()
|
||||
status.timestamp = now;
|
||||
_ekf.get_state_delayed(status.states);
|
||||
status.n_states = 24;
|
||||
_ekf.get_covariances(status.covariances);
|
||||
_ekf.covariances_diagonal().copyTo(status.covariances);
|
||||
_ekf.get_gps_check_status(&status.gps_check_fail_flags);
|
||||
// only report enabled GPS check failures (the param indexes are shifted by 1 bit, because they don't include
|
||||
// the GPS Fix bit, which is always checked)
|
||||
|
||||
Reference in New Issue
Block a user