tf2 时间查询：报错是分诊，不是噪音

1. 融合「偶尔成功」多半是时间域错了

激光投影到相机偶尔对、偶尔偏半米——算法组调了三天 RANSAC，最后发现查询 TF 时混用了 now() 与 msg.header.stamp。链路有 80 ms 延迟时，now() 系统性偏离采集时刻，外推有时落在缓存内「碰巧成功」，有时落在缓存外抛异常；更糟的是外推成功但几何已错，下游还以为融合正常。

lookupTransform 失败时的文案几乎就是分诊单：future extrapolation（查询太超前、发布滞后或时钟域不一致）、past（缓存不够或 stamp 过旧）、nonexistent（树断或 frame 名错）。把所有异常吞掉再 return 的节点，会把 TF 问题伪装成「感知偶发失效」。

2. 传感器必须用消息时间

对传感器数据，用 msg.header.stamp，不要盲目 now()。静态外参可用 TimePointZero 取最新；对动态边滥用 zero，拿到的是「此刻最新」而非「采集当时」，多传感器融合会对不齐，重投影误差却说不清来源。

cpp

geometry_msgs::msg::TransformStamped tf;
try {
  tf = tf_buffer_->lookupTransform(
    target_frame, source_frame, msg->header.stamp,
    rclcpp::Duration::from_seconds(0.05));
} catch (const tf2::TransformException & ex) {
  RCLCPP_WARN_THROTTLE(get_logger(), *get_clock(), 2000, "%s", ex.what());
  return;
}

仿真与真机混部时，先确认查询时钟与发布时钟同属 /clock 或同属系统时钟。use_sim_time 不一致是 future extrapolation 的高发源——Gazebo 里一半节点跟 /clock，另一半跟墙钟，症状就是「仿真里 TF 随机炸」。

3. 缓存与 timeout 的边界

tf2_ros::Buffer 的 cache 应覆盖最坏传感器延迟，用延迟直方图定，不要拍脑袋加到 30 s——过大 cache 会掩盖发布频率过低。timeout 吞得了短暂抖动，吞不掉缺静态 TF 或混用 sim_time。先修树与时钟，再加大 timeout。

外推成功 ≠ 几何正确：可能在用过期运动模型延拓。高精度融合应让查询落在缓存内，并分开监控「查询成功率」与「重投影误差」。只盯成功率，会在几何已经漂了之后仍显示绿灯。

4. 广播侧的 stamp 纪律

广播侧禁止随手打未来时间，除非模块明确在做预测且下游知道那是预测边。未来 stamp 会让查询「偶然成功」，几何却指向尚未发生的运动。高频里程计节点的 stamp 应来自轮速/IMU 源时间，不要用回调到达的墙钟乱填。

tf2_ros::TransformListener 默认订阅 /tf 与 /tf_static；晚加入的 static 边仍可得，动态边只能看到缓存窗口内的历史。重启某个节点后「永远查不到」——先查 static 是否已发、动态是否在持续广播。

5. 分诊打点，禁止无限重试

旧代码常见 while (!ok) lookup，会把树断了的问题刷成雪花日志。改为：分类错误 → 打点 → 有限退避 → 向上游报告失败。把 future / past / nonexistent / timeout 分开计数，现场一眼能看出是时钟、缓存还是拓扑。

bash

ros2 run tf2_tools view_frames
ros2 run tf2_ros tf2_echo map base_link

view_frames 查环与多父；tf2_echo 带时间参数可验证特定 stamp 是否可查。录包回放时，确认 bag 里 /clock 与 TF 消息 stamp 同域。

6. 与定位栈的交接

map→odom 与 odom→base 的 stamp 策略必须一致：定位节点停更时，依赖方应分类报错，而不是继续用过期外推做规划。Nav2 的 costmap 更新频率与 TF 查询 stamp 不对齐，表现为局部代价图「拖影」。

bringup 顺序：静态外参就绪 → 动态定位边持续发布 → 感知节点启动。感知比定位先起，会在日志里刷 past extrapolation，但不应被代码静默忽略。

7. 验收

view_frames 无环、无多父；静态边晚启动节点仍可查。
回放含延迟的 bag：消息 stamp 查询应明显好于乱用 now()。
失败瞬间日志打印查询时间与最新可用 TF 时间。
集成测试覆盖：断静态边、停动态广播、故意错误 stamp，三类故障都能被分类捕获。
旧代码 while (!ok) lookup 改为有限退避后，树断时不再刷雪花。

TF 时间是几何的第四维。查错时间，树再完整也是错的；把报错当分诊而不是噪音，比调融合参数有用得多。

8. 案例：录包复盘里的 stamp 陷阱

事故袋回放时，若分析脚本用 now() 查 TF 而 bag 走 sim_time，会系统性 past extrapolation——复盘结论变成「当时 TF 全断」，实际是查询方式错了。状态层录包应记录查询用的 frame 对、stamp 来源与失败分类，证据链才分得清是感知问题还是时间域问题。