航迹.txt

用matlab仿真

产生真实运动轨迹的程序如下：



%********************产生真实轨迹************************

sx=zeros(1,N4);%目标实际x位置
sy=zeros(1,N4);
svx=zeros(1,N4);%目标实际x方向速度
svy=zeros(1,N4);
sax=zeros(1,N4);%目标实际x方向加速度
say=zeros(1,N4);
sx(1)=100;%初始x位置
sy(1)=3000;%初始y位置
v0=426;%初始速度m/s
b=pi/4;%目标初始航向角
svx(1)=v0*cos(b);%初始x速度
svy(1)==v0*sin(b);%初始y速度
sax=0;%初始x加速度
say=0;%初始y加速度
a0=20;%初始加速度m/s^2

%旋转半径
Rr=3000;%m
for i=1:N4

if (i<=N1)

sx(i+1)=sx(i)+svx(i)*T;
sy(i+1)=sy(i)+svy(i)*T;
svx(i+1)=v0*cos(b);
svy(i+1)=v0*sin(b);
sax(i+1)=0;
say(i+1)=0; 
elseif (i>N1&i<=N2)


sx(i+1)=sx(i)+svx(i)*T+0.5*a0*cos(b)*T*T;
sy(i+1)=sy(i)+svy(i)*T+0.5*a0*sin(b)*T*T;
svx(i+1)=svx(i)+a0*cos(b)*T;
svy(i+1)=svy(i)+a0*sin(b)*T; 
sax(i+1)=a0*cos(b);
say(i+1)=a0*sin(b);

elseif (i>N2&i<N3)
vy=(svx(N2+1)^2+(N2+1)^2)^0.5;
a1=vy^2/Rr;
bb=a1/vy*T;
xx=Rr*(sin(b+bb)-sin(b));
yy=Rr*(cos(b)-cos(b+bb));
b=b+bb;
sx(i+1)=sx(i)+xx;
sy(i+1)=sy(i)+yy;
svx(i+1)=vy*cos(bb)+sax(i)*cos(bb)*T;
svy(i+1)=vy*sin(bb)+say(i)*sin(bb)*T;;
sax(i+1)=-a1*sin(bb);
say(i+1)=a1*cos(bb);

else
a1=vy^2/Rr;
bb=a1/vy*T;
xx=Rr*(sin(b-bb)-sin(b));
yy=Rr*(cos(b)-cos(b-bb));
b=b-bb;
sx(i+1)=sx(i)-xx;
sy(i+1)=sy(i)-yy;
svx(i+1)=vy*cos(b);
svy(i+1)=vy*sin(b);
sax(i+1)=a1*sin(b);
say(i+1)=a1*cos(b);

end

end