Ap=0.0123;
Kx=2.5;
Kp=4.2*10^(-11);
Ctp=0;
Vt=0.0014;
betae=6.89*10^6;
tao=0.01;
Kv=0.0239;
ms=12487;
muf=706;
mur=1000;
m=14193;
h=1.15;
huf=0.53;
hur=0.53;
Cf=582*10^3;
Cr=783*10^3;
bf=10^5;
br=10^5;
ktf=2060*10^3;
ktr=3337*10^3;
kf=380*10^3;
kr=684*10^3;
kAOf=10730;
kAOr=15480;
Ixx=24201;
Ixz=4200;
Izz=34917;
Iw=0.93;
lf=1.95;
lr=1.54;
r=0.83;
mu=1;
v=19.4;
g=9.8;
lact=0.8;
tao=3.14;
Ybeta=-mu*(Cf+Cr);
Ypsi=-mu*(Cf*lf-Cr*lr)/v;
Ydeta=mu*Cf;
Nbeta=-mu*(Cf*lf-Cr*lr);
Npsi=-mu*(Cf*lf^2+Cr*lr^2)/v;
Ndeta=mu*Cf*lf;
Ybetaf=-mu*Cf;
Ypsif=-mu*Cf*lf/v;
Mkf=muf*g*huf-kf-ktf;
Ybetar=-mu*Cr;
Ypsir=mu*Cr*lr;
Mkr=-(mur*g*hur+ktr+kr);
E0=[m*v,0,0,-ms*h,0,0,0,0,0,0;
0,Izz,0,-Ixz,0,0,0,0,0,0;
-(ms+m)*v*h,-Ixz,0,Ixx+ms*h^2,-bf,-br,0,0,0,0;
muf*v*(r-huf),0,0,0,-bf,0,0,0,0,0;
mur*v*(r-hur),0,0,0,0,-br,0,0,0,0;
0,0,1,0,0,0,0,0,0,0;
0,0,0,0,-Ap*lact,0,-Vt/(4*betae),0,0,0;
0,0,0,0,0,0,0,1,0,0;
0,0,0,0,0,-Ap*lact,0,0,-Vt/(4*betae),0;
0,0,0,0,0,0,0,0,0,1];
A0=[Ybeta,Ypsi-m*v,0,0,0,0,0,0,0,0;
Nbeta,Npsi,0,0,0,0,0,0,0,0;
0,(ms+m)*v*h,ms*g*h-kf-kr,-(bf+br),kf,kr,2*Ap*lact,0,2*Ap*lact,0;
-r*Ybetaf,-muf*v*(r-huf)-r*Ypsif,-kf,-bf,-Mkf,0,-2*Ap*lact,0,0,0;
-r*Ybetar,-muf*v*(r-hur)-r*Ypsir,-kr,-br,0,-Mkr,0,0,-2*Ap*lact,0;
0,0,0,1,0,0,0,0,0,0;
0,0,0,Ap*lact,0,0,Kp+Ctp,Kx,0,0;
0,0,0,0,0,0,0,-1/tao,0,0;
0,0,0,Ap*lact,0,0,0,0,Kp+Ctp,-Kx;
0,0,0,0,0,0,0,0,0,-1/tao];
E=inv(E0);
A=E*A0;
B01=[Ydeta;Ndeta;0;r*Ydeta;0;0;0;0;0;0];
B02=[0,0;0,0;0,0;0,0;0,0;0,0;0,0;Kv/tao,0;0,0;0,Kv/tao];
B1=E*B01;
B2=E*B02;
B=[B1 B2];
C=eye(10);
D=0
评论7