计算机应用 ›› 2020, Vol. 40 ›› Issue (4): 1157-1163.DOI: 10.11772/j.issn.1001-9081.2019081326

• 虚拟现实与多媒体计算 • 上一篇    下一篇

利用惯导测量单元确定关键帧的实时SLAM算法

卫文乐, 金国栋, 谭力宁, 芦利斌, 陈丹琪   

  1. 火箭军工程大学 核爆侦测工程系, 西安 710025
  • 收稿日期:2019-08-01 修回日期:2019-09-20 出版日期:2020-04-10 发布日期:2019-09-29
  • 通讯作者: 卫文乐
  • 作者简介:卫文乐(1994-),男,陕西宝鸡人,硕士研究生,主要研究方向:无人机导航、计算机视觉;金国栋(1979-),男,安徽池州人,副教授,博士,主要研究方向:无人机测绘、目标定位;谭力宁(1983-),男,河南南阳人,讲师,博士,主要研究方向:深度学习、无人机飞行控制;芦利斌(1967-),男,陕西西安人,副教授,博士,主要研究方向:无人机自主导航、集群;陈丹琪(1996-),女,安徽池州人,硕士研究生,主要研究方向:无人机光电定位、数据挖掘。
  • 基金资助:
    国家自然科学基金资助项目(61403398);陕西省自然科学基金资助项目(2017JM6077)。

Real-time SLAM algorithm with keyframes determined by inertial measurement unit

WEI Wenle, JIN Guodong, TAN Lining, LU Libin, CHEN Danqi   

  1. Department of Nuclear Explosion Detection Engineering, Rocket Force University of Engineering, Xi'an Shaanxi 710025, China
  • Received:2019-08-01 Revised:2019-09-20 Online:2020-04-10 Published:2019-09-29
  • Supported by:
    This work is partially supported by the National Natural Science Foundation of China(61403398),the Natural Science Foundation of Shaanxi Province(2017JM6077).

摘要: 由于嵌入式处理器算力的限制,实时性差一直是视觉惯导同时定位与建图(VI-SLAM)走向实际应用的一个亟待解决的问题,因此提出一种利用惯导测量单元(IMU)确定关键帧的实时同时定位与建图(SLAM)算法,主要分为3个线程:跟踪、局部建图和闭环。首先由跟踪线程通过IMU预积分自适应地确定关键帧,而自适应阈值由视觉惯性紧耦合优化的结果得出;然后仅对关键帧进行跟踪,避免对所有帧进行特征处理;最后利用局部建图线程在滑动窗口中通过视觉惯导光束平差法得到更加精确的无人机位姿,利用闭环线程得到全局一致的轨迹和地图。在数据集EuRoC上的实验结果表明,该算法能在不降低精度和鲁棒性的情况下显著减少跟踪线程耗时,降低VI-SLAM对计算资源的依赖。在实际飞行测试中,该算法能够较实时准确地估计出具有尺度信息的无人机飞行真实轨迹。

关键词: 同时定位与建图, 惯导测量单元, 关键帧, 预积分, 视觉惯性紧耦合, 无人机导航

Abstract: Due to the limitation of the computational power of embedded processors,the poor real-time performance has always been an urgent problem to be solved in the practical applications of Visual Inertial Simultaneous Localization And Mapping(VI-SLAM). Therefore,a real-time Simultaneous Localization And Mapping(SLAM)with keyframes determined by Inertial Measurement Unit(IMU)was proposed,which was mainly divided into three threads:tracking,local mapping and loop closing. Firstly,the keyframes were determined adaptively by the tracking thread through the IMU pre-integration, and the adaptive threshold was derived from the result of the visual inertia tight coupling optimization. Then,only the keyframes were tracked,thereby avoiding the feature processing to all frames. Finally,a more accurate Unmanned Aerial Vehicle(UAV)pose was obtained by the local mapping thread through the visual inertial bundle adjustment in the sliding window,and the globally consistent trajectory and map were output by the loop closing thread. Experimental results on the dataset EuRoC show that the algorithm can significantly reduce the tracking thread time consumption without loss of precision and robustness,and reduce the dependence of VI-SLAM on computing resources. In the actual flight test,the true trajectory of the drone with scale information can be estimated accurately by the algorithm in real time.

Key words: Simultaneous Localization And Mapping (SLAM), Inertial Measurement Unit (IMU), keyframe, preintegration, visual inertia tight coupling, Unmanned Aerial Vehicle (UAV) navigation

中图分类号: