esob.m

可以用于无源定位跟踪的好程序－－粒子滤波和其他滤波的很多方法

function YYr=esob(x1,x2)
RE=x1-x2;
BB=0;
VB=0;
BB=atan(RE(1)/RE(2));%-atan(RE(1)/RE(2));RE,
VB=(RE(3)*RE(2)-RE(4)*RE(1))/(RE(1)^2+RE(2)^2);%-(RE(3)*RE(2)-RE(4)*RE(1))/(RE(1)^2*RE(2)^2);
%BB1=gauss(BB,C(1),100);
%VB1=gauss(VB,C(2),100);
YYr=[BB;VB];