movement.rar_Movement_迎头 尾后_雷达目标机动仿真

clear; close all; DL1=70e3; %起始段纵向距离 DT1=10e3; %起始段横向距离 DF=5e3; %起始段目标直行距离 VT=300; %目标线速度，匀速圆周运动 VM=1000; %弹速 T=20e-3; %通讯周期20ms g=9.8; %重力加速度 a1=8*g; %小转弯向心加速度 a2=4*g; %大转弯向心加速度 r=VT^2/a1; %小转弯半径 R=VT^2/a2; %大转弯半径 ts=(pi*(R+r)+DF)/VT; %总交汇时间 Dr=DL1-VM*ts-2*(R+r)-DF;%交汇结束后纵向距离 if Dr<=0 disp('请重新设置路径参数') error('交汇结束后目标进入弹后方'); end %%%%1st section%%%% t1=DF/VT; %运动时间 t1=t1-mod(t1,T); t=0:T:t1; t11=length(t); DL1t=DL1-(VM+VT)*t; %纵向距离 DT1t=DT1; %横向距离 D1=sqrt(DL1t.^2+DT1t.^2); %径向距离 V1=(VM+VT)*(DL1t./D1); %径向速度 %%%%2nd section%%%% t2=pi*r/2/VT; %运动时间 t=0:T:t2; DL2=DL1t(t11); %初始纵向距离 DT2=DT1t; %初始横向距离 DL2t=DL2-VM*t-r*sin(VT/r*t); %纵向距离 DT2t=DT2+r*(1-cos(VT/r*t)); %横向距离 D2=sqrt(DL2t.^2+DT2t.^2); %径向距离 V2=VM*(DL2t./D2)+VT*cos(atan(DT2t./DL2t)+VT/r*t); %径向速度 %%%%3rd section%%%% t3=pi*R/VT; %运动时间 t=0:T:t3; DL3=DL2-VM*t2-r; %初始纵向距离 DT3=DT2+r; %初始横向距离 DL3t=DL3-VM*t-R*(1-cos(VT/R*t)); %纵向距离 DT3t=DT3+R*sin(VT/R*t); %横向距离 D3=sqrt(DL3t.^2+DT3t.^2); %径向距离 V3=VM*(DL3t./D3)-VT*cos(atan(DL3t./DT3t)+VT/R*t); %径向速度 %%%%4th section%%%% t4=pi*r/2/VT; %运动时间 t=0:T:t4; DL4=DL3-VM*t3-2*R; %初始纵向距离 DT4=DT3; %初始横向距离 DL4t=DL4-VM*t-r*(1-cos(VT/r*t)); %纵向距离 DT4t=DT4-r*sin(VT/r*t); %横向距离 D4=sqrt(DL4t.^2+DT4t.^2); %径向距离 V4=VM*(DL4t./D4)+VT*cos(atan(DL4t./DT4t)-VT/r*t); %径向速度 %%%%combination%%%% D=[D1,D2,D3,D4]; V=[V1,V2,V3,V4]; DL=[DL1t,DL2t,DL3t,DL4t]; Vp=VM*DL./D; figure plot(D/1000); xlabel('帧数');ylabel('距离(km)') title('径向距离'); figure plot(V,'r'); hold on plot(Vp); xlabel('帧数');ylabel('速度(m/s)') title('径向速度');