基于Matlab构造无迹卡尔曼滤波器

2021-10-20 17:05:38 阅读：199 来源： 互联网

标签：errorout xc 卡尔曼滤波 xcout stater state Matlab 0.005 无迹

在这里插入图片描述

%------------------清屏----------------
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

完整代码链接：https://pan.baidu.com/s/1fwk7uIjLJGw5fnf__yZrsw

提取码：knpw

标签：errorout,xc,卡尔曼滤波,xcout,stater,state,Matlab,0.005,无迹
来源： https://blog.csdn.net/m0_47432290/article/details/120870013

本站声明： 1. iCode9 技术分享网（下文简称本站）提供的所有内容，仅供技术学习、探讨和分享；
2. 关于本站的所有留言、评论、转载及引用，纯属内容发起人的个人观点，与本站观点和立场无关；
3. 关于本站的所有言论和文字，纯属内容发起人的个人观点，与本站观点和立场无关；
4. 本站文章均是网友提供，不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属；如您发现该文章侵犯了您的权益，可联系我们第一时间进行删除；
5. 本站为非盈利性的个人网站，所有内容不会用来进行牟利，也不会利用任何形式的广告来间接获益，纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。

ICode9

基于Matlab构造无迹卡尔曼滤波器