Unable to lookup transform

asked 2014-05-21 06:01:43 -0500

Rahndall
133 ●36 ●42 ●47

updated 2017-09-18 17:15:55 -0500

jayess
6155 ●26 ●85 ●92

Using this code

geometry_msgs::PoseStamped current_position()  
{  
        tf::TransformListener my_temp_listener;  
        geometry_msgs::PoseStamped  pose;  
        pose.header.stamp = ros::Time::now();  
        pose.header.frame_id = "/base_link";  
        pose.pose = pose_zero;  
        my_temp_listener.waitForTransform("map", "/base_link", ros::Time(0), ros::Duration(3.0));  
        tf::StampedTransform my_transform;  
        my_temp_listener.lookupTransform("/map","/base_link",ros::Time(0), my_transform);  
        my_temp_listener.transformPose("map", pose, pose);   
        return pose;  
}

I get terminate called after throwing an instance of tf::ExtrapolationException

  what():  Unable to lookup transform, cache is empty, when looking up transform from frame [/base_link] to frame [/map] at runtime.

However, looking at the frames using rosrun tf tf_echo /base_link /map I correctly get
At time 1400687504.239

Translation: [-8.817, 0.695, 0.000]
Rotation:
- in Quaternion [0.000, 0.000, 0.097, 0.995]
- in RPY [0.000, -0.000, 0.194]
  Thank you!

edit retag flag offensive close merge delete

add a comment

0

answered 2014-05-22 04:48:46 -0500

Rahndall
133 ●36 ●42 ●47

updated 2017-09-18 17:13:33 -0500

jayess
6155 ●26 ●85 ●92

Thank for the suggestion
I solved in this way and it works, I don't know if it is the best solution

geometry_msgs::PoseStamped current_position()  
{ 
        ros::Time now = ros::Time::now();  
        geometry_msgs::PoseStamped  pose;  
        pose.header.stamp = now;  
        pose.header.frame_id = "/base_link";  
        pose.pose = pose_zero;  
        tf::StampedTransform my_transform;

        try {
                mRosTransformListener->waitForTransform("/base_link", "/map", (now+ros::Duration(1.0)), ros::Duration(10.0) );
                mRosTransformListener->lookupTransform("/base_link", "/map", now, my_transform);
        } 
        catch (tf::TransformException ex) { ROS_ERROR("%s",ex.what()); }
        if (mRosTransformListener->frameExists("/map"))
                ROS_INFO ("/map exist");
        if (mRosTransformListener->frameExists("/base_link"))
                ROS_INFO ("/base_link exist");
        try {
                mRosTransformListener->transformPose("/map", pose, pose);
        } 
        catch (tf::TransformException ex) { ROS_ERROR("%s",ex.what()); }       
        ROS_INFO("pose %f %f %f", pose.pose.position.x, pose.pose.position.y, pose.pose.position.z);                
        return pose;
}

Thank you again for you support