【状态估计】变分贝叶斯近似的递归噪声自适应卡尔曼滤波(Matlab代码实现)

本文涉及的产品
云原生网关 MSE Higress,422元/月
任务调度 XXL-JOB 版免费试用,400 元额度,开发版规格
服务治理 MSE Sentinel/OpenSergo,Agent数量 不受限
简介: 【状态估计】变分贝叶斯近似的递归噪声自适应卡尔曼滤波(Matlab代码实现)

💥💥💞💞欢迎来到本博客❤️❤️💥💥


🏆博主优势:🌞🌞🌞博客内容尽量做到思维缜密,逻辑清晰,为了方便读者。


⛳️座右铭:行百里者,半于九十。


📋📋📋本文目录如下:🎁🎁🎁


目录


💥1 概述


📚2 运行结果


🎉3 参考文献


🌈4 Matlab代码及文献


💥1 概述

文献来源:


5e918e89384841388cb2f232cfa1c10f.png


本文研究了变分贝叶斯方法在线性状态空间模型中动态状态和时变测量噪声参数联合递归估计中的应用。所提出的自适应卡尔曼滤波方法基于对各时间步上状态和噪声参数的联合后验分布分别形成可分离变分近似。结果是一个递归算法,其中每一步都用卡尔曼滤波器估计状态,并通过定点迭代估计噪声方差的足够统计数据。通过仿真数据演示了该算法的性能。


原文摘要:


Abstract:

This article considers the application of variational Bayesian methods to joint recursive estimation of the dynamic state and the time-varying measurement noise parameters in linear state space models. The proposed adaptive Kalman filtering method is based on forming a separable variational approximation to the joint posterior distribution of states and noise parameters on each time step separately. The result is a recursive algorithm, where on each step the state is estimated with Kalman filter and the sufficient statistics of the noise variances are estimated with a fixed-point iteration. The performance of the algorithm is demonstrated with simulated data.


卡尔曼滤波器 (KF) [1] 考虑了估计问题类中噪声测量的动态状态估计,其中动态和测量过程可以通过线性高斯状态空间模型近似。扩展卡尔曼滤波器(EKF)和无迹卡尔曼滤波器(UKF)通过形成后验状态分布的高斯近似[2]–[5],将该方法扩展到非线性动态和测量模型。这些滤波器的一个严重限制是,它们假定完全了解测量和动态模型参数,包括噪声统计。参数的确切知识,特别是噪声统计,在许多实际情况中并不是一个合理的假设。这种应用的例子是低成本的集成GPS/INS定位系统和容错系统(例如,见[6]、[7]及其中的参考资料)。


解决不确定参数问题的经典方法(参见[8],[9])是使用自适应滤波器,其中模型参数或噪声统计与动态状态一起估计。经典的噪声自适应滤波方法可分为贝叶斯、最大似然、相关和协方差匹配方法[8]。贝叶斯方法是其中最通用的,其他方法通常可以解释为贝叶斯方法的近似值。贝叶斯噪声自适应滤波方法的例子是基于状态增强的方法[10],[11],多模型方法,如交互多模型(IMM)算法[3],[9]和粒子方法[12]-[15]。


变分贝叶斯(VB)方法已被开发用于各种模型,与采样方法相比,以较低的计算成本执行近似后验推理(有关VB方法的回顾,请参阅例如[16]-[18])。 这些方法假设后部采用更简单、易于分析的形式。两种主要方法是推导因式自由形式分布(对于共轭指数类中的模型),或者假设固定形式的后验分布(例如,多元高斯,可能具有模型的适当参数化)。


Smidl和Quinn[19]提出了VB近似的理论框架,特别强调了递归贝叶斯推理和信号处理应用。与本工作相关,还考虑了具有未知方差的AR模型的VB近似,但未考虑具有未知时变方差的一般线性状态空间模型。卡尔曼平滑器的通用变分版本在[20]中已经开发出来,利用共轭指数框架,但具有平稳噪声。时变方差模型已在 [21] 中使用固定形式方法解决。


我们提出的方法通过分解的自由形式分布来近似状态的联合后验分布和噪声方差。该近似在每个时间步上分别形成,结果是一个递归算法,其中在每个步骤上,状态和噪声方差的足够统计数据都是通过卡尔曼滤波器的定点迭代估计的。我们还提出了方差的启发式动力学模型,可用于对噪声的时间行为进行建模,同时仍保留近似后验分布的功能形式。


📚2 运行结果


679505367a3641628707b7871b7a9801.png


部分代码:

for t = 2:Tn
        %%%%True noise covariance matrices
        Q = (1+0.5*cos(pi*t/Tn))*Q0;
        R = (1+0.6*cos(pi*t/Tn))*R0;
        %%%%Square-root of noise covariance matrices
        SQ = utchol(Q);
        SR = utchol(R);
        %%%%Simulate true state and measurement
        x = F*x+SQ*randn(nx,1);
        z = H*x+SR*randn(nz,1);
        X(:,t) = x;
        %%%%Filtering
        [x1,P_Const,Ppf] = kf(x1,P_Const,F,H,z,Q0,R0*times_Of_R);
        [x2,P_True,Pptf] = kf(x2,P_True,F,H,z,Q,R);
        [x3,P_VB,alfa,beta,mk] = vbkf(x3,P_VB,alfa,beta,mk,F,H,z,Q0,N);
        %%%%Save data
        XKF_Const(:,t) = x1;
        XKF_True(:,t) = x2;
        XKF_VB(:,t) = x3;
    end
    %%%%MSE calculation
    mse_Kf_1(:,k) = (X(1,:)-XKF_Const(1,:)).^2+(X(2,:)-XKF_Const(2,:)).^2;
    mse_Kf_2(:,k) = (X(3,:)-XKF_Const(3,:)).^2+(X(4,:)-XKF_Const(4,:)).^2;
    mse_Ktf_1(:,k) = (X(1,:)-XKF_True(1,:)).^2+(X(2,:)-XKF_True(2,:)).^2;
    mse_Ktf_2(:,k) = (X(3,:)-XKF_True(3,:)).^2+(X(4,:)-XKF_True(4,:)).^2;
    mse_VB_1(:,k) = (X(1,:)-XKF_VB(1,:)).^2+(X(2,:)-XKF_VB(2,:)).^2;
    mse_VB_2(:,k) = (X(3,:)-XKF_VB(3,:)).^2+(X(4,:)-XKF_VB(4,:)).^2;
end
%%%%%%%%%RMSE calculation
rmse_Kf_1 = sqrt(mean(mse_Kf_1,2));
rmse_Kf_2 = sqrt(mean(mse_Kf_2,2));
rmse_Ktf_1 = sqrt(mean(mse_Ktf_1,2));
rmse_Ktf_2 = sqrt(mean(mse_Ktf_2,2));
rmse_VB_1 = sqrt(mean(mse_VB_1,2));
rmse_VB_2 = sqrt(mean(mse_VB_2,2));
%%%%%%%RMSE curves
figure;
j = 2:L;
subplot(2,1,1)
plot(j*T,rmse_Kf_1(2:end),'-b',j*T,rmse_Ktf_1(2:end),'-g',j*T,rmse_VB_1(2:end),'--r','linewidth',2);
ylabel('RMSE_{pos} (m)');
subplot(2,1,2)
plot(j*T,rmse_Kf_2(2:end),'-b',j*T,rmse_Ktf_2(2:end),'-g',j*T,rmse_VB_2(2:end),'--r','linewidth',2);
xlabel('Time (s)');
ylabel('RMSE_{vel} (m/s)');
legend('KF1','KF2','The VBKF');


🎉3 参考文献

部分理论来源于网络,如有侵权请联系删除。


[1]S. Sarkka and A. Nummenmaa, "Recursive Noise Adaptive Kalman Filtering by Variational Bayesian Approximations," in IEEE Transactions on Automatic Control, vol. 54, no. 3, pp. 596-600, March 2009, doi: 10.1109/TAC.2008.2008348.


🌈4 Matlab代码及文献


相关实践学习
基于MSE实现微服务的全链路灰度
通过本场景的实验操作,您将了解并实现在线业务的微服务全链路灰度能力。
相关文章
|
9月前
|
Perl
【MFAC】基于全格式动态线性化的无模型自适应控制(Matlab代码)
【MFAC】基于全格式动态线性化的无模型自适应控制(Matlab代码)
|
7月前
|
算法 vr&ar
基于自适应波束成形算法的matlab性能仿真,对比SG和RLS两种方法
```markdown - MATLAB2022a中比较SG与RLS自适应波束成形算法。核心程序实现阵列信号处理,强化期望信号,抑制干扰。RLS以其高效计算权重,而SG则以简单和低计算复杂度著称。[12345] [6666666666] [777777] ```
|
8月前
|
算法 调度 决策智能
基于自适应遗传算法的车间调度matlab仿真,可以任意调整工件数和机器数,输出甘特图
这是一个使用MATLAB2022a实现的自适应遗传算法解决车间调度问题的程序,能调整工件数和机器数,输出甘特图和适应度收敛曲线。程序通过编码初始化、适应度函数、遗传操作(选择、交叉、变异)及自适应机制进行优化,目标如最小化完工时间。算法在迭代过程中动态调整参数,以提升搜索效率和全局优化。
|
8月前
|
算法
基于ADM自适应增量调制算法的matlab性能仿真
该文主要探讨基于MATLAB的ADM自适应增量调制算法仿真,对比ADM与DM算法。通过图表展示调制与解调效果,核心程序包括输入输出比较及SNR分析。ADM算法根据信号斜率动态调整量化步长,以适应信号变化。在MATLAB中实现ADM涉及定义输入信号、初始化参数、执行算法逻辑及性能评估。
|
9月前
|
机器学习/深度学习 算法
基于自适应支持向量机的matlab建模与仿真,不使用matlab的SVM工具箱函数
基于自适应支持向量机的matlab建模与仿真,不使用matlab的SVM工具箱函数
|
9月前
|
监控 算法 计算机视觉
基于FPGA的图像自适应阈值二值化算法实现,包括tb测试文件和MATLAB辅助验证
基于FPGA的图像自适应阈值二值化算法实现,包括tb测试文件和MATLAB辅助验证
|
9月前
【MFAC】基于紧格式动态线性化的无模型自适应控制(Matlab代码)
【MFAC】基于紧格式动态线性化的无模型自适应控制(Matlab代码)
|
传感器 数据采集 算法
移动通信系统的LMS自适应波束成形技术matlab仿真
移动通信系统的LMS自适应波束成形技术matlab仿真
|
机器学习/深度学习 传感器 算法
【红外图像】利用红外图像处理技术对不同制冷剂充装的制冷系统进行性能评估(Matlab代码实现)
【红外图像】利用红外图像处理技术对不同制冷剂充装的制冷系统进行性能评估(Matlab代码实现)
|
6月前
|
安全
【2023高教社杯】D题 圈养湖羊的空间利用率 问题分析、数学模型及MATLAB代码
本文介绍了2023年高教社杯数学建模竞赛D题的圈养湖羊空间利用率问题,包括问题分析、数学模型建立和MATLAB代码实现,旨在优化养殖场的生产计划和空间利用效率。
272 6
【2023高教社杯】D题 圈养湖羊的空间利用率 问题分析、数学模型及MATLAB代码