0% found this document useful (0 votes)
184 views

Aircraft Flight Dynamics, Control and Simulation: Using MATLAB and SIMULINK: Cases and Algorithm Approach

Uploaded by

Frkan
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as PDF, TXT or read online on Scribd
0% found this document useful (0 votes)
184 views

Aircraft Flight Dynamics, Control and Simulation: Using MATLAB and SIMULINK: Cases and Algorithm Approach

Uploaded by

Frkan
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as PDF, TXT or read online on Scribd
You are on page 1/ 101

Aircraft Flight Dynamics,

Control and Simulation


Using MATLAB and SIMULINK: Cases and Algorithm Approach

SINGGIH SATRIO WIBOWO


Preface 1

P REFACE

This book is written for students and engineers interesting in flight


control design, analysis and implementation. This book is written
during preparation of Matlab and Simulink course in UNIKL-MIAT
(University of Kuala Lumpur-Malaysian Institute of Aviation
Technology) in third week of February 2007. Although this book is still
in preparation, I hope that this book will be useful for the readers.

I wish to express my great appreciation to Professor Said D. Jenie


for his support. I wish to acknowledge Mr. Kharil Anuar and Mr.
Shahrul Ahmad Shah of MIAT for their invitation to the author to give
Matlab course in MIAT during the period of 26 February to 2 March
2007. I also wish to acknowledge the support of my colleagues at
Institut Teknologi Bandung (ITB): Javensius Sembiring and Yazdi I.
Jenie, and also my friends at Badan Pengkajian dan Penerapan
Teknologi (BPPT): Dewi Hapsari, Dyah Jatiningrum and Nina Kartika.
No words can express the thanks I owe to my parents: Ibunda Sulasmi
and Ayahanda Satrolan, and my family for their continuous support
through out my life. Finally and the most importantly, I would like to
thank The Highest Sweetheart Allah Almighty, The Creator and The
Owner of the universe.

Kuala Lumpur, 25 February 2007

Singgih Satrio Wibowo

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Contents 2

C ONTENTS

Preface.............................................................................................................. 1

Contents ........................................................................................................... 2

List Of Figures ................................................................................................... 5

List of Tables ..................................................................................................... 7

1 Aircraft Dynamics and Kinematics .............................................................. 9

1.1 Coordinate Systems and Transformation ....................................................... 10

1.1.1 Local Horizon Coordinate Reference System ....................................... 10

1.1.2 Body Coordinate Reference System ..................................................... 10

1.1.3 Wind Coordinate System ...................................................................... 12

1.1.4 Kinematics Equation ............................................................................. 15

1.1.5 Direction Cosine Matrix ........................................................................ 16

1.1.6 Quaternions .......................................................................................... 17

1.2 Aircraft equations of motion .......................................................................... 21

1.2.1 Translational Motion ............................................................................ 21

1.2.2 Angular Motion ..................................................................................... 23

1.2.3 For e a d Mo e t due to Earth s Gra ity ........................................... 25

1.2.4 Aerodynamic Forces and Moments...................................................... 26

1.2.5 Linearization of Equations of Motion ................................................... 27

1.1 Matlab and Simulink Tools for Flight Dynamics Simulation ........................... 30

2 Flight Control............................................................................................ 31

2.1 Attitude and Altitude Control using Root Locus Anlysis ................................. 32

2.2 Optimal Path-Tracking Control for Autonomous Unmanned Helicopter Using


Linear Quadratic Regulator ............................................................................ 33

2.2.1 Linearized Model .................................................................................. 34

2.2.2 Modified Linearized Model .................................................................. 37

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Contents 3

2.2.3 Path Generator ..................................................................................... 39

2.2.4 Path-Tracking Controller Design ........................................................... 43

2.2.5 Matlab and Simulink Implementation .................................................. 46

2.2.6 Numerical Results ................................................................................. 54

2.2.7 Analysis and Discussion of the Results ................................................. 63

2.3 Coordinated Turn Using Linear Quadratic Regulator ..................................... 65

2.3.1 State-Space Equations for an Airframe ................................................ 65

2.3.2 Problem Definition ............................................................................... 65

2.3.3 Matlab and Simulink Implementation .................................................. 66

2.3.4 Results................................................................................................... 69

2.3.5 Analysis and Discussion of the Results ................................................. 70

2.4 Adaptive Control for Yaw Damper and Coordinated Turn ............................. 71

2.4.1 Yaw Damper and Coordinated Turn: Definition ................................... 71

2.4.2 Model Reference Adaptive System ...................................................... 71

2.4.3 State-Space Model of XX-100 Aircraft .................................................. 72

2.4.4 Matlab and Simulink Implementation .................................................. 72

2.4.5 Results................................................................................................... 72

2.4.6 Discussion of The Results ..................................................................... 73

3 Flight Simulation ...................................................................................... 74

3.1 Matlab and Simulink tool for simulation ........................................................ 75

3.1.1 Matlab command for simulation purpose ........................................... 75

3.1.2 Simulink toolbox for simulation purpose ............................................. 75

3.2 Virtual Reality, an advance tool for visualization ........................................... 76

3.2.1 Introduction to Virtual Reality toolbox: a user guide ........................... 76

3.2.2 Virtual Reality for transport aircraft ..................................................... 88

3.3 Simulation of Aircraft Dynamics: a VirtueAir transport craft ......................... 89

Appendix A ..................................................................................................... 90

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Contents 4

Appendix B ..................................................................................................... 93

References ...................................................................................................... 99

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
List Of Figures 5

L IST O F F IGURES

Figure 1-1 Local horizon coordinate system ............................................................................ 10


Figure 1-2 Body-coordinate system......................................................................................... 11
Figure 1-3 Aircraft attitude with respect to local horizon frame: Euler angles ....................... 12
Figure 1-4 Wind-axes system and its relation to Body axes .................................................... 13
Figure 1-5 Aerodynamic lift and drag ...................................................................................... 14
Figure 2-1 A small-scale unmanned helicopter, Yamaha R-50 ................................................ 33
Figure 2-2 Dimension of the Yamaha R-50 Helicopter ............................................................ 34
Figure 2-3 The complete state-space form of R-50 dynamics................................................. 35
Figure 2-4 Trajectory for example 1, circular .......................................................................... 40
Figure 2-5 Velocity profile for example 1 ................................................................................ 41
Figure 2-6 Trajectory for example 2, rectangular .................................................................... 41
Figure 2-7 Velocity profile for example 2 ................................................................................ 42
Figure 2-8 Trajectory for example 3, spiral ............................................................................. 42
Figure 2-9 Velocity profile for example 3 ................................................................................ 43
Figure 2-10 Path tracking controller model............................................................................. 49
Figure 2-11 Path generator block ............................................................................................ 49
Figure 2-12 Earth to inertial velocity transform block ............................................................ 50
Figure 2-13 Optimal controller block........................................................................................ 50
Figure 2-14 Yamaha R50 dynamics model block ..................................................................... 50
Figure 2-15 Body to inertial transform block .......................................................................... 51
Figure 2-16 Inertial to Earth transform block .......................................................................... 51
Figure 2-17 Write to file block ................................................................................................. 51
Figure 2-18 Flight trajectory geometry.................................................................................... 55
Figure 2-19 Trajectory history ................................................................................................. 55
Figure 2-20 Velocity history ..................................................................................................... 56
Figure 2-21 Control input history ............................................................................................ 56
Figure 2-22 Attitude history .................................................................................................... 57
Figure 2-23 Trajectory error history ........................................................................................ 57
Figure 2-24 Flight trajectory geometry.................................................................................... 58
Figure 2-25 Trajectory history ................................................................................................. 58
Figure 2-26 Velocity history ..................................................................................................... 59
Figure 2-27 Control input history ............................................................................................ 59
Figure 2-28 Attitude history .................................................................................................... 60
Figure 2-29 Trajectory error history ........................................................................................ 60
Figure 2-30 Flight trajectory geometry.................................................................................... 61
Figure 2-31 Trajectory history ................................................................................................. 61

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
List Of Figures 6

Figure 2-32 Velocity history ..................................................................................................... 62


Figure 2-33 Control input history ............................................................................................ 62
Figure 2-34 Attitude history .................................................................................................... 63
Figure 2-35 Trajectory error history ........................................................................................ 63
Figure 2-36 A Body Coordinate Frame for an Aircraft [16] ..................................................... 65
Figure 2-37 Simulink diagram of coordinated turn ................................................................. 67
Figure 2-38 Write to file block ................................................................................................. 67
Figure 2-39 Attitude history .................................................................................................... 69
Figure 2-40 Tracking error history ........................................................................................... 70
Figure 2-41 Control input history ............................................................................................ 70
Figure 2-42 Block diagramfor Turn Coordinator system ......................................................... 71
Figure 2-43 Block diagram for Model Reference Adaptive System......................................... 72
Figure 3-1 The 3D AutoCAD model of XW aircraft .................................................................. 77
Figure 3-2 The 3D AutoCAD model of lake and hill ................................................................. 78
Figure 3-3 The V-Realm Builder window ................................................................................. 78
Figure 3-4 The 3D studio model of XW craft after imported into the V-Realm Builder ......... 79
Figure 3-5 The 3D studio model of XW craft after a background is added ............................. 79
Figure 3- Addi g four Tra sfor ......................................................................................... 80
Figure 3- ‘e a i g the four Tra sfor a d o i g the Wise ......................................... 80
Figure 3-8 Adding a dynamic observer .................................................................................... 80
Figure 3-9 Edit rotation (orientation) of the observer ............................................................ 81
Figure 3-10 Edit position of the observer ................................................................................ 81
Figure 3-11 Edit description of the observer ........................................................................... 82
Figure 3-12 An example of an observer .................................................................................. 82
Figure 3-13 An example of an observer, Right Front Observer ............................................... 82
Figure 3-14 Final results of the Virtual World ......................................................................... 83
Figure 3-15 A new SIMULINK model with VR Sink................................................................... 83
Figure 3-16 Parameter window of VR Sink .............................................................................. 84
Figure 3- Para eter i do of V‘ “i k after loadi g ise raftV‘. rl ........................ 84
Figure 3-18 The VR visualization window of WiSE-8 craft ....................................................... 85
Figure 3-19 The VR parameter after VRML Tree editing ......................................................... 86
Figure 3-20 The VR Sink after VR parameter editing ............................................................... 87
Figure 3-21 The VR Transform subsystem ............................................................................... 88

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
List of Tables 7

L IST OF T ABLES

Table 1 Physical Parameter of The Yamaha R-50 .................................................................... 34


Table 2 Parameter values of matrix A ..................................................................................... 35
Table 3 Parameter values of matrix B ..................................................................................... 37

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
List of Tables 8

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 9
Kinematics

1 A IRCRAFT D YNAMICS AND K INEMATICS

Nature of Aircraft dynamics and kinematics in three-dimensional (3D)


space can be described by a set of Equations of Motion (EOM), which
contains six degrees of freedom: three translational modes and three
rotational modes. In the equations, it needs to define the forces and
moments acting on the vehicle since it is the factors responsible for
the motion. Therefore, the modeling of the forces and moments is a
must. The mathematical model of forces and moments include the
aerodynamic, propulsion system and gravity. These models will be
discussed in detail in this chapter.

In this chapter, first we briefly overview the coordinate systems


that used as the reference frame for the description of aircraft motion.
Then, a complete nonlinear model of the aircraft motion will be
discussed briefly.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 10
Kinematics

1.1 C OORDINATE S Y STEMS AND T RANSFO RMATION


A number of coordinate systems will employed here to be use as a
reference for the motion of the aircraft in three-dimensional space,

 Local horizon-coordinate system

 Body-coordinate system

 Wind-coordinate system

1.1.1 L OC AL H ORI Z ON C OORD IN AT E R E FE RE NCE S Y ST EM


The local horizon coordinate system is also called the tangent-plane; it
is a Cartesian coordinate system. Its origin is located on pre-selected
point of interest and its xh , yh , z h axes align with the north, east and
down direction respectively as shown in Figure 1-1.

Ze

xh


yh

zh
Ye


Xe

F IGURE 1-1 L OCAL HORIZON COORDINATE SYSTEM

For simulation purpose, the local horizon local will be used as


reference (inertial) frame. It is correct since the most of aircraft is
flying in low altitude and range relative to the earth surface.

1.1.2 B OD Y C OORD IN AT E R E FER ENC E S YSTE M

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 11
Kinematics

The body coordinate system is a special coordinate system which


represents the aircraft body. Its origin is attached to the aircraft center
of gravity, see Figure 1-2. The positive xb axis lies along the
symmetrical axis of the aircraft in the forward direction, its positive yb
axis is perpendicular to the symmetrical axis of the aircraft to the right
direction, and the positive zb is perpendicular to the oxb yb plane
making the right hand orientation.

xb

center of gravity

yb zb

F IGURE 1-2 B ODY -COORDINATE SYSTEM

The transformation of body axes to the local horizon frame is


carried out using Euler angle orientation procedures. The orientation
of the body axes system to the local horizon axes system is expressed
by Euler angles as shown in Figure 1-3.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 12
Kinematics

Local Vertical

xb


xh


Local Horizon

  z
yh

yb b
zh

F IGURE 1-3 A IRCRAFT ATTITUDE WITH RESPECT TO LOCAL HORIZON FRAME :


E ULER ANGLES

The transformation of local horizon coordinate system to body


coordinate system can be expressed as [2]

cos  cos cos  sin   sin  


Cbh  sin  sin  cos  cos  sin  sin  sin  sin   cos  cos sin  cos  
  (1-1)
cos  sin  cos  sin  sin  cos  sin  sin   sin  cos cos  cos  

The above formula is very useful for determining the orientation of


the aircraft with respect to the earth surface. This matrix is an
orthogonal class of matrix, meaning that its inverse can be obtained by
transposing the matrix above as Chb  Cbh   Cbh  .
1 T

1.1.3 W I ND C OOR DI N ATE S Y ST EM


Wind coordinate system represents the aircraft velocity vector. This
fra e defi es the flight path of the air raft. The ter i d used here
is relative wind flowing through the aircraft body as the aircraft fly in
the air [2].

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 13
Kinematics

Its origin is attached to the center of gravity while its axes


define the direction and the orientation of flight path. The positive xw
axis coincides to the aircraft velocity vector V . The z w axis lies on the
symmetrical plane of the aircraft, perpendicular to the xw axis and
positive downward. And the last, positive y w axis is perpendicular to
the oxw zw plane obeying the right-hand orientation. These axes
definition are shown in Figure 1-4.

xb


V
xw

yw 
yb
zw zb

F IGURE 1-4 WIND -AXES SYSTEM AND ITS RELATION TO B ODY AXES

Wind axes system can be transformed to the body axes system using
the following matrix of transformation,

cos  cos  -cos  sin  -sin  


C  sin 
w
cos  0 

sin  cos  -sin  sin  cos  
b (1-2)

This equation is useful for transforming the aerodynamic lift and drag
forces to body axes system. As can be seen in Figure 1-4, the

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 14
Kinematics

aerodynamic lift vector is along the negative z w axis while the


aerodynamic drag is along the negative xw axis. Since the equations of
motion are derived in body axes system, it needs to express all forces
and moments which acting on the aircraft in the body axes. Therefore
the aerodynamic lift and drag vectors should be transformed from
wind axes to the body axes.

xb

D 

V
xw

yw 
yb
zw zb

F IGURE 1-5 A ERODYNAMIC LIFT AND DRAG

Using Equation (1-2), Aerodynamic lift and drag can be


transformed to body axes system by the following relation

 FAX  cos  cos  - cos  sin  -sin    D 


  sin   0 
 FAY    cos   
   
0
sin  cos  -sin  sin  cos 
(1-3)
 FAZ     L 

Similarly, after dividing Equation (1-3) by 1


2 VT2 S , the aerodynamic
coefficients can be expressed as

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 15
Kinematics

C X  cos  cos  -cos  sin  -sin   CD 


  sin   0 
 CY    cos   
C   C 
0
sin  cos  -sin  sin  cos 
(1-4)
 Z   L

Equation (1-4) will be used for transforming aerodynamic lift and drag
coefficients to body axes aerodynamic coefficients C X , CY , and CZ .

The translational velocity can also be transformed into the body


axes system as follows:

U  cos  cos  -cos  sin  -sin   VT 


  sin   0 
V    cos   
W  cos    0 
0
  sin  cos  -sin  sin 
VT cos  cos  
(1-5)
 
  VT sin  
V sin  cos  
 T 

in which the total velocity VT is defined as VT  U 2  V 2  W 2 . Angle


of attack  , and angle of sideslip  can be derived from equation (2-
9) as follows:

W 
  arctan  
U 
V 
  arcsin  
(1-6)

 VT 

Equation (2-10) will also be used in the simulation for calculating angle
of attack and sideslip angle from body axes velocity.

1.1.4 K I NEM ATI CS E QUATI ON


Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 16
Kinematics

  P Q R  . The physical definition of Euler angles can


Kinematics equation shows the relation of Euler angles and angular
T
velocity b

be seen in Figure 1-3. The kinematics equations are listed as follows:

  P  Q sin  tan   R cos  tan 


  Q cos   R sin 
sin  cos 
(1-7)
  Q R
cos  cos 

The above equation can be rewritten in the form of matrix as

 
  1 sin  tan  cos  tan    P 
    
    0 cos   sin   Q 
   sin  cos    R 
(1-8)
  0 
 cos  cos  

Equations (2-2) and (2-3) are used to obtained the Euler angles
from the angular velocity P , Q , and R . But the above equations have
disadvantage, i.e. can be singular for  = ± 90 degrees. It motivates to
use another way that can avoid the singularity. This can be done using
quaternion which will be discussed in the next section.

Intersection angle  i of any two vectors in three-dimensional (3D)


1.1.5 D I R ECT I ON C OS IN E M AT RI X

space, denoted by r1 and r2 , can be found by the inner product


relationship:

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 17
Kinematics

 r1 ฀r2 
i  arccos  
 r1 r2 
(1-9)

Using above idea, the transformation coordinate from local horizon


axes system ( i h , jh , z h ) to body axes system ( i b , jb , z b ) can be cast into
the matrix form [48]:

 i h ฀i b i h ฀jb i h ฀z b 
DCM   jh ฀i b jh ฀jb jh ฀z b 
 z h ฀i b z h ฀jb z h ฀z b 
 c  c c  s  s 
(1-10)

  s  s  c  c  s s  s  s  c  c s  c  
c  s  c  s  s c  s  s  s  c c  c  

where symbol s    sin   and c   cos  are used for
abbreviation. Equation (1-10) is identical to Equation (1-1). Therefore
the term DCM will be used together with the transformation matrix
Cbh in the simulation.

1.1.6 Q UAT ERN I ON S


Quaternions were discovered by Sir William Hamilton in 1843. He used
quaternion for extensions of vector algebras to satisfy the properties
of division rings (roughly, quotients exist in the same domain as the
operands). It has been widely discussed as interesting topic in algebra
and for its amazing applicability in dynamics.

The following paragraphs discuss the application of Quaternion


starting with its definition while more detail discussion will be
presented in Appendix C. Quaternion is define as

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 18
Kinematics

q  1 q0  i  q1  j  q2  k  q3   q0 q3 
T
q1 q2 (1-11)

where q0 , q1 , q 2 , q3 are reals, 1 is the multiplicative identity element,


and i , j , k are symbolic elements having the properties:

i 2  1 , j2  1 , k 2  1

ij  k ji  k
jk  i kj  i
(1-12)

ki  j ik   j

The time-derivative of the quaternion can be expressed as follows:

q    K   q
 0 R Q P   q0   q0 
 R 0  
P Q   q1   
1  q1 
    K  
2  Q  P 0 R  q2  q2 
    q3 
  P Q  R 0   q3 
 q3 q2 q1   q0 
(1-13)
q  P q 
1 2 q3 q0     1
 Q   K   
2   q1 q0 q3    q2 
  R
 q0 q1 q2   q3 
Q b  K q

 
where   1  q02  q12  q22  q32 is an error coefficient.

Obviously, integrating equation (1-13) is much more efficient


than (1-3) because it does not involve computationally expensive
trigonometric functions. This integration can be evaluated using the
following relation:

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 19
Kinematics

q  t   q 0   q dt
t

t0
(1-14)

where q  t  denotes quaternion at time t and q 0 is initial quaternion


calculated from initial Euler angles using Eqn. (1-17).

The rotational transformation matrix can be directly found with


quaternion:

Cbh  DCM
 q02  q12  q22  q32 2  q1q2  q0 q3  2  q1q3  q0 q2  
 
  2  q1q2  q0 q3  q02  q22  q12  q32 2  q2 q3  q0 q1   (1-15)
 2  q1q3  q0 q2  2  q2 q3  q0 q1  q02  q32  q12  q22 

Euler angles can be determined from the quaternion by comparing


Eqn. (2-15) to Eqn. (2-1) which yields

 2  q2 q3  q0 q1  
  arctan  2 
 q0  q3  q1  q2 
2 2 2

  arcsin  2  q1q3  q0 q2  
 2  q1q2  q0 q3  
(1-16)

  arctan  2 
 q0  q1  q2  q3 
2 2 2

This quaternion can also be expressed in terms of Euler angles as [8]:

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 20
Kinematics

      
q0    cos cos cos  sin sin sin 
 2 2 2 2 2 2
      
q1    sin cos cos  cos sin sin 
 2 2 2 2 2 2
      
(1-17)
q2    cos sin cos  sin cos sin 
 2 2 2 2 2 2
      
q3    cos cos sin  sin sin cos 
 2 2 2 2 2 2

The above equations will be used in the simulation which will be


conducted in this book.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 21
Kinematics

1.2 A IRCRAFT EQUATIO NS O F MOTIO N


The equations of motion are derived based on Newton law. They were
first derived by Euler, a great mathematician. It is the reason why the
equations of motion are dedicated to Newton and Euler.

The solutions of the complete equations of motion provide the


characteristics of motion of any solid body in three-dimensional space,
three translational and three angular motions. Therefore they called
the six degree of freedom (6-DOF) equations of motion. These
equations are very general and apply for all rigid bodies, e.g. aircrafts,
rockets and satellites.

The 6-DOF equations of motion consists a set of nonlinear first


ordinary differential equations (ODES). They express the motions of
the aircraft in terms of external forces and moments, which can be
subdivided in a number of categories such as aerodynamics, control
surface, propulsion system, and gravity. In this section, the equations
of motion will be presented along with all relevant force and moment
equations and a large number of output equations of which some are
needed to calculate these forces and moments.

1.2.1 T R ANS LATI ON AL M OTI ON


Applying the second law of Newton, the net forces acting on the
airplane can be found by adding up the force acting on the all parts of
the airplane as follows:

d  mVI 
 F 
 dV 
 m b   Vb   m Vb
 dt 
b (1-18)
dt

 F   F FZ  is total force vector along xb , yb and


T
where FY

zb axes respectively, Vb  U V W  is velocity vector coordinated


X

  P Q R  denotes angular
T
at the body axes frame and b

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 22
Kinematics

velocity vector of the aircraft with respect to the inertial space


coordinated at the body axes system. Upon decomposition, the
resulting three scalar force equations become:

FX  m U  QW  RV   mU
FY  m V  RU  PW   mV

FZ  m W  PV  QU   mW
 (1-19)

The above equation then used for calculating the translational


acceleration that can be expressed in the following equation:

F  mU
U  X  QW  RV

F  mV
m
V  Y  RU  PW

(1-20)

F  mW
m
W  Z  PV  QU

m

The term   F  m V  m is defined as translational acceleration a b

=  ax a y az  =  FX  mu  m  FY  mv
  m  FZ  mw  m .
b

T T

Forces occurred in (2-19) and (2-20) are caused by the aerodynamics,


control surface, propulsion system a d Earth s gra ity. He e it a e
written as follows:

FX  FAX  FC X  FPX  FGX


FY  FAY  FCY  FPY  FGY (1-21)
FZ  FAZ  FCZ  FPZ  FGZ

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 23
Kinematics

where FAX denotes aerodynamic force acting along xb axis, FH X is


hydrodynamic force acting along xb axis, FTX denotes the propulsion
force acting along xb axis FGX denotes gravity force acting along xb
axis, and so on.

1.2.2 A N G ULAR M OT I ON
Angular motion of the aircraft is also derived based on the second law
of Newton. The net moment acting on the airplane can be found by
adding up the moments acting on the all parts of the airplane as:

 M  Ib   I   I
dH I
b b b (1-22)
dt

 M   M M Z  is total moment vector along xb ,


T
where X MY
yb and zb axes respectively, denotes the angular velocity of the
aircraft as mentioned before and I denotes the inertia tensor of the
aircraft defined as

 I xx  J yx  J zx 
 
I    J xy  J zy 
  J xz I zz 
I yy (1-23)
  J yz

The angular acceleration can be evaluated using Equation (2-22)


as

 b  I 1   M  b  I b   I b  (1-24)

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 24
Kinematics

Here, I 1 is the inverse of the inertia tensor as shown in Equation (2-


24). This inverse has a relatively simple form [8]:

 k11 k31 
1
k32 
k21
I   k12
1


k22 (1-25)
 k13 k23 k33 

where


k11  I yy I zz  J yz2  k12  k21   J yz J xz  J xy I zz  
 I I  J xz2  k13  k31   J xy J yz  J xz I yy  
 I  k23  k32   J xy J xz  J yz I xx  
k22 zz xx (1-26)
k33 I  J xy2
xx yy

and

  I xx I yy I zz  2 J xy J yz J xz  I xx J yz2  I yy J xz2  I zz J xy2 (1-27)

For conventional aircraft which is symmetrical to oxb zb plane,


the cross inertial products are very small and can be assumed to be
zero ( J xy  0 and J yz  0 ). Under this condition, Eqn. (2-27) can be
simplified as

  I xx I yy I zz  I yy J xz2 (1-28)

By assuming the inertia tensor is constant which implies I = 0, Eqn. (2-


24) can be decomposed as:

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 25
Kinematics

M I  M Z J xz J xz  I xx  I yy  I zz  PQ  I zz  I zz  I yy   J xz  QR
P  X zz  
2

  
 I  I  PR  J xz P  R
Q  Y  zz xx
M
2
 2

M X J xz  M Z I xx  I xx  I xx  I yy   J xz  PQ J xz  I xx  I yy  I zz  QR
I yy I yy I yy (1-29)

R  
2

  

The moments ( M X , M Y and M Y ) can also be expressed in


terms of aerodynamic, control surface and propulsion moments as
those for the forces,

M X  M AX  M C X  M PX
M Y  M AY  M CY  M PY (1-30)
M Z  M AZ  M CZ  M PZ

where M AX denotes aerodynamic moment which respect to xb axis,


M CX is control surface moment which respect to xb axis, FPX denotes
the propulsion moment which respect to xb axis, and so on.

1.2.3 F OR CE AND M OME NT D UE T O E ARTH ’ S G R AVIT Y


The gravity force vector can be decomposed along the body axes
system as:

FGX  mg sin 


FGY  mg sin  cos  (1-31)
FGZ  mg cos  cos 

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 26
Kinematics

or can be written as

 FGX   0   0 
  h    
 FGY   Cb  0   DCM  0 
  mg  mg 
(1-32)

 FGZ     

The gravity force produces zero moment because it is acting on the


center of gravity. Equation (2-32) is the gravity force equation which
will be used in the simulation.

1.2.4 A E R OD YN AMIC F OR CES AN D M OM ENTS


Aerodynamic forces and moments are function of some parameters.
They can be written as:

FAX  C X  ,  , H , M ,  a ,  e ,  r ,U ,V ,W , P, Q, R  12 VT2 S
FAY  CY  ,  , H , M ,  a ,  e ,  r ,U ,V ,W , P, Q, R  12 VT2 S
FAZ  CZ  ,  , H , M ,  a ,  e ,  r ,U ,V ,W , P, Q, R  12 VT2 S
M AX  Cl  ,  , H , M ,  a ,  e ,  r ,U ,V ,W , P, Q, R  12 VT2 Sb
(1-33)

M AY  Cm  ,  , H , M ,  a ,  e ,  r ,U ,V ,W , P, Q, R  12 VT2 Sc
M AZ  Cn  ,  , H , M ,  a ,  e ,  r ,U ,V ,W , P, Q, R  12 VT2 Sb

Equation (1-33) shows that the aerodynamic forces and


moments are very complicated. Due to the limitation of methods and
tools available for determining the aerodynamic coefficients as
function of parameters shown in Eqn. (1-33), the simpler aerodynamic
model will be used for the simulation, see Eqns. (1-34) and (1-35).
These equations are adopted from aircraft control model.

In aircraft control studies which the interest is laying in the


air raft s respo se to a s all de iatio fro a steady re tili ear
symmetrical flight, the aerodynamic forces and moments can be
Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 27
Kinematics

separated into two uncoupled groups of symmetric and asymmetric


equations.

  V S
Symmetric equations:

FAX  C X  , H   C X q q 2Vc R  C X   e

 C   V S
1 2

 , H   CZ q 2Vc
2 T

 C Z
e

 C   V Sc
1 2
FAZ (1-34)

 , H   Cm q 2Vc
Z q e 2 T

 Cm
R e

1 2
M AY m q R e 2 T
e

The aerodynamic coefficients C X and CZ which occurred in Eqn.


(1-34) were calculated from aerodynamic lift and drag using Equation

predicted using Digital DATCOM as function of angle of attack (  ) and


(1-8). Aerodynamic lift and drag coefficients of the aircraft were

altitude ( H ).

 
Asymmetric equations:

FAY  CYo  CY   CYp p 2VbR  CYr r 2VbR  CY  a  CY  r VT2 S

 C 
1
2

 Cl   Cl p p 2VbR  Clr r 2VbR  Cl  a  Cl  r VT2 Sb


a r

 C 
1
M AX lo 2 (1-35)
 Cn   Cn p p 2VbR  Cnr r 2VbR  Cn  a  Cn  r VT2 Sb
a r

1
M AZ no 2
a r

Aerodynamic coefficient CY which occurred in Equation (1-35)


was also calculated from aerodynamic lift and drag using Equation (1-
8). For sideslip angle  = 0, the aerodynamic CYo , Clo and Cno are
assumed to be zero.

Stability and control derivatives occurred in equation (1-34) and


(1-35) will be calculated using DATCOM and Smetana method. These
parameters will be listed in Appendix C.

1.2.5 L I NE ARI Z ATI ON OF E QUATI ONS OF M OT I ON

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 28
Kinematics

We rewrite the complete equation of motion for conventional aircraft

m U  QW  RV   mg sin   FaX  FpX  FcX


in the form of

m V  RU  PW   mg cos  sin   FaY  FpY  FcY


m W  PV  QU   mg cos  cos   FaZ  FpZ  FcZ
I xx P   I zz  I yy  QR  J xz R  J xz PQ  M aX  M pX  M cX
(1-36)

I yy Q   I xx  I zz  PR  J xz  P 2  R 2   M aY  M pY  M cY
I zz R   I yy  I xx  PQ  J xz P  J xzQR  M aZ  M pZ  M cZ

Linearization of equations of motion is derived at trim condition, i.e.


the condition when all acceleration (translation and rotation) are zero,
U = V = W = P = Q = R = 0. At this condition, equations of
o o o o o o

motion become,

m  QoWo  RoVo   mg sin o  FAX  FPX  FCX


m  RoU o  PW
o o   mg cos  o sin o  FAY  FPY  FCY
o o o

m  PV
o o  QoU o   mg cos  o cos o  FAZ  FPZ  FCZ
o o o
(1-37)

I  I yy  Qo Ro  J xz PoQo  M AX  M PX  M C X
o o o

 I xx  I zz  Po Ro  J xz  Po M
zz

 Ro  M PY  M CY
o o o

I  I xx  PoQo  J xz Qo Ro  M AZ  M PZ  M CZ
2 2
AYo o o
(1-38)

yy o o o

we introduce small disturbance such that

U  Uo  u   o  d P  Po  p
V  Vo  v    o  d Q  Qo  q
   o  d
(1-39)
W  Wo  w R  Ro  r

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 29
Kinematics

Where , , , , , , ��, �� and �� is small deviation from its steady


state value.

During trim condition, external force and moment can be written as:

FaX  FaX  dFaX FpX  FpX  dFpX


FcX  FcX  dFcX
o o

etc
M aX  M aX  dM aX M pX  M pX  dM pX
o
(1-40)

M cX  M cX  dM cX
o o

etc
o

The trim condition is chosen at symmetrical cruising flight, where V0 =


Po = Qo = Ro = 0, dan  o =  o = o = 0. Applying Eqn. (1-37) to (1-40)
and neglecting product of small variables, yields

m  u  Wo q     mg cos o  d  dFAX  dFPX  dFCX (1-41)

m  v  U o r  Wo p    mg cos o  d  dFAY  dFPY  dFCY (1-42)

m  w  U o q     mg sin o  d  dFAZ  dFPZ  dFCZ (1-43)

I xx p  J xz r  dM AX  dM PX  dM CX (1-44)

I yy q  dM AY  dM PY  dM CY (1-45)

I zz r  J xz p  dM AZ  dM PZ  dM CZ (1-46)

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Aircraft Dynamics and 30
Kinematics

1.1 M ATLAB AND S IMULIN K T OOL S F OR F LIGHT D YNAMICS S IMULATI ON

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 31

2 F LIGHT C ONTROL

This chapter deals with control design and analysis using classical and
modern techniques. The explanation will be given in examples. First
we will give example of classical control applying for longitudinal and
lateral control (first example), then continuing by modern control
(second to fourth examples).

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 32

2.1 A TTITUDE AND A LTITUDE C ONT R OL USI NG R OOT L OCUS A N LYSIS

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 33

2.2 O PTIMAL P ATH -T RACKING C ONTROL FO R A UTONOMOU S U NMAN NED


H ELICOPTER U SING L INEAR Q UA DRATIC R EGULATOR

This chapter presents tracking control design of a small-scale


unmanned helicopter (Yamaha R-50) using Linear Quadratic Regulator
(LQR) technique [10]. We proposed scheme involves two steps: (1)
generate a path/trajectory off-line and (2) apply a time-invariant LQR
to track the path/trajectory. Numerical simulation using
MATLAB/Simulink® is carried out to demonstrate the feasibility of the
control system. Physical parameter of R-50 helicopter is presented in
Table 1.

F IGURE 2-1 A SMALL - SCALE UNMANNED HELICOPTER , YAMAHA R-50

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 34

F IGURE 2-2 D IMENSION OF THE Y AMAHA R-50 HELICOPTER

T ABLE 1 P HYSICAL P ARAMETER OF T HE Y AMAHA R-50

Rotor speed 850 rpm

Tip speed 449 ft/s

Dry weight 97 lb

Instrumented 150 lb

Engine Single cylinder, 2-stroke

2.2.1 L I NE ARI Z ED M ODE L


The linearized model of R-50 dynamics can be written in the state-
space form as

x  t   Ax  t   Bu  t  (2-1)

Where

x  u v w p q r   a b w r rfb c d 
T
(2-2)

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 35

is state vector, and

u  lat lon  ped col 


T
(2-3)

is control input. The matrices A and B are shown in the complete


state-space form (Figure 1-4).

F IGURE 2-3 THE COMPLETE STATE - SPACE FORM OF R-50 DYNAMICS

The parameter values of matrix A and B for hover and cruise flight
condition presented in Table 2 and Table 3 below.

T ABLE 2 P ARAMETER VALUES OF MATRIX A

Parameter Hover Cruise

Xu -0.0505 -0.122

X , Xa -32.2 -32.2

Xr 0 -11

Yv -0.154 -0.155

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 36

Y , Yb 32.2 32.2

Yr 0 -49.2

Lu -0.144 0

Lv 0.143 0

Lw 0 -0.213

Lb 166 213

Mu -0.0561 0

Mv -0.0585 0

Mw 0 0.0728

Ma 82.6 108

Ba 0.368 0.419

Bd 0.71 0.664

Ab -0.189 -0.176

Ac 0.644 0.577

Zb -131 0

Za -9.75 0

Zw -0.614 -1.01

Zr 0.93 0

Zp 0 11

Zq 0 49.2

Np -3.53 0

Nv 0.0301 0.401

Nw 0.0857 0

Nr -4.13 -3.9

N rfb -33.1 -26.4

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 37

Kr 2.16 2.18

K rfb -8.26 -7.79

T ABLE 3 P ARAMETER VALUES OF MATRIX B

Parameter Hover Cruise

Blat 0.14 0.124

Blon 0.0138 0.02

Alat 0.0313 0.0265

Alon -0.1 -0.0837

Z col -45.8 -60.3

M col 0 6.98

N col -3.33 0

N ped 33.1 26.4

Dlat 0.273 0.29

Clon -0.259 -0.225

Yped 0 11.23

p 0.0991 0.0589

f 0.046 0.0346

hcg -0.411 -0.321

s 0.342 0.259

2.2.2 M OD I FIE D L INE ARI Z ED M ODE L

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 38

We have modified the original dynamic model above for our


convenience. We added to the model, the rotation   r and then
rearrange the state vector as follows

x  u v w p q r    rfb a b c d 
T
(2-4)

Using this new state vector, we have new model with the matrices A
and B are as follows (Eqs. 28 and 29),

 Xu 0 g 0 
 0 0 
0 0 0 0 0 0 0 Xa 0 0
 Yv 0 0 0 0 g 0 0 0 0 Yb 0
 0 0 
 
0 Zw 0 0 Zr 0 0 0 0 Za Zb 0
 Lu 0 
M u 0 
Lv Lw 0 0 0 0 0 0 0 0 Lb 0

 
Mv Mw 0 0 0 0 0 0 0 Ma 0 0
 0 0 
 0 0 
Nv Nw Np 0 Nr 0 0 0 N rfb 0 0 0

A = 
0 0 1 0 0 0 0 0 0 0 0 0
 0 0 
 0 0 
0 0 0 1 0 0 0 0 0 0 0 0 (2-5)
 
0 0 0 0 1 0 0 0 0 0 0 0
 0 0 
 
0 0 0 0 Kr 0 0 0 K rfb 0 0 0
 0  1/  f Ab /  f Ac /  f 0 
 0 Bd /  f 
0 0 0 0 0 0 0 0 0
1 0 Ba /  f  1/  f
 
0 0 0 0 0 0 0 0
 0  1/ s 0 
 0  1 /  s 
0 0 0 0 0 0 0 0 0 0 0
 0 0 0 1 0 0 0 0 0 0 0 0

 0 0 
 0 0 
0 0
 0 Y ped
 0 Z col 
 
0 0
 0 0 
 0 M col 
0 0

 
0 0
 0 N col 
 0 0 
0 N ped

B 
0 0
 0 0 
(2-6)
 0 0 
0 0

 
0 0
 0 0 
 
0 0
 Alat /  f Alon /  f 0 
 Blat /  f 0 
0
Blon /  f
 
0
 0 Clon /  f 0 
D /  0 
0
 lat s 0 0

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 39

2.2.3 P ATH G EN ER AT OR
The path generator was developed by a simple idea, i.e. setting the
trajectory/path in the inertial reference and then finding its velocity
profile. This method can be expressed in the following relation:

x  x t  x  t   Vx  t 
y  y  t  and y  t   Vy  t 
z  z t  z  t   Vz  t 
(2-7)

And the total velocity is

VT  Vx2  Vy2  Vz2 (2-8)

The total velocity VT must be less or equal to the maximum velocity of


the helicopter, and it is assumed to be constant. We assume that the
u0 2  v0 2  49.22   11
2
maximum velocity of the helicopter is =
50.4 ft/s, and therefore we take VT = 50 ft/s for simulation.

The inertial frame, by definition, is chosen such that the positive z-


axis is downward. We then set positive x-axis is eastward, and
therefore the positive y-axis is southward. But for our convenience, we
choose local horizon as inertial frame where the positive x-axis is
eastward, the positive y-axis is northward, and the positive z-axis is
upward. So we need to transform the original inertial frame to the
local horizon frame. The transformation can be expressed as follows:

 X E  1 0 0   X I 
    
 YE   0 1 0   YI 
 Z  0 0 1  Z 
(2-9)
 E   I 

or inversely:
Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 40

 X I  1 0 0   X E 
    
 YI   0 1 0   YE 
 Z  0 0 1  Z 
(2-10)
 I   E 

To give more precise understanding of this method, we present


here three examples. The first example is generating horizontal
circular trajectory (Figure 2-4). The second example is generating
horizontal rectangular trajectory (Figure 2-6). And the third example is
generating (3D) spiral trajectory (Figure 2-8).

Trajectory

200

150

100
Altitude [ft]

50

-50

-100
500
400
300
300
200
200 100
100 0
-100
0
-200
-100 -300
North [ft]
East [ft]

F IGURE 2-4 TRAJECTORY FOR EXAMPLE 1, CIRCULAR

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 41

Velocity Profile
60
40
20

Vx [ft/s]
0
-20
-40
-60
0 2 4 6 8 10 12 14 16 18 20
Time [s]
Velocity Profile
60
40
20

Vy [ft/s]
0
-20
-40
-60
0 2 4 6 8 10 12 14 16 18 20
Time [s]
Velocity Profile
60
40
20

Vz [ft/s]
0
-20
-40
-60
0 2 4 6 8 10 12 14 16 18 20
Time [s]

F IGURE 2-5 V ELOCITY PROFILE FOR EXAMPLE 1

Trajectory

200

150

100
Altitude [ft]

50

-50

-100
800

600
800
700
400 600
500
400
200 300
200
0 100
0
-100
-200 -200
North [ft]
East [ft]

F IGURE 2-6 TRAJECTORY FOR EXAMPLE 2, RECTANGULAR

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 42

Velocity Profile
60
40
20

Vx [ft/s]
0
-20
-40
-60
0 10 20 30 40 50 60
Time [s]
Velocity Profile
60
40
20

Vy [ft/s]
0
-20
-40
-60
0 10 20 30 40 50 60
Time [s]
Velocity Profile
60
40
20
Vz [ft/s]

0
-20
-40
-60
0 10 20 30 40 50 60
Time [s]

F IGURE 2-7 V ELOCITY PROFILE FOR EXAMPLE 2

Trajectory

200

150

100
Altitude [ft]

50

-50

-100
500
400
300
300
200
200 100
100 0
-100
0
-200
-100 -300
North [ft]
East [ft]

F IGURE 2-8 TRAJECTORY FOR EXAMPLE 3, SPIRAL

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 43

Velocity Profile
60
40
20

Vx [ft/s]
0
-20
-40
-60
0 5 10 15 20 25 30 35 40
Time [s]
Velocity Profile
60
40
20

Vy [ft/s]
0
-20
-40
-60
0 5 10 15 20 25 30 35 40
Time [s]
Velocity Profile
60
40
20
Vz [ft/s]

0
-20
-40
-60
0 5 10 15 20 25 30 35 40
Time [s]

F IGURE 2-9 V ELOCITY PROFILE FOR EXAMPLE 3

2.2.4 P ATH -T R ACK IN G C ONTR OLLE R D ES I GN

2.2.4.1 L I NE AR R E G ULA T OR P R OBLE M


The controller design is based on LQR problem that is to find the
control input that can minimize the performance measure

J x  t f  Hx  t f     xT  t  Q  t  x  t   uT  t  R  t  u  t dt
1 T 1 tf
(2-11)
2 2 t0

Referring to the plant

x  t   A  t  x  t   B  t  u  t  (2-12)

which have the physical interpretation: it is desired to maintain the


state vector close to the origin without an excessive expenditure of
control effort.

The solution of this LQR problem can be seen in [6], in the form of
optimal gain matrix K and the optimal control law. The optimal gain
Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 44

matrix can be found by solving the matrix differential equation as


follow
  t   K  t  A  t   AT  t  K  t   Q  t   K  t  B  t  R 1  t  BT  t  K  t 
K (2-13)

And the optimal control input is

u *  t   R 1  t  BT  t  K  t  x  t 
฀ K opt  t  x  t 
(2-14)

2.2.4.2 P ATH -T R ACK IN G F ORM ULAT I ON


The tracking problem can be expressed in simple mathematics relation
as

xerror  t   x ref  t   x  t  (2-15)

we then take the derivative of Eqs. (38) respect to time, yields

x error  t   x ref  t   x  t  (2-16)

if we set xref  t   constant then the time derivative of Eqs. (39) can be
simplified to be

x error  t   x  t  (2-17)

equation (40) give us a motivation to design control law for path


tracking problem, that is:

x error  t   i x  t  ; i  1,2,, n (2-18)

where  i is arbitrary positive constant.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 45

2.2.4.3 P ATH -T R ACK IN G I M PLEM ENT ATI ON


Now, we are going to implement the path tracking controller. Our
motivation is to minimizing the tracking error matrix x error . Where the
tracking error matrix is

 xerror  t    xref  t   x  t  
xerror  t    yerror  t    yref  t   y  t  
   
 zerror  t    zref  t   z  t  
(2-19)
 

where xerror , yerror , zerror are error in x, y, and z position in body axis
frame. Applying equation (41) to equation (42) yields

 xerror  t    1 x  t  
x error  t    yerror  t     2 y  t 
   
 zerror  t    3 z  t  
(2-20)

Substituting x  u , y  v , z  w to Eqs. (43) yields

 1u  t  
x error  t      2 v  t  
 
3 w  t  
(2-21)

we choose the value such that 1 =  2 =  3 =  = 0.1 by trial and


error.

Using equation (2-21) we develop the augmented state-space


model:

x aug  t   A aug x aug  t   B aug u  t  (2-22)

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 46

where

xaug   xerror x
T
yerror zerror (2-23)

0 0.1  I 3 0311 
A aug   33
0143 A 
(2-24)

0 
B aug   34 
 B 
(2-25)

The performance measure is

J    x aug T  t  Q  t  x aug  t  uT  t  R  t  u  t   dt


tf

t0
(2-26)

with

Q  0.01 I17

R  0.01 I 4
(2-27)

then we minimizing (2-26) using LQR technique as describe before.


The solution is the optimal gain matrix Kopt (2-12).

2.2.5 M AT LAB AND S IM ULI NK I M PLEM EN TAT I ON

2.2.5.1 LQR C ONTR OLLE R I M PLEM ENT ATI ON : M AT LAB C ODE


The following code is Matlab implementation of the controller design
using LQR.

%==================================================%
% Simulation Yamaha R-50 Helicopter %
% Author : Singgih S. Wibowo %
% NIM : 23604003 %

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 47

% Version 2.1, 18 Des 2004 %


% 1st modification, 21 Feb 2007 %
%==================================================%
% References : %
% [1] A.Budiyono, H.Y. Sutarto %
% "Multivariable Controller Design for %
% a small scale helicopter using %
% Coefficient Diagram Method" %
% [2] B. Mettler, M.B. Tischler, Takeo Kanade %
% "System Identification Modeling of %
% a Small-Scale Unmanned Rotorcraft %
% for Flight Control Design" %
%==================================================%

%==================================================%
% Physical Parameter of The Yamaha R-50 %
%==================================================%
% Rotor speed 850 rpm %
% Tip speed 449 ft/s %
% Dry weight 97 lb %
% Instrumented 150 lb %
% Engine Single cylinder, 2-stroke %
% Flight autonomy 30 minutes %
%==================================================%

clear;

%===================================%
% A matrix [Hover mode; Cruise mode]%
%===================================%
Xu = [ -0.0505; -0.122 ];
Xth = [ -32.2 ; -32.2 ];
Xa = [ -32.2 ; -32.2 ];
Xr = [ 0 ; -11 ];
Yv = [ -0.154 ; -0.155 ];
Yph = [ 32.2 ; 32.2 ];
Yb = [ 32.2 ; 32.2 ];
Yr = [ 0 ; -49.2 ];
Lu = [ -0.144 ; 0 ];
Lv = [ 0.143 ; 0 ];
Lw = [ 0 ; -0.213 ];
Lb = [ 166 ; 213 ];
Mu = [ -0.0561; 0 ];
Mv = [ -0.0585; 0 ];
Mw = [ 0 ; 0.0728];
Ma = [ 82.6 ; 108 ];
Ba = [ 0.368 ; 0.419 ];
Bd = [ 0.71 ; 0.664 ];
Ab = [ -0.189 ; -0.176 ];
Ac = [ 0.644 ; 0.577 ];
Zb = [-131 ; 0 ];
Za = [ -9.75 ; 0 ];
Zw = [ -0.614 ; -1.01 ];
Zr = [ 0.93 ; 0 ];
Zp = [ 0 ; 11 ];
Zq = [ 0 ; 49.2 ];
Np = [ -3.53 ; 0 ];
Nv = [ 0.0301; 0.401 ];
Nw = [ 0.0857; 0 ];
Nr = [ -4.13 ; -3.9 ];
Nrfb = [ -33.1 ; -26.4 ];
Kr = [ 2.16 ; 2.18 ];
Krfb = [ -8.26 ; -7.79 ];
g = 32.2; %gravity constant = 32.2 ft/s^2

%===================================%
% B matrix [Hover mode; Cruise mode]%
%===================================%
Blat = [ 0.14 ; 0.124 ];
Blon = [ 0.0138; 0.02 ];

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 48

Alat = [ 0.0313; 0.0265];


Alon = [ -0.1 ; -0.0837];
Zcol = [-45.8 ; -60.3 ];
Mcol = [ 0 ; 6.98 ];
Ncol = [ -3.33 ; 0 ];
Nped = [ 33.1 ; 26.4 ];
Dlat = [ 0.273 ; 0.29 ];
Clon = [ -0.259 ; -0.225 ];
Yped = [ 0 ; 11.23 ];
Tau_p = [ 0.0991; 0.0589];
Tau_f = [ 0.046 ; 0.0346];
h_cg = [ -0.411 ; -0.321 ];
Tau_s = [ 0.342 ; 0.259 ];

%===================================%
% Choose fly mode
% 1 = Hover
% 2 = Cruise
%===================================%
Mode = 2;
if Mode == 1
Mtext = '[Hover Mode]';
elseif Mode == 2
Mtext = '[Cruise Mode]';
end

A = [Xu(Mode) 0 0 0 0 0 0 -g 0 0 ...
Xa(Mode) 0 0 0;
0 Yv(Mode) 0 0 0 0 g 0 0 0 ...
0 Yb(Mode) 0 0;
0 0 Zw(Mode) 0 0 Zr(Mode) 0 0 0 0 ...
Za(Mode) Zb(Mode) 0 0;
Lu(Mode) Lv(Mode) Lw(Mode) 0 0 0 0 0 0 0 ...
0 Lb(Mode) 0 0;
Mu(Mode) Mv(Mode) Mw(Mode) 0 0 0 0 0 0 0 ...
Ma(Mode) 0 0 0;
0 Nv(Mode) Nw(Mode) Np(Mode) 0 Nr(Mode) 0 0 0 Nrfb(Mode) ...
0 0 0 0;
0 0 0 1 0 0 0 0 0 0 ...
0 0 0 0;
0 0 0 0 1 0 0 0 0 0 ...
0 0 0 0;
0 0 0 0 0 1 0 0 0 0 ...
0 0 0 0;
0 0 0 0 0 Kr(Mode) 0 0 0 Krfb(Mode) ...
0 0 0 0;
0 0 0 0 -1 0 0 0 0 0 ...
-1/Tau_f(Mode) Ab(Mode)/Tau_f(Mode) Ac(Mode)/Tau_f(Mode) 0;
0 0 0 -1 0 0 0 0 0 0 ...
Ba(Mode)/Tau_f(Mode) -1/Tau_f(Mode) 0 Bd(Mode)/Tau_f(Mode);
0 0 0 0 -1 0 0 0 0 0 ...
0 0 -1/Tau_s(Mode) 0;
0 0 0 -1 0 0 0 0 0 0 ...
0 0 0 -1/Tau_s(Mode)];

B = [0 0 0 0
0 0 Yped(Mode) 0
0 0 0 Zcol(Mode)
0 0 0 0
0 0 0 Mcol(Mode)
0 0 Nped(Mode) Ncol(Mode)
0 0 0 0
0 0 0 0
0 0 0 0
0 0 0 0
Alat(Mode)/Tau_f(Mode) Alon(Mode)/Tau_f(Mode) 0 0
Blat(Mode)/Tau_f(Mode) Blon(Mode)/Tau_f(Mode) 0 0
0 Clon(Mode)/Tau_s(Mode) 0 0
Dlat(Mode)/Tau_s(Mode) 0 0 0];

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 49

%===========================================================
% X = [u v w p q r phi theta psi rfb a b c d]'
% U = [delta_lat delta_lon delta_ped delta_col]'
%===========================================================
alp = 5;
A_aug = [0 0 0 -alp 0 0 zeros(1,11)
0 0 0 0 -alp 0 zeros(1,11)
0 0 0 0 0 -alp zeros(1,11)
zeros(14,3) A];
B_aug = [zeros(3,4); B];
C = eye(14);
D = B*0;

%===========================================================
% Linear Quadratic Regulator is computed here
% We defined The Performance Cost by
% J = INTEGRAL (X^2 + U^2);
%===========================================================
weight = 1;
Q = weight*eye(17);
R = weight*eye(4);
K = lqr(A_aug,B_aug,Q,R);
%===========================================================

2.2.5.2 P ATH T R ACK IN G S IM ULAT I ON : S IM ULI NK D I AG R AM


The following figures show the Simulink diagram of the LQR controller
design

I to E transform

V [f t/s] Vx,Vy ,Vz u,v ,w u,v ,w Vx,Vy ,Vz Inertial Earth Vel_Earth_Axes (f t/s)
u,v ,w error Pos_Earth_Axes (f t)
p,q,r
Pos [f t] ph,th,psi Control Input input Control_Input (rad)
State phi,theta,psi ph,th,psi X,Y ,Z Inertial Earth
Attitude (rad)
Path Generator Inertial to Body
Optimal Controller State I to E transform1 Ref _V_E_Axes (f t/s)
Local Horizon Frame Body to Inertial
Yamaha R50 Dynamics Ref _Pos_E_Axes (f t)

Write to File

F IGURE 2-10 P ATH TRACKING CONTROLLER MODEL

cos

Step 50 1

sin V [ft/s]
1
2
Step1 s
Pos [ft]
0

Vz

F IGURE 2-11 P ATH GENERATOR BLOCK

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 50

2 Eul2DCM
Matrix
ph,th,psi 1
Multiply
1 Earth Inertial u,v,w
Vx,Vy,Vz
E to I transform

F IGURE 2-12 EARTH TO INERTIAL VELOCITY TRANSFORM BLOCK

1
1
s
error -K* u 1
2 Control Input
LQ Gain Saturation
State

F IGURE 2-13 O PTIMAL CONTROLLER BLOCK

-11
v_ini
49.2
u_ini

1
u,v,w

2
p,q,r
x' = Ax+Bu
1
y = Cx+Du 3
input
phi,theta,psi
State-Space Model
of Yamaha R50

4
State

F IGURE 2-14 YAMAHA R50 DYNAMICS MODEL BLOCK

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 51

u,v,w
1 u,v ,w
Vx,Vy ,Vz 1
T
2 Eul2DCM u DCM Vx,Vy,Vz
ph,th,psi

1
2
s
X,Y,Z

F IGURE 2-15 B ODY TO INERTIAL TRANSFORM BLOCK

1 -1 1
Inertial Earth
-1

F IGURE 2-16 I NERTIAL TO EARTH TRANSFORM BLOCK

5
Yamaha_R50_OPTCON_vdata
Ref_V_E_Axes (ft/s) 1
Vel_Earth_Axes (ft/s) To File

Yamaha_R50_OPTCON_verrdata

To File5

6
Yamaha_R50_OPTCON_xdata
Ref_Pos_E_Axes (ft) 2
Pos_Earth_Axes (ft) To File2

Yamaha_R50_OPTCON_errdata

To File1

3 -K- Yamaha_R50_OPTCON_condata
Control_Input (rad)
rad2deg To File3
4 -K- Yamaha_R50_OPTCON_atdata
Attitude (rad)
rad2deg To File4

F IGURE 2-17 WRITE TO FILE BLOCK

2.2.5.3 P LOT TI NG S IM ULAT I ON R E S ULT S : M AT LAB C ODE

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 52

The following Matlab code will plot figures of the simulation results.

%==================================================%
% This program will plotting simulation results %
% of Path-Tracking Controller for R-50 Helicopter %
%==================================================%
% Loading data From %
% [1] Yamaha_R50_OPTCON_vdata.mat %
% [2] Yamaha_R50_OPTCON_xdata.mat %
% [3] Yamaha_R50_OPTCON_condata; %
% [4] Yamaha_R50_OPTCON_atdata; %
% [5] Yamaha_R50_OPTCON_verrdata; %
% [6] Yamaha_R50_OPTCON_errdata; %
% then plotting them %
%==================================================%
% Author : Singgih S. Wibowo %
% NIM : 23604003 %
% Version 2.1, 18 Des 2004 %
% 1st modification, 21 Feb 2007 %
%==================================================%

load Yamaha_R50_OPTCON_vdata;
load Yamaha_R50_OPTCON_xdata;
load Yamaha_R50_OPTCON_condata;
load Yamaha_R50_OPTCON_atdata;
load Yamaha_R50_OPTCON_verrdata;
load Yamaha_R50_OPTCON_errdata;

Tmax = X(1,end);

%Flight Trajectory Geometry


figure(1);
plot3(X(2,:),X(3,:),X(4,:),'b',X(5,:),X(6,:),X(7,:),'r','LineWidth',2);
xlabel('East [ft]','FontSize',14);
ylabel('North [ft]','FontSize',14);
zlabel('Altitude [ft]','FontSize',14);
title('Flying Path [3D]','FontSize',14);
legend('Path_r_e_f','Path_o_u_t');
axis([-200 800 -200 800 -100 100]);
%axes('FontSize',14);
box on;
%grid on;

%Trajectory History
figure(2);
subplot(311);
plot(X(1,:),X(2,:),'b',X(1,:),X(5,:),'r','LineWidth',2);
xlabel('time [s]'); ylabel('East [ft]'); title('X-position');
legend('X_r_e_f','X_o_u_t');
axis([0 Tmax -200 800]);
%grid on;
subplot(312);
plot(X(1,:),X(3,:),'b',X(1,:),X(6,:),'r','LineWidth',2);
xlabel('time [s]'); ylabel('North [ft]'); title('Y-position');
legend('Y_r_e_f','Y_o_u_t');
axis([0 Tmax -200 800]);
%grid on;
subplot(313);
plot(X(1,:),X(4,:),'b',X(1,:),X(7,:),'r','LineWidth',2);
xlabel('time [s]'); ylabel('Altitude [ft]'); title('Z-position');
legend('Z_r_e_f','Z_o_u_t');
axis([0 Tmax -100 100]);
%grid on;

%Velocity History
figure(3);
subplot(311);

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 53

plot(V(1,:),V(2,:),'b',V(1,:),V(5,:),'r','LineWidth',2);
xlabel('time [s]'); ylabel('V_x [ft/s]'); title('X-Velocity');
legend('V_x _r_e_f','V_x _o_u_t');
axis([0 Tmax -60 60]);
%grid on;
subplot(312);
plot(V(1,:),V(3,:),'b',V(1,:),V(6,:),'r','LineWidth',2);
xlabel('time [s]'); ylabel('V_y [ft/s]'); title('Y-Velocity');
legend('V_y _r_e_f','V_y _o_u_t');
axis([0 Tmax -60 60]);
%grid on;
subplot(313);
plot(V(1,:),V(4,:),'b',V(1,:),V(7,:),'r','LineWidth',2);
xlabel('time [s]'); ylabel('V_z [ft/s]'); title('Z-velocity');
legend('V_z _r_e_f','V_z _o_u_t');
axis([0 Tmax -60 60]);
%grid on;

%Control Input History


figure(4);
subplot(221);
plot(Con(1,:),Con(2,:),'b','LineWidth',2);
xlabel('time [s]'); ylabel('\delta_l_a_t [deg]'); title('Control Input 1');
axis([0 Tmax -30 30]);
%grid on;
subplot(222);
plot(Con(1,:),Con(3,:),'b','LineWidth',2);
xlabel('time [s]'); ylabel('\delta_l_o_n [deg]'); title('Control Input 2');
axis([0 Tmax -30 30]);
%grid on;
subplot(223);
plot(Con(1,:),Con(4,:),'b','LineWidth',2);
xlabel('time [s]'); ylabel('\delta_p_e_d [deg]'); title('Control Input 3');
axis([0 Tmax -30 30]);
%grid on;
subplot(224);
plot(Con(1,:),Con(5,:),'b','LineWidth',2);
xlabel('time [s]'); ylabel('\delta_c_o_l [deg]'); title('Control Input 4');
axis([0 Tmax -30 30]);
%grid on;

%Attitude History
figure(5);
subplot(311);
plot(Atd(1,:),Atd(2,:),'b','LineWidth',2);
xlabel('time [s]'); ylabel('\phi [deg]'); title('roll angle');
axis([0 Tmax -60 60]);
%grid on;
subplot(312);
plot(Atd(1,:),Atd(3,:),'b','LineWidth',2);
xlabel('time [s]'); ylabel('\theta [deg]'); title('pitch angle');
axis([0 Tmax -60 60]);
%grid on;
subplot(313);
plot(Atd(1,:),Atd(4,:),'b','LineWidth',2);
xlabel('time [s]'); ylabel('\psi [deg]'); title('yaw angle');
axis([0 Tmax -360 20]);
%grid on;

%Velocity Error History


figure(6);
subplot(311);
plot(verr(1,:),verr(2,:),'r','LineWidth',2);
xlabel('time [s]');
ylabel('u_e_r_r_o_r [ft/s]');
title('X Velocity Error');
axis([0 Tmax -100 100]);
%grid on;
subplot(312);
plot(verr(1,:),verr(3,:),'r','LineWidth',2);

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 54

xlabel('time [s]');
ylabel('v_e_r_r_o_r [ft/s]');
title('Y Velocity Error');
axis([0 Tmax -100 100]);
%grid on;
subplot(313);
plot(verr(1,:),verr(4,:),'r','LineWidth',2);
xlabel('time [s]');
ylabel('w_e_r_r_o_r [ft/s]');
title('Z Velocity Error');
axis([0 Tmax -100 100]);
%grid on;

%Trajectory Error History


figure(7);
subplot(311);
plot(err(1,:),err(2,:),'r','LineWidth',2);
xlabel('time [s]');
ylabel('X_e_r_r_o_r [ft]');
title('X Position Error');
axis([0 Tmax -100 100]);
%grid on;
subplot(312);
plot(err(1,:),err(3,:),'r','LineWidth',2);
xlabel('time [s]');
ylabel('Y_e_r_r_o_r [ft]');
title('Y Position Error');
axis([0 Tmax -100 100]);
%grid on;
subplot(313);
plot(err(1,:),err(4,:),'r','LineWidth',2);
xlabel('time [s]');
ylabel('Z_e_r_r_o_r [ft]');
title('Z Position Error');
axis([0 Tmax -100 100]);
%grid on;

2.2.6 N UM ER IC AL R E S ULTS
In this section, we present our numerical experiment result using
MATLAB/Simulink®. The Simulink model as shown in Figure 2-10. We
have carried out three experiments as follow

2.2.6.1 E X PER IME NT 1, C I RC ULAR T R AJE CT OR Y


Follow the circular trajectory lies on horizontal plane as given previous
section, see Figure 2-4.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 55

Flying Path [3D]

Pathref
Pathout

100

80

60

40

20

Altitude [ft]
0

-20

-40

-60

-80

-100
500
400
300
300 200
200 100
100 0
-100
0
-200
-100 -300
North [ft]
East [ft]

F IGURE 2-18 F LIGHT TRAJECTORY GEOMETRY

X-position
300
Xref
200
Xout
100
East [ft]

0
-100
-200
-300
0 2 4 6 8 10 12 14 16 18 20
time [s]
Y-position
500
Yref
400
Yout
300
North [ft]

200
100
0
-100
0 2 4 6 8 10 12 14 16 18 20
time [s]
Z-position
20
Zref
10 Zout
Altitude [ft]

-10

-20
0 2 4 6 8 10 12 14 16 18 20
time [s]

F IGURE 2-19 T RAJECTORY HISTORY

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 56

X-Velocity
60
Vx ref
40
Vx out
20

Vx [ft/s]
0
-20
-40
-60
0 2 4 6 8 10 12 14 16 18 20
time [s]
Y-Velocity
60
Vy ref
40
Vy out
20

Vy [ft/s]
0
-20
-40
-60
0 2 4 6 8 10 12 14 16 18 20
time [s]
Z-velocity
60
Vz ref
40
Vz out
20
Vz [ft/s] 0
-20
-40
-60
0 2 4 6 8 10 12 14 16 18 20
time [s]

F IGURE 2-20 V ELOCITY HISTORY

Control Input 1 Control Input 2


30 30

20 20

10 10
lon [deg]
[deg]

0 0
lat

-10 -10

-20 -20

-30 -30
0 5 10 15 20 0 5 10 15 20
time [s] time [s]

Control Input 3 Control Input 4


30 30

20 20

10 10
[deg]

col [deg]

0 0
ped

-10 -10

-20 -20

-30 -30
0 5 10 15 20 0 5 10 15 20
time [s] time [s]

F IGURE 2-21 C ONTROL INPUT HISTORY

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 57

roll angle
60
40
20

 [deg]
0
-20
-40
-60
0 2 4 6 8 10 12 14 16 18 20
time [s]
pitch angle
60
40
20

 [deg]
0
-20
-40
-60
0 2 4 6 8 10 12 14 16 18 20
time [s]
yaw angle
0

-100
 [deg]

-200

-300

0 2 4 6 8 10 12 14 16 18 20
time [s]

F IGURE 2-22 A TTITUDE HISTORY

X Position Error
50
Xerror [ft]

-50
0 2 4 6 8 10 12 14 16 18 20
time [s]
Y Position Error
50
Yerror [ft]

-50
0 2 4 6 8 10 12 14 16 18 20
time [s]
Z Position Error
50
Zerror [ft]

-50
0 2 4 6 8 10 12 14 16 18 20
time [s]

F IGURE 2-23 T RAJECTORY ERROR HISTORY

2.2.6.2 E X PER IME NT 2, R E CT AN G ULAR T R AJEC T OR Y


Follow the rectangular trajectory as given in Fig.17.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 58

Flying Path [3D]

Pathref
Pathout

100

80

60

40

20

Altitude [ft]
0

-20

-40

-60

-80

-100
800

600
800
700
400 600
500
400
200 300
200
0 100
0
-100
-200 -200
North [ft]
East [ft]

F IGURE 2-24 F LIGHT TRAJECTORY GEOMETRY

X-position
800
Xref
600
Xout
East [ft]

400

200

-200
0 10 20 30 40 50 60
time [s]
Y-position
800
Yref
600
Yout
North [ft]

400

200

-200
0 10 20 30 40 50 60
time [s]
Z-position
100
Zref
50 Zout
Altitude [ft]

-50

-100
0 10 20 30 40 50 60
time [s]

F IGURE 2-25 T RAJECTORY HISTORY

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 59

X-Velocity
60
Vx ref
40
Vx out
20

Vx [ft/s]
0
-20
-40
-60
0 10 20 30 40 50 60
time [s]
Y-Velocity
60
Vy ref
40
Vy out
20

Vy [ft/s]
0
-20
-40
-60
0 10 20 30 40 50 60
time [s]
Z-velocity
60
Vz ref
40
Vz out
20
Vz [ft/s]

0
-20
-40
-60
0 10 20 30 40 50 60
time [s]

F IGURE 2-26 V ELOCITY HISTORY

Control Input 1 Control Input 2


30 30

20 20

10 10
lon [deg]
[deg]

0 0
lat

-10 -10

-20 -20

-30 -30
0 10 20 30 40 50 60 0 10 20 30 40 50 60
time [s] time [s]

Control Input 3 Control Input 4


30 30

20 20

10 10
[deg]

col [deg]

0 0
ped

-10 -10

-20 -20

-30 -30
0 10 20 30 40 50 60 0 10 20 30 40 50 60
time [s] time [s]

F IGURE 2-27 C ONTROL INPUT HISTORY

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 60

roll angle
60
40
20

 [deg]
0
-20
-40
-60
0 10 20 30 40 50 60
time [s]
pitch angle
60
40
20

 [deg]
0
-20
-40
-60
0 10 20 30 40 50 60
time [s]
yaw angle
0

-100
 [deg]

-200

-300

0 10 20 30 40 50 60
time [s]

F IGURE 2-28 A TTITUDE HISTORY

X Position Error
100

50
Xerror [ft]

-50

-100
0 10 20 30 40 50 60
time [s]
Y Position Error
100

50
Yerror [ft]

-50

-100
0 10 20 30 40 50 60
time [s]
Z Position Error
100

50
Zerror [ft]

-50

-100
0 10 20 30 40 50 60
time [s]

F IGURE 2-29 T RAJECTORY ERROR HISTORY

2.2.6.3 E X PER IME NT 3, S PIR AL T R AJEC T OR Y


Follow the spiral trajectory as given in Fig.23.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 61

Flying Path [3D]

Pathref
Pathout

300

250

200

150

Altitude [ft]
100

50

-50

-100
500
400
300
300 200
200 100
100 0
-100
0
-200
-100 -300
North [ft]
East [ft]

F IGURE 2-30 F LIGHT TRAJECTORY GEOMETRY

X-position
800
Xref
600
Xout
East [ft]

400

200

-200
0 5 10 15 20 25 30 35 40
time [s]
Y-position
800
Yref
600
Yout
North [ft]

400

200

-200
0 5 10 15 20 25 30 35 40
time [s]
Z-position
300
Zref
200 Zout
Altitude [ft]

100

-100
0 5 10 15 20 25 30 35 40
time [s]

F IGURE 2-31 T RAJECTORY HISTORY

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 62

X-Velocity
60
Vx ref
40
Vx out
20

Vx [ft/s]
0
-20
-40
-60
0 5 10 15 20 25 30 35 40
time [s]
Y-Velocity
60
Vy ref
40
Vy out
20

Vy [ft/s]
0
-20
-40
-60
0 5 10 15 20 25 30 35 40
time [s]
Z-velocity
60
Vz ref
40
Vz out
20
Vz [ft/s]

0
-20
-40
-60
0 5 10 15 20 25 30 35 40
time [s]

F IGURE 2-32 V ELOCITY HISTORY

Control Input 1 Control Input 2


30 30

20 20

10 10
lon [deg]
[deg]

0 0
lat

-10 -10

-20 -20

-30 -30
0 5 10 15 20 25 30 35 40 0 5 10 15 20 25 30 35 40
time [s] time [s]

Control Input 3 Control Input 4


30 30

20 20

10 10
[deg]

col [deg]

0 0
ped

-10 -10

-20 -20

-30 -30
0 5 10 15 20 25 30 35 40 0 5 10 15 20 25 30 35 40
time [s] time [s]

F IGURE 2-33 C ONTROL INPUT HISTORY

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 63

roll angle
60
40
20

 [deg]
0
-20
-40
-60
0 5 10 15 20 25 30 35 40
time [s]
pitch angle
60
40
20

 [deg]
0
-20
-40
-60
0 5 10 15 20 25 30 35 40
time [s]
yaw angle
0

-200
 [deg]

-400

-600

0 5 10 15 20 25 30 35 40
time [s]

F IGURE 2-34 A TTITUDE HISTORY

X Position Error
50
Xerror [ft]

-50
0 5 10 15 20 25 30 35 40
time [s]
Y Position Error
50
Yerror [ft]

-50
0 5 10 15 20 25 30 35 40
time [s]
Z Position Error
50
Zerror [ft]

-50
0 5 10 15 20 25 30 35 40
time [s]

F IGURE 2-35 T RAJECTORY ERROR HISTORY

2.2.7 A N ALY SI S AN D D IS C US SI ON OF TH E R E S ULT S


The path tracking controller using LQR applied to our platform
(Yamaha R-50) have advantage and disadvantage. The LQR approach
can be minimizing error tracking while keep control input low. But it

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 64

can be applied for full states feedback where in the real application
may not applicable since only a part of states can be fed back.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 65

2.3 C OORDINATED T UR N U S ING L INEAR Q UADRATIC R EGULATOR


The following example is taken from Matlab demo, see [16]. The
program is modified for education purpose.

2.3.1 S T AT E -S PAC E E QUAT I ON S FOR AN A IR FR AM E


For this case, the state-space equation is a standard form

x  Ax  Bu (2-28)

where

x  u v w p q r  
T
(2-29)

The variables , , and are the three velocities with respect to the
body frame, which is shown in Figure 2-36 below.

F IGURE 2-36 A B ODY C OORDINATE F RAME FOR AN A IRCRAFT [16]

The variables , , and are the roll, pitch, and yaw rates, � and � are
pitch and roll respectively.

2.3.2 P R OBLEM D E FIN IT I ON


The goal is to perform a steady coordinated turn, as shown in the
following figure.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 66

Figure 4-57: An Aircraft Making a 60° Turn

To achieve this goal, we must design a controller that commands a


steady turn by going through a 60° roll. In addition, assume that, the
pitch angle, is required to stay as close to zero as possible.

2.3.3 M AT LAB AND S IM ULI NK I M PLEM EN TAT I ON

2.3.3.1 I M PLEM ENT ATI ON OF LQR: M AT LAB C OD E


The following code is Matlab implementation of the controller design
using LQR for aircraft turn.

%=========================================================================%
% LQG design for 60 degree aircraft turn
% Copyright 1986-2002 The MathWorks, Inc.
% $Revision: 1.5 $ $Date: 2002/04/10 06:40:38 $
%=========================================================================%
% State vector => x = [u,v,w,p,q,r,theta,phi]
% u,v,w: linear velocities
% p,q,r: roll, pitch, yaw rates
% theta: pitch angle
% phi : bank angle
% Control vector => u = [u1,u2,u3,u4]
%=========================================================================%
% Modified by SSW, 21 Feb 2007 for education purpose
%=========================================================================%

% Linear dynamics
A = [-0.0404 0.0618 0.0501 -0.0000 -0.0005 0.0000 0 0
-0.1686 -1.1889 7.6870 0 0.0041 0 0 0
0.1633 -2.6139 -3.8519 0.0000 0.0489 -0.0000 0 0
-0.0000 -0.0000 -0.0000 -0.3386 -0.0474 -6.5405 0 0
-0.0000 0.0000 -0.0000 -1.1288 -0.9149 -0.3679 0 0
-0.0000 -0.0000 -0.0000 0.9931 -0.1763 -1.2047 0 0
0 0 0.9056 0 0 -0.0000 0 0
0 0 -0.0000 0 0.9467 -0.0046 0 0];

B =[ 20.3929 -0.4694 -0.2392 -0.7126


0.1269 -2.6932 0.0013 0.0033
-64.6939 -75.6295 0.6007 3.2358
-0.0000 0 0.1865 3.6625
-0.0000 0 23.6053 5.6270
-0.0001 0 3.9462 -41.4112
0 0 0 0
0 0 0 0];

%=========================================================================%
% Add integrator state dz/dt = -phi
% Augmanted vector => x_aug = [z,u,v,w,p,q,r,theta,phi]
% Augmanted control => u_aug = [0,u1,u2,u3,u4]
%=========================================================================%
A_aug = [zeros(1,8) -1;
zeros(8,1) A];
B_aug = [zeros(1,4) ; B];

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 67

%=========================================================================%
% LQR gain synthesis
%=========================================================================%
Q = blkdiag(1,0.1*eye(6),1000,1);
R = diag([10,50,1,1]);
K_lqr = lqr(A_aug,B_aug,Q,R);

2.3.3.2 C OOR D IN ATED T URN S IM ULATI ON : S IM ULIN K D I AGR AM

W rite to File
20 1
s+20 s
x' = Ax+Bu
K*u U U(E)
phi_ref Integrator y = Cx+Du
Linearized
LQR Gain Dynamics

F IGURE 2-37 S IMULINK DIAGRAM OF COORDINATED TURN

3
Aircraft_Turn_State
States
1 To File
Roll_Ref

U U(E) Aircraft_Turn_Error

To File5

2 Aircraft_Turn_Control
Control
To File1

F IGURE 2-38 WRITE TO FILE BLOCK

2.3.3.3 P LOT TI NG R ES ULTS : M AT LAB C ODE

The following Matlab code will plot figures of the simulation results.

%==================================================%
% This program will plotting simulation results %
% of Turn-Coordinator Controller for Aircraft %
%==================================================%

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 68

% Loading data From %


% [1] Aircraft_Turn_State.mat %
% [2] Aircraft_Turn_Error.mat %
% [3] Aircraft_Turn_Control.mat %
% then plotting them %
%==================================================%
% Author : Singgih S. Wibowo %
% NIM : 23604003 %
% Version 1.0, 21 Feb 2007 %
%==================================================%

load Aircraft_Turn_State;
load Aircraft_Turn_Error;
load Aircraft_Turn_Control;

Tmax = state(1,end);

%==================================================%
%Aircraft Attitude, Pitch and Roll
%==================================================%
figure(1);
set(1,'Name','Attitude History');
subplot(211);
plot(state(1,:),state(8,:)*180/pi,'b','LineWidth',2);
set(gca,'FontSize',14);
xlabel('Time (s)');
ylabel('\theta (deg)');
title('Pitch Attitude History');
grid on;
subplot(212);
plot(state(1,:),state(10,:)*180/pi,'r',...
state(1,:),state(9,:)*180/pi,'b','LineWidth',2);
set(gca,'FontSize',14);
xlabel('Time (s)');
ylabel('\phi (deg)');
title ('Roll Attitude History');
legend ('roll ref','roll actual');
grid on;

%==================================================%
%Aircraft Tracking Error
%==================================================%
figure(2);
set(2,'Name','Tracking Error');
plot(error(1,:),error(2,:)*180/pi,'b','LineWidth',2);
set(gca,'FontSize',14);
xlabel('Time (s)');
ylabel('\phi_r_e_f - \phi (deg)');
title('Roll Tracking-Error History');
grid on;

%==================================================%
%Aircraft Control Input
%==================================================%
figure(3);
set(3,'Name','Control Input');
plot(control(1,:),control(2,:)*180/pi,'b',...
control(1,:),control(3,:)*180/pi,'g',...
control(1,:),control(4,:)*180/pi,'r',...
control(1,:),control(5,:)*180/pi,'m',...
'LineWidth',2);
set(gca,'FontSize',14);
xlabel('Time (s)');
ylabel('Control Input (deg)');
title('Control Input History');
grid on;
legend ('control 1','control 2','control 3','control 4');

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 69

2.3.4 R E S ULT S
This figure shows the response of to the 60° step command. Figure 4-
58: Tracking the Roll Step Command As you can see, the system tracks
the commanded 60° roll in about 60 seconds. Another goal was to
keep , the pitch angle, relatively small. This figure shows how well the
LQG controller did. Figure 4-59: Minimizing the Displacement in the
Pitch Angle, Theta Finally, this figure shows the control inputs. Figure
4-60: The Control Inputs for the LQG Tracking Problem Try adjusting
the Q and R matrices in lqrdes.m and inspecting the control inputs and
the system states, making sure to rerun lqrdes to update the LQG gain
matrix K. Through trial and error, you may improve the response time
of this design. Also, compare the linear and nonlinear designs to see
the effects of the nonlinearities on the system performance.

x 10
-3 Pitch Attitude History
2
 (deg)

0
0 10 20 30 40 50 60
Time (s)
Roll Attitude History
100
roll ref
 (deg)

roll actual
50

0
0 10 20 30 40 50 60
Time (s)

F IGURE 2-39 A TTITUDE HISTORY

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 70

Roll Tracking-Error History


60

50

40

-  (deg)
30

20
ref

10

-10
0 10 20 30 40 50 60
Time (s)

F IGURE 2-40 T RACKING ERROR HISTORY

Control Input History


5
control 1
4 control 2
control 3
control 4
Control Input (deg)

-1
0 10 20 30 40 50 60
Time (s)

F IGURE 2-41 C ONTROL INPUT HISTORY

2.3.5 A N ALY SI S AN D D IS C US SI ON OF TH E R E S ULT S

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 71

2.4 A DAPTIVE C ONTROL F OR Y AW D AMPER AND C OORDINATED T URN


This chapter presents implementation of adaptive control for yaw
damper and coordinated turn. The major content of this chapter is
taken from [9].

2.4.1 Y AW D AM PE R AN D C OOR DI N ATE D T UR N : D E FI NI TI ON


Yaw damper is a SAS (Stability Augmentation System) which augment
the stability of dutch roll mode of an aircraft. The principle of this
control system is giving command to rudder which causes a moment
against yaw rate which finally damp the dutch roll. This control system
sense yaw rate and use it for feedback. The following figure shows the
block diagram of yaw damper system.

F IGURE 2-42 B LOCK DIAGRAMFOR TURN C OORDINATOR SYSTEM

Coordinated turn maneuver is a turn maneuver with zero lateral


acceleration at constant altitude. The absent of lateral acceleration
make aircraft passengers feel comfort during the maneuver. This
maneuver is difficult to do since it needs good coordination of control
surface (elevator, aileron and ruder) deflection. Therefore an
automatic control is needed for it.

2.4.2 M OD E L R E FE RENC E A D APT I VE S YST EM

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 72

Model reference adaptive system (MRAS) is an adaptive control


method by using performance index of reference model. The
reference model is a mathematical model of the ideal system. Block
diagram of the MRAS shown in figure below:

F IGURE 2-43 B LOCK DIAGRAM FOR MODEL R EFERENCE A DAPTIVE S YSTEM

2.4.3 S T AT E -S PAC E M OD E L OF XX-100 A IR CR AFT

2.4.4 M AT LAB AND S IM ULI NK I M PLEM EN TAT I ON

2.4.4.1 I M PLEM ENT ATI ON OF MRAS: M AT LAB C OD E

2.4.4.2 MRAS-C OOR D IN AT ED T UR N S IM ULAT I ON : S IM ULIN K D I AGR AM

2.4.4.3 P LOT TI NG R ES ULTS : M AT LAB C ODE

2.4.5 R E S ULT S

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Control 73

2.4.6 D I SC USS I ON OF T HE R ES ULTS

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 74

3 F LIGHT S IMULATION

This chapter deals with simulation technique using Matlab and


Simulink. We also introduce an advance visualization tools: Virtual
Reality toolbox and the application of the tool for visualizing aircraft
dynamics related to previous chapter.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 75

3.1 M ATLAB AND S IMULIN K TOO L FO R SIMULATIO N


3.1.1 M AT LAB C OMM AN D FOR S I M ULAT I ON PUR POS E

3.1.2 S I M ULI NK T OOLBOX FOR S IM ULATI ON PUR POS E

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 76

3.2 V IRTUA L R EALITY , AN ADVANCE TOOL F OR VIS UALIZATI ON


3.2.1 I N TR OD UCT I ON T O V I RT UAL R E ALI T Y T OOLBOX : A USER G UI DE
Virtual Reality (VR) toolbox is already available in MATLAB 6.0 and the
higher versions. However, the examples and user guide for the toolbox
are available only for simple cases. Therefore, those who want to use
the toolbox in advance should study the toolbox in deep themselves.
The author has studied the toolbox for hours before using the toolbox
for simulating aircraft. MATLAB 7.0 has been used for the simulation.
The author suggests the reader to utilize the computer set with
minimum specifications of: processor 1 GHz, RAM 256 MB, and Video
Memory 32 MB.

The following paragraphs will discuss the detail procedures of


using the toolbox, particularly for XW aircraft. The motivation of
writing this user guide is to provide comprehensive information to the
readers that will give them the skill on using the VR toolbox.

3.2.1.1 D E FI NI NG TH E PR OBLE M

Our problem is to visualize the motions of XW aircraft in the VR world.


The motions defined here are three translational and three rotational
motions of the craft. The requirements for this visualization are: the
position w.r.t. x , y and z axes of VR frame (see Section 3.2) and the

attitude angles (  ,  and  ).

3.2.1.2 C R E ATE VI RT UAL W OR LD

To create a virtual world, the author chose the following steps to


achieve the best result:

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 77

(1) Drawing the 3D aircraft and 3D virtual environment in AutoCAD


and then export them into 3D Studio file type. It is important to
note that the smaller the files size the faster the visualization
(simulation) process. The author suggests that to obtain a faster
visualization, the files size should not be more than 10 MB.
(2) Importing the 3D Studio file into V-Realm Builder and then
editing the file.
(3) Saving the virtual orld hi h has ee edited usi g File\Save
As o a d. This file ill e sa ed auto ati ally i V‘ML type
(*.wrl). The VRML file is the only file that can be used for VR
visualization. Note: Do ot use “ave o a d e ause the
file will be saved in original file type (*.3ds) but different
format.
Figure E.1 shows the 3D model of WiSE-8 craft. The 3D model
should be drawn in the actual scale and standard dimension (meter)
because the VR dimension is in meter. Other important things are: (1)
setting the attitude of WiSE craft such that the xb -axis is coincide with

x -axis of UCS world system, yb -axis is coincide with z -axis of UCS


world system and zb -axis is coincide with negative y -axis of UCS

world system. It is important since the UCS world will be defined as


the VR frame by V-Realm Builder, (2) setting the origin of UCS coincide
with the aircraft center of gravity.

F IGURE 3-1 THE 3D A UTO CAD MODEL OF XW AIRCRAFT

The name for the 3D model of XW craft the author gives is


wise8craft (.dwg). The author preserves the file name for 3D studio

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 78

file. Figure E.2 show the 3D model of virtual lake and hill. The file
name of the model is 3D_lake (.dwg). This name is also preserved for
the 3D studio file.

F IGURE 3-2 THE 3D A UTO CAD MODEL OF LAKE AND HILL

3.2.1.3 W OR KIN G IN V-R E ALM B UI LDER


The V-Realm Builder can be executed using one of the following ways:

(1) Run the vrbuild2.exe ( ) directly. This executable file can


be accessed in folder: MATLAB7\toolbox\vr\vrealm\program.
The V-Realm window will then appear as shown in Figure E.3.
(2) Open Simulink Library Browser. Then create new model. The new
model window will appear. Drag the VR Sink block available in
the Virtual Reality Toolbox into the new model window. Double
click the block. The parameters window will then appear. Click
the new button. This last action will run the vrbuild2.exe. Figure
E.3 shows the V-Realm window that will be appeared just after
the execution.

F IGURE 3-3 THE V-R EALM B UILDER WINDOW

After running the V-Realm Builder, the next step is opening the 3D
Studio files that have already been created, and then editing the files.
The procedures are as follows:

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 79

(1) Click the open button, or choose the menu: File\Open, or push
the keyboard buttons: Ctrl + O.
(2) The open dialog window will then appear. Choose the file type of
3D Studio and file name: wise8craft.3ds.
(3) The 3D model of WiSE-8 craft will then appear as shown in Figure
E. . ‘e a e Group to Wise y dou le li ki g the ord
Group a d the typi g the e a e Wise .

(4) Add a a kgrou d y li ki g the Add Ba kgrou d utto ).


Figure E.4 shows the result.
(5) “a i g the proje t usi g File\“a e As… o a d. Na e the
proje t as ise raftV‘. rl .

F IGURE 3-4 T HE 3D STUDIO MODEL OF XW CRAFT AFTER IMPORTED INTO


THE V-R EALM B UILDER

F IGURE 3-5 T HE 3D STUDIO MODEL OF XW CRAFT AFTER A BACKGROUND IS


ADDED

(6) Add four Tra sfor for Wise y li ki g the Tra sfor utto

( . First Tra sfor ill e used for tra slatio isualizatio


a d the last three Tra sfor ill e used for rotatio
isualizatio . The Tra sfor should e added su h that the
se o d Tra sfor is the hild of the first Tra sfor a d so o ,
see Figure E.6.
(7) ‘e a e ea h Tra sfor y Wise_Tra slatio , Wise_‘oll ,
Wise_Pit h , a d Wise_Ya as sho i Figure E. . Note that
Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 80

this action, renaming the transform, is very important because


without renaming these parameters will not be identified by
SIMULINK.

F IGURE 3-6 A DDING FOUR TRANSFORM

(8) Mo e the Wise to the hild of the fourth Tra sfor , see agai
Figure E.7. This action can be carried out by the following step:
utti g the Wise , a ti ate the hildre y poi ti g the
ursor to hildre of the fourth Tra sfor or Wise_Ya a d
then click once, and (3) click the paste button.

F IGURE 3-7 R ENAMING THE FOUR TRANSFORM AND MOVING THE W ISE

(9) Add observer (viewer). An observer can be added into VR world

by clicking the Viewpoint button ( ). It is better to add a


Tra sfro first the add a o ser er as hild, see Figure E. .

F IGURE 3-8 A DDING A DYNAMIC OBSERVER

This action can make the observer become a dynamic observer, in


which the observer can be moving and rotating as the aircraft. The
observer has six parameters, see again Figure E.8. In this example, only
three parameters will be discussed. The parameters are: orientation,
Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 81

position, and description. The orientation parameter defines the


orientation of the observer, see Figure E.9.

F IGURE 3-9 EDIT ROTATION ( ORIENTATION ) OF THE OBSERVER

Input for the orientation is X axis, Y axis, Z axis, and Rotation (degree).
The X, Y and Z axis define the vector of rotation axes in VR axes
system, while the Rotation defines the rotation angle in degree. The
position parameter defines the position of the observer. Inputs for the
position are X, Y and Z position with respect to VR axes system.

F IGURE 3-10 EDIT POSITION OF THE OBSERVER

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 82

The third parameter is description. This parameter defines the


observer name, see Figure E.11. Note that the default position is
[0,0,0] and the default orientation is along negative Z axis or can be
written in vector notation as [0,0,1,0].

F IGURE 3-11 EDIT DESCRIPTION OF THE OBSERVER

In this example, we will show how to make an observer that will flying
with the WiSE craft, located at [20,0,7] meter from the craft and the
orientation is 73 degrees, see Figure E.12.

F IGURE 3-12 AN EXAMPLE OF AN OBSERVER

To make this observer, set the location as [20,0,7] and orientation as [0,1,0,73]. Then
a e this o ser er as Fro t ‘ight O ser er . The result is sho i Figure E. . Note
that the Tra sfor a d Vie poi t ha e ee re a ed as ‘ightFro t_O ser er .

F IGURE 3-13 A N EXAMPLE OF AN OBSERVER , R IGHT F RONT O BSERVER

Using the same procedures, we made other observers and add the lake and hill model.
The result is shown in Figure E.14.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 83

F IGURE 3-14 F INAL RESULTS OF THE V IRTUAL WORLD

3.2.1.4 P LUG G IN G TH E VR WOR LD IN T O S IMU L INK M OD E L

After creating the virtual world (wise8craftVR.wrl), the next step is


plugging the world into SIMULINK environment. The following steps
show the procedure.

(1) Open Simulink Library Browser. Then create new model. The new
model window will appear. Drag the VR Sink block available in
the Virtual Reality Toolbox into the new model window, see
Figure E.15.

F IGURE 3-15 A NEW S IMULINK MODEL WITH VR S INK

(2) Double click the block. The parameters window will then appear,
see Figure E.16. Then click the Browse button. Select the VR file
we already made, ise raftV‘. rl . The i do ill sho the
VRML tree, see Figure E.17.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 84

F IGURE 3-16 P ARAMETER WINDOW OF VR S INK

F IGURE 3-17 P ARAMETER WINDOW OF VR S INK AFTER LOADING


WISE 8 CRAFT VR. WRL

(3) Click the OK button. Then we will back to Simulink window as


shown in Figure E.15. Double click the VR Sink block, then VR
window as shown in Figure E.18 will appear.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 85

F IGURE 3-18 T HE VR VISUALIZATION WINDOW OF W I SE-8 CRAFT

(4) Click the Block Parameter button ( ). This action will show the
parameter window as already shown in Figure E.17. In the VRML
tree, click the translation parameter for Wise_Translation, then
click the rotation for Wise_Roll, Wise_Pitch, and Wise_Yaw, see
Figure E.19. Click also the translation parameter for the
Right_Observer, RightFront_Observer, Front_Observer,
LeftFront_Oberver, Left_Observer, LeftBehind_Oberver,
Behind_Observer, and RightBehind_Observer. Choose rotation
parameter for StaticRight_A_Observer, StaticRight_B_Observer,
and StaticRight_C_Observer. Finally click OK button.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 86

F IGURE 3-19 T HE VR PARAMETER AFTER VRML TREE EDITING

(5) Back to Simulink model window. The VR Sink will show the VR
parameter as shown in Figure E.20. Save this Simulink model as
Tes_VR_World. Now the VR Sink is ready to be connected to
Simulink model of WiSE-8 motion simulation. As already
discussed in the beginning of Appendix E, the motion parameters
needed for visualization are position and attitude angle.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 87

F IGURE 3-20 T HE VR S INK AFTER VR PARAMETER EDITING

Before connecting the VR Sink to Simulink model, it is very important


to note that (1) the translation input of VR Sink is in the form of vector
containing three elements [X,Y,Z], in which each element defines the
recent position in meter w.r.t. VR frame, and (2) the rotation input for
VR Sink is in the form of vector containing four elements [Xr,Yr,Zr,],
where Xr, Yr, and Zr define the vector of rotation w.r.t. VR frame and 
defines the rotation angle in radian. Please note that the unit for
rotation input is radian, it is differs from orientation angle input
(degree). Since the outputs of WiSE-8 simulation are in local horizon
frame, we need to transform the output into VR frame. The
transformation matrix from local horizon to VR frame is already shown
in Equation (3-1). For convenience, the equation will be rewritten
here.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 88

1 0 0 
C  0 0 1
h
(3-1)
0 1 0 
VR

Equation (E-1) is implemented in the VR Transform subsystem as


shown in Figure E.21. This figure is similar with Figure 3.28. The
different between Figure E.21 and Figure 3.28 is the transformation
method. Although the methods are different, they give the same
result.

LH to VR matrix

[3x3] Matrix
1
Multiply
<signal2> X Y Z [m] (0 1 0)

1 5
200
Motion Bus atan2 Angle A [rad]
<signal3> Xo [m]
25
(1 0 0) Zo [m]
2
roll angle [rad] (0 1 0)

6
600
atan2 Angle B [rad]
Xo [m]1
(0 0 1) 25
3 Zo [m]1
pitch angle [rad]
(0 1 0)

7
[0 -1 0] 1100
4 atan2 Angle C [rad]
Xo [m]2
25
yaw angle [rad]
Zo [m]2

F IGURE 3-21 T HE VR T RANSFORM SUBSYSTEM

3.2.1.5 S UMM ARY


The procedures of creating VR world have been discussed in detail in
this section. The VR world then connected to any aircraft simulation
model to visualize the aircraft motion as already discussed in previous
chapter. The author hopes that the procedures discussed above give
the readers a new knowledge and a guide for using the Virtual Reality
toolbox.

3.2.2 V I RT UAL R E ALIT Y FOR TR ANS PORT AIR CR AFT

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Flight Simulation 89

3.3 S IMULATION OF A I RCRAFT D Y NAMICS : A V IRTUE A IR TRANSP ORT


CRAFT

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Appendix A Appendix
90 A

A PPENDIX A

Quick Matlab Reference: Some Basic Commands


Note: command syntax is case-sensitive!

Help <command> display the Matlab help for <command>


who lists all of the variables in matlab workspace
whos list the variables and describes their matrix size
clear deletes all matrices (variables) from active workspace
clear u deletes the matrix or variable u from active workspace
save saves all the matrices defined in the current session into the file,
matlab.mat
load loads contents of matlab.mat into current workspace
save filename saves the contents of workspace into filename.mat
save filename x y z saves the matrices x, y and z into the file titled filename.mat
load filename loads the contents of filename into current workspace; the file can be a
binary (.mat) file or an ASCII file.

Matrix commands
1 2 3
[1 2 3; 4 5 6] create the matrix
4 5 6
zeros(n) creates an nxn matrix whose elements are zero.
zeros(m,n) creates a m-row, n-column matrix of zeros.
ones(n) creates a n x n square matrix whose elements are 1's
ones(m,n) creates a mxn matrix whose elements are 1's.
ones(A) creates an m x n matrix of 1's, where m and n are based on the size of an
existing matrix, A.
zeros(A) creates an mxn matrix of 0's, where m and n are based on the size of the
existing matrix, A.
eye(n) creates the nxn identity matrix with 1's on the diagonal.
A' Transpose of A

Plotting commands
plot(x,y) creates an Cartesian plot of the vectors x & y
plot(y) creates a plot of y vs. the numerical values of the elements in the y-vector
semilogx(x,y) plots log(x) vs y
semilogy(x,y) plots x vs log(y)
loglog(x,y) plots log(x) vs log(y)
grid creates a grid on the graphics plot
title('text') places a title at top of graphics plot
xlabel('text') writes 'text' beneath the x-axis of a plot
ylabel('text') writes 'text' beside the y-axis of a plot
text(x,y,'text') writes 'text' at the location (x,y)
text(x,y,'text','sc') writes 'text' at point x,y assuming lower left corner is (0,0) and upper
right corner is (1,1)
gtext('text') writes text according to placement of mouse hold on maintains the current

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Appendix A 91

plot in the graphics window while executing subsequent plotting


commands
hold off turns OFF the 'hold on' option
polar(theta,r) creates a polar plot of the vectors r & theta where theta is in radians
bar(x) creates a bar graph of the vector x (Note also the command stairs(y))
bar(x,y) creates a bar-graph of the elements of the vector y, locating the bars
according to the vector elements of 'x' (Note also the command stairs (x,y))
hist(x) creates a histogram. This differs from the bargraph in that frequency is
plotted on the vertical axis
mesh(z) creates a surface in xyz space where z is a matrix of the values of the
function z(x,y). z can be interpreted to be the height of the surface above
some xy reference plane
surf(z) similar to mesh(z), only surface elements depict the surface rather than a
mesh grid
contour(z) draws a contour map in xy space of the function or surface z
meshc(z) draws the surface z with a contour plot beneath it
meshgrid [X,Y]=meshgrid(x,y) transforms the domain specified by vectors x and y
into arrays X and Y that can be used in evaluating functions for 3D
mesh/surf plots
print sends the contents of graphics window to printer
print filename -dps writes the contents of current graphics to 'filename' in postscript format

Misc. commands
length(x) returns the number elements in a vector
size(x) returns the size m(rows) and n(columns) of matrix x
rand returns a random number between 0 and 1
randn returns a random number selected from a normal distribution with a mean
of 0 and variance of 1
rand(A) returns a matrix of size A of random numbers
fliplr(x) reverses the order of a vector. If x is a matrix, this reverse the order of the
columns in the matrix
flipud(x) reverses the order of a matrix in the sense of exchanging or reversing the
order of the matrix rows. This will not reverse a row vector!
reshape(A,m,n) reshapes the matrix A into an mxn matrix from element (1,1) working
column-wise

Some symbolic toolbox commands


syms t define the variable t to be symbolic. The value of t is now t
f = t^3 + sin(t) let f be t3 + sin(t) symbolically
diff(f) differentiate f
diff(f,t) differentiate f with resp. to t
int(f) integrate f
int(f,t,a,b) integrate f with resp. to t from a to b
inv(A) matrix inverse of A
det(A) determinant of A
rank(A) rank of A
eig(A) eigenvalues and eigenvectors.
poly(A) characteristic polynomial.
expm(A) matrix exponential
help symbolic get help on all symbolic toolbox commands.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Appendix A 92

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Appendix B 93

A PPENDIX B

Continuous System Analysis: Some Basic Commands

A. Transfer Function Representation


Commands covered:
tf2zp
zp2tf
cloop
feedback
parallel
series

Transfer functions are defined in MATLAB by storing the coefficients of the numerator and
the denominator in vectors. Given a continuous-time transfer function
( )
� =
( )
where
= � � + �−1 �−1 + ⋯ + 0 and = � � + �−1 �−1 + ⋯ + 0 written in their
coefficients, A(s) in numerator vectors num = [1 aN-1 ... a0] and B(s) is denominator den =
[bM bM-1 ... b0].
In this text,
the names of the vectors are generally chosen to be num and den, but any other name could
be used.
For example,

2 + 3
�( ) = 3+ 4 2+ 5

is defined by
num = [2 3];
den = [1 4 0 5];
Note that all coefficients must be included in the vector, even zero coefficients.
A transfer function may also be defined in terms of its zeros, poles and gain:
H(s) =
k(s- z )(s- z ) (s-z )
(s- p )(s- p ) (s-p )
12m
12n
K
K
Error! Switch argument not specified.
To find the zeros, poles and gain of a transfer function from the vectors num and den which
contain the coefficients of the numerator and denominator polynomials, type
Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Appendix B 94

[z,p,k] = tf2zp(num,den)
The zeros are stored in z, the poles are stored in p, and the gain is stored in k. To find the
numerator and denominator polynomials from z, p, and k, type
11
G(s)
G(s)
H(s)
unity feedback
feedback
-
-
[num,den] = zp2tf(z,p,k)
The overall transfer function of individual systems in parallel, series or feedback can be found
using
MATLAB. Consider block diagram reduction of the different configurations shown in Figure
1.
Store the transfer function G in numG and denG, and the transfer function H in numH and
denH.
To reduce the general feedback system to a single transfer function, Gcl(s) =
G(s)/(1+G(s)H(s)) type
[numcl,dencl] = feedback(numG,denG,numH,denH);
For a unity feedback system, let numH = 1 and denH = 1 before applying the above
algorithm. Alternately, use the command
[numcl,dencl] = cloop(numG,denG,-1);
To reduce the series system to a single transfer function, Gs(s) = G(s)H(s) type
[nums,dens] = series(numG,denG,numH,denH);
To reduce the parallel system to a single transfer function, Gp(s) = G(s) + H(s) type
[nump,denp] = parallel(numG,denG,numH,denH);
(Parallel is not available in the Student Version.)
12
G(s)
G(s)
H(s)
H(s)
series
parallel

B. Time Simulations
Commands covered: residue
step
impulse
lsim

The analytical method to find the time response of a system requires taking the inverse
Laplace
Transform of the output Y(s). MATLAB aides in this process by computing the partial
fraction

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Appendix B 95

expansion of Y(s) using the command residue. Store the numerator and denominator
coefficients of Y(s) in num and den, then type
[r,p,k] = residue(num,den)
The residues are stored in r, the corresponding poles are stored in p, and the gain is stored in
k.
Once the partial fraction expansion is known, an analytical expression for y(t) can be
computed by
hand.
A numerical method to find the response of a system to a particular input is available in
MATLAB.
First store the numerator and denominator of the transfer function in num and den,
respectively.
To plot the step response, type
step(num,den)
13
To plot the impulse response, type
impulse(num,den)
For the response to an arbitrary input, use the command lsim. Create a vector t which
contains
the time values in seconds at which you want MATLAB to calculate the response. Typically,
this is
done by entering
t = a:b:c;
where a is the starting time, b is the time step and c is the end time. For smooth plots,
choose b
so that there are at least 300 elements in t (increase as necessary). Define the input x as a
function of time, for example, a ramp is defined as x = t. Then plot the response by typing
lsim(num,den,x,t);
To customize the commands, the time vector can be defined explicitly and the step response
can be
saved to a vector. Simulating the response for five to six time constants generally is sufficient
to
show the behavior of the system. For a stable system, a time constant is calculated as 1/Re(-p)
where p is the pole that has the largest real part (i.e., is closest to the origin).
For example, consider a transfer function defined by
H(s) =
2
s+ 2
4
The step response y is calculated and plotted from the following commands:
num = 2; den = [1 2];
t = 0:3/300:3; % for a time constant of 1/2
y = step(num,den,t);
plot(t,y)
For the impulse response, simply replace the word step with impulse. For the response to
an
arbitrary input stored in x, type

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Appendix B 96

y = lsim(num,den,x,t);
plot(t,y)

C. Frequency Response Plots


Commands covered:
freqs
bode
logspace
log10
semilogx
unwrap
To compute the frequency response H() of a transfer function, store the numerator and
denominator of the transfer function in the vectors num and den. Define a vector w that
contains
the frequencies for which H() is to be computed, for example w = a:b:c where a is the
lowest
frequency, c is the highest frequency and b is the increment in frequency. The command
H = freqs(num,den,w)
returns a complex vector H that contains the value of H() for each frequency in w.
To draw a Bode plot of a transfer function which has been stored in the vectors num and
den,
type
bode(num,den)
To customize the plot, first define the vector w which contains the frequencies at which the
Bode
plot will be calculated. Since w should be defined on a log scale, the command logspace
is
used. For example, to make a Bode plot ranging in frequencies from 10-1 to 102, define w by
w = logspace(-1,2);
The magnitude and phase information for the Bode plot can then be found be executing:
[mag,phase] = bode(num,den,w);
To plot the magnitude in decibels, convert mag using the following command:
magdb = 20*log10(mag);
To plot the results on a semilog scale where the y-axis is linear and the x-axis is logarithmic,
type
semilogx(w,magdb)
for the log-magnitude plot and type
semilogx(w,phase)
for the phase plot. The phase plot may contain jumps of ±2which may not be desired. To
remove
these jumps, use the command unwrap prior to plotting the phase.
semilogx(w,unwrap(phase))

E. Control Design
Commands covered: rlocus

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Appendix B 97

Consider a feedback loop as shown in Figure 1 where G(s)H(s) = KP(s) and K is a gain and
P(s)
contains the poles and zeros of the controller and of the plant. The root locus is a plot of the
roots
of the closed loop transfer function as the gain is varied. Suppose that the numerator and
denominator coefficients of P(s) are stored in the vectors num and den. Then the following
command computes and plots the root locus:
rlocus(num,den)
To customize the plot for a specific range of K, say for K ranging from 0 to 100, then use the
following commands:
K = 0:100;
r = rlocus(num,den,K);
plot(r,’.’)
The graph contains dots at points in the complex plane that are closed loop poles for integer
values
of K ranging from 0 to 100. To get a finer grid of points, use a smaller increment when
defining
K, for example, K = 0:.5:100. The resulting matrix r contains the closed poles for all of
the
gains defined in the vector K. This is particularly useful to calculate the closed loop poles for
one
particular value of K. Note that if the root locus lies entirely on the real axis, then using
plot(r,’.’) gives inaccurate results.
F. State Space Representation
Commands Covered: step
lsim
ss2tf
tf2ss
ss2ss
The standard state space representation is used in MATLAB, i.e.,
&x Ax Bu


y Cx


5
17
where x is nx1 vector, u is mx1, y is px1, A is nxn, B is nxm, and C is pxn. The response of a
system to various inputs can be found using the same commands that are used for transfer
function
representations: step, impulse, and lsim. The argument list contains the A, B, C, and
D
matrices instead of the numerator and denominator vectors. For example, the step response is
obtained by typing:
[y,x,t] = step(A,B,C,D);
The states are stored in x, the outputs in y and the time vector, which is automatically
generated,

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
Appendix B 98

is stored in t. The rows of x and y contain the states and outputs for the time points in t.
Each
column of x represents a state. For example, to plot the second state versus time, type
plot(t,x(:,2))
To find the response of an arbitrary input or to find the response to initial conditions, use
lsim.
Define a time vector t and an input matrix u with the same number of rows as in t and the
number of columns equaling the number of inputs. An optional argument is the initial
condition
vector x0. The command is then given as
[y,x] = lsim(A,B,C,D,u,t,x0);
You can find the transfer function for a single-input/single-output (SISO) system using the
command:
[num,den] = ss2tf(A,B,C,D);
The numerator coefficients are stored in num and the denominator coefficients are stored in
den.
Given a transformation matrix P, the ss2ss function will perform the similarity transform.
Store the state space model in A, B, C and D and the transformation matrix in P.
[Abar,Bbar,Cbar,Dbar]=ss2ss(A,B,C,D,P);
performs the similarity transform z=Px resulting in a state space system that is defined as:
&x Ax Bu


y Cx Du


6
where A= PAP-1, B= PB, C = CP-1, D= D.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
References 99

R EFERENCES

Textbooks
[1] Brian L. Stevens and Frank L. Lewis, Aircraft Control and Simulation, John Wiley and
Sons, Inc, 2003.
[2] Said D. Jenie, Flight Control, Lecture Notes, Department of Aeronautics and
Astronautics, Bandung Institute of Technology, 2006. (in Bahasa Indonesia)
[3] Said D. Jenie and Hari Muhammad, Flight Dynamics, Lecture Notes, Department of
Aeronautics and Astronautics, Bandung Institute of Technology, 2006. (in Bahasa
Indonesia)
[4] John H. Blakelock, Automatic Control of Aircraft and Missiles, John Wiley and Sons, Inc,
1991.
[5] J.A. Mulder, W.H.J.J van Staveren, and J.C. van der Vaart, Flight Dynamics, Lecture
Notes, Faculty of Aerospace Engineering, TU-Delft, 2000.
[6] Donald E. Kirk, Optimal Control Theory an Introduction, Prentice-Hall, Inc, 1970.

Thesis
[7] Singgih S. Wibowo, Virtual Reality of Wing in Surface Effect Craft, Graduate Thesis,
Department of Aeronautics and Astronautics, Bandung Institute of Technology, 2006.
[8] Singgih S. Wibowo, Calculation of Aerodynamic Parameter of RX 250 LAPAN Rocket and
Analysis of its Dynamics, Undergraduate Thesis, Department of Aeronautics and
Astronautics, Bandung Institute of Technology, 2002. (in Bahasa Indonesia)
[9] Ony Arifianto, Adaptive Control Design for Yaw Damper and Turn Coordinator, Case
Study: N-250 PA-2 Aircraft, Undergraduate Thesis, Department of Aeronautics and
Astronautics, Bandung Institute of Technology, 1997. (in Bahasa Indonesia)

Paper
[10] Singgih S. Wibowo, Optimal Path Tracking Control for Autonomous Helicopter using
LQR, Unpublished Paper, Department of Aeronautics and Astronautics, Bandung
Institute of Technology, 2004.

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach
References 100

[11] Singgih S. Wibowo, Effect of Weighing Matrix in Error Tracking for Autonomous
Helicopter, Unpublished Paper, Department of Aeronautics and Astronautics, Bandung
Institute of Technology, 2004.
[12] Singgih S. Wibowo and Hari Muhammad, Real-Time Simulation with Virtual Reality
Visualization, National Conference in Computational Technology-BPPT, 2006.
[13] Singgih S. Wibowo, Hari Muhammad and Said D. Jenie, Simulation with VR
Visualization of WiSE Craft during Takeoff Maneuver, The Sixth Asian Control
Conference-Bali, 2006.

Online Resources
[14] www.control.lth.se/~kursdr/matlab/matlabref.pdf
[15] www.ee.unlv.edu/kevin/index_files/tutorials/matlab_tutorial.pdf

Other Documents
[16] MATLAB 7.0 Help Documentation

Aircraft Flight Dynamics, Control and Using MATLAB and SIMULINK: Cases and Singgih Satrio Wibowo
Simulation Algorithm Approach

You might also like