公开(公告)号：CN110567455A

公开(公告)日：2019-12-13

申请号：CN201910908134.6

申请日：2019-09-25

Applicant: 哈尔滨工程大学

Inventor： 李宁 ,  冉培志 ,  张勇刚 ,  王钊 ,  张振宇

IPC: G01C21/16 ,  G01S19/47

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

公开(公告)号：CN110567455B

公开(公告)日：2023-01-03

申请号：CN201910908134.6

申请日：2019-09-25

Applicant: 哈尔滨工程大学

Inventor： 李宁 ,  冉培志 ,  张勇刚 ,  王钊 ,  张振宇

IPC: G01C21/16 ,  G01S19/47

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