第4章 · TF消息格式

geometry_msgs/TransformStamped、tf2_msgs/TFMessage、消息的发布与订阅

说实话，很多刚接触TF的朋友，上来就写广播、监听，结果一跑起来就报“消息类型不匹配”。
我当年也踩过这个坑——明明看着代码没问题，但就是收不到变换。后来才发现，对消息格式的理解不够透彻。

这一章，咱们就把TF的“信使”彻底扒开看看。你想想看，坐标变换在ROS里怎么传递？靠的就是两个核心消息：geometry_msgs/TransformStamped 和 tf2_msgs/TFMessage。说白了，一个描述“单个变换”，一个打包“一组变换”。

4.1 geometry_msgs/TransformStamped —— 变换的“身份证”

这个结构体，我习惯叫它“变换单”。它把一次坐标变换的所有信息都装进去了。看下它的骨架：

std_msgs/Header header
    uint32 seq
    time stamp
    string frame_id
string child_frame_id
geometry_msgs/Transform transform
    geometry_msgs/Vector3 translation
        float64 x
        float64 y
        float64 z
    geometry_msgs/Quaternion rotation
        float64 x
        float64 y
        float64 z
        float64 w

header.frame_id 是父坐标系，child_frame_id 是子坐标系。举个例子：frame_id = "base_link"，child_frame_id = "laser_frame"，意思就是“激光雷达在机器人底盘下的位姿”。

💡 我个人的习惯：每次构造 TransformStamped 时，一定先检查 frame_id 和 child_frame_id 的命名规范。大小写、下划线，错一个都可能导致 TF 树断掉。我在项目里遇到过因为 "base_link" 写成了 "base_link "（多了一个空格），查了整整一下午。

旋转部分用四元数表示。很多人觉得四元数反直觉，但ROS里统一用它。你只要记住：w 是实部，x,y,z 是虚部。单位四元数模长为1。如果从欧拉角转过来，记得用 tf2::Quaternion 工具。

4.2 tf2_msgs/TFMessage —— 批量变换的“快递箱”

这个就更简单了。它里面只有一个字段：

geometry_msgs/TransformStamped[] transforms

对，就是一个数组。为什么需要它？因为ROS里广播器发布的时候，不是一条一条发，而是把一整个TF树的变化打包成一个 TFMessage 发出去。你想想看，如果机器人有20个关节，每个关节都单独发一个话题，那网络就炸了。

⚡ 避坑指南：我曾经在调试多传感器融合时，发现某个变换总是延迟。后来用 rostopic echo /tf 一看，TFMessage 里塞了30多个变换，时间戳还都不一样。记住：同一个 TFMessage 里的所有变换应该共享同一个时间戳，否则监听器会混乱。

4.3 消息的发布与订阅 —— 让变换流动起来

在ROS里，TF消息通过两个话题传输：/tf 和 /tf_static。前者发动态变换，后者发静态变换（比如机器人底座到激光雷达的固定外参）。

发布端（广播器）：

创建一个 TransformStamped 对象，填好 header、child_frame_id、平移和旋转。
把它塞进 TFMessage 的 transforms 数组里。
用 Publisher 发布到 /tf 话题。

订阅端（监听器）：

订阅 /tf 话题，回调函数里拿到 TFMessage。
遍历 transforms 数组，提取每个 TransformStamped。
根据 header.frame_id 和 child_frame_id 更新本地的 TF 树。

当然，实际开发中我们很少直接操作原始消息。用 tf2_ros::TransformBroadcaster 和 tf2_ros::TransformListener 就封装好了。但理解底层消息格式，能帮你快速定位问题。

⚠️ 注意：不要手动发布 /tf 话题时把 frame_id 搞反。我见过有人把 parent 和 child 填反了，结果 TF 树里出现循环依赖，整个系统直接崩溃。记住：transform 描述的是 child 在 parent 坐标系下的位姿。

4.4 实战小例子：看一眼消息长啥样

打开终端，启动一个机器人（比如 roslaunch turtlebot3_gazebo turtlebot3_world.launch），然后：

rostopic echo /tf -n 1

你会看到类似这样的输出：

transforms: 
  - 
    header: 
      seq: 1234
      stamp: 
        secs: 1692000000
        nsecs: 123456789
      frame_id: "odom"
    child_frame_id: "base_footprint"
    transform: 
      translation: 
        x: 0.0
        y: 0.0
        z: 0.05
      rotation: 
        x: 0.0
        y: 0.0
        z: 0.0
        w: 1.0

看到没？这就是一个典型的 TransformStamped。odom 到 base_footprint 的变换，平移 (0,0,0.05)，旋转为单位四元数。

🔍 我建议：刚开始学TF的同学，多开几个终端，用 rostopic echo /tf 和 rostopic hz /tf 观察消息频率和内容。看得多了，你对TF的理解会上一个台阶。

好了，关于TF消息格式，核心就是这两个结构体。你只要记住：TransformStamped 是单个变换的完整描述，TFMessage 是它们的集合。