You are on page 1of 6

2019 4th Conference on Control and Fault Tolerant Systems (SysTol)

Casablanca, Morocco, September 18-20, 2019

Unmanned Aerial Vehicles Fleet Control via Artificial Bee Colony


Algorithm
Majd Saied, Malak Slim, Hussein Mazeh, Clovis Francis and Hassan Shraim

Abstract— This paper considers a distributed planner method litterature [5], [6] and demonstrate its advantages in terms of
for multiple unmanned aerial vehicles (UAV), based on a self organization, scalability and distributed control of agents.
leaderless approach, using an Artificial Bee Colony (ABC) On the other hand, centralized, decentralized and distributed
optimization algorithm. The ABC algorithm is a metaheuristic
optimization method inspired by the intelligent behavior of control architectures can be distinguished, where the last
the honeybee swarm. The proposed ABC, implemented on one was proven to be the most successful architecture for
each UAV independently, is used to compute velocity profiles autonomous flight formation control [7]. Each agent in this
that avoid obstacles and collisions between the UAVs while architecture has its onboard controller that uses its own
ensuring the fleet formation control and the target tracking. information and that of its neighbors obtained from sensing
The proposed algorithm is demonstrated by simulations on
Matlab/Simulink in different scenarios. devices on each agent or through communication.
Different control architectures used for autonomous ve-
I. INTRODUCTION hicle fleet control exist in the literature in addition to the
theoretical tools used to synthesize the control laws. Some
The recent years have witnessed many developments in methods proposed the use of consensus protocol to achieve
the area of unmanned aerial vehicles fleet and formation a defined fleet goal [8], where the theory of algebraic graphs
control. This is due to the benefits of operating multiple is the main theoretical tool used to solve control problems.
UAVs to achieve tasks more efficiently compared to a single Other methods are based on optimization approaches where
UAV in a wide range of applications such as investigating the controllers are designed by minimizing or maximizing an
large regions for surveillance and rescue or large payloads optimization criterion. The advantage with these approaches
transportation [1]. The main challenge in this field is to find in the control of multi-agent systems is that the objective
the local interaction rules between these vehicles to achieve is formulated as an optimization problem, providing effec-
a global desired comportment. To deal with this issue, tive tools to find the optimal solution with respect to the
different formation strategies are proposed in the literature considered criteria. A distributed control strategy of a fleet
and summarized below. of quadrotors based on a leaderless strategy is proposed in
In the leader-follower configuration, the desired trajectory [9]-[11] where the formation problematic is stated as an
is loaded in the leader followed by the other agents of the optimization problem solved by the particle swarm optimiza-
flight [2]. The main drawback of this configuration is that tion (PSO) algorithm. The objective is to minimize a cost
the entire formation depends on the leader, in addition to the function for each vehicle that enables the whole system to
non self-organization formation. Solutions to some of these converge to a target point in a predefined configuration while
drawbacks were proposed in [3] where an interactive leader- avoiding obstacle and collision between agents. According
follower configuration of multiple quadrotors is considered to the authors, the PSO has shown optimal performance
to solve the problem of one leader dependency. with a minimum calculation time. However, as stated in
In the virtual configuration, each UAV in the formation [12], the PSO can converge untimely and be snared into
follows its own trajectory, where trajectories are computed a local minimum, which could be risky when dealing with
in a central controller and shared with the agents without systems such as UAVs. To overcome this drawback, other
interactions between them [4]. The main drawbacks of this optimization algorithms could be used to minimize the cost
approach reside in the computational and communication functions.
cost and the possibility of collision occurrence in the pres- The Artificial Bee Colony (ABC) is a population-based
ence of perturbations. optimization technique capable of handling constrained op-
The behavior-based structure is based on the collective timization problems [13]. Its was compared to other known
behavior of animals where each agent must follow some optimization methods and the results outmatched or matched
guidelines to accomplish the formation, including the col- those achieved using other techniques [14], [15]. Different
lision avoidance, the velocity matching and the formation works in the literature proposed the use of ABC approach
centering. Different works considered this structure in the to solve mobile path planning [16] and satellite formation
keeping problems [17], and show the feasibility of applying
The authors are with the Lebanese University, Faculty of En-
gineering, Research Scientific Center in Engineering, Hadath, this technique for path planning and optimization of feed-
Lebanon. {cfrancis, hassan.shraim}ul.edu.lb back gain controller parameters with a good quality of the
978-1-7281-0380-8/19/$31.00 ©2019 IEEE 80
solutions and fast convergence.
In this paper, we propose the use of the Artificial Bee
Colony algorithm for the leaderless distributed control of a
fleet of quadrotor UAVs. The optimization problem is formu-
lated as in the work proposed previously in [9]. The results
show that the ABC approach is efficient, fast converging and
suitable for such applications.
The paper is organized as follows. Section II is dedicated
for the problem formulation. The Artificial Bee Colony
algorithm is presented in Section III with its application
to the quadrotor UAVs formation control. The results are
presented in Section IV. The paper ends with conclusions
Fig. 1: Quadrotor Configuration
and perspectives in Section V.

II. P ROBLEM F ORMULATION B. Quadrotor UAV Modeling


A. Quadrotor Formation Topology The quadrotor UAV is modeled as a rigid body, and its
nonlinear model is given as follows:
The interaction topologies of m agents in a multi-agents
systems can be described using the graph theory [18], where ζ̇ = v
the system is represented by an undirected graph G = (V, E), mζ̈ = g + RU
(6)
V = {1, 2, ..., m} and E ⊆ {(i, j) : i, j ∈ V, i 6= j} being η̇ = W Ω
the sets of nodes and edges respectively. In a quadrotor fleet, J Ω̇ = ΩxJΩ + τ
each node is equivalent to a quadrotor UAV and the edges where ζ = [x y z]T and v are the center of mass position and
represent the communication between each two quadrotors. velocity vectors in the inertial frame, η = [φ θ ψ]T and Ω
Let A ∈ Rmxm be the adjacency matrix with elements aij > are the angles and angular velocities in the body-fixed frame.
0 if (i, j) ∈ E and aij = 0 otherwise. The quadrotor’s mass is m and g = [0 0 − 9.81]T . J is the
To represent the quadrotors fleet in the Euclidean space, a moment of inertia matrix. W is the transformation velocity
position vector qi = [xi yi ]T ∈ R2 is associated to each node matrix and R is the rotation matrix from the body frame to
i in the graph. A set of neighbors of a vehicle i is defined the inertial frame. U is the thrust vector and τ is the torque
by: vector given as:
Ξi = {j ∈ m : ||qi − qj || ≤ l} (1) 
(f2 − f4 ).l

τ = (f3 − f1 ).l  (7)


where l is the neighborhood scope. τ1 + τ2 + τ3 + τ4
The required configuration of multiple UAVs in the fleet
could be formulated as follows: with fi and τi being the propeller’s thrust force and reaction
torque respectively:
||qi − qj || = ddij ∀j ∈ Ξi (2) fi = Kf ωi2
(8)
τi = (−1)i+1 Kτ ωi2
where ddij
is the desired inter-distance between two UAVs
i and j. In addition, collision between agents should be Kf and Kτ are the thrust and torque coefficients.
avoided. This constraint can be written as follows: III. A RTIFICIAL B EE C OLONY
||qi − qj || > c (3) A. Principle of ABC Algorithm
The Artificial Bee Colony optimization method was in-
with c ∈ R being the smallest acceptable distance between troduced in 2005 by Karaboga [19]. It is inspired by the
any two neighbors. In the matrix A(t), this constraint is searching behavior of honey bee swarm.
formulated as: The colony of artificial bees includes three types of bees:
employed, onlookers, and scout. Employed agents arbitrarily
∀aij (t) ∈ A(t) : aij (t) > c, with i 6= j (4) look for food-source locations referred to us as solutions.
Then, by dancing, they send the nectar amounts of this
To introduce this constraint in the cost function, a new food-source, referred to us as the solutions qualities, to
function αij (t) is defined between each quadrotor i and its the onlookers staying in the dance area of the hive. The
neighbor j [9]: period of a dance is equivalent to the nectar content, fitness
c−aij (t)
value, of the food-source currently being exploited by the
αij (t) = 1 + e σ (5) employed bee. Hence, by watching various dances, onlooker
81
bees choose the appropriate food source position according
to the probability proportional to its quality. A good food-
source position catches most of the bees. If onlookers and
scout bees find a new food-source position, they may become
employed bees. Moreover, when the food-source position has
been tested fully, the employed bee associated with it leaves
it, and may change it status to an onlooker or a scout bee.
In the ABC algorithm, each search cycle includes three
steps:
• In the initialization step, the food is produced, the
employed agent is sent to it to measure the nectar
amounts and calculate the fitness. It is modeled as:

xij = xmin
j + rand(0, 1)(xmax
j − xmin
j ) (9)

i = 1, ... , n with n being the number of food sources


and j varies from 1 to the dimension of x vector.
After updating the position of the food source as in (9),
the fitness response is calculated as follows:
1
Fitnessi = (10) Fig. 2: Solution update in the ABC algorithm
1 + Λi
where Λi represents the value of the cost function at Population size 100
the solution i. Limit 100 s
• When the search step is done, food sources description Max Iterations 1000
c 1m
is sent to the onlooker bees: nectar amounts (fitness) and hmax 0.25
position. An onlooker bee analyzes all the information hmin −0.25
collected and selects the best food location according Tolerance 0.1
to its nectar quantity probability calculated as: TABLE I: Parameters of the ABC algorithm
Fitnessi
pi = Pn (11)
i=1 Fitnessi

• If the food site is consumed, it will be forsaken and a The objective of the ABC algorithm in this problem is to
new exploration is launched for a new food location. compute the optimal vector h for each quadrotor i that
This is done using a set counter (limit). minimizes Λi (t) such that:
The solutions generation and update process in ABC lim Λi (t) = 0 → lim L(t) = Ld (t) (14)
t→∞ t→∞
algorithm is shown in Fig. 2.
Ld is the desired geometrical configuration around a ren-
B. ABC Algorithm for UAVs Fleet Application Problem dezvous point.
Finally, the next position at time t + t0 for the agent i will
The mathematical formulation of the optimization problem
then be:
for the UAVs formation application is presented below where
the cost function for each UAVi is defined as in [9]:
Yi (t + t0 ) = Y (t) + h (15)
Λi (t) =Pρ(||Pd − [qi (t) + h]|| − ddip )
q IV. S IMULATION R ESULTS
+ Pi=1 αij (t)(||qj (t) − [qi (t) + h]|| − ddij )
m The proposed UAVs fleet control method has been val-
+ k=1 Obski (t)
(12) idated by simulations on Matlab under different scenarios,
with: i 6= j, q = card(Ξ(t)), ρ >> 1, ddip is the desired then the trajectory following is shown when the algorithm
distance between UAVi and rendezvous point. h ∈ R2 is the is tested on a quadrotor fleet simulator on Matlab. The
desired reference point to be found at each step time for each parameters of the ABC used for simulations are presented
UAV according to the rendezvous point Pd and the neighbors in table I.
xj (t), with j ∈ Ξ(t). Firstly, the ABC technique is applied on a single agent to
The obstacle avoidance constraint is formulated by the term generate its path from an initial to a desired position without
below introduced into the cost function: and with an obstacle, where the location of the obstacle
c−||qkobs(t)−[q (t)+h]|| is considered to be known. The results of this scenario
i
Obski (t) = e σ (13) are shown in Fig. 3 and 4. Fig. 4 shows how the ABC
82
Fig. 3: 2D targets and trajectory generated by ABC algo-
rithm of one quadrotor without obstacle
Fig. 5: 2D targets and trajectory generated by ABC algo-
rithm of two quadrotor with collision avoidance

Fig. 4: 2D targets and trajectory generated by ABC algo-


rithm of one quadrotor with obstacle avoidance

algorithm adjusts the trajectory to avoid a collision if the


Fig. 6: 2D targets and trajectory generated by ABC algo-
vehicle approaches near the obstacle.
rithm of six quadrotor with collision avoidance
In a second scenario, two agents should converge to a
rendezvous point (0, 0) while keeping a circle configuration
of radius 2. The generated trajectories are shown in Fig. 5.
The second scenario is repeated with six agents where
the rendezvous point is (15, 10) and the radius is 6. Fig. 6
shows the generated trajectories while Fig. 7 and 8 show
respectively the cost functions for the six agents and their
corresponding radius while converging to the desired config-
uration.
Multiple simulations were performed at the same initial
conditions shown in the figures 3 to 6, and the table II
below summarizes the average convergence time for each
scenario, with an error tolerance of 0.1.

The scenarios above were tested on a quadrotor simulator


on Matlab taking into account all the nonlinear dynamics of
the model, disturbances and errors and biases on the sensors Fig. 7: Cost functions for six quadrotors using ABC
measurements. The implemented control law is a simple PID
83
Fig. 8: Raduis for the six quadrotors using ABC

Scenario Convergence Time


One agent without obstacle 3.724 s
One agent with obstacle 3.52 s Fig. 10: Trajectories of six quadrotors in a circle configura-
Two agents 10.477 s
Six agents 80.22 s
tions

TABLE II: Convergence time for different scenarios using Population size 100
ABC algorithm inertia weight wmax = 0.9, wmin = 0.4
cognitive weight b1initial = 2.6, b1f inal = 0.4
social weight b2initial = 0.4, b2f inal = 2.6
Max Iterations 1000
c 1m
controller applied on the positions and the attitude. hmax 0.25
Fig. 9 shows the trajectory for a single quadrotor moving hmin −0.25
Tolerance 0.1
between the two points (−8, −2) and (10, 6) for a time
constant of 0.2 s with its reference trajectory computed from TABLE III: Parameters of the adaptive PSO algorithm
the ABC algorithm. The trajectories of the 6 quadrotors
flying in a circle configuration to the point (15, 10) are shown
in Fig. 10.
error tolerance as above and Fig. 12 shows the cost functions
For comparison purpose, the same scenarios above were
for each quadrotor in terms of the number of iterations.
performed using the Adaptive Particle Swarm Optimization
(PSO) used in [9] with the parameters shown in Table III. Multiple simulations were performed at the same initial
Fig. 11 shows the trajectory generated by this method for the conditions and error tolerance for the ABC algorithm and
six quadrotors with the same initial positions and the same the table IV below summarizes the average convergence
time for each scenario. According to the obtained results, it
is clear that, with same conditions and solutions quality, the
ABC converges faster than the PSO.

V. C ONCLUSION
This paper presents a distributed optimization-based con-
trol method for a fleet of unmanned aerial vehicles. The
Artificial Bee Colony algorithm is used to minimize a cost

Scenario Convergence Time


One agent without obstacle 4.962 s
One agent with obstacle 4.97 s
Two agents 11.66 s
Six agents 112.66 s

TABLE IV: Convergence time for different scenarios using


adaptive PSO algorithm
Fig. 9: Trajectory following for a single quadrotor

84
ACKNOWLEDGEMENTS
This work has been funded with support from the research
support program of the Lebanese University.
R EFERENCES
[1] Q. Jiang and V. Kumar, The inverse kinematics of cooperative transport
with multiple aerial robots, IEEE Trans. Robot., vol. 29, no. 1, pp.
136-145, Feb. 2013.
[2] J.A. Guerrero and R. Lozano, Flight Formation Control. John Wiley-
ISTE, 2012.
[3] Z. Hou and I. Fantoni, Interactive Leader-Follower Consensus of Mul-
tiple Quadrotors Based on Composite Nonlinear Feedback Control,
IEEE Trans. on Control Systems Technology, vol. 26, no. 5, pp. 1732-
1743, Oct. 2017.
[4] A. Kushleyev, D. Mellinger, C. Powers et al., Towards a swarm of
agile micro quadrotors, Auton. Robot., vol. 35, no. 4, pp. 287-300,
Nov. 2013.
[5] R. Olfati-Saber, Flocking for multi-agent dynamic systems: algorithms
and theory, IEEE Trans. on Automatic Control, vol. 51, no. 3, pp. 401-
Fig. 11: 2D targets and trajectory generated by adaptive PSO 420, 2006.
algorithm of six quadrotor with collision avoidance [6] G. Antonelli, F. Arrichiello and S. Chiaverini, Flocking for multirobot
systems via the null-space based behavioral control, Swarm Intel., vol.
4, pp. 37-56, March 2010.
[7] O. Saif, Reactive Navigation of a Fleet of Drones in Interaction. PhD
Thesis, University of Technology of Compiègne, France, 2016.
[8] L. Brunet, H.L. Choi and J. How, Consensus-Based Auction Ap-
proaches for Decentralized Task Assignment, AIAA Guidance, Navi-
gation and Control Conference and Exhibit, Hawaii, August 2008.
[9] A. Belkadi, L. Ciarletta and D. Theilliol, UAVs Fleet Control De-
sign Using Distributed Particle Swarm Optimization : A Leaderless
Approach, International Conference on Unmanned Aircraft Systems
(ICUAS), Arlington, VA USA, 2016.
[10] A. Belkadi, H.A. Gonzalez, L. Ciarletta, P. Castillo and D. Theilliol,
Design And Implementation Of Distributed Path Planning Algorithm
For A Fleet Of UAVs, IEEE Trans. on Aerospace and Electronic
Systems, March 2019.
[11] A. Belkadi, H. Abaunza, L. Ciarletta, P. Castillo and D. Theilliol,
Distributed Path Planning for Controlling a Fleet of UAVs : Applica-
tion to a Team of Quadrotors, IFAC-PapersOnline, vol. 50, no. 1, pp.
15983-15989, 2017.
[12] Z. Abdmouleha, A. Gastlia, L. Ben-Brahima, M. Haouarib and
N.A. Al-Emad, Review of optimization techniques applied for the
integration of distributed generation from renewable energy sources,
Renewable Energy, vol. 113, pp. 266-280, 2017.
Fig. 12: Cost functions for six quadrotors using adaptive [13] D. Karaboga and B. Basturk, ABC Optimization Algorithm for Solving
PSO Constrained Optimization Problems. Springer-Verlag, vol. LNAI 4529,
pp. 789-798, 2007.
[14] D. Karaboga and B. Basturk, On the performance of ABC algorithm,
Appl. Soft Comput., vol. 8, no. 1, pp. 687-697, 2008.
[15] M. Lalitha, N. Padma, S. Reddy, V.C. Veera Reddy, Optimal DG
placement for maximum loss reduction in radial distribution system
function for each UAV guaranteeing convergence to the using ABC algorithm, Int. J. Rev. Comput., vol. 3, pp. 44-52, 2010.
desired position while avoiding obstacles and collisions with [16] M.A. Cruz, V. Ramirez, U.H. Belmonte, Mobile robot path planning
other agents. The results show that the ABC algorithm is using ABC and evolutionary programming, Applied Soft Computing,
vol. 30, pp. 319-328, 2015.
efficient, fast converging and suitable for such applications. [17] S.O. Kolawole and D. Haibin, Satellite formation keeping via chaotic
The whole approach inspired from previous similar works ABC, Aircraft Engineering and Aerospace Technology, vol. 89, no. 2,
using PSO optimization offers many advantages in particular pp. 246-256, 2015.
[18] R. Diestel, Graph Theory, vol. 173 of Graduate Texts in Mathematics.
in terms of its generic aspect since it can be applied to Springer-Verlag, Heidelberg, third ed., 2005
various types of vehicles, its simplicity of implementation [19] D. Karaboga, An idea based on honey bee swarm for numerical
and adjustment, and also its distributed architecture and real- optimization, in Tech. Rep. TR06. Kayseri, Turkey: Dept. Comput.
Eng., Erciyes Univ., 2005.
time aspect.
In future works, we intend to consider the energy min-
imization criterion in the cost function, and improve the
performance of the bee algorithm by setting a better bal-
ance between exploitation and exploration. The proposed
architecture will be tested experimentally on a fleet of real
quadrotors.
85

You might also like