航空学报 > 2014, Vol. 35 Issue (9): 2583-2592   doi: 10.7527/S1000-6893.2014.0013

基于混合特征匹配的微惯性/激光雷达组合导航方法

杭义军, 刘建业, 李荣冰, 孙永荣   

  1. 南京航空航天大学 导航研究中心, 江苏 南京 210016
  • 收稿日期:2013-11-27 修回日期:2014-03-05 出版日期:2014-09-25 发布日期:2014-04-04
  • 通讯作者: 刘建业,Tel.:025-84892304 E-mail:ljyac@nuaa.edu.cn E-mail:ljyac@nuaa.edu.cn
  • 作者简介:杭义军 男,博士研究生。主要研究方向:微惯性及有关导航技术。E-mail:hangyijun@nuaa.edu.cn;刘建业 男,教授,博士生导师。主要研究方向:惯性及多传感器融合导航技术。Tel:025-84892304 E-mail:liyac@nuaa.edu.cn
  • 基金资助:

    国家自然科学基金(61273057,61374115);江苏省普通高校研究生科研创新项目(CXZZ12_0159)

MEMS IMU/LADAR Integrated Navigation Method Based on Mixed Feature Match

HANG Yijun, LIU Jianye, LI Rongbing, SUN Yongrong   

  1. Navigation Research Center, Nanjing University of Aeronautics and Astronautics, Nanjing 210016, China
  • Received:2013-11-27 Revised:2014-03-05 Online:2014-09-25 Published:2014-04-04
  • Supported by:

    National Natural Science Foundation of China(61273057, 61374115); Funding of Jiangsu Innovation Program for Graduate Education (CXZZ12_0159)

摘要:

微惯性/激光雷达(MEMS IMU/LADAR)组合导航系统在室内应用时,由于室内结构化环境下环境特征(如点和线段)分布稀疏,传统的单一特征匹配算法存在观测盲区,易造成导航定位参数估计误差大的问题。基于此,研究了激光雷达自适应数据分割方法的点和线段的特征提取算法,提出了基于混合特征匹配观测模型的MEMS IMU/LADR扩展卡尔曼滤波(EKF)算法。同时,设计了MEMS IMU/LADR组合导航试验样机,在室内环境下通过试验对滤波算法进行了验证。结果表明:提出的算法在室内结构化环境下相比传统单一点或线特征匹配组合定位算法的定位精度可提高60%,对于小型旋翼无人飞行器在室内结构化环境中的高精度定位具有较高的参考意义。

关键词: 微惯性测量单元, 激光雷达, 混合特征匹配算法, 扩展卡尔曼滤波, 同步定位与建图

Abstract:

Usually, there are observation blind areas existing in that the distribution of land marks like angular point and line segment is parse in indoor environment. Then the locating accuracy of vehicle and the estimating precision of land marks is affected by the lack of observed quantities when using the traditional single feature matching algorithm. To solve these problems, the adaptive segmentation method of LADAR is studied, and the extraction algorithm of different types of land marks is researched, then the extended Kalman filter is presented based on the mixed feature matching observation model. At the same time, a test prototype of MEMS IMU/LADAR integrated navigation system is designed. To validate the filtering fusion algorithm, the analysis and tests are carried out in the indoor environment. The test results show that the accuracy of proposed algorithm relative to the traditional algorithm(a single point or line feature match integrated location algorithm) in the structured indoor environment increass about 60%. This indicates that the algorithm is efficient when used to improve accuracy of the MEMS IMU/LADAR integrated navigation system.

Key words: MEMS inertial measurement unit, laser radar, mix feature matched algorithm, extended Kalman filter, simultaneous localization and mapping

中图分类号: