一种用于视觉-惯性-激光融合的同步定位与建图方法

摘要

一种用于视觉‑惯性‑激光融合的同步定位与建图方法，主要涉及多传感器融合、SLAM等技术领域。为了解决单传感器SLAM在定位和建图中精度低、易丢失的问题，本发明提出了一种鲁棒的高精度的视觉、惯性、激光雷达融合的SLAM系统。本发明通过激光雷达的扫描匹配进一步优化紧耦合的视觉惯性里程计，得到更加精确的定位结果。并且当相机或者激光雷达发生退化，导致视觉惯性模块或者扫描匹配模块不能正常工作时，系统自动整合剩余可工作模块，维持稳定的位姿估计。为了移除累计误差，添加了基于外观的回环检测和基于点云的邻近匹配，之后进行六自由度的位姿优化，以保持全局一致性。本发明能够得到鲁棒的高精度的定位和建图效果。