卡尔曼滤波算法实现飞行物体运动轨迹预测

运动物体的轨迹预测，分别使用卡尔曼滤波、扩展卡尔曼滤波、无迹卡尔曼滤波以及数据拟合方法实现。本例代码仅含卡尔曼滤波部分代码。 本例仅为本人在研究轨迹预测问题时为理解算法原理所写，针对具体问题请自行斟酌算法适用性。 本例代码详解后续会在本人博客中做具体说明，欢迎讨论！

%---------------------------------------------%
%					      %
%          工作室提供代做matlab仿真	      %
%					      %
%  详情请访问：http://cn.mikecrm.com/5k6v1DP  %
%					      %
%---------------------------------------------%

%使用卡尔曼滤波方法对飞行航班进行轨迹预测
%数据来源：FlightAware（https://zh.flightaware.com）
%航    班：CES9937     宁波栎社国际机场飞往成都双流国际机场
%飞行时间：2018-07-17  07:07-09:55
%说明：取起飞后前20组数据作为实验数据。对时间点进行近似取值，假设每隔30s上报一次数据
clear;
clc;
%采样点的个数
N=228;
%测试数据：纬度
latitude=load（‘C:\workspace\matlab workspace\CES9937\latitude.txt‘）;
%真实维度值
lat=latitude;
%卡尔曼滤波处理的状态，即估计值
lat_kf=zeros（1N）;
%测报值
lat_z=zeros（1N）;
P=zeros（1N）;
%初始纬度值
lat（1）=29.8131;
%初始值的协方差
P（1）=0.09;
%初始测报值
lat_z（1）=29.8027;
%初始估计状态。假设和初始测报值相同
lat_kf（1）=lat_z（1）;
%噪声方差
%系统噪声方差
Q=0.1;
%测量噪声方差
R=0.001;
%方差决定噪声大小
W=sqrt

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----

     文件     153993  2018-07-24 16:28  卡尔曼滤波算法实现飞行物体运动轨迹预测\CES9937\CES9937.docx

     文件       1825  2018-07-17 15:07  卡尔曼滤波算法实现飞行物体运动轨迹预测\CES9937\latitude.txt

     文件       2051  2018-07-17 15:15  卡尔曼滤波算法实现飞行物体运动轨迹预测\CES9937\longitude.txt

     文件        410  2018-07-17 11:16  卡尔曼滤波算法实现飞行物体运动轨迹预测\CES9937\飞行数据-20组.txt

     文件       2227  2018-09-19 08:09  卡尔曼滤波算法实现飞行物体运动轨迹预测\QA_KF_lat.m

     文件         55  2018-08-27 11:33  卡尔曼滤波算法实现飞行物体运动轨迹预测\【源码使用必读】.url

     目录          0  2018-08-14 20:18  卡尔曼滤波算法实现飞行物体运动轨迹预测\CES9937

     目录          0  2018-09-16 11:01  卡尔曼滤波算法实现飞行物体运动轨迹预测

----------- ---------  ---------- -----  ----

               160561                    8