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