%Gaussian?Mixture?Probability?Hypothesis?Density?Filter
%author:Gao?Xiaodong
%data:2008/5/1
clear?all
clcclose?all
tic;
%===============初始參數(shù)設(shè)定===============
T=1;???????????????????????????????????????????????????????????%采樣時(shí)間間隔
N=40;??????????????????????????????????????????????????????????%測量時(shí)間
M_number=1;????????????????????????????????????????????????????%程序運(yùn)行次數(shù)
Msample=500;???????????????????????????????????????????????????%粒子數(shù)目
x_number=zeros（1N）;
x_number（1）=1;?????????????????????????????????????????????????%目標(biāo)的初始個數(shù)
q_noise1=0.5;??????????????????????????????????????????????????%狀態(tài)噪聲方差
q_noise2=0.1;??????????????????????????????????????????????????%狀態(tài)噪聲方差
q_noise=[q_noise1;q_noise2];
T_prun=1e-5;???????????????????????????????????????????????????%修剪門限
U_merg=4;??????????????????????????????????????????????????????%合并門限
J_max=200;?????????????????????????????????????????????????????%最大高斯數(shù)
c_ospa=5;
p_ospa=2;
F=[1T00
???0100
???001T
???0001];???????????????????????????????????????????????????%存活目標(biāo)轉(zhuǎn)移矩陣
G=[T^2/20
????T0
????0T^2/2
????0T];??????????????????????????????????????????????????????%狀態(tài)噪聲的轉(zhuǎn)移矩陣
%===================目標(biāo)的真實(shí)運(yùn)動軌跡====================
target_position=TARGET_FORM（FGq_noise）;??????????????????????%目標(biāo)的真實(shí)運(yùn)動軌跡
%?target_position.m（2）.s=[zeros（47）target_position.m（2）.s];
%?target_position.m（3）.s=[zeros（411）target_position.m（3）.s];
%?target_position.m（4）.s=[zeros（419）target_position.m（4）.s];
%====================存活目標(biāo)初始化=======================
initial.m=target_position.m（1）.s（:1）;?????????????????????????%目標(biāo)的初始位置
Q_noise=[q_noise1^20
?????????0q_noise2^2];
Q=G*diag（[q_noise（1）q_noise（2）]）*G‘;
initial.P=diag（[1?2?1?2]）;???????????????????????????????????????????%目標(biāo)的初始協(xié)方差矩陣
initial.w=1;
initial.J=1;
%====================新生目標(biāo)初始化=======================
birth.m（:1）=[0000]‘;?????????????????????????????????????%birth對應(yīng)于目標(biāo)出現(xiàn)強(qiáng)度函數(shù)
birth.m（:2）=[-10000]‘;
birth.P=diag（[5?1?5?1]）;
birth.P=cat（3birth.Pbirth.P）;???
birth.w（1）=0.2;
birth.w（2）=0.2;
birth.J=2;???????????????????????????????????????????????????%新生目標(biāo)高斯分量數(shù)
%======================生成量測報(bào)告========================
H=[1000
???0010];???????????????????????????????????????????????????%量測矩陣
r_noise=[0.5;0.5];?????????????????????????????????????????????%量測噪聲標(biāo)準(zhǔn)差
R=[r_noise（1）^20
????0r_noise（2）^2];
ps=0.99;???????????????????????????????????????????????????????%目標(biāo)存活概率
pd=0.98;???????????????????????????????????????????????????????%目標(biāo)檢測概率
r=3;???????????????????????????????????????????????????????????%雜波平均數(shù)
motocaro_number=10;????????????????????????????????????????????%蒙特卡羅次數(shù)
x_number=zeros（motocaro_numberN）;?????????????????????????????%PHD估計(jì)的目標(biāo)數(shù)目
x_number_smooth=zeros（motocaro_numberN）;??????????????????????%平滑后?估計(jì)的目標(biāo)數(shù)目
dh1=zeros（motocaro_numberN）;
dw1=zeros（motocaro_numberN）;
d_ospa1=zeros（motocaro_numberN）;
dh2=zeros（motocaro_numberN）;
dw2=zeros（motocaro_numberN）;
d_ospa2=z

?屬性????????????大小?????日期????時(shí)間???名稱
-----------?---------??----------?-----??----
?????目錄???????????0??2014-08-11?09:33??GM-PHDsmooth\
?????文件????????8168??2012-06-10?17:08??GM-PHDsmooth\demo.m
?????文件?????????298??2008-04-30?22:25??GM-PHDsmooth\ESTIMATE.m
?????文件?????????395??2008-05-04?13:48??GM-PHDsmooth\GENRANDN.m
?????文件?????????578??2008-05-11?22:00??GM-PHDsmooth\HDISTANCE.m
?????文件????????2206??2011-07-15?09:15??GM-PHDsmooth\Hungary.m
?????文件?????????249??2008-10-09?16:20??GM-PHDsmooth\IsInMatrix.m
?????文件????????1222??2008-05-09?10:18??GM-PHDsmooth\MEASUREMENT.m
?????文件?????????437??2010-07-22?08:47??GM-PHDsmooth\Normp.m
?????文件?????????163??2011-07-15?09:10??GM-PHDsmooth\OSPA.m
?????文件?????????459??2008-05-05?10:56??GM-PHDsmooth\PREDIC.m
?????文件?????????394??2008-05-05?11:15??GM-PHDsmooth\PREDIC_S.m
?????文件????????2028??2012-06-01?15:02??GM-PHDsmooth\PRUN_MERG.m
?????文件????????1388??2012-06-08?15:31??GM-PHDsmooth\smoothing.m
?????文件????????1535??2012-06-08?19:56??GM-PHDsmooth\TARGET_FORM.m
?????文件????????1645??2008-10-09?16:19??GM-PHDsmooth\TryAssign.m
?????文件?????????833??2008-05-30?09:11??GM-PHDsmooth\UPDATA.m
?????文件?????????582??2008-05-11?21:59??GM-PHDsmooth\WDISTANCE.m
?????文件?????????603??2008-10-09?16:15??GM-PHDsmooth\ZeroCover.m
?????文件?????????123??2008-10-09?16:13??GM-PHDsmooth\ZeroNumber.m