ekf2: publish filter control mode status

This commit is contained in:
Paul Riseborough
2016-04-16 13:42:11 +10:00
committed by Lorenz Meier
parent 07eb4feed8
commit 631040b30b
+1
View File
@@ -730,6 +730,7 @@ void Ekf2::task_main()
_ekf->get_state_delayed(status.states);
_ekf->get_covariances(status.covariances);
_ekf->get_gps_check_status(&status.gps_check_fail_flags);
_ekf->get_control_mode(&status.control_mode_flags);
if (_estimator_status_pub == nullptr) {
_estimator_status_pub = orb_advertise(ORB_ID(estimator_status), &status);