-
大小: 2KB文件類型: .rar金幣: 1下載: 0 次發布日期: 2021-02-02
- 語言: Matlab
- 標簽: trackinger??trackinger.r??
資源簡介
目標跟蹤程序,使用matlab編寫,采用CV模型,卡爾曼跟蹤,有軌跡模擬,給出了跟蹤的誤差
目標跟蹤,采用CV模型,卡爾曼濾波,給出模擬結果和跟蹤結果,給出誤差分析
代碼片段和文件信息
%參考文獻?
%Decoupling?joint?probabilistic?data?association?algorithm?for?multiple?target?tracking??
%雜波環境下多傳感器的數據融合?
%三維常速CV模型?
?
clear?all;?
clc;?
close?all;
?
T=1;?%?采樣周期?
hits=2000;?%?采樣點數?
MCNum=10;??%?Monte?Carlo仿真次數?
?
Qn=50;??%?觀測誤差標準差??
R_Q=50;??????%?R方向觀測誤差標準差?
THETA_Q=0.1;?%?THETA方向觀測誤差標準差?
PHI_Q=0.1;???%?PHI方向觀測誤差標準差?
?
v_x=300;?v_y=200;?v_z=100;?%?X、Y和Z方向的速度(恒定)?
x0=1000;?y0=5000;?z0=10000;?%?初始位置?
?
DX_Average=zeros(1hits);?%?Monte?Carlo仿真的需要?
DY_Average=zeros(1hits);?
DZ_Average=zeros(1hits);?
?
O2=[0?0;?0?0];?%?2*2階的零矩陣,為了以后賦值的方便?
O3=[000]‘;??
?
f=[1?T;0?1];?
F=[f?O2?O2;O2?f?O2;O2?O2?f];?%?狀態轉移矩陣?
?
q=[T^4/4?T^3/2;T^3/2?T^2];??
Q=[q?O2?O2;O2?q?O2;O2?O2?q];?%?模型噪聲協方差陣?gama?
Qq=0.001;?%?模擬加速度的過程噪聲方差?w?
Q=Q*Qq;?
R=[R_Q^2?0?0;0?THETA_Q^2?0;0
?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????文件???????3609??2009-03-03?20:55??trackinger.m
-----------?---------??----------?-----??----
?????????????????3609????????????????????1
評論
共有 條評論