摘要:针对低成本足绑式行人导航系统中航向误差快速发散导致定位精度下降的问题,从降低姿态更新误差的角度出发,基 于等效旋转矢量理论和傅里叶展开,提出一种基于函数拟合姿态更新方法的足绑式行人导航算法。 首先,以等效旋转矢量法为 理论基础,使用正余弦函数拟合足部运动角速度,利用泰勒展开及等式变换求取函数拟合姿态更新方法;随后,结合长短期记忆 网络(LSTM)零速检测,设计适用于多种步态的足绑式行人导航算法;最后,以 WT901BC IMU 为硬件平台开展了多组不同步态 的闭环路径验证实验,结果表明,相较于传统基于四元数法或二子样等效旋转矢量法的足绑式行人导航算法,所提方法定位误 差平均减小 47. 66% 和 42. 83% ,航向误差平均减小 49. 99% 和 44. 74% 。