精选优质文档-倾情为你奉上%三维制导模型,比例导引法求解%源代码作者不详,注释人:lylogn%Modified by lylogn,2012年4月17日clear all;close all;clcdt=0.1;%仿真时间步长alpha=pi/6;v_t=0.42;s_t=v_t*dt;%目标以0.42的速度沿alpha的角方向匀速飞行,s_t为目标在单位仿真步长前进的距离v_m=0.60;s_m=v_m*dt;%s_m为导弹在单位仿真步长沿目前速度方向前进的距离x(1)=0;y(1)=1.0;z(1)=0;pmr(:,1)=x(1);y(1);z(1);%导弹初始位置,在坐标原点ptr(:,1)=25;5;7;%目标初始位置K=3;%比例导引系数q(1)=0;%初始的视线角,设定参考线为t和m初始位置的连线o(1)=0;%初始导弹速度向量方向角a(1)=0;%初始导弹相对目标的运动速度向量的方向角for(k=2:600)ptr(:,k)=ptr(1,1)-v_t*cos(al