机器人 / 系统课时

解释 map 到 odom 的定位修正

解释 map 到 odom 的定位修正

机器人启用地图定位后,RViz 2 中的模型有时会突然平移或旋转,但轮速与底盘里程计并未发生对应变化。本课通过 TF 变换链、定位修正算例和 ROS 2 实测命令,解释这种现象的来源,并判断它是正常的全局定位更新还是坐标系统故障。

学习目标

  • 区分 map、odom、base_link 的职责与变换发布方。
  • 根据局部里程计和全局定位结果解释 map → odom 的修正量。
  • 使用 ROS 2 Jazzy 的 tf2 工具判断定位跳变是否代表真实运动。

为什么需要 map 到 odom 的变换

按照 ROS REP 105 坐标系约定,移动机器人通常维护 map → odom → base_link 这条 TF 父子链。每个坐标系承担不同的稳定性约束。

坐标系 含义 关键约束
map 地图参考坐标系 长期定位漂移较小,但定位结果允许离散跳变
odom 局部里程计参考坐标系 位姿连续平滑,但误差会逐渐累积
base_link 固定在机器人机体上的坐标系 随机器人实际运动,通常作为机体位姿基准

odom → base_link 通常由轮式里程计、视觉里程计或融合轮速与 IMU 的状态估计器发布。它提供连续的局部运动估计,适合底盘控制和短时间轨迹跟踪。

map → odom 通常由 AMCL、SLAM 或其他全局定位模块发布。定位模块利用激光扫描与地图匹配等观测修正累计误差,使机器人在地图中的估计位姿重新对齐环境。

注意,map → base_link 是通过上述两段 TF 组合得到的查询结果,不应该再作为第三条直接父子边发布。TF 树要求每个子坐标系只有一个父节点;部分机器人还会在 odom 与 base_link 之间加入 base_footprint。

定位修正如何形成

定位模块先估计机器人在 map 下的全局位姿,再查询同一时刻机器人在 odom 下的局部位姿,计算两者之间的坐标变换。

用 Ta,bT_{a,b} 表示坐标系 b 相对于坐标系 a 的刚体变换,并将 base 作为 base_link 的简写,则有:

Tmap,odom=Tmap,base (Todom,base)−1T_{map,odom}=T_{map,base}\,(T_{odom,base})^{-1}

这是一条刚体变换组合关系,包含平移和旋转。只有两套坐标轴方向相同、旋转为零时,才能直接用位置坐标相减。一般二维运动需要考虑偏航角,三维运动还需要完整的旋转变换。

考虑一个机器人实际保持静止、所有坐标轴方向相同的算例:

位姿或变换的 X 坐标 修正前 修正后
odom → base_link 2.00 m 2.00 m
map → base_link 1.70 m 1.45 m
map → odom -0.30 m -0.55 m

修正前,地图定位认为机器人位于 X=1.70 m,而里程计认为机器人相对 odom 原点位于 X=2.00 m,因此 odom 原点在 map 中的 X 坐标为 -0.30 m。

收到新的可靠地图观测后,全局定位把机器人的估计位置调整为 X=1.45 m。局部里程计仍然是 2.00 m,于是 map → odom 更新为 -0.55 m。变化量为 -0.25 m,但底盘没有向后移动 0.25 m。

map、odom、base_link 的变换职责及定位修正前后对比

这也解释了为什么 RViz 2 以 map 为 Fixed Frame 时,机器人可能表现为突然跳动:显示的是重新估计的全局位姿。改用 odom 为参考坐标系时,只要局部里程计保持连续,同一次全局修正便不会表现为相同的机体位置跳变。

在 ROS 2 中追踪三段变换

以下命令适用于 ROS 2 Jazzy,假设 Ubuntu 环境已经安装 tf2_ros,并且机器人里程计、地图和定位节点已启动,定位也已初始化。先在终端检查 map → odom:

bash
source /opt/ros/jazzy/setup.bash
# 每秒查询两次最新可用的全局定位修正变换
ros2 run tf2_ros tf2_echo map odom -r 2

预期输出(仅展示每次输出的前几行,实际还包含 RPY 和变换矩阵):

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

<TIME> 为实际变换时间戳,其余占位符表示随机器人状态变化的数值,并非终端会打印的字面内容。按 Ctrl+C 停止观察。

随后在其他终端分别执行下列单条命令,比较三种查询结果:

查询命令 重点观察
ros2 run tf2_ros tf2_echo odom base_link -r 2 局部里程计是否连续
ros2 run tf2_ros tf2_echo map odom -r 2 全局修正量是否改变
ros2 run tf2_ros tf2_echo map base_link -r 2 两段变换组合后的全局位姿

最容易复现的测试是在地图中让机器人静止约 5 秒,再观察定位更新前后数据。正常情况下,odom → base_link 近似稳定,而 map → odom 可能因为新观测产生修正。若三个查询均可用,应满足前述变换组合关系;比较历史数据时必须使用对应时间戳,不能把不同采样时刻的数值直接相减。

什么时候属于异常跳变

首先区分局部运动估计和全局定位修正,不能仅凭 RViz 2 中模型是否跳动来判断机器人是否真的发生了物理位移。

观察现象 优先检查的对象 判断与处理
map → odom 改变,odom → base_link 连续 AMCL 或其他全局定位器 可能是正常重定位;检查激光与地图是否对齐
odom → base_link 突然跳变 编码器、里程计节点、局部 EKF 检查设备重启、里程计原点重置和状态估计连续性
map → odom 长时间不可用 定位生命周期、初始位姿、TF 发布 确认定位器已激活且获得有效地图和观测
map → odom 高频大幅往复变化 传感器外参、时间戳、地图匹配 检查雷达安装变换、时间同步及定位收敛情况

在导航系统中,局部控制通常依赖 odom 的连续性,全局路径规划则依赖 map 中的定位结果。若把 map → base_link 的离散位置修正直接当成机器人速度变化,就可能算出虚假的速度尖峰。

一次合格的验证应当同时确认三个事实:TF 父子链无冲突;里程计运动连续且与底盘实际运动一致;全局定位修正后,机器人在地图上的位置与激光观测更加吻合。满足这些条件时,地图坐标下的跳变通常应解释为定位估计更新,而不是底盘瞬移。

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

目录与阅读设置

阅读设置

17

记录一个想法

解释 map 到 odom 的定位修正

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

登录哪都通