机器人 / 系统课时
前端和后端更新频率为何可以不同
前端和后端更新频率为何可以不同
机器人持续运动时,车轮里程计需要高频输出连续位姿,回环检测和位姿图优化却可能间隔数秒才发生。本课把两类计算放进 ROS 2 坐标链,说明后端修正如何经 map 到 odom 生效,以及怎样检查地图更新不会打断局部运动估计。
学习目标
- 区分局部估计、全局优化、TF 广播和栅格地图发布的节奏。
- 用数值算例解释回环修正如何改变
map到odom。 - 配置
slam_toolbox的更新参数并用 ROS 2 验证。
不同更新频率服务不同任务
假设一台差速机器人使用 10 Hz 二维激光雷达与 50 Hz 轮速里程计。各模块不必等待同一个时钟:
| 链路 | 示例节奏 | 职责 |
|---|---|---|
odom 到 base_link |
50 Hz,每 20 ms | 为速度控制提供连续的短时位姿 |
| 前端扫描匹配 | 随扫描和运动阈值触发,不一定处理每帧 | 用局部几何约束新位姿与关键帧 |
| 回环与全局位姿图优化 | 检测到有效回环时触发,耗时随图规模变化 | 联合调整大量历史关键位姿 |
map 到 odom TF |
20 Hz 广播(示例) | 向使用者提供最新全局校正 |
/map 占据栅格 |
每 5 s 刷新(示例) | 向规划器和 RViz 提供栅格地图 |
odom 到 base_link 通常由车轮里程计、惯导融合等局部估计器发布,并不要求 SLAM 每 20 ms 完成一次全局优化。前端利用里程计预测和激光匹配处理新观测;后端在有新增图约束、尤其是有效回环时执行更昂贵的优化。TF 的重复广播也不代表每次都重新求解。
全局修正怎样接入连续里程计
ROS 2 的典型坐标链为 map → odom → base_link。odom 下的位置可缓慢漂移,但应连续;map 下的位置经全局修正后允许离散变化。设变换 T_{a,b} 表示把 b 坐标表示到 a 坐标系,则:
例如回环前后机器人局部里程计保持 odom 下 m,而优化给出其 map 下 m。若两坐标系朝向相同、其他坐标相同,map 到 odom 的平移就是 m。此时局部控制仍看到连续的 odom 位姿,全局规划却能使用修正后的 map 位姿。实际二维场景还要计算旋转,不能只把两个位置坐标直接相减。

全局求解改变的是历史关键帧的最优位置,栅格地图需要据此重新生成并发布,所以 TF 修正与 /map 图像刷新不一定同一瞬间可见。map 到 odom 也可能因平时的扫描匹配产生小幅调整,并非仅在回环时改变。
在 slam_toolbox 中分开设置发布周期
下面是 ROS 2 slam_toolbox 参数文件的片段示例,合并到已使用的节点配置文件中,不能用它代替完整启动配置。示例假设机器人底盘帧确实叫 base_link;若系统使用 base_footprint,必须按实际 TF 修改。
slam_toolbox:
ros__parameters:
map_frame: map
odom_frame: odom
base_frame: base_link
minimum_travel_distance: 0.2
minimum_travel_heading: 0.2
transform_publish_period: 0.05 # map 到 odom 的广播周期
map_update_interval: 5.0 # /map 占据栅格刷新间隔这里的 0.2 分别是米和弧度级的运动阈值,用于减少无意义的扫描处理;0.05 秒对应名义 20 Hz TF 广播,5.0 秒是栅格地图刷新间隔。这两个发布参数都不是后端图优化频率。调整前先确保 CPU 能处理传感器负载,再按运行效果修改;不要靠把 /map 发布改成 20 Hz 来解决回环漂移。
验证回环后两种坐标行为
启动已有的里程计、激光驱动和 slam_toolbox 建图系统后,在另一个已加载 ROS 2 环境的终端执行:
ros2 run tf2_ros tf2_echo map odom预期输出(节选,数值由现场 TF 决定):
At time <TIME>
- Translation: [<X>, <Y>, <Z>]
- Rotation: in Quaternion [<QX>, <QY>, <QZ>, <QW>]<TIME> 和各坐标、四元数占位符需以实际输出替换。让机器人绕行并回到已经走过的区域,观察回环前后这些数值是否发生校正;没有触发有效回环时,不应期待固定幅度的跳变。
同时打开 RViz2,设置 Global Options → Fixed Frame = map,添加 Map 显示并选择 /map,观察重复墙面是否在地图重新发布后对齐。再把 Fixed Frame 改为 odom,检查机器人局部运动是否持续平滑。若 map 下校正了而 /map 暂未变化,先等待配置的地图刷新周期;若 odom 下发生突跳,则检查里程计来源和是否有多个节点同时发布同一条 TF。
正确的运行状态是:局部控制使用连续的 odom 位姿,全局建图与规划使用可被回环修正的 map 位姿,地图栅格按独立节奏刷新。