# GPS-free, error tolerant path planning for swarms of micro aerial vehicles with quality amplification ‡

Michel Barbeau, Joaquin Garcia-alfaro, Evangelos Kranakis, Fillipe Santos

<figure><img src="image_1.png" /></figure>

## To cite this version:

Michel Barbeau, Joaquin Garcia-alfaro, Evangelos Kranakis, Fillipe Santos. GPS-free, error tolerant path planning for swarms of micro aerial vehicles with quality amplification ‡. Sensors, 2021, 21 (14), pp.4731:1-4731:16. 10.3390/s21144731. hal-03628455

HAL Id: hal-03628455

https://hal.science/hal-03628455

Submitted on 23 Feb 2023

HAL is a multi-disciplinary open access
archive for the deposit and dissemination of sci-
entific research documents, whether they are pub-
lished or not. The documents may come from
teaching and research institutions in France or
abroad, or from public or private research centers.

L'archive ouverte pluridisciplinaire HAL, est
destinée au dépôt et à la diffusion de documents
scientifiques de niveau recherche, publiés ou non,
émanant des établissements d'enseignement et de
recherche français ou étrangers, des laboratoires
publics ou privés.

<figure><img src="image_2.png" /></figure>

Distributed under a Creative Commons Attribution 4.0 International License
Article

# GPS-Free, Error Tolerant Path Planning for Swarms of Micro Aerial Vehicles with Quality Amplification ‡

Michel Barbeau ¹,*,† ID, Joaquin Garcia-Alfaro ²,*,† ID, Evangelos Kranakis ¹,*,† ID and Fillipe Santos ³,*,† ID

¹ School of Computer Science, Carleton University, Ottawa, ON K1S 5B6, Canada

² Telecom SudParis, Institut Polytechnique de Paris, 91120 Palaiseau, France

³ Institute of Computing, University of Campinas, Campinas 13083-852, Brazil

* Correspondence: barbeau@scs.carleton.ca (M.B.); jgalfaro@ieee.org (J.G.-A.); kranakis@scs.carleton.ca (E.K.); fillipe@lrc.ic.unicamp.br (F.S.); Tel.: +1-613-520-2600 (M.B.); +33-160-76-47-22 (J.G.-A.); +1-613-520-2600 (E.K.); +55-(19)-3521-0336 (F.S.)

† All authors contributed equally to this work.

‡ This a revised and extended version of a paper that appeared in Proceedings of the IEEE GLOBECOM 2019 Workshops: IEEE GLOBECOM 2019 Workshop on Computing-Centric Drone Networks, Waikoloa, HI, USA, 9-14 December 2019.

**Abstract:** We present an error tolerant path planning algorithm for Micro Aerial Vehicle (MAV) swarms. We assume navigation without GPS-like techniques. The MAVs find their path using sensors and cameras, identifying and following a series of visual landmarks. The visual landmarks lead the MAVs towards their destination. MAVs are assumed to be unaware of the terrain and locations of the landmarks. They hold a priori information about landmarks, whose interpretation is prone to errors. Errors are of two types, *recognition* or *advice*. Recognition errors follow from misinterpretation of sensed data or a priori information, or confusion of objects, e.g., due to faulty sensors. Advice errors are consequences of outdated or wrong information about landmarks, e.g., due to weather conditions. Our path planning algorithm is cooperative. MAVs communicate and exchange information wirelessly, to minimize the number of recognition and advice errors. Hence, the quality of the navigation decision process is amplified. Our solution successfully achieves an adaptive error tolerant navigation system. Quality amplification is parameterized with respect to the number of MAVs. We validate our approach with theoretical proofs and numeric simulations.

**Keywords:** micro aerial vehicles (MAVs); autonomous aerial vehicles; MAV swarm; goal location; quadcopters; information sharing; localization; location; path planning

<figure><img src="image_3.png" /></figure>

check for
updates

**Citation:** Barbeau, M.; Garcia-Alfaro, J.; Kranakis, E.; Santos, F. GPS-Free, Error Tolerant Path Planning for Swarms of Micro Aerial Vehicles with Quality Amplification. *Sensors* **2021**, *21*, 4731. https://doi.org/10.3390/s21144731

Academic Editors: Davide Brunelli, Francesca Cuomo, Luca Catarinucci, Gregor Klancar and Matteo Nardello

Received: 2 June 2021

Accepted: 6 July 2021

Published: 10 July 2021

**Publisher's Note:** MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations.

<figure><img src="image_4.png" /></figure>

**Copyright:** © 2021 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (https://creativecommons.org/licenses/by/4.0/).

## 1. Introduction

Micro Aerial Vehicles (MAVs) are a popular type of drones. They are equipped with sensors and cameras, enabling hovering and navigation over complex three-dimensional terrains. They are used in a variety of applications, including sewer inspection [1], search and rescue operations [2] and parcel delivery [3]. Large terrains can be covered by so called swarms, namely collaborative teams of MAVs that exchange information gathered during navigation. They are required to be resilient to failures of all kinds, such as during navigation or due to sensor malfunctions. We are interested in designing swarm algorithms that are resilient in the presence of failures.

We present an error tolerant path planning algorithm for MAV swarms. We assume MAV navigation without using any GPS-like technique. MAVs find their way using sensors and cameras, in order to identify and follow a series of visual landmarks. The visual landmarks lead the MAVs towards the destinations. We assume that the MAVs are unaware of the terrain and locations of the landmarks. Figure 1 shows the idea. A number of landmarks are highlighted. A swarm of MAVs collectively identify a series of such landmarks over an inspected terrain. The identification of landmarks determines paths that must be followed.
<figure><img src="image_5.png" /><figcaption>**Figure 1.** Sample picture taken from an aerial vehicle, together with the identification of six landmarks at the campus of Carleton University.</figcaption></figure>

Swarms fly over terrains comprising multiple landmarks. The landmarks also include the starting and terminal points of a well-defined path. The MAVs may hover over the landmarks either on their own or in formation. They may hop from any one landmark to any other. The landmarks are identified as vertices. The resulting system forms a complete graph. Recall that the MAVs are unaware of the terrain and locations of the landmarks. However, they have the capability to visually recognize them. Furthermore, the MAVs may communicate and exchange information wirelessly as long as they are within communication range of each other. The MAVs are required to find a flight path from the starting point, leading to the terminal point.

We assume that the MAVs hold information about landmarks. Interpretation of this information is error prone. We consider two types of errors: recognition and advice. Recognition errors are due to misinterpretation of sensed data or a priori information, or confusion of objects, e.g., due to faulty sensors. Advice errors follow from changing or wrong information associated with landmarks, e.g., due to weather conditions. Path planning builds upon swarm cooperation. MAVs communicate and exchange information wirelessly, with the aim to reduce the amount of recognition and advice errors. Collaboratively exchanging information, the MAVs amplify the quality of decisions pertaining to the navigation process. The swarm gets equipped with an adaptive error tolerant navigation, where the degree of quality is related to the number of participating MAVs.

We show that the approach augments the probability of navigation correctness pro-
portionally to the number of MAVs in a swarm, when wireless communications allow
cooperation and exchange of information about landmarks. Indeed, single MAV navigation
is directly affected by recognition and advice errors. The MAV can get disrupted and
lost. With an increasing number of MAVs in a swarm, communications and exchange of
information take place. Quality of sensor fusion increases. We analyze the reduction of the
error probability induced by this algorithm. Quality amplification is demonstrated both
analytically and with simulation.

Section 2 reviews related work. Sections 3 and 4 present our navigation algorithm.
Section 5 evaluates the work. Section 6 concludes the paper.

## 2. Related Work

Surveys on path planning algorithms for unmanned aerial vehicles have been au-
thored by Goerzen et al. [4] and Radmanesh et al. [5]. Several algorithms build on solutions
originally created for computer networks. Some of the proposed solutions leverage algo-
rithms created in the field of classical robotics, such as approaches using artificial potential
functions [6], random trees [7], or Voronoi diagrams [8]. Path planning may be addressed
in conjunction with team work and formation control [9]. There are ideas that have been
tailored specifically to quadcopters [10]. Other constraints that the MAVs in the swarm must satisfy include the capability of each MAV to match the velocity of its neighbors in the swarm, as well as staying close to the neighbors while addressing collision avoidance. Recent works have addressed these issues applying Lyapunov theory [11,12] and attraction-repulsion functions [13,14].

Our research is closely related to works on navigation using topological maps [15]. Navigation does not rely on coordinates. The MAVs find their way recognizing landmarks. Weinstein et al. [16] propose the use of visual odometry as an alternative localization technique to, e.g., GPS-like techniques. The idea is as follows. The MAVs use their onboard cameras (e.g., downward facing cameras), combined by some inertial sensors, to identify and follow a series of visual landmarks. The visual landmarks lead the MAV towards the target destination. Unlike GPS, the technique allows the MAV to operate without boundaries in both indoor and outdoor environments. No precise information about concrete visual odometry techniques are reported by Weinstein et al. in their work. However, some ideas can be found in [15,17].

Maravall et al. [15,17] propose the use of probabilistic knowledge-based classification and learning automata for the automatic recognition of patterns associated with the visual landmarks that must be identified by the MAVs. A series of classification rules in their conjunctive normal form (CNF) are associated with a series of probability weights that are adapted dynamically using supervised reinforcement learning [18]. The process is conducted using a two-stage learning procedure. During the first process, a series of variables are associated with each rule. For instance, the variables associated with the construction of a landmark recognition classifier are constructed using images' histogram features, such as standard deviation, skewness, kurtosis, uniformity and entropy. During the second process, a series of weights are associated with every variable. Weights are obtained by applying a reinforcement algorithm, i.e., incremental R-L algorithm in [15,18], over a random environment. As a result, the authors obtain a specific image classifier for the recognition of landmarks, which is then loaded to the MAVs.

The resulting classifiers had been tested via experimental work. MAVs with high-definition cameras, recording images at a resolution of 640 × 360 pixels, at the speed of 30 fps (frames per second) are loaded a given classifier, to evaluate a visual classification ratio. Each experiment consists of building a classifier and getting the averaged ratio. Results by Maravall et al. in [17,19] show an average empirical visual error ratio of about 20% (i.e., 80% chances of properly identifying the landmarks, on average). The results are compared to some other well-established pattern recognition methods for the visual identification of objects, such as minimum distance and *k*-nearest neighbor classification algorithms. The previous contribution is complemented by Fuentes et al. and Maravall, et al. in [15,20], by combining the probabilistic knowledge-based classifiers with bug algorithms [8], to provide the MAVs with a navigation technique to traverse a visual topological map composed of several visual landmarks. A technique is used to compute the entropy of the images captured by the MAV, in case a decision must be made (e.g., to decide whether to go go in a south or north direction). The idea is as follows. The MAV uses the camera onboard and takes images from several directions. Afterward, it processes the images to choose a given direction. The lower the entropy of a captured image, the lower the probability of going towards an area containing visual landmarks. Conversely, the higher the entropy of a captured image, the higher the probability of going towards an area surrounded by landmarks. Using this heuristic, the MAV collects candidate images with maximum entropy (e.g., by driving the MAV forward and backward some meters) prior executing a bug algorithm to locate the landmarks [15].

The main contribution of our work is the introduction of a new MAV swarm path planning algorithm building upon drone-to-drone communication and collaboration. The algorithm does not require the use of GPS localization technology. Path planning and navigation use solely a priori provided visual facts and real-time visual data analysis. We acknowledge that provided facts may be wrong and that visual data analysis may
fail. The impacts of wrong facts or analysis failures are mitigated by drone-to-drone communication, exchange of information and a majority-based decisional framework. The algorithm performance versus recognition and advice error rates is analyzed in depth. We demonstrate that, in this setting, when the number of MAVs in a swarm increases, the quality of the decision process is amplified, thanks to the exchange of information collected by the individual MAVs. We also look into the energy cost of this process with respect to the number of MAVs in a swarm and advice recognition rates.

### 3. Error Prone Navigation

We identify the landmarks with the $n$ vertices of a complete graph $G = (V, E)$. Starting at $s$ and ending at $t$, the MAVs are seeking flight path connecting $k+1$ vertices

$$s := v_0, v_1, \dots, v_i, v_{i+1}, \dots, v_k := t$$

where $v_0, v_1, \dots, v_i, v_{i+1}, \dots, v_k$ are in $V$, see Figure 2. The MAVs have to navigate and find a flight path from $s$ to $t$ using clues. When hovering over an area, a MAV acquires data through its camera and other sensors, which may be visual, acoustic, etc. These data are used for landmark searching. A priori, the MAVs are given clues and specific characteristics about the landmarks. For example, the MAVs may be seeking a green door or a tall building.

<figure><img src="image_6.png" /><figcaption>**Figure 2.** Flight path from source $s$ to destination $t$. Edge $(v_i, v_{i+1})$ is an intermediate segment connecting landmarks $v_i$ and $v_{i+1}$.</figcaption></figure>

The landmarks provided have a priori information whose interpretation (by the MAVs) is prone to errors. We distinguish two types of errors, namely, recognition and advice. Recognition errors are due to misinterpretation of sensed data and a priori information or confusion of objects. For example, a MAV has found a green door which in fact is not a door but rather a window. The recognized object is incorrect. We assume that, for some real number $p$ in the interval $[0, 1]$, the value $p$ is the probability that a MAV performs recognition erroneously and $1-p$ that it is correct.

Advice errors about landmarks occur because the information provided is not up to date or even wrong. For example, upon finding a landmark, a MAV is advised to traverse a certain distance within the terrain in a northern direction where it will find the next landmark, say a restaurant, but this information is wrong because the restaurant is no longer there. We assume that, for some real number $q$ in the interval $[0, 1]$, the value $q$ is the probability that the advice provided to a MAV about a landmark is invalid or erroneously interpreted and $1-q$ that it is valid and correctly interpreted.

Recognition and advice errors are independent of each other. An important point to be made is that we assume that recognition and advice are random processes. For all MAVs, we make the assumption that recognition errors are independent and identically distributed and advice errors are also independent and identically distributed. The MAVs act independently of each other. Moreover, the outcome of the recognition process is random with a probability of success that depends on the parameter $p$. A similar observation
applies to the advice process. As a consequence, we can use this to our advantage so as to improve the recognition and advice mechanisms for swarms of MAVs.

Assume a MAV is navigating the terrain through a flight path, denoted as P, consisting of k vertices $v_0 := s, v_1, \dots, v_i, v_{i+1}, \dots, v_k := t$ from s to t. An edge $\{v_i, v_{i+1}\}$ corresponding to a segment of flight path P is said to be correctly traversed if and only if the advice provided about the landmark associated with vertex $v_i$ is valid and correctly interpreted and the landmark associated with vertex $v_{i+1}$ is correctly recognized. For $i = 0, \dots, k-1$, the flight path P is correctly traversed if and only if each of its segments defined by an edge $\{v_i, v_{i+1}\}$ is correctly traversed.

At the start, a MAV is given a flight plan. The flight plan defines the flight path P. For each vertex $v_i$, $i = 0, \dots, k-1$, the flight plan comprises advice for searching the next landmark, such as directional data. For each vertex $v_{i+1}$, the flight plan contains recognition data, such as landmark characteristics. A flight plan is correctly performed solely if every single segment is correctly traversed.

We obtain the following quantitative characterization of segment correctness and flight path in terms of recognition and advice probabilities.

**Lemma 1.** A flight plan leading to a path of length k is correctly performed with probability $(1-p)^k(1-q)^k$.

**Proof.** For individual segments $i = 0, \dots, k-1$, we have

$$ \Pr[\{v_i, v_{i+1}\} \text{ is correct}] = \Pr[\text{advice at } v_i \text{ and recognition at } v_{i+1} \text{ are correct}] = (1-p)(1-q). $$

For the whole flight plan for path P, we have

$$ \begin{aligned} \Pr[P \text{ is correct}] &= \Pr[\forall i(\{v_i, v_{i+1}\} \text{ is correct})] \\ &= \prod_{i=0}^{k-1} \Pr[\{v_i, v_{i+1}\} \text{ is correct}] \\ &= (1-p)^k(1-q)^k. \end{aligned} $$

This proves the lemma. □

Lemma 1 is valid for a single MAV that is recognizing landmarks and navigating from a start point to a terminal point. In Section 4, it is shown how to improve the probability of correctness for a swarm of co-operating MAVs that communicate and exchange information with each other.

In a swarm, we may take advantage of communications and collaboration among the MAVs so as to amplify the quality of a priori and sensed data. To this end, we use the principle of maximum likelihood.

Algorithms 1 and 2 define the main processes. Algorithm 1 applies majority recognition. Algorithm 2 applies the advice. It should be emphasized that the amplification of recognition and advice, implied by the majority rule used in the two algorithms above, is based on a binary decision. To illustrate this fact, consider the case of amplification of the quality of recognition. First of all, it is assumed that all the MAVs in the swarm run the same visual recognition software. Hence, the set of possible outcomes of the MAVs' visual systems is partitioned into two mutually disjoint sets. The first set can be interpreted as the container of positive outcomes, the second set as the container of negative outcomes. This is to be the same for all the MAVs. For a binary decision example, consider a swarm of five MAVs which is to decide whether the object viewed is either a Door (D) or a Window (W). If the answers of the individual MAVs are D, W, D, W, D, then the majority output will be Door.
A similar interpretation is being used for the advice algorithm software which is executed by “smart landmarks” giving advice to the MAVs, i.e., providing the direction the swarm should follow next. For a binary example with a swarm of five MAVs, assume that the landmarks may give either the answer North (N) or South (S). If the advice collected by the MAVs are N, S, S, N, N, then the majority decision will be North.

**Algorithm 1** Majority Recognition Algorithm for a swarm of *m* MAVs

1: Each MAV performs landmark recognition

2: MAVs exchange information

3: **if** there is a landmark common to the majority (of at least ⌈m/2⌋ MAVs) **then**

4: the MAV swarm adopts this common landmark

5: **else**

6: every MAV adopts its own recognized landmark

7: **end if**

**Algorithm 2** Majority Advice Algorithm for a swarm of *m* MAVs

1: Each MAV takes the advice provided for the visited landmark

2: MAVs exchange information

3: **if** there is a majority advice interpretation (for at least ⌈m/2⌋ MAVs) **then**

4: all MAVs follow this common advice interpretation

5: **else**

6: the MAVs follow their own advice interpretation

7: **end if**

## 4. Quality Amplification and Error Reduction

### 4.1. Reducing the Error Probability

The collaborative landmark recognition process defined by Algorithm 1 applies to a swarm composed of *m* MAVs. Let $p_m$ denote the error probability of the majority rule applied in Algorithm 1; this is given by the following formula:

$$p_m = 1 - \sum_{i=\lceil m/2 \rceil}^{m} \binom{m}{i} (1-p)^i p^{m-i} \quad (1)$$

Now, we show that the majority rule improves the error probability *p*.

**Lemma 2.** For $p < 1/2$, we have the following inequality:

$$1 - p < p^m \sum_{i=\lceil m/2 \rceil}^{m} \binom{m}{i} \left(\frac{1}{p} - 1\right)^i. \quad (2)$$

**Proof.** (Lemma 2) The inequality is proved by considering two cases depending on the parity of *m*, the number of MAVs.

**Case 1** (*m* is odd): If *m* is odd, we can express the value as $m = 2d + 1$, for some integer $d \ge 1$ so that ⌈m/2⌋ = d + 1. Let $a = \frac{1}{p} - 1$ and observe that $a > 1$, since $p < \frac{1}{2}$. From the binomial theorem, we have that

$$\begin{aligned} (a+1)^m &= \sum_{i=0}^{m} \binom{m}{i} a^i \\ &= \sum_{i=0}^{d} \binom{m}{i} a^i + \sum_{i=d+1}^{m} \binom{m}{i} a^i \\ &= L+U, \end{aligned} \quad (3)$$
where L and U are defined as follows:

$$L := \sum_{i=0}^{d} \binom{m}{i} a^i = \sum_{i=0}^{d} \binom{m}{d-i} a^{d-i}, \quad \text{and} \quad (4)$$

$$U := \sum_{i=d+1}^{m} \binom{m}{i} a^i = \sum_{i=0}^{d} \binom{m}{d+i+1} a^{d+i+1}. \quad (5)$$

Now, observe that L and U have the same number of summands with identical respective binomial coefficients, namely

$$\binom{m}{d-i} a^{d-i} \text{ and } \binom{m}{d+i+1} a^{d+i+1},$$

for $i = 0, 1, \dots, d$. In Formulas (4) and (5), observe that the left term when multiplied by $a^{2i+1}$ is equal to the right term, namely $a^{2i+1}\binom{m}{d-i}a^{d-i} = \binom{m}{d+i+1}a^{d+i+1}$, for $i = 0, 1, \dots, d$. Since $a > 1$ and $d \ge 1$, we conclude that

$$aL = \sum_{i=0}^{d} a \binom{m}{d-i} a^{d-i} < \sum_{i=0}^{d} a^{2i+1} \binom{m}{d-i} a^{d-i} = U. \quad (6)$$

From Equations (3) and (6), it follows that $(a+1)^m = L + U < (\frac{1}{a} + 1)U$. Since $a+1 = \frac{1}{p}$, we conclude that

$$U > \frac{(a+1)^m}{\frac{1}{a} + 1} = \frac{1-p}{p^m}.$$

**Case 2** (*m* is even): The proof is similar to the case when *m* is odd. Since *m* is even, it can be written as *m* = 2*d*, for some integer *d* ≥ 1 so that ⌊*m*/2⌋ = *d*. Let *a* = 1/*p* − 1 and observe that *a* > 1, since *p* < 1/2. From the binomial theorem, we have that

$$\begin{aligned} (a+1)^m &= \sum_{i=0}^{m} \binom{m}{i} a^i \\ &= \sum_{i=0}^{d-1} \binom{m}{i} a^i + \sum_{i=d}^{m} \binom{m}{i} a^i \\ &= L' + U', \end{aligned} \quad (7)$$

where $L'$ and $U'$ are defined as follows:

$$L' := \sum_{i=0}^{d-1} \binom{m}{i} a^i = \sum_{i=1}^{d} \binom{m}{d-i} a^{d-i}, \quad \text{and} \quad (8)$$

$$U' := \sum_{i=d}^{m} \binom{m}{i} a^i = \sum_{i=0}^{d} \binom{m}{d+i} a^{d+i}. \quad (9)$$

Now, we compare summands in $L'$ and $U'$, namely

$$\binom{m}{d-i} a^{d-i} \text{ and } \binom{m}{d+i} a^{d+i},$$
for $i = 0, 1, \dots, d$. In Formulas (8) and (9), observe that the left term when multiplied by $a^{2i}$ is equal to the right term, namely $a^{2i}(\binom{m}{d-i})a^{d-i} = (\binom{m}{d+i})a^{d+i}$, for $i = 0, 1, \dots, d$. Since $a > 1$ and $d \ge 1$, we conclude that

$$aL' \le \sum_{i=0}^{d} a \binom{m}{d-i} a^{d-i} < \sum_{i=0}^{d} a^{2i} \binom{m}{d-i} a^{d-i} = U'. \quad (10)$$

From Equations (7) and (10), it follows that $(a+1)^m = L+U < (\frac{1}{a}+1)U$. Since $a+1 = \frac{1}{p}$, we conclude that

$$U' > \frac{(a+1)^m}{\frac{1}{a}+1} = \frac{1-p}{p^m}.$$

Therefore, Inequality (2) is proved in both cases of $m$ odd and $m$ even. Thus, the proof of Lemma 2 is complete. □

We may now conclude the following.

**Theorem 1.** The majority rule applied to a swarm of $m$ MAVs executing Algorithm 1 reduces the probability of error of the recognition process as long as $p$ is less than $1/2$.

**Proof.** Let $m$ be the number of MAVs. Therefore, $1 - p_m$ is the probability that the majority is at least composed of $\lfloor m/2 \rfloor$ MAVs correctly performing recognition, i.e.,

$$1 - p_m = \sum_{i=\lfloor m/2 \rfloor}^{m} \binom{m}{i} (1-p)^i p^{m-i} \\ = p^m \sum_{i=\lfloor m/2 \rfloor}^{m} \binom{m}{i} \left(\frac{1}{p}-1\right)^i. \quad (11)$$

Now, for $p < 1/2$, Lemma 2 says that

$$1 - p < p^m \sum_{i=\lfloor m/2 \rfloor}^{m} \binom{m}{i} \left(\frac{1}{p}-1\right)^i, \quad (12)$$

which, in view of Equation (11), implies that $p_m < p$, i.e., the probability of error for a swarm of $m$ MAVs is less than for MAV in solo. This proves the theorem. □

A similar proof also yields the following.

**Theorem 2.** The majority rule applied to a swarm of $m$ MAVs executing Algorithm 2 reduces the probability of error of the advice process as long as $q < 1/2$,

**Proof.** The proof is similar to the proof of Theorem 2. □

Note that there are additional possibilities in Algorithm 2. The MAVs in a swarm could also acquire information either from the same landmark or from different landmarks (although we do not investigate the latter case further).

## 4.2. Approximating the Majority

Let $S_m$ be the sum of $m$ mutually independent random variables each taking the value 1 with probability $p$ and the value 0 with probability $1-p$ (i.e., Bernoulli random trials). The majority probability discussed above is given by the formula $\text{Pr}[S_m \ge \lfloor \frac{m}{2} \rfloor]$. Good approximations of the majority probability for large values of $m$ can be obtained from the central limit theorem, which states that

$$\text{Pr} \left[ a \le \frac{S_m - mp}{\sqrt{mp(1-p)}} \le b \right] \rightarrow \frac{1}{\sqrt{2\pi}} \int_a^b e^{-x^2/2} dx. \text{ as } m \rightarrow \infty \quad (13)$$
(see, for instance [21]). For example, for any *m*, we have that

$$S_m \geq \left\lfloor \frac{m}{2} \right\rfloor \Leftrightarrow \frac{S_m - mp}{\sqrt{mp(1-p)}} \geq \frac{\left\lfloor \frac{m}{2} \right\rfloor - mp}{\sqrt{mp(1-p)}}$$

Hence, the central limit theorem (13) is applicable with $a = \frac{\left\lfloor \frac{m}{2} \right\rfloor - mp}{\sqrt{mp(1-p)}}$ and $b = +\infty$, where $p < 1/2$ is a constant.

## 5. Experiments and Simulations

There is an interesting trade-off between the majority probability $p_m$ and cost of using a swarm of *m* MAVs. This helps put the probabilistic gains in context w.r.t. the energy consumption and time cost of the swarm.

### 5.1. Cost Measures and Tradeoffs

From Theorem 1, we know that, for any number *m* of MAVs, the error probability *p* is reduced to $p_m$, similarly for Theorem 2. We now examine quantitative estimates of this error reduction in relation to specific numbers *m* of MAVs involved.

From Equation (11), observe that we can derive the following identity expressing the ratio of improvement of the probability of correctness:

$$\frac{1 - p_m}{1 - p} = \sum_{i=\left\lfloor \frac{m}{2} \right\rfloor}^{m} \binom{m}{i} (1 - p)^{i-1} p^{m-i} \quad (14)$$

In a way, one can think of the right-hand side of Equation (14) as the “fractional gain” in the correctness probability (because we are employing a majority rule) that improves from $1-p$ to $1-p_m$. In general, we would like on the one hand to ensure that $\frac{1-p_m}{1-p}$ is greater than one, i.e., there is effectively a gain, and on the other hand to optimize the right-hand side of Equation (14). Since we are also interested in applying the majority algorithms for a relatively small number of MAVs, we give close form expressions and precise estimates of the optimal value of *p* and the maximum fractional gain, for *m* equal to 2, 3, 4, 5, 6 and 7 MAVs.

**Theorem 3.** For *m* equal to 2, 3, 4, 5, 6 and 7 MAVs, the maximum attainable fractional gain $\frac{1-p_m}{1-p}$ and the corresponding error probability *p* are as listed in the second and third column, respectively, of Table 1.

<table><caption>**Table 1.** Maximum fractional gain vs. number of MAVs (*m*).</caption><thead><tr><th>m</th><th>Maximum Fractional Gain</th><th>Corresponding p</th></tr></thead><tbody><tr><td>2</td><td>1 + 1/2</td><td>1/2</td></tr><tr><td>3</td><td>1 + 1/8</td><td>1/4</td></tr><tr><td>4</td><td>1.379</td><td>1 + &radic;10/9</td></tr><tr><td>5</td><td>1.198</td><td>0.276</td></tr><tr><td>6</td><td>1.368</td><td>0.398</td></tr><tr><td>7</td><td>1.249</td><td>0.294</td></tr></tbody></table>

**Proof.** Each of the six cases is examined individually. Recall that the fractional gain is the ratio $\frac{1-p_m}{1-p}$ whose expression as given by Equation (14) yields a polynomial which is easily optimized with analytical methods, namely by setting its first derivative equal to zero, or numerical methods.

Case *m* = 2. The fractional gain ratio is $\frac{1-p_2}{1-p}$, which is equal to $\frac{1-p^2}{1-p}$ or the linear polynomial $1 + p$. It is maximized for *p* equal to 1/2, i.e., the maximum value that can be assumed by *p*. The maximum fractional gain is therefore 1 + 1/2.
**Case m = 3.** The fractional gain ratio is $\frac{1-p_3}{1-p}$, which is equal to the polynomial $1 + p - 2p^2$. Setting its derivative equal to 0, we obtain $1 - 4p = 0$ and therefore $p = 1/4$. Therefore, the fractional gain attains the maximum value $1 + 1/8$.

**Case m = 4.** The fractional gain ratio satisfies $\frac{1-p_4}{1-p} = (1-p)(3p^2 + 2p + 1)$. Differen- tiating the last polynomial and setting it equal to 0, we obtain $-9p^2 + 2p + -1 = 0$. Solving the quadratic, we obtain that the fractional gain is maximized when $p = \frac{1+\sqrt{10}}{9}$ and attains the maximum value 1.379.

**Case m = 5.** The fractional gain ratio is $\frac{1-p_5}{1-p}$, which is equal to the polynomial $10(1-p)^2p^2 + 5(1-p)^3p + (1-p)^4$. Its first derivative is equal to the polynomial $24p^3 - 27p^2 + 2p + 1$. One of the roots of this polynomial is 1. We have that $24p^3 - 27p^2 + 2p + 1$ is equal to $(p-1)(24p^2 - 3p + 1)$. The positive root of the quadratic $24p^2 - 3p + 1$ is equal to $\frac{3+\sqrt{9+96}}{48}$, or approximately 0.276. The fractional gain ratio attains the maximum value 1.1917.

**Case m = 6.** The fractional gain ratio is $\frac{1-p_6}{1-p}$, which is equal to the polynomial $1 + p + p^2 + p^3 - 14p^4 + 10p^5$. Using the Wolfram Mathematica™ function, solve(diff(1 + p + p^2 + p^3 - 14p^4 + 10p^5), p)) we obtain the optimal value

$$p = \frac{6 + (38016 - 1350\sqrt{730})^{1/3} + 3(2(704 + 25\sqrt{730}))^{1/3}}{150} \approx 0.39751...$$

**Case m = 7.** The fractional gain ratio is $\frac{1-p_7}{1-p}$, which is equal to the polynomial

$$(1-p)^3(1+4p+10p^2+20p^3)$$

Using the Wolfram Mathematica™ function solve(diff((1 - p)^3(1 + 4p + 10p^2 + 20p^3), p)), we obtain the optimal value

$$p = \frac{10 + (217000 - 15120\sqrt{190})^{1/3} + 2(35(775 + 54\sqrt{(190)}))^{1/3}}{360} \approx 0.29357$$

<figure><img src="image_7.png" /></figure>

For m = 2,...,7, Table 2 displays the polynomials modeling the fractional gains and the majority error probability $p_m$.

<table><caption>**Table 2.** Fractional gain polynomials and majority error probability $p_m$, for m = 2 to m = 7.</caption><thead><tr><th>m</th><th>Fractional Gain Polynomial</th><th>p<sub>m</sub></th></tr></thead><tbody><tr><td>2</td><td>1 + p</td><td>0.25</td></tr><tr><td>3</td><td>-2p<sup>2</sup> + p + 1</td><td>0.15</td></tr><tr><td>4</td><td>-3p<sup>3</sup> + p<sup>2</sup> + p + 1</td><td>0.25</td></tr><tr><td>5</td><td>6p<sup>4</sup> - 9p<sup>3</sup> + p<sup>2</sup> + p + 1</td><td>0.13</td></tr><tr><td>6</td><td>10p<sup>5</sup> - 14p<sup>4</sup> + p<sup>3</sup> + p<sup>2</sup> + p + 1</td><td>0.179</td></tr><tr><td>7</td><td>-20p<sup>6</sup> + 50p<sup>5</sup> - 34p<sup>4</sup> + p<sup>3</sup> + p<sup>2</sup> + p + 1</td><td>0.113</td></tr></tbody></table>

Table 3 displays the optimal error probability, fractional gain and majority error probability $p_m$ versus a given number m of MAVs, where $m \le 20$.
<table><caption>**Table 3.** Left to right, the columns provide (1) the number of MAVs, (2) the optimal value (p), (3) the fractional gain $\frac{1-p_m}{1-p}$ from $m = 9$ to $m = 20$ and (4) the corresponding majority error.</caption><thead><tr><th>m</th><th>Optimal Value (p)</th><th>Fractional Gain</th><th>p<sub>m</sub></th></tr></thead><tbody><tr><td>8</td><td>0.381</td><td>1.380</td><td>0.144</td></tr><tr><td>9</td><td>0.307</td><td>1.287</td><td>0.111</td></tr><tr><td>10</td><td>0.372</td><td>1.396</td><td>0.120</td></tr><tr><td>11</td><td>0.317</td><td>1.319</td><td>0.103</td></tr><tr><td>12</td><td>0.370</td><td>1.411</td><td>0.110</td></tr><tr><td>13</td><td>0.326</td><td>1.345</td><td>0.098</td></tr><tr><td>14</td><td>0.370</td><td>1.426</td><td>0.101</td></tr><tr><td>15</td><td>0.333</td><td>1.368</td><td>0.083</td></tr><tr><td>16</td><td>0.371</td><td>1.440</td><td>0.092</td></tr><tr><td>17</td><td>0.339</td><td>1.387</td><td>0.084</td></tr><tr><td>18</td><td>0.373</td><td>1.452</td><td>0.084</td></tr><tr><td>19</td><td>0.344</td><td>1.404</td><td>0.073</td></tr><tr><td>20</td><td>0.374</td><td>1.464</td><td>0.077</td></tr></tbody></table>

Figure 3a plots the evaluation of equation $\frac{1-p_m}{1-p}$ from $m = 2$ to $m = 7$. Figure 3b plots the same evaluation, from $m = 8$ to $m = 20$. The curves indicate the maximum fractional gains as a function of the probability p.

<figure><img src="image_8.png" /><figcaption>**Figure 3.** Plots of the fractional gain function $\frac{1-p_m}{1-p}$ for varied p's and m's.</figcaption></figure>

## 5.2. Numerical Simulations

Algorithms 1 and 2 have been integrated into a Java simulator, which implements swarm populations modeled as mobile agents. Each swarm executes the algorithms within a terrain of interconnected landmarks. It consists of a simple discrete event, time-step based simulation engine, in which the swarm executes our algorithms at every step of simulated time. The simulation engine implements a discrete event scheduler, a graphical view, a data collection system and the simulated objects themselves, i.e., landmarks and agents. Videocaptures and source code are available online [22].

Using our Java simulation, we validate five different scenarios. Every scenario relates the number of MAVs with the error probability of the majority edasrule varying the recognition and advice error ratios among the percentages 70%, 80% and 90% (cf. Section 3). Figure 4a,b represent two grid structures of MAVSIM, i.e., a 10 × 10-grid and a 25 × 25-grid. Figure 5a is a topological structure imported from the OpenStreetMap (OSM (https://www.openstreetmap.org (accessed on 9 July 2021))) project, using Carleton University as the location; Figure 5b is a topological structure imported from OSM using Telecom SudParis (at the campus of the Institut Polytechnique de Paris (IPP)) as the location;
<figure><img src="image_9.png" /><figcaption>**Figure 4.** Experimental results for the two first scenarios. (a) depicts the 10 × 10-grid scenario. (b) depicts the 25 × 25-grid scenario. (c,d) show the relation between the number of MAVs and error probability of the majority rule ($p_m$) varying the recognition and advice error ratios between 70% (red), 80% (blue) and 90% (black). The vertical axis represents $p_m$. The horizontal axis represents the number of MAVs. (e,f) show the relation between the number of MAVs vs. energy consumption, when varying the recognition and advice error ratios. The vertical axis represents the energy consumption (joules).</figcaption></figure>
<figure><img src="image_10.png" /><figcaption>(a) Carleton University scenario</figcaption></figure>

<figure><img src="image_11.png" /><figcaption>(b) IPP – T. SudParis scenario</figcaption></figure>

<figure><img src="image_12.png" /><figcaption>(c) Campinas – Unicamp scenario</figcaption></figure>

<figure><img src="image_13.png" /><figcaption>(d) Error probabilities, Carleton scenario</figcaption></figure>

<figure><img src="image_14.png" /><figcaption>(e) Error probabilities, IPP scenario</figcaption></figure>

<figure><img src="image_15.png" /><figcaption>(f) Error probabilities, Campinas scenario</figcaption></figure>

<figure><img src="image_16.png" /><figcaption>(g) Energy consumption, Carleton scenario</figcaption></figure>

<figure><img src="image_17.png" /><figcaption>(h) Energy consumption, IPP scenario</figcaption></figure>

<figure><img src="image_18.png" /><figcaption>(i) Energy consumption, Campinas scenario</figcaption></figure>

**Figure 5.** Experimental results for the three last scenarios. (a) depicts the Carleton University map scenario. (b) depicts the IPP—T. SudParis scenario. (c) depicts the Campinas—Unicamp scenario. (d–f) show the relation between the number of MAVs and error probability of the majority rule ($p_m$) varying the recognition and advice error ratios between 70% (red), 80% (blue) and 90% (black). The vertical axis represents $p_m$. The horizontal axis represents the number of MAVs. (g–i) show the relation between the number of MAVs vs. energy consumption, when varying the recognition and advice error ratios. The vertical axis represents the energy consumption (joules).

5.3. Performance Evaluation

Table 4 shows key characteristics for each of the five scenarios. For every scenario, the second column lists the types of landmarks that are present. The third column lists the number of nodes contained in the map. The fourth column specifies the quantity of nodes used as landmarks.

For each of the five scenarios, Figures 4 and 5 (cf. Parts Figures 4c,d and 5d–f) show the relation between the number of MAVs and error probability $p_m$ of the majority rule varying the recognition and advice error ratios among the percentages 70%, 80% and 90%. The horizontal axis lists the numbers of MAVs. The vertical axis represents the majority error
probability $p_m$. For every scenario, there are three curves corresponding to the recognition and advice error percentages 70% (red), 80% (blue) and 90% (black). For each of the five scenarios, Figures 4 and 5 confirm that the majority rule applied to a swarm of *m* MAVs reduces the probability of error of the recognition process. Our solution benefits from swarm cooperation.

<table><caption>**Table 4.** Characteristics of each scenario.</caption><thead><tr><th>Scenario</th><th>Landmark Types</th><th># of Nodes</th><th># of Landmarks</th></tr></thead><tbody><tr><td>10 × 10-grid</td><td>Random nodes</td><td>100</td><td>1/4 of the nodes</td></tr><tr><td>25 × 25-grid</td><td>Random nodes</td><td>625</td><td>1/4 of the nodes</td></tr><tr><td>Carleton University</td><td>Traffic signals, junctions, etc.</td><td>3511</td><td>335</td></tr><tr><td>IPP—Telecom SudParis</td><td>Crossing paths, tourism viewpoint, etc.</td><td>1413</td><td>97</td></tr><tr><td>Campinas—Unicamp</td><td>Crossing paths, round-about, etc.</td><td>1559</td><td>29</td></tr></tbody></table>

### 5.4. Energy Evaluation

To move a distance *d* at speed $s_i$, the energy consumed by a straight line flight $E_{fly}$ can be quantified as the integral of the power $P(s_i)$ as a function of the speed along the time [23]:

$$E_{fly}(d, s_i) = \int_{t=0}^{t=d/s_i} P(s_i)dt = P(s_i) \frac{d}{s_i} \qquad (15)$$

For the five scenarios, Figures 4 and 5 (cf. Parts Figures 4e,f and 5g–i) show the relation between the number of MAVs and energy consumption varying the recognition and advice error ratios among the percentages 70%, 80% and 90%. In each case, the horizontal axis represents the number of MAVs. The vertical axis represents the energy consumption metric. There are three bars corresponding to the recognition and advice error ratios 70% (red), 80% (blue) and 90% (black). The speed is set to 5 m/s. In the first four scenarios, the results show that the energy consumption of the MAVs reduces to approximately 35%, when the number of MAVs increases. This is because the error probability of the majority rules $p_m$ decreases as well. On the other hand, the University of Campinas scenario is a sparse graph. The number of landmarks is relatively small. Energy consumption is less sensitive to the number of MAVs.

## 6. Conclusions

We have presented an error tolerant path planning algorithm for MAV swarms. We have assumed a navigation system in which the MAVs find their path by using their on board cameras, by identifying and following a series of visual landmarks. We have assumed landmarks' a priori information, but for which interpretation by the MAVs is error prone. We have defined two types of errors: (1) recognition errors, e.g., due to faulty sensors that misinterpret the sensed data, and (2) advice errors caused by the landmarks, e.g., due to weather conditions or outdated information. Our solution benefits from swarm cooperation. When the MAVs in a swarm can communicate and exchange information, the recognition and advice error ratios *get minimized to one fourth* at the expense of *increasing the total number of MAVs by twenty*. We validated the proposal via simulations, implemented in Java, available in a companion repository on github [22].

The recognition and advice algorithms presented are based on binary decision-making. An interesting setting worth exploring is non-binary. For example, consider a swarm of five MAVs required to decide its next move based on the majority color of a door, say, among Yellow (Y), Green (G) and Blue (B); in this case, it is assumed that Y is to be a positive outcome while G, B are negative outcomes. On the one hand, if the respective outputs of the visual systems are Y, G, Y, Y, B, then the Yellow Door is considered to be the positive
outcome and occurs three out of five times. On the other hand, if the respective outputs of the visual systems are Y, G, Y, B, B, then there is no majority of identical colors. In particular, the majority can be formed by three identical answers. Such situations can be handled using voting schemes and fuzzy logic, which would be the focus of future research.

The basic idea of our algorithms is to enhance the quality of recognition and advice by having multiple MAVs make a decision after exchanging information they have obtained. Naturally, this increases the cost of movement since multiple MAVs will be traveling to a destination. Therefore, it would be interesting to look at trade-offs of the cost of the search that take into account either time or total energy versus the number of MAVs in the swarm for a given budget.

**Author Contributions:** All authors (M.B., J.G.-A., E.K. and F.S.) contributed equally to this work. All authors have read and agreed to the published version of the manuscript.

**Funding:** Authors received financial support from the Natural Sciences and Engineering Research Council of Canada (NSERC) and the Emerging Leaders in the American Program (ELAP) through Global Affairs Canada.

**Institutional Review Board Statement:** Not applicable.

**Informed Consent Statement:** Not applicable.

**Data Availability Statement:** Not applicable.

**Acknowledgments:** The authors gratefully acknowledge financial support from the Natural Sciences and Engineering Research Council of Canada (NSERC) and the Emerging Leaders in the American Program (ELAP) through Global Affairs Canada.

**Conflicts of Interest:** The authors declare no conflict of interest.

## References

1. Aerial Robots for Sewer Inspection, "ARSI". Available online: http://echord.eu/essential_grid/arsi/ (accessed on 9 July 2021).

2. Altigator, "Drones for Search and Rescue Missions". Available online: https://altigator.com/drones-for-search-rescue-missions/ (accessed on 9 July 2021).

3. DHL, "DHL's Parcelcopter: Changing Shipping Forever". Available online: http://j.mp/2WV7KcO (accessed on 9 July 2021).

4. Goerzen, C.; Kong, Z.; Mettler, B. A survey of motion planning algorithms from the perspective of autonomous UAV guidance. *J. Intell. Robot. Syst.* **2010**, *57*, 65.

5. Radmanesh, M.; Kumar, M.; Guentert, P.H.; Sarim, M. Overview of path-planning and obstacle avoidance algorithms for UAVs: A comparative study. *Unmanned Syst.* **2018**, *6*, 95–118.

6. Khatib, O. Real-time obstacle avoidance for manipulators and mobile robots. *Int. J. Robot. Res.* **1986**, *5*, 90–98.

7. LaValle, S.M. *Rapidly-Exploring Random Trees: A New Tool for Path Planning*; Department of Computer Science, Iowa State University: Ames, IA, USA, 1998.

8. LaValle, S. *Planning Algorithms*; Cambridge University Press: Cambridge, UK, 2006.

9. Turpin, M.; Michael, N.; Kumar, V. CAPT: Concurrent assignment and planning of trajectories for multiple robots. *Int. J. Robot. Res.* **2014**, *33*, 98–112.

10. Rizqi, A.A.A.; Cahyadi, A.I.; Adji, T.B. Path planning and formation control via potential function for UAV quadrotor. In *Proceedings of the 2014 International Conference on Advanced Robotics and Intelligent Systems (ARIS)*, Taipei, Taiwan, 6–8 June 2014; pp. 165–170.

11. Prasad, A.; Sharma, B.; Vanualailai, J.; Kumar, S. Motion control of an articulated mobile manipulator in 3D using the Lyapunov-based control scheme. *Int. J. Control.* **2021**, 1–15, doi:10.1080/00207179.2021.1919927.

12. Kumar, S.; Sharma, B.; Vanualailai, J.; Prasad, A. Stable Switched Controllers for a Swarm of UGVs for Hierarchical Landmark Navigation. *Swarm Evol. Comput.* **2021**, *65*, 100926.

13. Kumar, S.; Vanualailai, J.; Sharma, B.; Prasad, A. Velocity controllers for a swarm of Unmanned Aerial Vehicles. *J. Ind. Inf. Integr.* **2021**, *22*, 100198.

14. Soria, E.; Schiano, F.; Floreano, D. SwarmLab: A MATLAB drone swarm simulator. In *Proceedings of the 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS)*, Las Vegas, NV, USA, 24 October 2020–24 January 2021; pp. 8005–8011.

15. Maravall, D.; de Lope, J.; Fuentes, J. Navigation and self-semantic location of drones in indoor environments by combining the visual bug algorithm and entropy-based vision. *Front. Neurorobotics* **2017**, *11*, 46.

16. Weinstein, A.; Cho, A.; Loianno, G.; Kumar, V. Visual inertial odometry swarm: An autonomous swarm of vision-based quadrotors. *IEEE Robot. Autom. Lett.* **2018**, *3*, 1801–1807.
17. Maravall, D.; de Lope, J.; Brea, J.P.F. A vision-based dual anticipatory/reactive control architecture for indoor navigation of an unmanned aerial vehicle using visual topological maps. In *International Work-Conference on the Interplay Between Natural and Artificial Computation*; Springer: Berlin/Heidelberg, Germany, 2013; pp. 66–72.

18. Narendra, K.; Thathachar, M. *Learning Automata: An Introduction*; Courier Corporation: Chelmsford, MA, USA, 2012.

19. Maravall, D.; Lope, J.D.; Fuentes, J.P. Fusion of probabilistic knowledge-based classification rules and learning automata for automatic recognition of digital images. *Pattern Recognit. Lett.* **2013**, *34*, 1719–1724.

20. Fuentes, J.P.; Maravall, D.; de Lope, J. Entropy-based search combined with a dual feedforward-feedback controller for landmark search and detection for the navigation of a UAV using visual topological maps. In *ROBOT2013: First Iberian Robotics Conference*; Springer: Berlin/Heidelberg, Germany, 2014; pp. 65–76.

21. Rozanov, Y.A. *Probability Theory: A Concise Course*; Dover Publications: New York, NY, USA, 1977.

22. Barbeau, M.; Garcia-Alfaro, J.; Kranakis, E.; Santos, F. Error Tolerant Path Planning for Swarms of Micro Aerial Vehicles with Quality Amplification [Github Repository]. Available online: https://github.com/jgalfaro/mirrored-scavesim/tree/main/mavsim_v2 (accessed on 9 July 2021).

23. Franco, C.D.; Buttazzo, G. Energy-aware coverage path planning of UAVs. In Proceedings of the 2015 IEEE International Conference on Autonomous Robot Systems and Competitions, Vila Real, Portugal, 8–10 April 2015; pp. 111–117.