trajectory.m

仿真 三点法 matlab 数值仿真 机动目标弹道仿真

clear;
global y;
global AMa;
global Aa;
global ACX;
global ACY;
global AP;
global APT;
global AXG;
global AXGT;
global AMZWZ1;
global AMZWZ2;
global AMZAF;
global AJZ;
global AJZT;

load -ascii ACX.txt;    %读入数据
load -ascii ACY.txt;
load -ascii AP.txt;
load -ascii APT.txt;
load -ascii AJZ.txt;
load -ascii AJZT.txt;
load -ascii AXG.txt;
load -ascii AXGT.txt;
load -ascii Aa.txt;
load -ascii AMa.txt;
load -ascii AMZAF.txt;
load -ascii AMZWZ1.txt;
load -ascii AMZWZ2.txt;

AE=0.01745329;   		%角度化弧度
h=0.01;
g=9.81;
%fo1=fopen('result.dat','wt');
%fprintf(fo1,'y1         y2         y3         y4         y5         y6         y7        y8       y9      y10      y11      x     y      xt     yt \n');
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%赋初值\
xm=0;
ym=0;

thetat=0*AE;
at=10*g;
vt=100;
vty=vt*cos(thetat);
vtx=vt*sin(thetat);
rtx=200;
rty=200;
qt=atan(rtx/rty); 
y(1)=100.0;				           %初速
y(2)=80*AE;                        %初始弹道倾角
y(3)=0;				           %初始转速
y(4)=80*AE;                           %初始俯仰角
y(5)=xm;				           %初始x坐标
y(6)=ym;				           %初始y坐标
y(7)=52.38;	           %起飞质量
y(8)=0;                         %初始时间
y(9)=sqrt(xm^2+ym^2);                           %Rm
y(10)=sqrt(rtx^2+rty^2);                        %Rt
qm=atan(ym/xm);                      %Qm
                   
time=0;timestep=h;
%fprintf(fo1,'%10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f\n',...
 %            y(1),y(2)*57.3,y(3),y(4)*57.3,y(5),y(6),y(7),y(8),y(9),y(10),y(11)*AE,y(9)*cos(y(11)),y(9)*sin(y(11)),y(10)*cos(y(11)),y(10)*sin(y(11)));

while y(10)-y(9)>=4
    
    rk(8,h);
    rtx=rtx+timestep*vtx;
    rty=rty+timestep*vty;
    dthetat=at/vt;
    thetat=thetat+timestep*dthetat;
    vtx=vt*sin(thetat);%目标的速度分量
    vty=vt*cos(thetat);   
    y(10)=sqrt(rtx^2+rty^2);
    y(6)=rtx*y(5)/rty;
    y(9)=sqrt(y(5)^2+y(6)^2);

 %   fprintf(fo1,'%10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f %10.10f\n',y(1),y(2)*57.3,y(3),y(4)*57.3,y(5),y(6),y(7),y(8),y(9),y(10),y(11)*AE,y(12),y(13),y(14),y(15));
    figure(1);plot(y(5),y(6),'r',rty,rtx,'b'),hold on,
    %figure(2);plot(y(8),y(1)),hold on,
    %figure(4);plot(y(8),(y(4)-y(2))*57.3),hold on, %攻角
    %figure(5);plot(y(8),y(4)*57.3),hold on,%弹道倾角
    
end
grid on;
%hold on,grid on,%legend('无控','有空导弹','目标'),

%fclose(fo1);