[发明专利]一种抗差自适应多模型滤波方法

说明书

本发明公开了一种抗差自适应多模型滤波方法，具体包括以下步骤：步骤1：采用三个滤波器的多模型滤波结构，建立应用对象的离散状态空间模型，并构建量测噪声方差阵模型集；步骤2：计算各滤波器间模型混合概率、各滤波器混合初始状态及其均方误差阵；步骤3：三个滤波器分别同时进行抗差Kalman滤波；步骤4：采用贝叶斯假设检验方法进行滤波器模型概率更新；步骤5：各滤波器估计值与对应滤波器模型概率加权融合，输出联合状态估计及其均方误差阵；步骤6：自适应更新量测噪声方差阵模型集；步骤7：重复步骤2～步骤6直至滤波结束。本发明能够有效提高滤波抗差能力，自适应快速估计量测噪声统计特性，提高滤波精度。

技术领域

本发明涉及一种抗差自适应多模型滤波方法，属于多传感器信息融合技术，特别适用于组合导航领域。

背景技术

Kalman滤波是一种线性，无偏，且误差方差最小的最优估计算法，广泛应用于多传感器信息融合，具有算法简单、易于工程实现的特点，但算法精度高度依赖系统模型的准确性，且要求准确已知系统噪声和量测噪声的统计特性。在实际工程应用中，由于传感器量测环境通常复杂多变，导致量测噪声的统计特性难以准确获取且具有时变性。另外，即使是非常精密的传感器，其量测数据也或多或少的会带有粗差(野值)。以上种种情况都会导致Kalman滤波精度明显变差甚至滤波发散。

多模型估计对于处理系统模型不确定情况下的估计问题有着其他方法所不具备的效果，但估计性能在很大程度上依赖于模型集。对于固定结构的多模型算法，为了能够覆盖到系统所有可能的模式，模型集要设计的足够大，但并不是所有系统模式都是完全已知的，同时若增大模型集，则会导致过度的模型竞争反而影响估计精度。

以水下惯导/多普勒组合导航为例。由于水下环境复杂多变，多普勒测速仪的量测数据不可避免会带有粗差，同时其量测噪声的统计特性也往往未知且会随着环境的变化而变化，单一固定的滤波器参数在系统长时间运行过程中必将会导致滤波精度的降低。另外，所建立的系统模型也难免会存在误差。因此，针对以上情况亟需一种更为有效的滤波方法。

发明内容

为了降低量测粗差和量测噪声统计特性未知多变对滤波精度的影响，本发明提出了一种抗差自适应多模型滤波方法。该方法能够有效提高滤波抗差能力，自适应快速估计量测噪声统计特性，提高滤波精度。

本发明的上述目的通过以下技术方案来实现：

一种抗差自适应多模型滤波方法，具体包括以下步骤：

步骤S1：采用三个滤波器的多模型滤波结构，建立应用对象的离散状态空间模型，并构建量测噪声方差阵模型集；

步骤S2：计算各滤波器间模型混合概率、各滤波器混合初始状态及其均方误差阵；

步骤S3：三个滤波器分别同时进行抗差Kalman滤波；

步骤S4：采用贝叶斯假设检验方法进行滤波器模型概率更新；

步骤S5：各滤波器估计值与对应滤波器模型概率加权融合，输出联合状态估计及其均方误差阵；

步骤S6：自适应更新量测噪声方差阵模型集；

步骤S7：重复步骤S2～S6直至滤波结束。

进一步，所述步骤S1具体包括以下过程：

S1.1采用三个滤波器的多模型滤波结构，建立应用对象的离散状态空间模型，包括状态方程和量测方程：

其中，和分别为k时刻滤波器j的状态向量和量测向量，为k-1时刻滤波器j的状态向量，为k-1时刻到k时刻滤波器j的状态一步转移矩阵，为k-1时刻滤波器j的系统噪声向量，为k-1时刻到k时刻滤波器j的系统噪声输入矩阵，为k时刻滤波器j的量测矩阵，为k时刻滤波器j的量测噪声向量，j＝1,2,3。