ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question

how to calculate transform for two geometry_msgs/poseStamped messages

asked 2016-08-03 10:38:00 -0600

gk gravatar image

updated 2016-08-08 03:39:38 -0600


I am new to ROS and RTT.

I want to calculate the transformation (relative position) for two geometry_msgs/poseStamped messages so that I can get the absolute position of my object if the position of other object is changed.

The first task is clearly to calculate the transform and then to use that transform also..

Please guide


Updated on August 8, 2016


void Rtt_apc::updateHook(){ if( == RTT::NewData){;

// calculate the transform from the object Pose this way we have the frame in which the object is lying

tf::Transform transform;
transform.setOrigin(tf::Vector3(msg_obj.pose.position.x, msg_obj.pose.position.y, msg_obj.pose.position.z));
transform.setRotation(tf::Quaternion( msg_obj.pose.orientation.x, msg_obj.pose.orientation.y, msg_obj.pose.orientation.z, msg_obj.pose.orientation.w));
tf::StampedTransform stf = tf::StampedTransform(transform,ros::Time(),"world","object");
// Calculate the relative position of hand WRT this frame

std::string target_frame = "world";
geometry_msgs::PoseStamped& rel_hand_pos = msg_hand;
tf::TransformListener tl;

  tl.transformPose(target_frame, msg_hand, rel_hand_pos);
catch (tf::TransformException ex){


} else{ std::cout << "Rtt_apc executes updateHook!! No New Data !!"<<std::endl; }="" }<="" p="">


world ERROR "world" passed to lookupTransform argument target_frame does not exist. listener: I heard : [ 0.25,0.25,0.25,0,0,0,1 ]

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted

answered 2016-08-04 14:49:05 -0600

Chrissi gravatar image

Use transformPose(). Exists for python and cpp. That of course requires that your tf tree is correct. See this tutorial.

edit flag offensive delete link more


However after using this i see an error and i am not sure if i am using the right frame for transformPose function.. Can you have a look at the code.

gk gravatar image gk  ( 2016-08-08 03:36:48 -0600 )edit

Question Tools

1 follower


Asked: 2016-08-03 10:38:00 -0600

Seen: 5,389 times

Last updated: Aug 08 '16