ROS机器人底盘 -获取机器人位置坐标,python源码分析

#!/usr/bin/env python
import rospy    #库函数

from tf_conversions import transformations    #库函数
from math import pi    #库函数
import tf    #库函数

class Robot:
    def __init__(self):
        self.tf_listener = tf.TransformListener()    
        #创建了监听器,它通过线路接收tf转换,并将其缓冲10s。若用C++写,需设置等待10s缓冲。
        try:
            self.tf_listener.waitForTransform('/map', '/base_link', rospy.Time(), rospy.Duration(1.0))    
            #猜测:等待Duration=1s,判断map是否转换为base_link
        except (tf.Exception, tf.ConnectivityException, tf.LookupException):
            return
        #try ... except ... 进行异常处理,若 try... 出现异常,则将错误直接输出打印,而不是以报错的形式显示。

    def get_pos(self):
        try:
            (trans, rot) = self.tf_listener.lookupTransform('/map', '/base_link', rospy.Time(0))
        #rospy_Time(0)指最近时刻存储的数据
        #得到从 '/map' 到 '/base_link' 的变换,
  • 5
    点赞
  • 41
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 8
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 8
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

weixin_42573595

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值