GNSS/INS松组合算法原理简介

本篇博文的矩阵展开都是根据状态向量为21维给出的，也就是位置误差、速度误差、失准角、陀螺常值零偏误差、加速度计常值零偏误差、陀螺比例因子误差、加速度计比例因子误差

卡尔曼滤波简介

概念

卡尔曼滤波算法作为一种重要的最优估计理论被广泛应用于各种领域，组合导航系统的设计是其成功应用中的一个最主要方面。卡尔曼滤波有离散型和连续型两种形式，前者可直接用于数字计算机上实现，后者更常用于卡尔曼滤波的理论性能分析。这里只介绍应用离散卡尔曼滤波算法实现GNSS/INS松组合解算的具体设计。

内容

在一个滤波周期内，卡尔曼滤波的信息更新过程可以分为时间更新过程和量测更新过程。其中时间更新又被称为预测，一步预测的状态及其协方差阵为:

方法

卡尔曼滤波器的初始化

GNSS/INS 松组合卡尔曼滤波算法设计的关键在于：建立离散时间系统误差状态模型，然后构建误差状态的线性观测方程。有了系统模型和观测方程则可直接使用卡尔曼滤波的基本方程进行组合导航解算，即完成了组合导航的算法设计。