论文部分内容阅读
当下很多机器人需要在工作场景中移动完成任务,而地图是移动机器人理解周围环境并作出行动的基础和关键。本文叙述了一种基于2D激光的环境三维地图构建方法,使机器人系统可以实现在动态运动过程中采集激光数据并构建三维点云地图。本文针对移动地图构建,以通过二维旋转激光传感器构建三维点云地图为目的,在系统架构、传感器数据处理、位姿估计等方面展开研究。主要研究内容和成果如下:(1)设计了环境感知单元的软硬件架构,并针对多传感器原始数据时间戳不一致问题,提出了基于样条平滑的多传感器时间同步。对不同的传感器采用了不同的时间同步方法,一般传感器数据直接使用线性插值法,而对于存在时间不确定性的视觉里程计数据,则利用重投影误差和关键帧信息,采用样条平滑方法实现时间同步。(2)构建了 JDL 模型(Joint Directors of Laboratories Model)和 EKF(Extended Kalman Filter)相结合的多传感器融合位姿估计方法。该方法采用JDL模型作为多传感器融合架构,在JDL模型的态势推断层级,采用EKF方法融合基于ORB-SLAM2的双目视觉里程信息和惯性传感单元数据。通过两者在位置变换估计和角度变换估计的优势互补提高了位姿估计精度。(3)实现了基于ICP(Iterative Closest Point)方法的在线和离线多帧地图融合优化。在线模式下,本文将多个点云局部地图使用ICP的方法拼接融合在一起,得到最终的激光地图。在保证基本的实时性的同时,最大可能地消除了实时姿态估计的累计误差。离线模式下,基于在线模式的基础,添加了基于ICP方法的单个局部点云内部优化。