欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2019112635304
申请人: 云南大学
专利类型:发明专利
专利状态:已下证
专利领域: 基本电子电路
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种新型无先导卡尔曼滤波方法,其特征在于,包括以下步骤:S1:建立系统基本方程,其表达式如下:xk=f(xk-1)+wk-1         (1)zk=h(xk)+vk             (2)式中,xk∈Rn表示k时刻的状态向量,zk∈Rn表示k时刻的量测向量,f(·)和h(·)分别为已知的非线性系统状态方程传递函数和非线性系统量测方程传递函数,过程噪声wk-1∈Rn和量测噪声vk∈Rn为不相关的高斯白噪声且两者都为0,协方差分别为Qk-1和Rk;

S2:对系统进行初始化滤波

设定状态估计与估计误差方差矩阵的初始值,其表达式分别如下;

S3:计算2n+1个Sigma采样点计算k时刻状态估计的2n+1个Sigma采样点,n是状态变量的维数,计算公式为:其中, 表示矩阵(n+λ)Px的平方根矩阵的第i列,λ=α2(n+k)-n决定了采样点与 的距离,α为调节参数,k为另一个常数参数,通常取为3-n,影响高阶误差的均值和协方差的因素,表示状态向量的平均值;

S4:计算2n+1个Sigma采样点的一步预测采样点一步预测信息的计算公式为:Xk|k-1=f(χk-1)                  (6)S5:对系统进行时间更新

计算系统状态变量的一步预测的均值和一步预测的协方差,将采样点的一步预测信息代入非线性传递函数f(·)得到相应的均值和协方差,其中:一步预测的均值的计算公式为:

其中, 表示计算均值所需的权重;

一步预测的协方差的计算公式为:

其中, 表示计算协方差所需的权重;

S6:迭代变量更新

利用步骤S5得到一步预测值进行重复UT变换得到新的Sigma点集,并将新的Sigma点集代入系统基本方程得到量测估计值、量测向量的互协方差矩阵和自协方差矩阵,其中:量测估计值的表达式如下:

量测向量的自协方差的表达式如下:量测向量的互协方差的表达式如下:S7:计算卡尔曼增益

根据步骤S6得到的量测向量的自协方差Pzz,k|k-1和量测向量的互协方差Pxz,k|k-1计算卡尔曼增益,计算公式如下:S8:对系统状态进行更新和对协方差进行更新,并重复步骤S3至S7,直至滤波结束状态估计值的表达式如下:状态估计误差的协方差的表达式如下:T

Pk=Pk|k-1-GkPxz,k|k-1Gk      (14)。

2.根据权利要求1所述的新型无先导卡尔曼滤波方法,其特征在于,量测向量的自协方差的计算过程如下:以所述系统基本方程在量测更新步骤中重构观测噪声协方差,首先利用对非线性函数进行泰勒公式展开近似,基于该近似用q微分的Huber方法获得状态估计,定义状态预测误差如下;

设定ek为k时刻状态预测的误差,构造如下的非线性递归模型:定义:

其中,Sk=diag([RxPk|k-1]),则对公式(16)进行改写:其中,

M估计的代价函数定义为:

其中,ri为残差向量rk=yk-g(xk)的第i个向量,n和m分别为状态和观测的维度,代价函数为:其中,μ为调解因子,取值为1.345,将 代替M估计代价函数中的rk,用q微分对代价函数求偏导得到代价函数最小值:定义函数 得到 调整协方差矩阵

再通过截取 得到修正后的量测协方差,其表达式为:将更新后的 代入到UKF的量测更新中,得到量测向量的自协方差。