2. 激光SLAM系统架构
激光SLAM不是单一算法，而是一套由多个模块协同工作的系统工程。理解系统架构的价值在于：当定位漂移、建图重影或回环失败时，你能迅速判断问题出在哪个模块、哪条数据流，而不是盲目调参。本节从模块划分与数据流两个视角，建立整门课程的“系统地图”。
一、核心原理：五大模块与三条数据流
典型的激光SLAM系统可划分为五个核心模块：传感器层、前端里程计、后端优化、回环检测、地图表示。它们之间通过三条主要数据流连接：
- 实时位姿流：激光雷达点云 + IMU/轮速 → 前端 → 当前帧位姿，频率最高（10～50Hz），直接支撑导航与控制。
- 因子图流：前端输出的位姿约束、回环约束、IMU预积分约束 → 后端 → 全局一致的轨迹，频率低（1～10Hz）。
- 地图更新流：优化后的位姿 + 原始点云 → 地图表示模块 → 栅格/特征/面元地图，供定位、避障与可视化使用。
关键认知是：前端负责“快”，后端负责“准”，回环负责“不漂”，地图负责“可用”。四者职责分离，但通过因子图共享同一套位姿变量，因此任一模块的异常都会沿数据流传播。
二、方法流程：从一帧点云到一张地图
以常见的“激光雷达 + IMU”配置为例，一帧数据在系统中的完整旅程如下：
- 数据采集与同步：雷达输出点云，IMU输出角速度与加速度，通过硬件触发或软件时间戳对齐到统一时钟。
- 前端配准：将当前帧与局部地图或上一帧配准，估计相对位姿。常用方法包括点到面ICP、NDT、GICP以及基于特征的方法（如LOAM系列）。
- 约束构建：前端输出帧间位姿约束，IMU预积分输出惯性约束，回环检测输出闭环约束，统一加入因子图。
- 后端优化：以位姿为变量，最小化所有约束的残差，得到全局一致的轨迹。常用工具为GTSAM、Ceres、g2o。
- 地图更新：用优化后的位姿将点云投影到世界坐标系，更新栅格地图、特征地图或面元地图。
- 回环修正：当检测到回环时，后端重新优化，地图随之更新，消除累积漂移。
关键理解：前端是“局部最优”，后端是“全局最优”，回环是“全局约束的触发器”。没有回环，后端只能延缓漂移；没有后端，回环无法修正历史轨迹；没有地图表示，SLAM结果无法被上层应用消费。
三、案例/场景：模块异常如何定位
假设一台AGV在长走廊中运行，出现“建图重影、回环失败、定位跳变”三个现象。按数据流逐层排查：
| 现象 | 可能模块 | 检查点 | 典型参数/日志 |
|---|---|---|---|
| 建图重影 | 前端配准 | 帧间配准残差、点云畸变校正 | icp_fitness_score、deskew_enable |
| 回环失败 | 回环检测 | 描述子阈值、候选检索范围 | loop_closure_radius、sc_threshold |
| 定位跳变 | 后端优化 | 因子图残差、异常约束剔除 | chi2_error、robust_kernel |
| 地图模糊 | 地图表示 | 分辨率、更新策略、动态点过滤 | resolution、max_range、filter_size |
这个案例说明：现象往往出现在应用层，但根因可能在前端、后端或回环。建立“现象→模块→检查点→参数”的映射，是工程调试的核心能力。
四、误区/复盘：架构理解中的常见偏差
- 误区一：把前端当全部。 很多人只关注前端配准精度，忽略后端与回环。实际上，长距离建图的质量主要由后端和回环决定。
- 误区二：回环检测越频繁越好。 错误的回环会引入错误约束，导致地图严重变形。回环必须经过几何验证和鲁棒核函数保护。
- 误区三：地图表示只是可视化。 地图分辨率、更新频率、内存占用直接影响定位精度和系统实时性，是架构设计的重要一环。
- 误区四：模块之间可以独立调参。 前端输出的约束质量会影响后端优化，后端优化结果又影响地图更新，参数之间存在耦合，必须联合调试。
调试建议：先保证前端位姿在短距离内稳定，再开启后端优化，最后引入回环检测。每引入一个模块，观察轨迹与地图的变化，逐步定位问题，避免一次性开启所有功能导致问题难以归因。
# 典型激光SLAM系统启动顺序（以LIO-SAM为例）
roslaunch lio_sam run.launch \
imu_topic:=/imu/data \
lidar_topic:=/velodyne_points \
loop_closure_enable:=true \
save_map:=true
# 关键日志观察点
# [INFO] Front-end: frame 1200, fitness=0.032
# [INFO] Back-end: optimize 1200 poses, chi2=45.2
# [INFO] Loop: candidate found, distance=3.2m
# [INFO] Map: update 1200 frames, resolution=0.2m