construct.m

ekf在无源导航中的应用

function YY=construct(REAL,C)
BB=atan(REAL(1)/REAL(2));%-atan(RE(1)/RE(2));RE,
VB=(REAL(3)*REAL(2)-REAL(4)*REAL(1))/(REAL(1)^2+REAL(2)^2);%-(RE(3)*RE(2)-RE(4)*RE(1))/(RE(1)^2*RE(2)^2);
BB1=sample_gaussian(BB,C(1,1),100);
VB1=sample_gaussian(VB,C(2,2),100);
YY=[BB1';VB1'];
%plot(YY(1,:));
%hold on;
%plot(YY(2,:),'r');