clear
%作勻加速運(yùn)動(dòng)的空中目標(biāo)的航跡示意圖：該模型可以表示空中目標(biāo)的直線運(yùn)動(dòng)、俯沖、上仰或者陸地目標(biāo)的上下坡運(yùn)動(dòng)
a0=19;
C=51329;
x1(1)=47169; 
M=2^16;  
for i=1:5999
	  x1(i+1)=mod(x1(i)*a0+C,M);
end
for i=1:6000
	  fakerand(i)=x1(i)/M;
end
for i=1:500
	  normrnd1(i)=0;
	  for j=(12*(i-1)+1):(12*i)
		  normrnd1(i)=normrnd1(i)+fakerand(j);
      end
	  normrnd1(i)=normrnd1(i)-6;
end
x0=3000;
y0=4000;
z0=4000;
v=-200;
Q1=120;Q2=160;Q3=140;
q=pi/2;
b=pi/3;
vx=v*cos(q)*sin(b);
vy=v*cos(q)*cos(b);
vz=v*sin(q);
ax=100;
ay=10;
t0=2;
t=[1:500]+t0;
for i=1:50
    x(i)=x0+vx*(t(i)-t0)+1/2*ax*(t(i)-t0)^2+Q1*normrnd1(i);
    y(i)=y0+vy*(t(i)-t0)+1/2*ay*(t(i)-t0)^2+Q2*normrnd1(i);
    z(i)=z0+vz*(t(i)-t0)+Q3*normrnd1(i);
end
for i=1:50
    X(i)=x0+vx*(t(i)-t0)+1/2*ax*(t(i)-t0)^2;
    Y(i)=y0+vy*(t(i)-t0)+1/2*ay*(t(i)-t0)^2;
    Z(i)=z0+vz*(t(i)-t0);
end
plot3(x0,y0,z0,'r^',[x0 x],[y0 y],[z0 z],'b.',[x0 X],[y0 Y],[z0 Z],'r-')
hold on
legend('起始點(diǎn)','方差為Q1=120;Q2=160;Q3=140的觀測(cè)曲線','理論曲線');
title('三維復(fù)合運(yùn)動(dòng)的軌跡');
xlabel('X坐標(biāo)軸');
ylabel('Y坐標(biāo)軸');
zlabel('Z坐標(biāo)軸');
grid on