Next Article in Journal
Effect of Surfactants with Different Hydrophilic–Lipophilic Balance on the Cohesive Force between Cyclopentane Hydrate Particles
Next Article in Special Issue
Three-Dimensional Trajectory Tracking for a Heterogeneous XAUV via Finite-Time Robust Nonlinear Control and Optimal Rudder Allocation
Previous Article in Journal
Analysis of Characteristic Changes of Blended Very Low Sulfur Fuel Oil on Ultrasonic Frequency for Marine Fuel
Previous Article in Special Issue
Adaptive Formation Control of Multiple Underactuated Autonomous Underwater Vehicles
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Fixed-Time Formation Control for Unmanned Surface Vehicles with Parametric Uncertainties and Complex Disturbance

1
Key Laboratory of Marine Dynamic Simulation and Control, Department of Navigation, Dalian Maritime University, Dalian 116026, China
2
Zhilong (Dalian) Marine Technology Co., Ltd., Dalian 116020, China
*
Author to whom correspondence should be addressed.
J. Mar. Sci. Eng. 2022, 10(9), 1246; https://doi.org/10.3390/jmse10091246
Submission received: 28 July 2022 / Revised: 18 August 2022 / Accepted: 27 August 2022 / Published: 6 September 2022

Abstract

:
In this paper, under parametric uncertainties and complex disturbances, a leader–follower formation control strategy based on accurate disturbance observer (ADO) and a novel fixed-time fast terminal sliding mode (FTFTSM) control for unmanned surface vehicles (USVs) is proposed. The main contributions of this paper are: (1) A novel fixed-time fast terminal sliding mode tracking control (FTFTSM-TC) strategy is designed for the tracking control subsystem, which greatly improves the convergence rate of the leader USV in trajectory tracking. (2) An ADO is designed to observe lumped disturbances with the smallest approximation error. The ADO greatly reduces the interference of disturbances and improves the performance of the formation system. (3) An ADO-based fixed-time formation control (ADO-FTFC) strategy is developed for the formation control subsystem to maintain the desired formation. Stability of the formation control system is established by the Lyapunov theory. Simulation results show that the proposed control strategy is superior for the USVs formation control.

1. Introduction

Recently, USVs have been extensively deployed in both civilian and military sectors due to their effectiveness and efficiency [1,2]. USVs have the ability of performing tasks around the clock, especially in harsh marine environments replacing humans in performing dangerous, time-consuming and laborious tasks. In the recent years, intelligent control of USVs has become a hot topic. Maritime authorities have vigorously promoted the development of USVs, and fruitful research results in the development of a single USV have been reported [3]. However, a single USV cannot meet the demand of complex tasks and changing landscape in real-world marine environments. Therefore, USV formation control has become a hot issue in the field of cooperative control. The USV formation control method designed in this paper can achieve the precise formation control effect and has far-reaching practical significance, for example, USV formation cruises in the military field and personnel search and rescue in the civil field.
As an integral part of cooperative control, the formation control of USVs can not only significantly reduce manpower costs but also enhance the fault tolerance of task completion in unknown marine environments, including disturbances of wind, waves and currents. There are many typical formation control methods, such as the virtual structure method [4], behavior-based control [5], the leader–follower formation control method [6], graph theory [7] and the artificial potential field method [8]. Among these methods, the control rule of the leader–follower formation control strategy is the simplest. Moreover, it translates the USV formation control problem into a USV trajectory tracking problem. As such, we only need to know the leader’s motion parameters and the follower’s tracking strategy to achieve formation control. Inspired by [4], the leader–follower control method is used to simplify the design process of USV formation control strategies in this work.
In USV formation control, the convergence rate is a key parameter used to evaluate the performance of the formation control system. Typical control methods used in formation system are sliding mode control, parameter adaptation, neural networks, fuzzy logic, and backstepping. Compared with other methods, backstepping has a good control effect for systems with uncertain parameters. However, the ability to resist external disturbance is weak. The sliding mode control is the simplest and most effective, and it has strong robustness for external disturbances and unmodeled dynamics [9]. Therefore, this formation control strategy has been widely used for USVs. Common sliding mode technologies mainly include the integral sliding mode (ISM) [10], the traditional asymptotic convergent sliding mode [11], the nonsingular terminal sliding mode [12] and the terminal sliding mode (TSM) [13]. In [14,15], a non-singular integral sliding mode tracking control strategy combine with adaptive control is proposed for nonlinear systems with disturbances, which can ensure the convergence in finite time, and the effectiveness of the proposed algorithm is verified by experiments. In [16], a non-singular terminal sliding mode tracking control strategy combined with adaptive control is proposed for perturbed nonlinear systems, which has a good control effect. In [17], a composite nonlinear feedback controller is designed for robust tracking, which keep precise tracking control with output saturation. The advantage of the integral sliding mode is the existence of singularity, while the disadvantage of the terminal sliding mode is slow convergence rate and depends on the initial system state. At the same time, the methods described above can only guarantee the convergence of the system in a finite time, and the maximum convergence time of the system has a great impact on the initial state of the system and cannot guarantee a fast and stable convergence rate. In order to alleviate the disadvantages of existing works and improve the convergence rate and stability of the formation system, a fixed-time fast terminal sliding mode (FTFTSM) is developed.
In order to ensure fast response of the formation system, the idea of finite-time control is adopted for trajectory tracking and cluster control of USVs [18,19,20]. However, the finite-time control dependents on the system initial state. As an extension of finite-time control, which is not affected by the initial system state, fixed-time control is introduced into the multi-agent control [21,22]. As proposed firstly in [23], using the fixed-time control algorithm, the upper bound of the convergence time can be calculated without relying on the initial system state. Therefore, in order to improve convergence rate of the formation system, the fixed-time control strategy is adopted in this paper.
In a practical environment, the uncertainties and complexity of the marine environment must be considered in the design of USV formation control algorithms. How to identify internal unmodeled dynamics and external disturbances of the system quickly and accurately has become a hot issue in USV formation control research. Many researchers are frequently confronted with the challenge of dealing with complex unknown disturbances [24]. In addition to applying adaptive fuzzy algorithms, neural networks techniques and other intelligent algorithms have been deployed to deal with external disturbances. However, all of them are not capable of dealing with complex unknown disturbance, and the system could become trapped into local minima. In order to alleviate the disadvantages of existing works, the observer reconstruction methodology is deployed to obtain real-time external state information so as to achieve effective identification. Numerous observer-based control methods have been proposed to improve the performance of the USV control system. In [25], a nonlinear observer was proposed to recover the position and velocity of a USV from measured data corrupted by noise. In [26], a novel lumped perturbation observer-based robust control method is proposed to improve the control performance of the system and deal with disturbances. In [27], a finite time disturbance observer is proposed to deal with severe model nonlinearities with large parametric uncertainties and external disturbances. At the same time, strict experimental analysis verifies the effectiveness of the designed observer. In [28], a finite-time disturbance observer was proposed to observe fault-mixed unknowns of USV with input saturation. In order to enhance trajectory tracking performance of an asymmetric underactuated surface vehicle, a finite-time unknown observer was proposed to exactly identify complex unknowns in [29], and remarkable performance has been achieved. On the basis of the aforementioned disturbance observers, in order to further improve the convergence speed and eliminate the influence of initial observation error on the accuracy of disturbance observer, we combine fixed-time control theory with disturbance observer technology to design a novel accurate disturbance observer (ADO) in this paper, which realizes accurate observation of complex disturbances.
In this paper, in order to solve the formation control problem of USVs with internal unmodeled dynamics and external unknown disturbances, a fixed-time formation control strategy is proposed, which contains uncertain and external disturbances to improve the convergence rate and handling of disturbances. In order to promote the following development, firstly, for the tracking control subsystem, a novel fixed-time fast terminal sliding mode tracking control (FTFTSM-TC) strategy is proposed. Secondly, an internal model of uncertainties and external disturbances in the formation control subsystem is considered, and a novel accurate disturbance observer (ADO) is designed to accurately identify disturbances in the USV formation system. Then, to accurately observe lumped disturbance terms and maintain the desired formation, an ADO-based fixed-time formation control strategy (ADO-FTFC) is proposed. Finally, vigorous analysis using the Lyapunov function shows that the proposed formation control strategy is accurate and reliable. The main contributions of this paper are as follows:
  • Aiming at solving the formation control problem of USVs under complex disturbances, the overall formation control framework is divided into tracking and formation control subsystems. Then, we design the FTFTSM-TC strategy and ADO-FTFC strategy. On the basis of simplifying the formation control structure, the convergence rate and control accuracy of the system are greatly improved by the proposed method, and the convergence rate of the system is shown to be independent of the initial state of the system (Section 3.1).
  • In order to improve the disturbance observation accuracy of the formation control system, we design an ADO to achieve real-time control of disturbances and perform accurate observation of the lumped uncertainty item efficiently in the formation control system (Section 3.2).
The paper is organized as follows: Section 2 introduces preliminaries and the problem formulation of the USV formation system. Section 3 presents the design process of the formation control system and establishes the stability of the entire formation system. The design process of the ADO is also introduced. In Section 4, simulation results which demonstrate that the proposed formation controller and disturbance observer can achieve excellent results are presented. Section 5 concludes the paper.

2. Preliminaries and Problem Formulation

This section introduces some key lemmas which are necessary for developing the formation control strategy.

2.1. Preliminaries

Lemma 1.
Consider the following nonlinear system [30]:
x ˙ ( t ) = f ( x ( t ) ) x ( 0 ) = 0 , f ( 0 ) = 0 , x R n
where f ( x ( t ) ) is a nonlinear function defined in the origin neighborhood, and x = [ x 1 , x 2 , , x n ] T is the vector of system state. If system (1) has a negative homogeneity degree and is asymptotically stable, the system is finite-time stable.
Lemma 2.
Consider the following scalar system [31]:
y ˙ = γ 1 y 2 p / q γ 2 y p / q , y ( 0 ) = y 0
where γ 1 , γ 2 > 0 and p < q and p , q are both positive odd integers. System (2) is fixed-time stable, and the upper bound of the convergence time satisfies:
T m a x y 0 = q π 2 γ 1 γ 2 q p .
Lemma 3.
Consider the following system [32]:
y ˙ = l a s i g m 1 ( y ) l b s i g m 2 ( y ) , y ( 0 ) = y 0
where m 1 > 1 , 0 < m 2 < 1 and l a , l b > 0 . When the system equilibrium point is fixed-time stable, the upper bound of the convergence time can be calculated independently of the initial state and is given by:
T m a x = 1 l a ( m 1 1 ) + 1 l b ( 1 m 2 ) .
Lemma 4.
If there is a continuous radial bounded function, V : R n R + { 0 } satisfies: V ( x ) = 0 x = 0 . For any x ( t ) satisfying V ˙ ( x ) l 1 V ( x ) σ 1 l 2 V ( x ) σ 2 , l 1 , l 2 , σ 1 , σ 2 are positive numbers and 0 < σ 1 < 1 , σ 2 > 1 . Then, the system can converge to zero in a fixed time and the convergence time T satisfies [25]:
T T max = 1 l 1 ( 1 σ 1 ) + 1 l 2 ( σ 2 1 ) .

2.2. Problem Formulation

USVs have the characteristics of strong coupling, strong nonlinearity, and high complexity in actual maritime navigation. Unmodeled dynamics and various external disturbances cannot be ignored when establishing a USV model. An overly simple USV model lacks practicality and generality, but an overly complicated model will hinder subsequent controller design. As shown in Figure 1, the leader–follower formation control framework is adopted. Based on the distances between the three USVs, a three-degrees-of-freedom model is used to solve the USV formation problem, which revolves around establishing the relationship between the surge speed u, sway speed v and yaw angular speed r in this paper.
Using the earth-fixed and body-fixed coordinate frames of USVs, the kinetic and dynamic models of the USV can be expressed as follows:
η ˙ = R ( ψ ) ν M ν ˙ + C ( ν ) ν + D ( ν ) ν = τ + δ
where ν = [ u , v , r ] T denotes the velocity vector in the earth-fixed coordinate system, η = [ x , y , ψ ] T denotes the position and heading angle in the earth-fixed coordinate system, and τ = [ τ i 1 , τ i 2 , τ i 3 ] T denotes the USV control input vector. δ = M R T ( ψ ) d ( t ) denotes external disturbances caused by wind, waves, and currents; M = M T > 0 is the inertia matrix; R ( ψ ) is the rotation matrix; D ( ν ) is the damping matrix; and C ( ν ) = C ( ν ) T is the skew-symmetric matrix given by:
M = m 11 0 0 0 m 22 m 23 0 m 32 m 33
R ( ψ ) = cos ψ sin ψ 0 sin ψ cos ψ 0 0 0 1
D ( ν ) = d 11 ( ν ) 0 0 0 d 22 ( ν ) d 23 ( ν ) 0 d 32 ( ν ) d 33 ( ν )
C ( ν ) = 0 0 c 13 ( ν ) 0 0 c 23 ( ν ) c 13 ( ν ) c 23 ( ν ) 0
Note that the aforementioned matrices satisfy the following properties:
R ˙ ( ψ ) = R ( ψ ) S ( r ) R T ( ψ ) S ( r ) R ( ψ ) = R ( ψ ) S ( r ) R T ( ψ ) = S ( r ) R ( ψ ) = 1 , R T ( ψ ) R ( ψ ) = I , ψ [ 0 , 2 π ]
The S ( r ) matrix is given by:
S ( r ) = 0 r 0 r 0 0 0 0 0
Rewriting the USV mathematical model to the following Lagrangian mathematical model, we have:
M ( η ) η ¨ + C ( η , η ˙ ) η ˙ + D ( η , η ˙ ) η ˙ = R ( η ) τ + δ ( t )
where M , C and D can be expressed as follows:
M ( η ) = R ( η ) M R T ( η ) C ( η , η ˙ ) = R ( η ) ( C MS ) R T ( η ) D ( η , η ˙ ) = R ( η ) D R T ( η ) M ( η ) = M T ( η ) > 0 M ( η ) 2 C ( η , η ˙ ) = [ M ( η ) 2 C ( η , η ˙ ) ] T
To facilitate the following analysis, we define:
x ˙ 1 = x 2 x ˙ 2 = M 1 ( x 1 ) R ( x 1 ) τ + Z ( · )
where Z ( · ) = M 1 δ ( t ) C * ( x 1 , x 2 ) x 2 D * ( x 1 , x 2 ) x 2 , x 1 = η , x 2 = η ˙ , the term f represents the lumped uncertainty term of disturbances in the formation system, which satisfies continuous differentiability and boundedness conditions, i.e., Z ( · ) Ω , where Ω is a bounded positive constant.
Definitions of each parameter are shown in Table 1. The term X * , Y * , Z * denotes the hydrodynamic derivatives, I z is the moment of inertia, m is the mass of the USV, and N v ˙ = Y r ˙ .
The desired trajectory is given by:
η ˙ d = R ( ψ d ) ν d M d ν ˙ d + C ( ν d ) ν d + D ( ν d ) ν d = τ d
where η = [ x d , y d , ψ d ] T is the desired position vector, ν d = [ u d , v d , r d ] T is the velocity vector of the USV, and τ d = [ τ d 1 , τ d 2 , τ d 3 ] T is the desired control input.

3. Design of the Proposed Controller

As shown in Figure 2, the formation system is divided into a tracking control subsystem and a formation control subsystem to facilitate controller design. Moreover, for ease of analysis, lumped disturbances are not considered when the trajectory tracking controller is designed.

3.1. Tracking Control Subsystem

Dynamic tracking errors of the leader USV and the desired trajectory are defined as follows:
1 = x 1 η d 2 = x 2 η ˙ d
It follows from (16) and (18) that:
˙ 1 = 2 ˙ 2 = M 1 ( x 1 ) R ( x 1 ) τ + Z ( · ) η ¨ d
A novel fixed-time fast terminal sliding mode (FTFTSM) is designed to ensure that the USV formation control system has a faster convergence rate and converge in fixed time in the entire universe, shown as follows:
s = 1 + 2 a 1 1 H N + b 1 1 N
The derivation is as follows:
s ˙ = 2 + 1 N ( a 1 1 H N + b 1 ) 1 2 1 N 1 a 1 ( H N ) ( a 1 1 H N + b 1 ) 2 1 H N 1 2 2 + ( a 1 1 H N + b 1 ) 1 ˙ 2
where a 1 > 0 , b 1 > 0 , H = h 1 h 2 , N = n 1 n 2 , h 1 , h 2 , n 1 , n 2 are positive odd numbers and satisfy h 1 > h 2 , n 1 < n 2 , H N > 1 .
In order to simplify the controller design, let = ( a 1 1 H N + b 1 ) 1 , simplified as follows:
s ˙ = 2 + 1 N ( 2 ) 1 N 1 [ a 1 ( H N ) 2 1 H N 1 2 2 + ˙ 2 ] = 2 a 1 ( H N ) N 1 N + 1 1 H N 1 2 1 N + 1 + 1 N 1 N 2 1 N 1 ˙ 2
Combined with Lemma 2, the FTFTSM-TC strategy is designed as follows:
τ = M ( x 1 ) R ( x 1 ) 1 [ 2 N 1 N 2 1 N 1 ( a 1 ( H N ) N 1 N + 1 1 H N 1 2 1 N + 1 + ε 0 s + ε 1 s 2 p / q + ε 2 s p / q ) η ¨ d ]
where ε 0 , ε 1 , ε 2 are the control coefficients of the controller, and p , q are positive odd numbers satisfying p < q .
Now, the main results of this work are presented as follows.
Theorem 1.
Consider the USV tracking control system governed by (19) under the assumption that there is no lumped disturbance, the proposed FTFTSM-TC strategy can ensure that velocity vector η ˙ and the position vector η of the leader USV can accurately track the desired trajectory in fixed time.
Proof of Theorem 1.
Reaching phase: Here, we establish that the errors 1 , 2 can reach the sliding surface in fixed time.
The following Lyapunov function is selected:
V = 1 2 s T s
The derivation is as follows:
V ˙ = s T s ˙ = s T [ 2 a 1 ( H N ) N 1 N + 1 1 H N 1 2 1 N + 1 + 1 N 1 N 2 1 N 1 ˙ 2 ] = s T [ 2 a 1 ( H N ) N 1 N + 1 1 H N 1 2 1 N + 1 + 1 N 1 N 2 1 N 1 ( M 1 ( x 1 ) R ( x 1 ) τ η ¨ d ) ] = s T [ ε 0 s + ε 1 s 2 p / q + ε 2 s p / q ] = ε 0 s 2 ε 1 2 3 q p 2 q ( 1 2 s 2 ) 3 q p 2 q ε 2 2 q + p 2 q ( 1 2 s 2 ) q + p 2 q ε 1 2 3 q p 2 q V 2 p + q 2 q ε 2 2 p + q 2 q V p + q 2 q
According to Lemma 2, the upper bound of the convergence time is computed by:
T 0 = q π 2 ε 1 ε 2 ( q p )
Then, in the maximum set time T 0 , the sliding surface s can be reached. After the sliding surface arrives, s = 0 , s ˙ = 0 , and we have:
2 = ˙ 1 = a 1 1 H b 1 1 N
Furthermore, according to Lemma 3, the tracking errors 1 , 2 will converge to zero along the manifold in a fixed time. In summary, the controller designed for the tracking subsystem can guarantee that η = η d , ν = ν d in fixed time, i.e., the leader USV can track the desired trajectory accurately.
Theorem 1 is proven complete. □

3.2. Formation Control Subsystem

We consider the lumped disturbance Z · in the design process of the formation control subsystem, which includes the external environment disturbance δ and the internal disturbance. The internal disturbance contains items C * ( x i , 1 , x i , 2 ) x i , 2 and D * ( x i , 1 , x i , 2 ) x i , 2 related to the internal unmodeled dynamics of the USV. Definition C ( x i , 1 , x i , 2 ) x i , 2 = C ( x i , 1 , x i , 2 ) x i , 2 C * ( x i , 1 , x i , 2 ) x i , 2 and D ( x i , 1 , x i , 2 ) x i , 2 = D ( x i , 1 , x i , 2 ) x i , 2 D * ( x i , 1 , x i , 2 ) x i , 2 .
First, we rewrite the Lagrangian model of the follower USVs:
x ˙ i , 1 = x i , 2 x ˙ i , 2 = M 1 ( x i , 1 ) [ τ i C ( x i , 1 , x i , 2 ) x i , 2 D ( x i , 1 , x i , 2 ) x i , 2 ] + Z ·
where i = 1 , 2 denotes follower USV1 and USV2, and Z · is defined as follows:
Z · = M 1 δ ( t ) C * ( x i , 1 , x i , 2 ) x i , 2 D * ( x i , 1 , x i , 2 ) x i , 2
where x i , 1 = η i and x i , 2 = η ˙ i .
Assumption 1.
The term Z · represents external disturbances of the formation control subsystem and the internal lumped uncertainty items, which is satisfying the conditions of boundedness and continuous differentiability, i.e., Z ( · ) Ω , where Ω is a bounded positive constant.
Auxiliary variables are defined as follows:
Θ = x i , 2 ω ω ˙ = M 1 ( x i , 1 ) [ τ i C ( x i , 1 , x i , 2 ) x i , 2 D ( x i , 1 , x i , 2 ) x i , 2 ] + 1 Θ + 2 Θ κ 1 + 3 Θ κ 2 + 4 s i g n ( Θ )
where 1 , 2 , 3 , 4 are positive definite diagonal matrices satisfying 4 Ω . κ 1 , κ 2 are positive numbers and satisfy 0 < κ 1 < 1 , κ 2 > 1 .
The derivative of Θ is as follows:
Θ ˙ = x ˙ i , 2 ω ˙ = M 1 ( x i , 1 ) [ τ i C ( x i , 1 , x i , 2 ) x i , 2 D ( x i , 1 , x i , 2 ) x i , 2 ] + Z · M 1 ( x i , 1 ) [ τ i C ( x i , 1 , x i , 2 ) x i , 2 D ( x i , 1 , x i , 2 ) x i , 2 ] [ 1 Θ + 2 Θ κ 1 + 3 Θ κ 2 + 4 s i g n ( Θ ) ] = Z · [ 1 Θ + 2 Θ κ 1 + 3 Θ κ 2 + 4 s i g n ( Θ ) ]
The ADO is designed as follows:
Z ^ ( · ) = 1 Θ + 2 Θ κ 1 + 3 Θ κ 2 + 4 s i g n ( Θ )
Z ˜ ( · ) is the observation error, which is defined as follows:
Z ˜ ( · ) = Z ^ ( · ) Z ( · ) = 1 Θ + 2 Θ κ 1 + 3 Θ κ 2 + 4 s i g n ( Θ ) + M 1 ( x i , 1 ) [ τ i C ( x i , 1 , x i , 2 ) x i , 2 D ( x i , 1 , x i , 2 ) x i , 2 ] x ˙ i , 2 = ω ˙ x ˙ i , 2 = Θ ˙
From the above formula, if Θ ˙ converges, then Z ˜ ( · ) converges. We select the following Lyapunov function:
V Z = 1 2 Θ T Θ
The derivation of the above formula is as follows:
V ˙ Z = Θ T Θ ˙ = Θ T [ Z · 1 Θ 2 Θ κ 1 3 Θ κ 2 4 s i g n ( Θ ) ] 1 Θ T Θ 2 Θ T Θ κ 1 3 Θ T Θ κ 2 2 κ 1 + 1 2 2 , m i n ( 1 2 Θ T Θ ) κ 1 + 1 2 2 κ 2 + 1 2 3 , m i n ( 1 2 Θ T Θ ) κ 2 + 1 2 = α z , 1 V Z β z , 1 α z , 2 V Z β z , 2
where α z , 1 = 2 κ 1 + 1 2 2 , m i n , α z , 2 = 2 κ 2 + 1 2 3 , m i n , 0 < β z , 1 = κ 1 + 1 2 < 1 , β z , 2 = κ 2 + 1 2 > 1 .
Furthermore, according to Lemma 4, Θ is globally fixed time stable. The convergence time T z is as follows:
T Z T Z , max = 1 α z , 1 ( 1 β z , 1 ) + 1 α z , 2 ( β z , 2 1 )
Then we can obtain:
Θ ˙ = 0 Z ˜ ( · ) = 0 , t T Z
In summary, the designed ADO can accurately observe the disturbances in fixed time and ensure that the observation error is independent of the initial observation error.
Theorem 2.
Consider the USV formation control system with a lumped uncertainty term Z · governed by (29): the designed ADO can accurately identify the disturbances. Moreover, the proposed ADO-FTFC strategy can ensure the position vector η i , and velocity vector η ˙ i of the followers can accurately track the velocity vector η ˙ and position vector η of the leader and maintain the desired formation in fixed time.
Proof of Theorem 2.
The dynamic error between the leader and the follower USV is defined as follows:
i , 1 = x i , 1 η i , 2 = x i , 2 η ˙
The derivation of the above formula is as follows:
˙ i , 1 = i , 2 ˙ i , 2 = M 1 ( x i , 1 ) R ( x i , 1 ) τ i + Z · η ¨
Considering the FTFTSM (20), we have:
s i = i , 1 + i , 2 a i , 1 i , 1 H i N i + b i , 1 1 N i
The derivation is as follows:
s ˙ i = i , 2 a i , 1 ( H i N i ) N i i 1 N i + 1 i , 1 H i N i 1 i , 2 1 N i + 1 + 1 N i i 1 N i i , 2 1 N i 1 ˙ i , 2
where i = 1 , 2 . We design the ADO-FTFC strategy as follows:
τ i = M ( x i , 1 ) R ( x i , 1 ) 1 [ i , 2 N i i 1 N i i , 2 1 N i 1 ( a i , 1 ( H i N i ) N i i 1 N i + 1 i , 1 H i N i 1 i , 2 1 N i + 1 + ε i , 0 s i + ε i , 1 s i 2 p / q + ε i , 2 s i p / q ) + Z ^ · η ¨ ]
where ε i , 0 , ε i , 1 , ε i , 2 are the control coefficients of the controller, and p , q are positive odd numbers satisfying p < q .
The following Lyapunov function is selected to prove that the errors i , 1 , i , 2 can reach the sliding surface in a fixed time:
V i = 1 2 s i T s i
The derivation is as follows:
V ˙ i = s i T s ˙ i = s i T [ i , 2 a i , 1 ( H i N i ) N i i 1 N i + 1 i , 1 H i N i 1 i , 2 1 N i + 1 + 1 N i i 1 N i i , 2 1 N i 1 ˙ i , 2 ] = s i T [ i , 2 a i , 1 ( H i N i ) N i i 1 N i + 1 i , 1 H i N i 1 i , 2 1 N i + 1 + 1 N i i 1 N i i , 2 1 N i 1 ( M 1 ( x i , 1 ) R ( x i , 1 ) τ i + Z · η ¨ d ) ] = s i T [ ε i , 0 s i + ε i , 1 s i 2 p / q + ε i , 2 s i p / q + ( Z · Z ^ · ) ] = s i T [ ε i , 0 s i + ε i , 1 s i 2 p / q + ε i , 2 s i p / q ] = ε i , 0 s i 2 ε i , 1 2 3 q p 2 q ( 1 2 s i 2 ) 3 q p 2 q ε i , 2 2 q + p 2 q ( 1 2 s i 2 ) q + p 2 q ε i , 1 2 3 q p 2 q V i 2 p + q 2 q ε i , 2 2 p + q 2 q V i p + q 2 q
The upper bound of the convergence time is computed according to Lemma 2, shown as follows:
T i = q π 2 ε i , 1 ε i , 2 ( q p )
Then, the sliding surface s i can be reached within the maximum set time T 0 . After the sliding surface arrives, s i = 0 , s ˙ i = 0 , and we have:
i , 2 = ˙ i , 1 = a i , 1 i , 1 H i b i , 1 i , 1 N i
Furthermore, according to Lemma 3, the formation errors i , 1 , i , 2 will converge to zero along the manifold in a fixed time, and three USVs can quickly and accurately form and maintain the desired formation.
Theorem 2 is proven complete. □

4. Simulation and Discussion

The parameters of the FTFTSM and ADO are shown in Table 2. In order to verify the effectiveness of the FTFTSM-TC strategy and the ADO-FTTC strategy proposed in this paper, the benchmark USV model Cybership II is used. The main parameters of the Cybership II are shown in Table 3. The initial values of the formation system are as follows: η d ( 0 ) = [ 0 , 0 , π / 2 ] T , ν d ( 0 ) = [ 0.2 , 0 , 0 ] T . The initial states of the leader USV and the follower USV1 and USV2 are as follows: η 0 ( 0 ) = [ 5 , 0.5 , 0 ] T , η 1 ( 0 ) = [ 5 , 2 , 0 ] T , η 2 ( 0 ) = [ 5 , 2.5 , 0 ] T , ν 0 ( 0 ) = ν 1 ( 0 ) = ν 2 ( 0 ) = [ 0 , 0 , 0 ] T .
The following disturbances are used in the simulation study:
d i = 5 cos ( π 10 t π 3 ) 4 cos ( π 5 t + π 2 ) 3 cos ( π 10 t + π 6 )
Simulation results are shown in Figure 3, Figure 4, Figure 5, Figure 6, Figure 7, Figure 8, Figure 9 and Figure 10. Figure 3 shows the comparison results of the proposed FTFTSM-TC strategy with the ISM-TC strategy. The desired trajectory is set as follows: η d = [ 3 sin ( 0.04 t ) + 0.2 , 1.5 sin ( 0.06 t ) , π 2 cos ( 0.03 t ) ] T . The results show that the ISM-TC strategy cannot deal with external disturbances in real time, and the FTFTSM-TC strategy proposed can achieve accurate tracking control. The FTFTSM-TC strategy proposed can ensure that the leader USV accurately track the desired trajectory and maintain stable movement along the desired trajectory.
In order to compare position and velocity tracking performances in different directions, Figure 4 and Figure 5 show position tracking and velocity tracking under the FTFTSM-TC strategy and the ISM-TC strategy. They clearly demonstrate that the FTFTSM-TC strategy is superior to the ISM-TC strategy.
Figure 6 shows the performance of the ADO disturbance observation. Simulation results show that the ADO strategy proposed can quickly and accurately handle the lumped uncertainty item of the formation system. The norm and derivatives of the tracking errors are shown in Figure 7, which clearly show that the approach of handling the lumped disturbances by the proposed ADO is effective and efficient.
Figure 8 demonstrates that all the USVs maintain a stable straight triangular formation operation, which show that three USVs quickly form the desired formation from different positions in five seconds and maintain stable kinestate and verify closed-loop stability and the effectiveness of the proposed ADO-FTFC strategy. In order to compare control performances on different positions and velocities, Figure 9 and Figure 10 show velocity tracking error and the position tracking error when the leader USV and two follower USVs maintain triangular formation. The results clearly demonstrate that the ADO-FTFC strategy proposed can ensure that the leader and follower USVs can maintain accurate and stable formation. From the change curve of control input with time shown in Figure 11 and Figure 12, it is verified that the designed controller can be stable in a fixed time.

5. Conclusions

In order to solve the key problems in the field of cooperative control of USVs, the leader–follower formation control strategy of USVs under unknown disturbances has been successfully designed. We divide the entire formation control system into the tracking control subsystem and the formation control subsystem. In the tracking control subsystem, the FTFTSM-TC strategy is proposed to improve the convergence rate and precision of the tracking control system. In the formation control subsystem, the ADO-FTFC strategy is proposed to observe lumped disturbances, and excellent disturbance identification results have been achieved, thereby ensuring stable and effective USV formation control. Rigorous stability analysis and simulation studies demonstrate that the proposed strategy is superior to the state-of-the-art methods. However, there are still some limitations in this paper. We design the controller based on the leader follower formation framework, which simplifies the interaction between individuals but reduces the flexibility of the formation. Therefore, this is the problem we need to solve in the future. The research results of this paper provide a bright research direction for the future USV formation control.

Author Contributions

Conceptualization, Y.Y.; methodology, Y.Y.; formal analysis, H.S. and X.Q.; software, X.Q. and H.S.; data curation, X.Q.; resources, H.S.; writing—original draft preparation, H.S.; writing—review and editing, Y.Y. and X.Q.; project administration, Y.Y.; funding acquisition, H.S. and Y.Y. All authors have read and agreed to the published version of the manuscript.

Funding

This research was partially supported by: (a) the project of Intelligent Ship Testing and Verification, (2018/473); (b) the Fundamental Research Funds for the Central Universities (no. 3132019011); (c) the Natural Science Foundation of Liaoning Province (no. 2021-MS-141).

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Partial data can be found in this paper.

Conflicts of Interest

The authors declare that there are no conflict of interest in the publication of this paper.

References

  1. Chen, D.; Zhang, J.D.; Li, Z.K. A novel fixed-time trajectory tracking strategy of unmanned surface vessel based on the fractional sliding mode control method. Electronics 2022, 11, 726. [Google Scholar] [CrossRef]
  2. Ning, W.; Choon, K.A. Coordinated trajectory tracking control of a marine aerial-surface heterogeneous system. IEEE/ASME Trans. Mechatron. 2021, 26, 3198–3210. [Google Scholar]
  3. Mu, D.D.; Wang, G.F.; Fan, Y.S. Tracking control of podded propulsion unmanned surface vehicle with unknown dynamics and disturbance under input saturation. Int. J. Control Autom. 2020, 16, 1905–1915. [Google Scholar] [CrossRef]
  4. 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. [Google Scholar] [CrossRef]
  5. Garcia-Aunon, P.; del Cerro, J.; Barrientos, A. Behavior-based control for an aerial robotic swarm in surveillance missions. Sensors 2019, 19, 4584. [Google Scholar] [CrossRef]
  6. He, S.D.; Wang, M.; Dai, S.S.; Luo, F. Leader–follower formation control of usvs with prescribed performance and collision avoidance. IEEE Trans. Ind. Inform. 2019, 15, 572–581. [Google Scholar] [CrossRef]
  7. Han, T.; Guan, Z.H.; Chi, M.; Hu, B.; Li, T.; Zhang, X.H. Multi-formation control of nonlinear leader-following multi-agent systems. ISA Trans. 2017, 69, 140–147. [Google Scholar] [CrossRef]
  8. Tan, G.G.; Zhuang, J.Y.; Zou, J.; Wei, L.; Sun, Z.Y. Artificial potential field-based swarm finding of the unmanned surface vehicles in the dynamic ocean environment. Int. J. Adv. Robot. Syst. 2020, 17, 1–16. [Google Scholar] [CrossRef]
  9. Ning, W.; Yu, H.Z.; Choon, K.A. Autonomous pilot of unmanned surface vehicles: Bridging path planning and tracking. IEEE Trans. Veh. Technol. 2021, 71, 2358–2374. [Google Scholar] [CrossRef]
  10. Pan, Y.P.; Yang, C.G.; Pan, L.; Yu, H.Y. Integral sliding mode control: Performance, modification and improvement. IEEE Trans. Ind. Inform. 2018, 14, 52–62. [Google Scholar] [CrossRef]
  11. Pai, M.C. Observer-based adaptive sliding mode control for nonlinear uncertain state-delayed systems. Int. J. Control. Autom. Syst. 2009, 7, 536–544. [Google Scholar] [CrossRef]
  12. Song, J.H.; Song, S.M.; Zhou, H.B. Adaptive nonsingular fast terminal sliding mode guidance law with impact angle constraints. Int. J. Control. Autom. 2016, 14, 99–114. [Google Scholar] [CrossRef]
  13. Sun, L.H.; Wang, W.H.; Yi, R.; Xiong, S.F. A novel guidance law using fast terminal sliding mode control with impact angle constraints. ISA Trans. 2016, 64, 12–23. [Google Scholar] [CrossRef] [PubMed]
  14. Alattas, K.A.; Mobayen, S.; Din, S.U.; Asad, J.H.; Fekih, A.; Assawinchaichote, W.; Vu, M.T. Design of a non-singular adaptive integral-type finite time tracking control for nonlinear systems with external disturbances. IEEE Access 2021, 9, 102091–102103. [Google Scholar] [CrossRef]
  15. Mofid, O.; Amirkhani, S.; Din, S.U.; Mobayen, S.; Vu, M.T.; Assawinchaichote, W. Finite-time convergence of perturbed nonlinear systems using adaptive barrier-function nonsingular sliding mode control with experimental validation. J. Vib. Control. 2022. [Google Scholar] [CrossRef]
  16. Alattas, K.A.; Vu, M.T.; Mofid, O.; El-Sousy, F.F.M.; Alanazi, A.K.; Awrejcewicz, J.; Mobayen, S. Adaptive nonsingular terminal sliding mode control for performance improvement of perturbed nonlinear systems. Mathematics 2022, 10, 1064. [Google Scholar] [CrossRef]
  17. Valiollah, G.; Saleh, M.; Sami, U.D.; Thaned, R.; Mai, T.V. Robust tracking composite nonlinear feedback controller design for time-delay uncertain systems in the presence of input saturation. ISA Trans. 2022; in press. [Google Scholar]
  18. Ning, W.; Ying, G.; Xue, F.Z. Data-driven performance-prescribed reinforcement learning control of an unmanned surface vehicle. IEEE Trans. Neural Netw. Learn. Syst. 2021, 32, 5456–5467. [Google Scholar]
  19. Huang, C.F.; Zhang, X.K.; Zhang, G.Q. Improved decentralized finite-time formation control of underactuated usvs via a novel disturbance observer. Ocean Eng. 2019, 174, 117–124. [Google Scholar] [CrossRef]
  20. Liu, X.W.; Chen, T.P. Finite-time and fixed-time cluster synchronization with or without pinning control. IEEE Trans. Cybern. 2018, 48, 240–252. [Google Scholar] [CrossRef]
  21. Zuo, Z.Y.; Tian, B.L.; Defoort, M.; Ding, Z.T. Fixed-time consensus tracking for multiagent systems with high-order integrator dynamics. IEEE Trans. Automat. Control 2018, 63, 563–570. [Google Scholar] [CrossRef]
  22. Zhang, J.X.; Yang, G.H. Fault-tolerant fixed-time trajectory tracking control of autonomous surface vessels with specified accuracy. IEEE Trans. Ind. Electron. 2020, 67, 4889–4899. [Google Scholar] [CrossRef]
  23. Polyakov, A. Nonlinear feedback design for fixed-time stabilization of linear control systems. IEEE Trans. Autom. Control 2012, 57, 2106–2110. [Google Scholar] [CrossRef] [Green Version]
  24. Wang, N.; He, H. Dynamics-Level finite-time fuzzy monocular visual servo of an unmanned surface vehicle. IEEE Trans. Ind. Electron. 2020, 67, 9648–9658. [Google Scholar] [CrossRef]
  25. Gu, N.; Peng, Z.H.; Wang, D.; Liu, L.; Jiang, Y. Nonlinear observer design for a robotic unmanned surface vehicle with experiment results. Appl. Ocean Res. 2020, 95, 102028. [Google Scholar] [CrossRef]
  26. Thanh, H.L.N.N.; Vu, M.T.; Mung, N.X.; Nguyen, N.P.; Phuong, N.T. Perturbation observer-based robust control using a multiple sliding surfaces for nonlinear systems with influences of matched and unmatched uncertainties. Mathematics 2020, 8, 1371. [Google Scholar] [CrossRef]
  27. Rojsiraphisal, T.; Mobayen, S.; Asad, J.H.; Vu, M.T.; Chang, A.; Puangmalai, J. Fast Terminal Sliding Control of Underactuated Robotic Systems Based on Disturbance Observer with Experimental Validation. Mathematics 2021, 9, 1935. [Google Scholar] [CrossRef]
  28. Wang, N.; Deng, Z.C. Finite-time fault estimator based fault-tolerance control for a surface vehicle with input saturations. IEEE Trans. Ind. Inform. 2020, 16, 1172–1181. [Google Scholar] [CrossRef]
  29. Ning, W.; Shun, F.S. Finite-time unknown observer based interactive trajectory tracking control of asymmetric underactuated surface vehicles. IEEE Trans. Control Syst. Technol. 2021, 29, 794–803. [Google Scholar]
  30. Bhat, S.P.; Bernstein, D.S. Continuous finite-time stabilization of the translational and rotational double integrators. IEEE Trans. Autom. Control 1998, 43, 678–682. [Google Scholar] [CrossRef]
  31. Fu, J.J.; Wang, J.Z. Fixed-time coordinated tracking for second-order multi-agent systems with bounded input uncertainties. Syst. Control Lett. 2016, 93, 1–12. [Google Scholar] [CrossRef]
  32. Liu, Y.F.; Geng, Z.Y. Finite-time formation control for linear multi-agent systems: A motion planning approach. Syst. Control Lett. 2016, 85, 54–60. [Google Scholar] [CrossRef]
Figure 1. Earth-fixed and body-fixed coordinate frames of USVs.
Figure 1. Earth-fixed and body-fixed coordinate frames of USVs.
Jmse 10 01246 g001
Figure 2. The algorithm architecture of the integrated USV formation system.
Figure 2. The algorithm architecture of the integrated USV formation system.
Jmse 10 01246 g002
Figure 3. Tracking curve of FTFTSM-TC and ISM-TC. The asterisk represents the start position of the USV.
Figure 3. Tracking curve of FTFTSM-TC and ISM-TC. The asterisk represents the start position of the USV.
Jmse 10 01246 g003
Figure 4. Position tracking of FTFTSM-TC and ISM-TC.
Figure 4. Position tracking of FTFTSM-TC and ISM-TC.
Jmse 10 01246 g004
Figure 5. Velocity tracking of FTFTSM-TC and ISM-TC.
Figure 5. Velocity tracking of FTFTSM-TC and ISM-TC.
Jmse 10 01246 g005
Figure 6. Observation results of ADO.
Figure 6. Observation results of ADO.
Jmse 10 01246 g006
Figure 7. Norm of tracking errors and their derivatives.
Figure 7. Norm of tracking errors and their derivatives.
Jmse 10 01246 g007
Figure 8. Triangular formation of USVs. The asterisk represents the start position of the USV.
Figure 8. Triangular formation of USVs. The asterisk represents the start position of the USV.
Jmse 10 01246 g008
Figure 9. Position tracking of triangular formation of USVs.
Figure 9. Position tracking of triangular formation of USVs.
Jmse 10 01246 g009
Figure 10. Velocity tracking of triangular formation of USVs.
Figure 10. Velocity tracking of triangular formation of USVs.
Jmse 10 01246 g010
Figure 11. Position tracking of triangular formation of USVs.
Figure 11. Position tracking of triangular formation of USVs.
Jmse 10 01246 g011
Figure 12. Velocity tracking of triangular formation of USVs.
Figure 12. Velocity tracking of triangular formation of USVs.
Jmse 10 01246 g012
Table 1. Definitions of parameters in M , C , D .
Table 1. Definitions of parameters in M , C , D .
ParameterValueParameterValue
m 11 m X u ˙ c 23 ( ν ) m 11 u
m 22 m Y v ˙ d 11 ( ν ) X u X | u | u | u | X u u u u 2
m 23 m x g Y r ˙ d 22 ( ν ) Y v Y v v v
m 32 m x g N v ˙ d 23 ( ν ) Y r Y v r v Y r r r
m 33 I z N r ˙ d 32 ( ν ) N v N v v v N r v r
c 13 ( ν ) m 11 m 23 r d 33 ( ν ) N r N v r v N r r r
Table 2. Parameter values.
Table 2. Parameter values.
ParametersValuesParametersValuesParametersValues
h 1 , h i , 1 9 h 2 , h i , 2 5 n 1 , n i , 1 3
n 2 , n i , 2 5 a 1 , a i , 1 1 b 1 , b i , 1 1
ε 0 ; ε i , 0 0.1; 0.1 ε 1 ; ε i , 1 0.8; 0.6 ε 3 ; ε i , 3 0.7; 0.4
p7q9 1 d i a g [ 3 , 3 , 3 ]
2 d i a g [ 7 / 9 , 7 / 9 , 7 / 9 ] 3 d i a g [ 5 / 7 , 5 / 7 , 5 / 7 ] 4 d i a g [ 8 , 7 , 8 ]
κ 1 7/9 κ 2 7/5
Table 3. Main parameters of CyberShip II.
Table 3. Main parameters of CyberShip II.
ParametersValuesParametersValuesParametersValues
m23.8000 Y v −0.8612 X μ ˙ −2.0
I z 1.7600 Y v v −36.2823 Y v ˙ −10.0
x g 0.460 Y r 0.1079 Y r ˙ 0.0
X μ −0.7225 N v 0.1052 N v ˙ 0.0
X μ μ −1.3274 N v v 5.0437 N r ˙ −1.0
X μ μ μ −5.8664
Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Share and Cite

MDPI and ACS Style

Shen, H.; Yin, Y.; Qian, X. Fixed-Time Formation Control for Unmanned Surface Vehicles with Parametric Uncertainties and Complex Disturbance. J. Mar. Sci. Eng. 2022, 10, 1246. https://doi.org/10.3390/jmse10091246

AMA Style

Shen H, Yin Y, Qian X. Fixed-Time Formation Control for Unmanned Surface Vehicles with Parametric Uncertainties and Complex Disturbance. Journal of Marine Science and Engineering. 2022; 10(9):1246. https://doi.org/10.3390/jmse10091246

Chicago/Turabian Style

Shen, Helong, Yong Yin, and Xiaobin Qian. 2022. "Fixed-Time Formation Control for Unmanned Surface Vehicles with Parametric Uncertainties and Complex Disturbance" Journal of Marine Science and Engineering 10, no. 9: 1246. https://doi.org/10.3390/jmse10091246

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop