Professional Documents
Culture Documents
ISA Transactions
journal homepage: www.elsevier.com/locate/isatrans
Research Article
art ic l e i nf o
a b s t r a c t
Article history:
Received 3 November 2013
Received in revised form
29 December 2013
Accepted 16 January 2014
This paper was recommended for
publication by Jeff Pieper.
A synthesis control method is proposed to perform the position and attitude tracking control of the
dynamical model of a small quadrotor unmanned aerial vehicle (UAV), where the dynamical model is
underactuated, highly-coupled and nonlinear. Firstly, the dynamical model is divided into a fully actuated
subsystem and an underactuated subsystem. Secondly, a controller of the fully actuated subsystem is
designed through a novel robust terminal sliding mode control (TSMC) algorithm, which is utilized to
guarantee all state variables converge to their desired values in short time, the convergence time is so
small that the state variables are acted as time invariants in the underactuated subsystem, and, a
controller of the underactuated subsystem is designed via sliding mode control (SMC), in addition, the
stabilities of the subsystems are demonstrated by Lyapunov theory, respectively. Lastly, in order to
demonstrate the robustness of the proposed control method, the aerodynamic forces and moments and
air drag taken as external disturbances are taken into account, the obtained simulation results show that
the synthesis control method has good performance in terms of position and attitude tracking when
faced with external disturbances.
& 2014 ISA. Published by Elsevier Ltd. All rights reserved.
Keywords:
Quadrotor UAV
Underactuated
Novel robust TSMC
SMC
Synthesis control
1. Introduction
The quadrotor unmanned aerial vehicles (UAVs) are being used
in several typical missions, such as search and rescue missions,
surveillance, inspection, mapping, aerial cinematography and law
enforcement [15].
Considering that the dynamical model of the quadrotor is an
underactuated, highly-coupled and nonlinear system, many control strategies have been developed for a class of similar systems.
Among them, sliding mode control, which has drawn researchers'
much attention, has been a useful and efcient control algorithm
for handling systems with large uncertainties, time varying properties, nonlinearities, and bounded external disturbances [6]. The
approach is based on dening exponentially stable sliding surfaces
as a function of tracking errors and using Lyapunov theory to
guarantee all state trajectories reach these surfaces in nite-time,
and, since these surfaces are asymptotically stable, the state
trajectories slides along these surfaces till they reach the origin
[7]. But, in order to obtain fast tracking error convergence, the
desired poles must be chosen far from the origin on the left half of
s-plane, simultaneously, this will, in turn, increase the gain of the
controller, which is undesirable considering the actuator saturation in practical systems [8,9].
Corresponding author.
E-mail addresses: jjxiong357@gmail.com (J.-J. Xiong),
ehzheng@cjlu.edu.cn (E.-H. Zheng).
Replacing the conventional linear sliding surface with the nonlinear terminal sliding surface, the faster tracking error convergence
is to obtain through terminal sliding mode control (TSMC). Terminal
sliding mode has been shown to be effective for providing faster
convergence than the linear hyperplane-based sliding mode around
the equilibrium point [8,10,11]. TSMC was proposed for uncertain
dynamic systems with pure-feedback form in [12]. In [13], a robust
adaptive TSMC technique was developed for n-link rigid robotic
manipulators with uncertain dynamics. A global non-singular TSMC
for rigid manipulators was presented in [14]. Finite-time control of
the robot system was studied through both state feedback and
dynamic output feedback control in [15]. A continuous nite-time
control scheme for rigid robotic manipulators using a new form of
terminal sliding modes was proposed in [16]. For the sake of
achieving nite-time tracking control for the rotor position in the
axial direction of a nonlinear thrust active magnetic bearing system,
the robust non-singular TSMC was given in [17]. However, the
conventional TSMC methods are not the best in the convergence
time, the primary reason is that the convergence speed of the
nonlinear sliding mode is slower than the linear sliding mode when
the state variables are close to the equilibrium points. In [18], a novel
TSMC scheme was developed using a function augmented sliding
hyperplane for the guarantee that the tracking error converges to
zero in nite-time, and was proposed for the uncertain single-input
and single-output (SISO) nonlinear system with unknown external
disturbance. In the most of existing research results, the uncertain
external disturbances are not taken into account these nonlinear
systems. In order to further demonstrate the robustness of novel
0019-0578/$ - see front matter & 2014 ISA. Published by Elsevier Ltd. All rights reserved.
http://dx.doi.org/10.1016/j.isatra.2014.01.004
Please cite this article as: Xiong J-J, Zheng E-H. Position and attitude tracking control for a quadrotor UAV. ISA Transactions (2014), http:
//dx.doi.org/10.1016/j.isatra.2014.01.004i
quadrotor is set up in this work by the body-frame B and the earthframe E as presented in Fig. 1. Let the vector [x,y,z]' denotes the
position of the center of the gravity of the quadrotor and the vector [u,
v,w]' denotes its linear velocity in the earth-frame. The vector [p,q,r]'
represents the quadrotor's angular velocity in the body-frame. m
denotes the total mass. g represents the acceleration of gravity. l
denotes the distance from the center of each rotor to the center of
gravity.
The orientation of the quadrotor is given by the rotation matrix
R:E-B, where R depends on the three Euler angles [,,]0 , which
represent the roll, the pitch and the yaw, respectively. And
A =2; =2; A =2; =2; A ; .
The transformation matrix from [,,]0 to [p,q,r]0 is given by
32 _ 3
2 3 2
1
0
sin
p
6 7
6 7 60
_ 7
cos
sin cos 7
1
56
4q54
45
0 sin cos cos
r
_
2. Quadrotor model
In order to describe the motion situations of the quadrotor model
clearly, the position coordinate is to choose. The model of the
_
l
_ Iy Ix Iz IJxr
>
r I x u2 I x
>
>
>
>
K5l _
_
l
>
>
_ _ Iz Iy Ix IJyr
r I y u3 I y
>
>
>
>
>
_ _ Ix I y 1 u K 6 _
:
I 4
I
I
z
3. Synthesis control
Compared with the brushless motor, the propeller is very light,
we ignore the moment of inertia caused by the propeller. Eq. (2) is
divided into two parts:
3 2
3
" # 2 u1 cos cos
Km3 z_
g
z
m
54
5
3
4
1
u4
_ _ Ix Iy K 6 _
Iz
8" #
"
>
cos
>
> x u1
>
>
m
>
sin
y
>
<
" # "
>
l=I x
>
>
>
>
>
>
0
:
Iz
sin
#"
Iz
cos sin
cos
sin
#" # 2 _ I y Iz K 4 l _ 3
_ Ix Ix
0
u2
4 _ I z Ix K 5 l _ 5
l=I y
u3
_ I I
y
2
4
Km1 x_
Km2 y_
3
5
4
where Eq. (3) denotes the fully actuated subsystem (FAS), Eq. (4)
denotes the underactuated subsystem (UAS). For the FAS, a novel
robust TSMC is used to guarantee its state variables converge to
their desired values in short time, then the state variables are
regarded as time invariants, therefore, the UAS gets simplied. For
the UAS, a sliding mode control approach is utilized. The special
synthesis control scheme is introduced in the following sections.
Please cite this article as: Xiong J-J, Zheng E-H. Position and attitude tracking control for a quadrotor UAV. ISA Transactions (2014), http:
//dx.doi.org/10.1016/j.isatra.2014.01.004i
6b
!
7b
In accordance with Eq. (5) and the time derivative of s2 and s4, we
have
u1
K3
d m0 =n0
cos cos g z_ 1 s_ 1 1 s1 1 1
dt
m
m
8a
8b
z d g 1 s_ 1
m =n1
1 s2 1 s2 1
m0 m0 n0 =n0
m =n
u4 I z d 2 s_ 3 2 02 s3 2 2 2 s_ 3 2 s4 2 s4 2 2
n2
9a
9b
where 1,2,1, and 2 are positive,m1, n1, m2, and n2 are positive
odd integers with m1 on1 and m2 on2 :
Under the controllers, the state trajectories reach the areas
(1,2) of the sliding surfaces s2 0 and s4 0 along s_ 2 1 s2
m =n
1 =n1
01 sm
and s_ 4 2 s4 02 s4 2 2 in nite-time, respectively. The
2
time is dened as
t 01 r
t 02 r
n1
1 n1 m1
ln
1 s1 0n1 m1 =n1 1
1
10a
n2
2 s3 0n2 m2 =n2 2
ln
2 n2 m2
2
10b
m1 =n1
0
j 1;
1 L1 =js2
1
L1 jK 3 z_ =mjmax ; 1 4 0; 1 fjs2 j r L1 = 1 m1 =n1 g
m2 =n2
m =n
0
_
j; 2 L2 =js4 2 2 j 2
2 2 K 6 =I z =js4
y_ 1 y2 ;
y_ 2 f 2 d2 ;
y_ 3 y4 ;
y_ 4 f 3 g 2 u2 d3 :
11
12
13
14
where
where
1
K6
d m0 =n0
s_ 4 d u4 _ 2 s_ 3 2 s3 2 2
Iz
dt
Iz
cos
n02
2 s3 0n2 m2 =n2 2
ln
t s3
0
0
2 n2 m2
2
cos
m1 n1 =n1
1 s2 2 01 s2
6a
u1
s4 s_ 3 2 s3 2 s3 m2 =n2
V 1 s22 =2
s2 s_ 1 1 s1 1 s1 m1 =n1
s_ 2 z d
m1 =n1
_
j;
1 K 3 z=m=js2
E1 e1 e2 e3 0 ; y y1 y2 y3 y4 0 and 4 0;
f 2
According
cos cos cos 0;
toy3
sin2 sin
and 0 o f 2 =y3 cos cos o 2, and , therefore, f 2 =
y3 is invertible.
Please cite this article as: Xiong J-J, Zheng E-H. Position and attitude tracking control for a quadrotor UAV. ISA Transactions (2014), http:
//dx.doi.org/10.1016/j.isatra.2014.01.004i
13
reference
real
12
-2
u1 ( m/s 2 )
x(m)
10
15
20
25
30
35
40
45
50
11
9
8
y(m)
X: 39.54
Y: 9.801
10
10
15
20
25
30
Time ( s )
35
40
45
50
10
15
20
25
30
35
40
45
50
z(m)
Table 1
Quadrotor model parameters.
10
15
20
25
30
35
40
45
50
Time ( s )
Fig. 2. The positions (x,y,z), PID control and SMC.
0.025
reference
( rad )
real
Value
Units
m
Ix Iy
Iz
K1 K2 K3
K4 K5 K6
l
Jr
b
d
g
2.0
1.25
2.2
0.01
0.012
0.20
1
2
5
9.8
kg
Ns2/rad
Ns2/rad
Ns/m
Ns/m
m
Ns2/rad
Ns2
N ms2
m/s2
-0.025
10
15
20
25
30
35
40
45
50
( rad )
0.06
-0.06
10
15
20
25
30
35
40
45
50
( rad )
Variable
X: 25.48
Y: 0.5003
0.5
10
15
20
25
30
35
40
45
50
Table 2
Controller parameters.
Variable
Value
Variable
Value
1
1
m01
n01
m1
n1
1
1
1
1
5
7
1
3
10
2
2
m02
n02
m2
n2
2
2
3
1
5
7
1
3
10
1
c1
c3
m =n1
L1 =js2 1
0.1
20
8
0.1
0
j 1
2
c2
1
3
m =n2
L2 =js4 2
0.1
22
1
0
2
j 2
Time ( s )
Fig. 3. The angles (,,), PID control and SMC.
Therefore, under the controllers, the subsystem state trajectories can reach, and, thereafter, stay on the manifold S 0 in
nite-time.
Please cite this article as: Xiong J-J, Zheng E-H. Position and attitude tracking control for a quadrotor UAV. ISA Transactions (2014), http:
//dx.doi.org/10.1016/j.isatra.2014.01.004i
reference
real
1
X: 4.977
Y: 0.9909
10
15
20
25
30
35
0.45
u ( m/s )
x(m)
v ( m/s )
y(m)
X: 4.977
Y: 0.9946
10
15
20
25
30
35
10
15
20
25
30
35
40
10
15
20
25
30
35
40
10
15
20
25
30
35
40
-0.45
40
1.4
w ( m/s )
z(m)
0.45
1
X: 1.779
Y: 0.9932
-0.45
40
10
15
20
25
30
35
40
-1.4
Time ( s )
Time ( s )
( rad )
0.05
Fig. 7. The linear velocities (u,v,w), novel robust TSMC and SMC.
reference
real
-0.05
10
15
20
25
30
35
40
10
15
20
25
30
35
40
30
35
40
( rad )
0.05
-0.05
1
( rad )
X: 21.01
Y: 0.5002
0.5
X: 1.163
Y: 0.4992
10
15
20
25
Time ( s )
Fig. 6. The angles (,,), novel robust TSMC and SMC.
5. Discussion
The extensive simulation tests have been performed to evaluate
the different synthesis control schemes which are based on
position and attitude tracking of the quadrotor UAV. It can be
Please cite this article as: Xiong J-J, Zheng E-H. Position and attitude tracking control for a quadrotor UAV. ISA Transactions (2014), http:
//dx.doi.org/10.1016/j.isatra.2014.01.004i
40
u1 ( N )
p ( rad/s )
0.15
-0.15
10
15
20
25
30
35
40
X: 17.86
Y: 19.66
20
10
0.1
10
15
20
25
30
35
40
10
15
20
25
30
35
40
10
15
20
25
30
35
40
10
15
20
25
30
35
40
10
0
-0.1
10
15
20
25
30
35
40
u2 ( N )
q ( rad/s )
30
-10
0
-1.2
10
15
20
25
30
35
40
Time ( s )
u3 ( N )
r ( rad/s )
1.2
Fig. 8. The angular velocities (p,q,r), novel robust TSMC and SMC.
-3
10
u4 ( N )
s2
0
X: 0.8018
Y: 0.000684
-2
10
15
20
25
30
35
40
-10
Time ( s )
1.2
s4
Fig. 10. The controllers (u1,u2,u3,u4), novel robust TSMC and SMC.
0
X: 1.338
Y: -0.0002129
-1.2
10
15
20
25
30
35
40
20
s(1)
s(2)
0
-20
10
15
20
25
30
35
40
Time ( s )
Fig. 9. The sliding variables (s2,s4,s), novel robust TSMC and SMC.
clearly seen that while all the state variables converge to their
reference values as desired in nite-time, the convergence time is
obviously different. It was shown that the synthesis control
method based on the novel robust TSMC and SMC is a more
reliable and effective approach to perform the tracking control for
the quadrotor UAV.
6. Conclusion
This work studies the position and attitude tracking control of a
small quadrotor UAV using the proposed control method based on
the aforementioned control algorithms. In order to further test the
performances of the designed controllers, the dynamical model of
the quadrotor along with the controllers is simulated on Matlab/
Simulink. The main conclusions are summarized as follows. (a) The
six degrees of freedom converge to their desired/reference values
in nite-time, respectively. (b) The convergence time of the state
Acknowledgment
This work was partially supported by the National Natural
Science Foundation of China (60905034).
References
[1] Raffo GV, Ortega MG, Rubio FR. An integral predictive/nonlinear H1 control
structure for a quadrotor helicopter. Automatica 2010;46:2939.
[2] Derafa L, Benallegue A, Fridman L. Super twisting control algorithm for the
attitude tracking of a four rotors UAV. J Frankl Inst 2012;349:68599.
[3] Luque-Vega L, Castillo-Toledo B, Loukianov AG. Robust block second order
sliding mode control for a quadrotor. J Frankl Inst 2012;349:71939.
[4] Garcia-Delgado L, Dzul A, Santibez V, Llama M. Quadrotors formation
bansed on potential functions with obstacle avoidance. IET Control Theory
Appl 2012;6(12):1787802.
[5] Alexis K, Nikolakopoulos G, Tzes A. Model predictive quadrotor control:
attitude, altitude and position experimental studies. IET Control Theory Appl
2012;6(12):181227.
[6] Nekoukar V, Erfanian A. Adaptive fuzzy terminal sliding mode control for a
class of MIMO uncertain nonlinear systems. Fuzzy Sets Syst 2011;179:349.
[7] Ashrauon H, Scott-Erwin R. Sliding mode control of under-actuated multibody systems and its application to shape change control. Int J Control
2008;81(12):184958.
Please cite this article as: Xiong J-J, Zheng E-H. Position and attitude tracking control for a quadrotor UAV. ISA Transactions (2014), http:
//dx.doi.org/10.1016/j.isatra.2014.01.004i
Please cite this article as: Xiong J-J, Zheng E-H. Position and attitude tracking control for a quadrotor UAV. ISA Transactions (2014), http:
//dx.doi.org/10.1016/j.isatra.2014.01.004i