ekf2: publish output predictor tracking errors

This commit is contained in:
Paul Riseborough
2016-08-14 13:42:34 +10:00
committed by Lorenz Meier
parent 23a379a6bf
commit 7a9e3002ff
+2
View File
@@ -914,6 +914,8 @@ void Ekf2::task_main()
_ekf.get_flow_innov_var(&innovations.flow_innov_var[0]);
_ekf.get_hagl_innov_var(&innovations.hagl_innov_var);
_ekf.get_output_tracking_error(&innovations.output_tracking_error[0]);
if (_estimator_innovations_pub == nullptr) {
_estimator_innovations_pub = orb_advertise(ORB_ID(ekf2_innovations), &innovations);