# Robust Formation Control for Multiple Underwater Vehicles

^{1}School of Mechanical Engineering, National Technical University of Athens, Athens, Greece^{2}University of Thessaly, Lamia, Greece

This paper addresses the distance-based formation control problem for multiple Autonomous Underwater Vehicles (AUVs) in a leader-follower architecture. The leading AUV is assigned a task to track a desired trajectory and the following AUVs try to set up a predefined formation structure by attaining specific distances among their neighboring AUVs, while avoiding collisions and enabling at the same time relative localization. More specifically, a decentralized control protocol of minimal complexity is proposed that achieves prescribed, arbitrarily fast and accurate formation establishment. The control signal of each vehicle is calculated based on the relative position of its neighbors and its own velocity only, which can be easily acquired by the onboard sensors without necessitating for explicit network communication. Finally, a realistic simulation study with five AUVs performing seabed scanning was conducted to clarify the approach and verify the theoretical findings of this work.

## 1. Introduction

The use of autonomous underwater vehicles has steadily grown during the last 20 years. Several activities related to the offshore industry, such as surveillance and inspection of underwater facilities, oceanography, seabed map building, search and rescue, marine resource exploitation and so on, have been enabled by underwater robotic vehicles (Griffiths, 2002; Fossen, 2011; Zeng et al., 2015). However, most of the aforementioned applications are complex, time critical and may impose high level requirements in terms of accuracy, dexterity as well as time of completion. Thus, such strict specifications are almost impossible to be satisfied using a stand-alone vehicle. Moreover, single vehicle operation increases significantly the risk of mission failure due to sensor or actuator faults.

As an alternative solution, the deployment of multiple underwater vehicles in various formation schemes has emerged (see Figure 1). In this way, significant mission characteristics, such as completion time, fault tolerance, cognition and perception of the augmented system are positively affected. Numerous applications can benefit from the use of multiple underwater vehicles. An indicative example is the speed up process of map building for an environmental quantity (e.g., temperature, salinity) via en-route sampling of the water column (Caiti et al., 2007). Moreover, Simultaneous Localization and Mapping (SLAM) can be significantly improved, in terms of accuracy and speed, employing multiple underwater vehicles with complementary sensing and actuation capabilities (Walter and Leonard, 2004). Similarly, significantly better results can be accomplished in area patrolling for security or search and rescue purposes, where a usually large area should be thoroughly examined with increased confidence level (Kemp et al., 2004).

**Figure 1**. Examples of multiple underwater vehicles in cooperative missions. **(A)** Multiple vehicles cooperation for intervention tasks. **(B)** Multiple vehicles formation for surveillance tasks.

Another key feature of multi-agent systems is the upgrade of persistent autonomy via fault tolerance (Longhi et al., 2008). In most cases, AUVs are deployed for long periods of time (e.g., days or weeks) and their recovery in case of sensor or actuation faults is a costly and time consuming process. A proper formation re-planning can ensure the mission progress by allocating the faulty agents in non-critical but still important tasks. For example, in a surveillance and map building application, an agent with a faulty Multi-Beam Imaging Sonar (MBIS) can be excluded from the perception process, but still can act as a communication relay among the rest of the agents and the support vessel, by exploiting its acoustic communication equipment.

## 2. Related Work

Formation control, one of the most significant missions in underwater multi-agent systems, is a cooperative task in which multiple AUVs are deployed to achieve a specific geometric structure and move coordinately, so that a global mission is satisfied. Particularly in *leader-follower formation tracking*, a leading AUV aims at following a given trajectory that is defined by the mission goal and represents the required dynamic behavior of the group, while the followers are responsible for maintaining a desired formation, based on information related to their neighboring vehicles and the leader (Aguiar et al., 2007; Cui et al., 2008, 2012; Wang et al., 2009; Zhou et al., 2012a; Ma and Zeng, 2015). Alternatively, in *formation coordinated control* (Zhang and Qi, 2013; Zhao et al., 2016), the problem of steering a group of AUVs along certain paths and maintaining a desired rigid formation is tackled, while requesting limited communication among the agents. The dynamics of each AUV is considered known and is compensated by each controller locally whereas the coordination is achieved by adopting a distributed control law with limited information exchange among the vehicles (Ghabcheloo et al., 2006, 2009; Xiang et al., 2010). In *synchronized path following control* (Fan et al., 2010; Qi, 2014), the control protocols are decomposed in two modules that: (i) steer individually each AUV to trace predefined paths, and (ii) ensure that tracked paths are synchronized by distributed flocking under the constraints of multi-agent communication topology.

*Non-linear formation-keeping control* protocols for multiple AUVs have been proposed in Borhaug et al. (2007), Yang and Gu (2007), Cui et al. (2010), and Park (2015), where the formation is defined by the desired position and orientation of each follower with respect to its leader. Furthermore, finite-time consensus algorithms were proposed for both leaderless and leader-follower underwater multi-agent systems in Li and Wang (2013). Particularly in the leader-follower case, a distributed finite-time observer was developed to estimate the leader's velocity. Alternatively, *range-based formation control* was studied in Atta and Subudhi (2013) and Soares et al. (2013), where only range information with respect to the leader was incorporated in the control scheme. Similarly, in *hierarchical control* (Edwards et al., 2004; Ihue et al., 2004; Zhou et al., 2012b; Rout and Subudhi, 2016) the AUVs are equipped with heading detectors to achieve accurate relative localization. The leader is assigned a trajectory and is responsible for path tracking, maneuvering and guiding tasks, whereas the followers measure their distances and/or bearings to a set of neighboring agents to maintain the shape of a desired formation by keeping certain fixed distances. Finally, in a *passivity-based coordination* framework (Ihle et al., 2007; Jung et al., 2009; Wang et al., 2012), the desired formation patterns are obtained when the reference velocity assigned by a dynamic virtual leader is available to a subgroup of the AUVs.

Despite the recent progress in marine technology, the most significant challenge in underwater cooperation is imposed by the strict communication constraints, owing to the limited bandwidth and update rate of underwater acoustic devices. Furthermore, as the number of cooperating vehicles increases, communication protocols require complex design to deal with the crowded bandwidth (Stilwell and Bishop, 2000). Therefore, the number of underwater robots involved in cooperative schemes is strictly limited. Unfortunately, the majority of the aforementioned works in formation control necessitate for explicit communication among neighboring vehicles; thus suffering from the severe communication constraints that prohibit their implementation in real underwater missions. Contrary to the current state of the art, the proposed cooperative control protocol is purely decentralized and requires no underlying communication network to operate^{1}. In particular, we propose a distance-based formation control protocol for a group of multiple AUVs in a leader-follower architecture, where the leader is assigned a task to track a desired trajectory and the followers try to establish a predefined formation structure by attaining specific distances among their neighboring AUVs, while avoiding collisions and enabling at the same time relative localization. The main contributions of this work can be summarized as follows.

1. *Decentralized Design:* The proposed design process is decentralized in the sense that each vehicle requires the relative position of its neighbors and its own velocity only, which can be easily acquired by the onboard sensors without necessitating for network communication.

2. *Reduced Complexity:* The proposed decentralized protocol requires simple calculations to output the control signal, thus it can be easily implemented on the embedded control systems of AUVs, and does not incorporate any prior knowledge of either the external disturbances or the vehicles' dynamic model parameters. Furthermore, no estimation has been employed to acquire such knowledge. Finally, the control protocol is independent of the global coordinate frame and does not require all local coordinate frames of the vehicles to be aligned.

3. *Robustness:* The actual transient and steady state response as well as the collision avoidance and relative localization specifications are determined a priori by the appropriate selection of certain performance functions and are isolated by the control gains selection (i.e., simple design) as well as the model uncertainties, extending thus greatly the robustness of the closed loop system.

The rest of the manuscript is organized as follows: section 3 introduces the problem, describes the system model and reviews preliminary results in rigid graphs. The control protocol along with the stability analysis are presented in section 4. Section 5 validates our approach via a simulated paradigm. Finally, section 6 concludes the paper and discusses future research directions.

## 3. Preliminaries

This section describes the dynamic model of the AUVs and introduces a rigorous formulation of the distance based formation control problem that will be tackled herein.

### 3.1. Vehicle Modeling

Let us define a body-fixed frame ${{B}}_{i}=\left\{{e}_{x},{e}_{y},{e}_{z}\right\}$ attached to the *i*-th vehicle's center of mass, as shown in Figure 2, and an inertial frame ${I}=\left\{{e}_{F},{e}_{R},{e}_{D}\right\}$ located at a fix position ${O}_{{I}}$ within the workspace. Moreover, assume that the vehicles behave as rigid bodies, the Earth rotation is negligible and the hydrodynamic coefficients remain constant. Thus, following standard modeling techniques (Fossen, 2011), the dynamic model of the vehicle in the body-fixed frame may be derived from the general Newton-Euler motion equations of a 6-DoFs rigid body subject to external forces and torques in a fluid medium, as follows:

where:

• ${\eta}_{i}\triangleq {\left[{\text{p}}_{i}^{T},{\text{q}}_{i}^{T}\right]}^{T}\in {\Re}^{6}$ is the pose vector expressed in ${I}$, that involves the position (i.e., ${\text{p}}_{i}\triangleq {\left[{x}_{i},{y}_{i},{z}_{i}\right]}^{T}$) and orientation (i.e., ${\text{q}}_{i}\triangleq {\left[{\varphi}_{i},{\theta}_{i},{\psi}_{i}\right]}^{T}$) vectors;

• ${\nu}_{i}\triangleq {\left[{\text{v}}_{i}^{T},{\text{w}}_{i}^{T}\right]}^{T}\in {\Re}^{6}$ is the velocity vector expressed in ${{B}}_{i}$, that involves the linear (i.e., ${\text{v}}_{i}\triangleq {\left[{u}_{i},{v}_{i},{w}_{i}\right]}^{T}$) and angular (i.e., ${\text{w}}_{i}\triangleq {\left[{p}_{i},{q}_{i},{r}_{i}\right]}^{T}$) velocity vectors;

• ${\tau}_{{E}_{i}}\in {\Re}^{6}$ is the total environmental force/torque vector expressed in ${{B}}_{i}$, that is applied on the vehicle;

• ${\tau}_{i}\triangleq {\left[{\tau}_{{u}_{i}},{\tau}_{{v}_{i}},{\tau}_{{w}_{i}},{\tau}_{{p}_{i}},{\tau}_{{q}_{i}},{\tau}_{{r}_{i}}\right]}^{T}\in {\Re}^{6}$ is the total propulsion vector (i.e., the body forces τ_{ui}, τ_{vi}, τ_{wi} and torques τ_{pi}, τ_{qi}, τ_{ri} generated by the actuators) applied on the vehicle and expressed in ${{B}}_{i}$;

• **M**_{i} ≜ **M**_{RBi} + **M**_{Ai}, where ${\text{M}}_{R{B}_{i}}\in {\Re}^{6\times 6}$ and ${\text{M}}_{{A}_{i}}\in {\Re}^{6\times 6}$ are the rigid body and added mass inertia matrices, respectively;

• **C**_{i}(ν_{i}) ≜ **C**_{RBi}(ν_{i}) + **C**_{Ai}(ν_{i}) , where ${\text{C}}_{R{B}_{i}}\left({\nu}_{i}\right)\in {\Re}^{6\times 6}$ and ${\text{C}}_{{A}_{i}}\left({\nu}_{i}\right)\in {\Re}^{6\times 6}$ are the rigid body and added mass matrices that model the Coriolis and centrifugal effects, respectively;

• **D**_{i}(ν_{i}) ≜ **D**_{qi}(ν_{i}) + **D**_{li}, where ${\text{D}}_{{q}_{i}}\left({\nu}_{i}\right)\in {\Re}^{6\times 6}$ and ${\text{D}}_{{l}_{i}}\in {\Re}^{6\times 6}$ denote the quadratic and linear drag matrices, respectively;

• ${\text{g}}_{i}\left({\eta}_{i}\right)\in {\Re}^{6}$ is the gravity and hydrostatic restoring force vector;

• ${\text{J}}_{i}\left({\eta}_{i}\right)\triangleq \left[\begin{array}{cc}{\text{J}}_{i}^{\text{v}}\left({\text{q}}_{i}\right)& {0}_{3\times 3}\\ {0}_{3\times 3}& {\text{J}}_{i}^{\text{w}}\left({\text{q}}_{i}\right)\end{array}\right]$ is the Jacobian matrix transforming the velocities from the body-fixed frame ${{B}}_{i}$ to the inertial frame ${I}$, in which ${\text{J}}_{i}^{\text{v}}\left({\text{q}}_{i}\right)\in SO\left(3\right)$ stands for the rotation matrix and ${\text{J}}_{i}^{\text{w}}\left({\text{q}}_{i}\right)\in {\Re}^{3\times 3}$ denotes the lumped transformation matrix (Fossen, 2011).

### 3.2. Coordination of Multiple AUVs

This work examines the coordination problem of *N* + 1 AUVs under a leader-follower architecture. The leader (indexed by 0) is assigned a desired trajectory (e.g., an exploratory task) for the multi-agent system and the *N* followers update their state using locally available feedback, which corresponds to measurements of the inter-agent distances/headings, i.e., we consider the *distance-based formation* control problem (Oh et al., 2015). Thus, each agent interacts with its neighbors in order to complete the assigned task. Herein, the interaction of the agents is modeled by undirected graphs. More specifically, we consider an undirected graph with *l* edges and *N* + 1 vertices (corresponding to the *N* + 1 AUVs of the multi-agent system), denoted by ${G}\triangleq \left({V},{E}\right)$ where ${V}=\left\{0,1,\dots ,N\right\}$ is the set of vertices and ${E}\subset {V}\times {V}$ is the set of edges. The set of neighbors of the *i*-th AUV is defined as:

Moreover, ${\text{p}}_{i}\in {\Re}^{3},i=0,1,\dots ,N$ denotes the position of each AUV and the overall vector $\stackrel{\u0304}{\text{p}}\triangleq \text{col}\left({\text{p}}_{i}\right)\in {\Re}^{3\left(N+1\right)}$ represents the realization of ${G}$ in ℜ^{3}. The pair ${F}\triangleq \left({G},\stackrel{\u0304}{\text{p}}\right)$ is said to be a *framework* of ${G}$. Since the sequence of edges in ${E}$ is arbitrary, an edge function (rigidity function) ${\Phi}_{{G}}:{\Re}^{3\left(N+1\right)}\to {R}^{l}$ associated with ${F}$ may be given as :

**Definition 1**. *The framework ${F}=\left({G},\stackrel{\u0304}{\text{p}}\right)$ is rigid at $\stackrel{\u0304}{\text{p}}\in {\Re}^{3\left(N+1\right)}$ there exists a neighborhood ${U}_{\stackrel{\u0304}{\text{p}}}$ of $\stackrel{\u0304}{\text{p}}$ such that ${\Phi}_{{G}}^{-1}\left({\Phi}_{{G}}\left(\stackrel{\u0304}{\text{p}}\right)\right)\cap {U}_{\stackrel{\u0304}{\text{p}}}={\Phi}_{{H}}^{-1}\left({\Phi}_{{H}}\left(\stackrel{\u0304}{\text{p}}\right)\right)\cap {U}_{\stackrel{\u0304}{\text{p}}}$, where ${H}$ denotes the complete graph with N* + 1 *vertices and ${\Phi}_{\star}^{-1}$ denotes the set of all points $\stackrel{\u0304}{\text{q}}\in {\Re}^{3\left(N+1\right)}$ satisfying ${\Phi}_{\star}\left(\stackrel{\u0304}{\text{p}}\right)={\Phi}_{\star}\left(\stackrel{\u0304}{\text{q}}\right)$ for any graph ⋆*.

This definition implies that in a rigid framework, keeping the edge length and at the same time moving one or a set of vertices of the graph does not affect the distances between the other vertices. Moreover, we define the *rigidity matrix* *R*:ℜ^{3(N + 1)} → ℜ^{l × 3(N + 1)} of ${F}=\left({G},\left(\stackrel{\u0304}{\text{p}}\right)\right)$ as:

Hence, given a sequence of edges in ${E}$, each row of the rigidity matrix $R\left(\stackrel{\u0304}{\text{p}}\right)$ takes the following form:

Clearly, the rigidity matrix depends only on the relative positions, so it can be written as $R\left(\stackrel{~}{\text{p}}\right)$ where $\stackrel{~}{\text{p}}=\text{col}\left({\stackrel{~}{\text{p}}}_{ij}\right)\in {\Re}^{3l}$ in which ${\stackrel{~}{\text{p}}}_{ij}={\text{p}}_{i}-{\text{p}}_{j},\left(i,j\right)\in {E}$.

**Definition 2**. *A framework ${F}=\left({G},\left(\stackrel{\u0304}{\text{p}}\right)\right)$ with N + 1 vertices is infinitesimally rigid in* ℜ

^{3}

*if:*

It follows from the aforementioned definition that ${F}=\left({G},\stackrel{\u0304}{\text{p}}\right)$ is infinitesimally rigid in ℜ^{3} if the corresponding graph has at least 3(*N* + 1) − 6 edges, i.e., $\left|{E}\right|\ge 3\left(N+1\right)-6$.

**Definition 3**. *A rigid framework is said to be minimally rigid if no edge can be removed without causing the graph to lose its rigidity. In* ℜ^{3} *a rigid framework $\left({G},\left(\stackrel{\u0304}{\text{p}}\right)\right)$ is minimally rigid if $\left|{E}\right|=3\left(N+1\right)-6$*.

If a framework is infinitesimally rigid and its underlying graph has exactly 3(*N* + 1) − 6 edges, then it is called a *minimally and infinitesimally rigid* framework. If ${\Phi}_{{G}}\left(\stackrel{\u0304}{\text{p}}\right)={\Phi}_{{G}}\left({\stackrel{\u0304}{\text{p}}}^{\star}\right)$ applies to frameworks $\left({G},\stackrel{\u0304}{\text{p}}\right)$ and $\left({G},{\stackrel{\u0304}{\text{p}}}^{\star}\right)$, these frameworks are said to be *equivalent*. Furthermore, if $\parallel {\text{p}}_{i}-{\text{p}}_{j}\parallel =\parallel {\text{p}}_{i}^{\star}-{\text{p}}_{j}^{\star}\parallel $ for $\forall i,j\in {V},$ then the two frameworks are *consistent*. Two infinitesimally rigid frameworks $\left({G},\stackrel{\u0304}{\text{p}}\right)$ and $\left({G},{\stackrel{\u0304}{\text{p}}}^{\star}\right)$ are said to be *congruent* if they are equivalent but not consistent. Finally, the set $\text{Iso}\left({F}\right)$ denotes all isometric frameworks of ${F}$ (i.e., all rotated, translated and reflected implementations).

**Lemma 1**. *(Cai and De Queiroz, 2015) We consider two frameworks ${F}=\left({G},\stackrel{\u0304}{\text{p}}\right)$ and ${{F}}^{*}=\left({G},{\stackrel{\u0304}{\text{p}}}^{*}\right)$ which share the same graph ${G}=\left({V},{E}\right).$ If ${{F}}^{*}$ is infinitesimally rigid and $\text{dist}\left(\stackrel{\u0304}{\text{p}};\text{Iso}\left({{F}}^{*}\right)\right)\le \u03f5$ where ϵ is a sufficient small positive constant, then ${F}$ is also infinitesimally rigid*.

**Lemma 2**. *(Cai and De Queiroz, 2015) If the framework ${F}=\left({G},\stackrel{\u0304}{\text{p}}\right)$ is minimally and infinitesimally rigid, then the matrix $R\left(\stackrel{\u0304}{\text{p}}\right)R{\left(\stackrel{\u0304}{\text{p}}\right)}^{T}$ is positive definite*.

**Remark 1**. *It should be noted that similar to the aforementioned results hold on* ℜ^{2} *for a planar motion as well, e.g., a minimally and infinitesimally rigid framework with N* + 1 *vertices in* ℜ^{2} *has exactly* 2(*N* + 1) − 3 *edges (Cai and De Queiroz, 2015). Figure 3 illustrates the aforementioned concepts on* ℜ^{2}.

**Figure 3**. Several frameworks on ℜ^{2}: **(A)** a non-rigid framework; **(B)** a minimally and infinitesimally rigid framework; **(C)** an equivalent but not consistent framework to **(B)**.

### 3.3. Problem Formulation

In the leader-follower architecture that is adopted in this work, there is one global plan, i.e., a reference trajectory **p**_{d} (*t*) assigned only to the leader and several inter-agent distance specifications ${d}_{ij}^{\star}$, $\left(i,j\right)\in {E}$ to be satisfied in order to attain the desired formation. Therefore, under the assumption that the initial framework $\left({G},\text{p}\left(0\right)\right)$ is minimally and infinitesimally rigid, we need to design decentralized control protocols to establish the desired formation and track the reference trajectory of the leader. Moreover, the only information employed in the control scheme should be acquired exclusively from the local navigation module of each vehicle and the distance/heading measurements among neighboring AUVs (i.e., no inter-agent communication is available).

**Remark 2**. *Under the assumption that the vehicle dynamics is fully actuated, the proposed control scheme shall output only forces expressed on the body frame of each vehicle. On the other hand, the rotational dynamics can be easily stabilized independently owing to their inherent passivity properties. Nevertheless, for a more energy efficient approach, the yaw motion can be controlled such that the longitudinal axis of the vehicles is aligned with the velocity vector that will be calculated by the proposed distance based control protocol, to reduce the hydrodynamic drag. Unfortunately, underwater vehicles that are unactuated in their translational motion, e.g., torpedo like vehicles where the sway and the heave DoFs are unactuated or vehicles with differential thrust configuration for which the sway motion is unactuated, are left open for future investigation owing to their inherent design complexity*.

## 4. Decentralized Control

Let us define the distance errors for each edge of the rigid graph, as:

A critical issue that has to be considered in multi-agent systems concerns collision avoidance among interacting agents. In this respect, the distance of the agents should be kept greater than a safety zone __d__$<{d}_{ij}^{\star}$ to avoid collisions. Similarly, since the sensing devices have limited capabilities, it is also critical to retain neighboring agents close enough so that relative localization is available. Hence, the distance of the agents should be kept less than a sensing radius $\stackrel{\u0304}{d}>{d}_{ij}^{\star}$ to secure the connectivity of the multi-agent system. Apparently, under the assumption that the initial condition satisfies the aforementioned collision avoidance and connectivity maintenance specifications, the control objective is to design a decentralized control protocol such that:

for all *t* ≥ 0, where __ρ___{ij}*(t)*, ${\stackrel{\u0304}{\rho}}_{ij}\left(t\right)$ denote strictly positive and decreasing performance functions (Bechlioulis and Rovithakis, 2008) that satisfy $\underset{t\to \infty}{lim}{\underset{\_}{\rho}}_{ij}\left(t\right)\triangleq {\underset{\_}{\rho}}_{ij}^{\infty}>0$ and $\underset{t\to \infty}{lim}{\stackrel{\u0304}{\rho}}_{ij}\left(t\right)\triangleq {\stackrel{\u0304}{\rho}}_{ij}^{\infty}>0$, respectively. Notice that if we select ${\underset{\_}{\rho}}_{ij}\left(0\right)={d}_{ij}^{\star}-\underset{\_}{d}$ and ${\stackrel{\u0304}{\rho}}_{ij}\left(0\right)=\stackrel{\u0304}{d}-{d}_{ij}^{\star}$, then satisfying (4) for all time guarantees collision avoidance and connectivity maintenance owing to the decreasing property of the performance functions ${\underset{\_}{\rho}}_{ij}\left(t\right),\text{}{\stackrel{\u0304}{\rho}}_{ij}\left(t\right)$. Moreover, selecting appropriately the decreasing rate and the steady state value of the performance functions ${\underset{\_}{\rho}}_{ij}\left(t\right),\text{}{\stackrel{\u0304}{\rho}}_{ij}\left(t\right)$ enforces transient and steady state performance specifications on the corresponding distance errors *e*_{ij}(*t*). For instance, we could adopt exponentially decaying performance functions of the form ${\underset{\_}{\rho}}_{ij}\left(t\right)=\left({d}_{ij}^{\star}-\underset{\_}{d}-{\rho}_{\infty}\right)exp\left(-\lambda t\right)+{\rho}_{\infty}$ and ${\stackrel{\u0304}{\rho}}_{ij}\left(t\right)=\left(\underset{\_}{d}-{d}_{ij}^{\star}-{\rho}_{\infty}\right)exp\left(-\lambda t\right)+{\rho}_{\infty}$, where λ and ρ_{∞} correspond to the decaying rate and the maximum error at the steady state, respectively.

**Remark 3**. *Distance based formation control, which has been extensively studied recently [for more details refer to the survey paper by Oh et al. (2015)], employs typically gradient based control laws, derived from quadratic potential functions of the distance errors, to establish the desired formation. Apparently, a similar to (3) rigidity matrix emerges during the calculation of the gradient, which verifies the resemblance with our approach. Nevertheless, notice that in our case, we extend the current state of the art by guaranteeing further predefined transient and steady state performance specifications, which also ensure collision avoidance and connectivity maintenance (i.e., relative localization), both of which are of utmost importance for the safe operation of the multi-agent system*.

### 4.1. Control Design

The proposed control protocol is first derived at the kinematic level assuming that the control signals are the linear body velocities. Subsequently, the kinematic controller is extended to the dynamic model, considering the actual control input signals, i.e., body forces. Hence, given a smooth and bounded desired trajectory ${\text{p}}_{d}\left(t\right)={\left[{x}_{d}\left(t\right),{y}_{d}\left(t\right),{z}_{d}\left(t\right)\right]}^{T}$ with bounded time derivatives, a priori known only to the leader, and any initial configuration close to the desired formation, that satisfies the collision avoidance and connectivity maintenance specifications, the control design proceeds as follows:

**Step 1:** Select the performance functions ${\underset{\_}{\rho}}_{ij}\left(t\right),\text{}{\stackrel{\u0304}{\rho}}_{ij}\left(t\right),\text{}\forall \left(i,j\right)\in {E}$ as:

to incorporate via the appropriate selection of ρ_{∞} and λ the desired performance specifications regarding the steady state error and the speed of convergence.

**Step 2:** Design the following velocity profile expressed in the inertial frame:

where *R* ∈ ℜ^{l × 3(N + 1)} denotes the rigidity matrix defined in (3), ${I}_{L}\triangleq {\left[{\text{I}}_{3\times 3},{0}_{3\times 3},\dots ,{0}_{3\times 3}\right]}^{T}\in {\Re}^{3\left(N+1\right)\times 3}$, *E* is the vector of modulated errors defined as:

and Ξ_{E} denotes the diagonal matrix of the derivatives of the modulated errors with respect to the actual distance errors:

**Step 3:** Express the aforementioned velocity profile in the body frame of each vehicle as:

where ${J}_{\text{v}}\triangleq \text{blockdiag}({J}_{i}^{\text{v}}{({q}_{i})}_{i=0,1,\dots ,N})\in {\Re}^{3\left(N+1\right)\times 3\left(N+1\right)}$.

**Step 4:** Define the velocity errors at the body frame:

and select the corresponding, exponential decaying, velocity performance functions ${\rho}_{{\text{v}}_{i}}\left(t\right)\triangleq {\left[{\rho}_{{\text{v}}_{i}}^{u}\left(t\right),{\rho}_{{\text{v}}_{i}}^{v}\left(t\right),{\rho}_{{\text{v}}_{i}}^{w}\left(t\right)\right]}^{T}$ such that $\left|{\stackrel{~}{\text{v}}}_{i}^{u}\left(0\right)\right|<{\rho}_{{\text{v}}_{i}}^{u}\left(0\right)$, $\left|{\stackrel{~}{\text{v}}}_{i}^{v}\left(0\right)\right|<{\rho}_{{\text{v}}_{i}}^{v}\left(0\right)$, $\left|{\stackrel{~}{\text{v}}}_{i}^{w}\left(0\right)\right|<{\rho}_{{\text{v}}_{i}}^{w}\left(0\right)$ and $\underset{t\to \infty}{lim}{\rho}_{{\text{v}}_{i}}^{u}\left(t\right)\triangleq {\rho}_{{\text{v}}_{i}}^{u\infty}>0$, $\underset{t\to \infty}{lim}{\rho}_{{\text{v}}_{i}}^{v}\left(t\right)\triangleq {\rho}_{{\text{v}}_{i}}^{v\infty}>0$, $\underset{t\to \infty}{lim}{\rho}_{{\text{v}}_{i}}^{w}\left(t\right)\triangleq {\rho}_{{\text{v}}_{i}}^{w\infty}>0$, *i* = 0, 1, …, *N*.

**Step 5:** Finally, design the control law:

where *E*_{vi} denotes the vector of modulated velocity errors defined as:

and Ξ_{Evi} is the diagonal matrix of the derivatives of the modulated velocity errors with respect to the actual velocity errors:

**Remark 4**. *Based on the assumption that the initial configuration of the multi-agent system meets the collision avoidance and connectivity maintenance specifications, the proposed error transformation (see Step 2 and 5 of the aforementioned design process) guarantees that the boundedness of the modulated errors is simply sufficient to establish the control objective via (4). Notice that the logarithmic functions that are adopted to modulate the distance and velocity errors operate similarly to the barrier functions in constrained optimization, admitting high values when the control objectives tend to be violated; eventually preventing the distance and velocity errors from reaching the corresponding performance bounds. Consequently, collision avoidance and connectivity maintenance is secured analytically via the appropriate selection of the distance error performance bounds*.

**Remark 5**. *The aforementioned design process is decentralized in the sense that each vehicle requires the relative position of its neighbors and its own velocity only, which can be easily acquired by the onboard sensors without necessitating for network communication. Hence, the control protocol is independent of the global coordinate frame and does not require the local coordinate frames of all vehicles to be aligned*.

**Remark 6**. *The transient and steady state response as well as the collision avoidance and connectivity maintenance specifications are encapsulated in the proposed control protocol via the appropriate selection of the performance functions ${\rho}_{ij}\left(t\right),\text{}\forall \left(i,j\right)\in {E}$. In addition, the velocity performance functions ρ*_{vi}(*t*), *i* = 0, 1, …, *N impose prescribed performance on the body velocity errors ${\stackrel{~}{\text{v}}}_{i},i=0,1,\dots ,N$. However, it should be stressed that although such performance specifications are not required, their selection (the only hard constraint attached to their definition is related to their initial value, see Step 4) affects the evolution of the distance errors within the corresponding performance envelopes. Similarly, the selection of the control gains k_{E}, k_{V} affects the control input characteristics as well. Decreasing the gain values leads to increased oscillatory behavior within the performance envelopes, which can be suppressed when adopting higher gain values enlarging however the control effort both in magnitude and rate. Apparently, fine tuning might be needed during real-time implementation to meet certain input constraints that affect severely the AUVs dynamics*.

### 4.2. Stability Analysis

The following theorem summarizes the main results of this work.

**Theorem 1**. *Consider a group of N* + 1 *AUVs obeying the dynamics (1), at an initial minimally and infinitesimally rigid configuration. The decentralized control protocol proposed in subsection 4.1 guarantees that the leader tracks the reference trajectory and the desired formation is attained with prescribed transient and steady state performance, while avoiding inter-agent collisions and connectivity breaks*.

*Proof*. The proof proceeds similarly to Bechlioulis et al. (2018), thus a brief sketch will be given herein. Particularly, based on Theorem 54 (pp. 476) in Sontag (1998) and given that the initial distance and velocity errors satisfy by construction $-{\underset{\_}{\rho}}_{ij}\left(0\right)<{e}_{ij}\left(0\right)<{\stackrel{\u0304}{\rho}}_{ij}\left(0\right),\text{}\forall j\in {{N}}_{i}$ and $\left|{\stackrel{~}{\text{v}}}_{i}^{u}\left(0\right)\right|<{\rho}_{{\text{v}}_{i}}^{u}\left(0\right)$, $\left|{\stackrel{~}{\text{v}}}_{i}^{v}\left(0\right)\right|<{\rho}_{{\text{v}}_{i}}^{v}\left(0\right)$, $\left|{\stackrel{~}{\text{v}}}_{i}^{w}\left(0\right)\right|<{\rho}_{{\text{v}}_{i}}^{w}\left(0\right)$, respectively for all *i* = 0, 1, …, *N* as well as that certain continuity and integrability conditions of the closed loop system are upheld, there exists a maximal interval [0, τ_{f}) with ${\tau}_{f}\in \left\{{\Re}_{+}^{*},\infty \right\}$, on which $-{\underset{\_}{\rho}}_{ij}\left(t\right)<{e}_{ij}\left(t\right)<{\stackrel{\u0304}{\rho}}_{ij}\left(t\right),\text{}\forall j\in {{N}}_{i}$ and $\left|{\stackrel{~}{\text{v}}}_{i}^{u}\left(t\right)\right|<{\rho}_{{\text{v}}_{i}}^{u}\left(t\right)$, $\left|{\stackrel{~}{\text{v}}}_{i}^{v}\left(t\right)\right|<{\rho}_{{\text{v}}_{i}}^{v}\left(t\right)$, $\left|{\stackrel{~}{\text{v}}}_{i}^{w}\left(t\right)\right|<{\rho}_{{\text{v}}_{i}}^{w}\left(t\right)$, respectively, for all *i* = 0, 1, …, *N* and all *t* ∈ [0, τ_{f}). Therefore, the modulated distance and velocity error vectors *E* and *E*_{vi}, *i* = 0, 1, …, *N* are well-defined for all *t* ∈ [0, τ_{f}). Subsequently, let us assume that τ_{f} ≠ ∞ (otherwise the problem would be trivially solved, since the inequalities would hold for all time). In the sequel, following standard Lyapunov arguments, we shall prove that, for all *t* ∈ [0, τ_{f}), the distance and velocity errors will evolve strictly within the corresponding upper and lower bounds dictated by the performance functions irrespectively of τ_{f}. Thus, invoking Proposition C.3.6 (pp. 481) in Sontag (1998), it can be proved by contradiction that τ_{f} = ∞.

Hence, consider a candidate Lyapunov function of the modulated distance errors *E* as follows:

Differentiating with respect to time, we obtain:

Employing the fact that $\frac{\partial E}{\partial {e}_{ij}}\triangleq {\Xi}_{E}$, $\frac{\partial E}{\partial {\stackrel{\u0304}{\rho}}_{ij}}\triangleq {\Xi}_{E}{\Xi}_{{\stackrel{\u0304}{\rho}}_{ij}}$, $\frac{\partial E}{\partial {\underset{\_}{\rho}}_{ij}}\triangleq {\Xi}_{E}{\Xi}_{{\underset{\_}{\rho}}_{ij}}$ for some bounded diagonal matrices Ξ_{ρij}, ${\Xi}_{{\stackrel{\u0304}{\rho}}_{ij}}$ and **col**(ė_{ij}(*t*)) = *RJ*_{v}**v**, where *R* denotes the rigidity matrix and $\text{v}\triangleq {\left[{\text{v}}_{0}^{T},{\text{v}}_{1}^{T},\dots ,{\text{v}}_{N}^{T}\right]}^{T}$ is the overall vector of the body velocities of the AUVs, and adding and subtracting the term ${E}^{T}{\Xi}_{E}R{\text{v}}_{I}$, we arrive at:

where $\stackrel{~}{\text{v}}\triangleq {\left[{\stackrel{~}{\text{v}}}_{0}^{T},{\stackrel{~}{\text{v}}}_{1}^{T},\dots ,{\stackrel{~}{\text{v}}}_{N}^{T}\right]}^{T}$. Substituting the control signal (10) and utilizing the fact that ${\stackrel{~}{\text{v}}}_{i}=\text{diag}\left({\rho}_{{\text{v}}_{i}}\left(t\right)\right)\text{tanh}\left({E}_{{\text{v}}_{i}}\right)$, where *E*_{vi} denote the modulated velocity errors, we obtain:

It should be noted that: (a) the rigidity matrix *R* is bounded by definition since it is formed by normalized vectors as in (4), (b) the Jacobian matrix is bounded by definition as it involves only sinusoidal terms, (c) the performance functions are bounded by construction, (d) the hyperbolic tangent function is bounded, (e) the reference trajectory of the leader is assumed bounded with bounded derivatives and (f) the derivative of the performance functions are bounded by construction. Therefore, there exists an upper bound of the right parenthesis in the second term, which is independent of τ_{f}. Hence, invoking the positive definiteness of the square matrix *RR*^{T} by Lemma 2, it is easy to deduce the existence of a positive constant Ē, which depends of the aforementioned upper bound, such that $\stackrel{\bullet}{V}\le 0$ for all ||*E*|| ≥ Ē. Thus, employing the Uniform Ultimate Boundedness Theorem (see Theorem 4.18 in Khalil, 2001), we derive the boundedness of all elements of the modulated error vector *E* as defined in (11), from which it is straightforward to deduce that (4) is strictly satisfied for all *t* ∈ [0, τ_{f}) (see Remark 4). Moreover, since *E* was proven bounded then the velocity profiles **v**_{I} and consequently **v**_{d} and its derivative remain bounded as well. Similarly, invoking the aforementioned boundedness properties and observing the proportional and derivative terms of the leader's control law in (10), we also establish accurate tracking of the reference trajectory by the leader for all *t* ∈ [0, τ_{f}) and for a sufficiently high gain *k*_{P}. Finally, what remains to be proved is that $\left|{\stackrel{~}{\text{v}}}_{i}^{u}\left(t\right)\right|<{\rho}_{{\text{v}}_{i}}^{u}\left(t\right)$, $\left|{\stackrel{~}{\text{v}}}_{i}^{v}\left(t\right)\right|<{\rho}_{{\text{v}}_{i}}^{v}\left(t\right)$, $\left|{\stackrel{~}{\text{v}}}_{i}^{w}\left(t\right)\right|<{\rho}_{{\text{v}}_{i}}^{w}\left(t\right)$ are strictly satisfied for all *i* = 0, 1, …, *N* and all *t* ∈ [0, τ_{f}). Hence, we follow the aforementioned line of proof for the velocity modulated errors *E*_{vi}, 0, 1, …, *N* by adopting the Lyapunov candidate function ${V}_{{\text{v}}_{i}}=\frac{1}{2}{E}_{{\text{v}}_{i}}^{T}{E}_{{\text{v}}_{i}}$ for each agent. Therefore, differentiating with respect to time and substituting the control law (15) and the AUV dynamics (1) (only the translational dynamics), we obtain:

Similarly to the previous step, notice that all terms in the right parenthesis are bounded by construction or by assumption; hence invoking the positive definiteness of the inertia matrix **M**_{i}, it is easy to conclude the boundedness of all elements of the modulated velocity errors *E*_{vi}, from which it is straightforward to deduce that $\left|{\stackrel{~}{\text{v}}}_{i}^{u}\left(t\right)\right|<{\rho}_{{\text{v}}_{i}}^{u}\left(t\right)$, $\left|{\stackrel{~}{\text{v}}}_{i}^{v}\left(t\right)\right|<{\rho}_{{\text{v}}_{i}}^{v}\left(t\right)$, $\left|{\stackrel{~}{\text{v}}}_{i}^{w}\left(t\right)\right|<{\rho}_{{\text{v}}_{i}}^{w}\left(t\right)$ are strictly satisfied for all *i* = 0, 1, …, *N* and all *t* ∈ [0, τ_{f}). Moreover, since *E*_{vi} was proven bounded then the control signals τ_{ui}, τ_{vi} and τ_{wi} remain bounded, which completes the proof.

**Remark 7**. *The proposed control protocol achieves its goals without resorting to the need of rendering the ultimate bounds of the modulated distance and velocity errors E, E*

_{vi}

*arbitrarily small by adopting extreme values of the control gains*

*k*_{P},*k*_{E}, and*k*_{V}. In the same spirit, large model uncertainty and external disturbances involved in the vehicle non-linear model (1) can be compensated, as they affect only the size of the ultimate bound of*E*, E_{vi},

*but leave unaltered the achieved stability properties. Since we do not consider input constraints in this work, notice that no matter how large the model uncertainty is [i.e., how large the ultimate bound of the modulated errors*

*E*, E_{vi},

*extracted by (21) and (22), is] the actual performance given in (4), which is solely determined by the designer-specified performance functions $-{\underset{\_}{\rho}}_{ij}\left(t\right),\text{}{\stackrel{\u0304}{\rho}}_{ij}\left(t\right),\text{}\forall j\in {{N}}_{i}$, is isolated by the model uncertainties, thus extending greatly the robustness of the proposed control scheme*.

## 5. Simulation Results

We consider a leader-follower scheme composed of five identical underwater robotic vehicles. The model that was used for simulation is a 4 DoFs Seabotix LBV (LBV150, 2006), actuated in surge, sway, heave and yaw via a 4 thruster set configuration (the motion in roll and pitch has been neglected as both DoFs are passive and affect minimally the others). The main inertial and hydrodynamic parameters of Seabotix LBV150 are given in Table 1, as they were identified in Karras et al. (2018). The simulation framework was implemented in the Robot Operating System (ROS, 2009) using UWSim (Prats et al., 2012).

The task of scanning the sea-bed was assigned to the multi-agent system. The scan was performed according to a pattern, used by divers for object recovery, called “compass box search pattern” (see Figure 4). The aforementioned scanning trajectory that is expressed in the world frame is assigned exclusively to the leader, which acquires its absolute position with respect to the world frame via a USBL system. On the contrary, the followers are not required to have an absolute positioning system since their actual velocity command is directly calculated at their body fixed frames, since only relative distances and bearings among neighboring agents are employed. Moreover, a squared formation of edge 1 m (see Figure 5) was chosen with the leader (agent 0) positioned at the center and four other equidistant agents (agents 1–4) around it. It should be noted that the desired formation specifications were defined on the *x* − *y* plane, where the proposed scheme was applied (the orientation of the vehicles was controlled such that their longitudinal axis is aligned with the velocity vector that was calculated by the proposed distance based control scheme). Notice further that the aforementioned framework is minimally and infinitesimally rigid since the underlying graph ${G}=\left(\left\{0,1,2,3,4\right\},\left\{\left(0,1\right),\left(0,2\right),\left(0,3\right),\left(1,2\right),\left(1,4\right),\left(2,3\right),\left(3,4\right)\right\}\right)$ has exactly *l* = 2 × 5 − 3 = 7 edges (see Remark 1). On the other hand, the depth was stabilized close to 10 m by an independent fixed-gain PID controller. To make the simulation more realistic, ocean currents with slowly varying direction of speed within 0.1–0.3 m/s were considered. Finally, the cruising speed of the desired trajectory that mimics the “compass box search” was 0.5 m/s.

The collision avoidance and connectivity specifications were selected as: (a) sensing range $\stackrel{\u0304}{d}=4$ m and (b) safety distance __ d__ = 0.4 m. Moreover, it was requested to establish the formation with minimum convergence speed $exp\left(-\frac{t}{5}\right)$ and retain it with maximum steady state error 0.1 m (i.e., the errors should reach close to zero with a slight deviation within 25 s). Hence, exponential performance functions were selected as in (8) and (9) to incorporate the aforementioned performance specifications. Similar performance functions were adopted for the velocity errors as well. Finally, the control gains were chosen as

*k*

_{E}= 1,

*k*

_{P}= 5,

*k*

_{V}= 100.

The simulation results of the aforementioned study are illustrated below. The evolution of the sea-bed scanning, which is displayed in the Supplementary Video, is also depicted in Figure 6 for six consecutive time instants. Figures 7–11 illustrate the distance errors of each agent with respect to its neighbors. Notice that the inter-agent distance errors are kept <0.1 m, as determined by the selected performance functions. Similarly, Figures 12–14 depict the velocity of the agents expressed in X, Y, and Z axes of the global frame along with the desired velocity profile. Finally, the control input signals are depicted in Figure 15. Apparently, the whole formation follows the desired motion profile with fine accuracy (reasonable spikes appear at the corners of the motion profile). As it was predicted in the analysis, the formation control problem was safely tackled with predefined performance specifications and bounded signals, despite the external disturbances.

## 6. Discussion and Conclusions

This paper proposed a solution to the formation control problem for multiple AUVs in a leader-follower architecture. The derived control protocol guarantees formation establishment with prescribed transient and steady state performance while avoiding collisions and connectivity breaks and despite the presence of external disturbances and dynamic model uncertainty. Moreover, no explicit communication among the fleet is needed. Furthermore, for each AUV the control signal is calculated based only on the relative position of the neighboring vehicles and its own velocity, which both can be easily acquired by the onboard sensors. Additionally, the proposed decentralized control protocol is of low complexity. Finally, realistic simulation results clarified and verified the proposed approach.

Future research directions will be devoted toward studying the effect of: (i) underactuated translational dynamics (i.e., AUVs unactuated in the sway or heave degrees of freedom), (ii) input uncertainties (i.e., mapping uncertainties between desired body forces/torques and actuator commands) and constraints (e.g., the thruster limitations) as well as (iii) sensor filtering (underwater relative localization is plagued with noise, intermittent failures and latency) on the closed loop stability, in order to increase the applicability of the proposed control methodology in open sea scenarios. Extra attention should also be pledged on studying how the achieved transient and steady state performance specifications could encapsulate further configuration constraints that may arise owing to extra sector-based (not only range-based) limited capabilities of the on board sensors (e.g., the limited field of view of cameras or sonars) adopted to acquire relative localization. Finally, the increasingly challenging mission scenarios in the field of marine robotics, call for inexpensive and robust control solutions for obstacle avoidance.

## Author Contributions

CB took over the technical writing of the manuscript. FG and GK conducted the simulation study. Finally, KK supervised the work.

## Conflict of Interest

The authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.

## Supplementary Material

The Supplementary Material for this article can be found online at: https://www.frontiersin.org/articles/10.3389/frobt.2019.00090/full#supplementary-material

**Supplementary Video.** Scanning the seabed via the compass box search pattern.

## Footnotes

1. ^Although underwater robots are equipped with acoustic modems to communicate with the surface control station, avoiding the use of intense explicit inter-robot communication is clearly motivated by the limited bandwidth of underwater acoustic devices and issues related to time delays and packet drops, which are critical in such communication medium.

## References

Aguiar, A., Ghabcheloo, R., Pascoal, A., and Silvestre, C. (2007). “Coordinated path-following control of multiple autonomous underwater vehicles,” in *Proceedings of the International Offshore and Polar Engineering Conference* (Lisbon), 1073–1079.

Atta, D., and Subudhi, B. (2013). Decentralized formation control of multiple autonomous underwater vehicles. *Int. J. Robot. Autom.* 28, 303–310. doi: 10.1109/OCEANS.2018.8604743

Bechlioulis, C. P., Demetriou, M. A., and Kyriakopoulos, K. J. (2018). A distributed control and parameter estimation protocol with prescribed performance for homogeneous lagrangian multi-agent systems. *Auton. Robots* 42, 1525–1541. doi: 10.1007/s10514-018-9700-2

Bechlioulis, C. P., and Rovithakis, G. A. (2008). Robust adaptive control of feedback linearizable mimo nonlinear systems with prescribed performance. *IEEE Trans. Autom. Control* 53, 2090–2099. doi: 10.1109/TAC.2008.929402

Borhaug, E., Pavlov, A., and Pettersen, K. Y. (2007). “Straight line path following for formations of underactuated underwater vehicles,” in *Proceedings of the IEEE Conference on Decision and Control* (New Orleans, LA), 1905–1912.

Cai, X., and De Queiroz, M. (2015). Formation maneuvering and target interception for multi-agent systems via rigid graphs. *Asian J. Control* 17, 1174–1186. doi: 10.1002/asjc.1044

Caiti, A., Munaf, A., and Viviani, R. (2007). Adaptive on-line planning of environmental sampling missions with a team of cooperating autonomous underwater vehicles. *Int. J. Control* 80, 1151–1168. doi: 10.1080/00207170701230973

Cui, R., Ge, S., Voon Ee How, B., and Sang Choo, Y. (2010). Leader-follower formation control of underactuated autonomous underwater vehicles. *Ocean Eng.* 37, 1491–1502.

Cui, R., Xu, D., and Yan, W. (2008). “Formation control of autonomous underwater vehicles under fixed topology,” in *2007 IEEE International Conference on Control and Automation, ICCA* (Guangzhou), 2913–2918.

Cui, R. X., Yan, W. S., and Xu, D. M. (2012). Synchronization of multiple autonomous underwater vehicles without velocity measurements. *Sci. China Inform. Sci.* 55, 1693–1703. doi: 10.1016/j.oceaneng.2010.07.006

Edwards, D. B., Bean, T. A., Odell, D. L., and Anderson, M. J. (2004). “A leader-follower algorithm for multiple auv formations,” in *2004 IEEE/OES Autonomous Underwater Vehicles* (Sebasco, ME), 40–46.

Fan, S., Feng, Z., and Lian, L. (2010). “Collision free formation control for multiple autonomous underwater vehicles,” in *OCEANS'10 IEEE Sydney, OCEANSSYD 2010* (Sydney, NSW), 1–4.

Fossen, T. (2011). *Handbook of Marine Craft Hydrodynamics and Motion Control*. West Sussex: John Wiley & Sons.

Ghabcheloo, R., Aguiar, A., Pascoal, A., Silvestre, C., Kaminer, I., and Hespanha, J. (2006). “Coordinated path-following control of multiple underactuated autonomous vehicles in the presence of communication failures,” in *Proceedings of the IEEE Conference on Decision and Control* (San Diego, CA), 4345–4350.

Ghabcheloo, R., Aguiar, A., Pascoal, A., Silvestre, C., Kaminer, I., and Hespanha, J. (2009). Coordinated path-following in the presence of communication losses and time delays. *SIAM J. Control Optim.* 48, 234–265. doi: 10.1137/060678993

Griffiths, G. (2002). *Technology and Applications of Autonomous Underwater Vehicles*. London: Ocean Science and Technology; CRC Press.

Ihle, I. F., Arcak, M., and Fossen, T. I. (2007). Passivity-based designs for synchronized path-following. *Automatica* 43, 1508–1518. doi: 10.1109/CDC.2006.377782

Ihue, I. F., Skjetne, R., and Fossen, T. I. (2004). “Nonlinear formation control of marine craft with experimental results,” in *Proceedings of the IEEE Conference on Decision and Control, Vol. 1* (Nassau), 680–685.

Jung, Y., Lee, K., Lee, S., Choi, M. H., and Lee, B. (2009). An efficient underwater coverage method for multi-auv with sea current disturbances. *Int. J. Control Autom. Syst.* 7, 615–629. doi: 10.1007/s12555-009-0412-4

Karras, G. C., Marantos, P., Bechlioulis, C. P., and Kyriakopoulos, K. J. (2018). Unsupervised online system identification for underwater robotic vehicles. *IEEE J. Ocean. Eng.* 44, 642–663. doi: 10.1109/JOE.2018.2827678

Kemp, M., Bertozzi, A. L., and Marthaler, D. (2004). “Multi-uuv perimeter surveillance,” in *2004 IEEE/OES Autonomous Underwater Vehicles* (Sebasco, ME), 102–107.

LBV150 (2006). *Seabotix lbv150*. Available online at: http://www.teledynemarine.com/lbv150-4/?BrandID=19

Li, S., and Wang, X. (2013). Finite-time consensus and collision avoidance control algorithms for multiple AUVs. *Automatica* 49, 3359–3367. doi: 10.1016/j.automatica.2013.08.003

Longhi, S., Monteriù, A., and Vaccarini, M. (2008). “Cooperative control of underwater glider fleets by fault tolerant decentralized MPC,” in *IFAC Proceedings Volumes (IFAC-PapersOnline), Vol. 17* (Seoul), 1–6.

Ma, C., and Zeng, Q. (2015). Distributed formation control of 6-DOF autonomous underwater vehicles networked by sampled-data information under directed topology. *Neurocomputing* 154, 33–40. doi: 10.1016/j.neucom.2014.12.022

Oh, K. K., Park, M. C., and Ahn, H. S. (2015). A survey of multi-agent formation control. *Automatica* 53, 424–440. doi: 10.1016/j.automatica.2014.10.022

Park, B. S. (2015). Adaptive formation control of underactuated autonomous underwater vehicles. *Ocean Eng.* 96, 1–7. doi: 10.1016/j.oceaneng.2014.12.016

Prats, M., Perez, J., Fernandez, J. J., and Sanz, P. J. (2012). “An open source tool for simulation and supervision of underwater intervention missions,” in *IEEE International Conference on Intelligent Robots and Systems* (Vilamoura), 2577–2582.

Qi, X. (2014). Adaptive coordinated tracking control of multiple autonomous underwater vehicles. *Ocean Eng.* 91, 84–90. doi: 10.1016/j.oceaneng.2014.08.019

ROS (2009). *Robot Operating System*. Available online at: http://www.ros.org/

Rout, R., and Subudhi, B. (2016). A backstepping approach for the formation control of multiple autonomous underwater vehicles using a leader-follower strategy. *J. Mar. Eng. Technol.* 15, 38–46. doi: 10.1080/20464177.2016.1173268

Soares, J., Aguiar, A., Pascoal, A., and Martinoli, A. (2013). “Joint asv/auv range-based formation control: theory and experimental results,” in *Proceedings–IEEE International Conference on Robotics and Automation* (Karlsruhe), 5579–5585.

Stilwell, D. J., and Bishop, B. E. (2000). “Framework for decentralized control of autonomous vehicles,” in *Proceedings–IEEE International Conference on Robotics and Automation, Vol. 3* (San Francisco, CA), 2358–2363.

Walter, M., and Leonard, J. (2004). An experimental investigation of cooperative slam. *IFAC Proc. Vol.* 37, 880–885. doi: 10.1016/S1474-6670(17)32091-8

Wang, Y., Yan, W., and Li, J. (2012). Passivity-based formation control of autonomous underwater vehicles. *IET Control Theory Appl.* 6, 518–525. doi: 10.1049/iet-cta.2011.0354

Wang, Y., Yan, W., and Yan, W. (2009). “A leader-follower formation control strategy for AUVs based on line-of-sight guidance,” in *2009 IEEE International Conference on Mechatronics and Automation, ICMA 2009* (Changchun), 4863–4867.

Xiang, X., Jouvencel, B., and Parodi, O. (2010). Coordinated formation control of multiple autonomous underwater vehicles for pipeline inspection. *Int. J. Adv. Robot. Syst.* 7, 75–84. doi: 10.5772/7242

Yang, E., and Gu, D. (2007). Nonlinear formation-keeping and mooring control of multiple autonomous underwater vehicles. *IEEE/ASME Trans. Mech.* 12, 164–178. doi: 10.1109/TMECH.2007.892826

Zeng, Z., Lian, L., Sammut, K., He, F., Tang, Y., and Lammas, A. (2015). A survey on path planning for persistent autonomy of autonomous underwater vehicles. *Ocean Eng.* 110, 303–313. doi: 10.1016/j.oceaneng.2015.10.007

Zhang, L., and Qi, X. (2013). “Muti-auv's formation coordinated control in the presence of communication losses,” in *Chinese Control Conference, CCC* (Xi'an), 3089–3094.

Zhao, R., Xiang, X., Yu, C., and Jiang, Z. (2016). “Coordinated formation control of autonomous underwater vehicles based on leader-follower strategy,” in *OCEANS 2016 MTS/IEEE Monterey, OCE 2016* (Monterey, CA), 1–5.

Zhou, Z., Yuan, J., Zhang, W., Zhao, H., and Zhao, J. (2012b). Formation control based on a virtual-leader-follower hierarchical structure for autonomous underwater vehicles. *Int. J. Adv. Comput. Technol.* 4, 111–121. doi: 10.4156/ijact.vol4.issue2.15

Keywords: autonomous underwater vehicles, multi-agent systems, distance-based formation, prescribed performance control, decentralized control

Citation: Bechlioulis CP, Giagkas F, Karras GC and Kyriakopoulos KJ (2019) Robust Formation Control for Multiple Underwater Vehicles. *Front. Robot. AI* 6:90. doi: 10.3389/frobt.2019.00090

Received: 20 December 2018; Accepted: 06 September 2019;

Published: 24 September 2019.

Edited by:

Ioannis Rekleitis, University of South Carolina, United StatesReviewed by:

Jawhar Ghommam, École de Technologie Supérieure (ÉTS), CanadaDongbin (Don) Lee, Oregon Institute of Technology, United States

Copyright © 2019 Bechlioulis, Giagkas, Karras and Kyriakopoulos. This is an open-access article distributed under the terms of the Creative Commons Attribution License (CC BY). The use, distribution or reproduction in other forums is permitted, provided the original author(s) and the copyright owner(s) are credited and that the original publication in this journal is cited, in accordance with accepted academic practice. No use, distribution or reproduction is permitted which does not comply with these terms.

*Correspondence: Charalampos P. Bechlioulis, chmpechl@mail.ntua.gr