ROS-TF库-使用ros::Time::now()及过去的tf

5 篇文章 2 订阅

1 如果非要使用 ros::Time::now()

   ros::Time now = ros::Time::now();
    listener.waitForTransform("/turtle2", "/turtle1", now, ros::Duration(3.0));
    listener.lookupTransform("/turtle2", "/turtle1", now, transform);
  • waitForTransform() 包含四个参数:
    1)Wait for the transform from this frame…
    2)… to this frame, 变换目标坐标系
    3)此时now
    4)timeout超时设置:等待最大时间 don’t wait for longer than this maximum duration
  • 所以waitforTransform()实际上会一直block阻塞,直到两个海龟之间的转换可用(这通常需要几毫秒),或者—如果转换不可用—直到超时。

2 使用历史的tf-tf time travel

  • 现在,不要让第二只乌龟去第一只乌龟现在所在的地方,而是让第二只乌龟去第一只乌龟5秒钟前所在的地方:
    1)错误写法
  try{
    ros::Time past = ros::Time::now() - ros::Duration(5.0);
    listener.waitForTransform("/turtle2", "/turtle1",
                              past, ros::Duration(1.0));
    listener.lookupTransform("/turtle2", "/turtle1",
                             past, transform);
  • 结果turtle2失控地四处乱跑,因为我们问tf的是,“5秒前/turtle1相对于5秒前/turtle2的姿势是什么?”这意味着我们正在根据第二只乌龟5秒钟前的位置以及第一只乌龟5秒钟前的位置来控制它。我们真正想问的是,“现在的turtle2相对5s前的turtle1的位置是什么?”.

2)正确写法

  try{
    ros::Time now = ros::Time::now();
    ros::Time past = now - ros::Duration(5.0);
    listener.waitForTransform("/turtle2", now,
                              "/turtle1", past,
                              "/world", ros::Duration(1.0));
    listener.lookupTransform("/turtle2", now,
                             "/turtle1", past,
                             "/world", transform);

郝奇-tftime-travel

  • 只有3个报错,是因为tf保存到缓冲需要一定时间,而此时listener接收不到/turtle2后,接受到后不再报错,不影响后续操作.
  • 0
    点赞
  • 9
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值