在ROS中，如何将姿势从kinect帧转换为PR2的base_link帧？

Question

我对 tf.我正在做一个抓取项目。我的视觉伙伴在相机框架或运行机器人时给我一个物体的姿势，机器人的 Kinect 框架（PR2 机器人）。现在，为了抓住那个物体，我需要在机器人的 base_link 框架中获取姿势，因为 moveit 接口使用该框架。

最初，我的想法是我可以使用 tf 的查找转换方法来做到这一点，但现在我知道这只能在不同帧之间进行转换。为了获得我需要的东西，即对象在 base_link 帧中的位置，我应该使用 transformListener 方法。我仍然对两者之间的区别感到困惑。我正在与 python 合作。如果有人能给我一个示例工作 transformListener 代码，那也会有帮助。

Answer 1

我得到了答案，结果是这样的：

import tf2_ros
import tf2_geometry_msgs #import the packages first

tf_buffer = tf2_ros.Buffer(rospy.Duration(1200.0)) #tf buffer length
tf_listener = tf2_ros.TransformListener(tf_buffer)
transform = tf_buffer.lookup_transform("base_link",
                                   poseStampedToTransform.header.frame_id, #source frame
                                   rospy.Time(0), #get the tf at first available time
                                   rospy.Duration(1.0))
pose_transformed = tf2_geometry_msgs.do_transform_pose(poseStampedToTransform, transform)
print("pose_transformed",pose_transformed.pose)

在ROS中，如何将姿势从kinect帧转换为PR2的base_link帧？

In ROS, how to transform pose from kinect frame to PR2's base_link frame?

python

coordinate-transformation

ros