静态变换：Static TF 的定义与配置

各位同学，今天我们来聊聊静态变换。说白了，就是那些在自动驾驶系统中「永远不变」的坐标关系。

你想想看，一辆车上那么多传感器——激光雷达、摄像头、GPS、IMU——它们都固定在车身上。只要你不拆装，它们之间的相对位置就是固定的。这种固定不变的关系，就是静态变换。

什么是静态变换？

静态变换（Static Transform）是指两个坐标系之间的相对位置和姿态不随时间变化。在 Apollo 里，最常见的静态变换包括：

  • 激光雷达 → 车身：LiDAR 固定在车顶，位置固定
  • 摄像头 → 车身：Camera 装在挡风玻璃后，角度固定
  • GPS/IMU → 车身：组合导航设备安装在车辆中心附近
  • 各个传感器之间：比如前视摄像头和激光雷达的相互位置

我个人习惯把静态变换想象成「焊接」——一旦标定好，就别再动了。动态变换则是「铰链」，比如车辆运动时车身相对于世界坐标系的变换，那是每时每刻都在变的。

为什么需要单独定义静态变换？

嗯，这里有个关键点。如果你每次计算传感器数据时都要重新算一遍「激光雷达相对于车身的位置」，那效率太低了。Apollo 的做法是：

  1. 把静态变换一次性定义好，存起来
  2. 系统启动时自动加载到 TF 树中
  3. 后续所有节点直接查询，不用重复计算

我在项目中遇到过一个问题：有个同事把静态变换写在了动态发布的代码里，结果每次启动都要等好几秒才能看到传感器数据。后来改成静态 TF，启动速度直接提升了一个数量级。

Apollo 中如何定义静态变换？

Apollo 提供了两种方式来定义静态变换。我建议你根据场景来选择：

方式一：通过配置文件（推荐）

在 Apollo 的 modules/transform/conf 目录下，有一个 static_transform_conf.pb.txt 文件。你可以在里面直接写：

# 激光雷达相对于车身的静态变换
frame_id: "lidar"
child_frame_id: "vehicle"
translation: {
  x: 0.0
  y: 0.0
  z: 1.5
}
rotation: {
  x: 0.0
  y: 0.0
  z: 0.0
  w: 1.0
}

这里要注意几个细节：

  • frame_id 是父坐标系，child_frame_id 是子坐标系
  • 平移单位是米，旋转用四元数表示
  • 如果传感器在车顶，z 值就是车顶高度
我的小技巧： 写配置文件时，先把传感器安装位置画个草图。我曾经因为搞混了 x 和 y 方向，导致点云投影到图像上偏了半米，排查了一整天。

方式二：通过代码发布

如果你需要在代码中动态注册静态变换，可以用 StaticTransformBroadcaster：

#include "modules/transform/static_transform_broadcaster.h"

// 创建广播器
StaticTransformBroadcaster broadcaster;

// 定义静态变换
TransformStamped static_transform;
static_transform.header.frame_id = "lidar";
static_transform.child_frame_id = "vehicle";
static_transform.transform.translation.x = 0.0;
static_transform.transform.translation.y = 0.0;
static_transform.transform.translation.z = 1.5;
static_transform.transform.rotation.w = 1.0;

// 发布
broadcaster.sendTransform(static_transform);

这种方式适合那些需要在启动时根据参数动态生成的场景。不过我个人更推荐配置文件方式，因为更直观，也方便后期维护。

静态变换的避坑指南

我曾经踩过的坑：
  • 四元数写错了顺序——Apollo 用的是 (x, y, z, w)，不是 (w, x, y, z)
  • 忘记设置时间戳——静态变换虽然不变，但时间戳不能为空
  • 坐标系命名不一致——比如有的地方写 "lidar"，有的地方写 "LIDAR"，大小写不匹配会导致查询失败

静态变换在 TF 树中的位置

为了让你更直观地理解，我画了一张图：

Apollo 静态变换 TF 树结构 world（世界坐标系） vehicle（车身） 动态变换（随时间变化） lidar（激光雷达） camera（摄像头） gps_imu（组合导航） 静态变换 静态变换 静态变换 图例： 动态变换（车辆运动） 静态变换（传感器固定）

从这张图你可以看到：

  • world → vehicle 是动态变换，随着车辆移动而变化
  • vehicle → lidar/camera/gps_imu 都是静态变换，安装后固定不变
  • 所有传感器数据最终都要变换到 vehicle 坐标系下，才能进行融合

验证静态变换是否生效

配置好之后，怎么知道它生效了？Apollo 提供了一个命令行工具：

# 查看所有静态变换
cyber_launch start modules/transform/launch/static_transform.launch

# 用 tf2 工具查看
tf2_echo lidar vehicle

如果输出显示平移和旋转与你配置的一致，那就说明搞定了。

核心要点：
  • 静态变换是「焊死」的坐标关系，不随时间变化
  • 推荐用配置文件方式定义，清晰且易维护
  • 注意四元数顺序和坐标系命名一致性
  • 验证工具要会用，别等跑起来才发现不对

好了，静态变换的内容就这些。记住一句话：静态变换是自动驾驶坐标系的「地基」，地基打牢了，后面的动态变换和传感器融合才能稳。

可可精品资料库

← 上一章 📖 返回目录 下一章 →