一种分体式SLAM设备及多传感器融合定位方法
摘要:
本发明公开了一种分体式SLAM设备及多传感器融合定位方法。本发明定位方法首先基于激光‑惯性子系统和视觉‑惯性子系统将激光雷达数据和视觉数据分别与惯性数据融合,然后以IMU的估计误差、激光雷达残差和视觉重投影误差为约束,共同估计系统状态并输出高频精确位姿;同时,采用激光‑视觉回环联合检测,达成优势互补,提升了回环检测的准确性和鲁棒性,在进行位姿图优化后进一步提高了全局一致性。同时,本发明还设计了一种采用分体式结构的便携SLAM设备,该设备包含手持部分和挎箱部分,通过设备分体实现便携手持,同时该设备的手持部分单层设计具有高扩展性,可以搭载任意不同型号的传感器以满足算法具体需求。
0/0