資源簡介
將幾種基本的卡爾曼濾波模型集中到一起處理目標跟蹤問題,包含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
評論
共有 條評論