-
大小: 2KB文件類型: .zip金幣: 1下載: 0 次發(fā)布日期: 2021-01-06
- 語言: 其他
- 標簽:
資源簡介
經(jīng)典比例導引法,二維,詳細注釋每一行代碼,適合比例導引法的入門學習經(jīng)典比例導引法,二維,詳細注釋每一行代碼,適合比例導引法的入門學習
代碼片段和文件信息
clear?all;
close?all;
clc;
Time=0;
TimeStep=0.005;?%仿真步長
%-------初始化制導系統(tǒng)參數(shù)---------
pi=3.141592653;
g=9.8;
Ma=340;
%---------導彈參數(shù)--------------
Rmx=50;Rmy=0;?%導彈初始位置
Vm=-3.24*Time^3+41.7*Time^2-248*Time+888;?%導彈速度(m/s)
AmMay=500*g;?%導彈最大機動能力
HeadError=-0.001;?%指向角誤差
%-------目標參數(shù)------------
Rt=6000;??%目標初始距離(彈目斜距)
ThetaT=pi+8/180*pi;?%目標速度方向
Rtx=Rt*cos(8/180*pi);?%目標初始X軸位置
Rty=Rt*sin(8/180*pi);?%目標初始Y軸位置
Vt=5*Ma;?%目標速度(m/s)
AtMay=0*g;?%目標機動能力
%--------導彈和目標幾何運動學結(jié)算--------
Rtmx=Rtx-Rmx;?%彈目在X軸方向的相對距離
Rtmy=Rty-Rmy;?%彈目在Y軸方向的相對距離
Rtm=sqrt(Rtmx^2+Rtmy^2);?%計算彈目相對距離
SightAngle=atan(Rtmy/Rtmx);?%視線角
LeadAngle=asin(Vt*sin(SightAngle-ThetaT)/Vm);?%指向角
Vmx=Vm*cos(SightAngle-LeadAngle+HeadError);?%導彈沿X軸方向的速度分量
Vmy=Vm*sin(SightAngle-LeadAngle+HeadError);?%導彈沿Y軸方向的速度分
?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????文件????????4210??2020-04-20?11:55??經(jīng)典比例導引法.m
評論
共有 條評論