You are on page 1of 7

Adaptive Second-order Sliding Mode Control of UAVs

for Civil Applications


V.T. Hoang, A.M. Singh, M.D. Phung and Q.P. Ha
Faculty of Engineering and Information Technology
University of Technology Sydney, Australia
E-mail: {VanTruong.Hoang, AnsuMan.Singh, ManhDuong.Phung, Quang.Ha}@uts.edu.au

Abstract - and coupling effects between the rotational and transla-


Quadcopters, as unmanned aerial vehicles (UAVs), have tional motions, or disturbances from aerodynamics and
great potential in civil applications such as surveying, build- other external factors.
ing monitoring, and infrastructure condition assessment. A number of control approaches have been developed
arXiv:1707.09718v1 [cs.SY] 31 Jul 2017

Quadcopters, however, are relatively sensitive to noises and for the quadcopter in the literature, for example PD, PID
disturbances so that their performance may be quickly down- control [24], H1 control [16], optimal control [17], or
graded in the case of inadequate control, system uncertainties potential field [21]. Among them, the sliding mode control
and/or external disturbances. In this study, we deal with the (SMC) is widely used as it can produce a robust closed-
quadrotor low-level control by proposing a robust scheme loop control system under the influence of modelling errors
named the adaptive second-order quasi-continuous sliding and external disturbances [22, 1, 4]. In SMC, chattering
mode control (adaptive 2-QCSM). The ultimate objective is may occur in the steady state and act as an oscillator that
for robust attitude control of the UAV in monitoring and excites unmodeled frequencies of the system dynamics
inspection of built infrastructure. First, the mathematical [10]. To reduce the chattering effect, high-order sliding
model of the quadcopter is derived considering nonlinear- modes (HOSM) have been introduced [7, 14, 18, 20].
ity, strong coupling, uncertain dynamics and external dis- In the HOSM control, the quasi-continuous (QC) SMC
turbances. The control design includes the selection of the [5] introduces the capability of maintaining the properties
sliding manifold and the development of quasi-continuous of the first order SMC while creating smooth responses. Its
second-order sliding mode controller with an adaptive gain. performance however depends on the knowledge of distur-
Stability of the overall control system is analysed by using a bance boundaries which are not always available. In prac-
global Lyapunov function for convergence of both the slid- tice, the quadcopter may be subject to various disturbances
ing dynamics and adaptation scheme. Extensive simulations and uncertainties such as wind gusts and modelling errors
have been carried out for evaluation. Results show that the that may downgrade the control performance. To address
proposed controller can achieve robustness against distur- this concern, the second-order sliding mode (SOSM) con-
bances or parameter variations and has better tracking per- troller with an adaptive gain has been applied to drive the
formance in comparison with experimental responses of a sliding variable and its derivative to zero in the presence
UAV in a real-time monitoring task. of bounded disturbances [19].
Keywords - In this work, we propose an adaptive quasi-continuous
Quadcopter, robustness, adaptation, quasi-continuous second-order sliding mode (AQCSM) scheme to control
second-order sliding mode control, monitoring system the attitude of quadcopters subject to nonlinear dynam-
ics, strong coupling, high uncertainties and disturbances
with unknown boundaries. The mathematical model of
the quadcopter is first derived by considering various dy-
1 Introduction
namic parameters. Here, the quasi-continuous SMC re-
Quadcopters have found many applications in civil en- tains the advantage of robustness while attenuating the
gineering automation due to its flexibility in operational control chattering and facilitating the implementation. Its
space and ability in vertical take off and landing. These performance is verified by simulation with comparison to
include the use of UAVs in automatic 3D reconstruction real-time datasets.
for building condition assessment [2], securing superstruc- The paper is organised as follows. The dynamic model
tures of high-rise buildings [3], or monitoring and inspec- of the quadcopter is presented in Section 2. Section 3
tion of civil infrastructure [6, 12]. In those applications, describes the development of the AQCSMC. Simulation
it is critical to maintain robustness and resilience of the results are presented in Section 4 with comparison to PID
control system to cope with the highly non-linear dynam- experimental responses. The paper ends with a conclusion
ics of quadcopters and system uncertainties, sensor noise and discussion for future work.
2 System modelling ⌧p , and aerodynamic friction ⌧a . The torque ⌧ consists of
three components corresponding the roll, pitch and yaw
2.1 Kinematics
rotations, ⌧ = [⌧ ⌧✓ ⌧ ]T . They are given by:
Two coordinate systems are used to model the kinemat-
ics and dynamics of quadrotors, as shown in Fig. 1. The ⌧ = l(F2 F4 ), (4)
inertial frame (xE , yE , zE ) is defined by the ground with
⌧✓ = l( F1 + F3 ), (5)
gravity pointing downward in zE direction. The body
frame (xB, yB, zB ) is specified by the orientation of the ⌧ = b( F1 + F2 F3 + F4 ), (6)
quadcopter with the rotor axes pointing in the positive zB
where l is the distance from the motor to the UAV centre
direction and the arms pointing in xB and yB directions.
of mass and b is the drag factor. The body gyroscopic
torque ⌧b is given by:

⌧b = S(!)I!, (7)

where S(!) is a skew-symmetric matrix,


2 3
6 0 r q 7
6 7
S(!) = 6 r 0 p 7. (8)
6 7
6 q p 0 7
4 5
The propeller gyroscopic torque ⌧p is determined as:
2 3
6 Ir ⌦r q 7
6 7
⌧p = 6 Ir ⌦r p 7,
6 7
6 0 7
Figure 1: A schematic diagram of quadcopter 4 5
where Ir is the inertial moment of rotor, ⌦r = ⌦1 +
The orientation of quadcopters is described by the roll,
⌦2 ⌦3 + ⌦4 is the residual angular velocity of rotor in
pitch, and yaw angles corresponding to its rotations around
which ⌦k denotes the angular velocity of the propeller k
the xB , yB and zB axes. Denoting those angles as ⇥ =
(k=1,2,3,4). Finally, the aerodynamic friction torque ⌧a is
( , ✓, )T , their rates are then given by ⇥ € € )T . The
€ = ( €, ✓,
given by:
rates relate with angular velocities, ! = [p, q, r]T , by the
⌧a = k a !2, (9)
following transformation:
where k a depends on aerodynamic friction factors, k a =

! = H ⇥, (1) [k ax, k ay, k az ]T . Given those torque components, the atti-
tude dynamic model of the quadcopter is described as:
where H is given by:
2 3 (10)
‹ = ⌧b + ⌧ + ⌧p
I⇥ ⌧a,
6 1 0 s✓ 7
6 7
H=6 0 c c✓ s 7, where I = diag[Ixx, Iyy, Izz ] is the inertia matrix when the
(2)
6 7
6 0 s c✓ c 7 quadrotor is assumed to be symmetrical.
4 5
In our system, the gyroscopic and aerodynamic torques
in which sx = sin(x) and cx = cos(x). As the result, the are considered as external disturbances. Thus, the control
rotational matrix of the quadcopter is described by: inputs mainly depend on torque ⌧ and from (4), (5) and
(6), they can be represented as:
2 3
6 c c✓ c s✓ s s c c s✓ c + s s 7
6 7 2 3 2 3 2 32 3
R = 6 s c✓ s s✓ s + c c s s✓ c c s 7 . (3) 6 u 7 6 ⌧ 7 6 0 l 0 l 7 6 F1 7
6 7 6 7 6 7 6 76 7
6 s✓ c✓ s c✓ c 7 6 u✓ 7 6 ⌧✓ 7 6 l 0 l 0 7 6 F2 7
4 5 6 7=6 7=6 76 7 , (11)
6 u 7 6 ⌧ 7 6 c c c c 7 6 F3 7
6 7 6 7 6 76 7
6 uz 7 6 F 7 6 1 1 1 1 7 6 F4 7
2.2 Quadcopter Dynamics 4 5 4 5 4 54 5
Since the focus is on the attitude control so only torque where F = F1 + F2 + F3 + F4 is the UAV lift, uz represents
components that cause changes in the orientation are con- the total thrust acting on the four propellers and u , u✓ and
sidered. They include torques caused by thrust forces ⌧, u respectively represent the roll, pitch and yaw torques,
body gyroscopic effects ⌧b , propeller gyroscopic effects c is a force-to-torque scaling coefficient. As only the
attitude of quadcopter will be controlled, uz is assumed to 3.2 QCSM control design and problem formulation
balance with the gravity. Consequently, the dynamics of
The second-order sliding mode control proposed in [8,
quadcopters can be represented in the following form for
9] is used in this paper, for which a conventional QCSM
attitude control:
is defined as follows:
1
!€ = I S(!)I! + U + d , (12) € +| | 1/2 sign( )
U= ↵ , (16)
| € | +| | 1/2
where U = [u , u✓ , u is the input vector and d =
]T
[d , d✓ , d ]T is the disturbance vector. In our system, where ↵ is the control gain to be adjusted. The control is
the following assumptions are made: continuous everywhere apart from the origin where =
€ = 0.
A.1 The quadcopter structure is rigid and symmetric. The Since I is symmetric and positive definite, the following
propellers are rigid. Lyapunov function is chosen to avoid the inversion of the
inertia matrix:
A.2 The signals ⇥ and ⇥ € can be measured by on-board 1 T
V0 = I . (17)
sensors. 2
Taking the time derivative of V gives
✓ ◆
A.3 The reference trajectories and their first and second 1⇣ T ⌘ 1 1
time derivatives are bounded. V€0 = € I + TI€ + T €
I = T I € + I€ .
2 2 2
(18)
A.4 The velocity and the acceleration of the quadcopter By substituting € from (18) to (15), one has
are bounded. ✓ ◆
 V€0 = T I ⇥ ‹ d + I⇤e€ S(!)I! + U + d + 1 I€ .
⇡ ⇡ 2
A.5 The orientation angles are limited to 2 , ,
 2 2 (19)
⇡ ⇡ Let I = I0 + I, where I0 and I represent the nominal
✓2 , and 2 [ ⇡, ⇡].
2 2 and uncertain parts of the inertia matrix. According to A1,
we have I€ = 0, equation (19) becomes
A.6 The rotational speeds of rotors are bounded.
V€0 = T { S(!) I! I⇥‹ d + I⇤e€ + d + 1 I€
2
3 Control Design + U S(!)I0 ! I0 ⇥ ‹ d + I0 ⇤e€ (20)
= T
{ P + U + P}, (21)
The control signals u , u✓ and u in (12) are used to
control the three angles { , ✓, } to reach the reference where
value ⇥d = { d, ✓ d, d }T .
P = S(!) I! I⇥‹ d + I⇤e€ + d, (22)
3.1 Sliding Manifold P = S(!)I0 ! ‹ d + I0 ⇤e.
I0 ⇥ € (23)

The sliding function determining the system’s equiva- Let ⌅ = [⌅1, ⌅2, ⌅3 ] denote the sum of P and P. Since
T

lent dynamics is presented as: the disturbance d and uncertain parameter I are bounded,
from (22) and (23) it can be seen that ⌅ is also bounded,
= e€ + ⇤e, (13) i.e., |⌅i |  ⌅ M,i, i = 1, 2, 3. Consider system (12) with
the sliding variable (!, t) as in (13). From assumptions
where ⇤ = diag( , ✓ , ) is a positive definite matrix to A1-A6, the sliding motion on the manifold is achieved by
be designed, and e = ⇥d ⇥ is the control error. Taking the controller (16) if we can select the gain ↵i such that
the derivative of , we have: [15]:
↵i ⌅ M,i . (24)
€ =⇥ ‹ ⇥ ‹ d + ⇤€e. (14) However, the bound ⌅ M,i is not easy to evaluate in practice
and besides, there is a trade-off with chattering if a high
For small angular rotations of the quadcopter, we can ap- value of ↵i is chosen. The problem is now to drive the slid-
proximate ! to ⇥ € [23]. Substituting ⇥ ‹ (12) to (14) yields: ing variable and its derivative € to zero in finite time by
means of quasi-continuous SMC without overestimation
€ = ⇥ ‹ d + ⇤€e + I 1 [ S(!)I! + U + d]. (15) of the control gain.
3.3 Adaptive QCSM Design 4 Simulation and Validation
The proposed gain-adaptation law is supposed to min- Extensive simulation has been carried out to evaluate
imise the chattering phenomenon while driving and € the performance of the proposed control algorithm. The
to zero even in the presence of disturbances. For initial model of the test quadcopter used is obtained from the
conditions !i (0), i (0), and ↵i (0) > 0, the reaching and 3DR Solo drone shown in Fig. 2 in which Lx , dx , rx and
sliding on the manifold is globally achieved in finite time hx are measured distances used to compute system param-
by the controller (16) with the following adaptive gain eters, as listed in Table 1. Design parameters used for the
[13]: controllers are given in Table 2. The UAV, with technical
specifications and accessories described in [11], was de-
(
!¯ i sign(| i (!, t)| if ↵i > ↵m,i ployed to perform the tasks of infrastructure inspection, as
i (!, t) ✏i )
↵€ i = shown in Fig. 3.
⌘i if ↵i  ↵m,i,
(25)
rm

where !¯ i > 0, ✏i , ⌘i are small positive constants, and ↵m,i dm


is a threshold of the adaptation.
day
ra
hm daz La
dmz
dax

To analyse the stability of the proposed controller, let dm


us first define a global Lyapunov function candidate for
Lh

and ↵ as: rh

’3
1
V( , ↵) = V0 + (↵i ↵M,i )2, (26)
i=1
2 i
y
x
z

where V0 has been defined in Eq. (17), i is some positive


constant and ↵M,i is the maximum possible value of the
adaptive gain ↵i . The derivative of the Lyapunov function Figure 2: The 3DR Solo drone with body coordinate
(26) is obtained as frame.


3
1
€ , ↵) = V€0 +
V( (↵i ↵M,i )↵€ i . (27)
i=1 i

Taking V€0 from (2) and ↵€ i from (25), equation (27) under
the control law (16) becomes

2 !3

3
6 sign( i ) 77
1/2
6⌅i € i +| i|
6 7+
€ , ↵) =
V( ↵i
6 7
i
| € i | +| i | 1/2
i=1
4 5

3
1
+ (↵i ↵M,i )!¯ i | i | sign(| i | ✏i ). (28)
i=1 i

When i is slowly time-varying, € i (t) is very small and


can be negligible, then equation (28) becomes
Figure 3: Insfrastructure inspection.

3
⇥ ⇤
€ , ↵) =
V( i ⌅i ↵i sign( i ) +
i=1 4.1 Control performance in nominal conditions

3
1
+ (↵i ↵M,i )!¯ i | i | sign(| i | ✏i ). (29) In this simulation, the quadcopter starts from zero initial
i=1 i conditions, i.e. all angles and velocities are zeros. Its roll
and pitch angles are then set to = 100 and ✓ = 100 at
It can be seen that V€  0 given (23) and ↵i  ↵M,i [13]. time 0.5 s and its yaw angle is then set to = 450 at time
Table 1: Parameters of the quadcopter model
Parameter Value Unit
m 1.50 kg
l 0.205 m
g 9.81 m/s2
Ixx 8.85 · 10 3 kg.m2
Iyy 15.5 · 10 3 kg.m2
Izz 23.09 · 10 3 kg.m2

Table 2: Control design parameters


Figure 5: Control torques.
Variable Value Variable Value
1 4.68 2 4.68
3 3.84 ✏1,2,3 0.7 P

1.24 !¯ 1,2,3 200


Q
↵0 R

↵m,1 0.01 ↵m,2 0.02


↵m,3 0.03 ⌘1,2,3 0.01

desired

2 s. The results are shown in Fig. 4 and Fig. 5, where desired

the time scale in the latter is zoomed in to observe the


desired

abrupt change in the control torque and coupling effect. It


can be seen that all controllers smoothly drive the angles
to the desired values with relatively small overshoot and Figure 6: Angular velocity and angle responses in the
within two seconds. According to (11), there exist strong presence of disturbances.
coupling relations between the control states. As a result,
it can been seen that the AQCSM controller can handle
4.3 Responses to parametric variations
this problem to control the attitude to reach the reference
values and then track them without being perturbed. To evaluate the performance of the proposed controller
in different conditions of loads and inertial moments, sim-
ulation parameters are varied to tolerate some modelling
errors. Specifically, a load of 0.8 kg, corresponding to
4.2 Responses to disturbances
the maximum payload of the 3DR Solo drone, is added to
the model and the following uncertainties are added to the
In this simulation, a torque disturbance with the ampli- inertial matrix:
tude of 0.5N.m is added to all three axes of the quadcopter.
2 3
The reference values are chosen to be the same as in the 6 0 0.0044 0.0077 7
6 7
previous simulation. The responses are shown in Fig. 6. I = 6 0.0044 0 0.0115 7 . (30)
6 7
As can be seen from the plots, the AQCSM controller can 6 0.0077 0.0115 0 7
cope with disturbances to reach the references and main- 4 5
tain the drone stability. Figure 7 shows the results in comparison with the nominal

P
Q
R

desired
AQCSM
desired AQCSM

desired desired
AQCSM
desired AQCSM

Figure 7: Angle and angular velocity responses in the


Figure 4: Responses of the quadcopter in nominal condi- presence of parametric variations.
tions (P, Q and R- roll, pitch and yaw angular velocities).
conditions. The almost identical settling time and over-
shoot between responses corresponding to those scenarios quadcopters. The control design is based on the selection
indicates robustness of the proposed AQCSM controller. of a sliding surface and some parameters for adaptation
The adaptive gain ↵1 (t) response versus time is shown in of the control gain taking account into chattering reduc-
Fig. 8. The higher gain magnitudes are observed in the tion. Control performance is evaluated in simulation for
two bottom sub-figures imply more energy is required to the cases of both external disturbances and system uncer-
stabilise the system in dealing with disturbances and un- tainties. This robustness property is quite important for
certainties. This also suggests feasibility of the control civil engineering applications which require accurate atti-
scheme. tudes during collecting data for monitoring and inspection
tasks. The validity of the proposed control scheme is also
judged through comparison with experimental real-time
10-3
10.002

10

9.998
data. Our future work will focus on implementing the
proposed controller to develop further high-level planning
9.996

9.994

strategies to take full advantage of UAV-based monitoring


1 1.05 1.1 1.15 1.2 1.25
10-3
10.02

10

9.98

9.96 and inspection of built infrastructure.


9.94

9.92
1 1.05 1.1 1.15 1.2 1.25
10-3

References
10.002

10

9.998

9.996
1 1.05 1.1 1.15 1.2 1.25
[1] Lénaïck Besnard, Yuri B Shtessel, and Brian Lan-
drum. Control of a quadrotor vehicle using slid-
Figure 8: The adaptation of gain ↵1 (t) in various scenarios. ing mode disturbance observer. In American
Control Conference, 2007. ACC’07, pages 5230–
5235. IEEE, 2007.
4.4 Comparison with real-time data
[2] Baohua Chen, Lei Deng, Yueqi Duan, Siyuan Huang,
To further evaluate the performance of the proposed and Jie Zhou. Building change detection based
controller, simulation results are compared with SMC and on 3d reconstruction. In Image Processing (ICIP),
real time data obtained by using the built-in PID controller 2015 IEEE International Conference on, pages 4126–
of the 3DR Solo drone when performing attitude control 4130. IEEE, 2015.
during a monitoring task [11]. The comparison is carried
out by setting the same reference yaw angle to the simu- [3] Sung-suk Choi and Eung-kon Kim. Design and
lated and real quadcopters. Figure 9 shows the responses implementation of vision-based structural safety in-
of simulation for AQCSM and SMC as well as experiment spection system using small unmanned aircraft. In
for the Solo drone’s PID. All controllers reach the refer- Advanced Communication Technology (ICACT),
ence value without causing much overshoot or oscillation 2015 17th International Conference on, pages 562–
but the AQCSM controller produces better performance 567. IEEE, 2015.
with a smoother response.
[4] L Derafa, A Benallegue, and L Fridman. Super twist-
ing control algorithm for the attitude tracking of a
four rotors uav. Journal of the Franklin Institute,
349(2):685–699, 2012.

[5] Shihong Ding, Arie Levant, and Shihua Li. New


families of high-order sliding-mode controllers. In
2015 54th IEEE Conference on Decision and Control
(CDC), pages 4752–4757. IEEE, 2015.

[6] Youngjib Ham, Kevin K Han, Jacob J Lin, and


Figure 9: Tracking errors - Yaw angular velocity and Yaw Mani Golparvar-Fard. Visual monitoring of civil in-
angle frastructure systems via camera-equipped unmanned
aerial vehicles (uavs): a review of related works.
Visualization in Engineering, 4(1):1, 2016.
5 Conclusion
[7] Arie Levant. Sliding order and sliding accuracy
In this paper, an adaptive quasi-continuous sliding mode in sliding mode control. International journal of
controller has been developed for robust control of the control, 58(6):1247–1263, 1993.
[8] Arie Levant. Higher-order sliding modes, differen- [19] Yuri Shtessel, Mohammed Taleb, and Franck
tiation and output-feedback control. International Plestan. A novel adaptive-gain supertwisting slid-
journal of Control, 76(9-10):924–941, 2003. ing mode controller: methodology and application.
Automatica, 48(5):759–769, 2012.
[9] Arie Levant. Principles of 2-sliding mode design.
Automatica, 43(4):576 – 586, 2007. [20] Vadim Utkin. Discussion aspects of high-order slid-
ing mode control. IEEE Transactions on Automatic
[10] Malik Manceur, Najib Essounbouli, and Abdelaziz
Control, 61(3):829–833, 2016.
Hamzaoui. Second-order sliding fuzzy interval type-
2 control for an uncertain system with real ap- [21] A. Woods, H. M. La, and Q. P. Ha. A novel extended
plication. Fuzzy Systems, IEEE Transactions on, potential field controller for use on aerial robots. In
20(2):262–275, 2012. Automation Science and Engineering (CASE), 2016
IEEE International Conference on, pages 286–291,
[11] M. D. Phung, T. H. Dinh, V. T. Hoang, and
2016.
Q. P. Ha. Automatic crack detection in built in-
frastructure using unmanned aerial vehicles. In [22] Rong Xu and Ümit Özgüner. Sliding mode control
Automation and Robotics in Construction (ISARC), of a quadrotor helicopter. In Decision and Control,
2017 International Symposium on, 2017. 2006 45th IEEE Conference on, pages 4957–4962.
[12] MD Phung, CH Quach, DT Chu, NQ Nguyen, IEEE, 2006.
TH Dinh, and QP Ha. Automatic interpretation [23] En-Hui Zheng, Jing-Jing Xiong, and Ji-Liang Luo.
of unordered point cloud data for uav navigation Second order sliding mode control for a quadrotor
in construction. In Control, Automation, Robotics uav. ISA transactions, 53(4):1350–1356, 2014.
and Vision (ICARCV), The 2016 14th International
Conference on, 2016. [24] Z. Zuo. Trajectory tracking control design with
command-filtered compensation for a quadrotor. IET
[13] Franck Plestan, Yuri Shtessel, Vincent Bregeault, Control Theory Appl., 4(11):2343–2355, 2010.
and Alexander Poznyak. New methodologies for
adaptive sliding mode control. International journal
of control, 83(9):1907–1919, 2010.
[14] Andrei Polyakov and Alex Poznyak. Lyapunov
function design for finite-time convergence analysis:
"twisting" controller for second-order sliding mode
realization. Automatica, 45(2):444–448, 2009.
[15] Chutiphon Pukdeboon, Alan SI Zinober, and
May-Win L Thein. Quasi-continuous higher or-
der sliding-mode controllers for spacecraft-attitude-
tracking maneuvers. IEEE Transactions on Industrial
Electronics, 57(4):1436–1444, 2010.
[16] Guilherme V Raffo, Manuel G Ortega, and Fran-
cisco R Rubio. An integral predictive/nonlinear
H1 control structure for a quadrotor helicopter.
Automatica, 46(1):29–39, 2010.
[17] R. Ritz, M. Hehn, S. Lupashin, and R. D’Andrea.
Quadrocopter performance benchmarking using op-
timal control. In Intelligent Robots and Systems
(IROS), 2011 IEEE/RSJ International Conference
on, pages 5179–5186, Sept 2011.
[18] Guillermo J Rubio, José M Cañedo, Vadim I Utkin,
and Alexander G Loukianov. Second order sliding
mode block control of single-phase induction mo-
tors. International Journal of Robust and Nonlinear
Control, 24(4):682–698, 2014.

You might also like