美文网首页
02-TF-建立坐标系

02-TF-建立坐标系

作者: joey_zhou | 来源:发表于2016-08-04 18:58 被阅读322次

本篇教程演示如何建立新坐标系,建立新坐标系与创建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()

相关文章

  • 02-TF-建立坐标系

    本篇教程演示如何建立新坐标系,建立新坐标系与创建tf广播类似,同时能加强tf功能。 1.为什么添加坐标系 很多实例...

  • 07基准的综合操作

    建立参考坐标系方法: 基准轴的建立方法 基准面的建立

  • 建立“坐标系”

    《同读一本书.王朋彦》2017-2-15-031《管理的觉醒》P178 原文:只在制度和激励上想措施,不在改变人内...

  • 多坐标系

    1.3D图形学中常用的坐标系: * 世界坐标系世界坐标系是一个特殊的坐标系,它建立了描述其他坐标系所需要的参考框架...

  • GIS中坐标系与偏移算法总结

    一 大地坐标系1.1 概念大地坐标系是大地测量中以参考椭球面为基准面建立起来的坐标系。大地坐标系根据其原点的位置...

  • 如何在WorkNC中载入机床?

    如何在WorkNC中载入机床? 如何在WorkNC中放置机床? WorKNC的坐标系建立方式 直接选中坐标系-点击...

  • 1.空间直角坐标系

    1.空间直角坐标系 1.1空间直角坐标系的建立 坐标轴:x轴(横轴)、y轴(纵轴)、z轴(竖轴)。 空间直角坐标系...

  • 建立企业文化坐标系

    企业文化100篇—第四十五篇 企业文化坐标系有什么用处,为什么要建立它,又如何建立这个坐标系?我是在做企业文化成效...

  • [Tutorial][数学向]从零开始的MC特效(六 | 坐标系

    目录: 导读 Location点的旋转 坐标系的修正与在玩家背部建立坐标系 制作简易翅膀 导读 导读本教程需要读者...

  • G54~G59讲解

    G54~G59为工件坐标系建立,为模态代码,可以从这6个工件坐标系中任意选择一个,指定工件坐标系以后那么程序中的制...

网友评论

      本文标题:02-TF-建立坐标系

      本文链接:https://www.haomeiwen.com/subject/incvdttx.html