读取 /tf 话题中指定tf

本文深入讲解了在ROS系统中如何利用tf::TransformListener类的lookupTransform函数从/tf话题中读取特定tf变换矩阵的方法。通过示例代码,详细解释了如何实现不同坐标系之间的转换,包括目标坐标系map和原坐标系odom之间的变换。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

大家都知道在ROS系统中同一个话题可以被多个node节点发送或者订阅,如下图是一个典型的tf结构
在这里插入图片描述那么如何才能获得到自己想要用的那一个变换矩阵是一个非常棘手的问题,经过查阅资料,我写了下面这一个读取/tf话题中的指定tf的demo供大家一起学习讨论。

#include<iostream>
#include<ros/ros.h>
#include<tf/tf.h>
#include<tf/transform_listener.h>
#include<geometry_msgs/TransformStamped.h>
int main(int argc, char** argv){
    ros::init(argc, argv, "tf_sub_test");
    ros::NodeHandle nh;
    tf::TransformListener tf_listener;
    ros::Rate rate(10);
    while(ros::ok()){
        tf::StampedTransform transform;
        try
        {
            tf_listener.lookupTransform("map", "odom", ros::Time(0), transform);
            ROS_INFO("x,y,z = %f, %f, %f", transform.getOrigin().x(), transform.getOrigin().y(), transform.getOrigin().z());
            ROS_INFO("w,y = %f, %f", transform.getRotation().getW(), transform.getRotation().getY());
        }
        catch(const std::exception& e)
        {
            ROS_ERROR("%s", e.what());
        }
        rate.sleep();
    }
    return 0;
}

其中比较关键的是lookupTransform函数,其中“map”是目标坐标系,“odom”是原坐标系,ros::time(0)是获取最近的时间戳,transform是输出tf。

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值