Robust UAV Controller Design Thesis
Robust UAV Controller Design Thesis
A THESIS SUBMITTED TO
THE GRADUATE SCHOOL OF NATURAL AND APPLIED SCIENCES
OF
MIDDLE EAST TECHNICAL UNIVERSITY
BY
ANNA PRACH
SEPTEMBER 2009
Approval of the thesis:
Date: _______________
I hereby declare that all information in this document has been obtained and
presented in accordance with academic rules and ethical conduct. I also declare
that, as required by these rules and conduct, I have fully cited and referenced
all material and results that are not original to this work.
Signature :
iii
ABSTRACT
Prach, Anna
M.S., Department of Aerospace Engineering
Supervisor: Prof. Nafiz Alemdaroğlu
This study describes the design and implementation of the pitch and roll autopilots
for a fixed wing unmanned vehicle. A Tactical Unmanned Aerial Vehicle (TUAV),
which is designed at the Middle East Technical University (METU), is used as a
platform. This work combines development of the classical and robust controllers,
which are used for the pitch and roll autopilots. One of the important steps in the
thesis is development of the non-linear dynamic model of the UAV, which is
developed in MATLAB/Simulink environment. Two different strategies of the
controller design imply development of the PID and controllers. Simulation
results illustrate the performances of the designed controllers. Simulation is
performed for the nominal model of the UAV and for the model that includes
uncertainties and sensor noises.
iv
ÖZ
Prach, Anna
Yüksek Lisans, Havacılık ve Uzay Mühendisliği
Tez Yöneticisi: [Link] Alemdaroğlu
Bu tez sabit kanatlı bir Insansız Hava Aracının (IHA) yunuslama ve yalpalama
otopilotu tasarımının tasarım ve uygulanmasını anlatmaktadır. ODTU’de tasarlanan
bir taktik İHA (TİHA) uygulama platformu olarak kullanılmaktadır. Bu çalışma
yunuslama ve yalpalama harekteleri için klasik ve gürbüz kontrolcü tasarımlarını
içermektedir. Bu tezde aynı zamanda IHA’nın doğrusal olmayan dinamik modeli
MATLAB/SIMULINK ortamında geliştirilmiştir. Bu kapsamda PID ve
v
In Living Memory of M. J. …
vi
ACKNOWLEDGMENTS
I would like to express gratitude to my advisor, Prof. Dr. Nafiz Alemdaroğlu, for his
valuable support and encouragement. Thanks to him I got an opportunity to start my
master program at this university. I am very thankful to Dr. Volkan Nalbantoğlu, for
his continuous guidance and supervision throughout this work. I want to express
special gratitude to Dr. Ilkay Yavrucuk for his valuable suggestions and help that
enabled me to complete my work successfully.
Lastly, I want to express my love and gratitude to my family for understanding and
love through the duration of my studies.
vii
TABLE OF CONTENTS
ABSTRACT................................................................................................................iv
ÖZ.................................................................................................................................v
ACKNOWLEDGMENTS..........................................................................................vii
TABLE OF CONTENTS...........................................................................................vii
LIST OF TABLES………………………………………………………………….xiv
LIST OF FIGURES………………………………………………………………....xv
LIST OF SYMBOLS………………………………………………………………xxi
CHAPTERS
1. INTRODUCTION........................................................................................1
2.1 Platform...............................................................................................5
viii
2.8 Atmosphere Model.............................................................................20
Representation....................................................................................22
3.3 Sensors...............................................................................................39
Controller...........................................................................................40
Performance............................................................................42
Performance............................................................................48
ix
3.6 Command Filter Implementation for a Control System....................51
Implementation...................................................................................52
Implementation...................................................................................55
Systems)…………………………………………….……….69
x
[Link] Robust Performance (RP)..............................................71
Systems).................................................................................72
4.3 Design........................................................................................74
4.4 Analyses……………………........................................................76
Autopilot........................................................................88
Analysis….....................................................................92
xi
[Link] Performance of the Robust Controller for Roll
Autopilot........................................................................98
Analysis…………………………………….………...102
System..............................................................................................103
Implementation.....................................................................103
Implementation.....................................................................107
5.2 Performance Issues for the Nominal Model with a Command Filter
Implementation...............................................................................115
Uncertain Plant.................................................................................119
xii
5.4 Performance Comparison of PID and Robust Controllers with a
6. CONCLUSIONS......................................................................................126
REFERENCES.........................................................................................................130
APPENDICES
xiii
LIST OF TABLES
TABLES
Table 4.2 Lower and Upper Bounds and Critical Frequency................................ 103
xiv
LIST OF FIGURES
FIGURES
Figure 2.5 Power, Torque and SFC vs. RPM of Limbach L 275 E........................ 19
xv
Figure 3.3 Basic Controller Configuration............................................................. 41
xvi
Figure 4.2 Schematic Block Diagram of an LTI System........................................ 60
xvii
Figure 4.23 Step Input Response of the Nominal Plant: Pitch Angle..................... 89
Figure 4.32 Step Input Response of the Nominal Plant: Roll Angle...................... 99
xviii
Figure 4.44 Ailerons Deflection............................................................................. 108
Figure 5.3 Elevator Deflection Rate for a Unit Step Input..................................... 112
Figure 5.6 Ailerons Deflection Rate for a Unit Step Input..................................... 115
Figure 5.8 Elevator Deflection for the Command Pitch Angle.............................. 116
Figure 5.9 Elevator Deflection Rate for the Command Pitch Angle...................... 117
Figure 5.11 Ailerons Deflection for the Command Roll Angle.............................. 118
Figure 5.12 Ailerons Deflection Rate for the Command Roll Angle..................... 119
xix
Figure 5.20 Elevator Deflection Response ............................................................ 124
xx
LIST OF SYMBOLS
xxi
CHAPTER 1
INTRODUCTION
Unmanned Aerial Vehicles (UAVs) are one of the fastest growing sectors of the
world’s aerospace industry. High demand for UAVs in the commercial industry
arises by taking into account the advantages of UAVs over manned aircraft: low
manufacturing and operational costs of the systems; elimination of the aircrew and
related life support systems allows UAVs to be smaller than manned aircraft [1] and
eliminates the risk of human lifes in difficult and dirty missions [2]. Removal of
aircrew and their support systems means that UAVs are capable of flying longer,
higher and faster without endangering lives. Furthermore, they promise better cost-
effectiveness and greater utility than manned aircraft [3]. Some of the military and
civil applications of UAVs are listed below [2].
Military applications: reconnaissance surveillance and target acquisition (RSTA),
surveillance for peacetime and combat Synthetic Aperture Radar (SAR), deception
operations, maritime operations (naval fire support, over the horizon targeting, anti
ship missile defense, ship classification), UCAV (Unmanned combat air vehicle)
applications, meteorology missions, route and landing reconnaissance support,
electronic warfare (EW) and SIGINT (SIGnals INTelligence), radio and data relay.
Civil applications: security, search and rescue, wild fire suppression, topographical
material and agriculture, communications relay, disaster and emergency
management, industrial applications, etc.
Unmanned Aerial Vehicles rely on two basic approaches in implementing unmаnned
flight-autonomy аnd pilot-in-the-looр - which rely predominantly on microрroсessor
1
and communication technologies, respectively. Both are used in differing lеvеls in
UАV’s fields, together they compensate the absence of an onboard pilot and thus
enable unmanned flight [4]. Autonomy of UAVs requires efficient and accurate
control systems. One of the most important steps in control system design is the
development of the aircraft model. The full model of an aircraft includes models of
its subsystems such as: aerodynamics, propulsion, actuators. Development of the
dynamic model of a UAV is of primary importance. For an accurate dynamic model
it is necessary to have accurate data of UAVs’ aerodynamics, which can be obtained
by various means such as wind tunnel tests, CFD analyses or calculated by empirical
formulas [5]. Physically an aircraft is a complicated system, which includes variation
of its aerodynamic coefficients, sensor noise, and limited information of the system.
Controllers designed with PID methods are unable to take into account errors in the
system modeling and signal uncertainties. In cases, when it is impossible to obtain an
accurate aerodynamic data for dynamical modeling of a UAV or there are
simplifications used in the modelling (linearization of nonlinear dynamics), classical
controller, implemented to the actual physical system, might not show the desired
performance. Robust control theory provides methods for designing controllers that
would produce accurate and fast response in the face of uncertainties or disturbances
in the plant model.
The main objective of this thesis is the development, implementation and comparison
of performances for pitch attitude and roll autopilots for the simulation of the METU
TUAV, designed by means of classical and robust control theories. The problem for
a controller design for the METU TUAV is the absence of an accurate data of the
UAV’s aerodynamics. In [6] aerodynamic coefficients and derivatives are obtained
by empirical formulas. [7] provides the aerodynamic data obtained by wind tunnel
test for a very similar UAV SCAUT, designed and developed at Politecnico Di
Torino, which has similar geometrical properties to the METU TUAV. The purpose
of this thesis is the comparison of performances of the PID controller and robust
controller. Simulations are performed for the nominal model of the UAV and the
2
models, which include uncertainties and sensor noise. Uncertainties are assumed to
be present in the aerodynamic coefficients of the UAV.
In the literature, many different approaches can be seen related to the autonomous
control of UAVs. In [8] Andrievsky B.R [Link]. propose an algorithm of a combined
adaptive controller, which uses both adaptation methods based on the parameter
identification and variable-structure control technique. In [9] authors introduce flight
control system is based on PID controller and uses gain scheduling algorithm based
on the airspeed to improve performance of the controller. In [10] PID controller is
used for autonomous landing for the METU TUAV. Model inversion is used in
landing algorithm. S. Kurnaz [Link]. [11] introduce fuzzy logic based control system
for an autonomous UAV system. Robust nonlinear controller design is employed in
[12] by M. Sadraey [Link]. [13] by Etkin B. describes design of a robust flight control
system for a mini-UAV using coupled stability derivatives.
This thesis is organized as follows: Chapter 2 includes the modelling of the UAV, its
mass-inertia properties. Dynamic model is based on the 6-DOF equations of motion.
Aerodynamic data is used from the reference [7]. Mass-inertia properties are taken
from [6]. UAV model also includes models of actuators, gravity and atmosphere.
Engine model is developed using the experimentally obtained data. Chapter 3
examines the basics of classical control theory, defines requirements to the control
system. It also covers the design of PID controllers for the pitch and roll autopilots
and simulation by a linear environment for a nominal model; command filter
implementation to the control systems. Theoretical background to the robust control
theory, definition of uncertainties, design techniques are reviewed in Chapter 4.
This chapter also contains the design of robust controllers for pitch and roll
3
• Development of the nonlinear dynamic model of the METU TUAV, its
linearization and investigation of the open-loop response.
• Design and implementation of pitch and roll autopilots based on PID
controllers.
• Design and implementation of pitch and roll autopilots, which use the
controllers based on robust technique.
4
CHAPTER 2
2.1 Platform
The platform used in this thesis is the METU tactical UAV system which is
developed with the initial funding provided from the State Planning Office (DPT) in
2004. The UAV is designed and manufactured in the Aerospace Engineering
Department of Middle East Technical University and is practically near its
completion. The first flight is foreseen within 2009 or early 2010. The UAV is
completely manufactured from composite materials, using fiber glass, carbon fiber
and Kevlar clothes as composite materials. The aircraft has a fuselage and a high
wing configuration and a twin boom T tail configuration. The booms are also
manufactured from composite material using filament winding technique. The basic
geometrical dimensions and the technical characteristics of the tactical UAV is given
in the following Table 2.1. The maximum take off weight of the UAV is estimated as
120 kg. However, this may be slightly less than this predicted value. The final weight
will be definite when the aircraft is fully completed. The total payload capacity of the
5
UAV is about 30 kg and is sufficient to carry a daylight and an IR camera mounted
in a gimbal system. Besides these Electro Optical (EO) payload system envisaged at
this stage other useful payload systems can easily be integrated into the UAV since
there is enough payload volume within the fuselage. The aerodynamical control
surfaces of the aircraft includes left and right ailerons, left and right flaps, left and
right rudders and an elevator. All these control surfaces are actuated by means of
servomotors with sufficient torque capacity. The take off and landing of the UAV is
foreseen to be conventional at this stage. However, in the near future this capability
will be augmented by incorporating catapult launch and parachute recovery systems
into the UAV. The UAV is equipped with steerable front and fixed main landing
gears having hydraulic breaking capability. All of the landing wheels are flight
qualified. The aircraft is a pusher configuration with the engine mounted at the rear
of the fuselage in between the tail booms. The engine used is gasoline powered
Limbach L 275 E engine producing 21 HP of output. It is a two stroke cycle opposed
twin cylinder engine (boxer engine) where each cylinder is operated by separate
carburators. Due to this fact each cylinder operates individually and in case of failure
of one of the cylinders the other cylinder produces enough power to propel the
aircraft. The preliminary ground tests of the engine and the propeller system shows
that a total thrust of about 40 kg is obtained from the engine at normal ground level
operations. This much thrust is more than enough for flying the UAV. The aircraft
can be operated remotely line of sight by radio control or by auto pilot.
Characteristics of the METU TUAV system are the following:
• Conventional take off and landing from runway
• Autonomous Flight
• 2 stroke cycle, 2 opposed cylinders, dual carburator IC engine delivering 21 HP
• Electro-optical and infrared camera inside a Gimbal system
• Real time video downlink to ground station
• Fully composite structure
6
Figure 2.1 METU Tactical UAV
7
2.2. Reference Frames and Coordinate systems
The following frames and systems are of primary importance for the modeling of the
vehicle dynamics.
Inertial reference frame is fixed or in uniform rectilinear translation, relative to the
distant stars; in it Newton’s second law is valid for the motion of a particle [13]. If
the rotation of the Earth is neglected and the surface is assumed to be flat an Earth-
surface reference frame is considered as an inertial frame, with origin near the
vehicle if possible and with axis directed vertically down. x- and y-axis is the
local horizontal plane, x-axis points north and y-axis points east. Vehicle’s position
is calculated with respect to the inertial frame.
Navigation frame (north-east-down frame), also called as vehicle-carried frame, is
used the reference frame in which the origin is attached to the vehicle (usually at the
center of gravity), z-axis points down along the local gravity vector, x-axis is
directed north and y-axis is directed east.
If the aircraft is considered as a rigid body, it is represented by a frame, the so-called
body frame. Although this frame is not used as a reference, it is nevertheless
important [14]. The body coordinate system is used for deriving the equations of
motion of the vehicle. The origin of this coordinate system is at the center of gravity
of the airplane, x-axis points through the nose of the vehicle and lies with the
downward pointing z-axis in the plane of symmetry, y-axis, out the right wing,
completes the coordinate system.
Transformation from navigation frame to the body frame is composed of three
transformations, which are represented by so-called Euler angles: yaw, pitch and roll,
or , and . The first rotation is around the z-axis of the navigation frame by
angle , second rotation is around the y-axis of an intermediate frame, obtained
after the first rotation by the pitch angle and the last rotation is around the x-axis
8
The transformation matrix:
Wind coordinate system is frequently used for defining aerodynamic forces and
moments acting on the aircraft. x-axis is parallel to the free-stream velocity vector.
Transformation from the wind axis to body is composed of two rotations: by angle
around the z-axis of the wind coordinate system and rotation by angle
around y-axis such that it coincides with the body axis. Angles and are called
angle of attack and sideslip angle. The transformation matrix from the wind axis to
body:
its origin at the airplane center of mass. The vehicle is assumed to be a rigid body
with six degrees of freedom. Three translational degrees describe the motion of the
center of mass and three attitude degrees describe the orientation of the vehicle.
Plane XZ is a plane of symmetry of the airplane, therefore .
The scalar force equations of motion in the airplane body-fixed axis system [15]:
Force along X:
(2.1a)
9
Force along Y:
(2.1b)
Force along Z:
(2.1c)
The scalar moment equations in the airplane body-fixed axis system:
Rolling moment about :
(2.2a)
(2.2b)
(2.2c)
Kinematic equations:
Roll rate about :
(2.3a)
Pitch rate about :
(2.3b)
Yaw rate about :
(2.3c)
In scalar force equations of motion forces X, Y and Z include aerodynamic forces
and propulsion forces.
10
Experimental methods have a great advantage of allowing rather accurate predictions
of full-scale airplane aerodynamic behavior over a wide range of flight conditions,
including nonlinear effects. A disadvantage of experimental methods is that their cost
is very high, both in time and in money. Therefore, in most preliminary design and
parametric design studies theoretical and empirical methods are used [15].
The main emphasis is on the so-called build-up method for modeling aerodynamic
and thrust forces and moments. In this method, the airplane is assumed to be built up
from a number of components. The total forces and moments, which act on the
airplane, are then assumed to follow from summing the forces and moments, which
act on these components. In these terms, aerodynamic coefficients can be expressed
as follows:
(2.4)
Figure 2.2 illustrates the longitudinal aerodynamic forces and moments that act on
the airplane in a steady state flight condition. In the stability axis system, these forces
and moments are written as:
Longitudinal force in x-direction:
(2.5)
11
(2.8)
(2.9)
(2.10)
where: is the total airplane drag coefficient; is the total airplane lift
coefficient. Total airplane drag and lift coefficients are the functions of the angle of
attack, , pitching rate, , elevator and flap deflections, , , Mach number and
number, and moment reference center (usually the center of gravity) location.
12
For an airplane equipped with an elevator and flaps, the drag coefficient is expressed
in terms of the first order Taylor series [15]:
(2.11)
where - the value of airplane drag coefficient for zero angle of attack, zero
attack, .
- the change in airplane drag due to elevator deflection .
Similarly, the lift coefficient, , can be expressed in terms of a first order Taylor
series as follows:
(2.12)
where:
- the value of airplane lift coefficient for zero angle of attack, zero control
surfaces deflections.
- the change of airplane lift due to a change in airplane angle of
attack, .
- the change in airplane lift due to change in elevator angle.
coefficient due to a change in angle of attack, it is also called the static longitudinal
13
stability derivative. It is of major importance to airplane stability and controls [15].
Another important derivative, which effects airplane stability is , also called the
pitch-damping derivative.
The steady state model for the aerodynamic force in the stability x-axis direction is:
(2.14)
The steady state model for the aerodynamic force in the stability z-axis direction is:
(2.15)
The steady state model of the aerodynamic pitching moment in stability axes is:
2.16)
It should be noted that the stability y-axis coincide with the body-fixed y-axis,
therefore .
Lateral-directional force and moments that act on the airplane are shown in Figure
2.3.
In stability axis system, aerodynamic lateral-directional force and moments are
written as follows:
Aerodynamic rolling moment:
(2.17)
For steady state flight conditions these force and moments are non-dimensionalized
as:
(2.20)
14
(2.21)
(2.22)
15
In terms of the first order Taylor series, these coefficients can be expressed as
follows:
(2.23)
(2.24)
(2.25)
The coefficients and derivatives are defined in a similar way as for the longitudinal
stability coefficients and derivatives.
The derivative is called the airplane effective dihedral; this derivative plays a
2.27)
(2.28)
The values of the aerodynamics coefficients and derivatives are taken from the
reference [7], which contains wind tunnel test data, performed for analog airplane
16
SCAUT at Politecnico di Torino, Italy. Gaphs for the aerodynamic coefficients and
derivatives may be found in the Appendix A.
The mass inertia model contains the mass of the airplane and its tensor of inertia.
The mass is lumped and concentrated at the center of gravity (c.g.) location and the
inertia tensor is calculated with respect to the c.g.
Table 2.2. includes maximum take-off gross weight, fuel weight and moments of
inertia of the MTUAV [6].
The change of the gross weight and c.g. location of the MTUAV is neglected for
simulation purposes. Change in the c.g. location is very small, and its position moves
towards the nose of the airplane during the flight, increasing longitudinal stability of
the aircraft. Moments of inertia are considered to be constant for all time of
simulation.
2. 6 Propulsion Model
17
The propulsion model of the METU TUAV is represented by the engine model and
propeller model. METU TUAV uses two-cylinder engine Limbach L275 E shown in
the Figure 2.4
Characteristics of the engine are obtained from [16] and presented in the Figure 2.5.
Characteristics include required power ( ), torque and specific fuel consumption
(SFC) dependence on RPM. The data are shown for RPM variation from 4000 to
7200. It is assumed that the dependence of required power and SFC on RPM for
RPM is less than 4000 is linear. Fuel consumption (FC) can be found as follows:
(2.29)
(2.30)
18
power coefficient
(2.31)
advanced ratio
(2.32)
Thrust and power coefficients and geometric properties of METU TUAV propeller
sections can be found in [6].
Figure 2.5 Power, Torque and SFC vs. RPM of Limbach L 275 E
19
The actuators servo are assumed to be a first order servo with a transfer function
(2.33)
Dynamics of control surfaces (elevator, ailerons and rudder) is assumed faster than
dynamics of a UAV, the bandwidth T has been chosen equal to 30 rad/s. The inputs
to the actuators are subjected to the strict limits on the range of variations that can be
achieved. These limitations include physical limitations on the actuators themselves
and also ensure the system of being damaged [55]. Elevator deflection is constrained
up to , rudder and ailerons deflection is limited to .
Atmosphere model is used for developing more accurate aerodynamic model of the
vehicle. The main parameter that has an influence on the aerodynamic and thrust
forces and moments is air density , which depends on altitude. The altitude range
for MTUAV is 10 km. Change in air temperature, pressure and viscosity has a
secondary effect upon the aerodynamic and thrust forces and moments.
For simulating atmosphere effects Aerospace blockset of MATLAB/Simulink
provides a COESA Atmosphere Model block. The COESA Atmosphere Model block
implements the mathematical representation of the 1976 Committee on Extension to
the Standard Atmosphere (COESA) United States standard lower atmospheric values
for absolute temperature, pressure, density, and speed of sound for the input
geopotential altitude. Below the geopotential altitude of 0 m and above the
geopotential altitude of 84852 m temperature values are extrapolated linearly and
pressure values are extrapolated logarithmically. Density and speed of sound are
calculated using a perfect gas relationship. More information can be found in [17].
20
The Earth model blocks available in the Aerospace Blockset. WGS84 Gravity Model
block implements the mathematical representation of the geocentric equipotential
ellipsoid of the World Geodetic System (WGS84). The block output is the Earth's
gravity at a specific location.
Use of the WGS84 Close Approximation model should be limited to a geodetic
height of 20000 m. Below this height, it gives results with high precision. More
specific information about the Earth gravity model is present in [20].
21
density, and speed of sound for the given altitude. Gravity model provides the Earth's
gravity information.
Using the small disturbance theory, the nonlinear equations of motion of the airplane
are linearized for small disturbances around an equilibrium point of the airplane.
22
The steady-level-flight condition is chosen for the trim analysis. Under certain
assumptions, equations of motion can be uncoupled and airplane longitudinal and
lateral dynamics can be analyzed separately. Existence of pure longitudinal motion
requires three approximations and assumptions: the flat-Earth approximation,
existence of a plane of symmetry and absence of rotor gyroscopic effects. Existence
of the uncoupled lateral motions besides the restrictions above also requires
neglecting all aerodynamic cross-coupling terms (which may not be strictly equal to
zero) [14].
Linearization of the nonlinear model of the METU TUAV has been done using the
Simulink Control Design tools. Linearization is the approximation of a nonlinear
system as a linear system, based on the assumption that the system is almost linear
within a certain range of operation. Linearization is performed around certain
equilibrium point (or trim condition) of the nonlinear system.
Trim condition used for linearization task is given below:
velocity in x-direction in body axis , velocity in z-direction in body
Consider the state space representation of the longitudinal dynamics. The states are
, the input is elevator deflection and the outputs are
. Expression for a state matrix and input matrix are the following:
23
For a trim condition described above, longitudinal state matrix and input
Roots of the characteristic equation of the airplane (eigenvalues) are equal to:
The pair of roots of the characteristic equation that are located more far away from
the imaginary axis and have a greater absolute value is referred to as a short period
mode. The other pair of roots of the characteristic equation, with a smaller imaginary
part that are located closer to the imaginary axis, defines a phugoid mode [18]. The
phugoid or long-period mode is the one in which there is a large-amplitude variation
of air-speed, pitch angle, and altitude, but almost no angle-of-attack variation. In
practice airplane is always under the action of disturbances caused by different
factors (pilot, control system etc.). The phugoid oscillation is really a slow
interchange of kinetic energy (velocity) and potential energy (height) about some
24
equilibrium energy level as the aircraft attempts to re-establish the equilibrium level-
flight condition from which it had been disturbed. The short-period mode is a very
fast, usually heavily damped, oscillation with a period of a few seconds. This motion
might be, for example, a rapid pitching of the aircraft about the center of gravity. The
period is so short that the speed does not have time to change, so the oscillation is
essentially an angle-of-attack variation [15]. Characteristics of the longitudinal
modes are given in Table 2.3.
States, which correspond to the lateral dynamics of an aircraft, are: side velocity in
body axis ( ), roll rate ( ), yaw rate ( ) and roll angle ( ). To control the lateral
motion ailerons and rudder are used. State and control matrices, which describe
lateral motion of an aircraft are as given below:
25
where
For a trim condition, lateral state and input matrices and are obtained as
follows:
26
The lateral motion of aircraft is described by 3 dynamic modes: roll mode, dutch-roll
mode and spiral mode.
The first two roots of the characteristic equation is a complex conjugate pair. This
pair is referred to as a dutch-roll mode, which is a coupled roll and yaw motion. This
mode is usually poorly damped.
The real root with a larger magnitude defines the roll mode. The roll mode consists
of almost pure rolling motion and is generally well damped. The real root which is
closer to the origin corresponds to the spiral mode, which is usually slow and
unstable. In order to reduce the impact of the spiral mode aircraft should have
sufficiently large wing dihedral, which increases roll stability. The lateral modes
characteristics are shown in the Table 2.4 and 2.5.
27
2.12 Open-Loop Simulation
28
Figure 2.7 System Response to Elevator Input: x-body Velocity
29
Figure 2.9 System Response to Elevator Input: Pitch Angle
30
Figure 2.11 System Response to Ailerons Input: y-body Velocity
31
Figure 2.13 System Response to Ailerons Input: Roll Rate
32
Figure 2.15 System Response to Ailerons Step Input
33
CHAPTER 3
34
Measured System System
Reference + error input output
Controller System
-
13
(3.1)
(3.2)
where u is the control signal and e is the control error (difference between the set-
point and output).
35
Input Error + Output
+ +
Process
- +
+
controller combines both PI and PD controllers and therefore includes the advantages
of both. Since PI controller performs its action in a low-frequency region and PD
controller – in a high-frequency region, PID controller can be used for design of
control systems in which it is required to improve characteristics of both transient
and steady state response [23].
Proportional term reduces the rise time and steady-state error (but never eliminates
it); it also attenuates noise at high frequencies. However, increasing the controller
gain makes system unstable. Adding an integral term adds a zero at the origin, which
makes the controller to have an infinite gain at zero frequency. The presence of a
pole at the origin of the complex plane allows the reduction to zero of the steady-
state error when a step reference signal is applied or a step load disturbance occurs.
Derivative term improves the closed-loop stability: reduces overshoot and settling
time of the system response, it has no effect on the steady-state error. Disadvantage
36
of a derivative term is its sensitivity to noise in the error term, so if noise amplitude
and the derivative gain are large system becomes unstable. More detailed
information about PID controllers is introduces in [25], [26], [27].
Considering representation of a PID controller as it is shown in (3.1), if denotes
the input to PID controller, then its output is a linear combination of , its
integral, and its derivative.
Presence of pure derivation action makes the controller transfer function not proper
and therefore it cannot be implemented in practice. The difficulty in designing PID
controller is in physical implementation of a derivative term. Very often, in practice,
proper approximation of a derivative term is used:
(3.3)
37
structure of a controller and it introduces a tuning technique for tuning of the
controller’s gains, so-called IMC-PID tunings. [30] provides the most comprehensive
summary of PID controller tuning rules to date. Tuning of the controller’s parameters
is performed after specifying the structure of the controller as well as the form of the
model used to represent the dynamic response of the controlled variables. Although
tuning rules that provide the best performance often vary from case to case, modern
rules such as IMC and direct synthesis tend to provide better results than traditional
techniques such as Ziegler Nichols or Cohen-Coon tuning. [31] covers PID controller
design for various systems, evaluates several existing PID tuning rules from the
robustness and fragility point of view. The range of system parameters is given for
each tuning rule such that the system remains stable when the PID parameters
deviate from the nominal value within the given range. This reference also provides
several examples to illustrate the design of PID control to satisfy time domain
performance specifications. [32] gives basics and fundamentals of PID control,
online model-free methods, with emphasis on the iterative feedback tuning (IFT)
method, nonparametric methods for PID tuning through the concept of relay
feedback, a well-known technique that experimentally locates critical points in the
frequency response that can then be used for controller tuning, it also covers the
topics of using of relay feedback for multivariable systems, parametric design
methods that assume that a transfer function model is available at the onset of the
design procedure. [36] and [37] include Ziegler-Nichols classical methods of PID
controllers design and their extensions; pole placement and other methods; auto-
tuning techniques. Reference [36] provides some adoptive techniques, which include
auto-tuning, gain scheduling and adaptation.
38
• Choosing actuators to drive the plant
• Developing mathematical models for plant, actuators and sensors
• Define control criteria
• Designing the controller, which is based on the developed models and control
criteria
• Check controller performance by simulation.
Control criteria usually include (see reference [22]):
• Reducing the effects of the disturbance of the output
• Steady-state errors
• Transient response characteristics
• Sensitivity to parameter changes in the plant.
Mathematical models of plant and actuators has been given in a previous chapter.
The following section describes sensors required for a controller synthesis and give
definition to a command filter.
The following requirements for the system response must be considered and satisfied
pending the controller design for METU TUAV:
• overshoot: < 10%
• settling time: < 3 sec
• rise time: < 1 sec
• steady state error: < 2%
3.3 Sensors
Onboard sensors are necessary to measure the states of the aircraft. The
measurements are performed with respect to certain reference frames (inertial frame,
Earth frame, body frame, etc.). Dynamics of inertial sensors, like accelerometers and
gyros, with a high bandwidth is usually neglected. These sensors are modeled as
simple gains [24].
The following sensors are available on the board of METU TUAV:
39
• Inertial Navigation System (INS) is used to obtain the position and
orientation of a vehicle. INS is an autonomous system. Inertial measurement
unit (IMU) typically includes three orthogonal accelerometers, and three
orthogonal gyros (usually rate-gyros). Inertial measurement unit gives the
information about linear accelerations and angular turning rates about the
airplane’s body axis. Euler angles are obtained by integrating body angular
rates. Position of the vehicle is calculated by integrating linear accelerations.
INS outputs also provide “steering commands to the autopilot to steer the
airplane through predetermined waypoints”. However, output of INS tends to
drift during the integration process: small errors in the measurement of
acceleration and angular velocity grow in time with integration. This leads to
significantly larger errors in position and orientation. This problem can be
eliminated by fusing INS with GPS. More detailed information about
characteristics and basic principles of INS can be obtained from [29].
• Global Positioning System (GPS), which gives accurate three-dimensional
position and velocity information. However, GPS is not autonomous system;
it is subjected to jamming. Integrating INS and GPS combines advantages of
both systems and eliminates the disadvantages. Therefore, data, obtained in
such a way, are reliable for navigation purposes.
• Airspeed indicator. The airspeed indicator or airspeed gauge is used in an
aircraft to display the aircraft’s airspeed.
• Altimeter is an instrument used to measure the altitude of an aircraft with
respect to a fixed level. Barometric altimeter (or pressure altimeter) uses an
aneroid barometer measures the atmospheric pressure from a static port
outside the aircraft.
40
The purpose of the pitch attitude autopilot is to follow the desired reference input and
maintain the pitch orientation of the aircraft after it has reached desired value. For
design purposes, linearized longitudinal dynamic equations are used for the
controller synthesis and simulation. Later performance of the controller is checked
for the 6-DoF nonlinear model of the airplane. Response of the control system
through the nonlinear simulation with comparisons to a robust controller response is
given in Chapter 5.
The basic block diagram for the closed-loop system of the pitch autopilot is shown in
Figure 3.3. Command input is first introduced into the closed-loop. A pitch angle
error is the input to the controller. It represents the difference between the system
output (measured pitch angle ) and the commanded pitch angle .
Command
Input Error A/C Output
PID Dynamics
Controller
-
41
Aircraft dynamics includes linearized longitudinal dynamics of the METU TUAV
and actuator model. Elevator deflection is used as a control surface.
Pitch angle to elevator deflection transfer function is obtained as:
(3.4)
(3.5)
where controller parameters (proportional gain, integral time and derivative time)
must be determined.
Negative sign indicates that a positive deflection of a control surface creates a
negative pitching moment therefore, negative pitch angle.
For determining the parameters of a PID controller, which is used in pitch attitude
control system, Ziegler-Nichols rule, based on step response of the plant, presented
in [3] is used. This method can be applied in case if its response to the unit step looks
like S-shaped curve, which is shown in the Figure 3.4.
42
Figure 3.4 S-shaped Response Curve
The response curve can be characterized by two parameters: delay time L and time
constant T, which are obtained by drawing a tangent line at the inflection point and
defining cross points as it is shown in Figure 3.4. Reference [3] gives formulas for
calculating , and based on values for L and T. It should be noted, that a PID
. However, the simulation does not show the desired response to the
pitch command. Having knowledge of how each parameter effects the response of
the closed-loop system, by manual tuning it is possible to adjust the values of the
43
parameters of the PID controller such, that the response curve would have a desired
shape. The following values of the parameters were obtained: , ,
(3.6)
It should be noted, that tuning of the PID controller’s coefficients is performed for
the nominal plant, however presence of a sensor noise is also taken into account in
simulation.
Phase and gain margins are illustrated in the Bode plot of the open-loop system in
Figure 3.5.
44
Figure 3.6 System Response to a Unit Step Input: Pitch Angle
Response of a closed-loop system to a unit step input is illustrated in Figure 3.6 and
has the following characteristics:
• overshoot: 10%
• settling time: < 3 sec
• rise time: < 1 sec
• steady state error: < 0.2%.
Elevator deflection and deflection rate for a unit step input is shown in Figures 3.7,
3.8.
45
Figure 3.7 Elevator Deflection for a Unit Step Input
46
From Figure 3.8 it is seen that the rate of elevator deflection is high at initial time of
the input, which is not desired in the physical system. This problem is solved by
using a command filter. Architecture of the command filter and its implementation
are described in section 3.6.
The basic function of the roll autopilot is to bring the airplane to a desired roll
orientation. Ailerons are used as a control surfaces. Design of the PID controller and
simulation is done using a linearized lateral dynamics of the METU TUAV. In
Chapter 5 performance of the PID controller is given on the nonlinear model in
comparison with nonlinear simulation of Robust controller.
(3.7)
47
(3.8)
of the closed-loop system is not satisfactory. Using these values as a start point,
manual tuning is performed to make a step response’s characteristics correspond to
the desired ones; noise attenuation is taken into account while tuning. The following
values of controller parameters are chosen: , , .
(3.9)
Figure 3.9 shows the Bode plot of the open-loop system, which provides information
about phase and gain margins and stability of the closed loop system.
Response of a closed-loop system in terms of roll angle, position and rate of ailerons
is illustrated in the Figures 3.10, 3.11, 3.12.
Response of the closed-loop system has characteristics listed below:
• overshoot: 7%
• settling time: < 3 sec
• rise time: < 1 sec
• no steady state error
48
Figure 3.9 Bode Plot of the Open-Loop System
49
Figure 3.10 System Response to a Unit Step Input Roll Angle
50
3.6 Command Filter Implementation for a Control System
Command filters are used in order to shape the command signal so its dynamics
matches the dynamics of the vehicle. If the command input is a step function (for
example pitch angle for a pitch attitude autopilot), this means that the rate of change
of the input (pitch rate) will be infinite. This might cause saturation of control
surfaces. The purpose of command filter is to smooth the input signal such an
airplane would be able to follow it (see Figure 3.13).
Command filters are low-pass filters. For the purposes of this thesis, second order
command filter is used. The transfer function for a second order low pass filter is
(3.11)
Command filters are frequently used in control systems and are well described in
literature. In [33] a time varying bandwidth (TVB) command shaping filter, which is
51
used to improve the tracking transient performance, is introduced. TVB filter limits
the actuator deflection rate to achievable values. Reference [34] explaines the usage
of a command filter in order to improve a system’s step response: command filter
removes high frequency components from a command input, therefore reducing the
overshoot of the response. Command filter does not cause a destabilizing action upon
a control system as it is located outside of the loop. [35] shows the way of using a
pre-filter in order to eliminate the effect of the zero of a closed-loop transfer function
on the step response. In reference [10] 2nd order command filter is employed to the
autolanding control system designed for the METU TUAV.
Figure 3.14 gives a block diagram of a closed-loop control system with a command
filter implemented.
Consider the block diagram of the control system as it is shown in Figure 3.14.
Aircraft dynamics includes a state space representation of the linearized longitudinal
dynamics of the UAV. Command input to a closed-loop system is given in Figure
3.15.
Filtered
Command Command
Input Error A/C Output
Command Input PID Dynamics
Filter Controller
-
52
Figure 3.14 Basic Controller Configuration with Command Filter
Nominal command for angle of attack is shaped by passing through a command
filter. Filtered command represents the desired change in pitch angle, which should
be provided by a PID controller in a closed-loop configuration. Response of the
closed-loop system that includes linear dynamics of the UAV to a given input is
shown in Figure 3.16. Control surface deflection and its rate are presented in Figure
3.17 and Figure 3.18 respectively. From the plots above it is seen that implementing
a command filter to the control system improves its response. Shaping the input
command decreases the control surface efforts required to bring an airplane to a
desired pitch attitude.
53
Figure 3.16 System Response to Pitch Angle Command
54
Figure 3.18 Elevator Deflection Rate
55
Figure 3.19 Roll Angle Command: Nominal vs. Filtered
56
Figure 3.21 Ailerons Deflection
57
CHAPTER 4
described.
Research in robust control theory has been one of the most active areas of modern
control theory since the late 70s. The first important works were made by Zames [38]
and Zames and Francis [39] in the late 1970s and early 1980s. Later this theory
became known as optimal control theory. The main idea was to find design
techniques that would provide stability of a closed-loop system under the system
uncertainties. Zames formulated three fundamental problems in robust control:
1) the uncertain disturbance attenuation problem, know as the standard problem;
58
The works of Athans [40], Safanov [41], Grimble [42] and others show how
uncertainty can be modelled and give the concept of the norm and -synthesis
theory. In 1987 B. A. Francis and John C. Doyle gave a modified solution to the
general rational MIMO optimal problem but suffered from the high order of the
Riccati equations [43], [44]. State space methods for solving the problem for
control problem and classical control was made in [46], in which loop shaping
design techniques were introduced. More detail and different perspectives can be
found in the books by Zhou, Doyle, and Glover (see references [47] ,[48]).
Consider a control system, block diagram of which is given in the Figure 4.1
In the Fig. 4.1 P is a generalized plant derived from the nominal plant but includes
weighting functions. P is also assumed Finite Dimensional Linear Time Invariant
(FDLTI) system; is a controller; is an external input signal, which includes the
reference signal, disturbances and noise; represents control signal; is a signal
that contains measured variables, and represents the error signals. It is assumed
that state space models of P and are available and that their realizations are
assumed stabilizable and detectable [47]. The goal of robust control design is to
minimize the norm of the transfer function from to under the constraint of
internal stability. The definition of internal stability will be given in further section.
59
z w
P
y u
K
Norms are used to characterize the size of signals or systems. The main purpose of
system norms computation is to get proper measures to compare the performance of
a control system, which can be based on the measure of the error signals, system
gains, etc.
Consider the block diagram of an LTI system in the Figure 4.2.
u(t) y(t)
G
60
norm: (4.1)
norm: (4.2)
norm: (4.3)
norm: (4.4)
Another important measure for signals is root mean square value (RMS). It reflects a
signal’s eventual average size:
(4.5)
Norms of systems are usually determined in terms of norms of input and output
signals (induced norms). For a stable SISO linear system the norm:
(4.6)
norm is a peak value in the Bode magnitude plot of the system. It provides a
bound on the system gain.
For a MIMO system is a rational transfer function matrix
. norm is defined as:
61
norm:
(4.8)
peak value of the largest_singular_value of the frequency response matrix over the
whole_frequency range [49].
The term “uncertainty” means that the mathematical model of the plant differs from
the actual physical model. It can be caused by few reasons: disturbance signals and
dynamic perturbations. Disturbance signals usually include input and output
disturbances (gust on the A/C), sensor noise, actuators noise. Dynamic perturbations
include the differences between the mathematical model and the actual system:
missing high frequency dynamics, system parameters errors or their variation in time,
etc.
Taking into account the model uncertainty it is assumed that the dynamic behaviour
of the plant is described by a set of possible LTI models is a set of all perturbed
plants. Consider the following notation for plant models:
: nominal plant model with no uncertainties;
: particular perturbed plant.
Assume that all the uncertainties (such as missing high frequency dynamics), that
may occur in different parts of the system, are lumped into one block , which is
represented by any stable transfer function with norm less than unity.
62
[Link] Additive Uncertainties
+
+
is a stable transfer function, which defines the magnitude of the uncertainty in all
frequency range. block represents a stable transfer function, which satisfies
.
63
Perturbed plant with a multiplicative uncertainty can be defined as:
(4.10)
(4.11)
64
structure of the perturbed plant is known: the whole set of possible perturbed
plants have the same structure as the nominal plant , but some of the
parameters are uncertain [21]. These uncertainties will affect the closed-loop system
performance at low frequencies.
(4.12)
65
(4.13)
, if is invertible.
When the inverse exists, then
(4.14)
66
P
K P
-
67
represents the plant to be controlled, block represents a controller,
represents a reference command, represents the error signal, represents
controller’s output, and represents disturbances and noise, and represents
system’s output.
Transfer function of a closed-loop system for a given feedback configuration is
defined as:
(4.16)
(4.17)
From relation (4.17) it is obvious that for a good tracking system gain has to be very
large.
68
4.2.6 Stabilization and Performance Requirements (SISO
Systems)
+ +
+
K P
-
69
[Link] Nominal Performance (NP)
NP means that the system satisfies the performance specifications with no model
uncertainty. NP implies that the norm of a transfer function from disturbances to
error must be small. For norm notation:
(4.18)
where is any stable transfer function which defines the magnitude of uncertainty.
The definition of RS is the following: the system is stable for all perturbed plants
about the nominal model up to the worst case of uncertainty. So if the controller K
internally stabilizes each of the perturbed plant including the nominal, robust
stability is guaranteed.
If the norm is used, condition for robust stability is the following:
, (4.19)
Small gain theorem is the basis for derivation of a robust stability test. Consider the
block diagram from the Figure 4.9 in a modified form. By isolating the block and
re-drawing the feedback connection, the block diagram of a feedback configuration
is obtained as shown in Figure 4.10.
Theorem: if and are stable linear systems, the closed-loop system is internally
stable if and only if for all .
70
.
The worst case for the condition above is when . Then the condition for RS
can be written in the form: .
e d
RS is:
(4.20)
RP implies that the performance specifications are satisfied for every perturbed plant
about the nominal model up to the worst case uncertainty. In other words RR
requires the NP condition to be satisfied for all possible perturbed plants.
71
For internally stable nominal feedback system NP condition is .
, then is perturbed to .
and , , .
Similar approach as for SISO systems is used for MIMO case. Conception of LFT is
used to derive stability and performance requirements for MIMO system.
For a general case hence both uncertainties and disturbances act upon the system the
following configuration as shown in Figure 4.11 is considered.
In the Figure 4.11, plant and controller are combined into block , which
represents the lower linear fractional transformation: .
(4.22)
72
w z w z
d
P e d
M e
u y
K
Condition for NS for a MMO system comes from the criterion for SISO system.
Transfer functions from all inputs to all outputs must satisfy NS conditions for SISO
case.
for NP is:
(4.23)
73
A criterion for RS is derived using the small gain theorem: if then
(4.24)
the norm:
4.3 Design
The main aim of robust design is to find a controller for the system, such that the
closed-loop system is robust.
Optimal control problem statement is the following: “find all the admissible
closed form solution. Therefore, instead of the problem statement given above,
another definition of control problem is used: “Given , find all admissible
74
Consider the system block diagram of which is shown in Fig. 4-1, where controller K
and plant G are assumed real rational and proper.
Consider the following realization of the transfer function matrix:
(4.26)
(4.27)
(4.28)
Theorem above gives necessary and sufficient conditions for existence of a controller
.
According to the theorem, if three conditions are satisfied there exist a controller
such that .
(4.29)
(4.30)
iii) (4.31)
75
When these conditions are satisfied, the controller is given by:
(4.32)
where
;
The following assumptions should be made for the derivation of the results of the
theorem:
1) is stabilizable
2) is detectable
3)
4) .
More detailed description of the solution of problem for a general case can be
4.4 Analysis
Consider the block diagram as it is shown in the Figure 4.12. The uncertainty block
in the structure connection usually has a block diagonal structure:
.
76
e d
where is a scalar and is an identity matrix, which has the same dimension as
the uncertainty .
77
(4.36)
The Structured Singular Value (SSV) , , was first suggested by Doyle in 1982 as a
way of analyzing systems with uncertainties. The SSV is defined as follows
(4.37)
Computation of a SSV is very difficult procedure; therefore, upper and lower bounds
on are used:
(4.38)
78
Still, the gap between spectral radius and largest singular value may be
arbitrary large, that is not acceptable. For this reason, it is necessary to define the
bounds by scaling in a way that will not affect but will affect and . In
(4.40)
Then the upper and lower bounds from (4.37) can be tightened to
(4.41)
More detailed information about the SSV and its bounds can be found in [48], [52].
Consider and are stable linear systems. Then the closed-loop system
is stable for all allowed uncertainties with if and only if
, (4.42)
79
P
Let be the plant after controller has been connected (see Figure 4.15)
80
(4.43)
81
4.5 Robust Controller Design for METU TUAV
The task is to design a pitch and roll displacement autopilots that will bring the
airplane to a desired pitch and roll orientations. The control inputs to the system are
elevator deflection for a pitch controller, and ailerons deflection for a roll controller.
Design of the robust controller involves the solutions of Algebraic Riccati Equations
(ARE) as it had been described in section 4.3. Therefore, design of controllers for
METU TUAV is performed using MATLAB Robust Control Toolbox. The toolbox
enables to compute a stabilizing controller K for a given plant P. For design
Consider the the block diagram of a closed-loop system as it is shown in Figure 4.18.
It is composed of weight function for multiplicative uncertainty of the actual
model, weight function for performance of the controller, for sensor noise,
a nominal model G, model error and controller K. It is assumed that the error is
82
not known, except that it satisfies the condition . For - synthesis control
system from Figure 4.18 can be expressed to a general plant shown in Figure 4.1.
Remind that the generalized plant P contains what is usually called the plant in a
control problem plus all weighting functions. The signal w contains all external
inputs, including disturbances, sensor noise, and commands, the output z is an error
signal, y is the measured variables, and u is the control input. The desired controller
K satisfies the nominal performance and robust performance.
+
ref output
K Act +
G
-
+
83
neglected. Weighting transfer function represents the multiplicative uncertainty,
it must be chosen such that the effect of the uncertainties of system’s parameters will
be represented in the best way. For the purposes of this work it is assumed that main
source of multiplicative uncertainty is in change of the parameters of the system. It
can be found from the Bode plots of the perturbed plants such that the Bode plot of
‘covers’ the Bode magnitude plots of all the plants with different combinations
of uncertainties. Weighting transfer function must be chosen such that the norm
(4.45)
84
parameter is assumed. (4.11) gives an expression for weighting function that
(4.46)
85
is chosen such that it would reflect frequency characteristics of the input signal
(4.47)
86
Weighting function represents effect of the sensor noise on the system’s output.
Assume 0.1% noise at low frequencies and 1% noise at high frequencies. Transfer
function of is obtained as:
(4.48)
87
Figure 4.22 Bode Plot of
Robust controller is designed using MATLAB “hinf” command, which computes the
controller. As a result the state-space model of the controller is obtained such
that the controller has 1 output, 1 input, and 8 states. Pitch angle response of the
nominal plant to the 1deg step command input, which is done by a linear simulation,
are given below in Figure 4.23. Deflection of the control surface that brings pitch
angle to the required value and deflection rate are illustrated in Figures 4.24, 4.25.
Step response characteristics of the closed-loop system with a nominal plant are the
following:
• overshoot: 2.89 %
• settling time: < 2.5 sec
• rise time: < 0.5 sec
• steady state error: < 0.4 %
88
Figure 4.23 Step Input Response of the Nominal Plant: Pitch Angle
89
Figure 4.25 Elevator Deflection Rate
90
Figure 4.26 Generic Tradeoff Between Uncertainty Level and Performance
less than 1 for all values of the the uncertain systems. A performance robustness
margin less than 1 means that certain values of the uncertain elements, within their
specified ranges, lead to an input/output gain greater than 1 ( see references [53],
[54]). “robustperf” provides the information about upper ([Link])
and lower ([Link]) bounds on performance margin and frequency at
which the minimum robust performance margin occurs, associated with upper bound
on performance margin; structure of values of uncertain elements associated with
[Link]. Another output arguments of “robustperf” command are
91
“Frequency vector” associated with analysis, cell array (same length as “Frequency
vector”), upper and lower bounds from “mussv”, structure of compressed data from
“mussv”. “mussv” is used to compute upper and lower bounds of the Structured
Singular Value.
Using the “robustperf” command for the closed-loop system shown in the Figure
4.18, for which plant is represented by the transfer function (4.45), the following
results are obtained:
Upper Bound: 0.9434
Lower Bound: 0.9434
Critical Frequency: 0.4921
“perfmargunc” is a structure of values of uncertain elements associated with the
hyperbola crossing. By substituting the values into the closed-loop system it can be
verified that this collection of values causes the closed-loop system norm to be
greater than or equal to the reciprocal of the performance margin upper bound:
perfmargunc = 1.0567
1/([Link]) = 1.0600.
Finally, plot of the bounds from “mussv” is illustrated in Figure 4.27.
The peak value is the reciprocal of the performance margin, and the frequency at
which the peak occurs is the critical frequency.
Consider the -analysis technique, described in the section 4.4. Extract the
( ) decomposition, and call “mussv” command on the appropriate channels of
M. In order to perform robust performance analysis a fictitious uncertain element
must be generated. This fictitious element is often referred to as the "performance
block." It should be a complex matrix-valued uncertain element with nominal value
of 0, and norm-bounded by 1.
92
Figure 4.27 Bounds for Robust Performance
The block diagram of the uncertain plant with performance block is shown in
"wrapped" around the input/output channels of the system under consideration, and
then a robust stability analysis is performed. Since the rows of uncertain elements
correspond to the columns of M, and vice-versa, the row dimension of the
performance block should be the column (input) dimension of closed-loop system.
Generating the performance block (denoted as “PerfBlock” in the code) and closing
the input/output channels of the closed-loop system with it a modified closed-loop
system is created by “lft” command. The modified closed-loop system has
following characteristics: 13 States, 0 Outputs, 0 Inputs, Continuous System.
It should be noted, that the modified closed-loop system has 0 inputs and 0 outputs
(this is expected), but has dependence on the original uncertain elements, as well as
the new performance block.
93
“lftdata” command is used to separate the uncertain system into a certain system M,
in feedback with a normalized block diagonal uncertain matrix (call it “NDelta”).
The structure of the block-diagonal matrix is described by another output argument
(“BlkStruct”), which will be used as the block structure argument to “mussv”. “frd”
command is used to compute a frequency response of M. The same frequency range
as in the “robustperf” analysis. “mussv” bounds for M are generated and their
plot is shown in Figure 4.28. It should be noted that the plot is identical to the plot
obtained from the “robustperf” analysis.
The performance margin is the reciprocal of the structured singular value. Therefore
upper bounds from “mussv” become lower bounds on the performance margin.
Making these conversions the bounds and frequency associated with the upper bound
of the performance margin are obtained.
94
For comparison compare the lower and upper bounds from “robustperf” and
“mussv” as well as the corresponding critical frequencies are given in Table 4.1.
“robustperf” “mussv”
Lower bound 0.934 0.934
Upper bound 0.934 0.934
Critical frequency 0.4921 0.4921
Consider the block diagram of a feedback control system as it is shown in the Figure
4.18. Plant G represents a transfer function from ailerons deflection to roll angle,
which is described by the following expression:
(4.49)
Reference input to the closed-loop system is a command roll angle. Output of the
closed-loop system is the measured value of the roll angle.
Procedure of determining weighting functions required for robust controller design is
similar to the procedure described above for the pitch autopilot. In order to derive
, consider 1% and 5% of uncertainty of system’s parameters that mostly effect
95
damping . Recall (4.11) for the expression for weighting function . Magnitude
(4.50)
Weighting function had been chosen in a similarly to the previous section and is
equal to:
96
(4.51)
97
Figure 4.31 Bode Plot of
As a result of the design procedure, the controller with 1 output, 1 input, and 8 states
is obtained. To estimate performance of the robust controller used for roll autopilot
consider response of the nominal plant to a step input of 1 deg, which is represented
in Figure 4.32. Simulation is performed for a linear environment. Ailerons
deflection, which corresponds to system’s response, and deflection rate are shown in
Figures 4.33, 4.34.
Step response characteristics of the closed-loop system with a nominal plant are the
following:
• overshoot: 2.55%
• settling time: 1.02 sec
98
• rise time: < 0.5 sec
• steady state error: 0.2%
Figure 4.32 Step Input Response of the Nominal Plant: Roll Angle
99
Figure 4.33 Ailerons Deflection
100
[Link] Robust Performance Analysis
101
Figure 4.35 illustrates the plot of the bounds from “mussv”. The peak value is the
reciprocal of the performance margin, and the frequency at which the peak occurs is
the critical frequency.
102
Table 4.2 Lower and Upper Bounds and Critical Frequency
“robustperf” “mussv”
Lower bound 0.9974 0.9974
Upper bound 0.9974 0.9974
Critical frequency 0.5460 0.5460
The lower and upper bounds from “robustperf” and “mussv” as well as the
corresponding critical frequencies are given below for comparison in Table 4.2.
From Figures 4.25 and 4.34 is seen that deflection rate of the control surfaces is too
high for realization in the actual physical system. Saturation of the control surfaces
and will make controller performance worse. Using a command filter in the control
system architecture helps to avoid this problem. Detailed information and structure
of the command filter used in simulation is given in section 3.5 of Chapter_3.
The block diagram of the control system with a command filter implementation is
shown in Figure 4.37 below. For simulation of the controllers performances
linearized models of longitudinal and lateral dynamics are used. Simulation using
nonlinear UAV model in comparison to a PID controller performance is presented in
Chapter 5.
103
Filtered
Command Command
Input Error Output
Input
Command Robust G
Filter Controller
-
The plant G as in Figure 4.37 represents a transfer function from elevator deflection
to pitch angle obtained from the linearized longitudinal dynamics of the METU
TUAV. Assume the input to the control system is as it is shown in Figure 4.38.
Response of the control system in terms of pitch angle to the given input is shown in
Figure 4.39. Elevator deflection and deflection rate are illustrated in Figures 4.40,
4.41.
From the simulation results it is seen that shaping the input command with a
command filter sufficiently decreases the rates of actuators making them to
correspond to the physical performance capabilities.
104
Figure 4.38 Pitch Angle Command
105
Figure 4.40 Elevator Deflection
106
4.6.2 Robust Roll Autopilot Performance with a Command
Filter Implementation
For the roll autopilot he plant G in Figure 4.18 consistes of the transfer function
from ailerons deflection to roll angle obtained from the linearized lateral dynamics of
the METU TUAV. Consider the following command input to the closed-loop system
as it is shown in Figure 4.42. Figures 4.43, 4.44 and 4.45 give the roll angle response,
ailerons deflection and rate of ailerons deflection, respectively.
107
Figure 4.43 System Response to a Roll Command
108
Figure 4.45 Ailerons Deflection Rate
Simulation results give similar conclusions, as made for the pitch autopilot:
implementing a command filter to the control system improves its performance in
terms of actuators behaviour, mainly by decreasing their rates.
109
CHAPTER 5
This chapter includes comparison of the controller designed using classical control
theory, and the controller designed by methods of robust control theory. Comparison
analysis of controllers’ performances is performed by nonlinear simulation.
Consider the response of the classical and robust controllers designed for a pitch
autopilot to a unit a step pitch angle command, which is represented by a pitch angle
response given in Figure 5.1 below.
Numerical values of performance characteristics of the PID and robust controllers
are listed in Table 5.1.
Change in elevator position and deflection rate for PID and robust controller for a
step pitch command is illustrated in Figures 5.2 and 5.3 respectively.
110
Figure 5.1 Pitch Angle Response to a Unit Step Input
111
Figure 5.3 Elevator Deflection Rate for a Unit Step Input
112
Consider response of the classical and robust controllers for roll autopilot to a unit
step roll angle command in terms of roll angle, ailerons deflection and ailerons
deflection rate, given in Figures 5.4 – 5.6, respectively.
Numerical values of performance characteristics of the PID and robust controllers are
listed in Table 5.2. Figure 5.4 shows that characteristics of the roll angle response for
the robust and PID controllers are satisfactory for the design requirements. However,
the actuators rate is high for the robust controller at initial moment of the input (see
Figures 5.6), which contradicts the performance capabilities of the physical system.
This problem is solved by implementing a command filter to the control system.
113
Table 5.2 Performance Comparison of Controllers for Roll Autopilot
114
Figure 5.6 Ailerons Deflection Rate for a Unit Step Input
This chapter gives the simulation results of the PID and robust controllers for a
nonlinear model of the METU TUAV using a command filter implemented to the
control systems.
Response to the filtered command input for the PID and the robust controllers
designed for a pitch autopilot in terms of pitch angle, elevator position and elevator
deflection rate is shown in Figures 5.7 – 5.9.
115
Figure 5.7 Pitch Angle Response
116
Figure 5.9 Elevator Deflection Rate for the Command Pitch Angle
Consider response to the filtered command of the PID and robust controllers
designed for the roll autopilot. Figures 5.10 – 5.12 illustrate change in roll angle,
ailerons position and rate of change, respectively.
117
Figure 5.10 Roll Angle Response
118
Figure 5.12 Ailerons Deflection Rate for the Command Roll Angle
Consider the nonlinear model of the METU TUAV, which has uncertainties due to
variation in aerodynamic derivatives. As it have been mentioned in the previous
chapters, the most important aerodynamic derivatives that effect stability of the
vehicle are static longitudinal stability derivative and pitch-damping derivative
uncertainty with respect to the nominal value of the parameter. Simulations are
performed for pitch and roll angle inputs as they are shown in the Figures 5.13 and
5.16 for pitch and roll autopilots, respectively. The results of simulations are
illustrated in the figures below.
119
Figure 5.13 Pitch Angle Step Response of Uncertain Model
120
Figure 5.15 Elevator Deflection Rate of Uncertain Model
121
Figure 5.17 Ailerons Deflection of Uncertain Model
122
Simulations results illustrate, that both PID and robust controllers, designed for pitch
and roll autopilots, perform equally well at tracking the input signal for the nominal
plant, and for the plant, which has the uncertainties in aerodynamic parameters. Such
results are expected from the robust controller, which takes into account model
uncertainties in design algorithm. However, it is seen that the PID controller is also
able to handle with system uncertainties.
Consider the case when there is a noise, present in the system. Assume, that the
sensors are the sources of the noise (sensor noise). The simulation for comparison of
the classical and robust controllers is performed for the nonlinear nominal model.
In order to compare performances of the PID and the robust controllers, designed for
a pitch attitude autopilot, consider responses of the PID and the robust control
systems. Simulation includes responses of the classical and robust control systems to
the input, which is shaped by the command filter as it is given in the Figure. Assume
presence of the sensor noise with a frequency of 100 Hz and standart deviation of
0.5% of the output nominal value.
123
Figure 5.19 Pitch Angle Response
124
Figure 5.21 Elevator Deflection Rate Response
Simulation results show that both PID and robust controllers show good performance
in tracking the input command. However, the PID controller is more sensitive to the
noise than the robust controller, it considers noise as a reference input and tries to
follow it. This is clearly seen from the position of the control surface, and its rate.
Minimization of the actuator’s efforts as well as taking sensor noise into account by
algorithm is performed systematically during the design of the controller.
As for the pitch autopilot, consider responses of the control systems, which use PID
and robust controllers, to the input command shown in the Figure 3.19. Simulation is
performed for the presence of sensor noise with a frequency of 100 Hz and standart
deviation of 0.5% of the output nominal value.
125
Figure 5.22 Roll Angle Response
126
Figure 5.24 Ailerons Deflection Rate Response
According to the obtained results, which are shown in the figures above, robust
controller shows satisfactory performance in terms of roll angle response, ailerons
position and ailerons deflection rate. PID controller illustrates good input tracking,
however it is more sensitive to the sensor noise than the robust controller, which is
reflected in actuator’s behaviour: ailerons deflection and its rate for the PID
controller exceeds the corresponding values for the robust controller.
127
CHAPTER 6
CONCLUSION
As a result of this work, the pitch and roll autopilots are designed for the METU
TUAV. Two different techniques are used for the autopilots design. PID controller is
developed by methods of the classical control theory and robust controller is
developed by the design technique. Performances of both types of controllers
128
uncertainties, which are present in the model parameters. The design technique,
which is used for the robust controller design, consideres the uncertainties of the
model’s parameters and the disturbances, which act upon the system. Two
approaches are used to establish robust performance of the robust closed-loop
system. The “robuststab” function gives the answer to the basic robustness
question: “is the closed-loop system stable or not?”. analysis is the mathematical
tool used to find the robust stability and robust performence margins. The “mussv”
function is used directly to compute the structured singular value , as a function of
frequency.
Simulation results provide comparison of the controllers performances. Simulations
are performed for the nominal model, for model that includes uncertainties due to
variation in aerodynamic derivatives, and for the case when sensor noise is taken into
account. It should be noted, that when sensor noise is present response of the
controller designed by technique is better than response of the control system
with a PID controller. The most efficient way to decrease sensitivity of the PID
controller to the noise is decreasing the derivative time . However, this effects the
response of the system by increasing overshoot and settling time. Therefore, a trade-
off decision should be made between system’s performance and its noise rejection
capabilities. Implementation of the command filter to the control systems has a
positive effect on their performances.
The following suggestions can be made for future work:
• implementation of the model into the open source code Flight Gear for a real-
time simulation
• verification of the dynamic model by the flight tests of the METU TUAV
129
REFERENCES
[1]. Barak J. Carlson, “Past UAV Program Failures and Implications for Current
UAV Programs”, Maxwell Air Force Base, Maxwell Air Force Base, AL: Air
Command and Staff College; Air University Rep. No.037/2001-04.
[2]. Zak Sarris, “Survey of UAV Applications in Civil Markets”, Technical
University of Crete, 2001
[3]. Koldaev A., Sokut S., “Russia: Military Conservatism in Relation to Industry
UAV Initiatives”, UAV Systems, The Global Perspectives 2006/2007, p.100
– 104.
[4]. “UAV Control Systems Hunger for Compute Density”, COTS Journal,
January 2006.
[5]. Roskam, Jan, “Airplane Design”, Roskam Aviation and Engineering Corp.,
1985.
[6]. Kargın, Volkan, “Design of an Autonomous Landing Control Algorithm for a
Fixed Wing UAV”, Master Thesis, Ankara : METU, 2007.
[7]. “Caratteristiche Aerodinamiche Modello SCAUT”, Politecnico di Torino,
2001.
[8]. Andrievsky B.R., A.L. Fradkov, “Combined Adaptive Controller for UAV
Guidance”, Proc. European Control Conference ECC 2003, University of
Cambridge, UK.
[9]. Fu Xu, Zhou Zhaoying, Xiong Wei, “MEMS-Based Low-Cost Flight Control System
for Small UAVs”, Tsinghua Science and Technology, vol.13, #5, 2008.
[10]. [Link], [Link],”Autolanding Strategies for a Fixed wing UAV Under
adverse Atmospheric Conditions”, American Institute of Aeronautics and
Astronautics, Guidance, Navigation and Control Conference, Honolulu, HI,
USA, August 2008.
130
[11]. S. Kurnaz, O. Cetin, O. Kaynak, “Fuzzy Logic Based Approach to Design of
Flight Control and Navigation Tasks for Autonomous Unmanned Aerial
Vehicles”, Journal of Intelligent and Robotic Systems, 2008.
[12]. M. Sadraey, R. Colgren, “Robust Nonlinear Controller Design for a
Complete UAV Mission”, AIAA Guidance, Navigation, and Control
Conference and Exhibit, Keystone, Colorado, Aug. 21-24, 2006.
[13]. Etkin, Bernard, “Dynamics of Atmospheric Flight”, New York, Wiley 1972.
[14]. Peter H. Zipfel, “Modeling and simulation of aerospace vehicle dynamics”,
AIAA, 2007.
[15]. Jan Roskam, “Airplane Flight Dynamics and Automatic Flight Controls”,
Lawrence, DARcorporation, 1995.
[16]. Limbach Flugmotoren website, “[Link] as accurate of 15
July, 2009.
[17]. U.S. Standard Atmosphere, 1976, U.S. Government Printing Office,
Washington, D.C., 1976.
[18]. А. Aslanyan, “Automatic Control Flight Control Systems of Vehicles”, Kiev,
1984.
[19]. Kotwani, K., Sane, S. K., Arya H. and Sudhakar, K., “Performance Mapping
of Mini Aerial Vehicle Propellers”, Indian Institute of Technology, Bombay,
India, 2004.
[20]. National Imagery and Mapping Agency, Technical Report 8350.2, Third
Edition, Department of Defence World Geodetic System, 1984.
[21]. Hitay Özbay, “Introduction to feedback control theory”, CRC Press, 2000.
[22]. Charles L. Phillips, Royce D. Harbor, “Feedback control systems”, Prentice
Hall, 1991.
[23]. Ogata, Katsuhiko, “Modern Control Engineering”, Prentice Hall, 2002.
[24]. Peter H. Zipfel, “Modeling and Simulation of Aerospace Vehicle Dynamics”,
AIAA, 2007.
131
[25]. Sellers, David, "An Overview of Proportional plus Integral plus Derivative
Control and Suggestions for Its Successful Application and Implementation",
Retrieved on 2007-05-05.
[26]. Kok Kiong Tan, Wang Qing-Guo, Hang Chang Chieh, “Advances in PID
Control”, Springer, 1999.
[27]. Antonio Visioli, “Practical PID Control”, Springer, 2006.
[28]. Morari, Manfred, “Robust Process Control”, Prentice Hall, 1989.
[29]. “Avionics Fundamentals”, Jeppesen and United Airlines, 2006.
[30]. Aidan O’Dwyer, “Handbook of PI and PID Controller Tuning Rules”,
Imperial College Press, London, 2003.
[31]. Guillermo J. Silva, Aniruddha Datta, S.P. Bhattacharyya, “PID Controllers
for Time-Delay Systems”, Birkhauser, Boston, 2005.
[32]. Cheng-Ching Yu, “Autotuning of PID Controllers: A Relay Feedback
Approach”, Springer, 2006.
[33]. Mickle, M. C ., Zhu, J. J., “Simulation Results for Missile Autopilot Design
Based on Extended Mean Assignment”, System Theory, Proceedings of the
Twenty-Eight Southern Symposium, 1996.
[34]. George Ellis, “Observers in Control Systems: A Practical Guide”, Academic
Press, 2002.
[35]. Richard C. Dorf, Robert H. Bishop, “Modern Control System”, Pearson
Prentice Hall, 2005.
[36]. Karl J. Astrom, Tore Hagglund, “Advanced PID Control”, ISA-The
Instrumentation, Systems, and Automation Society, 2006.
[37]. Karl J. Astrom, Tore Hagglund, “Automatic Tuning of PID Controllers”,
Instrument Society of America, 1988.
[38]. G. Zames, “Feedback and Optimal Sensitivity: Model Reference
Transformations, Multiplicative Seminorms, and Approximate Inverses”,
IEEE Trans. Automat. Contr., vol. AC-26, 1981.
132
[39]. G. Zames and B.A. Francis, “Feedback, Minimax Sensitivity, and Optimal
Robustness”, IEEE Transactions on Automatic Control, AC-28:585–600,
1983.
[40]. Athans, M., “The Role and Use of the Stochastic Linear-Quadratic-Gaussian
Problem in Control System Design”, IEEE Transactions on Automatic
Control AC-16, 1971.
[41]. Safanov, M.G., “Stability and Robustness of Multivariable Feedback
Systems”, M.I.T. Press, Cambridge, 1980.
[42]. Grimble, M.J. and Johnson, M.A., “Optimal Control and Stochastic
Estimation: Theory and Application”, Vols 1 and 2, John Wiley & Sons,
Chichester, UK, 1988
[43]. B. A. Francis, “A Course in H-infinity Control Theory”, Lecture Notes in
Control and Information Sciences, vol. 88, 1987.
[44]. B. A. Francis and J. C. Doyle, “Linear control theory with an H-infinity
optimality criterion”, SIAM J. Control Opt., vol. 25, 1987.
[45]. J. C. Doyle, K. Glover, P.P Khargonekar, B. A. Francis, “State-space
Solutions to Standard and Control Problems”, AC-34:831–847,
1989.
[46]. D.C. MacFarlane, K. Glover, “A Loop Shaping Design Procedure Using
-synthesis”, AC-37:759–769, 1992.
[47]. K. Zhou, J.C. Doyle, “Essentials of Robust Control”, Prentice Hall, 1998.
[48]. K. Zhou, J.C. Doyle, K. Glover, “Robust and Optimal Control”, Prentice
Hall, 1996.
[49]. D.-W. Gu, [Link]. Petkov, M.M. Konstantinov, “Robust Control Design with
MATLAB”, 2005.
[50]. J. C. Doyle, B. Francis, A. Tannenbaum, “Feedback Control Theory”,
Macmillan Publishing Co., 1990
133
[51]. S. Ariki, “A New System Invariant and an Algebraic Proof of the Standard
Problem”, Conference Proceeding, 35th Conference on Decision and
Control, 1996
[52]. Alok Sinha, “Linear Systems : Optimal and Robust Control”, Boca Raton,
FL: CRC Press, 2007.
[53]. The MathWorks website, “[Link] as accurate of July
28, 2009.
[54]. “Robust Control Toolbox for Use with MATLAB”, User’s Guide, The
MathWorks, Inc., 2001.
[55]. William S. Levine, “The Control Handbook”, CRC Press, IEEE Press, 1996.
134
APPENDIX A
This section contains values of the aerodynamic coefficients and derivatives, which
are used for the aerodynamic model of the UAV. These data were obtained by the
wind tunel tests for the SCAUT UAV at the Politecnico di Torino, Italy. METU
TUAV is very similar to SCAUT UAV by geometrical and mass-inertia properties.
Therefore, these data are assumed to be suitable for the purposes of the thesis.
= 1.46
= 3.9
= 0.4275
=0
=0
= 0.0741
135
Figure A-1. vs.
136
= -5.2
= -13.3
= -0.03
= 0.13
= 0.019
137
Figure A-4. vs.
138
= -0.87
= 0.13
139
Figure A-7. vs. for Different Ailerons Positions
= -0.03
= -0.099
140
Figure A-8. vs.
141
Figure A-10. vs. for Different Rudder Positions
142
APPENDIX B
(B-2.a)
(B-2.b)
(B-2.c)
Kinematic equations:
(B-3.a)
(B-3.b)
(B-3.c)
Assume the small perturbations on the states, forces and moments. The steady-state
values are denoted by subscript e (for equilibrium) and changes from them by the
prefix .
Motion variables:
143
(B-4)
Forces:
(B-5)
Moments:
(B-6)
Carrying out these perturbation substitutions into the general airplane equations of
motion (1.1) and (1.2) result in:
(B-7.a)
(B-7.b)
(B-7.c)
(B-8.a)
(B-8.b)
(B-8.c)
144
Following approximations are applied:
, , ;
(B-9.a)
(B-9.b)
(B-9.c)
(B-10.a)
(B-10.b)
145
(B-10.c)
The thin underlined terms in the equations above represent the general steady-state
equations of motion and assuming that they are inherently satisfied they can be
eliminated from without loss of generality. The double underlined terms are referred
to non-linear terms, which are assumed to be negligible compared with the linear
terms, therefore can be eliminated from the equations. The result is the following
equations:
(B-11.a)
(B-11.b)
(B-11.c)
(B-12.a)
(B-12.b)
(B-12.c)
where , , ,
146
Equations of motion can be uncoupled and airplane longitudinal and lateral dynamics
under certain assumptions. States that are referred to the longitudinal dynamics are
, the input is elevator deflection . States, referred to the lateral
State and input matrices that describe lateral dynamics are the following:
147
where
148