diff options
author | Thomas Gubler <thomasgubler@gmail.com> | 2014-12-30 10:19:33 +0100 |
---|---|---|
committer | Thomas Gubler <thomasgubler@gmail.com> | 2014-12-30 10:19:33 +0100 |
commit | 4c511210793c7b2479291bb2abb1de7ce1362b9e (patch) | |
tree | bd75ec58cd182cfbb081af7a12c5fbbbb9324abd | |
parent | 27203beaa7b9c9110d93951ad4c068164d96f866 (diff) | |
download | px4-firmware-4c511210793c7b2479291bb2abb1de7ce1362b9e.tar.gz px4-firmware-4c511210793c7b2479291bb2abb1de7ce1362b9e.tar.bz2 px4-firmware-4c511210793c7b2479291bb2abb1de7ce1362b9e.zip |
add example ROS_INFO
-rw-r--r-- | src/platforms/ros/nodes/attitude_estimator/attitude_estimator.cpp | 3 |
1 files changed, 2 insertions, 1 deletions
diff --git a/src/platforms/ros/nodes/attitude_estimator/attitude_estimator.cpp b/src/platforms/ros/nodes/attitude_estimator/attitude_estimator.cpp index 7504091eb..e64ba335d 100644 --- a/src/platforms/ros/nodes/attitude_estimator/attitude_estimator.cpp +++ b/src/platforms/ros/nodes/attitude_estimator/attitude_estimator.cpp @@ -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); |