Multibody System-Based Adaptive Formation Scheme for Multiple Under-Actuated AUVs

Abstract

Underwater vehicles’ coordination and formation have attracted increasing attention since they have great potential for real-world applications. However, such vehicles are usually under-actuated and with very limited communication capabilities. On the basis of the multibody system concept, a multiple autonomous underwater vehicle formation and communication link framework has been established with an adaptive and radial basis function (RBF) strategy. For acoustic communication, a packets transmission scheme with topology and protocol has been investigated on the basis of an acoustic communication framework and transmission model. Moreover, the cooperative localization errors caused by packet loss are estimated through reinforcement learning radial basis function neural networks. Furthermore, in order to realize formation cruising, an adaptive RBF formation scheme with magnitude reduced multi-layered potential energy functions has been designed on the basis of a time-delayed network framework. Finally, simulations and experiments have been extensively performed to validate the effectiveness of the proposed methods.

1. Introduction

Currently, Autonomous Underwater Vehicles (AUVs) are increasingly attractive for various underwater tasks such as environmental exploration [1], seabed survey [2], harbor protection [3], and submarine search and rescue [4]. Recent advances in Autonomous Underwater Vehicle (AUV) research have enabled the utilization of multiple AUVs (MAUVs) to realize complex marine missions [5,6,7]. Moreover, although acoustic communications allow the improvement of localization precision, they are still limited with propagating delays and communication channel noise [8]. The upper bound range rate of underwater acoustic channel is 40 km·kb/s [9]. In order to achieve a global objective, each AUV can be taken as a relay and mobile node [10]. Information flow with interconnection topology graphs is necessary for reliable communication [11]. These graphs can have undirected or directed edges for the model of position constraints, information flow, or leader following inter-agent control specifications [12]. Therefore, the MAUVs’ acoustic communication structure should include both communication topology structure [13] and some collision-free data link schemes [14] in order to reduce information congestion and improve flow efficiency [15]. Meng, Shi, and Wang [16] presented a multi-channel scheme based on the multiple access with collision avoidance protocol to improve the network efficiency using code division multiple access (CDMA). Two channels are used for RTS (request to send)/CTS (clear to send) data packets. All nodes in the network are assigned to the same common channel for any packet arrival. One of the disadvantages of this protocol is the centralized nature of the CDMA scheme. In modular and scalable communication architecture, the data infrastructure includes navigation data, tracking data, target data, data request telegrams, etc. [17]. It can be reused, expanded, and bridged for wide area networks. However, the data for transmission is so great that wireless communication was used to assist acoustic communication during the sea trials of two AUVs’ cooperative missions [18]. Guo, Frater, and Ryan [19] proposed an adaptive propagation-delay tolerant media access control (MAC) [20] protocol for an underwater acoustic communication network. The protocol performs an improved handshaking with destination using RTS and CTS frames before transmitting the actual data frame to improve the communication efficiency. In order to further consider the channel blocking effect for simultaneous localization, artificial intelligence-based learning strategies have been employed for controllers [21,22].

In order to realize MAUVs’ formation, the vehicles’ trajectories not only depend on their own dead reckoning and control [23,24], but also depend on group objectives and environmental obstacles. Pramod Abichandani et al. [25] proposed a mixed integer nonlinear programming method for MAUVs’ motion planning under constraint communication. The collision-free trajectories accommodate stricter safety requirements despite intersecting or overlapping paths. Yukun Lin et al. [26] utilized a leader/follower multi-AUV control system to enable the AUVs to drive toward the target through a collision-free path. Mingzhi Chen et al. [27] proposed a novel cooperative hunting algorithm for inhomogeneous MAUVs to achieve quick and active path pursuit and planning. Marcello Farina et al. [28] proposed a distributed predictive control approach for robot coordination. The cost function was defined for rapid exploring formation control [12], coverage sensing, and collision avoidance. However, MAUVs’ formation in unknown environments and navigation in hostile environments [29] are often baffled with vehicle nonlinearity, constraint communications, environmental disturbance, and obstacles. Xiang Cao et al. [30] proposed a target following a cooperative search approach by combining the Glasius bio-inspired neural network with a bio-inspired cascaded tracking control approach to improve their search efficiency and reduce tracking errors. Hao Wang et al. [31] designed a smoothly switching function-based neural network adaptive technique to compensate system uncertainties for cooperative path following. Chengzhi Yuan et al. [32] proposed a learning-based formation scheme for multiple AUVs on heterogeneous nonlinear uncertain dynamics under the virtual leader-following framework, which includes an adaptive observer and a deterministic learning controller. The learned knowledge can be effectively stored in a time-invariant fashion by using radial basis function (RBF) neural networks. However, the formation error and stability not only lie in the controller quality, but they also are affected by the cooperative localization errors caused by packet transmission losses.

This paper proposed an adaptive formation scheme on the basis of multibody system concept, the contributions can be summarized in the following:

1. On the basis of the multibody system concept, the MAUVs’ formation and communication link framework has been established. The connection between AUVs can be viewed as a springs and damping system. An adaptive control strategy has been set up for multiple under-actuated AUVs formation with a desired formation region and magnitude reduced artificial potential function.

2. On the basis of the MAUVs’ formation and communication link framework, the packets transmission scheme has been designed with learning-based multi-layered network topology; the cooperative localization errors caused by packet loss are estimated and modified through reinforcement learning RBF neural networks.

3. On the basis of the MAUVs’ formation and communication link framework, an adaptive RBF formation scheme with magnitude reduced multi-layered potential energy functions has been designed on the basis of the time-delayed network framework. Simulations and experiments have verified the performance of the purposed schemes.

The rest of this study is organized as follows. In Section 2, the MAUVs’ formation and communication link framework will be proposed. An adaptive formation control approach of multiple AUVs will be proposed in Section 3. Simulations and experiments will be discussed and analyzed in Section 4. We will present the conclusion in Section 5.

2. MAUVs’ Formation and Communication Link Framework

2.1. Multibody-Based Formation Framework

When MAUVs cruise in the oceanic environment, they can be taken as mobile nodes. In comparison with the nodes of a normal multibody system, the distances between the nodes and their shapes are changing over time. Their connections are soft and established through communications and formation control approaches. However, the multibody system concept can strengthen the bonds and formation robustness between AUVs. From the multibody system concept (see Figure 1), the constraints between adjacent AUVs are designed through a virtual spring and damping system. During the formation process, the distance constraints between the i-th node and the j-th or the k-th node could be modified or from the variation of the external environment during the formation process. Although the formation is expected to maintain the shape, it is still necessary for shape modification for varied external environments, such as obstacles, narrow passages, dangerous zones, and so forth. Therefore, the shape modification could also lead to changes in the node positions and constraints of the multibody system.

Figure 1.

Multibody system based multiple Autonomous Underwater Vehicle (AUV) formation framework.

2.2. Adaptive Communication Protocol

If we take multiple AUVs’ formation as a multibody system, the mobile AUV nodes should be connected and coordinated over network communication. However, constantly varying the nodes’ distance and transmission latency could lead to the difficulties in data transmission and relative distance observation. Moreover, the energy consumption is correlated with the data transmission distance from source nodes. We adopt a multi-layer-based AUV formation topology according to their relative distance. Linear topology communication is applied for objective AUV nodes far away from the source AUV node while others are closer in the same direction; a one–many contending topology communication is applied for the other leader–follower conditions. The Multiple AUVs network topology is shown in Figure 2.

Figure 2.

Multiple AUVs (MAUV) network topology.

2.2.1. Protocol for Linear Topology

For communication between source node and objective nodes, the protocol at the data link layer includes four-way handshaking access methods for packets waiting and transmission control such as “RTS”, “CTS”, “Data”, “Acknowledgment for Receiving” (ACK), and “Blocked to Send (BTS)”. The communication process is illustrated in Figure 3.

Figure 3.

Communication protocol for linear topology.

After channel contention and selection, the source AUV node and objective AUV nodes realize time consensus through broadcasting and answering. The source AUV node will send information to the objective AUV node 2 through objective AUV node 1.

Secondly, the source AUV node will send information to the source node. The format of the data package is {RTS/overtime, node_pos, node_speed, destination_node}, which denotes the data send request, present position, speed, and destined AUV node (in Figure 3, the objective AUV node 2 is supposed as the destined AUV node). When the “RTS” message has been received by the objective AUV node 1, it will be sent to the objective AUV node 2 immediately. At the same time, objective AUV node 1 will be waiting for the “CTS” message from the objective AUV node 2 or a return timeout frame. When the “RTS” message has been received by the objective AUV node 2, it is informed about the forthcoming message, comes into “response adjustment” status, and sends the “CTS” message to the source AUV node through the objective AUV node 1. When the “CTS” message is received by the objective AUV node 1, it will be transmitted to the source AUV node with the format of the data package as {CTS1/overtime, node1_pos, node1_speed, CTS2/overtime, node2_pos, node2_speed}, which denotes the speed and position of objective nodes. When timeout happens, the source AUV node will send the request again or reselect another objective AUV node.

Thirdly, when the “CTS” message is received, “data” will be sent from the source AUV node to the objective AUV node 2 through the objective AUV node 1. When the objective AUV node 1 received “data”, it will come into “Response adjustment” status and send the data package to the objective AUV node 2. After the data has been received, the objective AUV node 2 will return “ACK” to the source node through the objective AUV node 1. The format of the data package is {ACK1/overtime, node1_pos, node1_speed, ACK2/overtime, node2_pos, node2_speed}, which denotes the speed and position of objective nodes. After “ACK” has been received by the source node, the transmission process will terminated.

2.2.2. Protocol for One-Many Contending Topology

The protocol includes a four-way handshaking access method for “RTS”, “CTS”, “Data”, and “Acknowledgment for receiving”, as well as “Blocked to Send” packets for waiting control. The “Response adjustment” time includes the time of propagation and process delay. Once a source decides to start transmission through one channel, the handshaking process will start and transmit a “Blocked to Send” to other sources (other AUVs) at the same time (see Figure 4).

Figure 4.

Communication protocol for one–many contending topology.

At the first stage, when the RTS frame is received, the destination is notified for the forthcoming transmission. The destination goes to the “Response adjustment” state to receive the packets from its neighbor through the selected channel. A block to send is transmitted to other neighbors so as to alert potential interferers that this channel will be busy for the whole carrying time before it can cause a collision.

At the second stage, the source waits until receiving either “CTS” or a timeout frame. When a timeout occurs, the source is back to the channel contention and selection state. Obviously, the propagation delay between a frame and its “Response adjustment” is at least equal to the length of the frame to be transmitted/received in it so that the node response can be dealt with one after another. Thus, the transmission of an “RTS” frame and reception of a “CTS” frame are two actions that have the same maximum single-trip propagation delay, Pmax. If we define the fixed length gap between a control frame and its consequent frame as “CML”, thus, the gap at the source between RTS and CTS is called CMLRTS, and the gap at the destination between “CTS” and “Data” is called “CMLCTS”. We define:

CMLRTS = CMLCTS = Pmax (1)

for the worst propagation scenario. After receiving the RTS frame, the destination then uses the distance information measured from the “RTS” frame to calculate the time to reply with a “CTS” frame so that the “CTS” frame reaches the source after a “CML” space can be counted. During the gap of “CML”, a potential interferer is avoided for collision-free transmission. Once the “Adjusted Response” state finishes, the source sends the data packets through the corresponding channel and goes to the “ACK” state. In summary, the second stage allows the destination to negotiate with the source, which gives both the source and the destination more flexibility and therefore reduces the chance that the destination fails due to channel collision.

The third stage starts as soon as the “CTS” frame is actually received. During this stage, if the destination receives “Data” from the source, it goes to the “Response adjustment” state to verify that the data packet is coming from the source. Otherwise, a timeout occurs.

At the fourth stage, “ACK” for the corresponding data packets are sent through the selected channel once the “Response adjustment” state finishes. After receiving the first ACK packet, the source finishes its transmission process. The BTS values are reset, and the node goes to a “Channel request” state if there are packets to transmit.

2.3. RBF Learning Network for Localization Errors Estimation

The sound propagation loss is one of the major reasons for cooperative localization errors. It is composed mainly of three aspects: namely, geometrical spreading, attenuation by absorption, and the anomaly of propagation:

$$10logA(l,f)=k\cdot 10logl+l\cdot \alpha$$ (2)

where $\alpha$ is the absorption coefficient in dB/km, k represents the geometrical spreading factor, $l$ represents the transmission range, and $f$ represents the signal frequency.

If we set ${\mathrm{N}}_t$ as the turbulence noise, ${\mathrm{N}}_{\mathrm{v}}$ as the vehicle noise, ${\mathrm{N}}_w$ as the wind driven wave noise, and ${\mathrm{N}}_{th}$ as the thermal noise,

$${\mathrm{N}=\mathrm{N}}_t+{\mathrm{N}}_{\mathrm{v}}+{\mathrm{N}}_w{+\mathrm{N}}_{th}$$ (3)

therefore, we obtain the channel capacity as:

$$E_{trans}={\displaystyle {\int }_B{log}_2\left(1+\frac{P_{tx}}{A(l,f)NB}\right)}df$$ (4)

where B is the bandwidth and $P_{tx}$ is the signal transmission power.

MAUVs in the formation should not only keep the formation configuration to realize purposed missions, but also avoid collision with obstacles. The formation shape and relative distances maintenance are important. If we set $p_c$ as the formation center, one obtains:

$$p_c=\frac{1}{N}{\displaystyle \sum _{i=1}^N{p}_i}.$$ (5)

Each AUV can acquire a geometric center by communicating with its neighbors so as to keep the formation. Hence, the error between $p_c$ and the desired center, $p_c^d=$ ${[x_c^d,y_c^d,z_c^d,{\theta }_c^d,{\psi }_c^d,{\varphi }_c^d]}^T$ is the desired center of the formation region:

$$e=p_c-p_c^d+{\widehat{W}}_i^T\sigma (s_i)$$ (6)

where ${\widehat{W}}_{1,i}^T{\sigma }_{1,i}(s_i)={[{\widehat{W}}_{1,i}^T{\sigma }_{1,i}(s_i),{\widehat{W}}_{2,i}^T{\sigma }_{2,i}(s_i),{\widehat{W}}_{3,i}^T{\sigma }_{3,i}(s_i)]}^T$ is the RBF neural network to estimate three dimensional cooperative localization errors caused by the data transmission packets loss and measurement noise. $\widehat{W}=\left[w_1,\dots ,w_{N_h}\right]$ is the weight vector, while $s_i$ represents the input, including the packet loss, delay, current relative distance and between the AUVS, throughput, and current AUV speed.

The output of the RBF neural network can be expressed in the following:

$$f_i={\displaystyle \sum _{m=1}^{N_h}\left[w_{im}\overline{\sigma }({\displaystyle \sum _{k=1}^{N_i}{\xi }_{mk}{\mu }_k+{\delta }_{\xi j}})+{\delta }_{wj}\right]},\begin{array}{cc}& i=1,2,\dots ,N_o\end{array}$$ (7)

where $N_h$, $N_i$, and $N_o$ represent the number of hidden layers, input layers, and output neurons. $w_{im}$ and ${\xi }_{mk}$ denote the network weights, ${\delta }_{\xi j}$ and ${\delta }_{wj}$ represent the threshold offsets, and $\overline{\sigma }\left(\right)$ denotes the Gaussian function:

$$\overline{\sigma }(\Vert s-r_i\Vert )=\exp (\frac{-{(s-r_i)}^T(s-r_i)}{{\gamma }_i^2})$$ (8)

where $r_i$ is the center vector of the receptive field. $w_{im}$ can be obtained through the following reinforcement learning algorithm.

$$w(s(t),a_k(t))=w(s(t),a_k(t))+\alpha \left[r(t+1)+\gamma w^{\ast }(s(t+1))-w(s(t),a_k(t))\right]$$ (9)

In this algorithm, the action is taken on the packets transmission episode. The actions are chosen through the $\epsilon$ greedy strategy. If $\epsilon >>0$, the actions are taken randomly of $a(t)\in U(a_{\min },a_{\max })$. When $\epsilon <<1$, the system exploits the knowledge through selecting the actions. The actions are selected through the comparisons between a random value of $x_{\epsilon }\in U[0,1]$ and $\epsilon$:

$$a(t)=\{\begin{array}{c}U(a_{\min },a_{\max })\begin{array}{cc}& \begin{array}{cc}if& x_{\epsilon }\le \epsilon \end{array}\end{array}\\ \arg {\max }_{a}w(s(t),a_k(t))\begin{array}{cc}& \begin{array}{cc}if& x_{\epsilon }>\epsilon \end{array}\end{array}\end{array}.$$ (10)

The actions represent the power transmission levels. The state is a combination of transmission energy ${\mathrm{E}}_{trans}$ and channel transmission error evaluation, ${\mathrm{P}}_{\mathrm{error}}$:

$$\{\begin{array}{c}s(t)=\Vert {\mathrm{E}}_{trans}\Vert +\Vert {\mathrm{P}}_{\mathrm{error}}\Vert \\ {\mathrm{P}}_{\mathrm{error}}=1-{(1-B_{error})}^{N_{bit}}\end{array}$$ (11)

where $B_{error}$ is the bit error rate and $N_{bit}$ is the number of bits in the packet [13]. If each transmission action attempts to transmit the total packets, the rewards are defined as a combination of packets reception and energy power levels:

$$r(t)=\pi [(p{r}^q(t)-1)n_{pts}+(n_{pts}-p_{Ediss}(t))-\frac{m_{pr}{n}_{pts}}{2}]$$ (12)

where $\pi$ is the quantization step size factor between two consecutive quantization levels. $pr(t)$ and $p_{Ediss}(t)$ are the packets reception levels and energy dissipation levels, respectively, while $m_{pr}$ is the number of quantized $pr(t)$ levels.

If one defines

$${\dot{p}}_c^d=L\left(G\right)e-p_c^d+p+1\otimes \beta$$ (13)

where $\beta$ is the maximum speed of desired trajectory $p^d$, $\beta =\max (p^d)$, $\otimes$ is the Kronecker product.

Then, the derivative of the error is given by:

$$\dot{e}=-\left(L\left(G\right)+I\right)e+\frac{1}{N}{\displaystyle \sum _{j=1}^N{\dot{p}}_j}+\frac{1}{N}{\displaystyle \sum _{j=1}^N\left(p_j-p_i\right)}-\beta +{\dot{\widehat{W}}}_{1,i}^T{\sigma }_{1,i}(s_i)$$ (14)

where ${\dot{\widehat{W}}}_{1,i}^T=-{\mathsf{\Gamma }}_{1,i}(\sigma (s_i){\eta }_{1,i}+{\tau }_{1,i}{\widehat{W}}_{1,i}^T)$. ${\mathsf{\Gamma }}_{1,i}$, ${\tau }_{1,i}$, and ${\eta }_{1,i}$ are free parameters, ${\eta }_{1,i}={[{\eta }_{11,i},{\eta }_{12,i},{\eta }_{13,i}]}^T$.

2.4. Formation Shape Maintenance with Potential Field

Potential functions play a great role in helping AUVs move along the desired gradients directions and finally stabilize at the local minima. The following will define the layered potential functions’ shape for the AUVs to reach the desired region and maintain a formation shape (see Figure 5).

$$f_S\left(\delta {\eta }_i\right)={\left[f_{S1}\left(\delta {\eta }_{io1}\right),f_{S2}\left(\delta {\eta }_{io2}\right),\dots ,f_{Sm}\left(\delta {\eta }_{iom}\right)\right]}^T\le 0$$ (15)

where ${\eta }_{iol}={\eta }_i-{\eta }_{ol}$, ${\eta }_{ol}$ is a constant reference point of the l-th desired region, $l=1,2,\dots ,m$, and $m$ is the total number of objective functions. $f_{Sl}\left(\delta {\eta }_{iol}\right)$ represents the scalar functions with continuous partial derivatives. From Equation (1), the desired range of AUV motions in the formation is defined as a cylindrical and ring-shape region. For each AUV $p_i$, the desired region is the ring centered around $p_c^d$ between $R_1$ and $R_2$ with height h. Therefore, the scalar attractive forces of the shape function can be defined as follows.

$$\begin{array}{l}\mathrm{Layer}1:\{\begin{array}{c}{f}_{S1}\left(\delta {\eta }_{io1}\right)={(x_i-x_c^d)}^2-{(y_i-y_c^d)}^2-R_1{}^2\le 0\\ f_{S1}\left(\delta {\eta }_{io1}\right)={(z_i-z_c^d)}^2-h^2\le 0\\ f_{S1}\left(\delta {\eta }_{io1}\right)={({\theta }_i-{\theta }_c^d)}^2-{\theta }_h^2\le 0\end{array}\\ \mathrm{Layer}2:\{\begin{array}{c}\begin{array}{l}{f}_{S2}\left(\delta {\eta }_{io2}\right)=R_1{}^2-{(x_i-x_c^d)}^2-{(y_i-y_c^d)}^2\le 0\\ and\begin{array}{cc}& f_{S2}\left(\delta {\eta }_{io2}\right)={(x_i-x_c^d)}^2-{(y_i-y_c^d)}^2-R_2{}^2\le 0\end{array}\end{array}\\ f_{S2}\left(\delta {\eta }_{io2}\right)={(z_i-z_c^d)}^2-h^2\le 0\\ f_{S2}\left(\delta {\eta }_{io2}\right)={({\theta }_i-{\theta }_c^d)}^2-{\theta }_h^2\le 0\end{array}\\ \mathrm{Layer}3:\{\begin{array}{c}\begin{array}{l}{f}_{S3}\left(\delta {\eta }_{io2}\right)=R_2{}^2-{(x_i-x_c^d)}^2-{(y_i-y_c^d)}^2\le 0\\ and\begin{array}{cc}& f_{S3}\left(\delta {\eta }_{io2}\right)={(x_i-x_c^d)}^2-{(y_i-y_c^d)}^2-R_3{}^2\le 0\end{array}\end{array}\\ f_{S3}\left(\delta {\eta }_{io2}\right)={(z_i-z_c^d)}^2-h^2\le 0\\ f_{S3}\left(\delta {\eta }_{io2}\right)={({\theta }_i-{\theta }_c^d)}^2-{\theta }_h^2\le 0\end{array}\end{array}$$ (16)

Hence, the center of the desired formation region is:

$$p_c^d={\left[r_c^d,z_c^d,{\theta }_c^d\right]}^T.$$ (17)

If $k_l$ is set as a positive constant, the traditional potential energy function for the desired formation regions in Figure 5 is:

$$P_{Sl}\left(\delta {\eta }_{iol}\right)=\frac{k_l}{2}{\left[\max (0,f_{Sl}\left(\delta {\eta }_{iol}\right))\right]}^2=\{\begin{array}{ll}0& f_{Sl}\left(\delta {\eta }_{iol}\right)\le 0\\ \frac{k_l}{2}{f}_{Sl}^2\left(\delta {\eta }_{iol}\right)& f_{Sl}\left(\delta {\eta }_{iol}\right)>0\end{array}.$$ (18)

Figure 5.

The layered region for AUV formation and collision avoidance.

In the consideration with the under-actuated characteristic of AUV, the potential energy functions’ magnitude produced from three-dimensional distances have been reduced to improve the scheme robustness and convergence. On the other hand, since the rudder angle is significant for under-actuated AUV to arrive at desired positions, the yaw error of AUV formation appears to be more important.

$$\{\begin{array}{c}{P}_{Sm}\left(\delta p_{iom}\right)=\frac{k_m}{2}\left[\max (0,In(\left|f_{Sm}\left(\delta p_{iom}\right)\right|)\right]=\{\begin{array}{ccc}0& f_{Sm}\left(\delta p_{iom}\right)\le 0\hfill & \\ \frac{k_m}{2}In(\left|f_{Sm}\left(\delta p_{iom}\right)\right|)& f_{Sm}\left(\delta p_{iom}\right)>0\hfill & m=1,2,3\dots \end{array}\\ P_{Sm}\left(\delta p_{iom}\right)=\frac{k_m}{2}{\left[\max (0,f_{Sm}\left(\delta p_{iom}\right))\right]}^2=\{\begin{array}{ccc}0& f_{Sm}\left(\delta p_{iom}\right)\le 0\hfill & \\ \frac{k_m}{2}{f}_{Sm}^2\left(\delta p_{iom}\right)& f_{Sk}\left(\delta p_{iom}\right)>0\hfill & m=4\end{array}\hfill \end{array}$$ (19)

Thus, the region error for the i-th AUV is defined as follows.

$$\begin{array}{l}{\left(\frac{\partial P_{Si}\left(\delta p_{iok}\right)}{\partial p_i}\right)}^T\\ ={\displaystyle \sum _{m=1}^N(k_m\frac{1}{\max \left(0,f_{Sm}\left(\delta p_{iom}\right)\right)}\times {\left(\frac{\partial f_{Sm}\left(\delta p_{iom}\right)}{\partial \delta q_{iom}}\right)}^T)}+k_4\max \left(0,f_{S4}\left(\delta p_{io4}\right)\right)\times {\left(\frac{\partial f_{Sk}\left(\delta p_{io4}\right)}{\partial \delta p_{io4}}\right)}^T=\Delta {\xi }_i\end{array}$$ (20)

For the collision avoidance conditions, the repulsive forces between AUVs or AUVs and obstacles are defined in the form as:

$$f_{irep}=k_{rep}\left((\frac{1}{\Vert p_i-p_j\Vert })\frac{p_i-p_j}{\Vert p_i-p_j\Vert }+(\frac{1}{\Vert p_i-p_{oi}\Vert })\frac{p_i-p_{oi}}{\Vert p_i-p_{oi}\Vert }\right)$$ (21)

where $p_{oi}$ is the position vector of the i-th obstacle, the energy functions are defined on the basis of the collision avoidance region:

$$\{\begin{array}{c}{g}_{1ij}\left(\delta {\eta }_{ij}\right)=R_{i1}^2-{\Vert \delta {\eta }_{ij}\Vert }^2\le 0\\ g_{2ij}\left(\delta {\eta }_{ij}\right)=R_{i2}^2-{\Vert \delta {\eta }_{ij}\Vert }^2\le 0\\ ⋮\\ g_{Nij}\left(\delta {\eta }_{ij}\right)=R_{iN}^2-{\Vert \delta {\eta }_{ij}\Vert }^2\le 0\end{array}$$ (22)

where $\delta {\eta }_{ij}={\eta }_i-{\eta }_j$, $g_{1ij},g_{2ij},\dots ,g_{NLij}$ are the functions for the first layer, second layer,…, and the innermost layer, respectively, and these layers are continuous and differentiable, while $N$ is the number of layers, and $R_{i1}>R_{i2}>\dots R_{iN}$ denote the radius of the first, second, and innermost layers, respectively.

Similar to the equations shown in (19), the collision avoidance energy functions have been magnitude reduced as:

$$\{\begin{array}{c}{Q}_{1ij}\left(\delta p_{ij}\right)=\frac{k_{1ij}}{2}\left[\max (0,In\left|g_{1ij}\left(\delta p_{ij}\right)\right|)\right]\\ Q_{2ij}\left(\delta p_{ij}\right)=\frac{k_{2ij}}{2}\left[\max (0,In\left|g_{2ij}\left(\delta p_{ij}\right)\right|)\right]\\ ⋮\\ Q_{Nij}\left(\delta p_{ij}\right)=\frac{k_{Nij}}{2}\left[\max (0,In\left|g_{Nij}\left(\delta p_{ij}\right)\right|)\right]\end{array}$$ (23)

where $k_{Nij}>\cdots >k_{2ij}>k_{1ij}$ are positive constants. The potential energy for collision avoidance between the i-th and j-th vehicle is:

$$\begin{array}{l}{Q}_{ij}\left(\delta p_{ij}\right)=Q_{1ij}\left(\delta p_{ij}\right)+Q_{2ij}\left(\delta p_{ij}\right)+\dots +Q_{Lij}\left(\delta p_{ij}\right)\\ =\frac{k_{1ij}}{2}{\left[\max (0,In\left|g_{1ij}\left(\delta p_{ij}\right)\right|)\right]}^2+\frac{k_{2ij}}{2}{\left[\max (0,In\left|g_{2ij}\left(\delta p_{ij}\right)\right|)\right]}^2+\dots +\frac{k_{Nij}}{2}{\left[\max (0,In\left|g_{Nij}\left(\delta p_{ij}\right)\right|)\right]}^2\end{array}$$ (24)

and

$$\frac{\partial Q_{Nij}\left(\delta q_{1ij}\right)}{\partial \delta q_{ij}}={\displaystyle \sum _{h=1}^N{k}_{hij}\max \left(0,\frac{1}{g_{hij}\left(\delta q_{ij}\right)}\right)}\times {\left(\frac{\partial g_{hij}\left(\delta q_{ij}\right)}{\partial \delta q_{ij}}\right)}^T\triangleq \Delta {\rho }_{ij}.$$ (25)

Therefore, if $p_c^d={[x_c^d,y_c^d,z_c^d,{\varphi }_c^d,{\psi }_c^d,{\theta }_c^d]}^T$ is set as the desired center of AUV formation, the desired AUV positions and formation shape can be obtained through Equations (16)–(25).

3. Adaptive RBF Formation Scheme

The dynamic equation of the i-th AUV can be expressed as:

$$M_i(p_i){\ddot{p}}_i+C_i(p_i){\dot{p}}_i+D_i(p_i){\dot{p}}_i+g_i(p_i)+{\Delta }_i(p_i)=T_i$$ (26)

where $M_i(p_i)$ is the $6\times 6$ mass matrix of the AUV, $C_i(p_i)$ is a $6\times 6$ matrix of centrifugal and coriolis terms, $D_i(p_i)$ is the damping matrix, $g_i(p_i)$ is the vector of gravitational forces and moments, ${\Delta }_i(p_i)$ is uncertain dynamics, and $T_i$ contains the forces and torques from thrusts. If we define:

$${\dot{p}}_{ci}={\dot{p}}_c^d-({\alpha }_i\Delta {\xi }_i+\gamma {\displaystyle \sum _{j=1}^{N_i}\Delta {\rho }_{ij}})$$ (27)

and set $\Delta {\epsilon }_i={\alpha }_i\Delta {\xi }_i+\gamma {\displaystyle \sum _{j=1}^{N_i}\Delta {\rho }_{ij}}$, we have ${\dot{p}}_{ci}={\dot{p}}_c^d-\Delta {\epsilon }_i$, where ${\ddot{p}}_{ci}={\dot{p}}_c^d-\Delta {\dot{\epsilon }}_i$. We define a sliding vector for the i-th AUV as:

$$s_i={\dot{p}}_i-{\dot{p}}_{ci}={\dot{p}}_i-{\dot{p}}_c^d+\Delta {\epsilon }_i.$$ (28)

Thus, we obtain:

$${\dot{s}}_i={\ddot{p}}_i-{\ddot{p}}_c^d+\Delta {\dot{\epsilon }}_i.$$ (29)

Substituting Equations (28) and (29) into Equation (27), one has:

$$M_i(p_i){\dot{s}}_i+C_i(p_i)s_i+D_i(p_i)s_i+M_i(p_i){\ddot{p}}_c^d+C_i(p_i){\dot{p}}_c^d+D_i(p_i){\dot{p}}_c^d+g_i(p_i)+{\Delta }_i(p_i)=T_i.$$ (30)

According to the adaptive control principle, we obtain:

$$M_i(p_i){\ddot{p}}_c^d+C_i(p_i){\dot{p}}_c^d+D_i(p_i){\dot{p}}_c^d+g_i(p_i)+{\Delta }_i(p_i)={\mathsf{\Upsilon }}_i\left(p_i,{\dot{p}}_i,{\dot{p}}_c^d,{\ddot{p}}_c^d\right){\lambda }_i$$ (31)

where ${\mathsf{\Upsilon }}_i\left(p_i,{\dot{p}}_i,{\dot{p}}_c^d,{\ddot{p}}_c^d\right)$ is a known regressor matrix and ${\lambda }_i$ represents the dynamic parameters. Therefore, the RBF-based region based adaptive controller is:

$$T_i=-K_{si}{s}_i-K_p\Delta {\epsilon }_i+{\mathsf{\Upsilon }}_i\left(p_i,{\dot{p}}_i,{\dot{p}}_c^d,{\ddot{p}}_c^d\right){\widehat{\lambda }}_i+{\widehat{W}}_i^T\sigma (s_i).$$ (32)

If we set $L_i$ as positive definite matrices, the estimated parameter ${\widehat{\lambda }}_i$ is updated as:

$${\widehat{\lambda }}_i=-L_i{\mathsf{\Upsilon }}_i^T\left(q_i,{\dot{q}}_i,{\dot{q}}_c^d,{\ddot{q}}_c^d\right)s_i.$$ (33)

Therefore,

$$M_i(q_i){\dot{s}}_i+C_i(q_i)s_i+D_i(q_i)s_i+K_{si}{s}_i+K_p\Delta {\epsilon }_i+{\mathsf{\Upsilon }}_i\left(q_i,{\dot{q}}_i,{\dot{q}}_c^d,{\ddot{q}}_c^d\right)\Delta {\lambda }_i+{\widehat{W}}_i^T\sigma (s_i)=0$$ (34)

where $\Delta {\lambda }_i={\lambda }_i-{\widehat{\lambda }}_i$.

In order to prove the stability of the RBF-based adaptive formation scheme, we obtain a Lyapunov-like function for the multiple AUVs system as:

$$\begin{array}{cc}\hfill V=& {\displaystyle \sum _{i=1}^N\frac{1}{2}}{s}_i^T{M}_i(q_i)s_i+{\displaystyle \sum _{i=1}^N\frac{1}{2}}\Delta {\lambda }_i^T{M}_i(q_i){\lambda }_i+{\displaystyle \sum _{k=1}^3\frac{1}{2}}{\tilde{W}}_{k,i}^T{\mathsf{\Gamma }}_{k,i}^{-1}{\tilde{W}}_{k,i}^{}\hfill \\ & +{\displaystyle \sum _{i=1}^N\frac{1}{2}}{\alpha }_i{K}_p{\displaystyle \sum _{l=1}^6{K}_l{P}_{Sm}\left(\delta q_{lom}\right)}+{\displaystyle \sum _{i=1}^N\frac{1}{2}}{\gamma }_i{K}_p{\displaystyle \sum _{j=1}^N{K}_{ij}{Q}_{2ij}\left(\delta q_{ij}\right)}\hfill \end{array}$$ (35)

We obtain from Equations (20), (31), and (32):

$$\begin{array}{l}{\dot{V}}_i=-{\displaystyle \sum _{i=1}^N{s}_i^T{K}_{si}{s}_i^{}}-{\displaystyle \sum _{i=1}^N{s}_i^T{D}_i(q_i)s_i^{}}-{\displaystyle \sum _{i=1}^N{s}_i^T{K}_p\Delta {\epsilon }_i}+{\displaystyle \sum _{i=1}^N{\alpha }_i{K}_p{\dot{e}}_{}^T\Delta {\xi }_i}\\ +{\displaystyle \sum _{i=1}^N\frac{1}{2}}{\gamma }_i{K}_p{\displaystyle \sum _{j=1}^{N_i}{\displaystyle \sum _{h=1}^L{k}_{hij}\delta {\dot{q}}_{ij}^T\left[\max (0,g_{hij}\left(\delta q_{ij}\right))\right]}{\left(\frac{\partial g_{hij}\left(\delta q_{ij}\right)}{\partial \delta q_{ij}}\right)}^T}-{\displaystyle \sum _{k=1}^3\frac{1}{2}}{\tilde{W}}_{k,i}^T(\sigma (s_i){\eta }_{k,i}+{\tau }_{k,i}{\widehat{W}}_{k,i}^T)\end{array}$$ (36)

If we set $E_{N_i}={\left[\underset{N_i}{\underbrace{1,\dots ,1}}\right]}^T$, the last term of the Equation (36) can be rewritten by using Equation (25):

$${\displaystyle \sum _{i=1}^N\frac{1}{2}}{\gamma }_i{\displaystyle \sum _{j=1}^{N_i}{K}_p\dot{e}\Delta {\rho }_{ij}}-{\displaystyle \sum _{i=1}^N\frac{1}{2}}{\gamma }_i{K}_p{\displaystyle \sum _{j=1}^{N_i}{\displaystyle \sum _{h=1}^L{k}_{hij}{\dot{e}}^T\left[\max (0,g_{hij}\left(\delta q_{ij}\right))\right]}{\left(\frac{\partial g_{hij}\left(\delta q_{ij}\right)}{\partial \delta q_{ij}}\right)}^T}.$$ (37)

From Equation (22), we can obtain

$$g_{hij}\left(\delta q_{ij}\right)=g_{hji}\left(\delta q_{ji}\right)\begin{array}{ccc}& and& \end{array}\frac{\partial g_{hij}\left(\delta q_{ij}\right)}{\partial \delta q_{ij}}=-\frac{\partial g_{hji}\left(\delta q_{ji}\right)}{\partial \delta q_{ji}}.$$ (38)

Thus, the last term of Equation (35) can be written as

$$\begin{array}{l}\begin{array}{c}\end{array}{\displaystyle \sum _{i=1}^N\frac{1}{2}}{\gamma }_i{K}_p{\displaystyle \sum _{j=1}^{N_i}{\displaystyle \sum _{h=1}^L{k}_{hij}{\dot{e}}^T\left[\max (0,g_{hji}\left(\delta q_{ji}\right))\right]}{\left(\frac{\partial g_{hji}\left(\delta q_{ji}\right)}{\partial \delta q_{ji}}\right)}^T}\\ ={\displaystyle \sum _{i=1}^N\frac{1}{2}}{\gamma }_i{K}_p{\displaystyle \sum _{j=1}^{N_i}{\displaystyle \sum _{h=1}^L{k}_{hji}{\dot{e}}^T\left[\max (0,g_{hji}\left(\delta q_{ji}\right))\right]}{\left(\frac{\partial g_{hji}\left(\delta q_{ji}\right)}{\partial \delta q_{ji}}\right)}^T}\\ ={\displaystyle \sum _{i=1}^N\frac{1}{2}}{\gamma }_i{K}_p{\displaystyle \sum _{j=1}^{N_i}{\displaystyle \sum _{h=1}^L{k}_{hji}{\dot{e}}^T\left[\max (0,g_{hji}\left(\delta q_{ji}\right))\right]}{\left(\frac{\partial g_{hji}\left(\delta q_{ji}\right)}{\partial \delta q_{ji}}\right)}^T}\\ ={\displaystyle \sum _{i=1}^N\frac{1}{2}}{\gamma }_i{K}_p{\displaystyle \sum _{j=1}^{N_i}{\dot{e}}^T\Delta {\rho }_{ji}}\\ ={\displaystyle \sum _{i=1}^N\frac{1}{2}}{\gamma }_i{K}_p{\displaystyle \sum _{j=1}^{N_i}{\dot{e}}^T\Delta {\rho }_{ij}}\end{array}$$ (39)

Moreover, $-{\tau }_{k,i}{\tilde{W}}_{k,i}^{}{\widehat{W}}_{k,i}^T\le -\frac{1}{2}{\tau }_{k,i}({\Vert {\tilde{W}}_{k,i}^{}\Vert }^2+{\Vert {\tilde{W}}_{k,i}^{*}\Vert }^2)$, $W_{k,i}^{*}$ denotes the ideal constant weights.

Therefore, the time derivative of the Lyapunov function in Equation (37) is

$${\dot{V}}_i\le -{\displaystyle \sum _{i=1}^N{s}_i^T{K}_{si}{s}_i^{}}-{\displaystyle \sum _{i=1}^N{s}_i^T{D}_i(q_i)s_i^{}}-{\displaystyle \sum _{i=1}^N{K}_p\Delta {\epsilon }_i^T\Delta {\epsilon }_i}-\frac{1}{2}{\tau }_{k,i}({\Vert {\tilde{W}}_{k,i}^{}\Vert }^2+{\Vert {\tilde{W}}_{k,i}^{*}\Vert }^2)\le 0.$$ (40)

From Equation (40), it can be obtained that $s_i$, $\Delta {\epsilon }_i$, $\Delta {\dot{\xi }}_i$, $\Delta {\dot{\rho }}_{ij}$ and $\Delta {\dot{\epsilon }}_i$ are bounded. ${\ddot{q}}_{ri}$ is bounded if $\ddot{e}$ is bounded. Thus, ${\dot{s}}_i$ is bounded from Equation (32). Applying Barbalat’s lemma, we obtain and $s_i\to 0$ as $t\to \infty$ if $\dot{e}\to 0$. From Equation (28), $\Delta {\rho }_{ij}\to 0$.

Since

$$\Delta {\epsilon }_i={\alpha }_i\Delta {\xi }_i+\gamma {\displaystyle \sum _{j=1}^{N_i}\Delta {\rho }_{ij}}\to 0$$ (41)

as $t\to \infty$, all the error terms are summing yields:

$${\displaystyle \sum _{i=1}^N({\alpha }_i\Delta {\xi }_i+\gamma {\displaystyle \sum _{j=1}^{N_i}\Delta {\rho }_{ij}}})\to 0$$ (42)

Since the interactive forces between AUVs are bi-directional, the summation of all the interactive forces in the systems is zero, we obtain:

$${\displaystyle \sum _{i=1}^N{\alpha }_i\Delta {\xi }_i}\to 0.$$ (43)

One trivial solution of Equation (43) is $\Delta {\xi }_i\to 0$, which means that all the AUVs remain in the desired region all the time because of Equation (40). This means that each AUV is in the desired region and maintains a minimum distance among themselves simultaneously. On the contrary, if we assume $\Delta {\xi }_i\ne 0$, the AUV are outside the desired region. Thus, some of the AUVs must be on the opposite sides of the desired region and their $\Delta {\xi }_i$ values can not be cancelled out, which contradicts with the fact that ${\displaystyle \sum _{i=1}^N{\alpha }_i\Delta {\xi }_i}=0$. Therefore, the only possibility is ${\displaystyle \sum _{i=1}^N{\alpha }_i\Delta {\xi }_i}=0$ when $\Delta {\xi }_i=0$. From Equation (41), $\Delta {\rho }_{ij}=0$. Therefore, if and only if all the forces of $\Delta {\xi }_i$ are zero or cancelled out, does ${\displaystyle \sum _{i=1}^N{\alpha }_i\Delta {\xi }_i}=0$. This means that some AUVs must be on the opposite sides of the desired region. When there are interactions or coupling among the AUVs from different sides of the desired region, a reasonable weightage can be obtained for $\Delta {\xi }_i$ by adjusting ${\alpha }_i$. Finally, since $s_i\to 0$ and $\Delta {\xi }_i\to 0$, we can conclude from Equation (28) that $\Delta {\rho }_{ij}\to 0$. Hence, all the AUVs are synchronized to the same speed and maintain constant distances among themselves at steady state.

4. Simulations and Experiments

In order to analyze and verify the designed communication link framework and formation scheme, simulations and experiments have been launched. In the formation simulations of Figure 6 and Figure 7, comparisons have been made on the proposed adaptive formation scheme with and without the RBF neural network. The disturbance is set with a current speed as 0.1 m/s in the west direction. The simulation includes the formation along a round curve and cruising in the confined channel. Their communications are simulated in the NS-2 simulator on the basis of the communication protocol of Section 2. The formation control simulation platform was established on the basis of AUV hydrodynamic equations.

Figure 6.

Formation simulation along a round curve.

Figure 7.

Formation simulation in the channel.

In Figure 6, the three AUVs are planned to follow a round curve with a line shape, e.g., the followers are planned to maintain the same distance one after another. The protocol for linear topology has been applied for the formation communication on the basis of the network framework of Section 2. Since the radius of the trace curvature is greater than the radius of the AUVs’ gyration, these three AUVs can keep formation cruising precisely. The package loss and data transmission throughput are illustrated in Figure 6b; one can improve the cooperative localization accuracy through reinforcement learning RBF neural network and therefore improve the formation stability. From Figure 6c, the reinforcement learning RBF neural network can compensate and reduce the cooperative localization errors caused by communication loss through Equations (12)–(14).

Channel cooperative exploration is one of the important applications, and it is very difficult for MAUVs because of the change of channel size and curve. Through the reinforcement learning RBF neural network, the MAUVs’ formation can obtain more accurate cooperative localization information. The multibody system-based potential field can help MAUVs maintain and change their formation shape according to the environment. The protocol for one–many contending topology and linear topology have been applied and switched according to the shape requirements.

Offshore experiments of MAUVs formation coverage exploration are illustrated in Figure 8. The vehicles were given folding lines with a 90-degree yaw path to test the formation performance of heterogeneous AUVs. The three AUVs can keep their formation while cruising under the strategies proposed in this study.

Figure 8.

Formation coverage experiments.

5. Conclusions

MAUVs’ formation is of great significance for marine surveys and exploration. In order to realize MAUVs’ formation, this study has focused on their communication and formation. On the basis of the multibody system concept, the MAUVs’ formation and communication link framework has been established with an adaptive RBF strategy. The connection for communication and formation between AUVs can be viewed as a springs and damping system. The packets transmission scheme has been designed with multi-layered network topology, which reduces the packets’ loss rate and improves the throughput of the network. Moreover, through the reinforcement-learning RBF neural networks, an adaptive RBF formation strategy can be improved with more accurate cooperative localization information. Simulations and offshore experiments with multiple heterogeneous under-actuated AUVs testify the performance of proposed method.

Author Contributions

Conceptualization, Y.P.; methodology, L.W. and Q.T.; data curation, G.Z.; writing—original draft preparation, H.H.; writing—review and editing, T.Z. and Q.T. All authors have read and agreed to the published version of the manuscript.

Funding

This project is funded by the National Nature Science Foundation of China, grant number: 61633009, 51579053, 51779059; and Field Fund of the 13^th Five-Year Plan for Pre-research Equipment, grant number: 61403120301, and also funded by the Key Basic Research Project of “Shanghai Science and Technology Innovation Plan”, grant number: No.15JC1403300.

Conflicts of Interest

The authors declare no conflict of interest.