无迹卡尔曼滤波器(UKF)

无迹卡尔曼滤波器(UKF)

UKF依然没有脱离KF的框架。只不过对下一时刻状态的预测方法变成了sigma点集的扩充与非线性映射。这样做有两个优点:1、避免了复杂非线性函数雅可比矩阵的复杂运算;2、保证了非线性系统的普遍适应性。此外,由于高斯分布sigma点集的扩展,使高斯分布的噪声得到抑制。

预测过程:

这里写图片描述

这里写图片描述

更新过程:

这里写图片描述

这里写图片描述

在准确建模的前提下,KF,EKF和UKF都有不错的表现。但是对于很多复杂的系统而言,建模就是一个复杂的问题。如果模型参数没办法准确估计,那么卡尔曼滤波器的应用就会受到限制。在不知道模型参数的情况下,可以通过蒙特卡洛采样,特别是粒子滤波的方法来对参数进行估计



  • 12
    点赞
  • 66
    收藏
    觉得还不错? 一键收藏
  • 3
    评论
无迹卡尔曼滤波器(Unscented Kalman Filter,UKF)是一种用于状态估计的滤波算法,它可以在非线性系统中对状态进行估计。与传统的卡尔曼滤波器相比,无迹卡尔曼滤波器通过使用一组称为sigma点的采样点来近似非线性系统的状态和观测方程,从而提高了估计的准确度和稳定性。 在MATLAB中,可以使用以下步骤来构造无迹卡尔曼滤波器: 1. 定义系统的初始状态和测量状态。 2. 初始化系统滤波器的状态误差协方差矩阵。 3. 设置仿真时间。 4. 使用滤波算法进行状态估计。 5. 在每个时间步骤中,更新状态和状态误差协方差矩阵,并计算滤波处理后的误差。 6. 重复步骤4和步骤5直到仿真时间结束。 以下是一个MATLAB代码示例,展示了如何构造无迹卡尔曼滤波器: ```MATLAB %------------------清屏---------------- close all;clear all; %关闭所有文件,清除所有变量 clc; tic; %清屏、记录程序开始时间 global Qf n; %定义全局变量 %------------------初始化-------------- stater0=[220; 1;55;-0.5]; %标准系统初值 state0=[200;1.3;50;-0.3]; %测量状态初值 %--------系统滤波初始化 p=[0.005 0 0 0;0 0.005 0 0; 0 0 0.005 0;0 0 0 0.005]; %状态误差协方差初值 n=4; T=3; Qf=[T^2/2 0;0 T;T^2/2 0;0 T]; %-------------------------------------- stater=stater0;state=state0; xc=state; staterout=[]; stateout=[];xcout=[]; errorout=[];tout=[]; t0=1; h=1; tf=1000; %仿真时间设置 %---------------滤波算法---------------- for t=t0:h:tf [state,stater,yc]=track(state,stater); %轨迹发生器:标准轨迹和输出 [xc,p]=UKFfiter(@systemfun,@measurefun,xc,yc,p); error=xc-stater; %滤波处理后的误差 staterout=[staterout,stater]; stateout=[stateout,state]; errorout=[errorout,error]; xcout=[xcout,xc]; tout=[tout,t]; end ```
评论 3
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值