详解ROS中的TF使用

最新推荐文章于 2025-03-18 19:14:31 发布
最新推荐文章于 2025-03-18 19:14:31 发布
阅读量6.1k 收藏 83
点赞数 9
分类专栏： 机器人 文章标签： ROS TF 坐标转换 机器人
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/qq_37394634/article/details/105494587
版权
本文深入探讨了ROS中TF坐标变换的API，包括tf::Transform、tf::Vector3、tf::Quaternion等数据类型及其构造、赋值、获取、逆变换等操作。同时，详细介绍了TF监听器和广播器的使用，以及TF与Eigen之间的转换方法。

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

 个人博客：http://www.chenjianqu.com/

原文链接：http://www.chenjianqu.com/show-107.html

  之前写过一篇博文<ROS-坐标转换>介绍了ROS中坐标转换的概念，并给出实例。在次基础上，本文总结了部分常用的TF的API，以供使用的时候查询。

TF 数据类型

tf::Transform

//Constructor from Quaternion (optional Vector3 )
Transform (const Quaternion &q, const Vector3 &c=Vector3(tfScalar(0), tfScalar(0), tfScalar(0)))
//Constructor from Matrix3x3 (optional Vector3)
Transform (const Matrix3x3 &b, const Vector3 &c=Vector3(tfScalar(0), tfScalar(0), tfScalar(0)))

//构造单位变换矩阵
Transform transform=tf::setIdentity ();

  • 赋值

tf::Transform transform;
transform.setOrigin( tf::Vector3(0.1, 0.0, 0.2) );//平移向量
transform.setRotation( tf::Quaternion(0,0,0,1) );//四元数

  • 获取平移和旋转

tf::Transform transform;
tf::Quaternion q=transform.getRotation();//获取四元数
tf::Vector3 t=transform.getOrigin();//获得平移向量

  • 逆变换

tf::Transform transform;
tf::Transform m=transform.inverse();//获得逆变换

  • 两个变换的乘积

mult (const Transform &t1, const Transform &t2);

 

tf::Vector3

tf::Vector3 v(1.0,0.0,0.0);

  • 赋值函数

tf::Vector3 v;
v.setX(1.0);
v.setY(0.0);
v.setZ(0.0);

//或通过下面的函数:
v.setValue(1.0,0.0,0.0);

v.setZero();//设置零向量

  • 获取向量的元素

tf::Vector3 v(1.0,0.0,0.0);
double x=v.getX(1.0);
double y=v.getY(0.0);
double z=v.getZ(0.0);

  • 其它函数参见文档.

 

tf::Quaternion

//无参数构造器
tf::Quaternion q=tf::Quaternion ();

//直接构造
Quaternion (const tfScalar &x, const tfScalar &y, const tfScalar &z, const tfScalar &w)

//通过旋转轴向量和旋转角构造
Quaternion (const Vector3 &axis, const tfScalar &angle)

//通过RPY构造
Quaternion (const tfScalar &yaw, const tfScalar &pitch, const tfScalar &roll)

  • 赋值函数

//使用Euler angles设置四元数
setEuler (const tfScalar &yaw, const tfScalar &pitch, const tfScalar &roll)

//使用Euler angles设置四元数
setEulerZYX (const tfScalar &yaw, const tfScalar &pitch, const tfScalar &roll) 

//使用旋转轴向量和旋转角度设置四元数
setRotation (const Vector3 &axis, const tfScalar &angle)

//使用RPY设置四元数
setRPY (const tfScalar &roll, const tfScalar &pitch, const tfScalar &yaw)

  • 获取函数

//获取四元数表示的旋转的转角[0,2Pi]
tfScalar getAngle () const

//返回旋转轴向量
Vector3 getAxis () const

  • 其它函数

//返回一个逆旋转的四元数
Quaternion inverse ()

//四元数归一化
Quaternion 	normalized ()

 

tf::Matrix3x3

旋转矩阵

//无参数构造函数
Matrix3x3 ()

//通过四元数构造
Matrix3x3 (const Quaternion &q)

//直接构造
Matrix3x3 (const tfScalar &xx, const tfScalar &xy, const tfScalar &xz, const tfScalar &yx, const tfScalar &yy, const tfScalar &yz, const tfScalar &zx, const tfScalar &zy, const tfScalar &zz)

  • 赋值函数

//设置沿ZYX轴的旋转角度
void setEulerYPR (tfScalar eulerZ, tfScalar eulerY, tfScalar eulerX)

//设置沿ZYX的旋转角度
void setEulerZYX (const tfScalar &yaw, const tfScalar &pitch, const tfScalar &roll) 

//设置为单位矩阵
void setIdentity ()

//通过四元数设置旋转
void setRotation (const Quaternion &q)

//通过RPY旋转角设置旋转
void setRPY (tfScalar roll, tfScalar pitch, tfScalar yaw)

//直接设置旋转矩阵的值
void setValue (const tfScalar &xx, const tfScalar &xy, const tfScalar &xz, const tfScalar &yx, const tfScalar &yy, const tfScalar &yz, const tfScalar &zx, const tfScalar &zy, const tfScalar &zz)

  • 获取函数

//获取YXZ轴的旋转角
getEulerYPR (tfScalar &yaw, tfScalar &pitch, tfScalar &roll, unsigned int solution_number=1) 

//获取四元数
getRotation (Quaternion &q)

//获取RPY角度
getRPY (tfScalar &roll, tfScalar &pitch, tfScalar &yaw, unsigned int solution_number=1)

//获取逆矩阵
Matrix3x3 inverse()

//获取转置矩阵
Matrix3x3 transpose ()

 

tf::Stamped

这是一个模板类.

 

tf::StampedTransform

tf::StampedTransform 是tf::Transforms的子类，它是带时间戳的Transform.

  • 成员变量

//这个变换的子坐标
std::string child_frame_id_;
//这个变换的坐标
std::string frame_id_
//时间戳
ros::Time stamp_

  • 构造函数

StampedTransform (const tf::Transform &input, const ros::Time &timestamp, const std::string &frame_id, const std::string &child_frame_id)

  • 赋值函数

//设置Transform对象
setData (const tf::Transform &input)

 

 

 

TF监听器

构造函数

TransformListener(const ros::NodeHandle &nh, ros::Duration max_cache_time=ros::Duration(DEFAULT_CACHE_TIME), bool spin_thread=true)

TransformListener(ros::Duration max_cache_time=ros::Duration(DEFAULT_CACHE_TIME), bool spin_thread=true)

 

常用函数

canTransform()

  • 判断能否实现变换,如果出错,则返回error_msg的内容.检查在时间time，source_frame能否变换到target_frame。

bool tf::TransformListener::canTransform (const std::string &target_frame, const std::string &source_frame, const ros::Time &time, std::string *error_msg=NULL) const

  • 检查在时间source_time，source_frame能否变换到fixed_frame，那么再实现在target_time变换到target_frame。

bool tf::TransformListener::canTransform (const std::string &target_frame, const ros::Time &target_time, const std::string &source_frame, const ros::Time &source_time, const std::string &fixed_frame, std::string *error_msg=NULL) const

 

waitForTransform()

  • 检查在时间time， source_frame能否变换到target_frame. 它将休眠并重试每个polling_duration，直到超时的持续时间已经过去。 它不会抛出异常。 在一个错误的情况下，如果你传递一个非NULL字符串指针，它会填充字符串error_msg。

bool tf::TransformListener::waitForTransform (const std::string &target_frame, const std::string &source_frame, const ros::Time &time, const ros::Duration &timeout, <br>const ros::Duration &polling_sleep_duration=ros::Duration(0.01), std::string *error_msg=NULL) const

  • 测试在source_time时间，source_frame能否变换到fixed_frame，那么在target_time，变换到target_frame。

bool tf::TransformListener::waitForTransform (const std::string &target_frame, const ros::Time &target_time, const std::string &source_frame, const ros::Time &source_time, <br>const std::string &fixed_frame, const ros::Duration &timeout, const ros::Duration &polling_sleep_duration=ros::Duration(0.01), std::string *error_msg=NULL) const

 

lookupTransform()

  • 查找两个坐标系的变换,返回的变换的方向是从target_frame到source_frame.这个方法会抛出TF异常.在时间time上使用从source_frame到target_frame的变换填充transform

void tf::TransformListener::lookupTransform (const std::string &target_frame, const std::string &source_frame, const ros::Time &time, StampedTransform &transform) const

  • 在source_time使用从source_frame到fixed_frame的变换填充transform，在target_time从fixed_frame到target_frame的链接变换。

void tf::TransformListener::lookupTransform (const std::string &target_frame, const ros::Time &target_time, const std::string &source_frame, const ros::Time &source_time,<br> const std::string &fixed_frame, StampedTransform &transform) const

 

transformDATATYPE()

  • 将数据stamped_in转换为target_frame，使用标记的数据类型中的frame_id和stamp作为源。

void tf::TransformListener::transformDATATYPE (const std::string &target_frame, const geometry_msgs::DATATYPEStamped &stamped_in, geometry_msgs::DATATYPEStamped &stamped_out) const

  • 将数据stamped_in转换为fixed_frame。 使用标记数据类型中的frame_id和stamp作为源。 然后在target_time从fixed_frame变换到target_frame。

void tf::TransformListener::transformDATATYPE (const std::string &target_frame, const ros::Time &target_time, const geometry_msgs::DATATYPEStamped &pin, <br>const std::string &fixed_frame, geometry_msgs::DATATYPEStamped &pout) const

 

TF广播器

构造函数

tf::TransformBroadcaster();

坐标发布

sendTransform()

void sendTransform(const StampedTransform & transform);

void sendTransform(const geometry_msgs::TransformStamped & transform);

 

TF异常

所有在TF里异常继承自tf::TransformException，它继承自std::runtime_error。

异常类型

  • tf::ConnectivityException
    如果由于两个坐标系ID不在同一个连接的树中而无法完成请求，则抛出。

  • tf::ExtrapolationException
    如果请求的坐标系id之间存在连接，但一个或多个变换已过期，则抛出。

  • tf::InvalidArgument
    如果参数无效则抛出。 最常见的情况是非规范化的四元数。

  • tf::LookupException
    如果引用了未发布的坐标系ID，则抛出。

 

TF与Eigen的转换

需要引入头文件：#include <tf_conversions/tf_eigen.h>，而且需要在CMakeLists.txt和package.xml里面加入tf_conversions的依赖，不然无法编译通过。

void tf::matrixEigenToTF (const Eigen::Matrix3d &e, tf::Matrix3x3 &t)

  • 将TF旋转矩阵转换为Eigen四元数

void tf::matrixTFToEigen (const tf::Matrix3x3 &t, Eigen::Matrix3d &e)

  • 将Eigen仿射矩阵转换为TF Pose

void tf::poseEigenToTF (const Eigen::Affine3d &e, tf::Pose &t)

  • 将Eigen变换矩阵转换为TF Transform

void tf::poseEigenToTF (const Eigen::Isometry3d &e, tf::Pose &t)

  • 将TF Pose转换为Eigen仿射矩阵

void tf::poseTFToEigen (const tf::Pose &t, Eigen::Affine3d &e)

  • 将TF Pose转换Eigen变换矩阵

void tf::poseTFToEigen (const tf::Pose &t, Eigen::Isometry3d &e)

  • 将Eigen四元数转换为TF四元数

void tf::quaternionEigenToTF (const Eigen::Quaterniond &e, tf::Quaternion &t)

  • 将TF四元数转换Eigen四元数

void tf::quaternionTFToEigen (const tf::Quaternion &t, Eigen::Quaterniond &e)

  • 将Eigen仿射矩阵转换为TF Transform

void tf::transformEigenToTF (const Eigen::Affine3d &e, tf::Transform &t)

  • 将Eigen变换矩阵转换为TF Transform

void tf::transformEigenToTF (const Eigen::Isometry3d &e, tf::Transform &t)

  • 将TF Transform转换为Eigen仿射矩阵

void tf::transformTFToEigen (const tf::Transform &t, Eigen::Affine3d &e)

  • 将TF Transform转换为Eigen变换矩阵

void tf::transformTFToEigen (const tf::Transform &t, Eigen::Isometry3d &e)

  • 将Eigen向量转换为TF向量

void tf::vectorEigenToTF (const Eigen::Vector3d &e, tf::Vector3 &t)

  • 将TF向量转换为Eigen向量

void tf::vectorTFToEigen (const tf::Vector3 &t, Eigen::Vector3d &e)

 

tf(Transform Frame)变换
shuijinghua的博客
11-11 1万+
tf是ROS中建立坐标系，并且使用各个坐标间转换关系的一个很好的工具。虽然官网的资料很复杂，但在 一、广播tf     就是发布你建立的坐标系，步骤如下    1. 定义一个广播，相当于发布话题时定义一个发布器。        tf::TransformBroadcaster br；  2. 定义存放转换信息（平动，转动）的变量 transform   tf::Transform ...
ROS中TF(坐标系转换)原理与使用
sinat_28924869的博客
01-21 4599
官网建议新工作直接使用tf2，因为它有一个更清洁的界面，和更好的使用体验。（自ROS Hydro以来，tf第一代已被“弃用”，转而支持tf2）。 TF介绍 TF(TransForm)，就是坐标转换，包括了位置和姿态两个方面的变换。注意区分坐标转换和坐标系转换。 坐标转换是一个坐标在不同坐标系下的表示，而坐标系转换不同坐标系的相对位姿关系。 ROS中机器人模型包含大量的部件，每一个部件统称之为link（比如手部、头部、某个关节、某个连杆）,每一个link上面对应着一个frame（坐标系）, 用frame表示该
ROS-TF的使用（常用功能）
liuzubing的博客
07-12 1万+
https://blog.csdn.net/u010876294/article/details/75004903 一、TF中的数据格式： 这些数据格式全都是class 头文件：#include <tf/transform_datatypes.h>基本上可以包含所有的tf数据类型 （1）tf::Vector3 tf::Vector3 point; 默认构造一个对象：tf::...
ROS中的TF坐标变换：从传感器数据到机器人系统的精准定位
最新发布
shiwei0813的博客
03-18 642
场景2:现有一带机械臂的机器人(比如:PR2)需要夹取目标物，当前机器人头部摄像头可以探测到目标物的坐标(x,y,z)，不过该坐标是以摄像头为参考系的，而实际操作目标物的是机械臂的夹具，当前我们需要将该坐标转换成相对于机械臂夹具的坐标，这个过程如何实现？场景1：雷达与小车现有一移动式机器人底盘，在底盘上安装了一雷达，雷达相对于底盘的偏移量已知，现雷达检测到一障碍物信息，获取到坐标分别为(x,y,z)，该坐标是以雷达为参考系的，如何将这个坐标转换成以小车为参考系的坐标呢？在坐标变幻中常用的msg是。
ROS中的tf(transform)的理解 ，你追我小乌龟的深入剖析
凌少skier的小窝
08-16 1万+
对于ros中的tf其实一直理解不是很深，最近工作上一直在用，就很懵逼，出来混果然是要还的～于是这两天把ros官方提供的小乌龟版的你追我，如果你追到我，我就让你xxx，一个一个命令跑了一下，现在有了一个较深的理解，如果哪里说的不对，还请指正。 首先看launch文件内容 <launch> <!-- 海龟仿真器 --> <node pkg="turtle...
ROS C++ tf库具有哪些功能？
lh2008xp的博客
11-24 1312
C++中给我们提供了很多TF的数据类型，如下表： 名称 数据类型 向量 tf::Vector3 点 tf::Point 四元数 tf::Quaternion 3*3矩阵（旋转矩阵） tf::Matrix3x3 位姿 tf::pose 变换 tf::Transform 带时间戳的以上类型 tf::Stamped 带时间...
机器人系统ros2-开发实践05-ROS2 中 tf2的定义及示例说明
小海聊智造
04-30 1763
tf2的全称是transform2，在ROS（Robot Operating System）中，它是专门用于处理和变换不同坐标系间位置和方向的库。tf2是ROS2中一个重要的组件，因为在机器人的许多应用中，正确理解各个部件如何相对于彼此移动是至关重要的。一旦turtlesim启动，您可以使用键盘箭头键在turtlesim中驱动中央乌龟，选择第二个终端窗口，以便捕获您的击键来驱动乌龟。在侧栏中，您将看到 tf2 广播的帧。tf2_echo当侦听器接收通过 ROS 2 广播的帧时，您将看到显示的转换。
Ros2 TF工具
qq_44237695的博客
12-21 2773
ROS2 TF工具使用
ROS中的TF转换与TF逻辑加密卡SLE4442详解
在C++中，可以使用`tf::TransformBroadcaster`和`tf::TransformListener`类来操作TF；在Python中，相应的库是`tf`模块，提供了`tf.TransformBroadcaster`和`tf.TransformListener`对象。 此外，TF还紧密关联着统一...
ROS下Stage仿真器以及TF详解PPT（含例程代码）
03-12
ROS（Robot Operating System，机器人操作系统）是一种用于机器人研究和开发的灵活框架，它提供了一...通过本课程提供的PPT和例程代码，学习者可以更加直观地了解和掌握Stage仿真器的使用方法和TF系统在ROS中的应用。
TensorFlow数据预处理库tf.Transform.zip
07-19
tf.Transform 是一个使用 TensorFlow 进行数据预处理的库。它允许用户结合各种数据处理框架（目前支持 Apache Beam，但是可以扩展 tf.Transform 以支持其他框架），使用 TensorFlow 来转换数据。 因为 tf.Transform 是基于 TensorFlow 构建的，所以它允许用户导出一个计算图（graph），用户随后可以将导出的 TensorFlow 计算图（TensorFlow graph）合并到它们的服务模型中，从而避免服务模型和训练数据之间的偏差。 标签：tfTransform
ros学习（三）：c++ tf-tutorials学习
biter0088的博客
01-13 559
0.前言 tf Tutorialshttp://wiki.ros.org/tf/Tutorials 一、创建工作空间 ##任意非中文目录下都可以 mkdir -p ./tf_tutorial_ws/src cd tf_tutorial_ws/ catkin_init_workspace src/ catkin_make source devel/setup.bash 二、tf-broadcaster 1.创建turtle_tf_broadcaster.cpp cd tf_tutorial
ROS TF坐标变换
u010456551的博客
05-21 883
在ROS下开发自动驾驶系统，第一步遇到的问题就是数据预处理，包括时间同步、坐标变换，而在ROS中应用坐标变换就会用到TF库 一. 监听TF 通过监听tf,我们可以避免繁琐的旋转矩阵计算，而直接获取我们需要的相关信息。在监听中最常用的又两个函数 (1）lookupTransform（） （2）transformPoint（）； （一）先来看lookupTransform（）， 函数功能：可以获得两个坐标系之间转换的关系，包括旋转和平移。主要步骤有 1. 定义监听器tf::Transfo...
ROS之tf空间坐标变换完全详解
热门推荐
zhanghm1995的博客
11-30 3万+
本博文主要汇总了自己在使用ROS中tf坐标变换包时查找的一些参考资料和博客，包括了tf和部分tf2的使用，在此感谢所有博客中出现的博客链接！ 参考资源： ROS官网详细介绍： http://wiki.ros.org/tf/Tutorials http://wiki.ros.org/tf introduction to tf: http://wiki.ros.org/tf/Tutorials/Int...
坐标变换-tf::transform
bansongzao8204的博客
07-18 1686
tf::Transform r_to_w(tf::createQuaternionFromYaw(robot_pose_[2]),tf::Vector3(robot_pose_[0],robot_pose_[1],0)); tf::Transform t_to_w(tf::createQuaternionFromYaw(target_pose_[2]),tf::Vector...
ROS TF相关笔记
dzysdhr1234的博客
02-16 580
1
tf::transformPose,tf::Transform,tf::Stamped,tf::Pose用法
newbeixue的博客
07-10 1907
根据具体的应用场景和需求，可以灵活使用这些方法来操作和管理附带时间戳的姿态和变换数据。该类是TF库中用于存储具有时间戳的姿态和变换的容器，在机器人系统中经常被使用。是TF库中的一个类，用于表示3D空间中的姿态（位置和方向）。它包含了旋转和平移变换的信息，可以用于表示从一个坐标系到另一个坐标系的变换。然后，我们创建了一个新的旋转四元数newRotation和一个新的平移向量newTranslation，并使用。类型的变量centered_laser_pose_，它表示一个时间戳的姿态变换。
8.ROS的TF坐标变换（二）：动态坐标变换、多坐标变换代码讲解（以LIO-SAM为例）
qq_41694024的博客
12-02 2493
ROS的TF坐标变换（二）：动态坐标变换、多坐标变换代码讲解（以LIO-SAM为例）
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

抵扣说明：

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

余额充值