%function??JPDAF（target_positionnTMC_numberc）
clc;
clear?all;
close?all;

n=100;?????????????????????????????????????????????????????????????????????????????%?采樣次數(shù)
T=1;?????????????????????????????????????????????????????????????????????????????????%?T為采樣間隔
MC_number=10;??????????????????????????????????????????????????????????????%?Monte?Carlo仿真次數(shù)
c=2;?????????????????????????????????????????????????????????????????????????????????%?目標(biāo)個(gè)數(shù)
target_position=[1500?300?500?400?1000?500;?500?400?1500?300?1000?500];????%目標(biāo)的起始位置和速度（mm/s）????????
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%?程序功能??:采用JPDA數(shù)據(jù)關(guān)聯(lián)算法實(shí)現(xiàn)兩個(gè)勻速運(yùn)動(dòng)目標(biāo)的點(diǎn)跡與航跡的關(guān)聯(lián)
%?輸入變量??:
%???????????-target_position:??目標(biāo)的初始位置
%???????????-?n:??采樣次數(shù)?
%???????????-?T:??采樣間隔
%???????????-MC_number:仿真次數(shù)
%???????????-?c:??目標(biāo)個(gè)數(shù)
%?輸出變量??:
%???????????無
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%

%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%??參數(shù)定義??%%%%%
%%%%%%%%%%%%%%%%%%%%%%%%%%%
Pd=1;??????????????????????????????????????????????????????????????????%檢測(cè)概率
Pg=0.99;??????????????????????????????????????????????????????????????%正確量測(cè)落入跟蹤門內(nèi)得概率
g_sigma=100;?????????????????????????????????????????????????????%門限
lambda=2;???????????????????????????????????????????????????????????%雜波密度5??10
gamma=lambda*10^（-6）;????????????????????????????????????%每一個(gè)單位面積（km^2）內(nèi)產(chǎn)生lambda個(gè)雜波
Target_measurement=zeros（c3n）;??????????????????????%目標(biāo)觀測(cè)互聯(lián)存儲(chǔ)矩陣
target_delta=[100?100];????????????????????????????????????????%目標(biāo)對(duì)應(yīng)的觀測(cè)標(biāo)準(zhǔn)差???[10?10]?????????????????
P=zeros（66c）;?????????????????????????????????????????????????????%協(xié)方差矩陣
P1=[target_delta（1）^2?0?0?0?0?0;0?0.01?0?0?0?0;
???????0?0?target_delta（1）^2?0?0?0;0?0?0?0.01?0?0;
???????0?0?0?0?target_delta（1）^2?0;0?0?0?0?0?0.01];????????????????%初始協(xié)方差矩陣?
P（::1）=P1;
P（::2）=P1;
A?=?[1?T?0?0?0?0;0?1?0?0?0?0;0?0?1?T?0?0;0?0?0?1?0?0;0?0?0?0?1?T;0?0?0?0?0?1];??????????????????????%狀態(tài)轉(zhuǎn)移矩陣
C?=?[1?0?0?0?0?0;0?0?1?0?0?0;0?0?0?0?1?0];????????????????????????????????????????????%觀測(cè)矩陣
R=[target_delta（1）^2?0?0;0?target_delta（1）^2?0;0?0?target_delta（1）^2];?????????%觀測(cè)協(xié)方差矩陣
Q=[4?0?0;0?4?0;0?0?4];?????????????????????????????????????????????????????????%系統(tǒng)過程噪聲協(xié)方差
G=[T^2/2?0?0;T?0?0;0?T^2/2?0;0?T?0;0?0?T^2/2;0?0?T];????????????????????????????????%過程噪聲矩陣
x_filter=zeros（6cn）;?????????????????????????????????????????????%存儲(chǔ)目標(biāo)的各時(shí)刻的濾波值
x_filter1=zeros（6cnMC_number）;???????????????????????%MC_number次Montle?Carlo仿真所得全部結(jié)果存儲(chǔ)矩陣
data_measurement=zeros（c3n）;?????????????????????????%觀測(cè)存儲(chǔ)矩陣
data_measurement1=zeros（c6n）;???????????????????????%實(shí)際位置坐標(biāo)xy矩陣???

%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%??產(chǎn)生目標(biāo)的實(shí)際位置??%%%%%
%%%%%%%%%%%%%%%%%%%%%%%%%%%
data_measurement1（::1）=target_position;??????????%實(shí)際位置矩陣初始化?
for?i=1:c
????for?ii=2:n?????????????????????????????????????????????????????????%實(shí)際位置?
????????data_measurement1（i:ii）=（A*data_measurement1（i:ii-1）‘）‘+（G*sqrt（Q）*（randn（31）））‘;????????
??

?屬性????????????大小?????日期????時(shí)間???名稱
-----------?---------??----------?-----??----
?????文件???????18193??2013-07-15?21:27??JPDA算法及分析\JPDA_sanwei.m
?????文件??????124928??2014-10-27?11:13??JPDA算法及分析\JPDA算法分析.doc