Professional Documents
Culture Documents
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)
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
and ↵ as: rh
’3
1
V( , ↵) = V0 + (↵i ↵M,i )2, (26)
i=1
2 i
y
x
z
’
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
desired
P
Q
R
desired
AQCSM
desired AQCSM
desired desired
AQCSM
desired AQCSM
10
9.998
data. Our future work will focus on implementing the
proposed controller to develop further high-level planning
9.996
9.994
10
9.98
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.