diff --git a/src/lib/ecl b/src/lib/ecl index a85d3a43ed..a892ececf8 160000 --- a/src/lib/ecl +++ b/src/lib/ecl @@ -1 +1 @@ -Subproject commit a85d3a43edc4ac4b85ae21159510b9c26f7359e6 +Subproject commit a892ececf8490b21aa8917bc243b2bc441af6a87 diff --git a/src/modules/ekf2/ekf2_main.cpp b/src/modules/ekf2/ekf2_main.cpp index 6b58853c04..7093f6a25a 100644 --- a/src/modules/ekf2/ekf2_main.cpp +++ b/src/modules/ekf2/ekf2_main.cpp @@ -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)