机器人 / 系统课时

校验 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 不表示失败。

odom 与底盘坐标系的正确结构和常见错误对比

用 tf2_echo 检查实时位姿

先启动仿真、底盘里程计发布节点,再开一个已执行 source /opt/ros/jazzy/setup.bash 的终端;使用工作区安装的节点时还需加载相应的 install/setup.bash。执行:

bash
# 持续查询底盘在 odom 参考系下的位姿
ros2 run tf2_ros tf2_echo odom base_link

预期输出(节选;仅以初始朝向为零的示例说明格式):

text
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 秒并在当前目录生成关系图:

bash
# 使用固定输出名,便于重复打开检查
ros2 run tf2_tools view_frames -o frames

预期输出(节选):

text
[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 父子发布来源,避免多节点争抢。

按运动结果验收

  1. 静止时连续观察 tf2_echo odom base_link 至少 5 秒:变换能读出,时间持续更新,位置不出现无故大跳变。
  2. 仿真中低速直行、原地旋转各一次:平移和偏航变化与实际运动一致,且没有轴向颠倒或方向相反。
  3. 重新生成 frames.pdf:odom 能沿正确方向到达 base_link,中间的 base_footprint 允许存在,底盘动态边没有被错误发布成静态边。

通过这三项,才说明 Nav2 能得到连续且方向一致的底盘里程计位姿;是否存在 map 到 odom 的定位变换应在定位节点启动后另行验证。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

校验 odom 到底盘的 TF

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通