一种求积更新容积卡尔曼滤波的紧组合导航方法

摘要

本发明公开了一种求积更新容积卡尔曼滤波的紧组合导航方法,首先对一步预测概率密度函数和状态后验概率密度函数进行建模，并对SINS/GPS紧组合导航系统进行动态建模；在更新一步预测状态求积点和下一时刻状态求积点时，分别构建系数矩阵F、G和H，建立以求积点误差矩阵相关的线性方程来辅助状态更新；初始时刻的导航参数直接由惯导解算得到，下一时刻的运载体导航误差、惯性元器件误差和GPS接收机时钟误差将作为滤波初值，实时地完成误差估计任务，再将估计后得到的系统状态误差反馈,对下一时刻惯性元件输出进行校正,输出组合导航参数信息。本发明使得组合导航精度有效提高，特别是对于速度和北向位置参数的导航精度提高明显。