程序有点麻烦,先谢谢大家耐心读完
function fun2()
global FX FY FZ G JX JY JZ MX MY MZ
pitch_g=3; roll_g=2;
M=0.6 ;
HH=9000;
S = 8.55 ;
BA = 1.14 ;
L = 7.50 ;
G=2060.00;
Y1=M - ( .54000 ) ;
Y2=HH - ( 8.00000 );
P = -1.7448e+011;
Y12=M - ( .62500 );
XX=M - ( .50000 );
YY=HH - ( 9.00000 );
DTCX = 3.5253e+005;
CYB =0.0046;
CZB = -1.2033 / 57.3;
CZH = -0.26358 / 57.3;
FZ= -0.0256;
MXB =-0.1345;
MXW =-0.5439;
MXY0 =-0.1368;
MXY1 =-0.0180;
MXH = -0.031515 / 57.3;
MXA = -0.192528 / 57.3;
MYB = -0.1094;
MYW =-0.2364;
MYX0 = -0.0599;
MYX1 = 0.0140;
MYH = -0.11746 / 57.3;
MZB =-0.0140;
MZW = -6.6500;
MZAF =-1.9881;
Y14= -0.0250;
JX=180.4400;
JY= 465.9900;
JZ=429.1630;
% 未知数为15个,设定初始值
x0=[100,100,100,2,2,3,173.2,1,1,0,0,0,30,30,30]; % v_x= 100; v_y=100 ; v_z=100; pitch=2;roll=2;yaw=3; v=173; AF=2;B=1;X=0;Y=