第1章 · TF坐标系统概述

理解ROS2中的坐标变换树，为什么导航需要TF，TF在导航栈中的角色。

各位工程师朋友，咱们直接进入正题。TF——坐标变换树，在ROS2导航里就像人的骨架。没有它，传感器数据、里程计、规划器全都在各自的世界里自说自话。我最早接触ROS1的时候，以为TF就是个“坐标转换小工具”，后来在调试一个差速底盘时，激光雷达和底盘的坐标系差了90度，车一直原地转圈……嗯，从那以后我再也不敢小看TF了。

1.1 什么是TF坐标变换树？

说白了，TF维护了一棵有向无环图，每个节点代表一个坐标系（比如 base_link、odom、map），边代表两个坐标系之间的相对位姿（平移+旋转）。你随时可以问TF：“base_link 相对于 map 现在在哪儿？” 它立刻给你一个变换。

在ROS2里，TF2是重写后的版本，引入了缓存、时间戳、以及更干净的API。我个人习惯把TF树想象成“坐标系的家族谱”——每个坐标系都有父系和子系，整个树必须连通，否则导航就会“迷路”。

1.2 为什么导航离不开TF？

你想想看，导航栈里有好几个模块：全局规划器、局部规划器、代价地图、AMCL定位……每个模块都需要知道“机器人在哪里”、“传感器朝哪看”。没有TF，这些信息就是孤岛。

• 数据融合：激光雷达的点云是在 laser_frame 下采集的，但代价地图需要 base_link 下的数据。TF负责把点云变换到正确坐标系。
• 里程计推算：轮式里程计给出 odom→base_link 的变换，AMCL给出 map→odom 的变换，两者通过TF树拼接成完整的位姿。
• 路径跟随：全局路径是在 map 坐标系下规划的，而局部规划器必须在 base_link 或 odom 下执行，TF就是那个“翻译官”。

1.3 TF在导航栈中的具体角色

咱们把导航栈拆开来看，TF在每个组件里扮演什么角色：

导航组件	使用的TF变换	角色说明
AMCL (自适应蒙特卡洛定位)	map → odom, odom → base_link	发布 map→odom 的变换，修正里程计漂移
全局代价地图	map → base_link, 各传感器帧	将传感器数据变换到map坐标系，更新障碍物层
局部代价地图	odom → base_link, 传感器帧	在odom或base_link下实时融合局部障碍物
全局规划器 (NavFn / Smac)	map → base_link	在map坐标系下规划路径，需要知道机器人当前位置
局部规划器 (DWA / TEB)	odom → base_link	在odom坐标系下生成速度指令，依赖实时TF
传感器驱动 (激光雷达/相机)	sensor_frame → base_link	外参标定结果，保证数据投影正确

你看，几乎每个模块都在向TF查询变换。我经常跟团队说：“TF是导航系统的血液循环系统，一旦血栓（延迟）或者血管破裂（断链），整个系统就得急救。”

1.4 TF树的核心特性（快速一览）

• 时间戳驱动：每个变换都带有时间戳，支持历史查询和未来预测（虽然未来查询很少用）。
• 缓存机制：TF2默认缓存10秒的变换数据，你可以通过参数调整。缓存太大占内存，太小容易丢数据。
• 发布/订阅模型：广播器发布变换，监听器订阅并缓存。ROS2的DDS天然支持可靠传输。
• 静态 vs 动态：static_transform_publisher 用于固定外参（如激光雷达相对于底盘的安装位置），动态TF用于里程计、定位等实时变化。

1.5 一个简单的TF广播/监听示例（ROS2 Python）

下面是一个最基础的静态TF广播，把 laser_frame 固定在 base_link 前方0.3米处。你可以在启动文件里用 static_transform_publisher 实现，但这里用代码展示原理：

# 静态广播示例 (Python)
import rclpy
from tf2_ros import StaticTransformBroadcaster
from geometry_msgs.msg import TransformStamped

def main():
    rclpy.init()
    node = rclpy.create_node('laser_static_tf_broadcaster')
    broadcaster = StaticTransformBroadcaster(node)

    t = TransformStamped()
    t.header.stamp = node.get_clock().now().to_msg()
    t.header.frame_id = 'base_link'
    t.child_frame_id = 'laser_frame'
    t.transform.translation.x = 0.3
    t.transform.translation.y = 0.0
    t.transform.translation.z = 0.1
    t.transform.rotation.w = 1.0  # 无旋转

    broadcaster.send_transform(t)
    rclpy.spin(node)  # 保持节点运行

if __name__ == '__main__':
    main()

这段代码虽然简单，但它是整个导航坐标系的基石。你想想看，如果这里写错了平移或者旋转，激光雷达的数据就会投影到错误的位置，代价地图上就会出现“幽灵障碍物”。