|
|
|
@ -730,6 +730,7 @@ void Ekf2::task_main()
@@ -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); |
|
|
|
|