singerCTCA模型卡尔曼滤波实现

将几种基本的卡尔曼滤波模型集中到一起处理目标跟踪问题，包含singer模型，CA模型，CT模型等等，是入门的好例子，希望对大家有帮助

clear;clc;
%%%%%%%%%%%%%%雷达地心地固坐标计算%%%%%%%%%%%%%%%%%%

[x01y01z01]=change（122.140.50）;[x02y02z02]=change（122.441.50）;[x03y03z03]=change（122.740.90）;
load（‘Data1.mat‘）;
load（‘Data4.mat‘）;

% %%%%%%%%%%%%1号雷达球-直角坐标变换%%%%%%%%%

logic1=（Data1（:5）==1）;
x1=Data1（logic11）.*cos（pi/2-Data1（logic12）/180*pi）.*cos（Data1（logic13）/180*pi）;
y1=Data1（logic11）.*sin（pi/2-Data1（logic12）/180*pi）.*cos（Data1（logic13）/180*pi）;
z1=Data1（logic11）.*sin（Data1（logic13）/180*pi）;


% %%%%%%%%%%%%多项式拟合%%%%%%%%%%%%%%%

tt1=Data1（logic14）-Data1（14）;
p=polyfit（tt1y14）;
YY1=p（1）*tt1.^4+p（2）*tt1.^3+p（3）*tt1.^2+p（4）*tt1+p（5）;
p1=polyfit（tt1x14）;
XX1=p1（1）*tt1.^4+p1（2）*tt1.^3+p1（3）*tt1.^2+p1（4）*tt1+p1（5）;
p2=polyfit（tt1z14）;
ZZ1=p2（1）*tt1.^4+p2（2）*tt1.^3+p2（3）*tt1.^2+p2（4）*tt1+p2（5）;

%%%%%%%%%%%%2号雷达球-直角坐标变换%%%%%%%%%

logic2=（Data1（:5）==2）;
x2=Data1（logic21）.*cos（Data1（logic22）/180*pi）.*cos（Data1（logic23）/180*pi）;
y2=Data1（logic21）.*sin（Data1（logic22）/180*pi）

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     文件       10194  2014-09-22 21:06  jianmo20140919.m