第2章 · TF树的结构与核心概念

frame_id、parent_frame、child_frame，静态与动态变换的区别。

聊到 TF（坐标变换），很多人第一反应就是“树”。没错，TF 数据在 ROS 2 里就是以树状结构组织起来的。你想想看，机器人身上那么多坐标系——底盘、激光雷达、IMU、摄像头……如果没有一棵树把它们串起来，那定位和导航根本没法搞。我个人习惯把 TF 树想象成家族谱系：每个坐标系都有爹（parent），可能有几个孩子（child），但不能有环。

这一章咱们就掰开揉碎，把 TF 树里最核心的三个字段——frame_id、parent_frame、child_frame——讲透。顺便把静态变换和动态变换的区别说清楚。嗯，这里要注意：很多新手调参时搞混这两类变换，导致定位飘移或者树结构爆炸，我见过太多次了。

2.1 frame_id、parent_frame、child_frame —— 三剑客

在 ROS 2 的 TF 消息里，TransformStamped 包含三个关键字符串：

• frame_id —— 父坐标系的名称。说白了就是“我从哪儿出发”。
• child_frame_id —— 子坐标系的名称。也就是“我要去哪儿”。
• parent_frame —— 在 TF 树语境下，它和 frame_id 是同一个东西，都是指父坐标系。

举个例子，如果你看到一条 TF 消息：frame_id: "odom"，child_frame_id: "base_footprint"，意思就是“odom 是爹，base_footprint 是儿子”。我刚开始学的时候老把 frame_id 和 child_frame_id 搞反，后来养成了一个习惯：读成“从 frame_id 到 child_frame_id 的变换”，再也没错过。

2.2 静态变换 vs 动态变换

TF 变换按更新方式分为两类：静态变换和动态变换。区别不只在更新频率，更在语义和使用场景。

特性	静态变换	动态变换
更新频率	通常只发布一次，或极低频率（如 0.1 Hz）	高频更新，10 Hz ~ 100 Hz 甚至更高
典型场景	激光雷达与底盘的固定外参、摄像头与IMU的硬安装	里程计 odom → base_footprint、map → odom（SLAM 估计）
发布方式	tf2_ros::StaticTransformBroadcaster	tf2_ros::TransformBroadcaster
缓存行为	静态变换会被缓存，且不依赖时间戳连续性	依赖时间戳，需要连续更新，否则会超时
对性能影响	几乎无开销，适合大量静态传感器	高频发布可能成为瓶颈，需注意频率调优

你可能会问：“静态变换真的只发一次就行？” 嗯，其实 ROS 2 的静态变换发布器会在 latched topic 上发布，订阅者会在连接时收到最新值，之后除非重新发布，否则不变。我个人的习惯是：所有传感器外参都用静态变换，因为一旦标定好，它就不该变。动态变换留给里程计和定位模块。

2.3 为什么树结构不能有环？

TF 树必须是一个有向无环图（DAG）。如果出现环路——比如 A 是 B 的父，B 是 C 的父，C 又是 A 的父——那 TF 缓存就没办法计算任意两个坐标系之间的变换了。ROS 2 的 tf2 会在检测到环时抛出异常，并拒绝更新。

我记得有一次调试多机器人系统，不小心把两个机器人的 TF 树连在了一起，形成了一个大环。控制台疯狂报错“Transform cycle detected”。当时我盯着 rqt_tf_tree 看了半天才找到问题。所以，设计 TF 树时一定要先画图，确保每个坐标系只有一个父节点。

2.4 一个小例子：如何定义静态变换

下面是一个 C++ 静态变换发布的片段，我通常把它放在节点初始化部分：

#include <tf2_ros/static_transform_broadcaster.h>

auto broadcaster = std::make_shared<tf2_ros::StaticTransformBroadcaster>(this);
geometry_msgs::msg::TransformStamped t;
t.header.stamp = this->now();
t.header.frame_id = "base_footprint";
t.child_frame_id = "base_laser";
t.transform.translation.x = 0.2;
t.transform.translation.y = 0.0;
t.transform.translation.z = 0.15;
t.transform.rotation.w = 1.0;
broadcaster->sendTransform(t);

注意 header.frame_id 是父坐标系，child_frame_id 是子坐标系。这个顺序千万别搞反。我见过有人把这两个写反，结果激光雷达的数据全部映射到了底盘后面……

2.5 动态变换的典型写法

动态变换通常放在高频循环里，比如在里程计回调中：

auto broadcaster = std::make_shared<tf2_ros::TransformBroadcaster>(this);
geometry_msgs::msg::TransformStamped odom_to_base;
odom_to_base.header.stamp = msg->header.stamp;
odom_to_base.header.frame_id = "odom";
odom_to_base.child_frame_id = "base_footprint";
// 从里程计消息中填充平移和旋转
broadcaster->sendTransform(odom_to_base);

这里的关键是时间戳必须和里程计数据的时间戳一致，否则 TF 缓存会认为变换过期。我个人习惯用 msg->header.stamp 而不是 now()，这样能减少时间错位导致的警告。