EKF算法扩展卡尔曼滤波

SIMULINK仿真模块 EKF算法扩展卡尔曼滤波，有仿真模块有对应s函数模块算法

%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% 功能说明：数据分析程序
%  详细原理介绍及中文注释请参考：
%  《卡尔曼滤波原理及应用-MATLAB仿真》，电子工业出版社，黄小平著。
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
function DataAnalysis
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
load Xstate;
load Zdist;
load Xekf;
load Xukf;
T1=length（Xstate（1:））;
T2=length（Zdist（1:））;
T=min（T1T2）;
for k=1:T
    Dev_EKF（1k）=sqrt（ （Xekf（1k）-Xstate（1k））^2+（Xekf（2k）-Xstate（2k））^2 ）;
    Dev_UKF（1k）=sqrt（ （Xukf（1k）-Xstate（1k））^2+（Xukf（2k）-Xstate（2k））^2 ）;
end
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
figure
hold on;box on;
plot（Xstate（1:）Xstate（2:）‘-b.‘）;
plot（Xekf（1:）Xekf（2:）‘-r+‘）;
plot（Xukf（1:）

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     文件        1188  2020-10-02 22:41  EKF\DataAnalysis.m
     文件        1891  2020-10-02 22:41  EKF\EKF.m
     文件       35551  2020-10-02 22:41  EKF\EKF_test.mdl
     文件       35550  2020-10-02 22:41  EKF\EKF_test.mdl.autosave
     文件          63  2020-10-02 22:41  EKF\ffun.m
     文件        1375  2020-10-02 22:41  EKF\GetDistanceFunction.m
     文件          65  2020-10-02 22:41  EKF\hfun.m
     文件        1411  2020-10-02 22:41  EKF\SimuStateFunction.m
     文件         192  2020-10-02 22:41  EKF\Xekf.mat
     文件         379  2020-10-02 22:41  EKF\Xstate.mat
     文件         285  2020-10-02 22:41  EKF\Zdist.mat