4. 使用karto_slam进行闭环检测建图

任务目标

在包含回环的仿真或真实场景中，使用 karto_slam 完成建图，重点验证算法在机器人回到已探索区域时能否正确识别闭环并修正累积漂移，最终获得全局一致的地图。

环境与依赖

• ROS（Noetic 或 Melodic）+ karto_slam 包（通常随 slam_karto 提供，可通过 sudo apt install ros-${ROS_DISTRO}-slam-karto 安装）
• 仿真环境：turtlebot3_gazebo（含回环的 turtlebot3_world 即可）
• 键盘控制：turtlebot3_teleop

核心实现

本案例直接使用 slam_karto 包提供的现成节点，无需编写算法源码。核心工作在于正确配置参数以启用闭环检测，并搭建最小启动文件。以下为完整的启动配置：

<!-- karto_slam.launch -->
<launch>
  <!-- 仿真环境 -->
  <include file="$(find turtlebot3_gazebo)/launch/turtlebot3_world.launch"/>

  <!-- 机器人模型 -->
  <param name="robot_description" command="$(find xacro)/xacro $(find turtlebot3_description)/urdf/turtlebot3_burger.urdf.xacro"/>

  <!-- Karto SLAM 节点 -->
  <node pkg="slam_karto" type="slam_karto" name="slam_karto" output="screen">
    <remap from="scan" to="scan"/>
    <param name="odom_frame" value="odom"/>
    <param name="map_frame" value="map"/>
    <param name="base_frame" value="base_footprint"/>
    <param name="minimum_travel_distance" value="0.1"/>
    <param name="minimum_travel_heading" value="0.1"/>
    <param name="scan_buffer_size" value="100"/>
    <param name="scan_buffer_maximum_scan_distance" value="10.0"/>
    <param name="link_match_minimum_response_fine" value="0.6"/>
    <param name="link_scan_maximum_distance" value="8.0"/>
    <param name="loop_search_maximum_distance" value="3.0"/>
    <param name="loop_match_minimum_chain_size" value="10"/>
    <param name="loop_match_maximum_variance_coarse" value="3.0"/>
    <param name="loop_match_minimum_response_coarse" value="0.35"/>
    <param name="loop_match_minimum_response_fine" value="0.55"/>
  </node>

  <!-- 地图服务器（用于可视化） -->
  <node pkg="map_server" type="map_server" name="map_server" args="$(find turtlebot3_gazebo)/maps/turtlebot3_world.yaml"/>
</launch>

运行与操作

1. 启动建图：roslaunch karto_slam.launch
2. 另开终端启动键盘控制：roslaunch turtlebot3_teleop turtlebot3_teleop_key.launch
3. 控制机器人沿环境外围绕行一圈，确保回到起点附近（形成闭环）。

验证方法与判定标准

• 在 rviz 中添加 Map 显示，话题选择 /map，观察建图过程。
• 闭环检测成功的标志：当机器人回到起点附近时，地图中原本错位或重影的墙壁、障碍物边缘会突然对齐，全局地图的累积漂移被明显修正。
• 量化验证：将最终地图与 map_server 加载的真实地图对比，在 rviz 中调整透明度叠加显示，观察轮廓重合度。若走廊宽度一致、墙角无重影，则判定闭环建图成功。
• 若闭环未生效，地图在回环处会出现明显的双重墙壁或错位，此时应检查 loop_search_maximum_distance 是否过小（建议 ≥ 环境宽度的一半），或适当增大 scan_buffer_size 以保留更多历史帧用于匹配。

关键参数说明

• loop_search_maximum_distance：搜索闭环候选帧的最大距离，需大于环境回环路径的宽度，否则无法找到闭环。
• loop_match_minimum_chain_size：形成闭环所需的最小连续匹配帧数，值越大闭环越保守，越小越灵敏。
• loop_match_minimum_response_fine：精匹配响应阈值，低于此值的匹配将被拒绝，防止误闭环。

以上参数已针对 turtlebot3_world 场景调优，若在更大环境中使用，需适当增大 scan_buffer_size 和 loop_search_maximum_distance。