1.一种噪声相关的两阶段容积Kalman滤波估计方法,其特征在于,所述噪声相关的两阶段容积Kalman滤波估计方法包括:采用恒等变形的方法对噪声相关系统进行变换,建立系统模型;
通过加入系数,将所述系统模型由噪声相关系统转化为噪声不相关系统,建立新系统模型;
再用所述新系统模型中的噪声参数与两阶段滤波的递推计算,得到噪声相关的两阶段容积Kalman滤波估计器。
2.如权利要求1所述的噪声相关的两阶段容积Kalman滤波估计方法,其特征在于,所述采用恒等变形的方法对噪声相关系统进行变换,建立系统模型的步骤具体如下:所述噪声相关系统为非线性高斯系统:xk+1=fk(xk)+ωk+1,k; (1)zk=hk(xk)+υk; (2)其中k是离散时间序列,xk∈Rn×1是系统的状态向量,zk∈Rm×1是量测向量,f(·)和h(·)为已知的非线性状态转移函数和量测函数且在xk处连续可微,过程噪声序列ωk+1,k和量测噪声序列υk均为高斯白噪声序列,其中均值为E(ωk+1,k)=qk,E(υk)=rk,方差Qk+1,k和Rk满足如下条件:初始状态x0与ωk+1,k、υk无关,且满足:
3.如权利要求1所述的噪声相关的两阶段容积Kalman滤波估计方法,其特征在于,所述通过加入系数,将所述系统模型由噪声相关系统转化为噪声不相关系统,建立新系统模型的步骤具体为:将噪声相关系统进行变换,通过恒等变形,将噪声相关系统转换为不相关系统,再进行滤波估计;
由模型公式(2)得:
zk-hk(xk)-υk=0;
设Δk为待定系数,则有:
Δk(zk-hk(xk)-υk)=0 (3);
带入公式(1)并整理得:
其中
Fk(xk)=fk(xk)+Δk(zk-hk(xk)) (5);
公式(1)和(2)所示模型转化为:zk=hk(xk)+υk (8);
其中
将噪声相关系统转换为噪声无关系统,则有:展开得:
当满足公式(9)时,噪声无关系统过程噪声和量测噪声不相关;
使用转换模型方法得到的噪声相关非线性高斯滤波公式均加角标t表示;
4.如权利要求1所述的噪声相关的两阶段容积Kalman滤波估计方法,其特征在于,再用所述新系统模型中的噪声参数与两阶段滤波的递推计算,从而得到噪声相关的两阶段容积Kalman滤波估计器的步骤具体为:步骤一,时间更新:
1)假设已知k-1时刻的后验密度函数 对Pk-1|k-1做Cholesky分解,得到
2)计算容积点 和传播容积点其中,i=1,2,...,m=2nx;
3)令mk-1=qk-1-Δkrk,根据状态向量维数和偏差向量维数将mk进行分块,则有:同理对rk进行分块有:
借助mk-1估计噪声相关的无偏滤波器状态预测值和有偏滤波器状态预测值
4)令
根据两阶段变换公式中分块矩阵的维度,将 进行分块:同理,令 对状态噪声方差矩阵进行分块:借助耦合关系 估计噪声相关的无偏滤波器状态误差协方差 和有偏滤波器状态误差协方差
步骤二,量测更新:
A)分解 得到
B)计算容积点 和经过量测方程传播的传播容积点其中,i=1,2,...,m;
C)估计噪声相关的量测预测值D)估计噪声相关的量测误差协方差和噪声相关的交叉协方差
E)将公式 按照相应的维度进行分块得到分块增益矩阵:估计噪声相关的无偏滤波器卡尔曼增益 和噪声相关的有偏滤波器卡尔曼增益
F)借助mk-1和rk计算噪声相关的无偏滤波器状态估计值和噪声相关的有偏滤波器状态估计值G)借助 计算噪声相关的无偏滤波器估计误差协方差
噪声相关的有偏滤波器估计误差协方差
5.一种如权利要求1所述噪声相关的两阶段容积Kalman滤波估计方法的噪声相关的两阶段容积Kalman滤波估计系统。