ROS2--8章机器人坐标系 tf2库

一、tf2基础理解

tf2 是 ROS 2 中负责**坐标变换（Transform）**的核心功能包。

它的主要作用是维护机器人各坐标系之间的空间关系树（TF Tree），并允许节点在任意两个坐标系之间进行实时查询和转换。

1.1 tf2 解决什么问题？

在机器人系统中，传感器数据通常分散在不同的坐标系下：

激光雷达点云 → lidar_link 坐标系
相机图像 → camera_link 坐标系
里程计位置 → odom 坐标系
地图定位 → map 坐标系

tf2 让你无需手动计算矩阵乘法，只需告诉系统"把 A 坐标系下的某点转换到 B 坐标系"，它会自动沿着 TF Tree 查找路径并完成变换。

1.2 tf2 核心架构

表格

组件	说明
TF Broadcaster	发布坐标变换关系（如 base_link → lidar_link）
TF Listener / Buffer	缓存历史变换，提供查询接口
TF Tree	所有坐标系构成的有向树结构（每个子帧只有一个父帧）
Static Transform	固定不变的变换（如传感器安装位置），只需发布一次

在 ROS 2 中，参数（Parameter） 是专门用于**外部配置节点（Node）**的一种机制。你可以把它理解为节点的"全局设置"或"运行时开关"。

二、tf2 (Transform Library 2)

在 ROS 2 中，tf2 (Transform Library 2) 是核心的坐标系管理框架。它负责维护机器人系统中所有坐标系（Frames）之间的相对位置和姿态关系，并支持随时间变化的动态查询。

简单来说，tf2 回答了机器人学中最基本的问题："在时刻 T，坐标系 A 相对于坐标系 B 在哪里、朝向哪里？"

以下是 ROS 2 tf2 的核心体系简介：

2.1. 核心数据结构：TF Tree（坐标树）

tf2 将所有坐标系组织成一棵有向树状结构，而非图或网状结构。

节点 (Node)：代表一个坐标系（如 base_link, lidar_link, map）。
边 (Edge)：代表两个坐标系之间的刚体变换（3D 平移 + 旋转），具有方向性（父 → 子）。
唯一父节点原则：每个坐标系只能有一个父节点，但可以有多个子节点。这保证了任意两帧之间的变换路径是唯一且确定的，避免了多路径冲突和歧义。

2.2. 两种变换类型

表格

类型	说明	典型示例	发布方式
Static Transform	不随时间变化的固定安装关系	雷达安装在底盘上、相机与IMU的相对位姿	static_transform_publisher 或 URDF/Xacro
Dynamic Transform	随时间实时变化的运动关系	里程计(odom)→底盘(base_link)、机械臂关节运动	节点代码实时广播 (Broadcaster)

⚠️ 关键区别：静态变换只需发布一次，tf2 会永久缓存；动态变换需要持续高频发布（通常 50Hz+），否则查询时会因超时失败。

2.3. 三大核心角色

📡 Broadcaster（广播者）

负责发布坐标变换到 /tf 或 /tf_static 话题。
动态广播使用 TransformBroadcaster，静态广播使用 StaticTransformBroadcaster。
数据格式为 geometry_msgs/msg/TransformStamped。

🔍 Listener（监听者）

负责查询任意两个坐标系之间的变换。
使用 Buffer + TransformListener 组合。
核心 API：lookup_transform(target_frame, source_frame, time)。
支持时间旅行：可查询历史时刻的变换（受限于 Buffer 缓存时长，默认 10s）。

🛠️ Tools（调试工具）

ros2 run tf2_ros static_transform_publisher ...：命令行快速发布静态变换。
ros2 run tf2_tools view_frames：生成当前 TF Tree 的 PDF/SVG 可视化图。
ros2 run tf2_ros tf2_echo <target> <source>：实时打印两帧间的变换数值。
RViz2 TF Display：图形化查看各坐标系的位置、方向和命名。

三、坐标系的变换原理

一个机器人上可以建立很多个坐标系；

一个不同的坐标系之间的关系；

一个物体在指定坐标系中，经过旋转和运动后新的位置和姿态；

空间不同的坐标系，关系可以分解为旋转和平移；

基本旋转矩阵（遵循右手螺旋定则）

3.1. 旋转

坐标系顶点位置一样，但是 xyz 轴不一样，旋转关系；

3.2. 平移

坐标系顶点位置不一样，但是 xyz 轴平行，平移；

3.3. 坐标点变换原理

先求坐标系B单位向量（xyz三轴）到坐标系A的旋转矩阵；在求出到A坐标系的平移矩阵；

在带入坐标的点，即可把B坐标系上的点移动到A坐标系中的坐标；系顶点位置一样，但是 xyz 轴不一样，平移；

四、坐标系的使用

4.1 坐标系启动

启动tf2的服务器

终端1

|-------------------------------------------------------|
| root@LHAYR:~/ros2_ws# ros2 run tf2_ros buffer_server |

发布两个世界坐标系 A 和B（3，4，5）

终端2 发布A坐标系

终端3 发布B坐标系

终端4，检测坐标系B到坐标系A的变换，

4.2 可视化坐标系Rviz

启动Rviz 执行指令rviz2

将全局设置（Global Options）下的固定坐标系（Fixed Frame）设置为World。添加TF可视化功能后，在三维可视化系统中，三个坐标系 World、A、B；

①、设置固定坐标系（Fixed Frame）

在 RViz2 窗口的左侧有一个 Displays 面板。如果没看到，点击顶部菜单 Panels → 勾选 Displays。操作：

点击 Fixed Frame 旁边输入框中的 map（或当前显示的文本）
删除它，输入 World（注意大小写，必须和你发布时用的 --frame-id World 完全一致）
按 Enter 键确认

✅ 此时，RViz2 会以 World 坐标系为世界原点。

②、添加 TF 可视化

操作：

点击 Add 按钮
会弹出一个 Create visualization display 对话框
在左侧列表中找到 By display 标签页，或在搜索框中输入 tf
选择 TF（图标是一个坐标系样子）
点击右下角的 OK 按钮

三位坐标系就显示出来了，其中A和World 是在（0，0，0）， B（3，4，5）

在发布一个C坐标（2，2，2）

显示三维

也可以输出绘制的信息使用指令ros2 run tf2_tools view_frames ；可以通过查看输出的pdf文件查看绘制输出的图；

通过vs code 打开frames_2026-07-03_21.28.04.pdf 文件

第五章发布静态坐标系

在机器人系统中，固定的障碍物或建筑物等坐标不会随时间发生变化。对于这类静态坐标系，只需向 tf2 注册并发布一次坐标信息即可。在 ROS2 中，tf2_ros 功能包提供的 StaticTransformBroadcaster 类专门用于发布静态坐标变换；同时，geometry_msgs 功能包中的 TransformStamped 消息类型则用于定义具体的坐标系变换数据。

5.1 创建工作空间，建立坐标系功能包，

创建工作空间，建立坐标系功能包，包的名称叫 tf_test，用于存放案例代码，（在src目录下，创建一个功能包名称叫tf_test，同时创建一个节点（static_frame_pub））；打卡vs code（code .）；

修改static_frame_pub.py 节点代码，如下

|------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------|
| import math import rclpy from rclpy.node import Node from geometry_msgs.msg import TransformStamped from tf2_ros.static_transform_broadcaster import StaticTransformBroadcaster def quaternion_from_euler(ai, aj, ak): """将欧拉角(roll, pitch, yaw)转换为四元数(x, y, z, w)""" ai /= 2.0 aj /= 2.0 ak /= 2.0 ci = math.cos(ai) si = math.sin(ai) cj = math.cos(aj) sj = math.sin(aj) ck = math.cos(ak) sk = math.sin(ak) cc = ci * ck cs = ci * sk sc = si * ck ss = si * sk q = $0.0$ * 4 q $0$ = cj * sc - sj * cs q $1$ = cj * ss + sj * cc q $2$ = cj * cs - sj * sc q $3$ = cj * cc + sj * ss return q class StaticFramePublisher(Node): """静态坐标系发布器""" def init(self): super().init('static_frame_tf2_broadcaster') # 声明并获取参数 self.x = self.declare_parameter('x', 0.0).get_parameter_value().double_value self.y = self.declare_parameter('y', 0.0).get_parameter_value().double_value self.z = self.declare_parameter('z', 0.0).get_parameter_value().double_value self.roll = self.declare_parameter('roll', 0.0).get_parameter_value().double_value self.pitch = self.declare_parameter('pitch', 0.0).get_parameter_value().double_value self.yaw = self.declare_parameter('yaw', 0.0).get_parameter_value().double_value self.child_frame = self.declare_parameter('child_frame', 'frame_A').get_parameter_value().string_value self.parent_frame = self.declare_parameter('parent_frame', 'world').get_parameter_value().string_value # 初始化静态广播器和日志器 self.tf_static_broadcaster = StaticTransformBroadcaster(self) self.logger = self.get_logger() # 发布静态坐标变换 self.pub_transforms() def pub_transforms(self): """创建并发送静态坐标变换""" t = TransformStamped() t.header.stamp = self.get_clock().now().to_msg() t.header.frame_id = self.parent_frame t.child_frame_id = self.child_frame # 设置平移 t.transform.translation.x = float(self.x) t.transform.translation.y = float(self.y) t.transform.translation.z = float(self.z) # 将角度转换为弧度，再转为四元数 quat = quaternion_from_euler( self.roll / 180.0 * math.pi, self.pitch / 180.0 * math.pi, self.yaw / 180.0 * math.pi ) t.transform.rotation.x = quat $0$ t.transform.rotation.y = quat $1$ t.transform.rotation.z = quat $2$ t.transform.rotation.w = quat $3$ # 打印日志并发布变换 self.logger.info(f'Publish static tf: {self.parent_frame} -> {self.child_frame}') self.tf_static_broadcaster.sendTransform(t) def main(args=None): rclpy.init(args=args) node = StaticFramePublisher() try: rclpy.spin(node) except KeyboardInterrupt: pass finally: node.destroy_node() rclpy.shutdown() if name == 'main': main() |
| 这段代码实现了一个通用的 ROS2 静态坐标系发布节点（Static Frame Publisher）。它的核心功能是：通过读取用户传入的参数，计算并广播两个坐标系之间的静态相对位姿（平移和旋转）。为了让你更清晰地理解，我将这段代码按功能模块进行详细拆解： 1. 欧拉角转四元数工具函数 (quaternion_from_euler) * 功能：在 ROS2 中，坐标系的旋转必须使用四元数（Quaternion）来表示。这个函数接收三个欧拉角参数（Roll, Pitch, Yaw），并通过三角函数公式将其转换为四元数 x y zw 。 * 意义：让开发者在输入参数时可以使用更符合人类直觉的"角度"，而由程序自动完成底层的数学转换。 2. 核心节点类 (StaticFramePublisher) 这是整个程序的主体，继承自 ROS2 的 Node 类，主要包含以下逻辑： * 参数声明与获取：在 init 中，节点声明了 8 个参数（平移量 x/y/z，旋转角 roll/pitch/yaw，以及父子坐标系名称 parent_frame/child_frame），并设置了默认值。这使得该节点非常灵活，无需修改代码即可通过命令行传参来发布任意坐标系。 * 初始化组件：实例化了 StaticTransformBroadcaster（静态变换广播器）和日志器（Logger），用于发送数据和打印运行状态。 * 构建并发布变换 (pub_transforms)： * 创建消息：实例化一个 TransformStamped 消息对象，并打上当前时间戳。 * 绑定坐标系：将参数中的父、子坐标系名称赋值给消息的 Header。 * 设置平移：将 x, y, z 参数填入消息的 translation 字段。 * 设置旋转：将 roll, pitch, yaw 参数除以 180 乘以 π （将角度转为弧度），然后调用 quaternion_from_euler 函数，将计算出的四元数填入 rotation 字段。 * 广播与日志：调用 sendTransform(t) 将变换数据发布到 ROS2 网络中，并通过 logger.info 打印发布成功的提示。 3. 程序入口与生命周期管理 (main 函数) * 初始化与实例化：调用 rclpy.init() 初始化 ROS2 客户端，并创建 StaticFramePublisher 节点实例。 * 保持节点运行：调用 rclpy.spin(node) 让节点进入事件循环。虽然静态坐标只需发布一次，但保持节点存活可以确保该节点能被 ROS2 系统正常管理和查询。 * 优雅退出：使用 try...except KeyboardInterrupt...finally 结构捕获用户的 Ctrl+C 中断信号，确保在程序退出时能正确销毁节点并关闭 ROS2 通信，防止资源泄露。总结简单来说，这段代码就是一个**"坐标翻译官"**。当你运行它并告诉它"A坐标系在B坐标系前方1米，且向上仰起90度"时，它就会把这个空间关系广播给整个机器人系统，让其他节点（如导航、机械臂控制）都能知道这两个坐标系的相对位置。 |

5.1 编译，加载，运行，验证

编译，在ros2_ws 目录下编译，

打开rviz

配置Rviz 终端 Fixed Frame 选中 world；在点击add，添加tf显示窗口；

坐标系统三维显示出来了，

终端4，在加上一个坐标点C；先加载，在输入

坐标系统三维显示出来了，

第六章发布动态坐标系

6.1 什么是动态坐标系

1. 静态坐标系 (Static Transform)

特点：一旦发布，相对位置就固定不变了。
应用场景：机器人的底盘与底盘上的激光雷达、相机之间的相对位置。只要你不把相机拆下来换个位置，它们之间的相对关系就是永远固定的。
广播器：StaticTransformBroadcaster（只需发送一次）。

2. 动态坐标系 (Dynamic Transform)

特点：需要以一定的频率（比如 10Hz、50Hz）持续不断地更新和广播相对位姿。
应用场景：机器人身上正在运动的部件。例如：
- 机械臂的关节（大臂和小臂之间在转动）。
- 机器人的轮子（轮子相对于车体在滚动）。
- 无人机的云台（云台在实时追踪目标并转动）。
广播器：TransformBroadcaster（普通的动态广播器，需要在定时器或循环中不断发送）。

3. 代码层面的区别

如果你要在 ROS2 中发布一个动态坐标系，代码逻辑会发生以下变化：

广播器改变：将 StaticTransformBroadcaster 替换为普通的 TransformBroadcaster。
增加定时器：不能只在 init 里发一次了，你需要创建一个定时器（Timer），比如每 50 毫秒（20Hz）触发一次发布函数。
数据源改变：平移和旋转的参数不能写死，通常需要从硬件传感器（如电机编码器、IMU）实时读取，或者从仿真软件中获取。

总结

简单来说：静态坐标系描述的是"死"的、固定的结构关系；动态坐标系描述的是"活"的、正在运动的部件关系。

6.2创建动态坐标系文件framepub.py

在tf_test工作空间，创建一动态坐标系文件framepub.py，用于存放动态坐标系发布的节点代码。

在vs code 的 src/tf_test/tf_test目录下，创建一个文件（framepub.py））；

修改framepub.py节点代码，如下

6.3 添加环境变量，编译，加载，运行，验证

在vs code的setup.py文件夹，里面添加

|-------------------------------------------------------------------------------------------------------------------------------------|
| entry_points={ 'console_scripts': $'static_frame_pub = tf_test.static_frame_pub:main', 'framepub = tf_test.framepub:main',$ , }, |

编译，在ros2_ws 目录下编译，

打开rviz

配置Rviz 终端 Fixed Frame 选中 frame_A；在点击add，添加tf显示窗口；

坐标系统三维显示出来了，B坐标系围绕坐标系A在旋转；

第7章坐标系的查询

7.1 接收坐标系变化的代码

tf2会把系统里所有的坐标系连成一棵树，只要查这棵树，就能知道任意两个坐标系是怎么变换的。在 tf2_ros 这个包里，有一个叫 TransformListener 的类，就是专门负责'监听'这些坐标系的。第一步，我们先在 tf_test 功能包里建一个 framesub.py 文件，用来写接收坐标系的节点代码。

在vs code 的 src/tf_test/tf_test目录下，创建一个文件（framesub.py））；

修改framesub.py节点代码，如下

7.2 添加环境变量，编译，加载，运行

在vs code的setup.py文件夹，里面添加

|-------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------|
| entry_points={ 'console_scripts': $'static_frame_pub = tf_test.static_frame_pub:main', 'framepub = tf_test.framepub:main', 'frame_sub = tf_test.framesub:main', #//注意事项，这个名称是frame_sub$ , }, |

编译，在ros2_ws 目录下编译，

运行 ros2 run tf_test frame_sub

ROS2--8章 机器人坐标系 tf2库

目录

一、tf2基础理解

1.1 tf2 解决什么问题？

1.2 tf2 核心架构

二、tf2 (Transform Library 2)

2.1. 核心数据结构：TF Tree（坐标树）

2.2. 两种变换类型

2.3. 三大核心角色

三、坐标系的变换原理

3.1. 旋转

3.2. 平移

3.3. 坐标点变换原理

四、坐标系的使用

4.1 坐标系启动

4.2 可视化坐标系Rviz

第五章 发布静态坐标系

5.1 创建工作空间，建立坐标系功能包，

5.1 编译，加载，运行，验证

第六章 发布动态坐标系

6.1 什么是动态坐标系

6.2创建动态坐标系文件framepub.py

6.3 添加环境变量，编译，加载，运行，验证

第7章 坐标系的查询

7.1 接收坐标系变化的代码

7.2 添加环境变量，编译，加载，运行

7.3运行结果

ROS2--8章机器人坐标系 tf2库

第五章发布静态坐标系

第六章发布动态坐标系

第7章坐标系的查询