机器人 / 系统课时
用 AMCL 在已有地图上定位
用 AMCL 在已有地图上定位
已有二维占据栅格地图后,机器人仍需判断自己在地图中的位置和朝向。本课使用 ROS 2 Jazzy 的 Nav2 AMCL,将轮式里程计与激光扫描匹配到静态地图;完成后能在 RViz 2 设置初始位姿,并用粒子分布、激光重合情况和 TF 验收定位结果。
学习目标
- 确认地图、激光话题与坐标变换满足 AMCL 的输入要求。
- 启动 AMCL,在 RViz 2 设置初始位置并观察粒子收敛。
- 区分真正定位成功、错误位置收敛和 TF 或传感器故障。
核对地图、激光与坐标系
AMCL 是在已有地图上定位,不是重新建图。准备一份描述静态地图的 YAML 文件及其引用的地图图像,地图分辨率例如 0.05 米/像素,且地图必须对应机器人当前所处的环境。底盘应持续提供 odom → base_link 的动态 TF,雷达与机体间应有 base_link → laser_frame 的正确安装变换;具体帧名以机器人实际 URDF/TF 为准。
先在已启动的机器人系统中检查激光话题。以下命令适用于安装了 ROS 2 Jazzy 的 Bash 终端:
source /opt/ros/jazzy/setup.bash
# 应返回 LaserScan 类型;若话题名不同,后续需同步修改 scan_topic
ros2 topic type /scan预期输出:
sensor_msgs/msg/LaserScan再确认 /scan 的 header.frame_id 对应真实雷达帧,并能通过 TF 查询到机体;只有话题存在而无有效数据,AMCL 仍不能正常工作。map → odom 应由 AMCL 负责发布,不要再让 SLAM 节点发布同一条变换。
配置并启动 AMCL
把以下参数合并到现有的 Nav2 参数文件 nav2_params.yaml 的 amcl.ros__parameters 下,其他如 map_server 的配置保留不变。这是片段示例,不能代替一份完整的 Nav2 参数文件:
amcl:
ros__parameters:
base_frame_id: "base_link"
odom_frame_id: "odom"
global_frame_id: "map"
scan_topic: "scan"
robot_model_type: "nav2_amcl::DifferentialMotionModel"
laser_model_type: "likelihood_field"
min_particles: 500
max_particles: 2000
max_beams: 60
update_min_d: 0.10
update_min_a: 0.10
set_initial_pose: false
tf_broadcast: true这组起点参数适合低速差速底盘:平移约 0.10 m 或旋转约 0.10 rad 即可触发一次运动阈值更新。500~2000 是自适应粒子数范围,不表示粒子必须全部重合。若机器人只发布 base_footprint 作为里程计子帧,应把 base_frame_id 改成实际使用的底盘帧。
确保 nav2_bringup 已安装、底盘与雷达已启动,再执行。示例中的两个绝对路径需替换为本机真实路径:
source /opt/ros/jazzy/setup.bash
# 使用已有静态地图和已合并 AMCL 参数的 Nav2 配置
ros2 launch nav2_bringup localization_launch.py \
map:="/home/robot/maps/site.yaml" \
params_file:="/home/robot/config/nav2_params.yaml" \
use_sim_time:=false预期结果:终端持续运行,地图服务器和 AMCL 由生命周期管理器激活;此处是实机系统时间,若数据来自仿真 /clock,应改用 use_sim_time:=true 并确保各节点时钟一致。在另一个已加载 Jazzy 环境的终端验证:
source /opt/ros/jazzy/setup.bash
ros2 lifecycle get /map_server
ros2 lifecycle get /amcl预期输出(两条查询分别对应一行):
active [3]
active [3]在 RViz 2 设置初始位姿
启动 RViz 2,并把左侧 Global Options → Fixed Frame 设置为 map。在 Displays → Add → By topic 依次选择 /map 的 Map、/scan 的 LaserScan,以及 /particle_cloud 的 Nav2 ParticleCloud 显示;粒子云话题采用 Best Effort 可靠性,若显示状态异常需检查该 QoS 设置。
source /opt/ros/jazzy/setup.bash
ros2 run rviz2 rviz2预期结果:弹出 RViz 2 图形窗口;添加上述显示项后,静态地图和激光数据可见,粒子云通常要在给出初始位姿后才出现。
- 在 RViz 2 工具栏点击
2D Pose Estimate,找到机器人在地图上大致所在的位置。 - 在该位置按住鼠标并朝车头方向拖动,松开后向
/initialpose发布带初始不确定性的位姿。 - 在安全、无遮挡的测试区域缓慢平移约
0.3~0.5 m或旋转约30°~90°,观察粒子从较分散逐渐集中到一个合理位置,同时查看激光点是否贴合地图墙体。

检查定位是否真的成功
粒子集中不等于一定定位正确:长得相似的走廊可能让粒子在错误位置形成紧密簇。验收时同时检查三个证据。
- 位置:
/amcl_pose持续给出map坐标下的位姿;在已知墙角或门口,估计位置与真实位置相符,而不是停在另一条相似走廊。 - 匹配:RViz 2 中激光障碍点基本贴合占据地图的墙体边缘;机器人转向时,点云与地图不应持续出现整体偏移。
- 变换:
map → odom → base_link → laser_frame链路连通。AMCL 允许通过调整map → odom修正里程计漂移,但不应出现两套节点争抢同一条 TF。
在已初始化且有激光数据的条件下执行:
ros2 topic type /amcl_pose
ros2 topic type /particle_cloud预期输出:
geometry_msgs/msg/PoseWithCovarianceStamped
nav2_msgs/msg/ParticleCloud这只能证明话题类型正确;还应运行 ros2 topic echo /amcl_pose --once,核实实际收到消息及其 header.frame_id: map,并检查 pose.covariance 的位置和朝向不确定性。数值随运动和环境变化,不能用单个固定阈值替代地图匹配验证。
定位失败时按现象处理
| 现象 | 先检查什么 | 处理方式 |
|---|---|---|
| 地图正常但没有粒子 | /amcl 是否 active、是否使用了 2D Pose Estimate、/scan 是否持续更新 |
重新给初始位姿,检查粒子云 Best Effort QoS |
| 激光和墙体始终错开 | base_link 到雷达帧的平移、朝向与扫描时间戳 |
修正雷达安装 TF 和时钟,不要靠调整地图掩盖外参错误 |
| 粒子收敛到错误走廊 | 起点、车头朝向及地图是否含重复结构 | 在可识别的墙角附近重设初始位姿,再小幅运动重定位 |
| TF 报超时或跳变 | use_sim_time、odom → base_link 的连续性、map → odom 发布者数量 |
统一时钟,只保留 AMCL 作为 map → odom 的发布者 |
若只是静止后迟迟没有更新,可在确认激光和 TF 正常时使用 AMCL 的 /request_nomotion_update 服务请求一次无运动更新;它不会替代正确的初始化或修复错误地图。最终以已知位置核对、激光与墙体重合、变换链稳定三项同时满足作为重定位成功的标准。