三维比例导引Matlab仿真程序

针对动目标的三维比例导引，给出质点三自由度仿真程序。
如果是初学比例导引，可以参考一下。特别是如何确定比例导引参数的计算方法，以及相关坐标系的应用及转换关系，都可以有一些启发。
如果要进行之后的控制律仿真的话，则需要针对特定动力学模型的飞行器才能进行。

clc
clear
close all
d2r=pi/180;
p0=[0;1000;0];
v0=[40;0;0];%弹道系速度
pt0=[1000;0;2000];
vt0=[20;-10;5];

theta0=30*d2r;
psiv0=60*d2r;
sinpv=sin（psiv0）;cospv=cos（psiv0）;
sinth=sin（theta0）;costh=cos（theta0）;
Cd2g0=[costh*cospv -sinth*cospv sinpv;sinth costh 0;-costh*sinpv sinth*sinpv cospv];
vxyz0=Cd2g0*v0;

X0=[p0‘ theta0 psiv0 pt0‘];

g0=9.80665;
r2d=180/pi;
threshehold=0.5;

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     文件       27156  2019-11-18 20:45  制导律研究\guidance.slx
     文件         405  2019-07-23 21:04  制导律研究\initial.m
     文件         575  2019-07-24 22:02  制导律研究\plotcurve.m
     目录           0  2019-11-18 20:46  制导律研究\