系统仿真学报 ›› 2018, Vol. 30 ›› Issue (11): 4359-4366.doi: 10.16182/j.issn1004731x.joss.201811037

• 仿真应用工程 • 上一篇    下一篇

改进的零速修正算法在行人自主导航中的应用

汪天生, 李擎   

  1. 北京信息科技大学高动态导航技术北京市重点实验室, 北京 100192
  • 收稿日期:2018-05-29 修回日期:2018-06-21 发布日期:2019-01-04
  • 作者简介:汪天生(1993-),男,安徽,硕士生,研究方向为个人定位、高动态导航技术等;李擎(1964-),女,河北,博士,教授,研究方向为导航制导、飞行器控制等。
  • 基金资助:
    国家自然科学基金(61771059),北京市教委市属高校创新能力提升计划(JSHG201510772017)

Application of Improved ZUPT in Pedestrian Self-Navigation

Wang Tiansheng, Li Qing   

  1. Beijing Information Science and Technology University Beijing Key Laboratory of High Dynamic Navigation Technology, Beijing 100192, China
  • Received:2018-05-29 Revised:2018-06-21 Published:2019-01-04

摘要: 针对目前传统的零速修正算法(Zero Velocity Update,ZUPT)理论上能够修正累积误差,但是由于其3维速度、位置、姿态的状态误差变量是以3维速度误差为观测量通过建立的模型而得到的,导致其稳定性较差,精度也不高的问题。提出了一种18维的零速更新算法,在零速状态时利用相邻时刻的状态信息计算得到无法直接观测的状态观测量,利用卡尔曼滤波器最优估计出所有状态误差。为验证改进的ZUPT的精确性,利用自研的IMU进行实验。结果表明改进的算法相比传统的ZUPT具有很好的稳定性而且导航精度提高了1.7%。

关键词: IMU, 零速修正技术, 行人自主导航, 误差观测量, 卡尔曼滤波器

Abstract: In view that the currently traditional Zero Velocity Update (ZUPT) can theoretically correct the cumulative error, while the state error variable of 3-dimensional velocity, position and attitude is measured by the model which is established by the observations of 3D velocity error with poor stability and low precision results, an 18-dimensional zero-velocity update algorithm is proposed. The algorithm uses state information of adjacent time to calculate state observations that cannot be directly observed in the zero-velocity state, and then uses the Kalman filter to optimally estimate all state errors. To verify the accuracy of the improved ZUPT, the experiments were carried out by using a self-developed IMU. The results show that the improved algorithm has better stability than the traditional ZUPT and the navigation accuracy is improved by 1.7%.

Key words: IMU, zero velocity update, pedestrian self-navigation, observations of errors, Kalman filter

中图分类号: