Abstract

This paper addresses the coordinated depth control problem of multiple autonomous underwater vehicles, which means to maneuver a group of underwater vehicles which move at the same depth synchronously. Firstly, a coordinated error of depth between vehicles and the common desired depth is defined by using extended graph theory in a distributed manner; then a deep-pitch double loop control algorithm based on sliding mode is designed for each vehicle, by which each vehicle is driven to and move at the common depth coordinately. In particular, a pitch reference command is firstly calculated by the predefined coordinated depth error, which can be regarded as the outer loop control, and then, the input rudder angle for each vehicle is derived according to the pitch reference command being as the inner loop control. Considering the uncertainties of the model hydrodynamic parameters, an online parameter adaptive algorithm is introduced to improve the performance of the sliding mode control algorithm proposed. Simulations were performed to verify the theoretical results proposed.

1. Introduction

With the development of artificial intelligence, robots play more and more roles in our daily lives. The high demand of industrial applications and automation devices always needs the robot operate in a complex environment which is posing requirements for the system stability, safety, and strong challenges for the controller design [13]. As a typical underwater robot, Autonomous Underwater Vehicle (AUV) plays great roles in ocean exploring missions and even more in the field of militaries. In order to fulfill these applications, it is usually necessary to maneuver an AUV cruise at a fixed and expected depth; this task is always called the vertical plane control of AUV, which is a typical motion form in the field of marine crafts [4]. Many works have been done to develop strategies capable of depth control of a single AUV, mainly include fuzzy control [5], neural networks [6], and sliding mode [7, 8]. Although significant progress has been made in the area, however, much work remains to be done to develop strategies for multiple AUVs. Considering the fact that current missions are getting more complex and AUV technology matures, it is common to require multiple AUVs to work cooperatively to solve these types of tasks with low cost, high adaptively, and easy maintenance.

Consensus theory and algorithms have proven to be effective tools to perform the network-wide distributed computation tasks such as computing aggregate quantities and functions over networks. There have been much works on consensus problems of first-order agents, such as consensus under time-varying topology [9], finite-time consensus [10], consensus over random networks [11], and asynchronous consensus [12]. Taking into account the fact that many vehicles such as AUVs considered in this paper and mobile robots are always controlled directly by their accelerations rather than by their velocities, hence it is also necessary to investigate consensus problems of second-order agents. In [13, 14], the authors studied conditions on the interaction graph and the control gains for two different consensus algorithms to ensure agreement on both positions and velocities. Despite significant progress has been made in aforementioned works, much work remains to be done for the AUV systems due to the fact that the dynamics of AUV are often complex and cannot be simply ignored or drastically simplified for control design purpose. In the field of marine vehicles, authors in [15] proposed a synchronized path following controller for fully actuated surface ships by using passivity theory. A decentralized formation controller was derived in [16], which deals with the cooperative problem of fully actuated surface vehicles with considering the influencing of the sea currents and model uncertainty. Even all the results proposed in the above woks are decentralized because each member of the group only needs to exchange the necessary information under local interactions, but all of them assumed that there is a global reference speed for the whole group which should be known to all the team members. In this sense, the controller proposed is not distributed because there is a global vector which should be known to all of them.

Motivated by the ideas of consensus tracking and aforementioned works, we consider the truly distributed depth coordinated control problem of AUVs in this proposal. By using extended graph theories, the coordinated depth error between each AUV and the common desired depth was defined firstly, in which we only need the common desired depth be available to one subset of AUVs by local interactions, so the strategy is truly distributed and this can be regarded as our first contribution. Moreover, a double loop based on adaptive sliding mode control algorithm for each AUV was derived with considering the model uncertainties of each AUV, and each AUV can move at the same depth coordinately by using the algorithm proposed. Furthermore, the control parameters used in the algorithm proposed are obtained from the kinematic model of the AUV and the expected dynamic characteristics of each link; except for the initial value of the model parameter vector, all other parameters are irrelevant to the AUV, so the strategy proposed has good application values.

The remainder of this paper is organized as follows: in Section 2, models of the vehicles considered in this work and extended graph theory which will be used throughout this paper are described. We also presented the basic principles of the synchronized depth control by defining a coordinated error vector novelty in this section. Sections 3 and 4 especially present the procedures of designing the sliding mode control for the depth tracking with and without considering the model uncertainties. In Section 5, simulation examples are executed to validate the effectiveness of the strategy proposed. Finally, conclusions and future works are summarized and discussed in Section 6.

2. Problem Formulation

2.1. AUV Model in Vertical Plane

The six degrees of freedom dynamic model of AUV can be decomposed into vertical plane motion and horizontal plane motion independently if some coupling constraints are satisfied. The depth control considered in this paper is a typical freedom in vertical plane, so before going on, we will give the AUV model in vertical plane borrowed from [4]where denotes the position and pitch of AUV in earth-fixed frame and represents the speed in body-fixed frame with being the transformation matrix from frame to . , , , and are the inertial matrix, Coriolis force matrix, damping matrix and gravity, and buoyancy generalized force vector with the following form, respectively:where is the combined moment of inertia with additional mass produced and the rotation inertia of the y-axis and is the rotation torque coefficient produced by rudder angle . Due to the fact that when AUV makes down steering which will produce the negative pitch angular acceleration , therefore, . denotes the control force and torque for AUV which will be designed in following sections to enable each AUV move at the desired depth.

From the above formulations, we can find that the diving equations of AUV motion should include the heave velocity , the angular velocity in pitch , the pitch angle , and the depth . Assume that the forward speed is constant and that the sway and yaw modes can be neglected, this suggests the following simplified equations of AUV motion in vertical plane aswhere denotes the bounded total modeling errors and external disturbance. Based on parameterized linearization techniques, the dynamic equation of pitch angular velocity can be rewritten aswhere

To be noted that, all the AUVs considered will be isomorphic in this paper, so for the sake of convenience, we omitted the index of the AUV number in the presentation of the model, and furthermore, in the implementing of the controller designing, we will make the following assumptions.

Assumption 1. The depth can be measured by a pressure meter and the pitch angle can be measured by an inclinometer while the pitch rate requires a rate gyro or a rate sensor. We also assumed that the velocities in the vertical plane can be measured by using a Doppler log for directly obtaining velocity measurements.

Assumption 2. The external disturbance is bounded by an unknown upper bound, and is bounded apparently. We assumed that , where to be the unknown upper bound of disturbance [17].

2.2. Extended Communication Graph

Assumed that there are AUVs in the group, it is a conventional way to model the interactions between them using directed graph adjacency matrix and topology graphs [18]. Firstly, we introduce a virtual AUV, denoted as , which specifically represents the desired state. For the AUVs system, the graph contains a set of nodes , and an adjacent matrix , where indicates that the th AUV can obtain state information from th, otherwise . Then we define a degree matrix with the elements . The Laplacian matrix of graph is expressed as and the normalized Laplacian matrix of is , where is the normalization of when ; otherwise [19]. If we add one virtual AUV to the group, then we call the graph as extended communication graph. An example of extended communication graph is given below; where Figure 1 is a topology graph with four nodes which contains three AUVs and one virtual AUV, its adjacency matrix, degree matrix, normalized adjacency matrix, Laplacian matrix, and normalized Laplacian matrix are, respectively,

Because the virtual AUV can not get any information from others, the row sum of the matrix is equal to 1, except for the first row. It is obvious that all the diagonal elements of are 1; we can know that is a diagonal dominant matrix, positive define, and reversible; its inverse matrix will satisfy with [20].

2.3. Basic Idea of Sliding Mode Control

Consider the following second-order controlled object [21]:where is nonlinear term, is external disturbances, and is the control input for the system.

Define tracking error aswhere is desired state value.

Sliding surface vector is defined as follows:where and satisfies Hurwitz condition. Then the basic idea of sliding mode control is how to derive the input determined by for the system to make and go to zero asymptotically.

2.4. Basic Principles of Coordinated Depth Control

Assume that there are AUVs in the group, and in the following sections, we will use a subscript to denote the index number of AUV. For multiple AUVs, we redefine each parameter as follows: is the depth of AUVs, respectively, and means depth of the virtual AUV, is the velocity of AUVs along x-axis, is the velocity of AUVs along z-axis, is the pitch angle of AUVs, is the angular velocity around y-axis, and is the rudder angle. To make each AUV track a common desired depth synchronously, the tracking error for th vehicle will be defined aswhere is the th element of the normalized adjacent matrix induced by the AUVs. According to the definition of normalized adjacent matrix in Section 2, the tracking error can also be described aswhere . Denote desired depth as ; then the collective depth tracking error of AUVs can be described aswhere . It is known from (8) that the dynamics of the depth can be also described aswhere with , with , and .

Assume that the depth tracking error will evolve with the following dynamics:where with being the positive gains. Then the tracking error will converge to zero exponentially at the rate of . This assumption is commonly used for error dynamic equations. Consider the following first-order homogeneous linear differential equation and its general solutions:where is a constant. Then solution (21) will be determined by the initial condition of (20) and .

That meansso the depth error converges to zero when tends to infinity.

Denote the desired pitch angle for each AUV as , then we can have

By simply calculations we can get assuming that , then .

Here we require ; otherwise, the objective of depth control cannot be achieved. In physical sense, this inequality constraint means the expectation of the depth changing rate of each AUV can not be greater than its total speed; moreover, consider the fact that we have assumed a linearization hypothesis of a pitching angle being as a small angle before, then characteristic of could be used here. Furthermore, by putting some saturation limit on we will have and the coefficient determines the range of the depth deviation limit, that is, when the depth deviation of th AUV is greater than , the pitch angle instruction will no longer be increased.

To make the desired pitch angle for each AUV to be more smooth, we will introduce a second-order filter to represent the dynamic relationship between and aswhere with and will be the desired pitch angle output for each AUV. The block diagram of this filter was shown in Figure 2.

As so far, the structure of depth control considered in this paper can be shown in the Figure 3, where we put forward a deep-pitch double loop control strategy with pitch angle controller as the inner loop and depth controller as the outer loop [22]. The desired common depth is initialized by the outer loop, and the according desired pitch angle is determined by the desired depth which means the input of the inner loop to be the output of the outer loop control, and the entire control system constitutes a closed-loop feedback structure.

3. Coordinated Depth Control without Model Uncertainties Based on Sliding Mode

To make the attitude of each AUV track the desired attitude derived in Section 2 before synchronously, define the th attitude tracking error as

According to the definition of normalized adjacent matrix , this attitude tracking error also can be described aswhere ; as an example of Figure 1, the synchronized attitude error will beso the attitude deviation of AUVs can be defined aswhere ; according to the definition of normalized Laplacian L, we can obtain

Nextly, we will show how to derive the control input for each AUV by using the coordinated error defined by (30). Before going on, define the linearized parameter vector and , then (9) can be rewritten as

According to the introduction of Section 2, define the sliding mode vector aswhere and is a design parameter with .

By simply calculations we will get the derivatives of (33):

Substituting (32) into (34), we can get

Choose the exponential reaching law aswhere and . Then the control law for AUVs can be proposed aswhere with .

Theorem 3. Consider the system composed by a fleet of AUVs of the form (8), guided by the slide mode control laws (37) with the sliding mode surface defined by (33). Then, the control system proposed solves the coordinated depth problem; that is, all the AUVs will move at the same common desired depth when this referred depth information can be available to at least one AUV and the graph induced by the AUVs has a directed spanning tree.

Proof. Consider the Lyapunov function candidate:The derivative of isSubstituting (34) into (39), we will haveand continuously substituting control law (37) into (40), we will getSimply manipulations will yieldAccording to Assumption 2, we know that , thus we can getAccording to Lyapunov stability theorem, the following two stability conditions will be hold asSo and will converge to zero asymptotically. Consequently, we will show that when the desired common depth information can only be obtained by at least one of the AUVs, all the AUVs can track this desired state coordinately; in order to do this, define the error between th AUV and the desired attitude angle asand the th sliding mode surface asconsequently introducing the auxiliary variables asSubstituting (48) into (47), the sliding mode surface can be rewritten asthen we can haveand rewrite (50) in a vector form withwhere and is the corresponding normalized weighted adjacency matrix. Considering the fact that the sum of first row elements of is 0 and other rows is 1 which means , then we will havewhich meansaccording to Section 2, we know that the Laplace matrix of the system is positive definite and reversible. So (53) will becomeAccording to (48), the time derivative of iswhere , and the vector form of (55) iswhere . By simply manipulations, we can getLemma 4. For the time constant  , define  ; the following inequalities will be hold:where is the maximum eigenvalue of , , , and , , .
Proof. The solution of (57) can be derived asConsidering the fact that the Laplace matrix of system is positive definite and is positive definite too. According to triangle inequality axiom of the matrix normwe will haveConsidering the following equation consequently:and we will getThis completes the proof, which indicates that the tracking error of the total system will converge to the neighborhood of the origin; that is to say, the pitch angle of each AUV can eventually reach the desired value, and simultaneously the each AUV will move at the common desired depth synchronously.

4. Coordinated Depth Control Design by Using Adaptative Sliding Mode with Model Uncertainties

In practical applications for AUVs, the parameters of the model always have uncertainties, which can affect the performance of the closed-loop system seriously. It is necessary to design control strategy to take into account these uncertainties which is the main contribution of this section.

Consider the control law described by (37) in the previous section; if the control gains , and the model parameters are not known, consider the following adaptive slide control law:where andwhere , , , , , and are design parameters and their diagonal elements are all positive.

Theorem 5. Consider the system composed by a fleet of AUVs of the form (8), guided by the slide mode control laws (64) with the sliding mode surface defined by (33) and adaptation law described by (65). Then, the control system proposed solves the coordinated depth problem; that is, all the AUVs will move at the same common desired depth when this referred depth information can be available to at least one AUV and the graph induced by the AUVs has a directed spanning tree.

Proof. Consider the following Lyapunov candidate function:where , , are estimation errors of , , and . The derivative of (66) can be derived asSubstituting (34) and adaptation law (65) into (67), we will getConsequently substituting control law (64) into (68), we can haveSimply manipulations will yieldAccording to Assumption 2, we can getand we can find for all . According to Lemma 4 consequently, we can know that there is a time constant which satisfiesand this completes the proof, so the system state would converge to the sliding mode surface in finite time, all errors converge to zero, and the closed-loop system is stable. Then the pitch angle of each AUV can eventually reach the desired value; meanwhile, all the AUVs will move at the same desired depth synchronously.

5. Simulation Results

In this section, we present simulation examples to validate the theoretical results proposed in this work. We consider a group of AUVs modeled by (8) with hydrodynamic parameters shown in Table 1.

The control law designed did not consider the input saturation, while the actual AUV always has a rudder angle limit and in this paper we assumed that . Choose the adaptive sliding mode controller control gains: , , , and , the initial depth of the three AUVs was 10 meters, 12 meters, and 8 meters, respectively, and the common desired depth is set to 20 meters. The simulation results are shown from Figures 49.

From Figure 4 we can see that all AUVs will move at the same common desired depth; specifically, the AUVs move to the desired depth more quickly under the control of adaptive sliding mode strategy. In the meantime, we can also find that the pitch angles of all AUVs can reach synchronization from Figure 5; moreover, when the AUVs move to the common desired depth, all the pitch angles tend to 0 degrees. Compared to the sliding mode strategy, the pitch angle of each AUV has a more quick convergent speed by using the adaptive sliding mode method. Figure 6 depicts the according rudder inputs for each AUV, and we can find that they also achieved synchronization behaviors. Figure 7 shows the evolving of the sliding mode surface of each controller; we can find that it will converge to zero in 12 and 6 seconds under the sliding mode and adaptive sliding mode, respectively, which shows the effectiveness of adaptive sliding mode strategy proposed specifically. Figures 8 and 9 show the coordinated tracking error of depth and pitch attitudes separately; they all tend to zero eventually.

In summary, due to the model parameter error, although the sliding mode control without adaptive mechanism is stable, there is always a steady-state error, and the adjustment time is also longer. With the introducing of adaptive parameter estimation algorithms, the system can estimate the linearization parameters online and converge to zero quickly. At the same time, it should be noted that the introducing of adaptive also makes the jitter frequency of the AUV rudder angle higher. This shows that the adaptive algorithm increases the system’s overshoot while improving the steady-state accuracy performance, but because the rudder angle converges quickly, it will hardly affect the stability of the system.

6. Conclusion

In this article, we discuss the coordinated depth control problem of multiple AUVs. We propose a distributed adaptive control law using the coordinated depth error based on sliding method; each AUV adopts deep-pitch double loop control. Our strategy is fully distributed because each controller only needs information of its neighbors and the desired common depth information can only be available to one subset of the AUVs. The uncertainty of the models is considered by adaptive laws. The stability of the control law proposed is analyzed and proved theoretically. The simulation results validate the effectiveness of algorithm proposed. We suppose that the topology between the AUVs is fixed and there are no communication delays. All the topics about multiple vehicles, such as dynamic changing topologies, time delays, and data dropouts, will warrant our future research.

Data Availability

The participant-level data of this work are the dynamic model parameters of AUV, which can be referred to Table 1 for details.

Disclosure

Yintao Wang and Yani Zhang are the co-first authors.

Conflicts of Interest

The authors declare that there are no conflicts of interest regarding the publication of this paper.

Acknowledgments

This work was supported by the National Natural Science Foundation of China via Grants 51209175 and 61472326.