公司建设网站的好处地板网站源码
1、内容简介
略
 26-可以交流、咨询、答疑
2、内容说明
无迹卡尔曼滤波 无迹卡尔曼滤波 无迹卡尔曼滤波
3、仿真分析


%该文件用于编写无迹卡尔曼滤波算法及其测试
%注解:主要子程序包括:轨迹发生器、系统方程
%      测量方程、UKF滤波器
%---------------------------------------
function UKFmain
%------------------清屏----------------
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;          %仿真时间设置 

4、参考论文
略
 链接:https://pan.baidu.com/s/1AAJ_SlHseYpa5HAwMJlk1w 
 提取码:rvol
