ekf2: publish vibration metrics

This commit is contained in:
Paul Riseborough
2016-10-22 12:03:05 +02:00
committed by Lorenz Meier
parent 79ec263b1e
commit 06ad477847
+1
View File
@@ -870,6 +870,7 @@ void Ekf2::task_main()
bool dead_reckoning;
_ekf.get_ekf_accuracy(&status.pos_horiz_accuracy, &status.pos_vert_accuracy, &dead_reckoning);
_ekf.get_ekf_soln_status(&status.solution_status_flags);
_ekf.get_imu_vibe_metrics(status.vibe);
if (_estimator_status_pub == nullptr) {
_estimator_status_pub = orb_advertise(ORB_ID(estimator_status), &status);