Professional Documents
Culture Documents
290
Fig. 3 The command surfaces and the actuators of the Sekwa UAV
the
the
the
the
a = ( 2 3 + 4 + 5 ) / 4 ,
r = (1 + 6 ) / 2 .
(1)
(2)
q sin + r cos
.
cos
291
L = p d S C C b C l C S c C m S b C n ,
M = p d S S b C l + C c C m ,
N = p d S S C b C l S S c C m + C b C n ,
(
(
(3)
aerodynamic
chord
C = cos , C = cos ,
and
C mq q ,
Cm = Cm 0 + Cm + Cme e +
2V
Cn = C n + Cn r r + Cn a a + 2V Cn p p + C nr r .
(7)
e r sin
cos ,
e = e + q +
cos
1
qr I y I z + p d SC1 ,
p =
Ix
[ pr (I z I x ) + p d SC 2 ] ,
q =
Iy
1
r =
pq I x I y + p d SC 3 ,
Iz
[ (
[ (
(8)
q+
(5)
e r sin
e + rsin
= 0 q =
.
cos
cos
(9)
e = e ;
with
(10)
C3 = S C b Cl S S c C m + C b C n ;
V (e ) = e e = e2 < 0, () > 0 .
C1 = C C b Cl C S c C m S b C n ,
C 2 = S b C l + C c C m ,
(6)
(11)
292
e + r sin
.
cos
(12)
e = e + e q cos ,
eq = q q .
(13)
1
pr (I z I x ) + pd S (S b Cl + C c C m ) q ;
Iy
p S
1
pr (I z I x ) + d S b C l + C l r +
r
Iy
Iy
pd S
b
S b C l a +
C l p p + C lr r +
Iy
2V
a
pd S
c
C c C m 0 + C m + C m e +
C mq q q .
e
Iy
2
V
1 2 1 2
e + e q
2
2
pd S
b
b
S b C l +
Cl p p +
Cl r
Iy
2V
2V r
pd S
c
C c C m 0 + C m +
C mq q + q .
Iy
2
V
(23)
(17)
= e2 q eq2 + eq e cos + q eq + eq ,
eq e cos + q eq + eq = 0
1 2
e , one gets:
2
V (e ) = e e = e2 < 0, ( ) > 0 .
The first two terms in the right side of (17) are negative and,
for stability reasons, it is desirable that:
(24)
(18)
or
e cos + q eq +
(21)
Vq e , eq = e e + eq eq =
1
pr (I z I x )
Iy
1
p d SS bCl ,
r
Iy
(16)
a3 =
1
1
p d SC c C m , a 2 =
p d SS bCl ,
e
a
Iy
Iy
V q e , eq =
a1 =
A = e cos q eq
(14)
(20)
with
p S
1
pr (I z I x ) + d S bCl +
Iy
Iy
p S
b
+ d S b Cl r + C l a +
C l p p + C lr r +
a
Iy
2V
r
(25)
e p = p p
p S
c
+ d C c C m 0 + C m + C m e +
C mq q q = 0 ;
e
Iy
2V
(26)
293
e p =
where
p S
1
qr I y I z p + d C C b Cl +
Ix
Ix
(27)
p S
d (C S c C m + S b C n ) ;
Ix
b1 =
b3 =
pd S
b
C Cb Cl a +
Cl p p + Clr r p
Ix
2V
a
(28)
pd S
b
S b Cn + Cn r + Cn a +
Cn p p + Cnr r .
r
a
Ix
2V
1 2 1 2
e + e p
2
2
Vp e , e p = e2 p e 2p + e p e + p e p + e p ,
e + p e p + e p = 0 .
(30)
pd S
b2
S
C n p p + C nr r + p .
Ix
2V
(35)
cos
sin
e
q.
cos
cos
(36)
V (e ) =
1 2
1
1
e , Vr (e , e r ) = e2 + e r2 .
2
2
2
(37)
(31)
p S
1
e + p e p +
qr I y I z + d C C bC l +
Ix
Ix
p S
c
d C S c C m 0 + C m + C m e +
C mq q
e
Ix
2V
c1 =
(32)
c3 =
(38)
with
p S
b
+ d C C b C l r + C l a +
C l p p + C lr r
a
Ix
2V
r
pd S
S b C n + C n r + C n a p +
r
a
Ix
1
p d Sb S C Cl + C C n ,
r
r
Iz
p S
1
pq I x I y d S C bCl
Iz
Iz
p S
p S
b2
d S C
C l p p + C lr r + d S S c C m 0 +
Iz
2V
Iz
294
1
1
p d SS S c C m , c 2 =
p d Sb S C C l + C C n ,
e
a
a
Iz
Iz
C = e r e r
p S
b2
d S
C n p p + C nr r = 0 ;
Ix
2V
b1 e + b2 a + b3 r = B ,
pd S
c
p S
C S c C m +
C mq q + d S bC n +
Ix
2V
Ix
r =
(34)
e = , e r = r r
(29)
p S
1
qr I y I z d C C bCl
Ix
Ix
p S
p S
b2
d C C
C l p p + C lr r + d C S c C m 0 +
Ix
2V
Ix
p S
c
Cmq q
d C S c Cm0 + Cm + Cm e +
e
Ix
2V
1
p d Sb C C Cl S C n ,
r
r
Ix
B = e p e p
p S
1
qr I y I z + d C C b Cl + Cl r +
r
Ix
Ix
1
1
pd SC S c C m , b2 =
pd Sb C C Cl S C n ,
e
a
a
Ix
Ix
pd S
c
p S
S S c C m +
C mq q d C bC n
Iz
2V
Iz
pd S
b2
C
C n p p + C nr r + r .
Iz
2V
(39)
b1e + b2 a + b3 r = B ,
c + c + c = C ,
2 a
3 r
1 e
1
[(b2 c3 c2 b3 )A + (c2 a3 a 2 c3 )B + (a2 b3 a3b2 )C ],
e =
det T
1
[(c1b3 c3b1 )A + (a1c3 a3 c1 )B + (a3b1 a1b3 )C ], (43)
a =
det
T
1
[(b1c2 b2 c1 )A + (a 2 c1 a1c2 )B + (a1b2 a2 b1 )C ],
r =
det
T
(40)
where
with ai , bi , ci , A, B, C , i = 1, 3 being described by (21), (34)
and (39). The equation system (40) has the matriceal form:
a1 a 2 a3 e A
b b b = B ,
1 2 3 a
c1 c2 c3 r C
(41)
A
B
C
(42)
T 1
or
Fig. 4 Attitude controller for the control of the Sekwa UAV flight
Fig. 5 Matlab/Simulink model of the UAV attitude controller using the backstepping method
295
In conclusion, the paper author has successfully implemented the nonlinear attitude controller on the nonlinear UAV
aircraft model. The attitude controller controls the attitude
angles, the angular rates, the angular accelerations and other
variables that describe the dynamics of UAV. Putting together
equations (2), (4), (5), (12), (21), (34), (36), (39), (43), (44)
and the expression of the six errors e , eq , e , e p , e , er , the
the desired values of the attitude angles have been chosen as:
= 5 deg, = 2 deg, = 3 deg .
In Fig. 6, I present the time evolutions of the variables
(t ) , (t ) , (t ) , p(t ), q(t ), r (t ), a (t ), e (t ), r (t ) . One remarks the
proper function of the backstepping method, because all the
angles, which define the UAV attitude (the roll angle, the
pitch angle and the yaw angle), track their imposed values.
S = 0.39 m 2 ,
mean aerodynamic
In this section, I present the obtained results after performing the numeric simulations. The designed control system
has been implemented in a Matlab/Simulink environment and
its effectiveness has been tested with a campaign of numerical
simulations. The Matlab/Simulink model of the structure in
Fig. 4 is presented in Fig. 5.
The UAV has small dimensions: wing span b = 1.7 m ,
wing surface
chord
[deg ]
[deg]
0
-2
-4
-6
4.5
[deg ]
0
-1
10
15
-2
20
10
15
-2
-4
= 1.4, p = 1.4
-4
-5
-6
10
2.5
12
14
16
18
3
2
= 0.4, q = 0.4
= 0.4, q = 1.4
= 0.7, q = 0.7
= 0.8, q = 1.4
= 1.2, q = 0.5
-1
= 1.4, q = 1.4
20
-2
0
10
15
20
10
12
14
16
18
Time [s]
Time [s]
0.5
r [deg/s]
= 1.2, p = 0.5
-3
3.5
Time [s]
q [deg/s]
p [deg/s]
Time [s]
= 0.8, p = 1.4
-2
= 0.7, p = 0.7
-1
Fig. 7 Time variation of the UAV roll angle for different values of
and p between 0.4 and 1.4
(45)
= 0.4, p = 1.4
Time [s]
= 0.4, p = 0.4
-8
-7
(46)
Fig. 8 Time variation of the UAV pitch angle for different values of
and q between 0.4 and 1.4
0
-0.5
-1
5
0
10
15
-1
20
10
15
20
-1.5
Time [s]
10
15
r [deg ]
-3.5
1
0
-4
3
2.5
2
1.5
1
10
Time [s]
15
20
10
= 0.4, r = 0.4
20
3.5
e [deg ]
a [deg ]
Time [s]
-1
Time [s]
15
20
Time [s]
10
15
20
Time [s]
The trim conditions are very important because they are the
starting values of the variables; the trim conditions are:
-6
= 0.4, r = 1.4
4.5
= 0.7, r = 0.7
= 0.8, r = 1.4
= 1.2, r = 0.5
= 1.4, r = 1.4
3.5
3
2.5
2
0
10
12
14
16
18
Time [s]
Fig. 9 Time variation of the UAV yaw angle for different values of
and r between 0.4 and 1.4
296
REFERENCES
[1]
[2]
The best results are obtained for the maximum value (in this
case 1.4). For example, if one considers the case of the roll
angle stabilization, for = 0.4, p = 0.4 , the overshoot is
[3]
[4]
[5]
[6]
[7]
[8]
VII. CONCLUSIONS
The focus of the backstepping controller synthesis process
was the choice of the error variables and of the Lyapunov
functions. The deflections of the control surfaces have been
obtained equations (43) and (44). The obtained attitude
controller may be implemented on UAVs; the technique that
has been used for its design is a general one and may be used
to all kind of flying objects, offering very good operation and
characteristics of the output signals.
The design of the three controllers and the backstepping
technique has directly used the nonlinear equations and the
Lyapunov analysis. The method has an important advantage
with respect to the classical techniques (for example the
design of PID controllers): the nonlinear system (describing
the dynamics of UAV) must not be linearised in a trim point.
This linearization must be done if we want to design PID
controllers. The linearization of the UAV dynamics limits the
applicability of PID controllers.
Using the backstepping method, the author obtained the
expressions of the elevator, rudder and aileron deflections that
control the UAV, at every moment, and stabilize it to the
desired values of the attitude angles and angular rates.
The paper author made complex simulations in Matlab/
Simulink by using data from the UAV flight tests. The
obtained results are very good (UAV attitude angles and the
UAV angular rates tend to their imposed values in a proper
transient regime without big overshoots).
While the constants , , and p , q , r have positive
[9]
[10]
[11]
[12]
[13]
[14]
[15]
[16]
[17]
[18]
[19]
[20]
297