sanfuhe.m

目标运动模型

clear
%作匀加速运动的空中目标的航迹示意图：该模型可以表示空中目标的直线运动、俯冲、上仰或者陆地目标的上下坡运动
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('起始点','方差为Q1=120;Q2=160;Q3=140的观测曲线','理论曲线');
title('三维复合运动的轨迹');
xlabel('X坐标轴');
ylabel('Y坐标轴');
zlabel('Z坐标轴');
grid on