比例导引法

正好研究学习了比例导引法，现在将自己的一些心得体会用文件形式传播给大家，交流交流。

function ydot=bili（ty）
% y（1）=theta  y（2）=V  y（3）=x  y（4）=y y（5）=xm  y（6）=ym  y（7）=m
T=288.15-0.0065*y（4）;%温度与高度的关系，用于算当地音速
gamma=1.4;
r=287;
a=sqrt（T*r*gamma）;%当地音速
Re=6370000;%地球半径
g=9.8*（Re/（Re+y（4）））^2;%当地重力加速度
rho=1.225*exp（-0.00015*y（4））;%当地空气密度
s=1.94;       %机翼面积
M=y（2）/a;%马赫数
Vm=-300;%目标速度
K=3;%比例系数
e=180/pi;
q=atan（（y（6）-y（4））/（y（5）-y（3）））;
eta=q*e-y（1）;
R=（y（6）-y（4））/sin（q）;
%导弹推力，质量与时间的关系
t1=2.79;t2=t1+40.82;
dotm=219.45*（t<=t1）+7.42*（t>t1&tp=40159*g*（t<=t1）+5135.94*g*（t>t1&t%升阻力系数的拟合
Mi=[1.52.02.53.03.54.04.5]; %给出的马赫数据
Clai=[0.03370.03240.0300.0240.0250.02330.0244]; %给出的数据 
Cla=interp1（MiClaiM‘spline‘）;%线性插值求升力线斜率
alpha=（K*y（7）*y（2）*（y（2）*sin（eta/e）-Vm*sin（q））/R+y（7）*g*cos（y（1）/e））/（0.5*rho*y（2）^2*s*Cla+p/e）;%求攻角
alphai=0:2:8;            %给出的数据
Mi2=[1.52.02.53.03.54.0];   %给出的数据
Cxi=[0.0430.0460.0540.0670.084;0.0370.03950.0470.05850.0745;0.03170.03350.0400.05050.0645;...
    0.0270.0290.0340.04350.056;0.0230.0250.02950.0370.0485;0.02050.02250.0260.03250.042];
Cx=interp2（alphaiMi2CxialphaM‘spline‘）; %线性插值求阻力系数
%微分方程组
% y（1）=theta  y（2）=V  y（3）=x  y（4）=y y（5）=xm  y（6）=ym  y（7）=m
ydot=[（p*alpha/57.3+0.5*rho*y（2）^2*s*Cla*alpha-y（7）*g*cos（y（1）/e））/（y（7）*y（2））;...
      p*cos（alpha/e）/y（7）-0.5*rho*y（2）*y（2）*Cx*s/y（7）-g*sin（y（1）/e）;...
      y（2）*cos（y（1）/e）;...
      y（2）*sin（y（1）/e）;...
      Vm;...
      0;...
      -dotm];

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----

     文件       1604  2018-11-30 21:01  比例导引法1\bili.m

     文件        181  2018-11-30 21:02  比例导引法1\bilievents.m

     文件        438  2018-11-30 21:02  比例导引法1\zhu.m

     文件       2426  2018-12-02 22:07  比例导引法1\三个全部集合在这个文件运行时请点击zhu其他为函数文件.m

     目录          0  2018-12-02 22:08  比例导引法1

----------- ---------  ---------- -----  ----

                 4649                    5