基于视觉惯导融合的移动机器人地图构建方法及相关设备

摘要

本发明公开了基于视觉惯导融合的移动机器人地图构建方法及相关设备，该方法包括：S1，根据视觉姿态和惯性姿态融合状态确定融合达成度，完成视觉初始化、视觉惯性校准对齐以及惯性初始化；S2，构建情形评估函数实时分析姿态趋势；S3，确定融合状态局部期望值并输出该状态；S4，根据公共地图点稀疏程度将关键帧分为强共视关键帧和弱共视关键帧；S5，根据分级结果将强共视关键帧送入滑动窗口并利用帧间位姿密集连续性优化强共视关键帧，借助观测地图点的联系对自感知地图进行绘制和校正。本发明保证了相机和IMU数据之间能准确融合，系统读取当前地图点位姿信息效率高、误差小。