Skip to content

Commit

Permalink
ekf2: Use ecl library with recent bug fixes and enhancements.
Browse files Browse the repository at this point in the history
Bug Fixes:

PX4/PX4-ECL#586 - EKF: fix covariance and output filter buffer initialization
PX4/PX4-ECL#590 - EKF: Fix innovation in fuseDeclination()

Enhancements:

PX4/PX4-ECL#543 - ekf_helper: add more useful methods to interface with the covariances
PX4/PX4-ECL#588 - Add unit tests for DataValidator

Note:

PX4/PX4-ECL#543  has required a change to how the state variances are accessed .
  • Loading branch information
priseborough authored and dagar committed Mar 13, 2019
1 parent 2ae2331 commit d10e386
Show file tree
Hide file tree
Showing 2 changed files with 3 additions and 3 deletions.
2 changes: 1 addition & 1 deletion src/lib/ecl
Submodule ecl updated from a85d3a to a892ec
4 changes: 2 additions & 2 deletions src/modules/ekf2/ekf2_main.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -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]);
Expand Down Expand Up @@ -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)
Expand Down

0 comments on commit d10e386

Please sign in to comment.