[发明专利]基于非线性未知随机偏差的两阶段容积卡尔曼滤波方法

说明书

技术领域

本发明属于非线性系统的滤波领域，特别涉及一种处理含有未知随机变量非线性系统的两阶容积卡尔曼滤波方法。

背景技术

非线性滤波是信号处理、目标跟踪和控制领域方面的热门话题之一，特别是，在卡尔曼滤波框架下的非线性滤波研究仍然是一个很火的问题，在近年来受到了越来越多的关注和研究。。

卡尔曼滤波器“为线性高斯系统中最小均方差下的位置状态”提供了有效的解决方法。然而真实世界中，系统总是受到非线性和非高斯两方面的困扰。想要获得关于状态估计良好的办法是很难的。扩展卡尔曼于是受到了广泛的使用，无踪卡尔曼是另外一种用样本来解决非线性分布的方法。不幸的是上述提到的非线性滤波器都有发散和维度灾难的问题。一个更为精确的容积卡尔曼应运而生。容积卡尔曼滤波的核心是球型射线容积法则。它可以用来解决高斯非线性滤波问题，而不需要很大的计算量。

标准的求容积卡尔曼滤波器要求精确的系统模型和精确的随机指标信息，在实际中模型通常包括未知定量和未知偏差。在处理含有位置偏差的动态系统的状态估计时，将偏差视为一部分系统状态，并且像系统一样估计偏差。这就引出了增广状态卡尔曼滤波，它的应用却也存在相对大的计算量的问题。

发明内容

本发明涉及一种处理还有未知偏差非线性系统的两阶段容积卡尔曼滤波器。该方法将含有位置偏差的非线性系统看作不含位置偏差估计和含有位置偏差估计两部分。从而在获得良好非线性滤波的情况下，避免了增广卡尔曼滤波所带来的计算量大的问题。对于不含未知偏差的部分，算出一步预测值、一步预测方差、一步预测协方差。从而算出增益阵、估计值、估计误差方差。对于含未知偏差的部分，算出一步偏差估计、一步偏差估计方差、一步偏差估计协方差。再算出偏差增益阵、偏差对于状态变量的一步增益阵和估计增益阵。通过两个部分算出来的值，算出含未知偏差非线性系统的一步预测值，一步预测误差方差，估计值和估计误差方差。在完成滤波的同时，避免了对计算机来说大的计算量和维度灾难。本发明的具体步骤如下：

步骤1.计算不含有未知偏差部分的无偏差估计一步预测一步预测误差方差一步预测误差协方差

步骤2.计算不含有未知偏差部分的无偏差估计增益阵估计值和估计误差方差阵P_k|k。

步骤3.计算含有未知偏差部分的，未知偏差一步预测b_k|k-1偏差一步预测方差偏差预测误差协方差和以及

步骤4.计算含有未知偏差部分的，偏差增益阵和偏差估计误差方差阵 以及偏差一步增益U_k|k-1和偏差增益。

步骤5.根据以上四步计算未知偏差非线性系统的一步预测方差和一步预测误差协方差和最终目标状态的最优线性估计及其误差协方差

本发明有益效果：使用两阶段容积卡尔曼方法不仅能有效处理还有未知偏差的非线性系统，还有效避免了增广状态卡尔曼在处理同类问题时所产生的维度灾难和计算机计算量过大的问题。

附图说明

图1为两阶段容积卡尔曼滤波的流程图。

具体实施方式

下面首先为跟踪目标的运动状态建立模型，其次给出两阶段容积强滤波器的滤波公式，将其分为无偏差估计和有偏差估计两个步骤，下面结合图1详细介绍本发明的实施过程。

1系统建模

1.1给出如下非线性系统动态模型

x_k＝f_k-1(x_k-1)+w_k,k-1

z_k＝h_k(x_k)+v_k

其中k≥1是时刻指数，x_k∈R^n×1表示系统状态(R^n×1为n×1维列向量全集)，z_k∈R^n×1是测量值列向量，f_k-1(·)以及h_k(·)都是可微函数。初始状态x₀服从为均值，P₀为方差且独立于w_k和v_k随机变量。w_k∈R^n×1和v_k∈R^m×1都是均值为零的高斯白噪声，其中δ_ij是克罗内克脉冲函数。