Professional Documents
Culture Documents
J.
A. Acosta,
R. Vazquez
J.
V
a
=
1
m
(D +F
T
cos mg sin) , (1)
=
1
mV
a
(L +F
T
sin mg cos ) , (2)
=q, (3)
q =
M(
e
)
I
y
, (4)
where m and I
y
are the mass and the inertia; V
a
is the
aerodynamic velocity; is the ight path angle; is the
pitch angle; q is the pitch angular velocity; F
T
is the engine
thrust and, nally, L, D and M(
e
) are the aerodynamics
forces lift, drag and pitching moment, respectively. In
Fig. 1 a detailed denition of the forces, moments, and
velocities are shown. Note that = , where is the
angle of attack.
Fig. 1. Denition of forces, moments and angles.
As usual in aerodynamic modeling, the aerodynamic forces
and moments are computed through their non-dimensional
coecients, as follows:
L =
1
2
V
2
a
SC
L
, D =
1
2
V
2
a
SC
D
, M =
1
2
V
2
a
S cC
m
, (5)
where is the air density, S is the reference wing surface,
c is the mean chord and C
L
, C
D
and C
m
are the lift, drag
and pitching moment coecients. Moreover, we consider
the following models for the drag and moment coecients
(see for instance Etkin and Reid (1996); Pamadi (2004)
and Schmidt (1998)):
C
D
=C
D
0
+k
1
C
L
+k
2
C
2
L
, (6)
C
m
=C
m
0
+C
m
+C
m
q
q +C
m
e
, (7)
where C
D
0
, k
1
, k
2
, C
m
0
, C
m
, C
m
q
and C
m
e
are aircraft
aerodynamic coecients, and
e
is the elevator angle. In
this work, C
D
0
, k
1
, k
2
, C
m
0
, C
m
and C
m
q
are considered
to be unknown parameters, while C
m
e
is known.
Regarding the lift coecient model, the following assump-
tion is done, which it is satised by conventional airplanes
in the non-stalled regime
1
.
Assumption 1. The lift coecient C
L
is only a function
of . The reference axis x
B
is chosen so that C
L
(0) = 0,
i.e. x
B
is parallel to the aircraft zero-lift line. Then, the
property x C
L
(x) 0 is satised for all x R.
3. CONTROLLER DESIGN
From a control viewpoint, (V
a
, , , q) R
4
is the state
vector and (F
T
,
e
) R
2
is the control input vector.
Thus, the control objective is to make the system seek
known references in velocity and ight path angle using
the elevator and thrust as control signals.
In order to simplify the controller design, we rst con-
sider velocity dynamics, given by Equation (1), and then
the pitch dynamics given by (2)(4). Thus, two dierent
controllers are designed: the aerodynamic velocity is con-
trolled using only thrust (F
T
) and the ight path angle
(pitch dynamics) is controlled with the elevator angle (
e
).
3.1 Control of aerodynamic velocity
Substituting the moment model D from (5) into (1), the
velocity dynamics reads
V
a
=
1
m
_
1
2
V
2
a
SC
D
+F
T
cos mg sin
_
. (8)
The engine thrust F
T
is the control input, while the and
are considered to be measurable. In addition, as is shown
in (6), the following drag model is considered:
C
D
= C
D
0
+k
1
+k
2
2
, (9)
where C
D
0
, k
1
and k
2
are unknown parameters. Denote V
r
to the reference velocity and dene the error z
V
:= V
a
V
r
.
Thus, the evolution of the error from (8) becomes
1
See for instance Abot and Von Doenho (1959), where an extensive
compendium of lift curves with this property can be found.
Preprints of the 18th IFAC World Congress
Milano (Italy) August 28 - September 2, 2011
1893
z
V
=
1
2m
(z
V
+V
r
)
2
S
V
()
T
V
+F
T
cos
m
g sin
V
r
=
1
_
z
2
V
+V
2
r
+ 2z
V
V
r
_
V
()
T
V
+F
T
cos
m
g sin
V
r
, (10)
where we have dened
V
() :=
_
1
2
T
,
V
:= [C
D
0
k
1
k
2
]
T
,
1
:=
S
2m
,
(11)
with
V
R
3
the unknown parameters vector, the vector
V
R
3
dened through the drag model (9) as C
D
=
V
()
T
V
> 0 and, the scalar parameter
1
> 0. Now
we are in position to state our rst result.
Proposition 1. Consider the system (10). Let
V
be the
estimate of
V
dened in (11), then the adaptative-state
feedback given by
F
T
=
m
cos
_
g sin +
V
r
+
1
(z
2
V
+V
2
r
)()
T
V
1
z
V
_
, (12)
V
=
1
_
z
3
V
+z
V
V
2
r
_
V
V
(), (13)
guarantees global boundedness of z
V
and
V
and conver-
gence of z
V
to zero.
Proof. Dene the Lyapunov function as
W
V
=
1
2
z
2
V
+
1
2
T
V
V
1
V
, (14)
where
V
:=
V
V
is the estimation error vector
and
V
=
V
T
> 0 is the adaptation gain matrix.
Thus, the derivative with respect to time of (14) along
the trajectories of (10) reads
W
V
=z
V
_
1
_
z
2
V
+V
2
r
+ 2z
V
V
r
_
V
()
T
V
+F
T
cos
m
g sin
V
r
_
+
T
V
V
1
V
=2
1
V
r
V
()
T
V
z
2
V
V
1
z
2
V
1
z
V
(z
2
V
+V
2
r
)
V
()
T
V
+
T
V
V
1
V
=2
1
V
r
V
()
T
V
z
2
V
V
1
z
2
V
+
T
V
_
V
1
V
1
z
V
(z
2
V
+V
2
r
)
V
()
_
, (15)
where we replaced F
T
by (12). By construction the rst
and second terms of (15) are negative and, the last term
is rendered zero through the adaptation law (13) and
noting that
V
=
V
. Thus, since W
V
is positive denite
and radially unbounded and
W
V
0 then, by LaSalle-
Yoshizawa theorem we conclude global boundedness of z
V
and
V
and convergence of z
V
to zero.
3.2 Control of the ight path angle
The pitch dynamics are governed by equations (2)(4),
which plugging (5) become
=
1
mV
a
_
1
2
V
2
a
SC
L
+F
T
sin mg cos
_
, (16)
=q, (17)
q =
V
a
S c
2I
y
_
C
m
0
+C
m
+C
m
q
q +C
m
e
_
, (18)
where the V
a
and F
T
are those obtained in the previous
step design of Subsection 3.1.
Assumption 2. The following usual assumptions are made:
- Since
ref
then it is assumed that cos =
cos
ref
, as proposed in reference Harkegard (2003).
-
ref
is assumed to be zero.
- The aircraft engines cannot produce negative thrust.
Thus, it is satised that F
T
0.
Under Assumption 2 the equation (16) becomes
=f() = f( ), (19)
where the scalar function f is dened as
f() :=
1
mV
a
_
1
2
V
2
a
SC
L
() +F
T
sin mg cos
ref
_
.
Property 1. Let
0
be the trim angle of attack, that is
f(
0
) = 0 when =
ref
, then, under the Assumption 1,
the function f() satises (
0
)f() > 0 . This trim
angle is supposed to be known.
The control objective is to make the equilibrium (, , q) =
(
ref
,
ref
, 0) asymptotically stable, where
ref
is given
and
ref
is computed from
ref
=
ref
+
0
. To design
the controller we shift the equilibrium to zero dening the
following set of error coordinates
z
1
=
ref
, z
2
=
ref
0
and z
3
= q. (20)
The equations (16)(18) in the new set of coordinates read
z
1
=(z
2
z
1
), (21)
z
2
=z
3
, (22)
z
3
=
2
(C
m
0
+C
m
(z
2
z
1
+
0
)
+C
m
q
z
3
+C
m
e
_
, (23)
where we dened
2
:=
V
2
a
S c
2I
y
and (x) := f(x +
0
).
Notice that the property 1 makes the scalar function (x)
to satisfy x (x) 0.
Remark 1. In Harkegard (2003), a backstepping control
law was designed for the cascade structure (21)(23), using
in (4) the aerodynamic moment model M as the control
input and, here, we use
e
through M(
e
). Assuming that
f satises property 1 and knowledge of
0
a control alloca-
tion scheme was used to estimate the elevator deections,
using an assumed aerodynamic moment model. In this
work, we use the same idea to generate a backstepping con-
troller with no need of exact knowledge of f, and extend
it using adaptive backstepping so that an aerodynamic
moment model is not needed. Thus, the main dierence is
that M(
e
) is given by (5) and (7) with the aerodynamic
coecients of (7) unknown.
Now the control objective is to make the origin of system
(21)(23) (globally) asymptotically stable. Thus, roughly
Preprints of the 18th IFAC World Congress
Milano (Italy) August 28 - September 2, 2011
1894
speaking, we design a controller using minimal information
about the aerodynamic model of the aircraft. To do so,
we stabilize each step of the cascade explicitly using
backstepping approach.
Step 1. First, equation (21) is stabilized using z
2
as a
virtual control. Dening the Lyapunov function as
W
1
=
1
2
z
2
1
,
the derivative reads
W
1
= z
1
(z
2
z
1
) and then we select
the control z
2
= u
1
(z
1
) =
1
z
1
. Thus,
W
1
|
z
2
=u
1
(z
1
)
= z
1
((1 +
1
)z
1
),
and hence
W
1
|
z
2
=u
1
(z
1
)
is negative denite for
1
> 1.
Step 2. Dening now the error variable
z
2
:= z
2
u
1
(z
1
),
the equations (21)(22) can be rewritten as
z
1
= () , (24)
z
2
=z
3
+
1
() , (25)
where, only for compactness, we dene as
:= (1 +
1
) z
1
+ z
2
,
and then
= () +z
3
.
The Lyapunov function for (24)(25) is
W
2
= c
1
W
1
+
1
2
z
2
2
+F(),
where F() is a positive denite function to be dened
further. Calculating
W
2
we get
W
2
=c
1
z
1
() + z
2
(z
3
+
1
()) +F
() (() +z
3
)
=(c
1
z
1
+
1
z
2
F
()) () + ( z
2
+F
()) z
3
. (26)
By selecting the virtual control as z
3
= u
2
( z
2
) =
2
z
2
,
2
> 0, and F
() = c
2
(), c
2
> 0, then (26) becomes
W
2
= (c
1
z
1
+ (
2
c
2
) z
2
) () c
2
2
()
2
z
2
2
,
which can be made negative denite if c
1
= (1 +
1
)(
2
c
2
1
), with
2
c
2
>
1
. Finally,
W
2
reads
W
2
= (
2
c
2
1
)() c
2
2
()
2
z
2
2
,
where the rst term is negative denite by the property 1,
and in turn F is positive denite by the properties of ().
Remark 2. This virtual control law (Harkegard (2003))
does not need the function f(), since the function F()
(rst introduced in Krstic and Kokotovic (1995)) has been
used to avoid cancellations of the terms associated to (),
which would introduce extra terms in the controller. Thus,
this design leads to a robust control law.
Step 3. In this last step, we extend the backstepping
design to generate the elevator deections laws. As com-
mented above the novelty is an adaptive scheme used
to estimate online the aerodynamic moment coecients.
Moreover, the control law is designed without cancellation
of terms coming from () in the previous step design.
Dening the error as z
3
:= z
3
u
2
(z
1
, z
2
) yields
z
1
= () , (27)
z
2
= z
3
2
z
2
+
1
() , (28)
z
3
=
2
_
C
m
0
+C
m
( +
0
) +C
m
q
z
3
+C
m
e
_
+
2
( z
3
2
z
2
+
1
()) , (29)
where
e
is the elevator deection, which is the real control
input of the aircraft, and C
m
0
, C
m
, C
m
q
are the un-
known aerodynamic coecients. The adaptive controller
proposed here is designed to stabilize equations (27)(29)
with an adaptation law to estimate these parameters.
First notice that the equation (29) can be written as
z
3
=
2
e
+
2
( z
3
2
z
2
+
1
()) , (30)
where
e
:=
V
2
a
S c
2I
y
C
m
e
,
:= [C
m
0
C
m
C
m
q
]
T
R
3
is
the unknown parameters vector and
:= [1 +
0
z
3
2
z
2
]
T
R
3
. Thus, the compound Lyapunov function for
this step is
W
3
= c
3
W
2
+
1
2
z
2
3
+
1
2
, (31)
where c
3
> 0,
T
> 0 is the adaptation gain
matrix,
is the estimate of
and
:=
is
the estimation error vector.
The Lyapunov function derivative becomes
W
3
=c
3
_
(
2
c
2
1
)() c
2
2
()
2
z
2
2
+ z
3
( z
2
+c
2
())] + z
3
_
e
+
2
( z
3
2
z
2
+
1
())] +
. (32)
In the former equation, there is a cross-term z
3
() whose
sign is undened. If it is cancelled, the function () would
appear in the controller and the benet of the controller
shown in the previous backstepping step would be lost.
Instead, grouping the terms ()
2
, z
2
3
and z
3
() and
completing squares as follows
c
3
c
2
()
2
+ (c
3
c
2
+
1
) z
3
()
=(
c
3
c
2
() z
3
)
2
+
2
z
2
3
,
where we have dened
:=
c
3
c
2
+
2
2
c
3
c
2
.
Completing squares also in the cross-terms z
3
z
2
, we have
c
3
2
z
2
2
_
2
c
3
_
z
3
z
2
=
_
2
c
3
2
c
3
2
z
3
+
c
2
2
z
2
_
2
+
_
2
c
3
_
2
4c
3
2
z
2
3
.
Thus, (32) can be rewritten as
W
3
=c
3
(
2
c
2
1
)() (
c
3
c
2
() z
3
)
2
2
c
3
2
c
3
2
z
3
+
c
2
2
z
2
_
2
+ z
3
_
e
+
_
2
+
_
2
c
3
_
2
4c
3
2
+
2
_
z
3
_
+
. (33)
Preprints of the 18th IFAC World Congress
Milano (Italy) August 28 - September 2, 2011
1895
This derivative is denite negative choosing the following
control and adaptation law
e
=
1
e
_
3
z
3
2
_
, (34)
=
2
z
3
, (35)
with
3
>
2
+
(
2
2
c
3)
2
4c
3
2
+
2
> 0.
We formally summarize the result obtained in this section
in the following proposition.
Proposition 2. Consider the system (16)(18) under As-
sumptions 1 and 2. Then, the adaptative-state feedback
given by
e
=
1
e
_
3
(q +
2
(
ref
0
+
1
(
ref
)))
_
, (36)
=
2
_
q +
2
(
ref
0
+
1
(
ref
))
_
, (37)
with c
2
, c
3
,
1
,
2
,
3
positive and satisfying
3
>
_
c
3
c
2
+
2
2
c
3
c
2
_
2
+
_
2
c
3
_
2
4c
3
2
+
2
,
assures that the equilibrium manifold (, , q,
) =
(
ref
,
ref
, 0,
.
Proof. First note that the closed-loop system is time-
invariant. The proposed Lyapunov function (31) is posi-
tive denite and radially unbounded which, together with
the adaptative-state feedback (36)(37), or equivalently
(34)-(35), makes
W
3
0 and then, by LaSalle-Yoshizawa
theorem, we conclude global boundedness of (, , q,
).
LaSalles invariance principle assures that all trajecto-
ries converge to the largest invariant set contained in
{(, , q,
) R
4
:
W
3
= 0}. Since
W
3
= 0 implies
z
3
= 0 then analyzing backwards the residual dynamics,
it is straightforward to see that the equilibrium manifold
(, , q,
) = (
ref
,
ref
, 0,
) is globally asymptotically
stable, or equivalently ( z
3
, z
2
, z
1
,
) = (0, 0, 0,
).
4. SIMULATION RESULTS
In this section, simulation results of the controllers de-
veloped are shown. The simulation model is composed of
Equations (1)(4), and the aerodynamic model of Cero
UAV, developed in the University of Seville (Bernal et al.
(2009)). For a more realistic simulation, saturations in the
control signals are also considered. Thus, the following
limits are introduced in the thrust and elevator angle:
F
T
[4.9 N, 117.6 N] ,
e
[30
o
, 30
o
] . (38)
The tuning parameters for the velocity controller are
V
1
= 10;
V
= 0.001I
3
,
where I
3
is the identity matrix of dimension 3. For the
ight path angle controller, the parameters are
1
= 0.2;
2
= 0.5;
3
= 1.5;
= 0.001I
3
.
The initial estimate of the unknown parameters is
V
= [ 0.05 0.05 0.05 ]
T
,
= [ 0.1 1 10 ]
T
The reference maneuver selected is as follows. The velocity
prole consist on three segments with constant velocity,
separated by uniform acceleration and uniform decelera-
tion segments. The ight path angle prole consist on two
leveled ight segments, with a climb of 10
o
between them.
Fig. 2 shows the time evolution of the aerodynamic ve-
locity. After an initial period with some oscillations in
which saturations in thrust occurs, the velocity controller
achieves an excellent agreement with the reference. Fig. 4
shows the control signals. In the gure, the dashed line
represent the computed control signal, whereas the solid
line represents the commanded control signal (with satura-
tions). Regarding the ight path angle controller, in Fig. 3
it can be seen that the reference seeking is achieved, but
a slower response is obtained since small gains have been
selected to avoid excessive oscillations. Fig. 5 shows other
state variables such as the pitch and attack angles, and
the pitch angular velocity, which have reasonable values
throughout the maneuver. Finally, Figure 6 shows the
time evolution of the estimated parameters towards certain
equilibrium values.
0 50 100 150 200 250
70
75
80
85
90
95
100
105
110
Time [s]
V
e
l
o
c
i
t
y
[
k
m
/
h
]
V
V
r
Fig. 2. Time evolution of the aerodynamic velocity (solid),
compared with its reference (dashed).
5. CONCLUSION
We presented the design a simple adaptive controller
for the longitudinal ight dynamics of an UAV that is
able to make the aircraft follow references in velocity
and ight path angle. The design is explicit, simple and
easy to implement, since it does not require knowledge
of the aerodynamics model and does not need much
computational power. In simulations, it is shown that the
controller can make the system follow the references, even
in the presence of actuator saturations.
The simulations were performed using a realistic UAV
model, the Cero aircraft developed by the University of
Preprints of the 18th IFAC World Congress
Milano (Italy) August 28 - September 2, 2011
1896
0 50 100 150 200 250
4
2
0
2
4
6
8
10
12
14
Time [s]
[
d
e
g
]
ref
Fig. 3. Time evolution of the ight path angle (solid)
compared with its reference (dashed).
0 50 100 150 200 250
100
50
0
50
Time [s]
e
[
d
e
g
]
0 50 100 150 200 250
20
0
20
40
60
80
Time [s]
F
T
[
N
]
Fig. 4. Control signals: computed (dashed) and com-
manded (solid).
Seville. As a next step the control laws will be implemented
on board the aircraft to perform experiments and further
validate the results.
REFERENCES
Abot, I.H. and Von Doenho, A.E. (1959). Theory of wings
and sections. Dover.
Bernal, C., Fernandez, A., Lopez, P., Martin, A., Perez,
D., Samblas, F., Esteban, S., Gavilan, F., and Rivas,
D. (2009). Cero: an aircraft design project in the
university of seville. In 9th European Workshop on
Aircraft Design Education (EWADE 2009).
Etkin, B. and Reid, L.D. (1996). Dynamics of Flight.
Stability and Control. John Wiley, 3rd edition.
Farrell, J., Sharma, M., and Polycarpou, M. (2005).
Backstepping-based ight control with adaptive func-
tion approximation. J. Guid. Contr. Dynam., 28(6),
10891102.
Harkegard, O. (2003). Backstepping and Control Alloca-
tion with Applications to Flight Control. Ph.D. thesis,
Linkoping Universtity.
Krstic, M., Kanellakopoulos, I., and Kokotovic, P. (1995).
Nonlinear and Adaptive Control Design. John Wiley.
0 50 100 150 200 250
0
5
10
Time [s]
[
d
e
g
]
0 50 100 150 200 250
10
0
10
20
Time [s]
[
d
e
g
]
0 50 100 150 200 250
10
5
0
5
Time [s]
q
[
d
e
g
/
s
]
Fig. 5. Time evolution of the angles of attack and pitch
, and the angular velocity q.
0 50 100 150 200 250
600
500
400
300
200
100
0
100
Time [s]
E
s
t
i
m
a
t
e
d
p
a
r
a
m
e
t
e
r
s
C
m0
C
m
C
mq
C
D0
k
1
k
2
Fig. 6. Time evolution of the estimated parameters.
Krstic, M. and Kokotovic, P.V. (1995). Lean backstepping
design for a jet engine compressor model. In IEEE
Conference on Control Applications, 10471052.
McLean, D. (1990). Automatic Flight Control Systems.
Prentice Hall.
Nichols, R.A., Reichert, R.T., and Rugh, W.J. (1993).
Gain scheduling for H