激光SLAM源码解析S-LOAM(三)里程计图优化
里程计,是通过累计帧间位姿变换得来的,因此会累积帧间误差。如果想要纠正此累积误差,我们需要通过另一种方法得到可信位姿,以此校正相同时刻里程计位姿。SLAM图优化,是一种记录各帧时刻里程计,并通过可信位姿校正累积误差的工具。闭环检测,利用“故地重游”的思想,通过当前帧与历史帧的配准(不是相邻时间帧),提供另一种位姿变换的关系,用来校正闭环内的累积误差。mapOptmization.cpp代码注释较详细,如下所示。/** * Created by haocaichao on 20






