Skip to content
Snippets Groups Projects
Commit 4c511210 authored by Thomas Gubler's avatar Thomas Gubler
Browse files

add example ROS_INFO

parent 27203bea
No related branches found
No related tags found
No related merge requests found
......@@ -44,7 +44,7 @@
AttitudeEstimator::AttitudeEstimator() :
_n(),
_sub_modelstates(_n.subscribe("joy", 10, &AttitudeEstimator::ModelStatesCallback, this)),
_sub_modelstates(_n.subscribe("gazebo/model_states", 10, &AttitudeEstimator::ModelStatesCallback, this)),
_vehicle_attitude_pub(_n.advertise<px4::vehicle_attitude>("vehicle_attitude", 10))
{
}
......@@ -54,6 +54,7 @@ void AttitudeEstimator::ModelStatesCallback(const gazebo_msgs::ModelStatesConstP
px4::vehicle_attitude msg_out;
/* Fill px4 attitude topic with contents from modelstates topic */
ROS_INFO("Test x: %.4f", msg->pose[0].orientation.x);
//XXX
_vehicle_attitude_pub.publish(msg_out);
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment