1. Introduction
In recent years, with the continuous development of unmanned surface vehicle (USV) swarm coordination technology, the formation technology of multiple USVs has been increasingly applied in fields such as marine data collection [1], collaborative search and rescue [2,3], cooperative escorting [4], and collaborative transportation [5]. During the execution of various formation tasks by multiple USV clusters, collision avoidance among USVs, as well as avoidance of obstacles such as reefs, buoys, and ice floes on the sea surface, is a fundamental requirement [6,7,8,9,10]. Currently, substantial research has focused on collision avoidance within multi-USV formations [8,11,12,13,14]. Little attention has been paid to collision avoidance strategies for a specialized type of USV operation, known as formation-containment tracking. Consequently, devising effective strategies for these formation-containment tracking scenarios is a critical issue in ongoing multi-USV studies.
To achieve collision avoidance in a multi-USV formation, a variety of formation strategies could be considered. The leader–follower formation method based on consensus, due to its reliability and practicality, has been widely applied. In recent years, this approach has seen a wealth of developments [15,16,17,18,19,20,21,22,23,24]. Ren et al. [15] specifically devised a consensus-based formation control algorithm for second-order multi-vehicle systems, which means vehicle dynamics can be simplified to second-order integrator dynamics. Taking into account the practical engineering constraints on each agent’s input driving force and motion velocity, Fu et al. [18] designed a leader–follower formation strategy with limited velocity and control inputs. Huang et al. [19] introduced a fixed-time USV leader–follower formation method representing a faster and more practically viable control strategy. Tang et al. [20] proposed a flexible serial formation protocol, based on the estimation of narrow waterways’ curvature using an observer, to enable a USV fleet to navigate through narrow and winding waterways. Although the single leader–follower formation method is effective in some cases, it often falls short in accommodating large-scale USV formations or managing complex tasks. To enable systems to incorporate more USVs and undertake more complex tasks, a hierarchical concept emerged: formation containment. This approach enhances the conventional leader–follower structure by introducing three distinct roles: the highest-ranking virtual leader, the mid-ranking real leader, and the lowest-ranking follower. In this hierarchy, information flows unidirectionally from higher to lower ranks, with followers being specifically designed to converge within the convex polygonal regions formed by real leaders, thus enabling the handling of more complex operational tasks [25]. Hua et al. [26] developed a control protocol enabling linear multi-agent systems to achieve formation-containment tracking despite the leader’s input being unknown. Wang et al. [27] introduced an innovative USV formation-containment strategy that employs a robust integral observer to estimate disturbances stemming from natural interferences and model uncertainties, complemented by an adaptive law specifically designed to offset actuator malfunctions. Hao et al. [28] has adopted a pioneering adaptive parameter fine-tuning strategy, which, even in the face of unknown global data and external disturbances within dynamically changing communication structures, can still precisely coordinate and maintain the stability of large-scale unmanned surface vessel (USV) formations. In actual marine settings, USVs are subject to various types of couplings, including dynamics and communication, complicating the control challenge. Liu et al. [29] introduced a sophisticated two-layer control framework, where the upper layer orchestrates formation containment using a fully actuated third-order integrator model, subsequently transmitting the generated trajectory to the lower layer in real time, and the lower layer leverages sliding mode control to enable under-actuated USVs to track the trajectory promptly, achieving effective formation containment. The hierarchical structure of formation containment offers new possibilities for addressing large-scale and complex tasks, while it also imposes novel requirements on collision avoidance strategies.
Collision avoidance is an indispensable aspect of any collaborative task involving USV swarms [30,31,32]. The artificial potential field method, a notable strategy for collision avoidance, effectively synergizes with the consensus formation of multi-vehicle systems [8,11,12,13,32,33,34,35]. Aranda-Bricaire et al. [11] developed an approach using repulsive vector fields (RVFs) grounded in the repulsive potential function (RPF) to facilitate collision-free formations in second-order multi-agent systems with input force and velocity constraints. Park et al. [13] advanced a multi-USV formation strategy that simultaneously addresses connectivity maintenance and collision avoidance, utilizing an innovative additional potential function to avert collisions. Ghommam et al. [12] proposed a practical approach for collision-free distributed formation control of under-actuated USVs, leveraging the repulsive potential function technique to enhance practical engineering applicability. Nevertheless, in collision avoidance tasks, distance plays a crucial role, especially the triggering distance for collision avoidance and the minimum safety distance. In these aspects, the control barrier function (CBF) method surpasses the artificial potential field (APF) approach, proving to be more aligned with practical collision avoidance applications. Firstly, regarding the criteria for triggering collision avoidance mechanisms, the APF method relies on a fixed triggering distance, initiating maneuvers based solely on proximity to obstacles. In contrast, the CBF method introduces a hazard coefficient as the trigger condition, closely tied to the relative distance and velocity between the USV and the obstacle. This meticulous consideration of dynamic factors ensures a more responsive and adaptable collision avoidance strategy. Secondly, there is a significant difference in how the two methods handle the minimum safety distance, typically set as the sum of the radius of two potentially colliding bodies. The APF method does not impose actual constraints on the obstacle’s radius, potentially leading to scenarios where the USV intrudes into the obstacle boundary without proper parameter adjustment, posing a high risk in practical operations. On the other hand, the CBF method, by leveraging forward safety sets to explicitly define the obstacle radius, effectively eliminates the risk of USV intrusion into obstacle areas, thereby enhancing the system’s safety and practicality. This makes the control barrier function (CBF) approach significantly more effective and friendly in collision avoidance in formation-containment tasks. Several notable accomplishments have been achieved using the control barrier function method for collision avoidance [36,37,38,39]. Gao et al. [36] implemented multi-target tracking for USVs by integrating the CBF with an extended state observer. Gong et al. [37] developed a technique employing a guiding vector field to steer the desired heading angle for reorganizing multi-USV formations and target tracking, concurrently utilizing a fixed-time CBF approach to evade both static and dynamic obstacles. Notably, Fu et al. [38] proposed a collision-free formation tracking method for second-order multi-agent systems that simultaneously considers connectivity maintenance and constraints on control inputs and velocity.
However, to our knowledge, the adoption of the CBF method for achieving collision-free multi-USV formation-containment tracking remains relatively unexplored. While the pioneering two-layer control framework in [16] presents a groundbreaking solution for such tasks, we believe there is still potential for refinement, especially within the upper distributed coordination layer. Here, the challenge of efficiently managing a fully actuated second-order point mass under velocity and input constraints for collision-free formation-containment tracking offers substantial scope for innovation. This paper concentrates on these areas, advancing the field with the following additional work and novel contributions:
1.. Expansion of the leader–follower controller: Based on the practical second-order leader–follower formation tracking controller introduced in [18], this study expands the leader–follower controller to a formation-containment tracking controller that considers constraints on movement velocity and input driving force. Serving as the nominal controller in the distributed cooperative layer, it coordinates multi-USV collision-free formation-containment tracking tasks. Furthermore, the controller’s asymptotic stability is demonstrated using the Lyapunov method. This hierarchical structure allows for the execution of more complex and flexible tasks, offering higher adaptability for complex maritime operations.
2.. Implementing collision avoidance with zeroing control barrier functions: In this paper, zeroing control barrier functions are utilized within the distributed cooperative layer. When the collision risk coefficient of any USV falls below zero, the system triggers a quadratic programming solution that subtly alters the existing nominal controller, thereby efficiently and safely facilitating collision avoidance. This paper takes into account collision avoidance among vehicles with different roles in USV formation-containment tracking tasks, as well as between the USV fleet and static maritime obstacles. This enhances the adaptability and flexibility of USV fleets in avoiding collisions.
The remainder of this paper is organized as follows: Some lemmas, preliminaries, and the problem formulation are given in Section 2. Section 3 is split into two parts. In one part, the formation-containment tracking nominal controller is presented, whose velocity and input force are constrained. And the obstacle avoidance and collision avoidance strategies are given in the other part. In addition, a simulation example is given is Section 4. Finally, Section 5 makes some collations and conclusions.
2. Preliminaries and Problem Formulation
In this section, the relevant theories used in this paper are presented in four sub-modules: Section 2.1 introduces the two-tier control framework. Section 2.2 discusses the fundamentals of graph theory. In Section 2.3, the system studied in this paper, including some assumptions and lemmas, is described. Section 2.4 details the application of control barrier functions.
2.1. Dual-Layer USV Collaborative Motion Control Framework
Due to the inherent complexity of directly applying the three-degree-of-freedom (3-DOF) motion model for coordinated control of unmanned surface vehicles (USVs), especially when multiple USVs are performing in surface coordinated movements, tight dynamic coupling issues are encountered. Furthermore, the single USV three-degree-of-freedom (3-DOF) motion model examined in this paper is under-actuated, meaning that the model has fewer control inputs than degrees of freedom (or state variables). This under-actuation presents challenges that must be addressed during the control process. To overcome these difficulties, inspired by [29], this paper adopts a dual-layer USV fleet cooperative motion control framework, as shown in Figure 1. The upper layer is the distributed cooperative layer; each vehicle in this layer is abstracted as a mass point with limited input driving force and motion speed, described by a second-order integrator motion model. Without considering the influence of wind, water flow, and the movement of other vehicles, the formation-containment task is completed by the distributed consistency control strategy, and the motion reference trajectory generated by each vehicle is transmitted to the lower layer. The lower layer is the local dynamic control layer, which employs the nonlinear sliding mode method [29] to control the movement of an individual three-degree-of-freedom (3-DOF) unmanned surface vehicle (USV) motion model, performing real-time tracking based on the real-time reference trajectory generated by the corresponding vehicle in the upper layer. To achieve this objective, the three-degree-of-freedom dynamic model is employed. This model is described by the following equations, which delineate the motion of any unmanned vehicle i within the cluster [28]:
(1)
where represents the position of vehicle i’s center of gravity; represents the heading angle of the vehicle; , , and represent vehicle i’s forward speed, sway speed, and yaw rate, respectively; “, , and ” represent the inertia parameters of vehicle i in three coordinate directions, which can be calculated using a semi-empirical method; “, , and ” represent the components of the fluid damping experienced by vehicle i on the water surface in three coordinate directions; and represent the control input forces of vehicle i, which are thrust for forward motion and torque for turning, respectively.Although the precise dynamic modeling of the lower control layer is crucial for overall system performance, this study primarily focuses on the upper layer, the distributed cooperative layer. Within this layer, the work presented here is dedicated to generating real-time reference trajectories for each unmanned surface vehicle (USV).
2.2. Graph Theory
The topology structure of M USVs (unmanned surface vehicles) is often expressed by a digraph , where represents the set of nodes, is the set of edges, and stands for the adjacency matrix. It is assumed that is an edge of G, and there is a directed path from to if . It is assumed that if and only if , and otherwise. The neighbors of i are represented by , where . Let diagonal matrix , where . Laplacian matrix L is defined as . If a root node has directional paths to all other nodes, the directional graph is said to contain a spanning tree. To illustrate the concepts mentioned above, the following Table 1 provides an example to aid understanding.
2.3. Formation-Containment Tracking Task
The system composed by USVs is considered. The USVs in the system can be divided into three categories, namely, the virtual leader or tracking leader, the real leaders or formation leaders, and the USV followers, as shown in Figure 2. The reference trajectory for the macroscopic motion of the entire multi-USV system is generated through the virtual leader, which is numbered 0. And the real leaders, which are numbered , are required to track the trajectory while completing the specified formation shape. Note that the formation shape in this paper is not time-varying. The followers need to converge to the convex hull formed by the real leaders, which are numbered . The information exchange among USVs is described by digraph G. The virtual leader has no neighbors, while a real leader can receive information from the virtual leader or the other real leaders, and a follower can receive information from the real leaders or the other followers.
The dynamics of the virtual leader in the distributed cooperative layer for the USVs can be expressed as follows, satisfying both the velocity and input constraints:
where ; and are the position vector and the velocity vector of the vitual leader; is the desired velocity signal of the vitual leader; and , where and are the minimum and the maximum values of the velocity of the virtual leader.The dynamics of the ith USV can be described by
(2)
where , , and are the position vector, the velocity vector, and the control input vector for each agent, respectively. The formation of the real leaders can be described by , where . represents the relative position vector between formation leader i and the virtual leader.For directed graph G of the communication among virtual leader and real leaders, there is a spanning tree, and the root node is the tracking leader.
For each follower, there is at least one real leader who can reach it through a directed path.
According to the topology characteristics of multi-USV systems, Laplacian matrix can be represented as
(3)
where , , , and .Let and , where if the virtual leader directly interacts with real leader i, or otherwise, and represents the Laplacian only among the real leaders, which ignores the virtual leader and the communication links it emits.
Let , where each represents the communication connection relationship between the ith real leader and all the followers. Similarly, let , where represents the Laplacian only among the followers, which ignores the real leaders and the communication links they emit, and each .
To facilitate the proof in the next section, the following lemmas and definitions are given.
([40]). If assumption 1 holds, then is of full rank. And there is a diagonal matrix , such that matrixes Q and satisfy , where .
([41]). If assumption 2 holds, then is of full rank. There is a diagonal matrix , such that matrixes P and satisfy , where .
([42]). If assumption 1 holds, then all eigenvalues of have positive real parts.
([43]). If assumption 2 holds, then all eigenvalues of have positive real parts, and the sum of each row of equals 1. Additionally, every element of is non-negative.
For the real leaders, if
(4)
then the real leaders are considered to have completed the formation tracking task.For the followers, if there is a set of non-negative constants satisfying , and if the equation
(5)
holds, then the followers are considered to have completed the containment task.If conditions (1) and (2) hold, then system (3) is considered to have completed the formation-containment tracking task.
In addition to the formation-containment tracking target, obstacle avoidance and collision avoidance are also the key concerns of the system in the process of completing the tasks. To ensure the normal execution of system tasks, firstly, a nominal controller which can perform the task of formation-containment tracking while constraining the input as well as the velocity of each USV is designed; secondly, various possible collisions will be presented as constraints to keep the system safe.
2.4. Collision Avoidance Using Control Barrier Function (CBF) Method
To ensure collision-free states in a dynamical system, we focus on systems of the form , where represents the system states and denotes the control inputs. Safety set S is defined using a zeroing control barrier function (ZCBF), which guarantees that the system states always remain within this set. Lemma 1 outlines the approach to achieve this goal.
([39]). For a given ZCBF candidate h that meets specific conditions, any Lipschitz continuous controller u: ensuring will maintain system states within safety set S and ensure asymptotic stability in d.
Furthermore, to guarantee the forward invariance of safety set S, the following inequality must be satisfied:
(6)
where and and represent the Lie derivatives of .3. Main Results
In this section, a formation-containment tracking strategy based on neighbor information exchange is presented in part A. This controller is then constrained to avoid obstacles when necessary based on a control obstacle function in part B.
3.1. Formation-Containment Tracking Strategy
We consider the following dynamic system:
(7)
where . If the system satisfies the initial condition , then the constraint will hold all the time. At the same time, the acceleration of the system is also constrained.We suppose that the lemma is not true, which means that for a period of time . We assume that and . According to the Lagrange mean value theorem, there exists a time such that . However, since , we have . Therefore, the hypothesis is not valid. And ; by choosing , the acceleration of the system will be constrained. □
We consider the following nominal controller:
(8)
where , , ; is the upper bound of the driving force; and represent the upper bound and the lower bound of the velocity of every single USV, respectively; , ; and represents the ultimate mean velocity.Based on Lemma 6, multi-USV system (2) can solve the formation-containment tracking problem while the system is constrained in velocity and input under protocol (8), where , , .
First, the demonstration of the consistency between virtual leaders and real leaders is as follows.
The dynamic equation of Virtual Leader 0 is , where and ; it requires that and .
For the real leaders, we let
(9)
denote the error in the tracking formation.Differentiating these two error quantities with respect to time t yields
(10)
We let and and rewrite (10) in vector form as
(11)
where . We let ; then, it follows that(12)
By moving the term to the left side and letting , it follows that
(13)
Then, we multiply both sides of (13) by the term and let .
(14)
Matrix can be represented as , where . Due to , expresses the same virtual leader–real leaders communication connection as . By using Lemma 2, there are , which satisfy that and .
We consider the Lyapunov candidate function . We differentiate the function along the trajectory of (14) to obtain
(15)
where we use the fact that . If is equal to 0, then is equal to 0. If not, then , which means that is equal to 0 in a finite time. Since , it leads to and as . And the system has completed the formation tracking task in a finite time. Then, it will be demonstrated that containment control can be achieved. For the real leaders, it follows that , where , which requires that . For the followers, we let(16)
denote the error in containment.We let and . We rewrite (18) in vector form as
(17)
where , .By substituting into (19), it follows that
(18)
where .By rearranging the terms, we can derive
By letting , it follows that
(19)
Matrix , where . Similarly, because of , expresses the same real leader–follower communication connection as . By using Lemma 3, there are , which satisfy that and .
Now, we consider the Lyapunov candidate equation and differentiate the function along the trajectory of (18) to obtain
We utilize the property of , where each . It derives
(20)
where we use the fact that . If is equal to 0, then is equal to 0. If not, then , which means that is equal to 0 in a finite time. That means that and as . And the system has completed the containment task. Thus, the formation-containment tracking problem is solved. □The nominal controller of the system is designed by Lemma 6 to conform to the basic form where the velocities and control inputs are constrained. Real-time information exchange among the USVs is then used to achieve distributed control. To better alleviate to system jitters caused by nonlinear terms and to better achieve consistency, we may replace the sign function with (21) in practical applications.
(21)
3.2. Barrier Function-Based Collision Avoidance Controller
In the actual multi-USV system, the acceleration and velocity of USVs are limited. This should also considered in the distributed cooperation layer. Considering the difference between leaders and followers, it is assumed that the real leaders’ velocity () and acceleration () are limited by and , which means that and . Similarly, the followers’ velocity () and acceleration () satisfy and . The controller of each agent is designed as , where satisfies the control input of the safety set. Next, the security zone needs to be divided.
For convenience, the USVs and obstacles in the distributed cooperative layer are regarded as circles when dealing with obstacle avoidance and collision avoidance. Taking into account the difference between the USVs and the obstacles, it is supposed that the radius of the USVs is and that the radius of the ith obstacle is .
It is assumed that the safe distance among the USVs is , where . Considering the collision avoidance requirements, the distance between any two USVs must be satisfy all the time, where . For a pair of USVs i and j, where , the velocity difference can be expressed as .
The collision avoidance maintenance condition is converted into the forward invariance of some sets. A comprehensive consideration of possible collisions throughout the system has led to the classification of collisions into four scenarios.
For each USV, the convergence position satisfies the safety distance requirement under a fixed topology. That means that , where , and .
-
1.. Case 1: First, we consider avoidance among the followers. According to the derivation similar to [39], collision avoidance set of USV i can be expressed as
(22)
where and(23)
where is the level set function of set . This means that when a collision between two USVs is about to occur, each of the two USVs will prevent the collision with its maximum acceleration. Additionally, the forward invariance of will be ensured if the ZCBF constraint in (6) is satisfied. By combining (6) and (23), the following inequality can be obtained:(24)
where . It can also be written in the following form: where . Thus, we can constrain the safety barrier of USV i and j distribution as(25)
Constraint (25) can be written in the linear form for each follower, where and .
-
2.. Case 2: Similarly, taking into account collision avoidance among real leaders, the following safety set can be obtained:
where and(26)
Then, the linear constraint can be obtained as for each real leader, where and . Since the virtual leader is not real, there is no need to consider its collision avoidance.
-
3.. Case 3: For a follower i and a real leader j, the collision avoidance set is
where , , and(27)
The linear constraint can be obtained as , where and .
-
4.. Case 4: In addition to collision avoidance among USVs, collision avoidance between obstacles and USVs should also be taken into consideration. It is assumed that the safe distance between an USV i and an obstacle is , where . Considering the collision avoidance requirements, the distance between any USV and any obstacle must satisfy all the time.
First, considering collision avoidance between obstacles and followers, the safety set between a follower USV i and an obstacle is represented by the following expression:
where and(28)
where is the level set function of set . This means that when a collision between an USV and an object is about to occur, the USV will prevent the collision with its maximum acceleration. The velocity () and acceleration () of the obstacles can be detected by sensors mounted on the USV. Furthermore, the static obstacles can be regarded as special cases of the dynamic obstacles with zero velocity and acceleration. Additionally, the forward invariance will be ensured if the ZCBF constraint in (6) is satisfied. By combining (6) and (28), the following inequality can be obtained:(29)
Inequality (29) can also be written in the following form:
(30)
where . We let stand for ; then, constraint (30) can be written in the linear form for each follower.Then, considering the avoidance of collisions between a real leader j and obstacles, the following safety set can be obtained:
where and(31)
Then, we can obtain the linear constraint for each real leader, where .
In order to avoid collisions, the system needs to satisfy the constraints of the above four cases at all times. To ensure the effectiveness of the nominal controller, collision avoidance strategies should be triggered as little as possible, and the nominal controller should be modified as little as possible. Since the constraints are linear, the following quadratic programming (QP) problem can be formulated in a least squares sense:
(32)
where , is the nominal controller, is the controller that satisfies the security strategy constraints, L is the set of real leaders, F is the set of followers, and is the set of obstacles. The actual controller is shown in the following expression:(33)
where .
Given the formation-containment tracking system, if for all USV , the control input is given by (33), where can be solved by QP problem (32), then the system is able to avoid collisions under assumption 3.
If all controllers of the USVs satisfy the decentralized safety certificates, then security set S is forward-invariant. If triggered, they are confined to the safety set [39]. As a result, the system is able to achieve obstacle and collision avoidance. □
The priority of collision avoidance and obstacle avoidance control for USVs is higher than that of formation-containment control based on consensus for multiple USVs. When considering containment control problems, if the topology of the system is fixed, the final convergence position of the followers should be calculated in advance. If the final convergence position of the followers does not satisfy the safety distance requirement, the CBF (control barrier function) will take precedence in maintaining a safe distance between follower and follower, consequently disrupting the preset consensus formation among the followers. However, the pre-formed position of the real leader USV should satisfy the requirement of a safe position; otherwise, it may deviate from the preset trajectory due to the inability to achieve consistent velocity.
At this point, the conditions that the real leaders and followers need to meet to avoid obstacles and collisions have all been given. However, the proposed constraint takes into account all pairs of USVs, which can be a very large number. From a topology structure perspective, this requires all the information interactions of the USVs. With the increase in the number of USVs, the related computing and sensing requirements will increase significantly. We consider a fact that if the USVs are far away enough, they will not collide in a period of time. Thus, each USV i only needs to consider other USVs and obstacles in a certain range.
4. Simulation
In this section, an example is used to illustrate the effectiveness of the control strategy in the distributed cooperation layer. The multi-USV system in this simulation example is composed of one virtual leader, four real leaders, and three followers. The communication topology of this system is shown in Figure 3, where USV 0 is the virtual leader, USVs 1–4 are real leaders, and USVs 5–7 are followers. The initial position vector and initial velocity vector of USVs 1–7 are and , respectively. The formation shape given by the real leaders is a rectangle, and the specific value vector is . The velocity limits of each real leader and follower are both , and the input limits are both . The dynamic equation of the virtual leader is . The initial position vector and initial velocity vector of the virtual leader are and , respectively. And the velocity limits and acceleration limits given by the virtual leader are and , with . According to Theorem 1, this leads to . There is only one obstacle in the motion environment of the system. The radius of the USV in the distributed cooperative layer is 1 m, and the radius of the obstacle is 10 m. This means that the safe distance among USVs is 2 m and the safe distance between any USV and any obstacle is 11 m.
The trajectories of USVs in the distributed cooperative layer obtained by the multi-USV system driven by controller (33) are shown in Figure 4. The system can be driven by the control strategy to perform the formation-containment tracking control task: real leaders can form the expected formations; followers can converge into the convex hull; the motion of the whole system is controlled by the virtual leader. At the same time, all USVs can avoid obstacles. The smooth trajectories of the agents represent no significant abrupt changes in the state of the USVs.
More details on three aspects are presented in the following simulation: the implementation of formation-containment tracking, the velocities and input constraints of the USVs, and the effectiveness of the obstacle and collision avoidance strategy.
The errors in formation-tracking control and containment control can be seen in Figure 5, Figure 6, Figure 7 and Figure 8. Figure 5 and Figure 6 show the formation-tracking position errors and velocity errors of the real leaders. The errors arise from the need for real leaders to track virtual leader states and form time-invariant formations, as shown in Equation (9). Figure 7 and Figure 8 show the containment position errors and velocity errors of the followers. The errors arise from the need for followers to track the states of the real leaders, as shown in Equation (16). The asymptotic convergence of all errors to zero indicates that the system is finally stable and completes the formation-containment tracking control task. The oscillations in these figures are produced by avoiding obstacles and other USVs. It is worth noticing that the convergence of the followers occurs after the convergence of the real leaders, but the time interval can be ignored in the application of the algorithm.
The accelerations and velocities of each USV are limited to the required range, as shown in Figure 8 and Figure 9, where dashed lines indicate acceleration and velocity limits. Although the controller input oscillates during obstacle avoidance, the velocities and accelerations of all USVs eventually converge to the same level. The oscillations are caused by the controller solving a quadratic programming problem during obstacle avoidance, the solution of which leads to abrupt changes in the controller inputs. Even during the obstacle avoidance process, the velocities and accelerations of all the USVs do not exceed the required limits.
To illustrate more clearly that in this example, the USVs can avoid obstacles, the distance between each USV and the center of the obstacle is plotted, as shown in Figure 10, where the dashed lines represent the safe distance. We further illustrate the effectiveness of obstacle avoidance by adding a time axis, zooming in on the local trajectory figure, and increasing the safety distance incrementally, as shown in Figure 11. The figure shows that the trajectory of each USV is smooth when avoiding obstacles and confirms that the velocities and inputs of each USV are limited. With the increase in safety distance, the implementation of the algorithm is still effective. Therefore, in practice, the setting of safety distance can be adjusted appropriately for better security.
Due to the different limited accelerations and velocities of the followers and leaders, the distance between the USVs is plotted to illustrate the collision avoidance effectiveness of the USVs, as shown in Figure 12 and Figure 13, with the dotted line representing the safe distance. In this example, the initial position of the real leader is set farther away from the follower, and the likelihood of collisions occurring is reduced. However, the whole system still realizes collision avoidance with the USVs avoiding obstacles.
5. Conclusions
This paper investigates the distributed formation-containment tracking task for collision-free multi-USV (unmanned surface vehicle) systems under constraints on velocity and driving force. Initially, a standard controller based on consensus theory is proposed, designed to guide the entire multi-USV system, subject to velocity and input constraints, to complete the formation-containment tracking task. Additionally, a collision avoidance approach based on control barrier functions is introduced. This method accounts for avoiding collisions both among USVs with different roles within the formation-containment mission and against static obstacles. The effectiveness of the proposed strategies is validated through simulation experiments. Future work will focus on generalizing the results to agents with nonlinear dynamics and taking into account interference and uncertainty.
Conceptualization, J.W.; Methodology, J.W.; Software, Q.S.; Validation, J.W. and Q.X.; Formal analysis, J.W.; Investigation, J.W.; Resources, J.W., Q.S. and G.X.; Data curation, Q.S.; Writing—original draft, J.W.; Writing—review & editing, Q.S.; Visualization, Q.S.; Supervision, Q.S., T.L., G.X. and Q.X.; Project administration, Q.S., T.L., G.X. and Q.X.; Funding acquisition, Q.S. and T.L. All authors have read and agreed to the published version of the manuscript.
Data are contained within the article.
The authors declare no conflict of interest.
Footnotes
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.
Figure 1. The structure of dual-layer USV collaborative motion control framework.
Figure 4. The trajectories of USVs in the distributed cooperative layer. The purple asterisk represents the position of the formation leader at [Forumla omitted. See PDF.] s.
Example topology and explanation of related concepts.
[Image omitted. Please see PDF.] | |
---|---|
Vertex | |
Edge | |
Neighbor | If two nodes are directly connected by an edge, they are considered neighbors. For example, the neighbors of node 1 are nodes 2 and 3, because there are edges (1, 2) and (1, 3) connecting them. |
Adjacency matrix | |
Degree(in) matrix | |
Laplacian matrix | |
Directed spanning tree | In a directed graph, a directed tree that originates from a root node and reaches all other nodes in the graph is known as a directed spanning tree. This means that starting from the root node, it is possible to reach every node in the graph via the edges of the tree. In the given graph, if node 1 is chosen as the root, then the structures formed by edges |
References
1. Xie, J.J.; Luo, J.; Peng, Y.; Xie, S.R.; Pu, H.Y.; Li, X.M.; Su, Z.; Liu, Y.; Zhou, R. Data driven hybrid edge computing-based hierarchical task guidance for efficient maritime escorting with multiple unmanned surface vehicles. J. Abbr.; 2020; 13, pp. 1788-1798. [DOI: https://dx.doi.org/10.1007/s12083-019-00857-6]
2. Jia, Q.; Li, R.H.; Li, J.W.; Li, Z.; Liu, J.Q. Vessel traffic scheduling optimization for passenger RoRo terminals with restricted harbor basin. Ocean. Coast Manag.; 2023; 246, 106904. [DOI: https://dx.doi.org/10.1016/j.ocecoaman.2023.106904]
3. Dewan, C.; Sibilia, E.A. Global containments and local leakages: Structural violence and the toxic flows of shipbreaking. Environ. Plan. C-Politics Space; 2023; 231, 208202. [DOI: https://dx.doi.org/10.1177/23996544231208202]
4. Patterson, R.G.; Lawson, E.; Udyawer, V.; Brassington, G.B.; Groom, R.A.; Campbell, H.A. Uncrewed Surface Vessel Technological Diffusion Depends on Cross-Sectoral Investment in Open-Ocean Archetypes: A Systematic Review of USV Applications and Drivers. Front. Mar. Sci.; 2022; 8, 736984. [DOI: https://dx.doi.org/10.3389/fmars.2021.736984]
5. Fu, S.S.; Gu, S.Y.; Zhang, Y.; Zhang, M.Y.; Weng, J.X. Towards system-theoretic risk management for maritime transportation systems: A case study of the yangtze river estuary. Ocean Eng.; 2023; 286, 115637. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2023.115637]
6. Chen, Y.J.; Wang, T.F.; Xiao, Y.A.; Wang, Y.; Yan, G.A. An Approach of Consensus-Based Double-Layer Blockchain System for Multi-Ship Collision Risk Mitigation Considering COLREGs. Appl. Sci.; 2023; 13, 11178. [DOI: https://dx.doi.org/10.3390/app132011178]
7. Zhang, Z.Q.; Wang, J.F.; Guo, L.L.; Yang, W.J.; Wang, F.; Xu, P. Research on Minimum Non-Collision Distance and Protection Strategy for Normal Train to Avoid Rear-End Accidents With Braking-Fault Train. IEEE Trans. Intell. Transp. Syst.; 2023; 24, pp. 4306-4319. [DOI: https://dx.doi.org/10.1109/TITS.2022.3233568]
8. Wang, Y.Y.; Wang, X.; Zhou, W.X.; Yan, H.C.; Xie, S.R. TThreat potential field based Pursuit-Evasion Games for underactuated Unmanned Surface Vehicles?. Ocean Eng.; 2023; 285, 115381. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2023.115381]
9. Niu, Y.H.; Zhu, F.X.; Wei, M.X.; Du, Y.F.; Zhai, P.Y. A Multi-Ship Collision Avoidance Algorithm Using Data-Driven Multi-Agent Deep Reinforcement Learning. J. Mar. Sci. Eng.; 2023; 11, 2101. [DOI: https://dx.doi.org/10.3390/jmse11112101]
10. Zhou, M.X.; Bachmayer, R.; DeYoung, B. Surveying a Floating Iceberg with the USV SEADRAGON. Front. Mar. Sci.; 2021; 8, 549566. [DOI: https://dx.doi.org/10.3389/fmars.2021.549566]
11. Aranda-Bricaire, E.; González-Sierra, J. Formation with Non-Collision Control Strategies for Second-Order Multi-Agent Systems. Entropy; 2023; 25, 904. [DOI: https://dx.doi.org/10.3390/e25060904]
12. Ghommam, J.; Saad, M.; Mnif, F.; Zhu, Q.M. Guaranteed Performance Design for Formation Tracking and Collision Avoidance of Multiple USVs with Disturbances and Unmodeled Dynamics. IEEE Syst. J.; 2021; 15, pp. 4346-4357. [DOI: https://dx.doi.org/10.1109/JSYST.2020.3019169]
13. Park, B.S.; Yoo, S.J. An Error Transformation Approach for Connectivity-Preserving and Collision-Avoiding Formation Tracking of Networked Uncertain Underactuated Surface Vessels. IEEE Trans. Cybern.; 2023; 53, pp. 5454-5465. [DOI: https://dx.doi.org/10.1109/TCYB.2018.2834919]
14. Wu, W.; Tong, S.C. Collision-Free Adaptive Fuzzy Formation Control for Stochastic Nonlinear Multiagent Systems. IEEE Trans. Syst. Man Cybern. Syst.; 2023; 53, pp. 5454-5465. [DOI: https://dx.doi.org/10.1109/TSMC.2023.3268663]
15. Ren, W. Consensus strategies for cooperative control of vehicle formations. IET Control Theory Appl.; 2007; 1, pp. 505-512. [DOI: https://dx.doi.org/10.1049/iet-cta:20050401]
16. Fang, X.; Wen, G.H.; Yu, X.H.; Chen, G.R. Formation control for unmanned surface vessels: A game-theoretic approach. Asian J. Control; 2022; 24, pp. 498-509. [DOI: https://dx.doi.org/10.1002/asjc.2791]
17. Hu, B.B.; Zhang, H.T.; Liu, B.; Meng, H.F.; Chen, G.R. Distributed Surrounding Control of Multiple Unmanned Surface Vessels with Varying Interconnection Topologies. IEEE Trans. Control Syst. Technol.; 2022; 30, pp. 400-407. [DOI: https://dx.doi.org/10.1109/TCST.2021.3057640]
18. Fu, J.; Wen, G.; Yu, W.; Huang, T.; Yu, X. Consensus of Second-Order Multiagent Systems with both Velocity and Input Constraints. IEEE Trans. Ind. Electron.; 2019; 66, pp. 7946-7955. [DOI: https://dx.doi.org/10.1109/TIE.2018.2879292]
19. Huang, C.; Zhang, X.; Zhang, G.; Deng, Y. Robust practical fixed-time leader–follower formation control for underactuated autonomous surface vessels using event-triggered mechanism. Ocean Eng.; 2021; 233, 109026. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2021.109026]
20. Tang, C.; Zhang, H.T.; Wang, J. Flexible Formation Tracking Control of Multiple Unmanned Surface Vessels for Navigating through Narrow Channels with Unknown Curvatures. IEEE Trans. Ind. Electron.; 2023; 70, pp. 2927-2938. [DOI: https://dx.doi.org/10.1109/TIE.2022.3169825]
21. Wang, J.C.; Shan, Q.H.; Zhu, J.; Cheng, X.F.; Wei, B.Z. Algebraic-Connectivity-Based Multi-USV Distributed Formation Method via Adding a Reverse Edge. Mathematics; 2023; 11, 2942. [DOI: https://dx.doi.org/10.3390/math11132942]
22. Shao, J.; Shi, L.; Cheng, Y.; Li, T. Asynchronous Tracking Control of Leader-Follower Multiagent Systems with Input Uncertainties Over Switching Signed Digraphs. IEEE Trans. Cybern.; 2021; 52, pp. 6379-6390. [DOI: https://dx.doi.org/10.1109/TCYB.2020.3044627] [PubMed: https://www.ncbi.nlm.nih.gov/pubmed/33476279]
23. Yang, Y.; Xiao, Y.; Li, T. Attacks on Formation Control for Multiagent Systems. IEEE Trans. Cybern.; 2021; 52, pp. 12805-12817. [DOI: https://dx.doi.org/10.1109/TCYB.2021.3089375] [PubMed: https://www.ncbi.nlm.nih.gov/pubmed/34260367]
24. Li, Z.; Li, T.; Feng, G.; Zhao, R.; Shan, Q. Neural network-based adaptive control for pure-feedback stochastic nonlinear systems with time-varying delays and dead-zone input. IEEE Trans. Syst. Man Cybern. Syst.; 2020; 50, pp. 5317-5329. [DOI: https://dx.doi.org/10.1109/TSMC.2018.2872421]
25. Li, T.; Bai, W.; Liu, Q.; Long, Y.; Chen, C.L.P. Distributed Fault-Tolerant Containment Control Protocols for the Discrete-Time Multi-Agent Systems via Reinforcement Learning Method. IEEE Trans. Neural Netw. Learn. Syst.; 2023; 8, pp. 3979-3991. [DOI: https://dx.doi.org/10.1109/TNNLS.2021.3121403]
26. Hua, Y.; Dong, X.; Han, L.; Li, Q.; Ren, Z. Formation-containment tracking for general linear multi-agent systems with a tracking-leader of unknown control input. Syst. Control Lett.; 2018; 122, pp. 67-76. [DOI: https://dx.doi.org/10.1016/j.sysconle.2018.10.006]
27. Wang, Y.; Liu, C. Distributed finite-time adaptive fault-tolerant formation–containment control for USVs with dynamic event-triggered mechanism. Ocean Eng.; 2023; 280, 114524. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2023.114524]
28. Hao, Y.; Lin, Z.; Hu, K.; Liu, L. Layered fully distributed formation-containment tracking control for multiple unmanned surface vehicles. Ocean Eng.; 2023; 270, 113658. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2023.113658]
29. Liu, Z.-W.; Hou, H.; Wang, Y.-W. Formation-containment control of multiple underactuated surface vessels with sampling communication via hierarchical sliding mode approach. ISA Trans.; 2022; 124, pp. 458-467. [DOI: https://dx.doi.org/10.1016/j.isatra.2019.12.003]
30. Liu, Y.Y.; Lin, X.G.; Zhang, C. Affine Formation Maneuver Control for Multi-Heterogeneous Unmanned Surface Vessels in Narrow Channel Environments. J. Mar. Sci. Eng.; 2023; 11, 1811. [DOI: https://dx.doi.org/10.3390/jmse11091811]
31. Wu, W.; Tong, S.C. Fixed-time formation fault tolerant control for unmanned surface vehicle systems with intermittent actuator faults. Ocean Eng.; 2023; 281, 114813. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2023.114813]
32. Tan, G.G.; Zhuang, J.Y.; Zou, J.; Wan, L. Adaptive adjustable fast marching square method based path planning for the swarm of heterogeneous unmanned surface vehicles (USVs). Ocean Eng.; 2023; 268, 113432. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2022.113432]
33. Wei, X.W.; Wang, H.; Tang, Y.X. Deep hierarchical reinforcement learning based formation planning for multiple unmanned surface vehicles with experimental results. Ocean Eng.; 2023; 268, 115577. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2023.115577]
34. Yan, X.; Jiang, D.P.; Miao, R.L.; Li, Y.L. Formation Control and Obstacle Avoidance Algorithm of a Multi-USV System Based on Virtual Structure and Artificial Potential Field. J. Mar. Sci. Eng.; 2021; 9, 161. [DOI: https://dx.doi.org/10.3390/jmse9020161]
35. Zhang, R.B.; Wen, N.F.; Yu, H.Y.; Wang, L.Y.; Wu, J.W.; Liu, G.Q. USVs Cooperative Collision Avoidance Based on Man-Machine Interaction and the Artificial Potential Field Method. Proceedings of the 2019 Chinese Automation Congress (Cac2019); Hangzhou, China, 22–24 November 2019; pp. 1552-1557.
36. Gao, S.; Peng, Z.; Wang, H.; Liu, L.; Wang, D. Safety-Critical Model-Free Control for Multi-Target Tracking of USVs with Collision Avoidance. IEEE/CAA J. Autom. Sin.; 2022; 9, pp. 1323-1326. [DOI: https://dx.doi.org/10.1109/JAS.2022.105707]
37. Gong, X.; Liu, L.; Peng, Z. Safe-critical formation reconfiguration of multiple unmanned surface vehicles subject to static and dynamic obstacles based on guiding vector fields and fixed-time control barrier functions. Ocean Eng.; 2022; 250, 110821. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2022.110821]
38. Fu, J.; Wen, G.; Yu, X.; Wu, Z.G. Distributed Formation Navigation of Constrained Second-Order Multiagent Systems with Collision Avoidance and Connectivity Maintenance. IEEE Trans. Cybern.; 2022; 52, pp. 2149-2162. [DOI: https://dx.doi.org/10.1109/TCYB.2020.3000264] [PubMed: https://www.ncbi.nlm.nih.gov/pubmed/32628607]
39. Wang, L.; Ames, A.D.; Egerstedt, M. Safety Barrier Certificates for Collisions-Free Multirobot Systems. IEEE Trans. Robot.; 2017; 33, pp. 661-674. [DOI: https://dx.doi.org/10.1109/TRO.2017.2659727]
40. Zhang, H.; Lewis, F.L. Adaptive cooperative tracking control of higher-order nonlinear systems with unknown dynamics. Automatica; 2012; 48, pp. 1432-1439. [DOI: https://dx.doi.org/10.1016/j.automatica.2012.05.008]
41. Li, Z.; Wen, G.; Duan, Z.; Ren, W. Designing Fully Distributed Consensus Protocols for Linear Multi-Agent Systems with Directed Graphs. IEEE Trans. Autom. Control; 2015; 60, pp. 1152-1157. [DOI: https://dx.doi.org/10.1109/TAC.2014.2350391]
42. Li, Z.; Duan, Z.; Chen, G.; Huang, L. Consensus of Multiagent Systems and Synchronization of Complex Networks: A Unified Viewpoint. IEEE Trans. Circuits Syst. I Regul. Pap.; 2010; 57, pp. 213-224. [DOI: https://dx.doi.org/10.1109/TCSI.2009.2023937]
43. Meng, Z.; Ren, W.; You, Z. Distributed finite-time attitude containment control for multiple rigid bodies. Automatica; 2010; 46, pp. 2092-2099. [DOI: https://dx.doi.org/10.1016/j.automatica.2010.09.005]
You have requested "on-the-fly" machine translation of selected content from our databases. This functionality is provided solely for your convenience and is in no way intended to replace human translation. Show full disclaimer
Neither ProQuest nor its licensors make any representations or warranties with respect to the translations. The translations are automatically generated "AS IS" and "AS AVAILABLE" and are not retained in our systems. PROQUEST AND ITS LICENSORS SPECIFICALLY DISCLAIM ANY AND ALL EXPRESS OR IMPLIED WARRANTIES, INCLUDING WITHOUT LIMITATION, ANY WARRANTIES FOR AVAILABILITY, ACCURACY, TIMELINESS, COMPLETENESS, NON-INFRINGMENT, MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Your use of the translations is subject to all use restrictions contained in your Electronic Products License Agreement and by using the translation functionality you agree to forgo any and all claims against ProQuest or its licensors for your use of the translation functionality and any output derived there from. Hide full disclaimer
© 2024 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (https://creativecommons.org/licenses/by/4.0/). Notwithstanding the ProQuest Terms and Conditions, you may use this content in accordance with the terms of the License.
Abstract
This paper studied the collision avoidance issue in the formation-containment tracking control of multi-USVs (unmanned surface vehicles) with constrained velocity and driving force. Specifically, based on a dual-layer control framework, it designed a multi-USV formation-containment tracking control strategy that accounts for constrained motion velocity and input driving force and validated the stability of this strategy using the Lyapunov method. Then, by utilizing zeroing control barrier function certificates, it considered collision avoidance among USVs with various roles as well as between each USV and static obstacles. A collision-free multi-USV formation-containment tracking control strategy considering constrained motion velocity and driving force was thus established, and its effectiveness was validated through the proposed simulation.
You have requested "on-the-fly" machine translation of selected content from our databases. This functionality is provided solely for your convenience and is in no way intended to replace human translation. Show full disclaimer
Neither ProQuest nor its licensors make any representations or warranties with respect to the translations. The translations are automatically generated "AS IS" and "AS AVAILABLE" and are not retained in our systems. PROQUEST AND ITS LICENSORS SPECIFICALLY DISCLAIM ANY AND ALL EXPRESS OR IMPLIED WARRANTIES, INCLUDING WITHOUT LIMITATION, ANY WARRANTIES FOR AVAILABILITY, ACCURACY, TIMELINESS, COMPLETENESS, NON-INFRINGMENT, MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Your use of the translations is subject to all use restrictions contained in your Electronic Products License Agreement and by using the translation functionality you agree to forgo any and all claims against ProQuest or its licensors for your use of the translation functionality and any output derived there from. Hide full disclaimer
Details
1 School of Navigation, Dalian Maritime University, Dalian 116026, China;
2 School of Automation Engineering, University of Electronic Science and Technology of China, Chengdu 611731, China;
3 Research Institute of Intelligent Networks, Zhejiang Lab, Hangzhou 311121, China;