airfunco.m

来自「数学建模中的飞行管理问题的matlab程序,分了三个m文件」· M 代码 · 共 24 行

function [c,ceq]=airfunco(delta)
x0=[150 85 150 145 130 0];
 y0=[140 85 155 50 150 0];
 v=800;
alpha0=[243 236 220.5 159 230 52]*pi/180;
co=cos(alpha0+delta);
si=sin(alpha0+delta);
for i=2:6
     for j=1:(i-1)
         t(i,j)=(x0(i)-x0(j))*(co(i)-co(j));
         t(i,j)=t(i,j)+(y0(i)-y0(j))*(si(i)-si(j));
         t(i,j)=-t(i,j)/v;
         t(i,j)=t(i,j)/((co(i)-co(j))^2+(si(i)-si(j))^2);
         if t(i,j)<0,
             d(i,j)=1000;
         else, 
             d(i,j)=(x0(i)-x0(j)+v*t(i,j)*(co(i)-co(j)))^2;
             d(i,j)=(y0(i)-y0(j)+v*t(i,j)*(si(i)-si(j)))^2+d(i,j);
         end
     end
 end
 c=64-[d(2,1),d(3,1:2),d(4,1:3),d(5,1:4),d(6,1:5)];
 ceq=[];