Skip to main content
Sensors (Basel, Switzerland) logoLink to Sensors (Basel, Switzerland)
. 2018 Feb 23;18(2):662. doi: 10.3390/s18020662

Leader-Follower Formation Control of UUVs with Model Uncertainties, Current Disturbances, and Unstable Communication

Zheping Yan 1, Da Xu 1, Tao Chen 1,*, Wei Zhang 1, Yibo Liu 1
PMCID: PMC5855002  PMID: 29473919

Abstract

Unmanned underwater vehicles (UUVs) have rapidly developed as mobile sensor networks recently in the investigation, survey, and exploration of the underwater environment. The goal of this paper is to develop a practical and efficient formation control method to improve work efficiency of multi-UUV sensor networks. Distributed leader-follower formation controllers are designed based on a state feedback and consensus algorithm. Considering that each vehicle is subject to model uncertainties and current disturbances, a second-order integral UUV model with a nonlinear function is established using the state feedback linearized method under current disturbances. For unstable communication among UUVs, communication failure and acoustic link noise interference are considered. Two-layer random switching communication topologies are proposed to solve the problem of communication failure. For acoustic link noise interference, accurate representation of valid communication information and noise stripping when designing controllers is necessary. Effective communication topology weights are designed to represent the validity of communication information interfered by noise. Utilizing state feedback and noise stripping, sufficient conditions for design formation controllers are proposed to ensure UUV formation achieves consensus under model uncertainties, current disturbances, and unstable communication. The stability of formation controllers is proven by the Lyapunov-Razumikhin theorem, and the validity is verified by simulation results.

Keywords: multi-UUV sensor networks, leader-follower formation control, model uncertainties, current disturbances, unstable communication

1. Introduction

In recent years, underwater mobile sensor networks have been rapidly developed and widely used in marine science and engineering fields. Compared with traditional static sensor networks, the underwater mobile sensor networks [1] can realize dynamic, large-scale sensing and operation at a lower cost. Due to the autonomous properties [2], multi-UUV, regarded as intelligent and reconfigurable underwater mobile sensor networks [3,4], have found an increasingly wide utilization for combined investigation, cooperative survey, and coordinated exploration [5]. Usually, multi-UUV sensor networks adopt a formation mode when sailing and working, which are propitious to information interaction and cooperative operation between UUVs. Thus, good formation control [6] is necessary and important for improving operation efficiency and reducing energy consumption of multi-UUVs.

There are four main methods for formation control [7], such as behavioral, virtual structure, queues and artificial potential trenches, and leader–follower approaches. For this paper, the leader–follower approach is adopted to realize formation control of multi-UUVs. In recent years, a great deal of attention has been focused on leader–follower formation control to keep multi-UUVs in a desired formation configuration and, at the same time, to complete the assigned tasks. Edwards [8] proposed a method that the leader navigates the mission waypoints and each follower maintains its place in formation using the position of the leader via an exogenous system with knowledge of the internal positions of all UUVs. In [9], the follower controller is designed by back-stepping and an approximate-based control method to track a reference trajectory based on the leader position and predetermined formation without the need for the leader’s velocity and dynamics. Bikramaditya [10] addresses the leader–follower formation control of multiple non-holonomic UUVs for the area coverage problem, based on a planned path by an optimization algorithm for the formation leader motion, and a designed communication strategy so that the UUVs can exchange information to obtain the designated waypoints that are sent from the leader. Therefore, one significant advantage of the leader–follower approach is that the reference trajectory is clearly defined by the leader and the internal formation stability is induced by the control laws of individual vehicles.

In general, the objective of coordinated formation control is to seek collaborative policies such that each UUV uses only limited local information to reach an overall goal in the ocean investigation, survey and exploration mission. This means that controllers of the leader-follower UUV formation should be designed to achieve consensus in complicated environments [11]. In recent years, considerable research efforts have been made on consensus [12,13,14]. A sufficient condition was derived to achieve multi-agent systems’ consensus in the case where the network is jointly connected frequently enough as the network evolves with time [15]. Second-order consensus in a multi-agent dynamical system with sampled data was studied by proposing a necessary and sufficient condition in [16,17]. Finite-time position consensus and collision avoidance problems are investigated for multi-UUV systems, which guarantee collision avoidance, connectivity maintenance, velocity matching, and consensus boundedness [18]. In fact, the particular underwater environment poses great disturbances on the formation control of multiple UUV system [19,20]. The controllers for multi-UUV should be designed for safety and robustness, especially in the presence of large model uncertainty and ocean current disturbances [21,22].

As is well known, in the difficult underwater communication environment, most communication systems on land cannot be applied in the design of UUVs, and the exchange of information between UUVs can only pass through limited underwater acoustic links which is characterized by low stability. In fact, how to design the formation control scheme while taking into account the practical means of communication for a multi-UUV system is a great challenge and has not been fully studied. In recent years, there are many studies regarding the narrow band and time delay of the acoustic communication of multiple UUVs [23,24], but fewer studies regarding the communication failures which have a serious impact on the stability of communications. Due to the link failure, which is a temporary disruption in an acoustic link caused by the complex underwater environment, the communication topology of multi-UUVs may fail to remain constant, but dynamically change over time. Moreover, the underwater acoustic links are seriously influenced by marine background noises. Thus, how to obtain valid communication information is very important for the UUV formation control.

Motivated by the above discussion, a formation control algorithm which can make the multiple UUV system achieve consensus is developed. The main contributions of this paper can be summarized as follows: First of all, a leader-follower UUV formation control approach is designed based on state feedback and consensus algorithm. To design the controller, the coupled mathematical model of the UUV is simplified and rewritten into a linearization model by state feedback linearization. Considering model uncertainties and current disturbances, a second-order integral UUV model with nonlinear function and current disturbances is established. Secondly, for unstable communication among UUVs, communication failure and acoustic link noise interference are considered. Two-layer random switching topologies, which are used to deliver position and velocity information, respectively, are adopted to improve the efficiency of communication and solve the problem of communication failure. For the acoustic link noise interference, the concept of communication topology effective weight is used to represent the validity of communication information interfered by noise in the acoustic link, and obtain the effective weights of position and velocity topologies, respectively. Finally, by stripping noise disturbances, sufficient conditions to design distributed controllers are proposed to ensure the UUV formation can achieve consensus under model uncertainties, current disturbances, and unstable communication. The stability of the leader-follower formation control is proven by using the Lyapunov-Razumikhin theorem.

The rest of this paper is organized as follows: Section 2 is the problem statement. In Section 3, the second-order integral UUV model with nonlinear function and current disturbances is built by state feedback. In Section 4, the leader-follower UUV formation controllers are designed by the state feedback and consensus algorithm under unstable communication. Section 5 presents the simulation results. Section 6 is the discussion of those results. Finally, Section 7 offers the conclusion.

2. Problem Statement

2.1. Multi-UUV Sensor Networks

The novel key feature of underwater sensor networks are multi-UUV sensor networks. Let UUV act as an intelligent sensing and operating node, and then the reconfigurable underwater mobile sensor networks are built for ocean investigation, survey, and exploration missions (Figure 1). In this paper, each UUV is equipped with one or more ocean survey sensors. The ocean survey sensors include: (1) an upward-looking ADCP (Acoustic Doppler Current Profiler) with a maximum range of 100 m; (2) a CTD (Conductivity Temperature Depth) sensor can continuously measure water conductivity, temperature, and depth; (3) side-scan sonar (SSS) creates an image of the sea floor topography for searching and detecting objects. The sonar is a dual frequency type that projects acoustic waves at 120 and 410 KHz at the central frequency; and (4) multi-beam echo sounder (MBS) observes bathymetry for mapping the seafloor terrain. Usually, multi-UUV sensor networks adopt a formation mode when sailing and working. Aiming to improve the work efficiency and reduce the energy consumption of multi-UUV sensor networks, the mission planning, navigation and location, and control of multi-UUVs are necessary. This paper mainly researches the leader-follower formation control method so that these UUVs can form an intelligent network achieving high performance with significant features of scalability, robustness, and reliability. The leader tracks a reference trajectory, and UUVs keep in a formation which is designed for specific tasks and mission areas.

Figure 1.

Figure 1

The multi-UUV sensor network.

The application area of the method and algorithm developed in this paper is mainly for ocean investigation, survey, and exploration missions using a middle-number-scale multi-UUV sensor network. Here, the middle-number-scale means that the multi-UUV system has no more than 10 UUVs, and, in order to realize formation sailing and operation, the multi-UUV system must have acoustic networking communication capabilities with a frequency range of 8–16 kHz. In addition, for obtaining better communication interaction and collaborative control, the formation spacing between every two UUVs is limited to 30–100 m.

2.2. Model Uncertainties, Current Disturbances, and Unstable Communication

The particular underwater environment poses great influences on the stability of leader-follower UUV formation control, which is shown in Figure 2. The distributed formation controllers are designed based on state feedback and consensus algorithm in this paper. To design the controller, the coupled mathematical model of the UUV should be simplified into a second-order integral model by state feedback linearization. However, each vehicle is subject to model uncertainties and current disturbances, as the underwater movement of UUV is a complex space motion. The model uncertainties include time-varying parameters and additional nonlinear parts. Thus, the model of the UUV is divided into an approximate linear part and a nonlinear uncertain part in Section 3. A second-order integral UUV model with nonlinear function and current disturbances is established.

Figure 2.

Figure 2

Model uncertainties, current disturbances, and unstable communication for UUV formation.

The state information between UUVs is transmitted through underwater acoustic links. There are many factors affecting the acoustic communication, and this paper mainly researches communication failures and acoustic link noise interference. The communication failure, data not available from the collaborative UUVs during certain periods of time, seriously limits information exchanges. Two-layer random switching topologies are adopted to solve the problem of communication failure. The topologies can dynamically change to maintain formation communication. In addition, the acoustic communication information may be disturbed by noises in the process from sender to receiver. How to accurately represent valid communication information and strip noise out of state information is researched.

2.3. Graph Theory

The communication relationship of all UUVs is G(V,ε,A), where V={1,2,,n} is n UUVs nodes set, εV×V is edge set representing all communication links in formation, An×n is the adjacency matrix. The neighbor set of node i is denoted as Ni={jV|(j,i)ε}. The Laplacian matrix L=[lij]n×n associated with A is defined as L=DA. D=diag{d1,d2,,dn} is defined as the in-degree matrix.

The communication topologies of the whole UUV formation include two parts. One communication topology is among n followers, the other is between the leader and all followers. Considering the limitation of acoustic link bandwidth, communication links among all UUV members are divided into position information links and velocity information links. Thus, the communication topologies are divided into position topology G¯p(V¯p,ε¯p,A¯p) and velocity topology G¯v(V¯v,ε¯v,A¯v).

Let Gp(Vp,εp,Ap) and Gv(Vv,εv,Av) be the position and velocity topologies among n followers. In G¯p(V¯p,ε¯p,A¯p), make V¯p=VpVl, ε¯p=εpεl, where Vl denotes the leader node, εl is the communication link between the leader and the followers. G¯v(V¯v,ε¯v,A¯v) is the same definition. The Laplacian matrix of G¯p(V¯p,ε¯p,A¯p) is Lp+Lc, and the Laplacian matrix of G¯v(V¯v,ε¯v,A¯v) is Lv+Ld. Lc is the position adjacency matrix between the leader and the followers, and Ld is the velocity adjacency matrix.

2.4. Consensus of the Leader-Follower UUV Formation

In this paper, the leader is fully-functional, guides the whole formation, and can transmit its position and orientation xl(t), and velocity vl(t), to all followers. Each follower maintains a desired geometric configuration with the leader. For UUV leader-follower formation, the leader is defined as the fixed reference point {xl(t),vl(t)}. Thus, the expected state of each follower UUV is that {xl(t)+Δlid,vl(t)}, Δlid is the fixed relative distance to the leader (Figure 3).

Figure 3.

Figure 3

The leader-follower UUV formation.

The advantage of leader-follower formation is that specifying a single quantity (the leader’s motion) directs the group behavior. Therefore, it is simple since a reference trajectory is clearly defined by the leader and the internal formation stability is induced by the control laws of the followers. In this way, the conclusion is that each follower UUV can also converge to the desired point, if each follower UUV can converge to the leader in the formation. Thus, Definition 1 can be obtained as follows.

Definition 1.

In the leader-follower UUV formation, there is one leader and n followers and, at time t, the motion state vector of the ith follower UUV is εi(t)=[xiT(t)viT(t)]T, and the motion state vector of the leader is εl(t)=[xlT(t)vlT(t)]T. If the following formula holds, the leader-follower UUV formation can achieve consistency and continuously ensure the system stability and convergence:

limt|εi(t)εl(t)|=0. (1)

3. Second-Order Integral UUV Model with Nonlinear Function and Current Disturbances

3.1. Five-Degrees-of-Freedom UUV Model

The kinematics and dynamics model [25] of UUV is:

{x˙=J(x)vMv˙+CR(v)v+Y(v)+g(x)=T (2)

where x=[x,y,z,θ,ψ]T is the position and orientation vector, v=[u,v,w,q,r]T is the linear velocity and angular velocity, M=MR+MA includes the inertial matrix and additional inertial matrix, CR(v) denotes the Coriolis force, g(x)=[0,0,0,zBBBsinθ,0]T denotes the restoring force which is generated by the difference between the center of gravity and the center of buoyancy, rBW=[0,0,0] is the coordinate of gravity center in the body-fixed frame, and rBB=[xBB,yBB,zBB] is the coordinate of the buoyancy center in the body-fixed frame. T=[X,Y,Z,M,N]T is the propulsion forces and moments vector. J(x) is the transformation between the body-fixed frame and the Earth reference frame. Y(v)=[YX,YY,YZ,YM,YN]T is the fluid viscosity force. There are:

J(x)=[J1(x)00J2(x)], J1(x)=[cosψcosθsinψcosψsinθsinψcosθcosψsinψsinθsinθ0cosθ], J2(x)=diag{1,1/cosθ}, and CR(v)=[0mrmq00mr0000mq00000000000000].

The list of main symbols used in the paper is shown in Table A1 of the Appendix A.

3.2. State Feedback Linearization

Combine CR(v)v, Y(v), and g(x) into a column vector N(x,v) which does not include inertia mass and additional inertial mass. The UUV Equation (2) is further rewritten as:

[x˙v˙]=[I00M1][J(x)vN(x,v)]+[0M1]T, (3)

where N(x,v)=(CR(v)v+Y(v)+g(x))=[mvrmwqYXmurYYmvqYZzBBBsinθYMYN].

In Equation (3), the two matrices consisting of M1 are:

M1=[I00M1]10×10,M2=[0M1]10×5, (4)

where

M1=[m1100000m2200m2500m33m34000m43m4400m5200m55]. (5)

To simplify the representation, let Σ1 and Σ2 be:

Σ1=(m12ρL3Yv˙)(Iz12ρL5Nr˙)(12ρL4Yr˙)(12ρL4Nv˙). (6)
Σ2=(m12ρL3Zw˙)(Iy12ρL5Mq˙)(12ρL4Zq˙)(12ρL4Mw˙). (7)

where m11=1/(m12ρL3Xu˙), m22=(IzρL5Nr˙/2)/Σ1, m25=(ρL4Nv˙/2)/Σ1, m33=(mρL3Zw˙/2)/Σ2, m34=(ρL4Zq˙/2)/Σ2, m43=(ρL4Mw˙/2)/Σ2, m44=(IyρL5Mq˙/2)/Σ2, m52=(ρL4Nv˙/2)/Σ1, m55=(mρL3Yv˙/2)/Σ1.

Then, the thrust Xprop,Yprop,Zprop and steering angle δr,δs are control input u^, where T=g(x)u^:

T=[XYZMN]=[100000100g24001g340000g4400000g55][XpropYpropZpropδsδr], (8)

where g44=M|q|δsu|q|+Mδsu2, g34=Zδsu|u|, g55=N|r|δru|r|+Nδru2, and g24=Yδru|u|.

The state vector ε=[xT,vT]T is constituted by positions, orientations, and velocities of the UUV. Equation (3) can be rewritten as:

ε˙=f(ε)+M2g(ε)u^, (9)

where f(ε)=M1[J(x)vN(x,v)]10×1, g(ε)=[gij(ε)]5×5. Let g(ε)=M2g(ε), define an output function y=h(ε), and obtain the general nonlinear model of the UUV:

{ε˙=f(ε)+g(ε)u^y=h(ε). (10)

Now, a feedback control law u through coordinate transformation [26] is designed to realize the feedback linearization of the UUV general nonlinear model. Considering Equation (10), let:

h(ε)=[h1(ε),h2(ε),h3(ε),h4(ε),h5(ε)]T=[x,y,z,θ,ψ]T. (11)

According to the definition of Lie derivatives [27,28], Lie derivatives of general nonlinear model of the UUV are obtained:

y˙=hε[f(ε)+g(ε)u]. (12)

Then, the partial differential equation of h(ε) is:

Lfhi(ε)=fi(ε). (13)

Since the first to the fifth elements of gi(ε) are zero, the equation Lgihj(ε)=0 holds for any 1i5,1j5.

For notation simplicity, c and s represent cos and sin function respectively, then:

Lf2h1(ε)=(ucψsθ+wcψcθ)f4(ε)+(usψcθvcψwsψsθ)f5(ε)+cψcθf6(ε)sψf7(ε)+cψsθf8(ε), (14)
Lf2h2(ε)=(usψsθ+wsψcθ)f4(ε)+(ucψcθvsψ+wcψsθ)f5(ε)+sψcθf6(ε)+cψf7(ε)+sψsθf8(ε), (15)
Lf2h3(ε)=(ucθwsθ)f4(ε)sθf6(ε)+cosθf8(ε), (16)
Lf2h4(ε)=f9(ε), (17)
Lf2h5(ε)=rsinθcos2θf4(ε)+f10(ε)cosθ. (18)

The matrix Γ(ε)=[Γij(ε)]5×5 consists of LgiLfhj(ε),1i5,1j5, where Γij(ε)=LgjLfhi(ε).

According to the definition of relative degree, ρ1+ρ2+ρ3+ρ4+ρ5=10 means that the number of system degrees are the same as relative degrees. Subtracting the redundancy terms, the states of the UUV is adopted as system outputs. Thus, the coordinate transformation is chosen as z=φ(ε) which are shown as follows:

{z1=[h1(ε),h2(ε),h3(ε),h4(ε),h5(ε)]Tz2=[Lfh1(ε),Lfh2(ε),Lfh3(ε),Lfh4(ε),Lfh5(ε)]T. (19)

According to the definition of Lie derivatives, yields:

{z˙1=z2z˙2=Lf2h(ε)+LgLfh(ε)u^. (20)

For the new coordinate system, the control input u is:

u=B(ε)+Γ(ε)u^=Lf2h(ε)+LgLfh(ε)u^. (21)

The feedback control input is u^=Γ1(ε)(uB(ε)). As a result, the linear second order integral UUV model can be obtained:

{z˙1=z2z˙2=u. (22)

3.3. Current Disturbances

Ocean current is one of main external disturbances of UUV. Current is changing with several factors such as sea area, depth, time, hydrology, salinity, and so on. It is difficult to describe an ocean current with a specific function. Supposing that the ocean current velocities in the Earth reference frame is UE=(ue,ve,we), ocean current velocities UB=(ub,vb,wb) in the body-fixed frame can be obtained based on conversion matrix J1(x) [29]:

[ubvbwb]=J11(x)[uevewe]. (23)

Since the control system of the leader-follower UUV formation has been represented by feedback linearization, the relative velocities of the UUV subject to UB is given:

[urvrwr]=[uvw][ubvbwb]. (24)

Substituting Equation (24) into the processes of feedback linearization, ocean current velocities can be separated from the relative velocity after coordinate conversion. Then, the velocity states of UUV can be described as:

v^(t)=v(t)+ω(t). (25)

Assuming that UUV formation’s mission area is limited, the current function ω(t) is continuously bounded, and ω(t)=[ue,ve,we,0,0]T.

3.4. Model Uncertainties

The model uncertainties of the UUV include time-varying parameters and additional nonlinear parts which affect the stability of the UUV control system. Thus, the model uncertainties of the UUV must be added into the linear model introduced in Section 3.2, defining a bounded nonlinear function f(xi,vi), which denotes the time-varying parameters and nonlinear terms. Then, the model of the UUV is divided into an approximate linear part in Equation (22) and a nonlinear uncertain part f(xi,vi). Additionally, an assumption of f(xi,vi) is built as follows:

Assumption 1.

The bounded nonlinear function f(xi,vi):×nn satisfies the following inequality:

f(xi(t),vi(t))f(xj(t),vj(t))βεi(t)εj(t), (26)

where εi=[xiTviT]T, f(xi(t),vi(t))=[0fv(xi(t),vi(t))]T, and β is a positive real number.

Here, it is considered that the model uncertainties exist as a certain probability. Thus, Bernoulli's distribution function ϑ(t) is used to describe the existence of the additional nonlinear function f(xi,vi):

Pr(ϑ(t)=1)=p, (27)
Pr(ϑ(t)=0)=1p, (28)

where ϑ(t)=1 shows the presence of the additional nonlinear function f(xi,vi), otherwise it does not exist. p indicates the probability of its existence. Then the following equation must be established:

E{ϑ(t)p}=0. (29)

In the presence of the model uncertainties and current disturbances, the leader’s model is:

{x˙l(t)=vl(t)+ωl(t)v˙l(t)=ϑ(t)fv(xl(t),vl(t)), (30)

The ith follower’s model is:

{x˙i(t)=vi(t)+ωi(t)v˙i(t)=ui(t)+ϑ(t)fv(xi(t),vi(t)). (31)

4. Formation Control with Unstable Communication

4.1. Two-Layer Random Switching Topologies for Communication Failure

Two-layer random switching communication topologies including position topology and velocity topology are proposed to solve the problem of communication failure in this part. Driven by the Markov random process, the position topology switches randomly among a position topology set, and the velocity topology switches randomly among a velocity topology set. Assuming that a topology set is Gu={G1,G2,,GN}, define a basic probability space of the Markov random process θ(t) is (Ω,F,P). F is the algebra of events, and P is the probability measure defined on F. When θ(t)=i, it indicates that the current communication topology is Gi,i{1,2,,N}, N is the quantity of the topological set. According to [30], the switching probability matrix is Γ=[γij]N×N, then:

P(θ(t+Δt)=j|θ(t)=i)={γijΔt+o(Δt)1+γiiΔt+o(Δt)if ijif i=j, (32)

where γij represents the switching probability from topology i to topology j, and Δt>0. When i=j, γii=ijγij. o(Δt) denotes an infinitesimal of a higher order than Δt, which means limt[o(Δt)/Δt]=0.

Now, the position topology set and the velocity topology set are formed, respectively. Let G¯pi(V¯pi,ε¯pi,A¯pi) be the ith position topological unit in the position topology set, 1iN. Joint topology of the position topology set is:

G¯puG¯p1G¯pN{V¯pu,ε¯pu,A¯pu}, (33)

where V¯pu=V¯p1V¯pN, ε¯pu=ε¯p1ε¯pN, and A¯pu=i=1NA¯i.

In the same way, the joint topology of velocity topology set is obtained as G¯vuG¯v1G¯vN{V¯vu,ε¯vu,A¯vu}. The joint Laplacian matrix is: Lpu+Lcu=i=1NLpi+i=1NLci, Lvu+Ldu=i=1NLvi+i=1NLdi.

4.2. The Effective Weight of Communication Topologies for Ocean Noises

The underwater acoustic links are seriously subject to ocean noises. The state information of the UUV may be disturbed by noises in the process from sender to receiver. Gaussian white noise ηij(t) is used to model ocean noises in this paper. Thus, the communication topology weights are stochastically perturbed by Gaussian white noise ηij(t). a˜ij(t)Ap and b˜ij(t)Av are respectively defined as the real position topology and velocity topology weights, which are interfered by ηij(t) among all follower UUVs. a˜ij=1, b˜ij=1, indicates that node j can receive information from node i, otherwise a˜ij=0, b˜ij=0. c˜li(t) is defined as the real position communication topology weights between the leader and followers, and the real velocity communication topology weights d˜li(t). c˜li=1, d˜li=1, indicate that the ith follower can receive the position and velocity information of the leader, otherwise c˜li=0, d˜li=0.

In order to solve the influence of ocean noise on communication, the concept of communication topology effective weight is introduced. Here, 0aij(t)1 and 0bij(t)1 are defined as position and velocity communication topology effective weights among all follower UUVs. 0cli(t)1 and 0dli(t)1 are defined as the position and velocity communication topology effective weights between the leader and followers. With the increasing of influence of ocean noises on communication, the communication topology effective weights decrease. Then, the relationships between real weights a˜ij(t), b˜ij(t) and effective weights aij(t), bij(t) can be expressed as:

a˜ij(t)=aij(t)+δij(t)ηij(t)aij(t), (34)
b˜ij(t)=bij(t)+δij(t)ηij(t)bij(t), (35)

where δij(t) is the noise density in the link from sender i to receiver j at time t, and it is also a continuous function that varies with time. ηij(t) is Gaussian white noise in the communication link from sender i to receiver j at time t, and {ηij(t),1i,jN} is an independent standard Gaussian white noise.

In a similar way, the relationships between real weights c˜li(t), d˜li(t) and effective weights cli(t), dli(t) are:

c˜li(t)=cli(t)+δli(t)ηli(t)cli(t), (36)
d˜li(t)=dli(t)+δli(t)ηli(t)dli(t). (37)

Now, the validity of communication information can be expressed by effective communication topology weights instead of real communication topology weights.

4.3. Leader-Follower UUV Formation Control

According to Definition 1 and UUV model with nonlinear function and current disturbances, the control inputs at time t of leader-follower UUV formation with unstable communication are:

ui(t)=KpjNipa˜ij(t)(xj(t)xi(tτ))+KvjNipb˜ij(t)(vj(t)vi(tτ))+Kpc˜li(t)(xl(tτ)xi(tτ))+Kvd˜li(t)(vl(tτ)vi(tτ)), (38)

where Kp and Kv respectively represent the control gains for the position and velocity communication topologies, Nip is the set of the ith UUV’s neighbors in the position topology, Niv is the set of the ith UUV’s neighbors in the velocity topology, and τ represents a time-varying time delay τ(t).

Stripping noise interference, the noise interference is expressed as corresponding vectors, then the ith UUV’s interferences are:

Δpi(t)=jNipδij(t)ηij(t)aij(t)(xj(tτ)xi(tτ))+δli(t)ηli(t)cli(t)(xl(tτ)xi(tτ)), (39)
Δvi(t)=jNip(δij(t)ηij(t)bij(t))(vj(tτ)vi(tτ))+δli(t)ηli(t)dli(t)(vl(tτ)vi(tτ)). (40)

The ith follower’s model with white noise interference, nonlinear function, and current disturbances is:

x˙i(t)=vi(t)+ωi(t)v˙i(t)=KpjNipaij(t)(xj(t)xi(tτ))+KvjNipbij(t)(vj(t)vi(tτ))+Kpcli(t)(xl(tτ)xi(tτ))+Kvdli(t)(vl(tτ)vi(tτ))+KpΔpi(t)+KvΔvi(t)+ϑ(t)fv(xi(t),vi(t)), (41)

Defining the ith follower’s state vector is εi(t)=[xiT(t)viT(t)]T, the leader’s state vector is εl(t)=[xlT(t)vlT(t)]T. Then, the state vectors of all followers are ε(t)=[ε1T(t)ε2T(t)εnT(t)]T. The system state equation is:

ε˙(t)=(InA)ε(t)((Lp+Lc)K¯p)ε(tτ)((Lv+Lc)K¯v)ε(tτ)+(LcK¯p)εl(tτ)+(LdK¯v)εl(tτ)+(InK¯p)Δ(tτ)+(InK¯v)Δ(tτ)+ΞFε(t)+W(t), (42)

where Fε(t)=[fT(x1(t),v1(t)),fT(x2(t),v2(t)),,fT(xn(t),vn(t))] donates the nonlinear function of the system, and Ξ=ϑ(t)(InI10). W(t)=[w1T(t),w2T(t),,wnT(t)]T is the current disturbances vector, and wi(t)=[ωiT(t)0]T; Δ(t)=[Δ1T(t),Δ2T(t),,ΔnT(t)]T, Δi(t)=[ΔpiT(t),ΔviT(t)]T, and A=[0I00], K¯p=[00Kp0], K¯v=[00Kv0].

According to Definition 1, the system’s state error vector is defined as ξ(t)=[ξ1T(t),,ξnT(t)]T, and the ith follower’s state error vector is ξi(t)=εi(t)εl(t).

In order to analyze ocean noise interference on system stability, Gaussian white noise is taken as a state variable of the system, which is written as follows:

Δpi(t)=Xpiθ(t)=kηi(t)+Ypiθ(t)=kηli(t), (43)
Δvi(t)=Xviθ(t)=kηi(t)+Yviθ(t)=kηli(t), (44)

and:

Xpiθ(t)=k=epi(t)(δ¯ia¯iθ(t)=k(t)),Ypiθ(t)=k=δli(t)cli(t)ξpi(t),Xviθ(t)=k=evi(t)(δ¯ia¯iθ(t)=k(t)),Yviθ(t)=k=δli(t)cli(t)ξvi(t),

where ηi(t)=[ηi1T(t),ηi2T(t),,ηinT(t)]Tn×1, δ¯i(t)=diag{δi1(t),δi2(t),,δin(t)}n×n, a¯iθ(t)=k(t)=diag{a1θ(t)=k(t),a2θ(t)=k(t),,anθ(t)=k(t)}n×n, epi(t)=[(ξp1(t)ξpi(t)),(ξp2(t)ξpi(t)),,(ξpn(t)ξpi(t))]5×n, evi(t)=[(ξv1(t)ξvi(t)),(ξv2(t)ξvi(t)),,(ξvn(t)ξvi(t))]5×n.

In addition, θ(t)=k denotes the Markov random process, kN. ξpi(t)=xi(t)xl(t), ξvi(t)=vi(t)vl(t). Assume that: η(t)=[η1T(t),η2T(t),,ηnT(t),η1T(t),η2T(t),,ηnT(t)]T, and ηl(t)=[ηl1,,ηln,ηl1,,ηln]T. Obviously, the following matrices are available:

Xθ(t)=k=diag{Xpθ(t)=k,Xvθ(t)=k}10n2×2n2, (45)
Yθ(t)=k=diag{Ypθ(t)=k,Yvθ(t)=k}10n2×2n2, (46)
Δ(t)=Xθ(t)=kη(t)+Yθ(t)=kηl(t), (47)

where Xpθ(t)=k=diag{Xp1θ(t)=k,Xp2θ(t)=k,,Xpnθ(t)=k}, Ypθ(t)=k=diag{Ypiθ(t)=k,Yp2θ(t)=k,,Ypnθ(t)=k},

Xvθ(t)=k=diag{Xv1θ(t)=k,Xv2θ(t)=k,,Xvnθ(t)=k}, Yvθ(t)=k=diag{Yviθ(t)=k,Yv2θ(t)=k,,Yvnθ(t)=k}.

The system error state equation is obtained:

ξ˙(t)=(InA)ξ(t)((Lp+Lc)K¯p)ξ(tτ)+(InK¯p)Δ(tτ)((Lv+Lc)K¯v)ξ(tτ)+(InK¯v)Δ(tτ)+ΞF(t)+W^(t), (48)

where, F(t)=[Δf1,Δf2,,Δfn]T, Δfi=fT(xi(t),vi(t))fT(xl(t),vl(t)), W^(t) represents the vector of the current error between the followers and leader, and W^(t)=W(t)1nwl(t), wl(t)=[ωlT0]T.

Further simplified, Equation (48) can be written as:

ξ˙(t)= A¯ ξ(t)Hpθ(t)=kξ(tτ)+K^pΔ(tτ)Hvθ(t)=kξ(tτ)+K^vΔ(tτ)+ΞF(t)+W^(t), (49)

where Hpθ(t)=k=(Lp+Lc)K¯p, Hvθ(t)=k=(Lv+Ld)K¯v, K^p=InK¯p, K^v=InK¯v.

According to the state error, as shown in Equation (49), the sufficient conditions of stable convergence of the system are obtained as shown in Theorem 1.

Theorem 1.

In a leader-follower UUV formation consisting of n+1 UUVs, the communication topologies satisfy the two-layer Markov random process. If the acoustic link is disturbed by ocean noise, at least one follower can receive the leader’s state information. If the following matrix inequality holds and positive definite matrices P, Q1 and Q2 exist, the leader-follower UUV formation control is stable and convergent:

[P A¯+A¯TP+Q1+Ω+Σ1P(Hp+Hv)0*(1κ)(Q1Q2)+Σ20**(1κ)Q2]<0, (50)

where Σ1=Nμ1PP+μ2NPP+μ3PP+μ4PP, Ω=(μ31βp2+ϖ2γ2μ41)I, 0<p,δ<1, Σ2=2μ21δ2((Lvu+Ldu)K¯pTK¯p)+2μ11δ2((Lpu+Lcu)K¯pTK¯p), μ1,μ2,μ3,μ4>0, and β,ϖ,γ>0.

4.4. Stability Analysis

Using the Lyapunov-Krasovskii theory to verify the stability of the leader-follower UUV formation control in the presence of model uncertainties, current disturbances, and unstable communication, build the Lyapunov function:

V(t)=ξT(t)Pξ(t)+tτtξT(t)Q1ξ(t)ds+thτtτξT(t)Q2ξ(t)ds, (51)

where P, Q1 and Q2 are positive definite matrices with the corresponding dimension, respectively. Let:

V1(t)=ξT(t)Pξ(t), (52)
V2(t)=tτtξT(t)Q1ξ(t)ds+thτtτξT(t)Q2ξ(t)ds. (53)

Then, let k{1,2,,N}, and build the kth topology’s Lyapunov function:

Vk(t)={ξT(t)Pξ(t)+tτtξT(t)Q1ξ(t)ds+thτtτξT(t)Q2ξ(t)ds}1θ(t)=k. (54)

Build the expectation equation E{V(t)} of the Lyapunov function:

E{Vk(t)}=E(j=12Vj(t)1{θ(t)=k}). (55)

The derivation of the Lyapunov function expectation equation is obtained:

dE{Vk(t)}=E(j=12d(Vj(t)1{θ(t)=k})). (56)

Lemma 1.

Assume that that f(t) is observable, and E[f(t)1{θ=i}] exists, so for any in, the following equation holds [31]:

E[f(x)d(1{θ=i})]=j=1nγjiE[f(x)1{θ=i}]dt+ο(dt). (57)

The time delay of communication for UUV formation at any time t0, satisfies 0<τ(t)<h, and its derivation satisfies τ˙(t)<κ<1, h, κ0.

Derive the expectation functions of two Lyapunov functions separately:

dE{V1k(t)}=E{dξTPξ+ξTPdξ}1{θ(t)=k}+E{ξTPξ+ξTPξ}d1{θ(t)=k}+o(t), (58)
dE{V2k(t)}=E{ξTQ1ξ+(1κ)(ξτTQ2ξτξhτTQ2ξhτξτTQ1ξτ)}1{θ(t)=k}+E{ξTQ1ξ+(1κ)(ξτTQ2ξτξhτTQ2ξhτξτTQ1ξτ)}d1{θ(t)=k}+o(t) (59)

where, in order to simplify the expression of above equations, ξ, ξτ, and ξhτ represent ξ(t), ξ(tτ) and ξ(thτ), respectively.

The Lyapunov expectation function of topology set is that dE{V}=k=1NdE{Vk()}. Obviously, the Lyapunov expectation function for the switching topology set can be expressed as follows:

dE{V}E{dξTPξ+ξTPdξ}+E{ξTQ1ξ+(1κ)(ξτTQ2ξτξhτTQ2ξhτξτTQ1ξτ)}. (60)

It should be noted that, in Equation (60), all state variables are based on the joint topology set. Therefore, the Laplacian matrices of the joint topology set are Lpu, Lvu, Lcu and Ldu.

Substituting the simplified system error state Equation (49) into Equation (60), one obtains:

E{V˙1}E{ξT(P A¯+A¯TP)ξξτT(HpTP+HvTP)ξξT(PHp+PHv)ξτ+θ(t)=1NΔT(tτ)K^pTPξ+θ(t)=1NξTPK^pΔ(tτ)+θ(t)=1NΔT(tτ)K^vTPξτ+θ(t)=1NξτTPK^vΔ(tτ)+ξTPΞF+FTΞTPξ+ξTPW^+W^TPξ}, (61)

where θ(t)=1NΔT(tτ)K^pTPξ+θ(t)=1NξTPK^pΔ(tτ)Nμ1ξTPPξ+μ11θ(t)=1NΔT(tτ)K^pTK^pΔ(tτ).

In the Lyapunov function, there are μ11ΔT(tτ)K^pTK^pΔ(tτ), so Lemma 2 is deduced to further support the stability analysis of the Lyapunov function in the following.

Lemma 2.

Assuming 0δijδ, i,j{1,2,,N}, one obtains:

θ(t)=1NΔT(tτ)(K^pTK^p)Δ(tτ)2δ2ξT(tτ)((Lpu+Lcu)K¯pTK¯p)ξ(tτ). (62)

Proof. 

Since the matrices in Equations (45)–(47) are diagonal matrices, it can be obtained:

Δ(tτ)=Xθ(t)=kη(t)+Yθ(t)=kηl(t)=[Xθ(t)=kYθ(t)=k][η(t)ηl(t)], (63)

where the time delay is included in Xθ(t)=k and Yθ(t)=k, and the subscript is used to simplify the expression of the time delay, for example Δτ=Δ(tτ), so:

ΔτTK^pTK^pΔτ=[ηTηlT][(Xθ(t)=k)T(Yθ(t)=k)T](K^pTK^p)[Xθ(t)=kYθ(t)=k][ηηl], (64)

Since Xθ(t)=k and Yθ(t)=k are diagonal matrices, Equation (64) is rewritten to:

ΔτT(K^pTK^p)Δτ=ηTXθ(t)=kT(K^pTK^p)Xθ(t)=kη+ηlTYθ(t)=kT(K^pTK^p)Yθ(t)=kηl, (65)

Since K^p=InK¯p, and the special structure of K¯p, the following equation is established:

ΔτT(K^pTK^p)Δτ=i=1nηiTXiθ(t)=kT(K¯pTK¯p)Xiθ(t)=kηi+i=1nηliTYiθ(t)=kT(K¯pTK¯p)Yiθ(t)=kηli=i=1nj=1n(aijθ(t)=k)2δij2ηij2(ξjτξiτ)T(K¯pTK¯p)(ξjτξiτ)+i=1nηli2δli2cli2ξiτ(K¯pTK¯p)ξiτ, (66)

where Xiθ(t)=k=[Xpiθ(t)=kXviθ(t)=k], ηi(t)=[ηi(t)ηi(t)], Yiθ(t)=k=[Ypiθ(t)=kYviθ(t)=k], ηli(t)=[ηli(t)ηli(t)].

According to the definition of communication links between leader and followers, one obtains:

ΔτT(K^pTK^p)Δτδ2i=1nj=1naijθ(t)=k(ξjτξiτ)T(K¯pTK¯p)(ξjτξiτ)+δ2i=1ncijθ(t)=kξiτ(K¯pTK¯p)ξiτ. (67)

Equivalent to:

ΔτT(K^pTK^p)Δτ2δ2ξτT(Lpθ(t)=kK¯pTK¯p)ξτ+δ2ξτT(Lcθ(t)=kK¯pTK¯p)ξτ. (68)

Since there must be δ2ξτT(Lcθ(t)=kK¯pTK¯p)ξτ0, the following inequality is established:

ΔτT(K^pTK^p)Δτ2δ2ξτT((Lpθ(t)=k+Lcθ(t)=k)K¯pTK¯p)ξτ. (69)

Then, for the joint topological set:

θ(t)=1NΔτT(K^pTK^p)Δτ2δ2ξτT((Lpu+Lcu)K¯pTK¯p)ξτ. (70)

The proof of Lemma 2 is completed. □

In the same way, the following inequality is obtained:

θ(t)=1NΔτTK^vTK^vΔτ2δ2ξτT((Lvu+Ldu)K¯pTK¯p)ξτ. (71)

Equation (61) can be rewritten as:

E{V˙1}E{ξT(P A¯+A¯TP)ξξτT(HpTP+HvTP)ξξT(PHp+PHv)ξτ+Nμ1ξTPPξ+2μ11δ2ξτT((Lpu+Lcu)K¯pTK¯p)ξτ+μ2NξTPPξ+2μ21δ2ξτT((Lvu+Ldu)K¯pTK¯p)ξτ+ξTPΞF+FTΞTPξ+ξTPW^+W^TPξ}. (72)

Considering the additional nonlinear factors, it is:

ξTPΞF+FTΞTPξμ3ξTPPξ+μ31FTΞTΞFμ3ξTPPξ+μ31βp2ξTξ. (73)

For the disturbances of ocean current:

ξTPW^+W^TPξμ4ξTPPξ+μ41W^TW^μ4ξTPPξ+ϖ2μ41InTIn. (74)

Substituting the Equations (73) and (74) into Equation (72), one obtains:

E{V˙1}E{ξT(P A¯+A¯TP)ξξτT(HpTP+HvTP)ξξT(PHp+PHv)ξτ+Nμ1ξTPPξ+2μ11δ2ξτT((Lpu+Lcu)K¯pTK¯p)ξτ+μ2NξTPPξ+2μ21δ2ξτT((Lvu+Ldu)K¯pTK¯p)ξτ+μ3ξTPPξ+μ31βp2ξTξ+μ4ξTPPξ+ϖ2μ41InTIn}. (75)

Combining the Equations (58), (59) and (75), the following is obtained:

E{V˙}E{ξT(P A¯+A¯TP)ξξτT(HpT+HvT)PξξTP(Hp+Hv)ξτ+Nμ1ξTPPξ+2μ11δ2ξτT((Lpu+Lcu)K¯pTK¯p)ξτ+μ2NξTPPξ+2μ21δ2ξτT((Lvu+Ldu)K¯pTK¯p)ξτ+μ3ξTPPξ+μ31βp2ξTξ+μ4ξTPPξ+ϖ2μ41γ2ξTξ+ξTQ1ξ+(1κ)ξτT(Q2Q1)ξτ(1κ)ξhτTQ2ξhτ}, (76)

If Equation (50) holds, there must be a positive real number σ>0, so that E{V˙}σξ(t)2. Therefore, the leader-follower UUV formation control is asymptotically stable.

5. Simulations

To illustrate the theoretical results obtained in the previous sections, some simulations are given. Suppose that the leader-follower UUV formation is consisted of one leader and four followers. The time delay is τ(t)=0.1(1+sin(2t)). The two-layer random switching topology set contain four (N=4) position communication topologies G¯pi and four velocity communication topologies G¯vi, i{1,2,3,4}. The joint topologies are G¯pu and G¯vu which are shown in Figure 4a. Figure 4b shows the state changes of the two-layer Markov switching topology in this simulation example.

Figure 4.

Figure 4

Switching topologies: (a) the two-layer random switching topology set; and (b) the Markov random states in switching topology.

The formation structure is designed as an equilateral triangle in this simulation, and each follower maintains a desired geometric configuration with the leader. The follower UUVs include UUV 1, UUV 2, UUV 3, and UUV 4. The desired relative distance Δl1d of UUV 1 to the leader is 10 m, the desired relative distance Δl2d of UUV 2 is 10 m, the desired relative distance Δl3d of UUV 3 is 20 m, and the desired relative distance Δl4d of UUV 4 is 20 m. Relative angle φi is the angle between the motion direction of leader and relative distance. The desired relative angle φ1d of UUV 1 is 150 deg, desired relative angle φ2d of UUV 2 is 210 deg, desired relative angle φ3d of UUV 3 is 150 deg, and desired relative angle φ4d of UUV 4 is 210 deg.

The initial position of each follower is randomly placed in the three-dimensional space. The initial pitch angle and heading angle are respectively set in the range [π/18,π/18] and [0,2π]. The initial states of leader UUV and all follower UUVs are shown in Table 1.

Table 1.

The initial states of the leader UUV and all follower UUVs.

Initx (m) Inity (m) Initz (m) Initθ (deg) Initψ (deg) Initu (m/s) Initv (m/s) Initw (m/s)
Leader 60 3 0 –10 90 1.58 0.1 –0.12
UUV 1 54.5 –15.6 0 1.83 164 0.1 0 0
UUV 2 75.1 –20 0 10 135 0.27 0 0
UUV 3 20.6 –23 0 0 41.8 0.2 0 0
UUV 4 88.6 –18 0 8.9 137.6 0.28 0 0

The control gains of the leader-follower UUV formation controller are Kp=kα[0I]T5×10 and Kv=kβ[0I]T5×10, where kα=0.045, kβ=0.58. The leader is operated on the desired path which is designed as a spiral curve:

{x(t)=100cos(0.02πt)y(t)=100sin(0.02πt)z(t)=0.03t2. (77)

Current velocity is set as UB=[0.2, 0.2, 0] m/s. The SNR of the acoustic communication is selected as 10 dB, and all effective communication topology weights are considered under the condition of SNR 10 dB. The additional nonlinear function is defined as the saturation function related to the UUV’s velocity state as shown in Equation (78) and satisfies the Poisson distribution: P(f(t,xi))=0.5:

f(t,xi)=0.01tanh(vi(t)). (78)

Figure 5, Figure 6, Figure 7 and Figure 8 show the simulation results of the leader-follower UUV formation control.

Figure 5.

Figure 5

3D trajectory of the leader-follower UUV formation.

Figure 6.

Figure 6

The trajectory of leader and follower UUVs in 2D with the desired triangle formation structure.

Figure 7.

Figure 7

Position and attitude states of the UUVs: (a) state x of each UUV; (b) state y of each UUV; (c) state z of each UUV; (d) pitch θ of each UUV; and (e) heading ψ of each UUV.

Figure 8.

Figure 8

Velocity states of the UUVs: (a) velocity u of each UUV; (b) velocity v of each UUV; (c) velocity w of each UUV; (d) angular velocity q of each UUV; and (e) angular velocity r of each UUV.

Figure 5 shows the three-dimensional trajectory of each member in the leader-follower UUV formation. As shown in the figure, the leader UUV is responsible for tracking the desired spiral curve path, and each follower UUV tracks the leader UUV according to its desired relative distance and angle, regardless of tracking the spiral curve path. The ultimate control result is that the whole multi-UUV system tracks the desired spiral path with the desired triangle formation structure. Figure 5 shows that, after an adjustment period, the randomly-placed follower UUVs can stably converge to a desired formation structure, and the leader-follower formation can, primarily, keep tracking the desired path. The two-dimensional trajectory of the leader and follower UUVs are shown in Figure 6. The red and yellow filled triangles on each trajectory denote the heading of the leader UUV and follower UUVs, respectively. It can be shown in Figure 6 that the initial positions and headings of each follow UUV are disorderly, which is not conducive to constructing a formation and track spatial path. However, under the formation control law, each follower can reach and keep the desired relative distance and relative angle with the leader after an adjustment period, and the leader and all followers can maintain the desired triangle formation structure.

Figure 7 shows the position and attitude states of leader-follower UUV formation. It can be seen detailed from the x, y, and z position figure, and the desired triangle formation absolutely follows the desired path after about 170 s because of the initial random positions of the follower UUVs. For Figure 7a, by analyzing the response trend of the position x value for all UUVs, it can be found that the leader UUV gradually shifts to be the smallest and then gradually shifts to be the largest. Referring to Figure 6, the response trend of the position x value is totally reasonable according to the position relationships of all UUVs along the two-dimensional circle trajectory. The similar analysis can be conducted regarding the response trend of the position y value in Figure 7b. From the pitch and heading figure, it can be shown that the attitudes of the UUVs present a period of adjustments because of model uncertainties and current disturbances. However, the pitch and heading of all follower UUVs finally converge to the leader UUV.

Figure 8 shows the velocity states of the leader-follower UUV formation. As shown in the figure, UUVs make a large adjustment of velocities early, and also a small adjustment when the followers converge to the desired formation structure after 300 s. This is because of changes of the transformation topology and the nonlinear function due to speed changes. It can also be observed that the follower UUVs located outside the desired spiral path (UUV 2 and UUV 4) have a greater surge velocity u than the follower UUVs located inside the path (UUV 1 and UUV 3), which can verify the correctness and effectiveness of the formation control algorithm. By reason of the desired helix path, it can be found that velocity v of all follower UUVs are mainly adjusted when the formation is maintained. The angular velocity q and r of all follower UUVs make adjustments before about 300 s, and also finally converge to the leader UUV.

6. Discussion

As is known, the leader-follower approach is a main formation control method of UUVs, and its basic principles and algorithms are relatively mature. In recent years, in order to obtain better application, the studies have focused on more practical problems when adopting the leader-follower approach. These problems mainly involve three aspects. One is the self-problem of UUVs for nonlinearity, under-actuation, control input saturation, and time-varying parameters. Another is the environment disturbance problem of ocean currents, waves, and obstacles. The last is the communication problem of delay, failure, and link noise interference.

To the best of our knowledge, most studies cover only one or two of the three aspects. Especially for communication problems, fewer studies involve communication failure and link noise interference, which have a seriously impact on the stability of formation control. However, for the purpose of developing a practical and effective formation control method, the three aspects are simultaneously considered in this paper. Moreover, in order to model and solve the problems, some novel means and ways are adopted. The main originalities of the paper can be summarized as follows:

First, three problems of model uncertainties, current disturbances, and unstable communication are simultaneously considered and modeled. Based on the three models, leader-follower formation controller is designed in the paper. More importantly, the stability and convergence condition of the controller is proposed and proved using the Lyapunov-Razumikhin theorem. Second, for model uncertainties, time-varying parameters and the nonlinearity of the UUV are modeled as a bounded nonlinear function. The nonlinear function exists as a certain probability meeting Bernoulli’s distribution, which is more in line with the actual situation. Third, communication failure and acoustic link noise interference are both modeled and solved by the method of converting to different communication topology problems. The communication failure problem is modeled and converted to a two-layer random switching communication topology. The acoustic noise interference problem is modeled and represented by effective communication topology weights.

As mentioned in Section 2.1, the method and algorithm proposed also have application boundary conditions in mission scenarios, system scale, communication frequency, formation spacing, and so on. Further, in order to improve the method and make it a more practical implementation, the two following future research directions may need to be concerned. One research direction is to develop formation control algorithms based on limited state information of the leader, which can reduce the communication burden and communication delay. The other one is to add effective estimate algorithms for position and velocity states of both the leader and all follower UUVs to tolerate the unstable communication.

7. Conclusions

This paper addressed the problems of leader-follower UUV formation control with model uncertainties, current disturbances, and unstable communication. A second-order integral UUV model with nonlinear function and current disturbances is established by state feedback linearization. Thus, the model of the UUV is divided into an approximate linear part and a nonlinear uncertain part. Unstable communication considered in this paper includes communication failure and acoustic link noise interference. Then, two-layer random switching topologies are designed, which can dynamically switch to solve the problem of communication failure. The concept of communication topology effective weight is proposed to represent the validity of communication information interfered by noises in acoustic link. By stripping noise disturbances, utilizing a state feedback and consensus algorithm, the distributed controllers of all follower UUVs are obtained. Using the Lyapunov-Razumikhin theorem, the asymptotic stability of the leader-follower UUV formation control method designed in this paper is proven. The effectiveness of the method is simulated by tracking a spiral helix curve path with one leader UUV and four follower UUVs. The simulation results show that leader-follower UUV formation controllers are feasible and effective. After a period of adjustment, all follower UUVs can converge to a desired formation structure, and the formation can keep tracking the desired path.

Acknowledgments

This work was partially funded by the National Nature Science Foundation of China under grant no. 51679057, and Science Foundation for Distinguished Young Scholars of Heilongjiang Province of China under grant no. J2016JQ0052, and Natural Science Foundation of Heilongjiang Province of China under grant no. E2017014. The authors would like to thank all the editors and anonymous reviewers for improving this article.

Appendix A

Table A1.

List of main symbols.

Symbol Description
x, y, z Position in surge, sway, heave
θ, ψ Pitch, yaw
u, v, w Linear velocity in surge, sway, heave
q, r Pitch velocity, yaw velocity
x=[x,y,z,θ,ψ]T Position and orientation vector of UUV
v=[u,v,w,q,r]T Linear and angular velocity vector of UUV
W Gravity
B Buoyancy
rBW=[0,0,0] The coordinates of gravity center in body-fixed frame
rBB=[xBB,yBB,zBB] The coordinates of buoyancy center in body-fixed frame
Xprop,Yprop,Zprop Thrusts
δr,δs Steering angles
m Weight of the UUV
n Total number of follower uuvs
xi(t) The ith follower’s position and orientation vector, i=1,2,n
vi(t) The ith follower’s velocity vector, i=1,2,n
εi(t)=[xiT(t)viT(t)]T The ith follower’s state vector, i=1,2,n
xl(t) The leader’s position and orientation vector
vl(t) The leader’s velocity vector
εl(t)=[xlT(t)vlT(t)]T The leader’s state vector
ε(t)=[ε1T(t)ε2T(t)εnT(t)]T State vectors of all followers
ξi(t)=εi(t)εl(t) The ith follower’s state error vector
ξ(t)=[ξ1T(t),,ξnT(t)]T The formation system’s state error vector
UE=(ue,ve,we) Ocean current velocities in earth reference frame
UB=(ub,vb,wb) Ocean current velocities in body-fixed frame
ϑ(t) Bernoulli’s distribution function
N The quantity of the topological set
G¯pi(V¯pi,ε¯pi,A¯pi) The ith position topological unit in position topology set, i=1,2,N
G¯vi(V¯vi,ε¯vi,A¯vi) The ith velocity topological unit in velocity topology set, i=1,2,N
G¯puG¯p1G¯pN Joint topology of position topology set
G¯vuG¯v1G¯vN Joint topology of velocity topology set
γij The switching probability from topology i to topology j, i,j=1,2,N
Kp, Kv Control gains for the position and velocity communication topologies

Author Contributions

Zheping Yan and Wei Zhang established the second order integral UUV model; Da Xu and Yibo Liu designed the leader-follower formation controllers of the UUVs; Da Xu and Zheping Yan performed the simulations; and Da Xu and Tao Chen wrote the paper.

Conflicts of Interest

The authors declare no conflict of interest. The founding sponsors had no role in the design of the study; in the collection, analyses, or interpretation of data; in the writing of the manuscript; or in the decision to publish the results.

References

  • 1.Hollinger G.A., Choudhary S., Qarabaqi P., Murphy C., Mitra U., Sukhatme G.S., Stojanovic M., Singh H., Hover F. Underwater data collection using robotic sensor networks. IEEE J. Sel. Areas Commun. 2012;30:899–911. doi: 10.1109/JSAC.2012.120606. [DOI] [Google Scholar]
  • 2.Yan Z.P., Wang L., Zhang W., Zhou J.J. Polar grid navigation algorithm for unmanned underwater vehicles. Sensors. 2017;17:1599. doi: 10.3390/s17071599. [DOI] [PMC free article] [PubMed] [Google Scholar]
  • 3.Rodriguez-Molina J., Bilbao S., Martinez B., Frasheri M., Curuklu B. An optimized, data distribution service-based solution for reliable data exchange among autonomous underwater vehicles. Sensors. 2017;17:1802. doi: 10.3390/s17081802. [DOI] [PMC free article] [PubMed] [Google Scholar]
  • 4.Al-Khatib H., Antonelli G., Caffaz A., Caiti A., Casalino G., de Jong I.B., Duarte H., Indiveri G., Jesus S., Kebkal K. The widely scalable Mobile Underwater Sonar Technology (WiMUST) project: An overview; Proceedings of the Oceans 2015; Genova, Italy. 18–21 May 2015; pp. 1–5. [Google Scholar]
  • 5.Li N., Curuklu B., Bastos J., Sucasas V., Fernandez J.A.S., Rodriguez J. A probabilistic and highly efficient topology control algorithm for underwater cooperating AUV networks. Sensors. 2017;17:1022. doi: 10.3390/s17051022. [DOI] [PMC free article] [PubMed] [Google Scholar]
  • 6.Yang H.Z., Wang C.F., Zhang F.M. A decoupled controller design approach for formation control of autonomous underwater vehicles with time delays. IET Control Theory Appl. 2013;7:1950–1958. doi: 10.1049/iet-cta.2013.0072. [DOI] [Google Scholar]
  • 7.Hou S.P., Cheah C.C. Can a simple control scheme work for a formation control of multiple autonomous underwater vehicles? IEEE Trans. Control Syst. Technol. 2011;19:1190–1201. doi: 10.1109/TCST.2010.2076388. [DOI] [Google Scholar]
  • 8.Edwards D., Bean T., Odell D., Anderson M. A leader–follower algorithm for multiple AUV formations; Proceedings of the IEEE/OES Autonomous Underwater Vehicles; Sebasco, ME, USA. 17–18 June 2004; pp. 40–46. [Google Scholar]
  • 9.Cui R.X., Ge S.Z., How B.V.E., Choo Y.S. Leader–follower formation control of underactuated autonomous underwater vehicles. Ocean Eng. 2010;37:1491–1502. doi: 10.1016/j.oceaneng.2010.07.006. [DOI] [Google Scholar]
  • 10.Das B., Subudhi B., Pati B.B. Cooperative control coordination of a team of underwater vehicles with communication constraints. Trans. Inst. Meas. Control. 2016;38:463–481. doi: 10.1177/0142331215590010. [DOI] [Google Scholar]
  • 11.He W., Zhang B., Han Q.L., Qian F., Kurths J., Cao J. Leader-following consensus of nonlinear multi agent systems with stochastic sampling. IEEE Trans. Cybern. 2015;47:327–338. doi: 10.1109/TCYB.2015.2514119. [DOI] [PubMed] [Google Scholar]
  • 12.Ren W. Distributed cooperative attitude synchronization and tracking for multiple rigid bodies. IEEE Trans. Control Syst. Technol. 2010;18:383–392. doi: 10.1109/TCST.2009.2016428. [DOI] [Google Scholar]
  • 13.Shen Q.K., Shi P., Shi Y., Zhang J.H. Adaptive output consensus with saturation and deadzone and its application. IEEE Trans. Ind. Electron. 2017;64:5025–5034. doi: 10.1109/TIE.2016.2587858. [DOI] [Google Scholar]
  • 14.Li L., Ho D.W.C., Lu J. A unified approach to practical consensus with quantized data and time delay. IEEE Trans. Circuits Syst. 2013;60:2668–2678. doi: 10.1109/TCSI.2013.2244322. [DOI] [Google Scholar]
  • 15.Ren W., Beard R.W. Consensus seeking in multi agent systems under dynamically changing interaction topologies. IEEE Trans. Autom. Control. 2005;50:655–661. doi: 10.1109/TAC.2005.846556. [DOI] [Google Scholar]
  • 16.Yu W., Chen G., Cao M. Some necessary and sufficient conditions for second-order consensus in multi-agent dynamical systems. Automatica. 2010;46:1089–1095. doi: 10.1016/j.automatica.2010.03.006. [DOI] [Google Scholar]
  • 17.Yu W., Zheng W.X., Chen G., Ren W., Cao J. Second-order consensus in multi-agent dynamical systems with sampled position data. Automatica. 2011;47:1496–1503. doi: 10.1016/j.automatica.2011.02.027. [DOI] [Google Scholar]
  • 18.Li S.H., Wang X.Y. Finite-time consensus and collision avoidance control algorithms for multiple AUVs. Automatica. 2013;49:3359–3367. doi: 10.1016/j.automatica.2013.08.003. [DOI] [Google Scholar]
  • 19.Peng Z.H., Wang D., Shi Y., Wang H., Wang W. Containment control of networked autonomous underwater vehicles with model uncertainty and ocean disturbances guided by multiple leaders. Inf. Sci. 2015;316:163–179. doi: 10.1016/j.ins.2015.04.025. [DOI] [Google Scholar]
  • 20.Xue Q. Adaptive coordinated tracking control of multiple autonomous underwater vehicles. Ocean Eng. 2014;91:84–90. [Google Scholar]
  • 21.Jung Y.S., Lee K.W., Lee S.Y., Choi M.H., Lee B.H. An efficient underwater coverage method for multi-AUV with sea current disturbances. Int. J. Control Autom. Syst. 2009;7:615–629. doi: 10.1007/s12555-009-0412-4. [DOI] [Google Scholar]
  • 22.Bayat M., Crasta N., Aguiar A.P., Pascoal A.M. Range-Based underwater vehicle localization in the presence of unknown ocean currents: theory and experiments. IEEE Trans. Control Syst. Technol. 2016;24:122–139. doi: 10.1109/TCST.2015.2420636. [DOI] [Google Scholar]
  • 23.Matsuda T., Maki T., Sakamaki T., Ura T. State estimation and compression method for thenavigation of multiple autonomous underwater vehicles with limited communication traffic. IEEE J. Ocean. Eng. 2015;40:337–348. doi: 10.1109/JOE.2014.2323492. [DOI] [Google Scholar]
  • 24.Tsiogkas N., Papadimitriou G., Saigol Z., Lane D. Efficient Multi-AUV Cooperation using Semantic Knowledge Representation for Underwater Archaeology Missions; Proceedings of the OCEANS 2014; St. Johns, QC, Canada. 14–19 Sepember 2014; pp. 1–6. [Google Scholar]
  • 25.Fossen T.I. Handbook of Marine Craft Hydrodynamics and Motion Control. John Wiley & Sons; West Sussex, UK: 2011. [Google Scholar]
  • 26.Peng Z.H., Wang J., Wang D. Distributed Containment Maneuvering of Multiple Marine Vessels via Neurodynamics-Based Output Feedback. IEEE Trans. Ind. Electron. 2017;64:3831–3839. doi: 10.1109/TIE.2017.2652346. [DOI] [Google Scholar]
  • 27.Shojaei K., Arefi M.M. On the neuro-adaptive feedback linearising control of underactuated autonomous underwater vehicles in three-dimensional space. IET Control Theory Appl. 2015;9:1264–1273. doi: 10.1049/iet-cta.2014.0472. [DOI] [Google Scholar]
  • 28.Khalil H.K. Nonlinear Systems. 3rd ed. Printice Hall; Upper Saddle River, NJ, USA: 2002. [Google Scholar]
  • 29.Osborn J., Qualls S., Canning J., Anderson M., Edwards D., Wolbrecht E. AUV State Estimation and Navigation to Compensate for Ocean Currents; Proceedings of the OCEANS 2015; Washington, DC, USA. 19–22 October 2015; pp. 1–5. [Google Scholar]
  • 30.Zhao X.R., Peng X.Y. The Basis of Random Process and Its Application. Harbin Engineering University Press; Harbin, China: 2007. [Google Scholar]
  • 31.Fragoso M.D., Costa O.L.V. A unified approach for stochastic and mean square stability of continuous-time linear systems with Markovian jumping parameters and additive disturbances. SIAM J. Control Optim. 2005;44:1165–1191. doi: 10.1137/S0363012903434753. [DOI] [Google Scholar]

Articles from Sensors (Basel, Switzerland) are provided here courtesy of Multidisciplinary Digital Publishing Institute (MDPI)

RESOURCES