[发明专利]噪声相关的带偏差系统的并行式融合估计方法

说明书

本发明涉及一种噪声相关的带偏差系统的并行式融合估计方法。针对存在影响系统状态和测量的动态偏差和相关噪声的多传感器测量系统的滤波问题，本发明提出了一种基于解相关技术和并行式多传感器融合思路的带偏差系统估计方法，通过引入解相关技术，重新建立一种噪声不相关的等效模型，同时，基于噪声相关的两阶段卡尔曼滤波器，分别对多个无偏差滤波器和多个偏差滤波器进行融合，最后，将局部融合后无偏差状态值和偏差值进行融合，得到系统状态的最优估计值。本发明解决了估计中过程噪声与测量噪声的相关性导致滤波精度下降的问题。

技术领域

本发明属于滤波估计领域，特别涉及一种基于噪声解相关技术和并列式融合结构的带偏差系统的估计方法。

背景技术

当动态偏差存在且影响系统过程或测量时，作为估计基础的系统增加了偏差方程，为了取得更准确的滤波估计值，需要对偏差进行估计。

面对含动态偏差的状态估计问题，常见的方法是将偏差与状态合成一个新状态，进行估计，这种方法虽然容易理解，但其计算涉及高维矩阵的计算，计算量大。在此基础上，两阶段卡尔曼滤波器的引入为该问题提出了一种解决方法，该估计方法的思路如下：加入噪声自适应协方差矩阵和转换矩阵概念，利用矩阵求逆定理和转换矩阵将增强状态的滤波器过程分解为无偏滤波器和偏差滤波器两部分，用偏差滤波器来对无偏滤波器进行补偿，得到系统状态的估计值。

相比于单传感器，多传感器信息融合系统在性能上有优势。利用单个传感器进行状态估计时，测量数据来源单一且容易出现问题，这就使得滤波估计的精度无法被保证；使用多个传感器进行状态估计时，测量数据来源众多，这些测量数据不太可能同时出现问题，估计的精度得到保证。因此，本发明重点是对存在噪声相关的带偏差系统的估计问题。

发明内容

为了应对上面提到的噪声相关和动态偏差情况，本发明引入噪声解相关技术，获得噪声相关条件下的两阶段卡尔曼滤波器。基于上述滤波器，分别对多个无偏差状态滤波器和偏差滤波器进行并行式融合，提出了噪声相关的并行式两阶段卡尔曼滤波融合估计方法。

本发明大体上可分为五个部分。第一部分是系统模型建立；第二部分引入解相关技术，重新建立一种噪声不相关的等效模型；在第三部分，依据量测数据，得到多个局部两阶段卡尔曼滤波器；第四部分分别对无偏差滤波器和偏差滤波器进行并行式融合；最后，将两个融合结果进行组合，得到系统状态的估计值，。

本发明的有益效果：可以对噪声相关进行处理，相对单个两阶段卡尔曼滤波器，本发明可以取得对无偏差状态和偏差的更精确估计值。

附图说明

图1为本发明方法递推过程。

图2为本发明中步骤4和5的详细过程。

具体实施方式

以下结合附图对本发明作进一步说明。

如图1所示，本发明包括以下步骤：

步骤1.系统建模

考虑了一类常见的带偏差多传感器系统为模型，系统过程噪声统计特性已知，存在相关噪声的系统的状态方程、偏差方程和量测方程描述如下：

式中，k表示时间序列；x_k,b_k和y_i,k分别为系统n维状态向量、m维偏差向量和第i个传感器的p维观测向量；和v_i,k分别为系统状态噪声向量、系统偏差噪声向量和第i个传感器的量测噪声向量；A_k+1,k∈R^n×n为状态转移矩阵；C_i,k∈R^p×n为第i个传感器的状态观测矩阵。过程噪声、偏差噪声和量测噪声均是零均值高斯白噪声序列：v_i,k～N(0,V_i,k)，且