mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-31 18:47:21 +08:00
add example ROS_INFO
This commit is contained in:
@@ -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);
|
||||
|
||||
Reference in New Issue
Block a user