欢迎访问《兵工学报》官方网站,今天是 分享到:

兵工学报 ›› 2017, Vol. 38 ›› Issue (10): 2031-2040.doi: 10.3969/j.issn.1000-1093.2017.10.020

• 论文 • 上一篇    下一篇

基于零速/航向自观测/地磁匹配的行人导航算法研究

黄欣, 熊智, 许建新, 徐丽敏   

  1. (南京航空航天大学 自动化学院, 江苏 南京 210016)
  • 收稿日期:2017-03-01 修回日期:2017-03-01 上线日期:2017-11-22
  • 通讯作者: 熊智(1976—),男,研究员,博士生导师 E-mail:xiongzhi@nuaa.edu.cn
  • 作者简介:黄欣(1993—),男,硕士研究生。E-mail:huangxin@nuaa.edu.cn
  • 基金资助:
    国家自然科学基金项目(61673208、61533008、61533009、61374115、61304227);江苏省“333工程”科研立项项目(BRA2016405);人力资源和社会保障部留学人员择优资助项目(2016年);江苏省六大人才高峰项目(2013-JY-013);江苏高校 优势学科建设工程项目(2014年);中央高校基本科研业务费专项项目(NZ2016104、NS2017016);江苏省普通高校研究生科研创新计划项目(KYLX15_0264);江苏省自然科学基金项目(BK20141453);航空科学基金项目(20165552043)

Research on Pedestrian Navigation Algorithm Based on Zero Velocity Update/Heading Error Self-observation/Geomagnetic Matching

HUANG Xin, XIONG Zhi, XU Jian-xin, XU Li-min   

  1. (College of Automation Engineering, Nanjing University of Aeronautics and Astronautics, Nanjing 210016, Jiangsu, China)
  • Received:2017-03-01 Revised:2017-03-01 Online:2017-11-22

摘要: 目前行人导航技术正发挥着越来越重要的作用,而无全球导航卫星系统(GNSS)环境下的行人导航定位成为其不可或缺的环节。以自包含传感器为硬件平台,针对无GNSS环境下的行人自主导航定位展开研究,提出一种基于“2+2”分级模式的零速判别方法,并设计一种惯性导航系统的零速修正卡尔曼滤波算法,有效提高同一参数阈值下零速判别的准确性与可靠性、抑制传感器误差发散;研究行人初始静态下磁航向误差观测算法及行人运动状态下的零速航向误差自观测算法,解决了行人长时间行走航向发散问题;提出基于多层约束和K近邻算法的地磁匹配算法,并实现基于零速修正/航向误差自观测的行人导航算法与地磁匹配算法的融合,提高了行人导航定位精度与可靠性。实际数据测试验证,所提基于零速修正/航向误差自观测/地磁匹配的行人导航算法可有效提高定位精度79%以上。

关键词: 控制科学与技术, 组合导航, 零速分级判别, 卡尔曼滤波, 航向误差自观测, 地磁匹配, 多层约束

Abstract: Nowadays, pedestrian navigation technology is playing an increasingly important role in supermarket shopping, fire rescue and field exploration, and the pedestrian navigation and positioning without global navigation satellite system (GNSS) has become an indispensable link. The self-contained sensors are used as a hardware platform for research on pedestrian autonomous navigation in non-GNSS environment. A zero-speed comprehensive discriminant algorithm based on the “2+2” hierarchical model is studied to improve the accuracy and reliability of zero velocity update (ZUPT). Kalman filter algorithm based on ZUPT designed for inertial navigation system is used to effectively suppress the sensor error divergence. To solve the problem of pedestrian long-term heading divergence, the magnetic heading error self-observation algorithm (MHESO) for pedestrian initial static state and the ZUPT heading error self-observation algorithm (ZHESO) for pedestrian movement are studied. In addition, a geomagnetic matching (GM) algorithm based on multi-layer constraint and K-nearest neighbor algorithm is proposed, and the fusion of ZUPT_HESO-pedestrian navigation algorithm and geomagnetic matching algorithm is realized, which improves the accuracy and reliability of pedestrian navigation. The actual data test proves that the proposed pedestrian navigation algorithm based on ZUPT_HESO_GM effectively improves the positioning accuracy by more than 79%. Key

Key words: controlscienceandtechnology, integratednavigation, zerovelocityupdategradingdiscrimination, Kalmanfilter, headingerrorself-observation, geomagneticmatching, multilayerconstraint

中图分类号: