一种基于视觉与激光雷达信息融合的机器人室内外定位导航系统方法

摘要

本发明涉及一种基于视觉与激光雷达信息融合的机器人室内外定位导航系统方法，包括以下步骤：以双目相机、2D激光雷达、超声测距传感器、6轴IMU和霍尔编码器作为环境感知单元；使用ORB‑SLAM2算法采集三维稀疏点云地图，为机器人提供位姿信息；室内环境，使用激光雷达，采用gmaping算法和粒子滤波器，建立二维地图；在室外环境，提取三维稠密点云地图中低于机器人高度空间点的平面位置，映射到二维地图。将室内外地图拼接形成完整的导航地图；集成拓展卡尔曼滤波器融合上述传感器数据，获取更为准确的位姿信息；系统在接受到目标点时开始导航，使用激光雷达实时建立周边环境的动态地图，对全局路径进行修正。