function?ParticleEx1

%?Particle?filter?example?adapted?from?Gordon?Salmond?and?Smith?paper.

x?=?0.1;?%?initial?state
Q?=?1;?%?process?noise?covariance
R?=?1;?%?measurement?noise?covariance
tf?=?50;?%?simulation?length

N?=?100;?%?number?of?particles?in?the?particle?filter

xhat?=?x;
P?=?2;
xhatPart?=?x;

%?Initialize?the?particle?filter.
for?i?=?1?:?N
????xpart（i）?=?x?+?sqrt（P）?*?randn;
end

xArr?=?[x];
yArr?=?[x^2?/?20?+?sqrt（R）?*?randn];
xhatArr?=?[x];
PArr?=?[P];
xhatPartArr?=?[xhatPart];

close?all;

for?k?=?1?:?tf
????%?System?simulation
????x?=?0.5?*?x?+?25?*?x?/?（1?+?x^2）?+?8?*?cos（1.2*（k-1））?+?sqrt（Q）?*?randn;%狀態(tài)方程
????y?=?x^2?/?20?+?sqrt（R）?*?randn;%觀測方程
????%?Extended?Kalman?filter
????F?=?0.5?+?25?*?（1?-?xhat^2）?/?（1?+?xhat^2）^2;
????P?=?F?

?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????目錄???????????0??2011-03-22?09:46??PF\
?????文件???????38400??2011-03-22?09:43??PF\粒子濾波.doc
?????目錄???????????0??2011-03-22?09:46??PF\粒子濾波5種類型\
?????目錄???????????0??2011-03-22?09:46??PF\粒子濾波5種類型\粒子濾波5種類型\
?????文件????????3636??2007-01-14?17:09??PF\粒子濾波5種類型\粒子濾波5種類型\ParticleEx1.m
?????文件????????5815??2007-01-14?18:35??PF\粒子濾波5種類型\粒子濾波5種類型\ParticleEx2.m
?????文件????????6115??2007-01-11?12:19??PF\粒子濾波5種類型\粒子濾波5種類型\ParticleEx3.m
?????文件????????7676??2007-01-11?12:19??PF\粒子濾波5種類型\粒子濾波5種類型\ParticleEx4.m
?????文件????????7992??2007-01-11?12:19??PF\粒子濾波5種類型\粒子濾波5種類型\ParticleEx5.m