ROS Indigo learning_tf-03 添加额外的坐标系 (Python版)

我使用的虚拟机软件：VMware Workstation 11
使用的Ubuntu系统：Ubuntu 14.04.4 LTS
ROS 版本：ROS Indigo

前言

这一节要做的事情：添加额外的坐标系。为什么要添加额外的坐标系：

对于许多任务很容易想到内嵌一个局部的坐标系。例如，将激光扫描仪的中心作为坐标系原点的激光扫描的结果更容易被理解。 TF 允许您为每个传感器、连杆等系统定义局部坐标系。

还是在

learning_tf

软件包中的

nodes

文件夹中创建一个

fixed_tf_broadcaster.py

文件：

$ roscd learning_tf
$ gedit  nodes/fixed_tf_broadcaster.py

并将下面的代码添加进去：

#!/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()

代码讲解：

最后一步，给这个

fixed_tf_broadcaster.py

文件加上可执行权限：

$ chmod +x fixed_tf_broadcaster.py

和前几节一样，上面的程序是一个节点，我们需要编写一个启动脚本文件，将几个节点同时运行，才能看到效果：

$ roscd learning_tf/launch
$ gedit start_demo3.launch

所以，在

start_demo2.launch

<launch>

start_demo3.launch

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

完整的

start_demo3.launch

<launch>
<!-- Turtlesim Node -->
<node pkg="turtlesim" type="turtlesim_node" name="sim" />
<node pkg="turtlesim" type="turtle_teleop_key" name="teleop" output="screen" />

<node name="turtle1_tf_broadcaster" pkg="learning_tf" type="turtle_tf_broadcaster.py" respawn="false" output="screen" >
<param name="turtle" type="string" value="turtle1" />
</node>
<node name="turtle2_tf_broadcaster" pkg="learning_tf" type="turtle_tf_broadcaster.py" respawn="false" output="screen" >
<param name="turtle" type="string" value="turtle2" />
</node>

<node pkg="learning_tf" type="turtle_tf_listener.py" name="listener" />

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

运行

start_demo3.launch

启动脚本文件：

$ roslaunch learning_tf start_demo3.launch

程序运行的效果，和上一节的是一样的。这是为什么？
因为我们没有启动名字叫 ”

carrot1

rosnode list

$ rosnode list
/broadcaster_fixed
/listener
/rosout
/sim
/teleop
/turtle1_tf_broadcaster
/turtle2_tf_broadcaster

里面没有 “

carrot1

tf

tf

$ rosrun rqt_tf_tree rqt_tf_tree

我们现在可以使用

rosrun tf tf_echo /turtle1 /carrot1

carrot1

tf

$ rosrun tf tf_echo /turtle1 /carrot1

tf_echo

$ rosrun tf tf_echo [源坐标系(父类)] [目标坐标系(子类)]

输出的信息：

这个结果是正确的，因为‘carrot1’ 绕着 ‘turtle1‘做半径为2的圆周运动。（上面打印出来的 ’ carrot1 ’ 的

tf

我们上面编程的

fixed_tf_broadcaster.py

carrot1

tf

/carrot1/cmd_vel

By The Way ：

上面出现的

tf

Tf 建立了一个坐标系的关系树型图。一个坐标系节点只能有一个父类，可以有多个子类。

现在你要添加一个坐标系( carrot1 )到这个树型关系图中， 就必须选择一个已有的坐标系(turtle1、turtle2、world)作为父类，而这个新的坐标系( carrot1 )就是子类。 如图：

总结：
其实这一节想要讲的内容已经讲完了：就是如何新建一个 tf 坐标系。
ok , 这一节，就已经介绍完了。因为这一节，我们还有没有看到小海龟窗口中小海龟什么新的动作。
所以，下一节我们在写一个新的监听坐标系变化的程序，希望看到的运行效果是： turtle2 海龟围绕着 ’ turtle1 ’ 海龟转圈。（因为：’ turtle2 ’ 小海龟设置在 ’ carrot1 ’ 这个坐标系节点上，而

carrot

turtle1