+ All Categories
Home > Documents > Decentralized Informative Path Planning with Exploration ... · pected to provide greater...

Decentralized Informative Path Planning with Exploration ... · pected to provide greater...

Date post: 24-Jun-2020
Category:
Upload: others
View: 1 times
Download: 0 times
Share this document with a friend
10
Decentralized Informative Path Planning with Exploration-Exploitation Balance for Swarm Robotic Search Payam Ghassemi * , and Souma Chowdhury Department of Mechanical and Aerospace Engineering University at Buffalo Buffalo, NY, 14260 Email: * [email protected], [email protected] AbstractSwarm robotic search is concerned with searching targets in unknown environments (e.g., for search and rescue or hazard localization), using a large number of collaborating simple mobile robots. In such applications, decentralized swarm systems are touted for their task/coverage scalability, time efficiency, and fault tolerance. To guide the behavior of such swarm systems, two broad classes of approaches are available, namely nature-inspired swarm heuristics and multi-robotic search methods. However, simultaneously offering computationally-efficient scalability and fundamental insights into the exhibited behavior (instead of a black-box behavior model), remains challenging under either of these two class of approaches. In this paper, we develop an important extension of the batch Bayesian search method for application to embodied swarm systems, searching in a physical 2D space. Key contributions lie in: 1) designing an acquisition function that not only balances exploration and exploitation across the swarm, but also allows modeling knowledge extraction over trajectories; and 2) developing its distributed implementation to allow asynchronous task inference and path planning by the swarm robots. The resulting collective informative path planning approach is tested on target search case studies of varying complexity, where the target produces a spatially varying (measurable) signal. Significantly superior performance, in terms of mission completion efficiency, is observed compared to exhaustive search and random walk baselines, along with favorable performance scalability with increasing swarm size. I. INTRODUCTION Swarm robotic search is concerned with searching and/or lo- calizing targets in unknown environments with a large number of collaborative robots. Potential applications include source localization of gas leakage [1], nuclear meltdown tracking [2], chemical plume tracing [3], radio source localization [4], cooperative foraging [5], and oil spill mapping [6], [7]. Swarm robotic systems demonstrate mission efficiency, fault toler- ance, and scalable coverage advantages [8], [9] compared to sophisticated standalone systems. In swarm robotic search, a Copyright c 2019 ASME. Personal use of this material is permitted. Per- mission from ASME must be obtained for all other uses, in any current or future media, including reprinting/republishing this material for advertising or promotional purposes, creating new collective works, for resale or redistribu- tion to servers or lists, or reuse of any copyrighted component of this work in other works. major challenge is in designing computationally lightweight algorithms that allow effective task-planning within the swarm of robots [10], one that maximizes search efficiency and mitigates conflicts. In this paper, we consider searching targets that emit a spatially varying signal (aka. a source localization problem) using a swarm of robots in 2D space. The online planning problem solved by the robots is then posed as finding a set of waypoints that maximize some measure of collective search efficiency [11]. For this purpose, we formulate, im- plement and test a novel decentralized algorithm, founded on the batch Bayesian search formalism, that not only tackles the balance between exploration and exploitation, but also allows asynchronous decision-making within the swarm. The proposed formulation is tested over a set of case studies involving varying number of robots and target sources. The remainder of this section briefly surveys the literature on swarm robotic search, and states the objectives of this paper. A. Single-robot vs. Multi-robot Search Various search strategies for single-robot system have been surveyed in [12]. Most of these works are theoretical in nature and applicable to a single robot searching for sin- gle, multiple, static or dynamic targets. However, in time- sensitive applications involving large areas and multiple signal sources [13], a team of robots can broaden the scope of operational capabilities through distributed remote sensing, scalability and parallelism (both in terms of task execu- tion and information gathering) [7]. The multi-robot search paradigm (typically involving 10 or less number of robots) uses concepts such as predefined lanes or patterns [14], space filling curves, [15], Voronoi-based methods [16], [17], control theory, team theory [18], and uncertainty reduction methods [19]. Among these approaches, the ones suited for search in unknown unstructured environments generally do not scale well from the multi-robotic to the swarm-robotic paradigm (where the latter involves 10’s to 100’s of robots). arXiv:1905.09988v2 [cs.MA] 31 May 2019
Transcript
Page 1: Decentralized Informative Path Planning with Exploration ... · pected to provide greater explainability and ease of debugging any performance shortfalls. C. Objective of This Paper

Decentralized Informative Path Planning withExploration-Exploitation Balance for Swarm

Robotic SearchPayam Ghassemi∗, and Souma Chowdhury†

Department of Mechanical and Aerospace EngineeringUniversity at BuffaloBuffalo, NY, 14260

Email: ∗[email protected], †[email protected]

Abstract—Swarm robotic search is concerned with searchingtargets in unknown environments (e.g., for search and rescue orhazard localization), using a large number of collaborating simplemobile robots. In such applications, decentralized swarm systemsare touted for their task/coverage scalability, time efficiency, andfault tolerance. To guide the behavior of such swarm systems, twobroad classes of approaches are available, namely nature-inspiredswarm heuristics and multi-robotic search methods. However,simultaneously offering computationally-efficient scalability andfundamental insights into the exhibited behavior (instead of ablack-box behavior model), remains challenging under either ofthese two class of approaches. In this paper, we develop animportant extension of the batch Bayesian search method forapplication to embodied swarm systems, searching in a physical2D space. Key contributions lie in: 1) designing an acquisitionfunction that not only balances exploration and exploitation acrossthe swarm, but also allows modeling knowledge extraction overtrajectories; and 2) developing its distributed implementation toallow asynchronous task inference and path planning by the swarmrobots. The resulting collective informative path planning approachis tested on target search case studies of varying complexity,where the target produces a spatially varying (measurable) signal.Significantly superior performance, in terms of mission completionefficiency, is observed compared to exhaustive search and randomwalk baselines, along with favorable performance scalability withincreasing swarm size.

I. INTRODUCTION

Swarm robotic search is concerned with searching and/or lo-calizing targets in unknown environments with a large numberof collaborative robots. Potential applications include sourcelocalization of gas leakage [1], nuclear meltdown tracking [2],chemical plume tracing [3], radio source localization [4],cooperative foraging [5], and oil spill mapping [6], [7]. Swarmrobotic systems demonstrate mission efficiency, fault toler-ance, and scalable coverage advantages [8], [9] compared tosophisticated standalone systems. In swarm robotic search, a

Copyright c©2019 ASME. Personal use of this material is permitted. Per-mission from ASME must be obtained for all other uses, in any current orfuture media, including reprinting/republishing this material for advertising orpromotional purposes, creating new collective works, for resale or redistribu-tion to servers or lists, or reuse of any copyrighted component of this workin other works.

major challenge is in designing computationally lightweightalgorithms that allow effective task-planning within the swarmof robots [10], one that maximizes search efficiency andmitigates conflicts. In this paper, we consider searching targetsthat emit a spatially varying signal (aka. a source localizationproblem) using a swarm of robots in 2D space. The onlineplanning problem solved by the robots is then posed as findinga set of waypoints that maximize some measure of collectivesearch efficiency [11]. For this purpose, we formulate, im-plement and test a novel decentralized algorithm, founded onthe batch Bayesian search formalism, that not only tacklesthe balance between exploration and exploitation, but alsoallows asynchronous decision-making within the swarm. Theproposed formulation is tested over a set of case studiesinvolving varying number of robots and target sources. Theremainder of this section briefly surveys the literature onswarm robotic search, and states the objectives of this paper.

A. Single-robot vs. Multi-robot Search

Various search strategies for single-robot system have beensurveyed in [12]. Most of these works are theoretical innature and applicable to a single robot searching for sin-gle, multiple, static or dynamic targets. However, in time-sensitive applications involving large areas and multiple signalsources [13], a team of robots can broaden the scope ofoperational capabilities through distributed remote sensing,scalability and parallelism (both in terms of task execu-tion and information gathering) [7]. The multi-robot searchparadigm (typically involving 10 or less number of robots)uses concepts such as predefined lanes or patterns [14], spacefilling curves, [15], Voronoi-based methods [16], [17], controltheory, team theory [18], and uncertainty reduction methods[19]. Among these approaches, the ones suited for search inunknown unstructured environments generally do not scalewell from the multi-robotic to the swarm-robotic paradigm(where the latter involves 10’s to 100’s of robots).

arX

iv:1

905.

0998

8v2

[cs

.MA

] 3

1 M

ay 2

019

Page 2: Decentralized Informative Path Planning with Exploration ... · pected to provide greater explainability and ease of debugging any performance shortfalls. C. Objective of This Paper

B. Swarm Robotic SearchThe class of approaches more popular in guiding the agents’

behavior in scalable swarm robotic search is often basedon nature-inspired swarm intelligence (SI) algorithms [20]–[23]. Variations of these algorithms are otherwise also usedfor performing optimization on highly nonconvex multimodalfunctions [24], which can be perceived as non-embodiedsearch in an n-dimensional space. A few examples of nature-inspired swarm robotic search is given here. Pugh and Mar-tinoli [10] proposed an algorithm based on particle swarmconcepts for swarm robotic search considering a stationarysingle target case. Jatmiko et al. [25] studied a particle swarm-based algorithm for odor source localization using a team of20 robots. They showed that effectiveness of these methodsrely on adaptive parameters (e.g., decreasing the inertia weightlinearly during the search) to be successful to find the sourcelocation. A comprehensive (albeit bit dated) review of workin swarm robotic search (including nature inspired methods)can be found in [26].

Multi-modal search environments: The use of robotic sys-tems to locate a single gradient source has been investigated inthe literature [27]. However, the localization of multiple gradi-ent sources or the maximum strength source in the presence ofother weaker sources (i.e., a multi-modal spatial distributionof signal strength) has received much less attention. A notableexception is the gradient search based distributed algorithmreported by Krishnanand et al. [28]. McGill and Taylor [27]however showed that the former approach [28] is not able tolocate all sources if the initial robot distribution does not coverthe search area (an impractical assumption).

In adopting population-based search algorithms, typicallyused in optimization (a non-embodied process), for physi-cal swarm-robotic search, we need to appreciate two maindifferences in the nature of the sampling process. We seethe process of deciding the next point to be explored byeach agent as “sampling” – which is system evaluation inoptimization and signal measurement in robotic search. Withthat perspective, the main differences are in: (1) sampling cost:unlike in optimization, each sample may require a differentenergy/time investment by robots depending upon the distanceof the next waypoint and the operating environment; and(2) sampling over path: robots are able to gather samples(signal measurements) over their path, unlike in optimizationwhere each population member evaluates the system only attheir next point. Thus, knowledge generation in robotic searchoccurs over trajectories, while in optimization it occurs atdiscrete points in the search space. Although, the samplingcost aspect has been considered in the aforementioned swarmintelligence-based methods, the “sampling over path” factorhas received minimal attention. In our proposed approach, weadopt the Bayesian optimization and informative path planningprinciples for swarm robotic search. Here, robots employ in-formative path planning to generate paths that simultaneouslybalances reduction of the knowledge uncertainty and getting

closer to the global source. This approach is such designedas to allow collectively assisting in reducing uncertainty, butnot necessarily requiring all robots to converge on the source.Given that robotic search is in general restricted to 2D or 3Dspace (higher dimensional state spaces are possible), a newbatch Bayesian approach is expected to be both effective andcomputationally frugal for this purpose.

Moreover, with swarm-intelligence based methods, the de-pendence of the (at times astonishingly competitive) emergentbehavior on heuristics raises questions of dependability andexplainability (a particular concern in applications requiringhuman-swarm teaming [29]). Now, the search problem canbe thought of as comprising two main steps: task perception(identifying/updating the signal spatial model) and task se-lection (waypoint planning). In swarm intelligence methods,the two steps are not separable, and a spatial model is notexplicit. In our proposed approach, the processes are inherentlydecoupled – the robots exploit Gaussian Processes (GP) tomodel the signal distribution knowledge (task inference stage)and solves a 2D optimization over the acquisition functionto decide waypoints (task selection). Such an approach is ex-pected to provide greater explainability and ease of debuggingany performance shortfalls.

C. Objective of This Paper

The primary objective of this paper is to develop (anexplainable) decentralized and asynchronous swarm roboticsearch algorithm, subject to the following assumptions: i) allrobots are equipped with precise localization; and ii) eachrobot can communicate their knowledge, state and decisionswith all neighbors (full observability) at waypoints. Withinthis context, the primary contributions of this paper lies in thefollowing developments: 1) a novel decentralized algorithm(Bayes-Swarm) that extends Gaussian process modeling (toupdate over trajectories) and integrates physical robot con-straints and other robots’ decisions to perform informativepath planning – simultaneously mitigating knowledge uncer-tainty and getting closer to the source; and 2) a simulatedparallelized implementation of Bayes-Swarm to allow asyn-chronous search planning over complex multi-modal signaldistributions. The performance of Bayes-Swarm is also com-pared with that of a random-walk baseline.

The remaining portion of the paper is organized as follows:The next section presents the problem definition and GPmodeling. Then our proposed decentralized algorithm (Bayes-Swarm) is described. Numerical experiments and results, en-capsulating the performance of these methods on different-sized swarm and a parametric analysis of the proposed de-centralized method are then presented. The paper ends withconcluding remarks.

Page 3: Decentralized Informative Path Planning with Exploration ... · pected to provide greater explainability and ease of debugging any performance shortfalls. C. Objective of This Paper

II. BACKGROUND

A. Gaussian Process Model

Gaussian process (GP) models [30] are probabilistic surro-gate models that have been used successfully in different appli-cations such as modeling the objective function in Bayesianoptimization [31]. If we have a set of n observations of anenvironment, D = xi, yi|i = 1 . . . n, then we can write thefollowing equation by assuming that the observed values ydiffer from the function f(x) values by an additive noise ε,where x denotes an input vector:

y = f(x) + ε (1)

By assuming the noise follows an independent, identicallydistributed Gaussian distribution with zero mean and varianceσ2n, we have ε ∼ N (0, σ2

n). The function f(x) can beestimated by a GP with mean function µ(x) and covariancekernel σ2(x) given by:

f(x) ∼ GP(µ(X), σ2(X)

)(2)

where,

µ(x) = Λ(x)(y − Φβ) (3)

σ2(x) = k(x,x)− Λ(x)kn(x) (4)

Λ(x) = kn(x)T [K + σ2n(x)I]−1 (5)

Here Φ is the vector of explicit basis functions and K =K(X,X|θ) is the covariance function matrix such that(K)ij = k(xi,xj), and kn(x) = [k(x1,x), . . . , k(xn,x)]T . Inthis paper, the hyper-parameters of the GP model are optimizedby maximizing the log-likelihood P as a function of β, θ, σ2

f :

β, θ, σ2 = arg maxβ,θ,σ2

logP (y|X, β, θ, σ2f ) (6)

where,

logP (y|X, β, θ, σ2) =− 1

2(y − Φβ)TΛ(x)−1(y − Φβ)

− Ns2

log 2π − 1

2log |Λ(x)|

(7)

III. SWARM BAYESIAN ALGORITHM

A. Bayes-Swarm: Overview

The robot behaviors including its motion, communication,and decision-making are illustrated in Fig. 1 and the pseu-docode of our proposed decentralized Bayes-Swarm algorithmis depicted in Alg. 1. Each robot in a team of size Nr isassumed to run the Bayes-Swarm algorithm at each decision-making step (i.e., after reaching its waypoint) to take the bestaction by maximizing an acquisition function that guides theteam to the source location over the course of the operation.Importantly, these decision-making instances need not besynchronized across robots, unlike many existing decentralizedimplementations.

Waypoint Planning

kr

r

First Decision

Add Recent Observation

kp

p

Receive Information

= + 1kr kr

Send Information

Fit GP Model

xkrr

Perform WaypointPlanning

Track Path & Take Measurement

No

Yes

EndWay-point?

= 0kr

Start

1:kr

r

Peers'Information

Downsample Dataset

Prepare Packet

Fig. 1. Bayes-Swarm architecture for each robot in the swarm

B. Acquisition Function

Robot-r solves an optimization problem based on its in-formation (D1:kr and Xkr

−r), including self-observations andshared peers’ observation from the beginning of the missiontill the decision-time kr (D1:kr =

⋃Nr

r=1

⋃kri=1Dir; Dir =

[Xir,y

ir]) and the current local peers’ next target location

(Xkr−r =

⋃p=1;p6=r X

kr−rp). For the rth robot, our mathematical

formulation of the acquisition function can be expressed as:

xk+1r = arg max

x∈Xkr

(α · hr(x,D1:kr ) + (1− α)gr(x,D1:kr , Xkr

−r))

(8)

s.t. 0 ≤ lkrs = ‖x− xkrr ‖ ≤ V T (9)

where the first term, hr(.), leads robot r to the expectedlocation of the source (exploitation) and the second term, gr(.),minimizes the knowledge uncertainty of robot r. The length(ls) of the path s is bounded based on the decision-horizonT and the nominal velocity of the robots (V ). The individualterms of the acquisition function are described next.

C. Source Seeking Term

The source location is the optimum point of the sourcesignal. In this approach, robots model the source signal usinga GP and the location with the maximum expected value basedon their then-current GP model of the environment wouldrepresent the greedy (exploitive) choice at each waypointplanning instance. Due to the motion constraints of the robotand limited decision-time horizon, all such a location may not

Page 4: Decentralized Informative Path Planning with Exploration ... · pected to provide greater explainability and ease of debugging any performance shortfalls. C. Objective of This Paper

be a feasible choices. To consider this factor, we define thesource seeking term as follows:

hr(x,D) =1

1 + (x− x∗)T (x− x∗)(10)

wherex∗ = arg max

xµ(x) (11)

D. Knowledge-gain Term

As we mentioned in the first section, robots typically gatherinformation over their path; therefore, different paths causedifferent knowledge-gains. This concept is known as infor-mative path planning (IPP), where robots plan paths such thatbest/maximum possible information is extracted. In this paper,we are interested in paths that minimizes the uncertainty in therobots’ belief (knowledge), which is analogous to maximizingthe knowledge-gain. For this purpose, we are estimating theuncertainty in the belief (modeled by a GP) based on thegathered observations and the planned future observations(other robots’ planned paths). We thus define the knowledge-gain as follows:

gr(x,D, X) =

∫s(x)

σ(s(u))du (12)

where, the path is written in the parametric form as:

s(u) = ux + (1− u)xkrr ; u ∈ [0, 1] (13)

Algorithm 1 Bayes-Swarm Algorithm

Input: GPr,xr, Xkr−r - the current location and recent obser-

vations of the robot (x), and the next waypoints of its peers(Xkr−r).

Output: xkr+1r - the next waypoint of robot-r at its iteration

kr.1: procedure TAKEDECISION(r, kr, Nr,∆θ)2: if kr = 0 then3: xkrr ← TAKEFIRSTDECISION(r, kr, Nr,∆θ)4: else5: if Size of Dkrr > Nmax then . Nmax = 4006: Down-sample Dkrr to Nmax n observations7: xkrr ← by solving the optimization, Eq.(8)8: kr ← kr + 19: return xkrr , kr

10: procedure TAKEFIRSTDECISION(r,Nr,∆θ, V, T )11: d← V T12: if ∆θ = 360 then . ∆θ: Initial feasible direction

range13: θ ← r∆θ/Nr14: else15: θ ← r∆θ/(Nr + 1)

16: x1r ← [d cos θ, d sin θ]

17: return x1r ,

E. Information Sharing

Inter-robot communication is a key element of any swarmsystem and robots often require to communicate with eachother over an ad-hoc wireless network in outdoor applications.However, given the bandwidth limitations of ad-hoc wirelesscommunication and the energy footprint of wireless communi-cation [32], it is typically desirable to reduce the communica-tion burden. To this end, in our proposed method, the decision-making is allowed to be asynchronous and robots share onlya down-sampled set of observations. Table I provides a quickoverview of the type and frequency of the information sharedby each UAV with all its peers across the swarm. Algorithm 2lists two procedures that each robot uses to share or receiveinformation. Robots then proceed to individually update theirrespective knowledge model based on their own informationand the future plan of its peers. Having presented an overviewof the Bayes-Swarm method, the next section introduces itsdistributed virtual implementation, case studies developed totest the performance of Bayes-Swarm, and the correspondingimplementation settings that we used.

IV. NUMERICAL EXPERIMENTS & CASE STUDIES

A. Distributed Virtual Implementation of Bayes-Swarm

In order to enable a better representation of distributedplanning process embodied by a physical swarm of robots,we develop a simulated environment that provisions a parallelcomputing deployment of Bayes-Swarm. This uses ”MAT-LAB”’s parallel programming capabilities to invoke 40 ded-icated threads. Each robot operates (the behavior illustrated inFig. 1) in parallel with respect to the rest of the swarm, updat-ing its own knowledge model after each waypoint and decidingits own next waypoint. The entire process is simulated in avirtual environment developed with MATLAB R2017b and isexecuted on a workstation with Intel R© Xeon Gold 6148 27.5MCache 2.40 GHz, 20 cores processor and 196 GB RAM. Thesimulation time step is set at 1 milliseconds. Robot settings: weset the velocity of each swarm robot at 10 cm/s based on thespecifications of e-puck 2 [33]. The observation frequency isset at 1 Hz. To keep the computational complexity of refitting

Algorithm 2 Communication Procedures

1: procedure RECEIVEINFORMATION(r, p,xkpp ,Dkpp )2: D1:kr

r ← D1:krr

⋃Dkpp

3: Xkr−rp(1 : 2)← Xkr

−rp(3 : 4)

4: Xkr−rp(3 : 4)← x

kpp

5: return D1:krr , Xkr

−rp

6: procedure SENDINFORMATION(r, xkrr ,Dkrr )7: if kr = 0 then8: Broadcast xkrr . 4 bytes9: else

10: Broadcast {xkrr ; Dkrr } . 4 + 6T bytes

Page 5: Decentralized Informative Path Planning with Exploration ... · pected to provide greater explainability and ease of debugging any performance shortfalls. C. Objective of This Paper

TABLE ICONTENT, SIZE, AND FREQUENCY OF INFORMATION SHARED BY ROBOT r VIA COMMUNICATION ACROSS THE SWARM.

Property Descriptions

Inter-robot communication frequency After each waypoint planning instanceContent of transmitted data • Its next location to visit (xkr

r )• Its observations over the last path (Dkr

r )Average size of outgoing data packets (with time-horizon 1 min) 364 Bytes

(a) Case study 1: large arena, convexsignal distribution

(b) Case study 2: small arena, non-convex signal distribution

(c) Case study 3: large arena, non-convex signal distribution

(d) Case study 4: large arena, highlymulti-modal signal distribution

Fig. 2. Four case studies with source distributions of different levels of complexity.

the GP low, the size of data (D1:krr ) used by each robot is

downsampled to 400 (i.e., when it grows beyond 400 in thelatter stages of the mission).

B. Case Studies

We design and execute a set of numerical experimentsto investigate the performance of the proposed decentralizedBayes-Swarm approach. In order to provide an insightful un-derstanding of the Bayes-Swarm algorithm, three types of testsare conducted for all case studies and the results are evaluatedand compared in terms of completion time, cost incurred byrobots, knowledge-gain per robot, and mapping error. Mappingerror measures how the estimated response surface using GPdeviates from the actual response surface of the source in termsof the Root-Mean Square Error (RMSE) metric. The three testsare described next. Study 1: a parametric analysis to studyhow the exploitation coefficient of Bayes-Swarm affects itsperformance; Study 2: a scalability analysis is performed toinvestigate the performance of Bayes-Swarm across multipleswarm sizes; and Study 3: Bayes-Swarm is run using thedefault values listed in Table II to analyse its performanceregarding different source distributions (i.e., single-modal andmulti-modal response surfaces) and results are compared withthat of standard exhaustive search and random walk methods.

Four distinct case studies (Fig. 2) are defined, correspondingto different combinations of source locations, to test theperformance and robustness of the Bayes-Swarm method. Thefirst case study is a large convex source signal and the rest ofthe case studies are non-convex (multi-modal) signal sources.The case study 4 is the most challenging as it contains oneglobal and five local maxima (highly non-convex function).

In this paper, Bayes-Swarm utilizes two termination criteriaduring operation. The primary criterion terminates the search ifany robot arrives within ε-vicinity of the source signal location.In addition, Bayes-Swarm terminates if the operation reaches amaximum allowed search time (Tmax). The distance thresholdε is set at 5 cm and the maximum search time Tmax is outlinedfor each case study in Table II. The decision-time horizon (T )is set at 4 seconds for the first decision-making step; then itchanges to 10 seconds for the later decision-making steps.

TABLE IIMAX. ALLOWED SEARCH TIME, TMAX (IN SECONDS), FOR CASE STUDIES.

Case Study Bayes-Swarm Random-walk

1 500 4,0002 100 50,0003 500 60,0004 700 60,000

V. RESULTS AND DISCUSSION

A. Overall Performance of Bayes-Swarm

Figure 3 depicts four snapshots of the Bayes-Swarm for casestudy 2 with 4 robots and α = 0.4. It can be seen from thisfigure how the estimated knowledge model and its uncertaintyimproves by exploring the search space. The top figures showthe uncertainty map (σ(x)) and the bottom figures show therobot location and its knowledge state (dashed contours). Inthe bottom figures, the gray solid contours represent the actualsource signal (ground truth) and the gray dashed contoursrepresent the source signal (knowledge) model of a robot atthe stated time point. Blue solid lines show the paths thatrobots have already travelled and the observations over which

Page 6: Decentralized Informative Path Planning with Exploration ... · pected to provide greater explainability and ease of debugging any performance shortfalls. C. Objective of This Paper

(a) Robot 1 at t = 4−s (b) Robot 4 at t = 4+s (c) Robot 3 at t = 26s (d) Robot 3 at t = 54s

0 0.5 1 1.5 2x [m]

0

0.5

1

1.5

2

y [m

]

(e) Robot 1 at t = 4−s

0 0.5 1 1.5 2x [m]

0

0.5

1

1.5

2y

[m]

(f) Robot 4 at t = 4+s

0 0.5 1 1.5 2x [m]

0

0.5

1

1.5

2

y [m

]

(g) Robot 3 at t = 26s

0 0.5 1 1.5 2x [m]

0

0.5

1

1.5

2

y [m

]

(h) Robot 3 at t = 54s

Fig. 3. Snapshots for the case study 2 with 4 robots that run Bayes-Swarm with α = 0.4. The top figures show the uncertainty map (σ(x)) and the bottomfigures show the robot and knowledge state. In the bottom figures, the gray solid contours represent the actual source signal (ground truth) and the gray dashedcontours represent the source signal (knowledge) model of a robot at the stated time point. Blue solid lines show the paths that robots have already travelledand the observations over which have been shared with all peers, assisting the refitting of their knowledge model. The red solid line shows the paths travelledbut the observations over which have not yet been shared with peers. The red dashed lines represent the paths that have been planned but not yet travelled.

have been shared with all peers, assisting the refitting of theirknowledge model. The red solid line shows the paths travelledbut the observations over which have not yet been shared withpeers. The red dashed lines represent the paths that have beenplanned but not yet travelled.

From Fig. 3(a)-3(e), it can be seen that when Robot 1reaches its first waypoint, only 4 self observations are availableto it;, hence it is able to build only a relatively inaccurateknowledge model (that gives the expected location of thesource at (1.6, 1.0), which is in reality far away from bothof the actual sources). When the last robot (robot 4) takesdecision, it has its peers’ observations at t = 4+s. The knowl-edge model (Fig. 3(f)) is still inaccurate, but the uncertaintymap (Fig. 3(b)) is improved. After 26 seconds (Figs. 3(c)and 3(g)), the robots are able to converge to a fairly accurateknowledge model of the signal distribution, and their futureupdates and planning (seen in Figs. 3(d) and 3(h)) puts tworobots in the team within the threshold of the source locationat time t = 54s.

B. Study 1: Parametric Analysis of Bayes-Swarm

In the proposed decentralized method, there is one majorprescribed parameter that needs to be prescribed or tuned – theexploitation coefficient parameter α, that regulates the balancebetween exploration and exploitation. We run an experimentto study how this exploitation coefficient parameter (α varyingfrom 0 to 1) affects the performance of Bayes-Swarm for thecase studies 2 and 4, across multiple swarm sizes. Snapshotsof the final state of robots for three values of α for the case

study 2 with 4 robots are depicted in Fig. 4. The performanceoutcomes in terms of completion time, and mapping error aresummarized in Figs. 5-6.

Pure source seeking (α = 1): One of the extreme casehappens when the knowledge-gain term is eliminated in theobjective function; in this mode, robots try to reach theexpected source location faster without exploring the area(getting enough knowledge) - basically the purely greedyapproach. For this purpose, the exploitation coefficient is setat α = 1. Figure 4(c) illustrates the behavior of robots underthis setting. It can be seen from this figure that, the estimatedsource signal or knowledge model is quite inaccurate, due tothe lacking of explorative search.

Only knowledge-gain term (α = 0): By setting α = 0, theobjective function (Eq. (8)) is reduced to the knowledge-gainterm (Eq. (12)), which results in purely explorative search.As expected, under this setting robots are ab;e to estimatea relatively accurate model of signal distribution (Fig. 4(a)).This mode is suited for mapping applications, such as mappingoffshore oil spills [7].

Combined source seeking & knowledge-gain terms –different trade-offs (0 < α < 1): By setting the exploitationcoefficient α at values between 0 and 1, we can tune thedegree of exploration and exploitation of the swarm search.Figures 5(b)-6(b) show that, by increasing the exploitationcoefficient from 0 to 1, the mapping error increases, especiallyfor α values beyond 0.3. Figure 4(b) depicts the searchbehavior of the swarm for α = 0.4. In this setting, onerobot successfully reaches the source location while other

Page 7: Decentralized Informative Path Planning with Exploration ... · pected to provide greater explainability and ease of debugging any performance shortfalls. C. Objective of This Paper

0 0.5 1 1.5 2x [m]

0

0.5

1

1.5

2

y [m

]

(a) α = 0

0 0.5 1 1.5 2x [m]

0

0.5

1

1.5

2

y [m

]

(b) α = 0.4

0 0.5 1 1.5 2x [m]

0

0.5

1

1.5

2

y [m

]

(c) α = 1.0

Fig. 4. Performance dynamics of a 4-robot team under different values of the exploitation/exploration balance coefficient (α), for case study 2. The solidline is the actual source signal distribution (ground truth) and the dashed line represents the extracted source signal distribution (knowledge) modeled by therobots. The red dot shows the actual source location.

0 0.2 0.4 0.6 0.8 1

40

60

80

100

Com

plet

ion

Tim

e [s

]

(a) Case study 2: completion time

0 0.2 0.4 0.6 0.8 10

0.1

0.2

0.3

0.4

0.5

0.6

Map

ping

Err

or (

RM

SE)

Nr = 1*

Nr = 1

Nr = 2

Nr = 4

(b) Case study 2: knowledge model accuracy

Fig. 5. Parametric analysis of the exploitation/exploration balance coefficient (α) in case study 2 (small arena, bi-modal signal distribution). For all runs, themaximum allowed search time is set at 100 seconds (Tmax = 100). In this case study, we provided two 1-robot scenarios, Nr = 1∗ and Nr = 1, by settingthe initial feasible direction (∆θ) at 0◦and 45◦, respectively, to demonstrate the sensitivity of single robot performance on the initial uninformed action.

0 0.02 0.04 0.06 0.08 0.1300

400

500

600

700

Com

plet

ion

Tim

e [s

]

(a) Case study 4: completion time

0 0.02 0.04 0.06 0.08 0.10

0.05

0.1

0.15

0.2

0.25

0.3

Map

ping

Err

or (

RM

SE)

(b) Case study 4: knowledge model accuracy

Fig. 6. Performance dynamics of a 10-robot team under different values of the exploitation/exploration balance coefficient (α), case study 4 (large arena,highly multi-modal signal distribution). For all runs, the maximum allowed search time is set at 700 seconds (Tmax = 700).

Page 8: Decentralized Informative Path Planning with Exploration ... · pected to provide greater explainability and ease of debugging any performance shortfalls. C. Objective of This Paper

robots are still exploring the search area. Depending on thecomplexity of the source signal distribution, the effect ofexploitation coefficient parameter on the estimation of theknowledge model will vary.

In terms of completion time, the complexity of the sourcesignal distribution and the initial path of robots play animportant role. In case study 2, the impact of α on completiontime varies with the size of the robot team (Fig. 5(a)). In casestudy 4, we can see from Fig. 6(a) that Bayes-Swarm withα > 0.04 is not able to lead the robots to find the target/sourcewithin the maximum allowed time (700 seconds). In orderto get the best performance, the exploitation coefficient (α)needs to be less than 0.02. This is attributed to the need forgreater exploration in a multimodal environment. In summary,for choosing the correct value of α to get the best performance,we need to consider the number of robots, the complexity ofthe source signal distributions, and the robots’ capabilities.

C. Study 2: Scalability Analysis of Bayes-Swarm

In this test, we use case study 4 to perform an analysisof how the size of the robot swarm impacts Bayes-Swarm’sperformance. To this end, we run Bayes-Swarm simulationswith α = 0.4 and swarm sizes varying from 2 to 100. Figure 7illustrates the results of this analysis in terms of the completiontime, averaged knowledge-gain of each robot (g(x)), averagednumber of decisions per robot (Nd) and mapping error. Theresults show that the performance improves by increasingthe size of the swarm from 2 to 100, with completion timereducing by ∼ 41.3%. Moreover, the averaged number ofdecisions (waypoint planning instances) per robot and theaveraged knowledge-gain per robot respectively decrease byabout 64% and 83.3% when the swarm size grows from 2 to100. Although the mapping error with 100 robots is 16.6% lessthan the mapping error with 2 robots, increasing the numberof robots does not universally improve the mapping error, asevident from the non-monotonic trend seen in the top rightplot of Fig. 7 (unless α is tuned based on the size of swarm).

To summarize the observations made from Fig. 7, increasingthe size of swarms become increasingly effective for complexsignal distribution environments. However, beyond a certainswarm size (∼20 in this analysis), there is a decreasing rateof improvement. These observations provide strong evidenceof the scalability of the Bayes-Swarm method. At the sametime, they highlight the importance of identifying suitable teamsizes for suitable mission profiles, given resource constraintsand time sensitivity of the mission.

D. Study 3: Comparative Analysis of Bayes-Swarm

As mentioned before, exhaustive search and random-walkalgorithms are implemented beside the Bayes-Swarm for com-parative analysis. We test these algorithms to find the sourcelocation in the four case studies, illustrated in Fig. 2. Thesettings of the Bayes-Swarm are not not individually tuned foreach case to allow fair comparison; the exploitation coefficient

TABLE IIIPERFORMANCE OF THE Bayes-Swarm, BASELINE, AND COMPETINGALGORITHMS ON FOUR TEST CASE STUDIES WITH 5 ROBOTS; THE

EXPLOITATION COEFFICIENT OF THE Bayes-Swarm IS SET AT 0.4 FOR ALLCASE STUDIES.

Case Study Algorithm Total Time ∗ [s] Success Rate

1Bayes-Swarm 246.1 1/1Random-Walk 20,394 1/5Exhaustive Search 22,174 1/1

2Bayes-Swarm 42.5 1/1Random-Walk 227.6 5/5Exhaustive Search 225.3 1/1

3Bayes-Swarm 260.1 1/1Random-Walk - 0/5Exhaustive Search 22,174 1/1

4Bayes-Swarm 373.2 1/1Random-Walk - 0/5Exhaustive Search 9,163 † 1/1

∗ As all random-walk runs are not able to find the source, we only reportthe total time of the best solution obtained using the random-walk.† For this case, we divide the search space into four equal quarters and eachrobot does an exhaustive search in each portion.

is set at 0.4 and T at 4 seconds. Table III summarizes theresults of this study in terms of the completion time. In thisstudy, the maximum allowed search time of the random-walksearch is adjusted to 1.5 times of what is needed by exhaustivesearch for each case study environment. In case study 4, wepartition the arena into 4 parts and each robot searches onepart using the exhaustive search method. Note that, in thistable, we only report the best performance across 5 runs ofthe random-walk method for each case.

The results show that the Bayes-Swarm performs signif-icantly better than exhaustive search and random-walk ap-proaches in all the four case studies. Due to complexity ofsome of the search environments, the random-walk methodoften fails to find the source location within the allowedmaximum search time, as evident from its poor success ratein Cases 1, 3 and 4. The table shows that Bayes-Swarm findsthe primary source location about 5 to 100 times faster thanthe exhaustive search in all four cases. As the random-walkreaches the goal only in the first two case studies, we compareBayes-Swarm with the random-walk method only in these casestudies; Bayes-Swarm is observed to perform 83 and 5 timesfaster than the random-walk method in case studies 1 and 2.

VI. CONCLUSION

In this paper, we proposed an asynchronous, decentralizedalgorithm to perform searching for the source of a spatiallydistributed signal in 2D arenas, using robot swarms. Thisalgorithm is founded on an extension of the batch Bayesiansearch method, with advancements made for application toembodied swarm systems. A new acquisition function isdesigned to be able to uniquely incorporate the following: 1)modeling knowledge gain over trajectories, as opposed to atpoints; 2) implicitly mitigating overlapping trajectories among

Page 9: Decentralized Informative Path Planning with Exploration ... · pected to provide greater explainability and ease of debugging any performance shortfalls. C. Objective of This Paper

0 20 40 60 80 100Number of Robots

300

350

400

450

500

550

Com

plet

ion

Tim

e [S

ec]

0 20 40 60 80 100Number of Robots

0.1

0.2

0.3

0.4

Map

ping

Err

or (

RM

SE)

0 20 40 60 80 100Number of Robots

1000

1500

2000

2500

3000

3500

4000

Avg

. # D

ecis

ions

/Rob

ot

0 20 40 60 80 100Number of Robots

0.1

0.2

0.3

0.4

Fig. 7. Scalability analysis of Bayes-Swarm with α = 0.4 and swarm sizes varying from 2 to 100, when applied to case study 4 environment.

robots to maximize unique knowledge gain; 3) incentivisingrobots to reach (closest to) the expectation of the source,while accounting for constraints on the robot’s motion and costincurred by it in reaching a candidate waypoint. A heuristic(weight coefficient, α) is currently used to balance the sourceseeking and knowledge gain components of the acquisitionfunction, and thus further parametric analyses is performedto understand the impact of this coefficient. It is found thatsuitable values of this parameter depends both on the size ofthe swarm and the complexity of the signal spatial distribution.An important direction of future research will be to build onthis understanding to formulate a situation-adaptive variation(instead of user prescription) of the weighting coefficient.

To evaluate and compare the performance of the proposedalgorithm, Bayes-Swarm, exhaustive search and random-walkbaselines are considered. These algorithms are tested on fourdistinct case studies, with varying arena size and complex-ity (non-convexity) of the spatial distribution of the signal.Performance is analyzed in terms of completion time andmapping error. Bayes-Swarm easily outperforms the exhaustivesearch and random-walk approaches by achieving up to 90times better values of completion time. Scalability of theBayes-Swarm is also analyzed, with significant performancegain (in terms of superlinear reduction in completion time)observed as the swarm size is changed from 2 to 20, andthen mostly saturating owing to the bounds on the size ofthe arena. It is important to note that increased swarm size(while beneficial to the mission) also increases the rate atwhich signal data is collected, thus increasing the onlinecomputational cost of updating the GP by every robot. Thus

future work will also look at approximate (downsampling-based) update approaches, in the cases of applications where100’s to 1000’s of robots are needed, or where longer missiontime periods are needed. This, along with the considerationof partial observability due to communication constraints andphysical demonstration, will allow us to more comprehensivelyexplore the scalability of the Bayes-Swarm algorithm.

REFERENCES

[1] Baetz, W., Kroll, A., and Bonow, G., 2009. “Mobile robots with activeir-optical sensing for remote gas detection and source localization”. In2009 IEEE International Conference on Robotics and Automation, IEEE,pp. 2773–2778.

[2] Nagatani, K., Kiribayashi, S., Okada, Y., Otake, K., Yoshida, K.,Tadokoro, S., Nishimura, T., Yoshida, T., Koyanagi, E., Fukushima,M., et al., 2013. “Emergency response to the nuclear accident at thefukushima daiichi nuclear power plants using mobile rescue robots”.Journal of Field Robotics, 30(1), pp. 44–63.

[3] Li, W., Farrell, J. A., Pang, S., and Arrieta, R. M., 2006. “Moth-inspiredchemical plume tracing on an autonomous underwater vehicle”. IEEETransactions on Robotics, 22(2), pp. 292–307.

[4] Song, D., Kim, C.-Y., and Yi, J., 2012. “Simultaneous localization ofmultiple unknown and transient radio sources using a mobile robot”.IEEE Transactions on Robotics, 28(3), pp. 668–680.

[5] Sugawara, K., Kazama, T., and Watanabe, T., 2004. “Foraging behaviorof interacting robots with virtual pheromone”. In 2004 IEEE/RSJ In-ternational Conference on Intelligent Robots and Systems (IROS)(IEEECat. No. 04CH37566), Vol. 3, IEEE, pp. 3074–3079.

[6] Senga, H., Kato, N., Ito, A., Niou, H., Yoshie, M., Fujita, I., Igarashi,K., and Okuyama, E., 2007. “Development of spilled oil trackingautonomous buoy system”. In OCEANS 2007, IEEE, pp. 1–10.

[7] Odonkor, P., Ball, Z., and Chowdhury, S., 2019. “Distributed operationof collaborating unmanned aerial vehicles for time-sensitive oil spillmapping”. Swarm and Evolutionary Computation.

Page 10: Decentralized Informative Path Planning with Exploration ... · pected to provide greater explainability and ease of debugging any performance shortfalls. C. Objective of This Paper

[8] De Silva, O., Mann, G. K., and Gosine, R. G., 2012. “Developmentof a relative localization scheme for ground-aerial multi-robot systems”.In Intelligent Robots and Systems (IROS), 2012 IEEE/RSJ InternationalConference on, IEEE, pp. 870–875.

[9] Ghassemi, P., and Chowdhury, S., 2018. “Decentralized task alloca-tion in multi-robot systems via bipartite graph matching augmentedwith fuzzy clustering”. In ASME 2018 International Design En-gineering Technical Conferences and Computers and Information inEngineering Conference, American Society of Mechanical Engineers,pp. V02AT03A014–V02AT03A014.

[10] Pugh, J., and Martinoli, A., 2007. “Inspiring and modeling multi-robot search with particle swarm optimization”. In Swarm IntelligenceSymposium, 2007. SIS 2007. IEEE, IEEE, pp. 332–339.

[11] Kalmar-Nagy, T., Giardini, G., and Bak, B. D., 2017. “The multiagentplanning problem”. Complexity, 2017.

[12] Benkoski, S. J., Monticino, M. G., and Weisinger, J. R., 1991. “A surveyof the search theory literature”. Naval Research Logistics (NRL), 38(4),pp. 469–494.

[13] Tan, Y., and Zheng, Z.-y., 2013. “Research advance in swarm robotics”.Defence Technology, 9(1), pp. 18–39.

[14] Beard, R. W., and McLain, T. W., 2003. “Multiple uav cooperativesearch under collision avoidance and limited range communicationconstraints”. In Decision and Control, 2003. Proceedings. 42nd IEEEConference on, Vol. 1, IEEE, pp. 25–30.

[15] Flint, M., Fernandez-Gaucherand, E., and Polycarpou, M., 2003. “Co-operative control for uav’s searching risky environments for targets”. InDecision and Control, 2003. Proceedings. 42nd IEEE Conference on,Vol. 4, IEEE, pp. 3567–3572.

[16] Vincent, P., and Rubin, I., 2004. “A framework and analysis forcooperative search using uav swarms”. In Proceedings of the 2004ACM symposium on Applied computing, ACM, pp. 79–86.

[17] Cortes, J., Martinez, S., Karatas, T., and Bullo, F., 2004. “Coveragecontrol for mobile sensing networks”. IEEE Transactions on roboticsand Automation, 20(2), pp. 243–255.

[18] Rajnarayan, D. G., and Ghose, D., 2003. “Multiple agent team theoreticdecision-making for searching unknown environments”. In Decision andControl, 2003. Proceedings. 42nd IEEE Conference on, Vol. 3, IEEE,pp. 2543–2548.

[19] Sujit, P., and Ghose, D., 2009. “Negotiation schemes for multi-agentcooperative search”. Proceedings of the Institution of MechanicalEngineers, Part G: Journal of Aerospace Engineering, 223(6), pp. 791–813.

[20] Kennedy, J., 2010. “Particle swarm optimization”. Encyclopedia ofmachine learning, pp. 760–766.

[21] Krishnanand, K., and Ghose, D., 2009. “Glowworm swarm optimisation:a new method for optimising multi-modal functions”. InternationalJournal of Computational Intelligence Studies, 1(1), pp. 93–119.

[22] Senanayake, M., Senthooran, I., Barca, J. C., Chung, H., Kamruzzaman,J., and Murshed, M., 2016. “Search and tracking algorithms for swarmsof robots: A survey”. Robotics and Autonomous Systems, 75, pp. 422–434.

[23] Dhameliya, M., Sher, S., and Chowdhury, S., 2018. “Prototypingand simulated analysis of autonomous swarm-bots”. In ASME 2018International Design Engineering Technical Conferences and Comput-ers and Information in Engineering Conference, American Society ofMechanical Engineers, pp. V05AT07A079–V05AT07A079.

[24] Chowdhury, S., Tong, W., Messac, A., and Zhang, J., 2013. “A mixed-discrete particle swarm optimization algorithm with explicit diversity-preservation”. Structural and Multidisciplinary Optimization, 47(3),pp. 367–388.

[25] Jatmiko, W., Sekiyama, K., and Fukuda, T., 2006. “A pso-based mobilesensor network for odor source localization in dynamic environment:Theory, simulation and measurement”. In 2006 IEEE InternationalConference on Evolutionary Computation, IEEE, pp. 1036–1043.

[26] Brambilla, M., Ferrante, E., Birattari, M., and Dorigo, M., 2013. “Swarmrobotics: a review from the swarm engineering perspective”. SwarmIntelligence, 7(1), pp. 1–41.

[27] McGill, K., and Taylor, S., 2009. “Comparing swarm algorithms forlarge scale multi-source localization”. In 2009 IEEE InternationalConference on Technologies for Practical Robot Applications, IEEE,pp. 48–54.

[28] Krishnanand, K., Amruth, P., Guruprasad, M., Bidargaddi, S. V., andGhose, D., 2006. “Glowworm-inspired robot swarm for simultaneoustaxis towards multiple radiation sources”. In Proceedings 2006 IEEEInternational Conference on Robotics and Automation, 2006. ICRA2006., IEEE, pp. 958–963.

[29] Kolling, A., Walker, P., Chakraborty, N., Sycara, K., and Lewis, M.,2016. “Human interaction with robot swarms: A survey”. IEEETransactions on Human-Machine Systems, 46(1), pp. 9–26.

[30] Rasmussen, C. E., 2003. “Gaussian processes in machine learning”. InSummer School on Machine Learning, Springer, pp. 63–71.

[31] Snoek, J., Larochelle, H., and Adams, R. P., 2012. “Practical bayesianoptimization of machine learning algorithms”. In Advances in neuralinformation processing systems, pp. 2951–2959.

[32] Li, M., Lu, K., Zhu, H., Chen, M., Mao, S., and Prabhakaran, B., 2008.“Robot swarm communication networks: architectures, protocols, andapplications”. In 2008 Third International Conference on Communica-tions and Networking in China, IEEE, pp. 162–166.

[33] Mondada, F., Bonani, M., Raemy, X., Pugh, J., Cianci, C., Klaptocz,A., Magnenat, S., Zufferey, J.-C., Floreano, D., and Martinoli, A.,2009. “The e-puck, a robot designed for education in engineering”.In Proceedings of the 9th conference on autonomous robot systems andcompetitions, Vol. 1, Castelo Branco, Portugal, pp. 59–65.


Recommended