一种基于航向自观测的惯性足绑式行人定位方法

摘要

本发明公开一种基于航向自观测的惯性足绑式行人定位方法，属于行人定位领域；本发明在惯性足绑式行人定位系统解算行人足部位姿过程中实时检测行人足部运动状态；在检测到零速状态时，对加速度计噪声进行判断；当加速度计噪声小于阈值时，根据加速度计输出信息得到水平姿态：横滚角、俯仰角，经过进一步解算得到姿态失准角：横滚失准角、俯仰失准角、航向失准角；以速度误差和姿态失准角为观测量，导航误差为状态量，利用卡尔曼滤波对导航误差进行估计、补偿，提高航向角可观测性，通过航向校正提高惯性足绑式行人定位系统精度。