机器人 / 系统课时

用 TF 校验基座到末端的坐标变换

用 TF 校验基座到末端的坐标变换

本课用 ROS 2 Jazzy 的 TF 工具检查机械臂基座、工具坐标系和世界参考系是否连通,并对照 RViz 验证位置与朝向。完成后,你能判断偏移来自机器人运动学模型、静态变换还是坐标系方向使用错误,避免把错误位姿交给 MoveIt 2 规划。

学习目标

  • 从 TF 树确认 base_link、末端工具与 world 的父子关系。
  • 正确读取基座到工具的平移、四元数和旋转方向。
  • 用 RViz 和话题数据定位缺失、反向或重复的坐标变换。

准备可查询的机器人状态

适用环境为 Ubuntu 24.04、ROS 2 Jazzy 与正在运行的 MoveIt 2 机器人演示。先启动自己的机器人描述、robot_state_publisher 和关节状态发布节点,再打开同一 ROS 环境的新终端。下文以 base_link、tool0 为示例名称;它们不是 ROS 规定的固定命名,必须替换成实际 URDF 中的 link 名。Panda 模型可优先检查 panda_link0 与 panda_hand。

robot_state_publisher 根据 URDF 与 /joint_states 生成连杆 TF:活动关节通常发布到 /tf,固定关节默认发布到 /tf_static。MoveIt 的规划场景能显示机械臂,不代表你要查询的全部 TF 已对外发布。

从 TF 树确认变换链

在机器人运行时执行:

bash
ros2 run tf2_tools view_frames

预期结果:工具监听约 5 秒,在当前工作目录生成 frames.pdf。打开文件,检查基座到工具是否有一条连续父子链,且每个子坐标系只有一个父坐标系。图中的节点名称来自实际发布的 TF,不一定包含 world。

机器人 TF 树、动态关节与固定参考关系

读取并核对基座到工具的位姿

先在机械臂保持静止时查询;第二个参数是要观测的目标坐标系,第一个参数是参考坐标系:

bash
ros2 run tf2_ros tf2_echo base_link tool0

预期输出(关键字段节选,按 Ctrl+C 结束,具体数值随机器人姿态变化):

text
At time <TIME>
- Translation: [<X>, <Y>, <Z>]
- Rotation: in Quaternion [<QX>, <QY>, <QZ>, <QW>]

这表示工具原点在 base_link 中的位置,平移单位是米,四元数顺序是 x、y、z、w。例如若平移为 [0.40, 0.10, 0.50],工具原点位于基座正 X 方向 0.40 m、正 Y 方向 0.10 m、正 Z 方向 0.50 m。实际查询还会给出 RPY 和旋转矩阵;检查末端朝向时不能只看三个平移量。

将 tool0 作为参考系、base_link 作为目标再次查询,结果是逆变换:即使正向平移为 [0.40, 0.10, 0.50],反向平移也不一定只是三个数字取负,还要考虑旋转。缓慢改变一个关节角度,工具相对基座的位姿应随之变化,而工具相对于末端法兰的固定偏置不应变化。

核实 world 到基座的静态参考

如果规划场景需要 world,先查询其与基座是否已连通:

bash
ros2 run tf2_ros tf2_echo world base_link

预期结果:能够持续返回平移和旋转;若安装基座固定不动,该结果应保持不变。出现 Invalid frame ID 或坐标系之间无法连通,应先核对实际 frame 名和 TF 树,不能直接把坐标系都改成 world。

仅当没有其他节点发布这条父子关系、且实验中确实规定 world 与 base_link 原点及方向重合时,可在独立终端启动如下固定发布者:

bash
ros2 run tf2_ros static_transform_publisher \
  --x 0 --y 0 --z 0 --roll 0 --pitch 0 --yaw 0 \
  --frame-id world --child-frame-id base_link

预期结果:该进程持续运行,tf2_echo world base_link 的平移接近 [0, 0, 0]、旋转为单位四元数。真实工作站应改成经测量或标定得到的安装外参;若已有同名子坐标系的发布者,必须先解决重复发布,不能叠加一个零变换掩盖问题。

用 RViz 和关节数据定位不一致

在 RViz 2 的 Displays → Global Options → Fixed Frame 中选择已存在且与机器人 TF 连通的 world 或 base_link,再通过 Displays → Add → TF 添加 TF 显示,打开 Show Names、Show Axes 观察各坐标轴。比较工具坐标系原点与 RobotModel 末端位置;若工具有设计偏置,应按 URDF 中的固定关节 origin 比较,不能要求二者完全重合。

当末端数值与画面不一致,依次检查:

  1. 找不到工具帧:用 frames.pdf 确认 tool0 是否存在;检查 URDF 中的工具 link 和固定 joint,避免把 MoveIt 的末端执行器组名误当成 TF frame。
  2. 活动连杆不更新:检查 /joint_states 是否在更新、关节名称是否与 URDF 一致,再确认 robot_state_publisher 正在运行。仿真中所有相关节点还应使用一致的 use_sim_time。
  3. 朝向反了或工具偏移:对照 URDF 关节 origin xyz/rpy、坐标轴方向和 tf2_echo 的参考/目标顺序。不要通过更改 RViz Fixed Frame 来修补错误外参。
  4. 模型整体漂移或重影:检查是否对同一子坐标系重复发布 TF,以及 RViz RobotModel 和 MoveIt 使用的 URDF 是否一致。

验收时保持基座固定、活动关节做一次小幅运动:world 到基座变换不变,base_link 到工具变换随关节变化,RViz 中工具轴与机器人的实际末端方向一致。三项同时满足后,再使用该参考系定义 MoveIt 的位姿目标。

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

目录与阅读设置

阅读设置

17

记录一个想法

用 TF 校验基座到末端的坐标变换

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

登录哪都通