%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%?功能說明：數(shù)據(jù)分析程序
%??詳細(xì)原理介紹及中文注釋請參考：
%??《卡爾曼濾波原理及應(yīng)用-MATLAB仿真》，電子工業(yè)出版社，黃小平著。
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
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