Download as pdf or txt
Download as pdf or txt
You are on page 1of 13

134 Int. J. Mechatronics and Automation, Vol. 7, No.

3, 2020

Adaptive fuzzy model-free control for 3D trajectory


tracking of quadrotor

Zakaria Chekakta* and Mokhtar Zerikat


LAAS Laboratory,
Department of Electrical Engineering,
Ecole Nationale Polytechnique d’Oran Maurice Audin,
Oran, Algeria
Email: zakaria.chekakta@gmail.com
Email: zerikat@yahoo.fr
*Corresponding author

Yasser Bouzid
CSCS Laboratory,
Ecole Militaire Polytechnique,
Algiers, Algeria
Email: yasseremp@gmail.com

Anis Koubaa
Robotics and Internet of Things Research Lab,
Prince Sultan University, Saudi Arabia
Email: anis.koubaa@gmail.com

Abstract: This paper presents a novel adaptive control strategy with rejection ability for
unmanned aerial vehicles (UAVs), namely fuzzy model-free control (FMFC). It is based on the
model-free control (MFC) concept, where the control parameters are tuned online using fuzzy
logic. The controller assumes an ultra-local model that can compensate unknown/unmodelled
dynamics, uncertainties and external disturbances, ensuring a good robustness level. Moreover,
the fuzzy logic system is used to tune online the proportional-derivative terms due to its heuristic
aspect. These compensation and adaptation mechanisms allow ensuring good compromise
robustness-performance even in the presence of disturbances. Several experiments, using RotorS
Gazebo micro aerial vehicle (MAV) simulator, are provided to demonstrate the effectiveness of
the proposed controller compared with other techniques. The fuzzy model-free controller shows
superior performance without the time-consuming and tedious tuning task.

Keywords: micro aerial vehicle; MAV; model-free control; MFC; fuzzy logic; adaptive control;
robust control.

Reference to this paper should be made as follows: Chekakta, Z., Zerikat, M., Bouzid, Y. and
Koubaa, A. (2020) ‘Adaptive fuzzy model-free control for 3D trajectory tracking of quadrotor’,
Int. J. Mechatronics and Automation, Vol. 7, No. 3, pp.134–146.
Biographical notes: Zakaria Chekakta is a PhD student at the National School Polytechnic of
Oran (ENPO) in Algeria, he received his BS in Electrical Engineering and MS in Electronic and
Embedded System in 2014, and 2016 respectively from the ENPO. He is currently conducting
researches on advanced optimal control of quadrotor including reinforcement learning control
using artificial intelligent algorithms.

Mokhtar Zerikat received his BS in Electrical Engineering, and his MS and PhD in Electronics
from the University of Sciences and Technology of Oran, Algeria, in 1982, 1992, and 2002,
respectively. He is currently a Professor in the Department of Electrical Engineering at the Ecole
Nationale Polytechnique d’Oran, Algeria. His current research includes embedded electronic
systems, modelling and adaptive control, image processing and intelligent applications. He is
involved in industry projects while engaged in teaching, research and consulting. He is the
Chairman of the IEEE in Algeria State and a member of the Industrial COST Education
Committee.

Yasser Bouzid received his Master of Science from the University of Paris XI, France in 2015.
He also received PhD in Automatic from the Paris Saclay University in 2018. He is currently an
Assistant Professor at the Ecole Militaire Polytechnique, Bordj El-Bahri, Algeria and a member

Copyright © 2020 Inderscience Enterprises Ltd.


Adaptive fuzzy model-free control for 3D trajectory tracking of quadrotor 135

in the CSCS Lab. His research interests include nonlinear control, fault tolerant control,
observation and estimation, path planning, heuristic algorithms, unmanned aerial vehicles,
multi-agent systems, and soft robotics.

Anis Koubaa is currently a Professor of Computer Science and the Leader of the Robotics and
Internet of Things Research Laboratory, Prince Sultan University. He is also a senior researcher
in the CISTER and ISEP-IPP, Porto, Portugal, and a research and development consultant in the
Gaitech Robotics, China. His current research deals with the integration of robots and drones into
the internet of things (IoT) and clouds. He is also a Senior Fellow of the Higher Education
Academy (HEA), UK. He has been the Chair of the ACM Chapter in Saudi Arabia, since 2014.

1 Introduction
Nowadays, unmanned aerial vehicles (UAVs) play a crucial 1.1 Paper contributions
role in many services such as aerial surveillance (Benjdira Even though the efficiency of MFC has been improved in
et al., 2019a), tracking (Koubaa and Qureshi, 2018), recent years, most of the improvements have been achieved
internet-of-drones (Koubaa et al., 2019), search and rescue due to different combinations between MFC and nonlinear
operations (Alotaibi et al., 2019), remote sensing (Benjdira auxiliary controllers. However, one of the major challenging
et al., 2019b), delivery, etc. Such an interest has attracted in the control system development is the robustness against
academic and industry researchers to solve problems related disturbances and uncertainties. Consequently, a new
to their large scale deployment. Currently, a variety of model-free controller with fuzzy logic self-tuning PD
UAVs are either deployed or under development. feedback (FiPD is referred to fuzzy logic MFC) is
Nevertheless, quadrotors are the most popular presented. The PD gains are refined during the control
configurations of multi-rotors UAVs. This is likely due to process to provide good performance. The control action
some of their characteristics such as the mechanical can be taken based on the estimation of the ultra-local
structure simplicity, vertical take-off and landing (VTOL) model to compensate all the unknown/unmodelled
capability and high maneuverability. dynamics, uncertainties and disturbances. Moreover, a deep
In the literature of quadrotor control, a variety of control study of robustness level compared to fuzzy logic PID and
techniques have been developed and successfully classic MFC is highlighted even when disturbances occur.
implemented for attitude stabilisation problem, and In addition, the control problem was divided into two
trajectory tracking as well. First studies were primarily levels supported by the dynamic structure of the multi-rotor
focused on linear control (Bouabdallah et al., 2004; system micro aerial vehicle (MAV). The low-level (inner
Mokhtaril et al., 2005). However, they were limited to loop) contains the attitude controller and computes the
non-agile motions due to the fact that they were based on angular speed of each rotor. The high-level controller (outer
the linearised dynamics model. Besides linear control loop) deals with the position controller and generates the
techniques, many researchers have proposed several desired roll and pitch angles. The proposed high-level
nonlinear methods to deal with the nonlinear dynamics of controller strategy is applied to control the position of the
the quadrotor (Benallegue et al., 2006; Bouabdallah and quadrotor, and to ensure the tracking of a desired trajectory.
Siegwart, 2005; Lee and Leok, 2010). Several approaches Specific attention is given to the accuracy of tracking and
have also developed and presented comprehensively in Lee energy consumption based on several performance metrics,
and Kim (2017). such as the integral squared error (ISE) and the integral
The nonlinear approaches are interesting. However, they squared control input (ISCI).
suffer from the dependence on the dynamic model of the Moreover, to evaluate the proposed strategy, the
system. One of the main issues is the lack of precise framework RotorS Gazebo MAV simulator (Furrer et al.,
information about the nonlinear high coupling terms, 2016) was used, which allows to use the same controller
especially under the effect of disturbances. To solve this algorithm including their parameters in the simulation as
problem, considerable attention has been recently paid to well as in real application.
the development of an improved technique to deal with
these unknown/unmodelled dynamics and disturbances.
1.2 Outlines
Among these interesting approaches, the model-free control
(MFC) proposed by Fliess and Join (2013), is noteworthy. It The remaining of the paper is organised as follows:
is called intelligent PID (iPID). It is important to note that Section 2 provides a brief background on the MFC approach
the terminology of MFC is not new in the literature, while and its related work. The dynamic model of quadrotor is
the term iPID has also been used previously, but with described in Section 3. Section 4 presents the proposed
different significations. control strategy. Experimental validation, using realistic
simulator under various scenarios to support the main goal
of this paper, is presented in Section 5. Concluding remarks
are given in Section 6.
136 Z. Chekakta et al.

2 Brief background and related work (PD) sliding mode control in the presence of external
disturbances. Cascaded MFC was tested by Bekcheva et al.
Initially, the basic of MFC was introduced by Fliess and
(2018) on a realistic quadrotor model in the presence of
Join (Fliess et al., 2006; Bourdais et al., 2007). The
unknown time varying disturbance for the tracking of an
fundamental idea of this technique is to use an observation
aggressive trajectory.
mechanism to estimate online the ultra-local model, which
represents the dynamic model of the system in addition to
the unknown/unmodelled dynamics, uncertainties and
3 Dynamic model of quadrotor
external disturbances. It is important to note that this
estimation is valid for a short time interval. This section presents a dynamic mode based on Wang’s
Usually, MFC also uses one of the linear/nonlinear (2013) model that describes the quadrotor using
control technique as an auxiliary input. In most cases, the Newton-Euler. However, some assumptions were made:
linear controller could be used due to its simplicity and
Assumption 1: The framework of the vehicle and the
efficiency. Otherwise, the nonlinear controller must be used
propellers are rigid and quite symmetrical.
to deal with the nonlinear terms of the system and achieve
certain control performance. Assumption 2: The origin of the body-fixed frame coincides
The major benefit of this control approach is that it does with the CoG of the vehicle.
not require a vast knowledge about the system dynamics
Assumption 3: The dynamics of the rotors are very fast and
whose parameters are difficult to be identified relatively
then will be ignored.
accurately using system identification. Thus, it can be easily
applied to control unknown/complex systems. Let I = {xi, yi, zi} denotes the inertial frame and B = {xb, yb,
Several studies have been carried out, including the zb} denotes the body-fixed frame (see Figure 1).
work of Chemori (2017), who designed a control structure
using model free to handle the under-actuation in stable Figure 1 Forces and moments acting on quadrotor with attached
limit cycle generation for the inertia wheel inverted coordinate frames (see online version for colours)
pendulum. Experiments in real-time shows the effectiveness
of the proposed control strategy and its ability for external
disturbances rejection. The model-free controller also
applied by Abouaïssa and Chouraqui (2019) to a six degree
of freedom PUMA-560 arm manipulator to track a desired
trajectory. Simulation results illustrated that the model-free
controller is able to provide outstanding tracking
performance robustly. Haddar et al. (2019) proposed an
Intelligent PD controller based on robust MFC strategy for
attenuating vibrations caused by road disturbance inputs in
vehicle suspension system.
For the quadrotor system, the MFC is implemented. It is
combined with LQR feedback controller and tested on a real
Qball-X4 quadrotor by Al Younes et al. (2014). Flight
control evaluation in real-world results confirm the
significance of employing the MFC. Same authors proposed The orientation from the body-fixed frame to the inertial
a combination between the nonlinear integral backstepping frame can be described using the rotational matrix R(1).
controller and model-free controller (Al Younes et al.,
2016). This combination shows superior performance with The order of rotation used in this work is yaw (ψ) followed
respect to other control techniques in terms of trackability of by pitch (θ) followed by roll () around the z, y and x axes
the desired path, stability, and robustness with the presence respectively.
of the actuator fault. Wang et al. (2016) developed a model cψ cθ s sθ  c sψ s sψ  c cψ sθ 
free-based terminal sliding-mode control (MFTSMC) to
R   cθ sψ c cψ  s sψ sθ c sψ sθ  cψ s  (1)
eliminate the tracking error in the finite time. Simulation
results demonstrate that MFTSMC has an advantage over   sθ cθ s c cθ 
the PID, backstepping, sliding-mode, and iPD control in
where c(.) = cos(.) and s(.) = sin(.).
term of the rise time, steady-state error, robustness, and
Based on the previous assumptions, and using the
disturbance rejection. Bouzid et al. (2018) derived an
Newton-Euler laws that relate the motion of the quadrotor
improved energy-based control via an online disturbance
with the sum of external forces and moments acting on the
compensation based on the MFC approach. The efficiency
vehicle in the body-fixed frame, the following equation is
of this approach is demonstrated in various scenarios. High
obtained:
level of robustness is ensured with respect to parameters
uncertainties or external disturbances. Li et al. (2018)
developed a MFC using an adaptive proportional derivative
Adaptive fuzzy model-free control for 3D trajectory tracking of quadrotor 137

 mJ O33  Vb   ωb   mVb    Fb   J x p    J y  J z  qr 


O    (2)  J q     J  J  pr   M
 33 J   ω   ωb   Jωb    M b  (5)
 y   z x  b
 J z r   J x  J y  pq 
where
 m is the mass of the quadrotor Otherwise, the total moments Mb = [Mx My Mz]T can be
written as follows:
 O3×3 is a 3 by 3 dimensional zero matrix and × denotes
the cross product  x    x 
M b  y  θ  y  (6)
 J  3×3 is the inertia matrix about the centre of
  
gravity, by Assumption 1, the inertia matrix turn into
J = dig(Jx, Jy, Jz) where

 Vb = [u, v, w]  3×1 is the linear velocity of the   and θ are the rolling and pitching moments
quadrotor around x and y axis respectively; they can be described
by:
 ωb = [p, q, r]  3×1 is the angular velocity in the
  l T2  T4  θ  l  T1  T3 
body-fixed frame
where  is the arm length.
 Fb = [Fx, Fy, Fz]T  3×1 and Mb = [Mx, My, Mz]T  3×1
are respectively the external forces and moments acting   is the yawing moment
on the quadrotor in the body-fixed frame.
 x and y are the blade flapping moments of ith rotor
Since the quadrotor model contains rotational and along x and y axis respectively
translational motions, using the relationship between the
linear accelerations and forces within the body-fixed frame,  x the gyroscopic moment along x axis defined as:
the translational motion can be computed by the following
4
equation:
x  (1)i 1 J r p i
xb   rxb  qzb 
  i 1
     1
 
 yb    pzb  rxb   m Fb (3) where Jr is the inertia of a rotor.
 
zb   qxb  pyb 
 y is the gyroscopic moment along y axis and is
Further, the equation describes the total external forces as obtained as:
follows: 4

 4

y  (1)i 1 J r p i

  H ix 
 i 1 
i 1

 Fxb   4   0  On the other hand, the equation that represents the relation
  between the angular velocities ωb = [p, q, r]T of the
 
Fb   Fyb     H iy   R T

 0 
  (4)
quadrotor in the body-fixed frame and the angular velocities
 Fzb   i 1   G 
 4  η  [, θ, ψ ]T in the inertia frame is written as follows:
 
 i 1
Ti 
   1 s tan θ c tan θ   p 
  
where:  θ   0 c  s   q  (7)
ψ  0 s sec θ c sec θ   r 
 G = –mg is the gravity along zi axis in the inertial frame
and g is the gravity acceleration. Here, the force in the Near to the equilibrium state, a small angles assumption is
Inertial frame can be translated into the body-fixed made where cos ≈ 1, cosθ ≈ 1 and sin ≈ sinθ ≈ 0.
frame using the rotation matrix R–1 = RT Therefore according to Mokhtaril et al. (2005) the following
is obtained:
 Hix the hub force of the ith rotor along xb axis
 Hiy the hub force of the ith rotor along yb axis  p     sθ ψ   
 q    c θ  s c ψ    θ  (8)
 Ti the thrust force of the ith rotor along zb axis.      θ   
 r    s θ  c cθ ψ  ψ 
 
Then, the rotational motion id derived using the relation
between the moments and the angular acceleration in the  = [x, y, z]T denotes the position of the quadrotor in the
body-fixed frame according to equation (5): Inertial frame. The following presents the complete
138 Z. Chekakta et al.

mathematical model of the quadrotor (Bouabdallah and  u


Siegwart, 2005; Lee and Leok, 2010):  x  1  c sθ cψ  s sψ   ρx
m
It is commonly assumed that the thrust and drag forces 
  u
are proportional to the square of the rotor’s speeds: y  i  c sθ sψ  s cψ   ρd
 m

Ti  C f i2 i  Cm i2   u
z  1  c cθ   g  ρd
 m
where Cf|m is aerodynamic coefficient.  (12)
J y  Jz  u
  θψ  2  ρ
  4
  J Jx

x
   H ix   
  i 1  J  Jx  u
b  θ  z  ψ  3  ρθ
 
x   ψx
 b  θz  4   0   J y J y
    1
      
 y   R   zb  ψxb   m   H iy     0  (9) 
ψ 
J x  J y   u4
 θ   ρψ
 
z   θx
 b   yb 
  i 1     g   Jz Jz
  4 

 
 i 1
fi  
  where  = [ρx, ρy, ρz, ρ, ρθ, ρψ]T  6×1 is a bounded vector

holds unknown noise and disturbances.
 J x  J y  J z  θψ 
Contemporary research on UAVs tend to focus on the
    
 J y θ    J z  J x   ψ  control system rather than the system modelling and
 J z ψ    J x  J y  θ  identification. Further, the enhancement of the control
 
performance depends on the accurate knowledge of the
 4


system parameters. In fact, precise estimation of the
 (1)i 1 k ρA  i Rrad  Rrad 
2

  nonlinear high coupling system parameters such as


i 1
 4  quadrotor is often not possible.
    (1)i 1
 
i 1
J r q i 
 (10)
 
 4
 4 Control strategy
 k ρA  i Rrad  Rrad 
2
 (1)
i 1

 i 1  Although nonlinear approaches exhibit superior


 4  performance, they require a wide knowledge about the
  θ  (1)i 1
 
i 1
J r q i 

system parameters and dynamics. It is difficult to obtain a
precise model for quadrotor, due to the influence of high
 
 4
 coupling terms, uncertainties and unknown external
 k ρA  i Rrad  Rrad 
2
(1)
i 1
disturbances. Recently, an interesting approach was
 i 1  proposed to solve this problem (Fliess and Join, 2013). It is
called MFC or iPID. The efficiency of this approach has
Hereinafter, the input control vector is defined as follows:
been improved by different alternatives of nonlinear
 i 4 controllers.
 1

u    C f 
i 1
i4 Therefore, it is possible to improve the effectiveness of
the MFC approach by introducing self-tuning and
 i 4
adaptation mechanism to the controller gains via fuzzy
u2    C f   2
 
i 1
i logic. As a result, the control performance for 3D trajectory
 (11) tracking can be improved as well as the robustness level
i 4

 u3   θ  C f   i2 against different disturbances.
 i 1
 i 4 4.1 Model-free control
 u4    Cm


i 1
i2
Generally, a nonlinear nth order single input single output
(SISO) system can be expressed by the following form:
It is well-known that the control-oriented model neglects
some forces and moments such as hub forces, blade x ( n )  g  x, x ,  , x ( n )   au (13)
flapping moments and the gyroscopic moments. Under this
approximation and the above simplifications, the simplified where g(.) is the model of the system, u   is the input,
model can be written as follows:
and a   is unkonwn input gain.
The basic idea of MFC is to locally approximate the
system presented in equation (13) by using a simple model
F  :
Adaptive fuzzy model-free control for 3D trajectory tracking of quadrotor 139

x ( n )  F  λu (14) Fˆ  
xd  k p e  kd e
u (20)
where λ

 F   is the ultra-local model Figure 2 Structure of MFC

 λ   is non-physical parameter.

It should be noted that the ultra-local model F represents the


dynamic model of the system in addition to the unknown/
unmodelled dynamics, uncertainties and disturbances at
time t, and it can be estimated by the following equation:
Stability of MFC by substituting equation (20) in Haddar
Fˆ (t )  xˆ (t )( n )  λu (t  ε ) (15) et al. (2019), we get the following relation:
where  xd  F  Fˆ  k p e  kd e
x   (21)
 x(t) the last output. If the estimation error of F as eest is defined as, it is possible
 x(n) is the derivative of order n ≥ 1 of x. The value of n to obtain:
is determined by the control designer. Several e  k p e  kd e  eest  0 (22)
precedent cases show that n   should constantly be
where eest   is time-varying.
chosen minimum at possible (Fliess and Join, 2013).
Otherwise, each small time interval h is written as
 λ   is a non-physical constant to estimate the follows:
unknown input gain a. It is chosen by the designer to
dxˆ duˆ
attain certain performance. eest   xˆ  λ  u (t )  u (t  ε )  
x   h h (23)
dt dt
 u(t – ε) is the latest applied control input.
dxˆ duˆ
 ε is the time-delay and the smaller ε is, the best Usually, in physical system and are bounded and
dt dt
estimation of the ultra-local model Fˆ (t ).
not equal to infinity, hence it gives the following:
The estimation of the ultra-local model F̂ will be updated
dxˆ duˆ
online at each iteration. Usually, MFC uses the classical PD  x  u
controller as auxiliary input due to its simplicity. It has the dt dt
following form: where the estimation  x̂ is supposed to be filtered, if a time
uc (t )  k p e(t )  kd e(t ) (16) interval h is rather small with respect to system dynamic
selected. eest will be bounded in small limit |eest| ≥ ,  ≥ 0.
where e(t) = x(t) – xd(t) denotes the tracking error between
Thus, by choosing appropriate gain kp and kd, the error in
the reference trajectory xd(t) and the output x(t). kp and kd
are the proportional and derivative gains respectively. equation (22) will converge to this small limit .
The global control input u is given by: Consequently, the system is practically stable (Wang,
2013).
Fˆ (t )  xd( n ) (t )  uc (t )
u (t )   (17)
λ 4.2 Fuzzy logic PD controller
The value of n has been chosen according to the system The best performance of PD controller depends on the
stability and the type of the feedback controller used in the optimal selection of the controller gains. Most likely, tuning
system (Fliess and Join, 2013). For this work, a second these gains is a tedious task. Herein, the fuzzy logic system
order system was used with n = 2. Furthermore, the was chosen to tune these gains due to its heuristic
time-delay  was neglected: characteristic and effectiveness. This approach turns the PD
controller into an adaptive controller.
x  F  λu
 (18) Figure 3 shows the fuzzy logic system used in this work,
Therefore, the ultra-local model can be estimated as which has two inputs (the tracking position error e and the
follows: tracking velocity error e ), and two outputs (kp, kd).
Furthermore, the fuzzy system uses the Mamdani method
Fˆ  
xˆ  λu (19) for the basic rules.
Finally, the control input of model-free controller shown in
Figure 2 has the following form:
140 Z. Chekakta et al.

Figure 3 Fuzzy logic system for PD controller Table 1 Rules for kp


(see online version for colours)
e / e NL NS ZE PS PL
NL PVL PVL PVL PVL PVL
NS PML PML PML PL PVL
ZE PVS PVS PS PMS PMS
PS PML PML PML PL PVL
Details of membership functions are represented in
PL PVL PVL PVL PVL PVL
Figure 4. For each input variable e and e, the fuzzy logic
system is designed to have five triangular membership
Table 2 Rules for kd
functions: negative large (NL), negative small (NS), zero
(ZE), positive small (PS) and positive large (PL). The input e / e NL NS ZE PS PL
membership functions are contained in the universal sets.
NL PVS PML PM PL PVL
The universal sets of all inputs ranging have the same range
[–1 1]. NS PMS PML PL PVL PVL
ZE PM PL PL PVL PVL
Figure 4 Membership functions for the all inputs PS PML PVL PVL PVL PVL
(see online version for colours)
PL PVL PVL PVL PVL PVL

All rules shown in Tables 1 and 2 are connected with the


AND operator. For example:
IF e is NS AND e is ZE, THEN k p is PVS
AND kd is PL.

The output is fuzzy information. Since the output for PD


controller requires a precise real number, it will be
For the output variables, the fuzzy logic system is designed necessary to convert the membership function obtained to a
to have seven triangular membership functions that are precise value. This operation called defuzzification.
considered as positive very small (PVS), PS, positive
medium small (PMS), positive medium (PM), positive 4.3 Cascaded control approach for multi-rotor
medium large (PML), PL and positive very large (PVL). system
The membership functions for the output variables kp
Figure 6 illustrates the control architecture used for this
and kd are shown in Figure 5. The universal sets ranging can
work. It is named as a hierarchical or cascaded control
be chosen by hit and trial. For this work they have been
structure. Moreover, this control scheme divides the control
chosen between [0.1 5].
problem into two loops. The first one is the outer loop,
Figure 5 Membership functions for outputs kp and kd which provides the desired roll and pitch angles in addition
(see online version for colours) to the thrust. The last one is the inner loop, which is used to
follow these angles to achieve the desired position.
However, the main objective of this work is to increase
the trajectory tracking performance. Therefore, the proposed
strategy was applied in the outer loop for the position
controller. Whereas the controller used in the inner loop is a
simple PID controller, as it has proved to be effective in
attitude control.

4.3.1 Position control (outer-loop)


The set linguistic rules is the major part of the fuzzy logic The altitude control input of the quadrotor is the resulting
system. In many cases, it is easy to translate an expert thrust force of the four rotors, which is based on the
experience into these rules and any number of such rules following equation:
can be created to define the actions of the system outputs. In 4
some other cases these rules can be obtained from some trial
and error approaches Tables 1–2 show the 25 rules used in T  u
1
i 1 (24)
this work for all possible combinations of the inputs for
tuning PD gains. Where the derived control law is written as follows:
Adaptive fuzzy model-free control for 3D trajectory tracking of quadrotor 141

5 Results and discussion


u1  
1 ˆ
λz
 Fz  zd  k pz ez  kdz ez  (25)
In this work, the AscTech hummingbird quadrotor was
Model-free control for positions x and y is given by the chosen for the experiments. Table 3 indicates the quadrotor
virtual control input ux and uy respectively. The parameters. In addition, the yaw angle is assumed to be zero
corresponding control laws can be written as: due to the high coupling in position and attitude dynamics.
The proposed control strategy was compared with two other
1 ˆ
ux  
λx
 Fx  xd  k px ex  kdx ex  control techniques, Fuzzy Logic PID control and model-free
control iPD, to illustrate the effectiveness of the proposed
(26) controller.
u y    Fˆy  
1
yd  k py e y  kdy ey 
λy
5.1 Experimental setup
where
All the experiments were conducted on a laptop with Intel®
 Fˆx  
xˆ  λx u x CoreTM i5-2410M CPU @ 2.30 GHz × 4, 8 GB RAM, and
 600 GB disk drive, using RotorS Gazebo MAV Simulator.
 Fˆy  
yˆ  λy u y (27) This framework permits the employment of the same
ˆ
zˆ  λz u1
 Fz   designed controllers, including their parameters, in the
simulation as well as on real application. Furthermore, the
Figure 6 Control structure of quadrotor (see online version strategy followed for robot operating system (ROS)
for colours) integration of the fuzzy model-free controller is to create a
ROS node to interface the controller to ROS, while model-
free control was implemented using C++ (Chekakta et al.,
2019). The fuzzy logic node was implemented within
MATLAB/Simulink block. Autocode generation was used
to extract the node package. The low-level attitude PID
controller node, used in this work, was previously
implemented by Kamel et al. (2016) for model predictive
control. The initial position of the quadrotor is x = 0(m),
y = 0(m), z = 0.06(m).
4.3.2 Attitude control (inner-loop)
The roll control input u2 is the difference in thrust between Table 3 AscTech hummingbird quadrotor parameters
rotors 1 and 3. The pitch control input u3 is the difference in Parameter Symbol Value Unit
thrust between rotors 2 and 4. The yaw control input u4 is
Inertia on x-axis Jx 0.007 kg m2
the difference in torque between the two clockwise turning
rotors 2 and 4 and the two counter-clockwise 1 and 3. The Inertia on y-axis Jy 0.007 kg m2
outputs of PID controller are given by: Inertia on z-axis Jz 012 kg m2
Quadrotor’s mass m 0 716 Kg

u2  k p e  ki e  kd e
 Arm length  17 m



u3  k pθ eθ  kiθ eθ  kdθ eθ (28) Thrust coefficient Cf 0.54858e –16
N kg s2
Drag coefficient Cm 0.016 Nm kg s2

u4  k pψ eψ  kiψ eψ  kdψ eψ

Table 4 shows the control gains of model-free controller.
where
Table 4 Model-free controller gains (P: parameter, V: value)
e  des  
 P V P V P V
eθ  θdes  θ (29)
e  ψ  ψ kpx 0.65 kdx 1.3 λx 1
 ψ des
kpy 0.65 kdy 1.3 λy 1
The desired yaw angle ψdes is given by the operator or the kpz 8.3 kdz 4.6 λz 5
trajectory generator, while the desired roll des and pitch θdes
angles are generated from equation (30):
5.2 In-depth trajectory tracking analysis
 1
des  g   u x cos  ψ des   u y sin  ψ des   In this experiment, a square trajectory (2 m × 2 m) was used

 (30) as a reference trajectory (Figure 7), where the mathematical
θdes  1   u x sin  ψ des   u y cos  ψ des   expression can be found in Appendix.
 g
142 Z. Chekakta et al.

Figure 7 Desired path by the outer-loop, (high-level controller) are plotted using
virtual control input ux, uy, and the last plot is the control
effort (thrust ).
Figure 9 presents the results obtained from the basic
scenario. Based on curves in Figures 9(a)–9(c), it can be
observed that the proposed controller FiPD ensures the
tracking of the desired trajectory with small errors, and it is
roughly the same compared to model-free control (iPD).
However, the fuzzy logic PID is the least accurate.
Otherwise, the thrust curves (control effort) in Figure 9(f)
show the energy consumption, we can see that the FiPD and
Several realistic scenarios were performed to show the iPD consume less energy compared to fuzzy logic PID, the
effectiveness of the proposed control strategy. These reason is the initial measured altitude position z = 0.06 m.
scenarios are as follows: Herein, the initial error for the position z, computed by the
1 Basic scenario (nominal case): For this scenario, the controller is 0.06. In Figure 9(c), the proposed controller
quadrotor should follow a desired trajectory under ideal and model-free control deal with this error and no control
conditions without any external disturbances. effort would be generated until the controller receives the
desired trajectory and take-off, while the fuzzy logic PID is
2 Parameters uncertainties: Precisely parameter generating control effort signal even when there is no
estimation and well-knowledge about the dynamics of desired altitude given as an input. Also, after quadrotor
the quadrotor are often challenging to obtain. Hence, it landing, the proposed controller and iPD would generate a
is assumed that the aerodynamic coefficients and the null control effort signal, while fuzzy logic PID keep
inertia elements are underestimated by 50% from their generating control effort. Curves in Figures 9(d)–9(e) show
real values. The control technique should be able to the desired pitch and roll angles given to the low-level
tolerate the uncertainties in the system parameters. attitude controller to achieve the motion along x and y-axes
3 Payload: In this scenario, we assume the quadrotor is respectively.
carrying an extra weight of 0.3 kg. The controller Overall, in term of trajectory tracking accuracy as a
should be able to generate the appropriate control effort performance criteria, the proposed FiPD controller shows
to follow the desired trajectory even in presence of superior performance with respect to other techniques. This
mass variation. is due to the compensation mechanism provided by the
ultra-local model, and the adaptation technique obtained by
4 Wind disturbance: The wind disturbance is a big the fuzzy logic system. In addition, it is important to note
challenge for the quadrotor control problem due to the that the proposed FiPD is robust and able to reject the
underactuated nature in the translational motion. To disturbances from the environment.
further understand the situation, if a continuous and To obtain a deeper analysis of robustness, two metrics
constant wind disturbance is appeared along the x-axis, were introduced, integral square error (ISE) quantifying the
the quadrotor must maintain a small pitch angle to keep trajectory tracking error and ISCI quantifying the energy
the quadrotor in the desired x position. In this case, to consumption. The metrics are defined as follows:
test wind robustness, an unknown and time-varying
tf
external wind disturbance is applied in the x-direction,
and constant wind in the y-direction around the linear
 ISE  t0
 ex2 (t )  e2y (t )  ez2 (t )  dt
velocity indicated in Figure 8.
tf
 ISCI    u12 (t )  dt.
Figure 8 Wind disturbance (see online version for colours) t0

Table 5 In-depth comparison

Type Fuzzy PID iPD FiPD


Basic scenario ISE 0.7969 0.3616 0.2653
ISCI 2383 2031 2025
Parameters ISE 1.0318 0.3321 0.2475
uncertainties ISCI 4853 4210 4140
Payload ISE 1.0066 0.3955 0.2660
ISCI 4727 4118 4040
For the basic scenario, the tracking errors along x, y and Wind disturbance ISE 1.8811 0.5410 0.3517
z-axes, the desired roll des and pitch θdes angles, generated ISCI 2,375 2,039 2,024
Adaptive fuzzy model-free control for 3D trajectory tracking of quadrotor 143

Figure 9 Basic scenario results (see online version for colours)

Figure 10 Controller gains (see online version for colours)

(a) (b)

Figure 11 Aggressive trajectory response (see online version for colours)

(a) (b)
144 Z. Chekakta et al.

Figure 11 Aggressive trajectory response (continued) (see online version for colours)

(c) (d)

Table 5 summarises the overall quantified metrics. 5.3 Aggressive trajectory


According to the results from the basic scenario, the
The last experiment was conducted using an aggressive
proposed strategy has a small tracking error (ISE 0.2653),
trajectory to test the effectiveness of the proposed strategy
and low energy consumption (ISCI 2025), followed by
in case of an aggressive motion. The expression of the
model-free control, which has an acceptable tracking error
aggressive trajectory can be found in Appendix.
(ISE 0.3616), and a moderate energy consumption (ISCI
Figure 11(a) and 11(c) shows the 3D tracking with the 2D
2031). The second baseline, fuzzy Logic PID, was the least
Figure 11(b) and 11(d) in the x-y plane. Furthermore, in the
accurate technique (ISE 0.7969), and it has the highest
first case, the environment was assumed ideal (nominal
energy consumption (ISCI 2383). Furthermore, the results
case), no external disturbances occurred. The results
under parameters uncertainties scenario show that the
depicted in Figures 11(a)–(b) (basic scenario) indicate that
tracking error is almost the same as the basic scenario in the
the FiPD controller has the best performance compared to
proposed technique as well as in model-free control. The
iPD and fuzzy Logic PID controller. In the second case, the
fuzzy logic PID, however, delivers a poor tracking
previous wind disturbances were introduced into the
accuracy. These results provide additional support for the
environment. Figure 11(c) (wind disturbance) shows the
capability of tolerating parameters uncertainties in the
result with the 2D Figure 11(d) (wind disturbance) in the x-y
proposed control technique. In addition, in the presence of
plane. It can be observed that the FiPD technique shows
extra payload, the ISE in fuzzy model-free control (FMFC)
satisfactory results with respect to other techniques.
is close to the ISE value of the basic scenario. Whereas, a
lack of accuracy is observed (higher ISE) in model-free
control. In contrast, there is a major increment of tracking
error in fuzzy logic PID. As a result, these outcomes of 6 Conclusions
FMFC highlight the robustness level to mass variation. This paper presented a new FMFC for UAVs. The purpose
Lastly, the results under wind disturbance, show a small of the controller design is to ensure the tracking of a
increment in the tracking error in FMFC, and a considerable predefined trajectory, without well-knowledge about the
increase in the error for model-free control. However, a loss dynamics model and physical system parameters.
of accuracy in fuzzy logic PID is observed. These results In addition, a comprehensive assessment of control
provide compelling evidence for the disturbance rejection performance was conducted in the context of various
ability offered by the proposed strategy. Overall, the realistic scenarios to test and demonstrate the tracking
accuracy of the proposed technique FiPD is roughly the capability of the proposed strategy with respect to
same for all scenarios. On the other hand, it is worthy conventional model-free control iPD and fuzzy logic PID.
mentioning that the FMFC technique is not sensitive to the The proposed approach FiPD controller shows superior
disturbance nature. As a conclusion, Table 5 indicates the performance among other techniques.
outstanding performance and high robustness level for the The performance exhibited by the proposed control
proposed strategy against different kinds of disturbances. approach based on model-free control depends on the good
Figure 10 illustrates the variation of the controller gains estimation of the ultra-local model. Furthermore, tuning the
over time. Specifically, Figure 10(a), represents the gains gains parameters during the control process increases the
adaptation for both controllers in the translation along x and robustness level. However, it can affect the estimation of the
y motion. The other Figure 10(b) shows the altitude ultra-local model due to the time-delay required to compute
controller gains. The adaptive behaviour during the control the appropriate gains. It should be noted that, the
process resulting better performance compared to static complexity of the algorithms that compute online the
gains as observed. controller gains is significant to avoid the time-delay and
maintain the good estimation.
As future work, and given the lower complexity and
better performance of the proposed strategy, the
experiments would be conducted on a real quadrotor. In
Adaptive fuzzy model-free control for 3D trajectory tracking of quadrotor 145

addition, we aim to develop other control methods such as Fliess, M. and Join, C. (2013) ‘Model-free control’, International
nonlinear model-free control. By comparing them, we will Journal of Control, Vol. 86, No. 12, pp.2228–2252.
carefully select the best one based on several Fliess, M., Join, C., Mboup, M. and Sira-Ramirez, H. (2006) Vers
performance-based aspects such as disturbance sensitivity, Une Commande Multivariable Sans Modnele, arXiv preprint
math/0603155.
robustness, power consumption, and so on.
Furrer, F., Burri, M., Achtelik, M. and Siegwart, R. (2016) ‘Robot
operating system (ROS): the complete reference (Volume 1)’,
Ch. RotorS – A Modular Gazebo MAV Simulator Framework,
References pp.595–625, Springer International Publishing, Cham.
Abouaïssa, H. and Chouraqui, S. (2019) ‘On the control of robot Haddar, M., Chaari, R., Baslamisli, S.C., Chaari, F. and
manipulator: a model-free approach’, Journal of Haddar, M. (2019) ‘Intelligent PD controller design for active
Computational Science, Vol. 31, pp.6–16. suspension system based on robust modelfree control
Al Younes, Y., Drak, A., Noura, H., Rabhi, A. and El Hajjaji, A. strategy’, Proceedings of the Institution of Mechanical
(2014) ‘Model-free control of a quadrotor vehicle’, 2014 Engineers, Part C: Journal of Mechanical Engineering
International Conference on Unmanned Aircraft Systems, Science, p.95440621983644.
ICUAS 2014 – Conference Proceedings, May, pp.1126–1131. Kamel, M., Burri, M. and Siegwart, R. (2016) Linear vs. Nonlinear
Al Younes, Y., Drak, A., Noura, H., Rabhi, A. and Hajjaji, A.E. MPC for Trajectory Tracking Applied to Rotary Wing Micro
(2016) ‘Robust model-free control applied to a quadrotor Aerial Vehicles, arXiv e-prints, November.
UAV’, Journal of Intelligent and Robotic Systems: Theory Koubaa, A. and Qureshi, B. (2018) ‘Dronetrack: cloud-based
and Applications, Vol. 84, Nos. 1–4, pp.37–52. real-time object tracking using unmanned aerial vehicles over
Alotaibi, E.T., Alqefari, S.S. and Koubaa, A. (2019) ‘LSAR: the internet’, IEEE Access, Vol. 6, pp.13810–13824.
multi-UAV collaboration for search and rescue missions’, Koubaa, A., Qureshi, B., Sriti, M-F., Allouch, A., Javed, Y.,
IEEE Access, Vol. 7, pp.55817–55832. Alajlan, M., Cheikhrouhou, O., Khalgui, M. and Tovar, E.
Bekcheva, M., Join, C. and Mounier, H. (2018) ‘Cascaded (2019) ‘Dronemap planner: a service-oriented cloud-based
model-free control for trajectory tracking of quadrotors’, 2018 management system for the internet-of-drones’, Ad Hoc
International Conference on Unmanned Aircraft Systems, Networks, Vol. 86, pp.46–62.
ICUAS 2018, pp.1359–1368. Lee, H. and Kim, H.J. (2017) ‘Trajectory tracking control of
Benallegue, A., Mokhtari, A. and Fridman, L. (2006) ‘Feedback multi-rotors from modelling to experiments: a survey’,
linearization and high order sliding mode observer for a International Journal of Control, Automation and Systems,
quadrotor UAV’, International Workshop on Variable Vol. 15, No. 1, pp.281–292.
Structure Systems (VSS’06), pp.365–372. Lee, T. and Leok, M. (2010) ‘Geometric tracking control of a
Benjdira, B., Khursheed, T., Koubaa, A., Ammar, A. and Ouni, K. quadrotor UAV on SE (3) for extreme maneuverability’,
(2019a) ‘Car detection using unmanned aerial vehicles: Proc. IFAC World Congress, No. 3.
comparison between faster R-CNN and YOLOv3’, in 2019 Li, Z., Ma, X. and Li, Y. (2018) ‘Model-free control of a quadrotor
1st International Conference on Unmanned Vehicle using adaptive proportional derivativesliding mode control
Systems-Oman (UVS), February, pp.1–6. and robust integral of the signum of the error’, International
Benjdira, B., Bazi, Y., Koubaa, A. and Ouni, K. (2019b) Journal of Advanced Robotic Systems, Vol. 15, No. 5,
‘Unsupervised domain adaptation using generative pp.1–15.
adversarial networks for semantic segmentation of aerial Mokhtaril, A., Benallegue, A. and Daachi, B. (2005) ‘Robust
images’, Remote Sensing, Vol. 11, No. 11. feedback linearization and GH controller for a quadrotor
Bouabdallah, S. and Siegwart, R. (2005) ‘Backstepping and unmanned aerial vehicle’, 2005 IEEE/RSJ International
sliding-mode techniques applied to an indoor micro Conference on Intelligent Robots and Systems, IROS, Vol. 57,
quadrotor’, Proceedings – IEEE International Conference on No. 1, pp.1009–1014.
Robotics and Automation, April, Vol. 2005, pp.2247–2252. Wang, H., Ye, X., Tian, Y., Zheng, G. and Christov, N. (2016)
Bouabdallah, S., Noth, A. and Siegwart, R. (2004) ‘PID vs. LQ ‘Model-free-based terminal SMC of quadrotor attitude and
control techniques applied to an indoor micro quadrotor’, position’, IEEE Transactions on Aerospace and Electronic
2004 IEEE/RSJ International Conference on Intelligent Systems, Vol. 52, No. 5, pp.2519–2528.
Robots and Systems (IROS) (IEEE Cat. No. 04CH37566), Wang, J. (2013) Quadrotor Analysis and Model Free Control with
Vol. 3, pp.2451–2456. Comparisons, PhD thesis, Universit e Paris Sud – Paris XI.
Bourdais, R., Fliess, M. and Perruquetti, W. (2007) ‘Towards a
model-free output tracking of switched nonlinear systems’,
IFAC Proceedings Volumes, Vol. 40, No. 12, pp.504–509. Appendix
Bouzid, Y., Siguerdidjane, H. and Bestaoui, Y. (2018) ‘Energy
based 3D trajectory tracking control of quadrotors with The square trajectory can be expressed as follows:
model-free based online disturbance compensation’, Chinese
xd (t ) 
Journal of Aeronautics, Vol. 31, No. 7, pp.1568–1578.
Chekakta, Z., Zerikat, M., Bouzid, Y. and Abderrahim, M. (2019)  (t  10)5
2
 (t  10)5  (5  t  10) when 5 s  t  20 s
‘Model-free control applied for position control of quadrotor 
using ROS’, in 2019 6th International Conference on 
Control, Decision and Information Technologies (CoDIT), 2  2 (t  40)5
when 20 s  t  35 s
IEEE, pp.1260–1265.  (t  40)5  (5  t  40)
Chemori, A. (2017) ‘Model-free control of the inertia wheel
inverted pendulum with real-time experiments’.
146 Z. Chekakta et al.

yd (t )  The aggressive trajectory is given as follows:


 (t  15)
5
 xd  0
 2 (t  15)5  (5  t  15) when 5 s  t  25 s 
  yd  0 (t  15 s )
  z  sin(2π / 60)t
2  2 (t  40)5  d
when 20 s  t  40 s
 (t  40)5  (5  t  40)
 xd  0
xd (t )  
 yd  0 (15 s  t  20 s )
 (t  35)5 z  5
2 (t  35)5  (5  t  35) when 0 s  t  10 s  d

0 when 10 s  t  35 s  xd  1  cos  0.25(t  20) 

 (t  40)5  yd  sin  0.5(t  20)  (t  s )
2  2 when 35 s  t  50 s  z 5
 (t  40)5  (5  t  40)  d

You might also like