Research on pedestrian navigation correction algorithm based on heading constraint

Jiayao ZHENG,Zhong SU,Qing LI

DOI: https://doi.org/10.16652/j.issn.1004-373x.2017.24.001

2017-01-01

Abstract:The MEMS inertial device has big zero-drift error with time accumulation and has poor observability for its heading error,which may cause the heading divergency of the pedestrian navigation. Therefore,a heading correction algorithm based on the main direction is proposed. Based on the fact that the heading angle while the pedestrian travels along the straight line main-tains within the constant range,taking the deviation between the pedestrian′s current heading and master heading as the observa-tion value when the heading changes,the extended Kalman filter(EKF)is used to estimate the error,so as to correct the heading. The navigation module is fixed on the upper surface of the shoes for about 200 m walking experiment. The experimental results show that the method can effectively suppress the heading divergency,and its positioning error is about 1% of the total walking distance.