基于增广拉格朗日条件的MIMU与GPS组合行人导航法

摘要

本发明提供的是一种基于增广拉格朗日条件的MIMU与GPS组合行人导航法。行人导航系统配有一个射频信号接收机和两个MIMU，射频信号接收机固定在行人的肩膀上，两个MIMU分别固定在一只脚的脚尖和脚跟上，实时采集系统数据；分别对两个MIMU进行导航解算得到惯导行人位置、速度、姿态信息，同时利用射频信号进行定位，得到接收机行人位置信息；分别对两个MIMU进行零速校正；构造一个非线性等式约束方程和一个非线性不等式约束方程；将约束方程与卡尔曼滤波相结合，利用增广拉格朗日方程对系统的状态变量进行校正，摆脱微弱信号下射频信号定位精度不够的问题。在恶劣的封闭室内导航环境下，采用本发明可以充分增加微弱射频信号的可利用性。