%使用卡爾曼濾波方法對(duì)飛行航班進(jìn)行軌跡預(yù)測(cè)
%數(shù)據(jù)來(lái)源：FlightAware（https://zh.flightaware.com）
%航????班：CES9937?????寧波櫟社國(guó)際機(jī)場(chǎng)飛往成都雙流國(guó)際機(jī)場(chǎng)
%飛行時(shí)間：2018-07-17??07:07-09:55
%說(shuō)明：取起飛后前20組數(shù)據(jù)作為實(shí)驗(yàn)數(shù)據(jù)。對(duì)時(shí)間點(diǎn)進(jìn)行近似取值，假設(shè)每隔30s上報(bào)一次數(shù)據(jù)
clear;
clc;
%采樣點(diǎn)的個(gè)數(shù)
N=228;
%測(cè)試數(shù)據(jù)：緯度
latitude=load（‘C:\workspace\matlab?workspace\CES9937\latitude.txt‘）;
%真實(shí)維度值
lat=latitude;
%卡爾曼濾波處理的狀態(tài)，即估計(jì)值
lat_kf=zeros（1N）;
%測(cè)報(bào)值
lat_z=zeros（1N）;
P=zeros（1N）;
%初始緯度值
lat（1）=29.8131;
%初始值的協(xié)方差
P（1）=0.09;
%初始測(cè)報(bào)值
lat_z（1）=29.8027;
%初始估計(jì)狀態(tài)。假設(shè)和初始測(cè)報(bào)值相同
lat_kf（1）=lat_z（1）;
%噪聲方差
%系統(tǒng)噪聲方差
Q=0.1;
%測(cè)量噪聲方差
R=0.001;
%方差決定噪聲大小
W=sqrt（Q）*randn（1N）;
V=sqrt（R）*randn（1N）;
%系統(tǒng)矩陣
F=1;
G=1;
H=1;
%本系統(tǒng)狀態(tài)為1維
I=eye（1）;
%模擬緯度測(cè)報(bào)，并濾波
for?k=2:N
????%隨時(shí)間推移，飛行緯度逐漸變化
????%k時(shí)刻的真是緯度值是測(cè)報(bào)儀器不知道的，測(cè)報(bào)值可能是無(wú)限接近于真實(shí)值，但并不是真實(shí)值
????%lat（k）=F*lat（k-1）+G*W（k-1）;
????%緯度在k時(shí)刻的測(cè)報(bào)值
????lat_z（k）=H*lat（k）+V（k）;
????%kalman濾波
????%有了k時(shí)刻的測(cè)報(bào)值lat_z（k）和k-1時(shí)刻的狀態(tài)，那么就可以進(jìn)行濾波了
????%狀態(tài)預(yù)測(cè)
????lat_pre=F*lat_kf（k-1）;
????%協(xié)方差預(yù)測(cè)
????P_pre=F*P（k-1）*F‘+Q;
????%計(jì)算卡爾曼增益
????Kg=P_pre*inv（H*P_pre*H‘+R）;
????%新息
????e=lat_z（k）-H*lat_pre;
????%狀態(tài)更新
????lat_kf（k）=lat_pre+Kg*e;
????%協(xié)方差更新
????P（k）=（I-Kg*H）*P_pre;
end
%計(jì)算誤差
%測(cè)量值與真實(shí)值之間的偏差
Err_Messure=zeros（1N）;
%kalman估計(jì)與真實(shí)值之間的偏差
Err_Kalman=zeros（1N）;
for?k=1:N
????Err_Messure（k）=abs（lat_z（k）-lat（k））;
????Err_Kalman（k）=abs（lat_kf（k）-lat（k））;
end
t=1:N;
%濾波效果圖
figure
plot（tlat‘g-‘tlat_z‘b-‘tlat_kf‘r-‘）;
legend（‘真實(shí)值‘‘觀測(cè)值‘‘kalman濾波值‘）;
xlabel（‘測(cè)報(bào)時(shí)間點(diǎn)‘）;
ylabel（‘緯度值‘）;
%誤差分析圖
figure
plot（tErr_Messure‘b-‘tErr_Kalman‘r-‘）;
legend（‘測(cè)報(bào)偏差‘‘kalman濾波偏差‘）;
xlabel（‘測(cè)報(bào)時(shí)間點(diǎn)‘）;
ylabel（‘緯度偏差值‘）;

?屬性????????????大小?????日期????時(shí)間???名稱
-----------?---------??----------?-----??----
?????文件??????153993??2018-07-24?16:28??CES9937.docx
?????文件????????1825??2018-07-17?15:07??latitude.txt
?????文件????????2051??2018-07-17?15:15??longitude.txt
?????文件????????1988??2018-07-26?16:59??QA_KF_lat.m
?????文件?????????410??2018-07-17?11:16??飛行數(shù)據(jù)-20組.txt