[发明专利]一种基于输出-反馈校正的线性系统滤波估计方法

说明书

本发明涉及一种基于输出‑反馈校正的线性系统滤波估计方法，其包括以下步骤：1)对第一测量系统和第二测量系统建立关系；2)针对系统特性，建立系统滤波方程；3)结合步骤2)选定滤波器的滤波方法；4)进行输出‑反馈校正系统滤波处理，将滤波器输出信息经积分和延迟处理后，对第一测量系统的测量量进行补偿，并在补偿之后与第二测量系统的测量量做差，其测量残差作为滤波器输入，滤波器输出信息经积分后，对第一测量系统的输出量进行输出校正，并作为整个信息融合的最终输出。本发明方法对异类测量系统信息融合具有适用性，将输出校正和反馈校正相结合，既解决了输出校正的非线性问题，又兼顾了反馈校正的独立性问题。

技术领域

本发明涉及自动控制领域，特别是涉及一种基于输出-反馈校正的线性系统滤波估计方法。

背景技术

在异类传感器信息融合时，若异类传感器直接获得的测量参数不同，且无法通过滤波信息进行反馈校正，随着时间推移，系统就难以满足线性条件。

工程上常用的间接法滤波估计通常都是建立在小偏差线性化方程的基础上，包括输出校正方式和反馈校正方式。其中，当系统采用输出校正方式时(如图1所示)，一旦系统误差增大而无法满足线性条件，则容易造成滤波精度下降甚至不收敛问题。而当系统采用反馈校正方式时(如图2所示)，则削弱了各测量系统的独立性，一旦某个测量系统故障造成滤波器污染，其它测量系统也会受到污染。

发明内容

(一)要解决的技术问题

本发明的目的是提供一种能够解决输出校正易出现的非线性问题和反馈校正的独立性问题的基于输出-反馈校正的线性系统滤波估计方法。

(二)技术方案

为了解决上述技术问题，本发明提供的一种基于输出-反馈校正的线性系统滤波估计方法，其包括以下步骤：

1)对第一测量系统和第二测量系统建立关系；

2)针对系统特性，建立系统滤波方程；

3)结合步骤2)选定滤波器的滤波方法；

4)进行输出-反馈校正系统滤波处理，将滤波器输出信息经积分和延迟处理后，对第一测量系统的测量量进行补偿，并在补偿之后与第二测量系统的测量量做差，其测量残差作为滤波器输入，滤波器输出信息经积分后，对第一测量系统的输出量进行输出校正，并作为整个信息融合的最终输出。

其中，所述步骤2)中，系统滤波方程包括离散化的系统状态方程和测量方程：

式中，ΔX_k为第k时刻的滤波状态，ΔX_K-1为k-1时刻的滤波状态，Φ_k,k-1为k-1时刻至k时刻的状态转移矩阵，Γ_k-1为系统噪声驱动阵，W_k-1为系统噪声，ΔZ_k为测量残差，H_k为测量矩阵，v_k为测量噪声。

其中，所述步骤3)中，滤波器选用标准卡尔曼滤波法，并根据离散化的系统状态方程和测量方程建立滤波方程：

式中，P_k|k-1分别为k时刻滤波状态和均方误差的一步预测阵，K_k为滤波增益，和P_k分别为k时刻滤波状态和均方误差的估计值，Q_k和R_k为系统噪声和测量噪声的协方差阵，为测量矩阵H_k的转置，为k-1时刻滤波状态的估计值，P_K-1为k-1时刻均方误差的估计值，为状态转移矩阵Φ_k,k-1的转置，为系统噪声驱动阵Γ_k-1的转置，I为单位矩阵。