param.m

A=[-0.0153803,0.0439192,-7.83906,-9.80253,0,0,0,0,0;...
    -0.0438131,-0.12042,20.3051,-0.378441,0,0,0,0,0;...
    0.00123923,-0.022159,-0.403074,0,0,0,0,0,0;...
    0,0,1.0,0,0,0,0,0,0;...
    0,0,0,0,-0.456379,7.83906,-203.051,9.80253,0;...
    0,0,0,0,-0.137907,-2.99727,2.13345,0,0;...
    0,0,0,0,0.0863470,0.0124572,-0.735554,0,0;...
    0,0,0,0,0,1,0.0386064,0,0;...
    0,0,0,0,0,0,1.00074,0,0];
% A=[-0.0153803,0.0439192,-7.83906,-9.80253,0,0,0,0,0;...
%     -0.0438131,0.012042,203.051,-0.378441,0,0,0,0,0;...
%     0.00123923,-0.0022159,-0.403074,0,0,0,0,0,0;...
%     0,0,1.0,0,0,0,0,0,0;...
%     0,0,0,0,-0.456379,7.83906,-203.051,9.80253,0;...
%     0,0,0,0,-0.137907,-2.99727,2.13345,0,0;...
%     0,0,0,0,0.0863470,0.0124572,-0.735554,0,0;...
%     0,0,0,0,0,1,0.0386064,0,0;...
%     0,0,0,0,0,0,1.00074,0,0];

% B=[2.07005,0,0,9.57054;...
%     -88.0560,0,0,0;...
%     -20.5780,0,0,-0.143558;...
%     0,0,0,0;...
%     0,12.2129,14.4466,0;...
%     0,-84.7711,15.1058,0;...
%     0,-3.25531,-6.83654,0;...
%     0,0,0,0;...
%     0,0,0,0];
B=[2.07005,0,0,9.57054;...
    -8.0560,0,0,0;...
    -20.5780,0,0,-0.143558;...
    0,0,0,0;...
    0,12.2129,14.4466,0;...
    0,-84.7711,15.1058,0;...
    0,-3.25531,-6.83654,0;...
    0,0,0,0;...
    0,0,0,0];


C=[-0.0498445,-1.35067,4.39526,0,0,0,0,0,0;...
    0,0,0,0,-0.0959802,-1.24018,-2.65403,0,0;...
    -0.189849e-3,0.00491755,0,0,0,0,0,0,0;...
    0,0,0,0,0.00492121,0,0,0,0];

D=[12.0969,0,0,0.698697;...
    0,-40.4214,-12.2709,0;...
    0,0,0,0;...
    0,0,0,0];

A_lon=A(1:4,1:4);
A_lat=A(5:9,5:9);
B_lon=[B(1:4,1),B(1:4,4)];
B_lat=B(5:9,2:3);
C_lon=[C(1,1:4);C(3,1:4)];
D_lon=[D(1,1),D(1,4);0,0];

X0=[0;0;0;0;0;0;0;0;0];         %init
%X0=[0;17.7459;0;0;0;0;0;0;0];  %alpha=5deg
%X0=[0;0;0;0;17.7327;0;0;0;0];  %beta=5deg

P.u0=0.6*330;
P.h0=0;
P.x0=[0,0,-P.h0];
P.a=330;
MainWork;