02-TF-建立坐标系

2016-08-04  本文已影响322人  joey_zhou

本篇教程演示如何建立新坐标系,建立新坐标系与创建tf广播类似,同时能加强tf功能。

1.为什么添加坐标系

很多实例中,分系统的本地坐标系理解起来比较简单,比如激光雷达的坐标系在雷达的几何中心,tf允许在任何传感中定义一个坐标系,tf的作用也在于整理好坐标系之间的转换关系。

2.坐标系在哪儿添加

tf建立了一个树状结构的坐标系组,坐标系组中不允许闭环存在。这意味着一个坐标系只有一个父坐标系,但可以有多个子坐标系。前面示例中使用的系统拥有三个坐标系:世界坐标系,海龟1,海龟2.两个海龟坐标系是世界坐标系的子坐标系。当我们要添加一个新的坐标系到tf中时,三个已知的坐标中的一个坐标系需要是其父坐标系,新的坐标系将成为子坐标系。


3.如何添加坐标系

在海龟示例中,我们在第一个海龟中添加一个坐标系,这个坐标系是第二个海龟的“胡萝卜”,如下所示进入当前工作包,添加代码。

$ roscd learning_tf
$ vim nodes/fixed_tf_broadcaster.py

import rospy
import tf

if __name__ == '__main__':
    rospy.init_node('my_tf_broadcaster')
    br = tf.TransformBroadcaster()
    rate = rospy.Rate(10.0)
    while not rospy.is_shutdown():
        br.sendTransform((0.0, 2.0, 0.0),
                         (0.0, 0.0, 0.0, 1.0),
                         rospy.Time.now(),
                         "carrot1",
                         "turtle1")
        rate.sleep()

4.运行坐标系发布程序

在start_demo.launch文件中添加下面的内容。

$vim launch/start_demo.launch

<launch> ... 
<node pkg="learning_tf" type="fixed_tf_broadcaster.py" name="broadcaster_fixed" />  
</launch>

5.检查结果

当运行上面的launch文件时,会发现结果与之前一致,海龟2还是跟随海龟1而不是新建的“carrot”坐标系。这是因为之前的listner文件中海龟2的坐标系是参照海龟1的坐标系计算速度的。如果将参考坐标系改为“carrot”坐标系计算速度信息,即可使得海龟2跟随“carrot”坐标系。

$ vim nodes/turtle_tf_listener.py

将lookupTransform后面的/turtle1替换为/carrot1

''' 
(trans,rot) = listener.lookupTransform("/turtle2", "/carrot1", rospy.Time(0))
'''

roslaunch learning_tf start_demo.launch、

6.运动坐标系的广播

我们在教程中新建的坐标系相对于父坐标系的位置是固定的,因此是固定坐标系。然而,当需要发布一个移动坐标系时,就需要随时改变广播,下面的实例中尝试将carrot1坐标系设置为移动坐标系,随着时间改变相对于海龟坐标系1的位置。
#!/usr/bin/env python
import roslib
roslib.load_manifest('learning_tf')

import rospy
import tf
import math

if __name__ == '__main__':
    rospy.init_node('my_tf_broadcaster')
    br = tf.TransformBroadcaster()
    rate = rospy.Rate(10.0)
    while not rospy.is_shutdown():
        t = rospy.Time.now().to_sec() * math.pi
        br.sendTransform((2.0 * math.sin(t), 2.0 * math.cos(t), 0.0),
                         (0.0, 0.0, 0.0, 1.0),
                         rospy.Time.now(),
                         "carrot1",
                         "turtle1")
        rate.sleep()
上一篇 下一篇

猜你喜欢

热点阅读