工具与仿真 · G4
Nav2 与移动机器人栈
AGV、巡检、配送的标配栈,也是「仿真能跑、现场就撞」差距最大的一层。参数不是调出来的,是按物理量算出来的。
课程正文 · 人话版
Nav2 是移动机器人的「导航全家桶」:全局规划+局部避障+恢复行为+成本地图。理解它的关键是一张图:代价地图上的波前扩散。
全局规划:代价地图上找路
全局代价地图 = 栅格(每格一个代价值):障碍格无穷大、周围膨胀(安全距离)、未知区惩罚。A*/Dijkstra 在这张图上从目标反向扩散——看动图:颜色深浅就是「离目标几步」,机器人沿梯度下降走到目标。
膨胀半径不是装饰:它就是「贴多近才算危险」的量化。太大钻不过门,太小撞墙角——现场调参主要就调它。
动图 · 拖一拖,亲眼看
全局与局部:分工明确
全局规划(NavFn/Smac):低频(1Hz)、全局图、回答「走哪条路」。局部规划(DWB/TEB/RPP):高频(20Hz)、局部窗口、回答「这一秒怎么打方向盘」+ 实时避障。局部规划器失败时触发恢复行为(转一圈、清代价图、后退)。
这层架构和 B10 的分层思想完全同构:粗略模型管大局,精细控制管执行。学一个会两个。
定位与地图:Nav2 的上游
Nav2 只管「在地图上从 A 到 B」。地图(SLAM 产出,C4)和定位(AMCL/cartographer 定位模式)是上游。定位抖动会让代价地图「抖」——机器人贴墙走时突然绕路的元凶多半是定位跳变。
工程排错顺序:定位漂了→地图旧了→膨胀半径不对→局部规划器参数。90% 的「导航抽风」在前两步。
学到什么程度
能配一套完整的 Nav2 参数文件(全局/局部规划器、代价地图层、恢复行为);能解释 costmap 各层(static/obstacle/inflation)的作用;能在 Gazebo 里跑通导航闭环。做到这些,室内移动机器人导航就能独立交付。
三道题,测你真懂了
1. 代价地图的膨胀层作用是?
- A把障碍按安全距离扩散成代价坡,让规划主动远离
- B好看
- C压缩地图
看答案
A。膨胀坡让 A* 天然远离障碍。半径即安全策略的量化。
2. 局部规划器(DWB/TEB)的职责是?
- A全局最优路径
- B高频局部窗口内的实时避障与执行
- C建图
看答案
B。全局管路线、局部管脚下的每一秒。恢复行为兜底。
3. 机器人导航「贴墙走时突然绕路」,首先排查?
- A局部规划器
- BCPU 占用
- C定位是否跳变/地图是否过旧
看答案
C。定位抖动→代价地图抖动→路径抖动。上游比下游常见。
在本站继续深入
正文讲完。下面是这个领域的完整大纲、深度要求与常见错误——查漏和面试准备时用。
要学什么
- 六个核心节点:bt_navigator、planner_server、controller_server、behavior_server、smoother_server、velocity_smoother
- 代价地图分层:static、obstacle、voxel、inflation;膨胀半径与代价衰减决定了「敢不敢贴墙走」
- 规划器:NavFn( Dijkstra/A*)、Smac 2D/Planner(混合)、Hybrid-A*(车式、有最小转弯半径)、Theta*(任意角)
- 控制器:DWB(默认,采样)、TEB(时间弹性带,窄道强但参数敏感)、MPPI(GPU 采样,动态环境好)、RPP(纯跟踪,简单稳)
- 行为树:NavigateToPose 的 XML 结构、恢复行为(清代价地图、原地旋转、后退)、自定义 BT 节点
- 定位:AMCL(粒子数、更新门限、初始位姿)与 slam_toolbox(在线建图);地图分辨率与内存的换算
- 现场差距的来源:轮径/轮距标定误差、打滑、地面反光、动态行人、以及局部规划器的加速度上限
这个领域的主流软件
| 软件 / 库 | 是什么 | 什么时候用 | 优先级 |
|---|---|---|---|
| Nav2 | 导航栈全套:规划、控制、行为树、恢复 | 轮式移动机器人 | 必装 |
| slam_toolbox | 在线建图与定位(2D 激光) | 没有现成地图时 | 必装 |
| AMCL | 已有地图下的粒子滤波定位 | 地图固定、只需定位 | 必装 |
| TEB / MPPI 控制器 | 窄道与动态环境的局部规划 | DWB 在窄道里过不去时 | 进阶 |
四条路线需要多深
「精通」= 能从零推导 / 能手写实现 / 能判断别人的方案对不对;「用过」= 能调起来、能改参数;「知道」= 能听懂、能提问。
怎么算学会了
在 Gazebo 里跑通 Nav2 到点导航;中途放一个箱子能绕开;拔掉激光雷达能触发恢复行为而不是原地卡死。能说清 inflation_radius 与 robot_radius 各自管什么、为什么要差一个安全余量。
常见错误
- 膨胀半径直接按机器人半径设,走廊宽度刚好一半,全局规划直接无解——要加跟踪误差与定位漂移的余量
- 只在空地图上调参数,现场放了箱子就撞:voxel 层没开,障碍只进不删(marking 与 clearing 没配)
- 全局路径很漂亮,机器人却来回摆:控制器的 max_vel 与加速度和底盘实际能力不匹配