[发明专利]一种针对过程噪声协方差矩阵Q未知情况下的Kalman滤波方法

摘要

本发明提供一种针对过程噪声协方差矩阵Q未知情况下的Kalman滤波方法，具体过程为步骤一，判断系统模型是否满足预设条件，若满足，则进入步骤二，否则结束该方法；步骤二，构建系统广义输出矩阵E；步骤三，利用所述矩阵E确定系统输出的耦合向量δi；步骤四、根据耦合向量δi构建系统输出的线性耦合；基于所述线性耦合，利用大数定律对过程噪声的协方差矩阵Q进行估计，将估计的结果记为步骤五、将过程噪声的协方差矩阵的实时估计结果带入到标准Kalman滤波器中，获得滤波结果。本发明方法可以实现过程噪声协方差矩阵Q未知情况下的Kalman滤波。

主权项

一种针对过程噪声协方差矩阵Q未知情况下的Kalman滤波方法，该方法所针对的系统量测噪声的协方差矩阵R已知，其特征在于，具体过程为：步骤一，判断系统模型是否满足预设条件，若满足，则进入步骤二，否则结束该方法；所述预设条件为：其中，rank[]代表矩阵的秩，A为系统状态转移矩阵，H为系统观测矩阵，m为系统状态变量的个数；步骤二，构建系统广义输出矩阵E；E=H0HAH]]>步骤三，利用所述矩阵E确定系统输出的耦合向量δi；步骤四、根据耦合向量δi构建系统输出的线性耦合；基于所述线性耦合，利用大数定律对过程噪声的协方差矩阵Q进行估计，将估计的结果记为所述根据耦合向量δi构建系统输出的线性耦合的过程如下：定义系统当前所处的时刻为l，同时定义其中代表向下取整；根据耦合向量δi计算输出的线性耦合Z~1i=δiZ1Z2,Z~2i=δiZ3Z4,......,Z~pi=δiZ2p-1Z2p]]>其中，Z1,Z2…Z2p分别对应时刻1,2,…,2p的系统输出；步骤五、将过程噪声的协方差矩阵的实时估计结果带入到标准Kalman滤波器中，获得滤波结果。