Abstract

The formation control issue for a group of underactuated unmanned surface vehicles (USVs) is discussed in the paper, and a staged finite-time control strategy for the USVs is proposed. Firstly, we try to steer each USV to its own starting point in the formation for a limited time, under the initial condition that each of these vehicles is parked at random. To deal with the nonholonomic behavior of the system, the dynamics of the USV is transformed into cascade systems. Then, the finite-time controller is designed for each vehicle based on homogeneity theory. After each USV reaches its own starting point with desired orientation, the model of the vehicle is decomposed into two subsystems under the Serret-Frenet frame. In order to maintain the formation pattern, two finite-time distributed controllers are developed for the surge subsystem and the yaw subsystem, respectively. The settling time for the staged control strategy is limited. Numerical simulations are carried out to illustrate the effectiveness of the proposed formation control strategy.

1. Introduction

Over the last decade, a great attention has been paid by scholars on unmanned surface vehicles (USVs), which can be used to perform various tasks, such as marine surveillance, oil spill collection, environmental monitoring, bathymetric mapping, and marine floor investigation [1]. These tasks are usually complexity and onerous, which are difficult to do by a single vehicle. Multivehicle cooperation is the inevitable choice, which can not only accomplish the tasks efficiently but also ensure personnel safety, reduce system cost, and provide redundancy against individual failure. Typical cooperative control issues of multiagent systems include consensus, distributed tracking, formation control, containment control, swarming, and aggregation. In this paper, the formation control of multiple USVs is considered.

There are two main difficulties in the formation control problem of underactuated USVs, one of which exists in the motion control of each single vehicle. Most existing USVs are typical underactuated systems, whose number of actuators is fewer than their degrees of freedom (DOF). The trajectory tracking control of the underactuated USV is studied in [2, 3], and the virtual target is adopted to generate the reference trajectory. The path following of the underactuated USV is usually addressed by introducing the Serret-Frenet frame and global coordinate transformation [4, 5]. Then, the underactuated problem is converted to a virtual fully actuated problem by designing the virtual control law. For the stabilization of the underactuated USVs, nonsmooth or time-varying cascaded design is usually proposed due to the nonholonomic constraints [6]. Moreover, finite-time controllers are developed in [7, 8] via adding one power integrator technique and terminal sliding mode method, respectively.

Another difficulty is to maintain formation pattern of multiple USVs, which will encounter issues of communication and coordination. From a review of the literature, there are mainly four methods used for the formation control of multiple vehicles, including virtual structure method [9], graph theory method [10], behavioral based approach [11], and leader-follower strategy [12, 13]. Among these methods, the leader-follower strategy is most preferred in practice for the formation of USVs because of its high reliability and easily implementation [14]. A robust adaptive formation controller is proposed in [15] for the formation of USVs with uncertainties and ocean disturbances, where neural networks and dynamic surface control technique are used to capture them. In [16], a parameter estimation- and upper bound estimation-based sliding mode control scheme is presented to deal with the model uncertainties and environmental disturbances. The control constraint issues in the formation of underactuated USVs are also considered by many scholars. In [17], a formation tracking controller is developed by using generalized saturation functions to reduce the risk of actuator saturation. The receding horizon control algorithm is adopted in [18] for the formation tracking of a feet of underactuated autonomous underwater vehicles (AUVs) with constrained inputs. In [19], auxiliary dynamic systems and disturbance observers are designed to deal with input saturations and disturbances respectively, and a robust controller is developed for time-varying formation control of underactuated AUVs. The fault tolerant control problem in the leader-follower formation of USVs is considered in [20], while both parametric and nonparametric system uncertainties are discussed.

Another popular method for USV formation control is based on the graph theory, which is proposed to settle the consensus problem of multiagents. The literature [21] considers the cooperative control of a group of underactuated USVs using the relative information between neighbor’s information with the aid of results from graph theory and Lyapunov techniques. In [22], a distributed maneuvering controller of multiple USVs is designed in the presence of unknown state constraints. An RNN-based command governor is provided between the kinematic controller and the kinetics controller. A cooperative path maneuvering controller is designed based on a line of sight guidance scheme in [23], where the modular adaptive control method is employed to identify uncertain kinematics and unknown kinetics of each vehicle.

Currently, finite-time formation control of multiple USVs become an active research area, since a lot of works have been carried out in both the finite-time control of single USV [2426] and the finite-time consensus of multiagents [2729]. In [30], the finite-time formation control of underactuated USVs is investigated with consideration of model uncertainty and environmental disturbance. The reference trajectory of each USV is given first according to the desired geometric pattern. Then, a nonlinear controller with fractional power feedback is designed for each USV, to make sure each vehicle follows its own trajectory in finite time. In [31], the terminal sliding mode approach is used to deal with the finite-time formation of underactuated ships. Specifically, a generalized error which contains topology information of communication is defined so that the method based on graph theory can be used for the nonlinear system.

Motivated by the aforementioned works, the finite-time control for single USV and the finite-time cooperative control for multiple USVs are integrated is this paper. A staged finite-time control scheme is proposed for the formation of multiple underactuated USVs. Our major contributions are listed as follows:(1)To deal with the underactuated nature and achieve the goal of finite-time convergence, we mainly separate the formation control process into two stages. In the first stage, we try to steer each USV to its own starting point in the formation configuration for a limited time. In the second stage, the formation pattern is maintained by using two finite-time cooperative controllers. As a consequence, the resulting control scheme can guarantee finite-time convergence.(2)In the first stage, the positioning problem of every single underactuated USV is regard as a finite-time stability problem of the homogeneous system. Homogeneous theory is applied in the control design, to make each vehicle get to its own position in the formation pattern.(3)In the second stage, the model of each USV can be decoupled into two subsystems with a series of integrators: the surge subsystem and the yaw subsystem. Taking communication link topology into account, two finite-time cooperative controllers are designed based on graph theory to maintain the formation pattern.

The remainders of the paper are organized as follows. In Section 2, preliminaries and problem formulation are introduced. Section 3 presents the main results on the staged control algorithm design, where finite-time control for single USV is designed in Section 3.1 and finite-time cooperative control for formation maintenance is given in Section 3.2. In order to illustrate the effectiveness of the proposed control laws, numerical simulation results are presented in Section 4. Finally, some conclusion remarks are drawn in Section 5.

2. Preliminary

In this section, theories of finite-time stability, homogeneity, and algebraic graph are introduced briefly, and some lemmas are given. Then, the kinematics and dynamics of the underactuated USV are provided, and the task of formation control for multiple USVs is summarized.

2.1. Finite-Time Stability and Homogeneity

Both asymptotic stability and finite-time convergence of the closed-loop system are required in our design, which leads to the conception of the finite-time stability.

Definition 1. Consider the systemwhere is continuous. Assume that, for every initial condition , system (1) possesses a unique solution in forward time which is defined on . The origin is said to be a finite-time stable equilibrium of (1) if there exists an open neighborhood of the origin and a function called the settling time function such that the following statements hold:(1)For every , (2)The origin is said to be a globally finite-time stable equilibrium if it is a finite-time stable equilibrium and .
In general, there are three techniques which can be used to achieve finite-time stability for the feedback stabilization, including homogeneous theory, terminal sliding mode method, and adding one power integrator approach [32]. In this paper, nonsmooth feedback finite-time controllers are designed with the help of the homogeneous system.

Definition 2 (see [32]). Consider the dilation of the form , where are suitable coordinates on and are positive real numbers. A vector field is homogeneous of degree if and only if the component is homogeneous of degree . System (1) is said to be a homogeneous system if its vector field is homogeneous.
The connection between the finite-time stability and the homogeneous system is concluded in the following two lemmas.

Lemma 1 (see [32]). For system (1), suppose there exists an open neighborhood of the origin, a positive definite function , and real number and , such that is negative semidefinite on . Then, the origin is a finite-time stable equilibrium of the system.

Lemma 2 (see [32]). Suppose that system (1) is homogeneous of degree with respect to , the origin is a finite-time stable equilibrium of (1) if and only if the origin is an asymptotically stable equilibrium of (1) and .
Consider the following chain of integrators:

System (2) is finite-time convergent to the origin if the control input is designed aswhere the exponents , are selected satisfying

The item is defined as , where is the sign function. The gains , are selected such that the following matrix is Huiwitz:

Define the Lyapunov function candidate with . and are symmetric positive definite matrices satisfying

Lemma 3 (see [33]). Consider system (2) together with (3). The state converges to the origin for a finite time. Moreover, the upper bound of the settling time can be estimated asfor all in some open neighborhood of the origin, where . is the minimum eigenvalue of the matrix , and is the maximum eigenvalue of the matrix .

2.2. Graph Theory

The communication links topology among the group of NSVs can be represented by a graph , where is the set of vehicles, represents the set of links between the vehicles (also called edge set), and is the weighted coefficients of edge set . In the directed graph, represents the vehicle can communicate with vehicle, but not conversely. The vehicle is called the parent node, and the vehicle is also called the child node of the vehicle, and they are neighbors. In the undirected graph, denotes the information can be exchanged between the two vehicles. All vehicles are connected with a single undirected path. However, in the directed graph, each vehicle has only one parent node, except for one vehicle, which is called the root. If vehicles are in the scenario, then the associated adjacency matrix of can be defined as . if and only if there is a link from vehicle to vehicle; otherwise, . The Laplacian matrix associated with the matrix is defined by and , when . The Laplacian matrix can be written as , where is the degree matrix [34].

Consider a virtual leader moving with the group centroid. Define the augmented graph as , where and are the new node set and edge set, respectively. Diagonal matrix is called the leader adjacency matrix, where if follower is connected to the leader; otherwise, . In this work, the communication topology verifies the following assumption.

Assumption 1. The graph associated with the follower is undirected, and in the graph the leader has directed path to all followers.

Lemma 4 (see [35]). Under Assumption 1, is a symmetric positive definite matrix.

2.3. Mathematical Model of Underactuated USV

Two reference coordinate systems are defined to describe the model of the USV, where XEOEYE is the earth-fixed inertial frame and XbObYb is the body-fixed frame, as shown in Figure 1. The model state of the USV in horizontal plane is given by , where , , and denote the position and orientation of the vehicle in the earth-fixed frame, , , and denote the surge, sway, and yaw velocity of the vehicle in the body-fixed frame, respectively.

Based on the above definition, the kinematic model of the USV can be described as

And the dynamic model of the USV can be given bywhere are the hydrodynamic damping of the vehicle and are the inertia of the vehicle including added masses in surge, sway, and yaw. Besides, is the hydrodynamic added mass and and are the surge force and yaw moment, respectively.

It can be seen from (9) that the USV can only get the surge force and yaw moment from the thrusters and the rudder in the stern, and there is no sway force from the vessel thruster, so the vehicle is a typical underactuated system.

2.4. Formation of Multiple USVs

Consider a group of USVs, whose mathematical models are expressed as (8) and (9). For clarity, the subscript “” () is used to distinguish one from another. Such as, the state of the USV is denoted by . Assume that all the USVs are scattered randomly in the water at any initial states. The goal of this work is to steer these vehicles to achieve the prescribed formation pattern along a given straight line or arc path with a desired speed. Moreover, the settling time is required to be finite. Without loss of generality, the earth-fixed frame is defined with its origin located on the center of the formation at starting point. The XE-axis coincides with the tangent of path with the positive axis pointing to the motion direction of the group, as shown in Figure 2.

A feasible desired trajectory can be described by the states of the group centroid which is moving along the path. The object of the control system can be expressed as follows.In the first stage:In the second stage:

where are the relative position and orientation of USV to the group centroid, are longitudinal and transversal displacements of USV with respect to the path, and are the longitudinal and transversal distances between USV and the group centroid.

3. Staged Control Design for the Formation of USVs

For formation control of the USVs, vehicles should be forced to achieve the desired formation firstly and then maintain the geometric configuration. Consequently, the proposed control strategy includes two stages. In the first stage, each vehicle is steered to its own position in the formation pattern within a finite time. After that, the dynamics of the underactuated USV can be transformed into two integrator systems. In the second stage, two finite-time cooperative controllers are employed to maintain the formation shape and guarantee the stabilities of the systems.

3.1. Finite-Time Control for Single USV

In this stage, each vehicle is controlled separately to reach its initial position in the formation. We hope that this process could be completed in a limited time. For the underactuated USV , its desired pose vector to the group centroid is . We can transform the set point tracking problem of USV to the stabilization problem by defining the following new state variables:

Then, the kinematic equation of USV can be rewritten as

Since the mathematical model of the underactuated USV is a typical nonholonomic system, the following global coordinate transformation is employed before control design [36]:where represents the new input transformation pattern. Thus, system (13) together with (9) can be transformed into

Remark 1 (see [36]). The system stabilization problem in (13) and (9) is equal to systems (15) and (16). If system (16) is global asymptotic convergent within finite time, the overall system of (15) and (16) is global asymptotic convergent.

Remark 2. As and can be converted to each other, just need to be designed to make variables asymptotically converge to zero, which means that the tuple converges to . That is to say, the USV has arrived to its initial place in the formation pattern with desired orientation.
In view of the above remarks, our objective has shifted from set point tracking for each USV to simply stabilizing system (15). Note that this system does not satisfy Brockett’s necessary condition. Hence, we divide system (15) into two cascade subsystems and try to provide a discontinuous control law. Suppose is not zero at the initial time, such as . The first cascade subsystem is given as the follows:where . The finite-time control law is designed aswhere the exponents are selected as . The gains are selected to satisfyThus, is the settling time which can be calculated bywhere and . According to Lemma 3, the feedback control law (18) presents a homogeneous closed-loop system with negative degree of homogeneity. Thus, the states and of system (17) reach to zero in finite time; then, would not affect system (17) any more. Moreover, can be designed independently for the second cascade system:After time , we havewhere the exponents are selected as . The gains are selected to satisfyThus, is the settling time which can be calculated bywhere and . By using Lemma 3 again, the control law (22) makes the states and of system (21) converge to zero in finite time.
After that the states of (15) converge to zero, system (16) is also asymptotically stabilized according to Remark 1. Actually, system (16) is simplified to first-order systems, whose settling time periods are and . We letSo, the final convergence time of all USVs is calculated asThat is to say, all USVs can arrive to their positions in the formation pattern after time .

3.2. Cooperative Control for Formation Maintenance

The goal of the second stage is to maintain the formation pattern by means of finite-time distributed control. It is assumed that only local distributed state information would be utilized by each vehicle to make its own surge velocity and yaw angular consistent with others. Consider a virtual leader moving with the group centroid, labeled 0. The communication graph among the vehicles and the virtual leader satisfies Assumption 1.

After the first stage, the group of USVs has come into a prespecified geometric pattern with desired yaw angular. A reference path is previously specified for the centroid of the group which must be followed by the group of the USVs, as shown in Figure 3. The kinematic model of each vehicle can be rewritten according to the Serret–Frenet frame. Suppose that there is a virtual S-F frame XtO0Xn moving along the path for the virtual vehicle 0. The kinematics of vehicle expressed in new state coordinates is [37]where and is the curvature of the path which is constant for the straight line or arc. Since each vehicle is on its own path and tangent to it at the initial moment, we assume that and . We define

Then, the dynamics of vehicle can be decoupled into two subsystems: the surge subsystemand the yaw subsystem

Suppose that are not zero. The cascade subsystem (29) can be written aswhere . The finite-time distributed protocols based on the relative position and relative velocity are designed aswhere the exponents are selected as . The gains are selected such that are Hurwitz polynomials.

Similarly, are assumed to change slowly and not zero. The cascade system (30) can be written aswhere . The finite-time distributed protocols based on the relative position and relative velocity are designed aswhere are selected as . The gains are selected such that are Hurwitz polynomials.

The main result is given by the following theorem.

Theorem 1. Under Assumption 1, protocols (32) and (34) can guide system (31) and (33) to realize finite-time consensus, respectively.

Proof. For systems (33) and (34), define the error states asDenoting , it is straightforward to express the error dynamics aswhere , and , denotes .
LetConsider a Lyapunov function candidate , where . It is obviously that is a Hurwitz satisfying the Lyapunov equation , where . Since is a symmetric positive definite matrix, the Lyapunov equation holds with , which means that is a Lyapunov function for the linear system .
From the proof of Theorem 1 in [33], we can see that is a Lyapunov function for system (36), where . So, system (36) is asymptotically stable. Moreover, it can be verified that system (36) is a homogeneous system of degree . Hence, by Lemma 2, system (36) is finite-time convergent to the origin. It follows that the finite-time consensus problem of system (33) with protocol (34) is solved.
The finite-time consensus of system (31) with protocol (32) can be proved similarly. Theorem 1 is proven.

4. Numerical Simulation and Results

To illustrate the effectiveness of the proposed control law, a simulation study based on the model is presented in [15]. The same model parameters are chosen as in [38] and given as follows: , , , , , , and .

Without loss of generality, in our simulation scene, we assume that there are only 3 USVs in the formation. Consider the fact that not all the follower vehicles can receive information from each other, but all of them can directly communicate with the “virtual leader,” as depicted in Figure 4. In addition, their initial conditions and the desired positions and orientations of each USV in the first stage are listed in Table 1.

According to the setting of aforementioned scenario, the adjacent matrix , the degree matrix , the Laplace matrix , and the leader adjacency matrix can be deduced as follows:

The expected path of the group centroid is given as a circle with radius 100 m. Thus, the expected paths for USV1, USV2, and USV3 are concentric circles with radius 90 m, 100 m, and 110 m, respectively. According to the design guideline, the control parameters are chosen as listed in Tables 2 and 3.

The final convergence time of the first stage for all USVs is selected as 150s, which is more than the sum of , , and . In the second stage, we assume that there is a virtual leader moving along the path with a fixed velocity .

The simulation results are shown in Figures 58. Figure 5 shows the formation trajectory of the USVs under the proposed control scheme. It can be seen that each of the USVs could arrive at their own starting points in formation first and then could track the desired paths and maintain the triangular pattern well.

Figure 6 shows the curves of the states and control inputs of the USVs. It can be observed that, in the first stage, the positions of the USVs converge to the expected values within about 40 seconds, before the first switch of the control algorithm. And then the orientations of the USV converge to the expected values within about 140 seconds, which is also before the second switching time of the control algorithm. The control inputs of the USVs are depicted in Figure 7. In the first stage, the exponents have great influences on the convergence time. A good choice of them can greatly reduce the settling time of stage one. In the second stage, the feedback gains of the yaw subsystem are usually selected to more than the gains of the surge subsystem , to make the USVs on their paths.

Figure 8 shows the errors of the longitudinal displacement and the transversal displacement between the follower vehicles and the leader vehicle. The cooperative control starts working after which every USV gets to its own start points. Therefore, the time starts at 150 seconds and the errors of the displacements are constant, which means that the formation of the USV is kept well.

5. Conclusion

A formation control strategy based on finite-time control and leader-follower theory is proposed in the paper to achieve formation maneuver control for USVs. The formation control process is divided into two stages. In the first stage, all the USVs would be steered to their starting points in the formation pattern in finite time. Then, in the second stage, all the vehicles would be controlled to maintain the formation pattern based on finite-time distributed cooperative control. By using tools from homogeneous theory, it is theoretically shown that the proposed protocol can guarantee finite-time converge and consensus, respectively. Numerical simulation is made to illustrate effectiveness of our strategy.

Data Availability

The data used to support the findings of this study are available from the corresponding author upon request.

Conflicts of Interest

The authors declare no conflicts of interest.

Authors’ Contributions

X. Y. and H. Y. conceptualized the study; H. Y. and X. Y. developed methodology; C. G. and H. Y. developed software; C. G. and Z. D. carried out formal analysis; C. G. investigated the study; H. Y, C. G., and X. Y. wrote the original draft.

Acknowledgments

This work was supported in part by the National Natural Science Foundation of China under Grant 61903163, Natural Science Foundation of the Jiangsu Higher Education Institutions of China under Grants 18KJB520010 and 19KJB510023, Jiangsu Province Postgraduate Innovation Plan under Grant 1032161916, and Zhenjiang Key Research and Design Project under Grant GY2018026.