LeGO-LOAM中mapOptmization.cpp
时间: 2024-06-01 18:08:40 浏览: 143
为适配kitti数据集修改的lego-loam.zip
mapOptimization.cpp 是 LeGO-LOAM 系统中的一个模块,用于对地图进行优化。具体来说,它实现了一个基于 scan-to-map 的非线性优化算法,优化的目标是最小化每个激光帧与地图之间的误差。
该模块的主要功能包括:
1. 将当前帧与地图中的关键帧进行匹配,得到初始位姿估计;
2. 采用 Ceres Solver 对当前帧的位姿和地图点的位置进行优化,以最小化误差;
3. 更新地图中的关键帧和点云。
该模块在 LeGO-LOAM 系统中扮演着非常重要的角色,通过对地图的优化,可以提高系统的精度和鲁棒性。
阅读全文