一种基于GNSS/INS深组合导航的双速率卡尔曼滤波方法

电子信息

本发明公开了一种基于GNSS/INS深组合导航的双速率卡尔曼滤波方法，包括以下步骤：1根据载体的初始位置、速率和姿态信息构建状态方程，初始化卡尔曼滤波的参数；2进行M步步长的状态预测更新，得到先验状态量的预测值3对先验状态量进行修正，得到后验状态量的预测值4对状态量的误差和系统误差协方差矩阵进行自适应更新，并用后验状态量预测值对惯性导航结果进行补偿，得到载体位置、速度与姿态信息；5补偿完成后更新该方法可以在GNSS/INS深组合导航的数据融合算法过程中，降低因GNSS卫星数据更新频率低或卫星数据失锁导致的截断误差；同时解决因INS数据与GNSS数据不同步导致的导航定位误差。

产业化应用