机器人 / 系统课时
校验 odom 到底盘的 TF
校验 odom 到底盘的 TF
Nav2 读取底盘位姿前,必须能在 TF 树中把 odom 连接到 base_link。本课用 tf2_echo 检查数值和更新时间,再用 view_frames 核对父子方向,区分正常的中间坐标系、断链与时间戳问题。
学习目标
- 识别
odom、base_footprint与base_link的正确连接关系。 - 读取底盘相对
odom的平移、旋转,并用实际运动验证方向。 - 根据 TF 图和报错定位缺失发布者、反向父子关系及时间不同步。
确认应该出现的坐标链
在 Ubuntu 24.04、ROS 2 Jazzy 的移动机器人仿真中,odom 是局部连续里程计参考系,base_link 固定在机器人底盘上。里程计节点或状态估计节点负责发布随运动变化的关系。合法结构可以是 odom 直接连接 base_link,也可以是 odom 经由 base_footprint 连接 base_link;后者在移动机器人模型中很常见。
odom 到底盘的路径应连通,且沿路径往下查时父子方向正确。base_footprint 到 base_link 通常是固定高度关系,不能因为看到中间节点就误判为断链。定位系统启动后可能额外出现 map 到 odom;在仅检查底盘里程计的阶段,尚无 map 不表示失败。

用 tf2_echo 检查实时位姿
先启动仿真、底盘里程计发布节点,再开一个已执行 source /opt/ros/jazzy/setup.bash 的终端;使用工作区安装的节点时还需加载相应的 install/setup.bash。执行:
# 持续查询底盘在 odom 参考系下的位姿
ros2 run tf2_ros tf2_echo odom base_link预期输出(节选;仅以初始朝向为零的示例说明格式):
At time <TIME>
- Translation: [0.000, 0.000, 0.000]
- Rotation: in Quaternion [0.000, 0.000, 0.000, 1.000]实际会继续输出 RPY 和变换矩阵;<TIME>、位置数值及四元数随仿真状态变化。平移单位为米,RPY 角度同时以弧度和度给出。命令最初短暂等待 TF 可属正常;稳定发布后应持续刷新,而不是一直报告无法连接坐标系。
让机器人初始朝向与 odom 的正 x 方向一致,低速直行约 0.2 m,观察 x 是否相应增加;原地向左旋转时,偏航角应按 REP 103 约定朝正方向变化。反向查询得到的是逆变换,不能仅因数值符号不同就判断发布方向出错。
用 frame graph 查父子方向
仅靠 tf2_echo 查询成功,不能证明 odom 与 base_link 是直接父子节点:tf2 可能沿中间节点组合变换。用以下命令采样约 5 秒并在当前目录生成关系图:
# 使用固定输出名,便于重复打开检查
ros2 run tf2_tools view_frames -o frames预期输出(节选):
[INFO] [<TIME>] [view_frames]: Listening to tf data for 5.0 seconds...
[INFO] [<TIME>] [view_frames]: Generating graph...
[INFO] [<TIME>] [view_frames]: Exporting graph in frames.pdf file...打开当前目录的 frames.pdf,检查 odom 到 base_link 是否存在连续路径,以及每一条边的父节点是谁。图上的 Broadcaster 用于追踪发布者,Average rate 与 Most recent transform 可帮助判断动态边是否持续更新;静态边不需要持续高频发布。
从现象反查发布和时间配置
| 现象 | 先检查 | 修复方向 |
|---|---|---|
odom 不存在或查不到变换 |
ros2 topic list -t 是否有 /tf;里程计节点是否在运行 |
启动正确的里程计或状态估计 TF 发布者;仅有 /odom 话题不等于已发布 TF |
图中底盘与 odom 分成两棵树 |
发布者的 header.frame_id、child_frame_id 和 URDF 帧名 |
统一 odom、base_footprint、base_link 拼写及连接关系 |
图中 base_link 指向 odom |
检查实际 TF 消息的父帧和子帧 | 纠正发布者的父子定义,不要用反向的静态 TF 掩盖 |
| 可查到变换但更新停止或提示时间外推 | /clock、相关节点的 use_sim_time、TF 时间戳 |
统一仿真时间,恢复动态发布,避免混用系统时间与仿真时间 |
可使用 ros2 topic echo /tf --once 观察实际 transforms 中的 header.frame_id 和 child_frame_id;一条消息未包含目标边时,应继续观察而非立即判定缺失。对同一个子坐标系,应只保留一个权威的 TF 父子发布来源,避免多节点争抢。
按运动结果验收
- 静止时连续观察
tf2_echo odom base_link至少 5 秒:变换能读出,时间持续更新,位置不出现无故大跳变。 - 仿真中低速直行、原地旋转各一次:平移和偏航变化与实际运动一致,且没有轴向颠倒或方向相反。
- 重新生成
frames.pdf:odom能沿正确方向到达base_link,中间的base_footprint允许存在,底盘动态边没有被错误发布成静态边。
通过这三项,才说明 Nav2 能得到连续且方向一致的底盘里程计位姿;是否存在 map 到 odom 的定位变换应在定位节点启动后另行验证。