attitude estimator dummy node: add timestamp

This commit is contained in:
Thomas Gubler
2015-01-29 10:28:56 +01:00
parent 9245f28fb8
commit 8a6b94adbf

View File

@@ -43,6 +43,7 @@
#include <px4/vehicle_attitude.h>
#include <mathlib/mathlib.h>
#include <platforms/px4_defines.h>
#include <platforms/px4_middleware.h>
AttitudeEstimator::AttitudeEstimator() :
_n(),
@@ -92,6 +93,7 @@ void AttitudeEstimator::ModelStatesCallback(const gazebo_msgs::ModelStatesConstP
// msg_v_att.pitchspeed = -(float)msg->twist[index].angular.y;
// msg_v_att.yawspeed = -(float)msg->twist[index].angular.z;
msg_v_att.timestamp = px4::get_time_micros();
_vehicle_attitude_pub.publish(msg_v_att);
}