Cartographer项目中的2D地图定位问题分析与解决方案

概述

在使用Cartographer进行2D SLAM时，从建图切换到纯定位模式是一个常见需求。本文详细分析了在Cartographer ROS2环境中实现纯定位功能时遇到的关键问题及其解决方案。

问题背景

当使用Cartographer完成建图并保存为.pbstream文件后，开发者期望系统能够基于已有地图进行定位。然而在实际测试中，系统仍然持续更新地图而非进行精确定位，导致定位效果不佳。

关键问题分析

1. 初始位姿需求：系统在没有提供精确初始位姿(特别是旋转角度)的情况下，难以正确匹配到地图中的对应位置。

2. 地图更新控制：传统的pure_localization参数已被弃用，需要新的方法来限制地图更新。

3. 搜索窗口限制：默认的角度搜索窗口可能过小，无法覆盖实际可能的旋转偏差。

解决方案

角度搜索窗口调整

通过修改POSE_GRAPH.constraint_builder.fast_correlative_scan_matcher.angular_search_window参数，将其设置为math.rad(180.)，显著提高了系统对初始旋转偏差的容忍度。这一调整使得系统能够在不提供精确初始角度的情况下，仍能成功定位。

配置参数优化

以下是一组经过验证的有效配置参数：

TRAJECTORY_BUILDER_2D.num_accumulated_range_data = 1
POSE_GRAPH.constraint_builder.min_score = 0.65
POSE_GRAPH.constraint_builder.global_localization_min_score = 0.6
POSE_GRAPH.global_sampling_ratio = 0.9
POSE_GRAPH.constraint_builder.sampling_ratio = 0.5
POSE_GRAPH.optimize_every_n_nodes = 5

系统启动参数

在节点启动时，确保添加以下关键参数：

• -load_state_filename：指定已保存的地图文件
• -load_frozen_state true：冻结已加载的地图状态

实施建议

1. 初始位姿提供：虽然系统现在对角度偏差有更好的容忍度，但仍建议尽可能提供准确的初始位姿估计。

2. 参数调优顺序：建议先调整角度搜索窗口，再根据实际效果微调其他匹配参数。

3. 性能监控：扩大搜索窗口会增加计算量，需监控系统性能表现。

结论

通过合理配置Cartographer的参数，特别是调整角度搜索窗口，可以有效解决2D定位模式下的初始定位问题。这种方法不需要依赖已弃用的pure_localization参数，为Cartographer的纯定位应用提供了可靠的解决方案。