close?all;clear;clc
tspan=（0:0.01:55）	;???????%t區(qū)間、步長
[ty]=ode45（@fun05tspan[260?0?0?7100?225?0?500]）;??%45龍格算法積分參數(shù)
%選取特征點，求動力學(xué)系數(shù)和傳遞函數(shù)
i=find（t==6）????%t在矩陣中位置????0?6??20??34.55?V最大

ma0=[0.60.80.91.01.2];???????????????????????????????
Cx00=[-0.2000-0.2210-0.2315-0.2420-0.2500];
Cxa20=[-0.0005-0.0005-0.0005-0.0005-0.0005];
Cya0=[0.25050.2530.2540.2550.256];
Cydetaz0=[0.040.0470.0430.0450.045];
mza0=[-0.0290-0.0298-0.0300-0.0302-0.0302];
mzdetaz0=[-0.0220-0.0240-0.0232-0.0230-0.0234];
mzwz0=[-0.002-0.0015-0.0015-0.0012-0.0016];
%空軍標(biāo)準(zhǔn)氣象條件
cc=20.046*（288.34-5.86*10^（-3）*y（i4））^0.5;???????????????%聲速
ma=y（i1）/cc;?????????????????????????????????????????????%馬赫數(shù)
g=9.806*（1.0-2*y（i4）/6371000）;??????????????????????????????%重力加速度
pp=1.225*（1.0-2.0323*10^（-5）*y（i4））^4.83;??????????????????%密度
q=?0.5*pp*y（i1）*y（i1）;?????????????????????????????????????%動壓
%三次樣條插值求各系數(shù)
Cx0=interp1（ma0Cx00ma‘spline‘）;
Cxalpha2=interp1（ma0Cxa20ma‘spline‘）;
Cyalpha=interp1（ma0Cya0ma‘spline‘）;
Cydetaz=interp1（ma0Cydetaz0ma‘spline‘）;
Czbeita=-Cyalpha;
mza=interp1（ma0mza0ma‘spline‘）;
mzdetaz=interp1（ma0mzdetaz0ma‘spline‘）;
mzwz=interp1（ma0mzwz0ma‘spline‘）;

L=2.358;?????%彈長
Jz=60.85;????%轉(zhuǎn)動慣量
S=0.456;????????????????????????%彈翼特征面積
P=3000;?????????????????????????%推力為3000
Xt=12000;Yt=0;Zt=0;????%目標(biāo)位置
K=4;
cita=y（i2）;
v=y（i1）;
h=y（i4）;
if?i??alpha=5*sin（0.2*pi*t+pi）-y（i2）*57.3??;???????????????????%攻角??
elseif?i??alpha=（y（i5）*g）/（P/57.3+（Cyalpha）*q*S）;??????????????????%攻角
else?????????????%末端攻擊段
??r=（（y（i4）-Yt）^2+（y（i3）-Xt）^2）;
??dq=y（i1）*（（y（i3）-Xt）*sin（y（i2））-（y（i4）-Yt）*cos（y（i2）））/r;?????%dq/dt??y
?alpha=（y（i5）*y（i1）*K*dq+y（i5）*g*cos（y（i2）））/（P/57.3+（Cyalpha）*q*S）;
end
m=y（i5）;
detaz=-mza/mzdetaz*alpha;

%計算各參數(shù)的偏導(dǎo)數(shù)
Xv=pp*v*S*（Cx0+Cxalpha2*alpha*alpha）;
Xa=2*Cxalpha2*alpha*q*S;
Mzwz=mzwz*q*S*L*L/v;
Mza=mza*q*S*L;
?Mzdetaz=mzdetaz*q*S*L;
?Yv=v*pp*S*（Cyalpha*alpha+Cydetaz*detaz）;
?Ya=Cyalpha*q*S;
?Ydetaz=Cydetaz*q*S;

%特征點各動力系數(shù)，忽略下洗延遲
A11=-Xv/m;A12=0;A13=-g*cos（cita）;A14=-（Xa+P*alpha）/m;A15=0;A16=1/m;
A21=0;A22=Mzwz/Jz;A23=0;A24=Mza/Jz;A25=Mzdetaz/Jz;
A31=Yv/m/v;A32=0;A33=g*sin（cita）/v;A34=（Ya+P）/m/v;A35=Ydetaz/m/v;A36=1/m/v;

%動力系數(shù)
a1=-A22
a2=-A24
a3=-A25
a4=A34
a5=A35
%計算彈體傳遞系數(shù)
Km=（-A25*A34+A35*A24）/（A22*A34+A24）?????%Km
Tm=1/sqrt（-A24-A22*A34）?????????????????%Tm?????????????????????????
Em=（-A22+A34）/sqrt（-A24-A22*A34）/2??????%ξm?
T1=A25/（A25*A34-A35*A24）????????????????%T1??

Wdz_jieta=tf（Km*[T1?1][Tm^2?2*Tm*Em?1?0]）;??%俯仰角對舵偏的傳遞函數(shù)

Kwz=-0.35;Kp=8;Ki=4;????????????????%設(shè)計的參數(shù)
%Kwz=-0.08;Kp=20;Ki=4;???????
G=tf（1[0.01?1]）;???????????????????%舵機一階慣性環(huán)節(jié)
G_Kwz=tf（Kwz*Km*[T1?1][Tm^2?2*Tm*Em?1]）????
figure（‘numbertitle‘‘off‘‘name‘‘內(nèi)環(huán)伯德圖‘）
margin（series（G_KwzG））;grid?on;??????????????????????%內(nèi)環(huán)伯德圖
figure（‘numbertitle‘‘off‘‘name‘‘內(nèi)環(huán)閉環(huán)傳遞函數(shù)階躍響應(yīng)‘）
step（feedbac

?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----

?????文件???????3679??2016-06-21?21:29??913108320128張昊\Bode01.m

?????文件???????1378??2016-06-21?20:37??913108320128張昊\dandao01.m

?????文件???????3558??2016-06-21?20:21??913108320128張昊\fun05.m

????I.A.SH.????311296??2016-06-21?21:30??913108320128張昊\Thumbs.db

?????文件?????391401??2016-06-21?22:08??913108320128張昊\【91310820128張昊】彈箭飛行控制原理.docx

?????目錄??????????0??2016-06-21?22:12??913108320128張昊

?????文件?????676232??2016-06-21?22:12??913108320128張昊\【91310820128張昊】彈箭飛行控制原理.pdf

-----------?---------??----------?-----??----

??????????????1387544????????????????????7