Next Article in Journal
Sequenced Steering Vector Estimation for Eigen-Subspace Projection-Based Robust Adaptive Beamformer
Next Article in Special Issue
An Image Enhancement Method for Side-Scan Sonar Images Based on Multi-Stage Repairing Image Fusion
Previous Article in Journal
A Deep-Learning-Based Approach to Keystroke-Injection Payload Generation
Previous Article in Special Issue
A Polar Moving Base Alignment Based on Backtracking Scheme
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Trajectory Tracking Control of Unmanned Surface Vehicles Based on a Fixed-Time Disturbance Observer

Tianjin Research Institute for Water Transport Engineering, M.O.T, Tianjin 300456, China
*
Author to whom correspondence should be addressed.
Electronics 2023, 12(13), 2896; https://doi.org/10.3390/electronics12132896
Submission received: 4 June 2023 / Revised: 27 June 2023 / Accepted: 28 June 2023 / Published: 30 June 2023

Abstract

:
In ocean environments with unknown complex disturbances, the control accuracy for an unmanned surface vehicle (USV) is severely challenged with an increase in task complexity. As the foundation for executing complex tasks, it is particularly important to control a USV to navigate along a safe trajectory that has been set. In order to effectively handle the trajectory tracking problem, an innovative USV tracking control strategy with high accuracy is proposed by combining the integral sliding-mode and disturbance observer technologies, and these are effectively extended to a scenario with the cooperative trajectory tracking of multiple USVs in this study. Specifically, unknown disturbances are treated as lumped uncertainties, and a novel fixed-time stable-convergence disturbance observer (FT-DO) is proposed to effectively observe and approximate the lumped uncertainties. Then, in order to quickly reach and steadily navigate along the desired trajectory, an effective fixed-time stable-convergence fast integral sliding mode is modified, and on this basis, an accurate trajectory tracking controller (FTFISM-TTC) for a single USV and a cooperative trajectory tracking controller for multiple USVs are meaningfully proposed. Finally, the stability of FT-DO and FTFISM-TTC was rigorously proven by using the Lyapunov approach, and a comprehensive simulation of current advanced tracking control methods was conducted by using Matlab, which proved the reliability of the proposed trajectory tracking control strategy and further eliminated the impact of the initial state on the tracking accuracy.

1. Introduction

With the significant improvement of hardware performance and operability, unmanned surface vehicles (USVs) come to be widely used in military and daily operations instead of humans due to their safety and scalability [1,2]. Especially in high-risk and high-uncertainty missions, USVs can perform tasks endlessly and efficiently on the basis of power support, which has significant effects on important tasks, such as threat monitoring, target reconnaissance, and search and rescue. In the field of intelligent control of USVs, as the foundation for USVs’ performance of other complex tasks, trajectory tracking control has received widespread attention from researchers, and rapid progress has been made in single-USV trajectory tracking [3]. The goal of single-USV trajectory tracking control is to guide and control a USV to arrive at a desired trajectory from any position and to navigate along the desired trajectory with minimal tracking error. It is worth mentioning that a given desired trajectory is a continuous curve composed of a series of waypoints with time constraints in an Earth coordinate system. As the complexity of tasks increases, deficiencies, such as the low efficiency and poor robustness of a single USV, gradually emerge. In order to further improve the efficiency of task completion, multiple USVs can be formed into a designed formation to execute tasks along the set trajectory, which greatly improves the efficiency of highly time-based tasks, such as regional searches.
As an extension of single-USV trajectory tracking control, multiple-USV cooperative trajectory tracking control limits the positioning among USVs by setting the desired navigation trajectory for each USV in advance, thus significantly reducing the task completion time and demonstrating advantages such as high accuracy and robustness. The cooperative trajectory tracking control scenario can be implemented using the formation control framework, and typical formation strategies include leader–follower formation framework, artificial potential field, behavior-based, virtual structure, and graph theory [4,5,6,7,8]. Specifically, a distributed prescribed-time leader–follower formation control scheme for SUV in [4], while meeting the predefined transient performance and overcoming the unknowns and input saturation. In [5], the artificial potential function consisting of formation control term and target tracking term is established for multiple unmanned aerial vehicles, which achieves accurate formation. Considering the problems of unreachable targets and local minimums in artificial potential fields, ref. [6] solves these problems by introducing behavior-based AUG formation control method. However, the disadvantage of this method is that it is difficult to describe the dynamic characteristics of the group, and difficult to control the stability of the formation. In [7], a method of finite-time position and attitude tracking control method combined with artificial potential field and virtual structure is presented, which ensures that the AUVs avoid collisions with each other during the dive, and form and change the formation after reaching the set depth. However, due to the virtual structure method requiring the formation to maintain a rigid structure, its collision avoidance effect is poor. In [8], a distance-based graph rigidity and affine transformation algorithm is used to control a fleet of AUVs to achieve any desired formation shape. Among the above control strategies, the leader–follower formation method is the most commonly referenced because of its simple structure and stable formation. We only need to strictly set the position difference between USVs while ensuring that the leader USV stably navigates along the set trajectory. Inspired by the leader–follower framework proposed in [4], a simple and effective dual layer cooperative trajectory tracking framework is designed to simplify analysis in this paper.
During the process of tracking a desired trajectory, the designed tracking controller should have a fast and stable convergence speed. The common intelligent trajectory tracking control algorithms are as the following: sliding-mode control, backstepping, model predictive control, and fuzzy control. Among the above methods, the backstepping method has good tracking and control performance in ideal conditions, but its performance is poor in situations with unknown external disturbances. In comparison, the sliding-mode control method has the simplest structure, has excellent control performance, and is insensitive to disturbances that may exist [9]. Therefore, as a theoretical basis, sliding-mode control has been widely improved and applied in the field of intelligent control of USVs. Typical improvement methods include integral sliding mode (ISM), terminal sliding mode (TSM), nonsingular terminal sliding mode (NTSM) and adaptive sliding mode scheme [10,11,12,13,14]. The ISM scheme, as a fundamental and effective sliding mode control method, ensures the robustness of the system by determining the appropriate initial position to ensure that the system only has a sliding stage, which is widely used in USV control. In [10], an improved integral sliding mode control attitude controller for AUV with model uncertainties and external disturbances is proposed to improve the ability of attitude tracking. However, due to its insensitivity to disturbances, the tracking performance is poor in non ideal environments. Compared with ISM, the TSM has the characteristics of finite time convergence and stable tracking. In [11], a formation tracking control method for the operation of multiagent systems under disturbances is proposed based on the fast TSM scheme. It is worth mentioning that most TSM schemes cannot eliminate singularity. On the basis of TSM, a time-varying NTSM controller is designed to ensure the global robustness of the USV tracking system with respect to large uncertainties and unknown environmental disturbances in [12]. Although this method effectively eliminates singularity, the convergence time is too dependent on the initial state of the system. In order to further improve the trajectory tracking accuracy in the presence of multiple disturbances, an adaptive sliding-mode unit vector control approach based on monitoring functions is proposed to handle disturbances of unknown bounds in [13,14]. The strategy is able to guarantee a pre-specified transient time, maximum overshoot, and steady-state error for multivariable uncertain plants, which verified its effectiveness in USV trajectory tracking control. It is worth mentioning that [13] provides rigorous theoretical derivation on the proposed adaptive sliding mode strategy, which is lacking in this article and the proposed strategy in this article is more inclined towards application. Compared with other sliding mode methods, the ISM ensures that the system can only have a sliding stage by obtaining an appropriate initial position to ensure robustness. Nevertheless, the ISM has limitations in convergence speed and relies on the initial state of the trajectory tracking. Based on TIM scheme and fixed-time theory, a novel fast integral sliding mode strategy is designed to further optimize convergence speed and stability in this paper.
Due to the limitations of existing trajectory tracking control methods and navigation uncertainties, there is a significant error between the actual navigation path and the expected trajectory. To further improve the trajectory tracking accuracy, combinations of finite-time theory and intelligent control methods can significantly improve the tracking performance of single or multiple USVs [15,16,17]. Nevertheless, finite-time theory cannot eliminate the impact of the initial state of a USV on control performance. To address this drawback, researchers have attempted to apply fixed-time control theory in multi-agent cooperative control to improve the control accuracy while reducing the dependence on the initial states [18,19], which was first proposed and rigorously proven in [20]. Hence, the fixed-time theory was used to optimize the control performance of the sliding-mode control in this study, and then an efficient trajectory tracking controller was designed.
Actual ocean environments have various unknown disturbances, and due to the limitations of sea trials, it is not possible to identify all USV model parameters. Therefore, one must accurately identify the internal and external disturbances present in a tracking system before designing a trajectory tracking controller [21]. The classical disturbance identification methods include active disturbance rejection control, neural network approximation, and Kalman filtering. Nevertheless, these methods have low disturbance processing accuracy and are prone to falling into local minima. On the basis of the above disturbance identification methods, disturbance observer technology has been proposed to identify unknown disturbances in the system and demonstrates excellent identification performance. In [22], a nonlinear disturbance observer is designed to repair the velocity and position information of USVs disturbed by multiple types of noise. In order to perform mixed fault disturbance identification for USV with input saturation constraints, an accurate finite-time convergence observer was designed in [23]. In [24], an improved observer is proposed to observe and handle complex disturbances during USV navigation and control the underactuated USV to accurately track the desired trajectory. To further optimize disturbance identification performance, the idea of extended state observer (ESO) was proposed in [25] and demonstrated excellent performance. For similar disturbance identification, a time-shifted sliding mode observer (SMO) is proposed to solve the problem of fault reconstruction in delayed systems in [26], which utilizes the variation of constants formula to obtain the present time estimate of the unmeasured state, achieving excellent observation results. In [27], a novel time shift approach for actuator fault reconstruction of systems with output time-delay based on a sliding mode observer is proposed to ensure that ideal sliding mode is made possible even in the presence of delay. Although the disturbance observer mentioned above can identify the disturbances present in the system, the identification accuracy of the above disturbance observer technologies will be affected by the initial observation state. Therefore, to further improve the disturbance identification performance and eliminate the impact of initial observation errors, we propose a modified disturbance observer based on fixed time control theory to accurately identify the disturbances existing in cooperative trajectory tracking system.
As mentioned above, in order to ensure that a USV can quickly track a set trajectory and accurately navigate along the desired trajectory with complex internal and external disturbances, a high-performance tracking controller and a high-precision disturbance observer are proposed in this study. Specifically, a modified fixed-time convergence disturbance observer (FT-DO) is proposed to achieve accurate identification of a lumped disturbance term in the tracking control system. Secondly, for a single-USV trajectory tracking control scenario, a reliable fixed-time-convergence fast integral sliding-mode trajectory tracking controller (FTFISM-TTC) is proposed to further improve the trajectory tracking accuracy and convergence speed. Then, a multiple-USV cooperative trajectory tracking controller was designed to demonstrate the scalability of the proposed algorithm. Finally, rigorous theoretical proof and a comprehensive simulation analysis are used to prove that the FTFISM-TTC is superior to the backstepping and TSM in [28]. Compared with the previous works, the main innovations of this paper are as follows.
(1) The internal unknown parameter disturbances and external ocean disturbances present in the trajectory tracking control system were considered as a lumped disturbance term. Then, a high-precision fixed-time-convergence disturbance observer (FT-DO) was designed to accurately identify the lumped disturbance term in real time and effectively eliminate the impact of initial errors on the identification accuracy.
(2) After the lumped disturbance term was eliminated, the FTFISM-TTC was proposed to ensure that a USV could quickly navigate to the set trajectory and to ensure stable movement along the current trajectory, while effectively eliminated the dependence of the tracking control accuracy on the initial state. Then, the trajectory tracking control of a single USV was extended to multiple-USV cooperative tracking control within the leader–follower framework, which further verified the scalability and effectiveness of the proposed FTFISM-TTC strategy.
(3) By designing appropriate Lyapunov functions to rigorously analyze the tracking control strategy, the reliability of the designed FT-DO and FTFISM-TTC was proved. At the same time, through comprehensive simulation and comparison experiments in Matlab, the excellent control performance of FT-DO and FTFISM-TTC was further verified.
The structure of the content is as follows: The basic lemmas and mathematical model of USV trajectory tracking are introduced in Section 2. Section 3 describes the design of the FT-DO and FTFISM-TTC, and it provides detailed theoretical derivations and proof of stability. Multiple comprehensive simulation and comparison experiments are described in Section 4. Section 5 provides a detailed summary.

2. Preliminaries and Mathematical Model

To facilitate the subsequent controller design and proof of stability, this section describes the key lemmas needed for disturbance identification and the design of the tracking controller, and it introduces a detailed mathematical USV model.

2.1. Preliminaries

 Lemma 1.
For the following asymptotically stable system [29],
x ˙ ( t ) = f ( x ( t ) ) , x ( 0 ) = x 0 f ( 0 ) = 0 , x R n
where x = [ x 1 , x 2 , , x n ] T is the state vector of the nonlinear system and f ( · ) : N R n is an upper semicontinuous mapping in an open neighborhood N of the origin such that the set f ( x ) is non-empty for any x N .
The system (1) converges to stability in finite time with a negative degree of homogeneity. If the convergence time set by the system has an upper bound T m a x > 0 , i.e., T ( ε ) T m a x for all ε R n , the asymptotically stable system (1) is proven to be fixed-time stable.
 Lemma 2.
For the following system [30],
y ˙ = γ 1 y 2 p / q γ 2 y p / q , y ( 0 ) = y 0 ,
if  γ 1 , γ 2 > 0 , p < q , and both of them represent positive odd integers; then, the scalar system (2) ensures convergence within a fixed time, and the maximum convergence time until stability is calculated as follows:
T m a x y 0 = q π 2 γ 1 γ 2 q p
 Lemma 3.
For the following nonlinear system [31],
y ˙ = α y A β y B , y ( 0 ) = y 0
where  α > 0 , β > 0 . A is composed of parameters a 1 and a 2 , and it satisfies A = a 1 / a 2 . B is composed of parameters b 1 and b 2 , and it satisfies B = b 1 / b 2 . If the above parameters are positive odd integers that satisfy a 1 > a 2 , b 1 < b 2 < 2 b 1 , the nonlinear system (4) ensures convergence within a fixed time, and the maximum convergence time until stability is calculated as follows:
T m a x = a 2 α ( a 1 a 2 ) + b 2 β ( b 2 b 1 )

2.2. Mathematical Model

Due to the limitations of ocean experiments, the model parameters of USVs could not be fully obtained. At the same time, stability is severely affected by unknown disturbances, such as wind, waves, and currents, when a USV performs tasks in actual ocean environments. Therefore, under the premise of reflecting the trajectory tracking characteristics of USVs as much as possible, a three-DOF mathematical USV model containing a lumped disturbance term was designed based on the Cybership II USV model shown in Figure 1a, which included the yaw angular speed r, sway speed v, and surge speed u. It is worth mentioning that the scalar-variable description of the roto-translational motion of a rigid object looks a bit obsolete, and the models proposed in [32,33] based on lie group and manifold theory are more advanced. However, the USV mathematical model used in this article can clearly reflect the motion mechanism of the USV and simplify the controller design process.
Figure 1b shows the three-DOF mathematical USV model. The kinetic and dynamic models of a single USV can be expressed as follows:
η ˙ = R ( ψ ) ν M ν ˙ + C ( ν ) ν + D ( ν ) ν = δ + τ
where η = [ x , y , ψ ] T represents the three different dimensional vectors contained in the kinematic model, ν = [ u , v , r ] T represents the three different dimensional vectors contained in the dynamic model, and τ = [ τ i 1 , 0 , τ i 3 ] T represents the control input of the USV in the forward direction and in steering. The unknown external disturbance term δ = M R T ( ψ ) d ( t ) is caused by wind, waves, and currents, and R ( ψ ) represents the rotation matrix between the Earth coordinate system and the relative motion coordinate system, which satisfies the following characteristics:
R ˙ ( ψ ) = R ( ψ ) S ( r ) R T ( ψ ) S ( r ) R ( ψ ) = R ( ψ ) S ( r ) R T ( ψ ) = S ( r ) R ( ψ ) = 1 , R T ( ψ ) R ( ψ ) = I , ψ [ 0 , 2 π ]
where
R ( ψ ) = cos ψ sin ψ 0 sin ψ cos ψ 0 0 0 1
S ( r ) = 0 r 0 r 0 0 0 0 0
The matrix M = M T > 0 represents the inertia matrix during the USV’s motion, and C ( ν ) = C ( ν ) T and D ( ν ) represent the ocean testing parameter matrices, which include unmodeled dynamics in the USV model. The structure of the above matrices is represented as follows:
C ( ν ) = 0 0 c 13 ( ν ) 0 0 c 23 ( ν ) c 13 ( ν ) c 23 ( ν ) 0
D ( ν ) = d 11 ( ν ) 0 0 0 d 22 ( ν ) d 23 ( ν ) 0 d 32 ( ν ) d 33 ( ν )
M = m 11 0 0 0 m 22 m 23 0 m 32 m 33
The simplification of the mathematical USV model (6) by using the Lagrange equation is as follows:
M ˜ ( η ) η ¨ + C ˜ ( η , η ˙ ) η ˙ + D ˜ ( η , η ˙ ) η ˙ = R ( η ) τ + δ ( t )
The transformed inertia matrix M ˜ , skew-symmetric matrix C ˜ , and damping matrix D ˜ are 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
Let x 1 = η , x 2 = η ˙ , and the internal unknown parameters and external complex disturbances are treated as a lumped disturbance term Δ , which satisfies the condition of being continuously differentiable and bounded: Δ = M ˜ 1 δ ( t ) C ˜ ( x 1 , x 2 ) x 2 D ˜ ( x 1 , x 2 ) x 2 . Then, we simplify (13) as follows:
x ˙ 1 = x 2 x ˙ 2 = M ˜ 1 ( x 1 ) R ( x 1 ) τ + Δ
The detailed parameter explanations for M , C , D are shown in Table 1. The terms m and I z represent the mass and the moment of inertia of the USV, N v ˙ = Y r ˙ , and X * , Y * , Z * represent the sea trial parameters for hydrodynamics.
The desired trajectory tracking model is represented as follows:
η ˙ d = R ( ψ d ) ν d M d ν ˙ d + C ( ν d ) ν d + D ( ν d ) ν d = τ d
where τ d = [ τ d 1 , 0 , τ d 3 ] T represents the ideal speed and steering input for the USV tracking the desired trajectory, and η d = [ x d , y d , ψ d ] T and ν d = [ u d , v d , r d ] T represent the ideal states of the USV when sailing along the desired trajectory without disturbances.

3. Disturbance Identification and Trajectory Tracking Controller Design

In the disturbance identification section, a novel fixed-time convergence disturbance observer is designed to ensure the accurate estimation of disturbances. Then, an accurate trajectory tracking control strategy is proposed based on a modified sliding-mode control and the fixed-time theory to ensure that a single USV can quickly reach a desired tracking trajectory and stabilize its navigation. Finally, the single-USV trajectory tracking control is expanded to multiple USVs, and a cooperative tracking controller is proposed by using the leader–follower framework. The overall cooperative trajectory tracking framework is shown in Figure 2.

3.1. Design and Analysis of the Stability of the FT-DO

As mentioned earlier, the internal unknown parameters and external complex disturbances in trajectory tracking are regarded as a lumped disturbance term Δ , which directly causes errors between the USV and the desired position. Therefore, to simplify the design of the disturbance observer, an auxiliary variable is introduced as follows:
Φ ˙ = M ˜ 1 ( x 1 ) R ( x 1 ) τ + λ Φ e
where Φ e = x 2 Φ , and λ is a normal number.
By combining the mathematical model of USV, the following fixed-time disturbance observer (FT-DO) is proposed:
Δ ^ = λ Φ ^ e + Φ ˙ e
where Δ ^ = Δ ^ i , 1 , Δ ^ i , 2 , Δ ^ i , 3 T represents the disturbance observation values of three different dimensions of Δ . Φ ^ e is the state estimate of Φ e , and the derivative is given by:
Φ ^ ˙ e = Φ ˙ e + α i , 1 s i g n ( Φ ˜ e ) β i , 1 + α i , 2 s i g n ( Φ ˜ e ) β i , 2 + α i , 3 Φ ˜ e
where Φ ˜ e = Φ e Φ ^ e represents the estimation error of the FT-DO, and α i , 1 , α i , 2 , α i , 3 > 0 and β i , 2 > 1 > β i , 1 > 0 represent disturbance observer’s gain.
 Theorem 1.
Let Δ ˜ be the disturbance observation error between the disturbance observation value and the lumped disturbance term Δ. The designed FT-DO can achieve fixed-time stability and ensure that the observation error converges to zero within a fixed time, i.e., when t T , Δ ˜ ( t ) = 0 . Then, the maximum convergence time of the designed FT-DO is obtained as follows:
T T M A X : = 1 2 1 + β i , 1 2 α i , 1 ( 1 β i , 1 ) + 1 2 1 + β i , 2 2 α i , 2 ( β i , 2 1 )
 Proof of Theorem 1.
From the above formula, the derivative of the estimation error Φ ˜ e is calculated as follows:
Φ ˜ ˙ e = Φ ˙ e Φ ^ ˙ e = Φ ˙ e Φ ˙ e α i , 1 s i g n ( Φ ˜ e ) β i , 1 α i , 2 s i g n ( Φ ˜ e ) β i , 2 α i , 3 Φ ˜ e = α i , 1 s i g n ( Φ ˜ e ) β i , 1 α i , 2 s i g n ( Φ ˜ e ) β i , 2 α i , 3 Φ ˜ e
The following Lyapunov function is selected:
V Φ = 1 2 Φ ˜ e T Φ ˜ e
The derivative of Equation (22) is taken as follows:
V ˙ Φ = Φ ˜ e T Φ ˜ ˙ e = Φ ˜ e T [ α i , 1 s i g n ( Φ ˜ e ) β i , 1 α i , 2 s i g n ( Φ ˜ e ) β i , 2 α i , 3 Φ ˜ e ] α i , 1 Φ ˜ e T s i g n ( Φ ˜ e ) β i , 1 α i , 2 Φ ˜ e T s i g n ( Φ ˜ e ) β i , 2 α i , 1 · 2 · 1 2 Φ ˜ e 2 1 + β i , 1 2 α i , 2 2 · 1 2 Φ ˜ e 2 1 + β i , 2 2 2 1 + β i , 1 2 α i , 1 V Φ 1 + β i , 1 2 2 1 + β i , 2 2 α i , 2 V Φ 1 + β i , 2 2
According to Lemma 3, the estimation error Φ ˜ e of the FT-DO achieves fixed-time stability, and the maximum convergence time of the designed FT-DO is obtained as follows:
T T M A X : = 1 2 1 + β i , 1 2 α i , 1 ( 1 β i , 1 ) + 1 2 1 + β i , 2 2 α i , 2 ( β i , 2 1 )
By combining (15) and (18), the disturbance observation error between the disturbance observation value and the lumped disturbance term Δ can be calculated as follows:
Δ ˜ = Δ Δ ^ = x ˙ 2 M ˜ 1 ( x 1 ) R ( x 1 ) τ λ Φ ^ e Φ ˙ e = x ˙ 2 M ˜ 1 ( x 1 ) R ( x 1 ) τ λ Φ ^ e x ˙ 2 + Φ ˙ = M ˜ 1 ( x 1 ) R ( x 1 ) τ λ Φ ^ e + M ˜ 1 ( x 1 ) R ( x 1 ) τ + λ Φ e = λ Φ e Φ ^ e = λ Φ ˜ e
To summarize, when t T , Δ ˜ ( t ) = 0 , the disturbance observation error converges within a fixed time.
The proof of Theorem 1 and the fixed-time stability of the FT-DO is complete. □

3.2. Design and Analysis of the Stability of the FTFISM-TTC

After disturbance identification, in order to ensure that the USV can quickly and accurately track the desired trajectory, an efficient tracking trajectory controller that effectively eliminates the impact of the initial tracking error on tracking accuracy must be designed.
The real-time tracking error of the USV is defined as follows:
x e 1 = x 1 η d x e 2 = x 2 η ˙ d
The derivation of (26) is as follows:
x ˙ e 1 = x e 2 x ˙ e 2 = M ˜ 1 ( x 1 ) R ( x 1 ) τ + Δ η ¨ d
Based on the characteristics of not relying on the initial state and the high robustness of fixed-time control and the integral sliding mode, a novel fixed-time-convergence fast integral sliding mode (FTFISM) is proposed as follows:
S ( t ) = x e 2 ( t ) + k s 0 t ( μ ( x e 1 ( σ ) ) + μ ( x e 2 ( σ ) ) ) d σ μ ( x e 1 ( σ ) ) = a 1 s i g ϑ 1 ( x e 1 ( σ ) ) + a 2 s i g ( x e 1 ( σ ) ) + a 3 s i g ϑ 2 ( x e 1 ( σ ) ) μ ( x e 2 ( σ ) ) = b 1 s i g ϑ 3 ( x e 2 ( σ ) ) + b 2 s i g ( x e 2 ( σ ) ) + b 3 s i g ϑ 4 ( x e 2 ( σ ) )
where k s represents integral sliding-mode gain. a i , b i > 0 . ( i = 1 , 2 , 3 ) , 1 > ϑ 1 , ϑ 3 > 0 , 2 > ϑ 2 , ϑ 4 > 1 .
The derivation of (28) is as follows:
S ˙ ( t ) = x ˙ e 2 ( t ) + k s ( μ ( x e 1 ( t ) ) + μ ( x e 2 ( t ) ) ) = M ˜ 1 ( x 1 ) R ( x 1 ) τ + Δ η ¨ d + k s ( μ ( x e 1 ( t ) ) + μ ( x e 2 ( t ) ) )
By combining (29) and Lemma 2, the fixed-time-convergence fast integral sliding-mode trajectory tracking controller (FTFISM-TTC) is proposed as follows:
τ = M ˜ R ( Δ ^ η ¨ d + k s ( μ ( x e 1 ( t ) ) + μ ( x e 2 ( t ) ) ) + l 0 S + l 1 S 2 m n + l 2 S m n )
where l 0 , l 1 , l 2 > 0 . m < n , and both of them are positive odd integers.
 Theorem 2.
After disturbance identification, the proposed FTFISM-TTC can achieve fixed-time stable convergence and ensure that the USV can quickly and accurately track a trajectory in both the position and velocity dimensions.
 Proof of Theorem 2.
Firstly, in order to demonstrate that the cooperative trajectory tracking control errors x e 1 , and x e 2 can quickly reach the surface of the FTFISM and achieve fixed-time convergence, we select the following Lyapunov function:
V s = 1 2 S T S
By combining (28) and (29), the derivative of (31) is taken as follows:
V ˙ s = S T S ˙ = S T [ x ˙ e 2 ( t ) + k s ( μ ( x e 1 ( t ) ) + μ ( x e 2 ( t ) ) ) ] = S T [ M ˜ 1 ( x 1 ) R ( x 1 ) τ + Δ η ¨ d + k s ( μ ( x e 1 ( t ) ) + μ ( x e 2 ( t ) ) ) ]
Combining this with (30), the above formula is simplified as follows:
V ˙ s = S T { M ˜ 1 ( x 1 ) R ( x 1 ) [ M ˜ ( x 1 ) R ( x 1 ) ( Δ ^ η ¨ d + k s ( μ ( x e 1 ( t ) ) + μ ( x e 2 ( t ) ) ) + l 0 S + l 1 S 2 m n + l 2 S m n ) + Δ η ¨ d + k s ( μ ( x e 1 ( t ) ) + μ ( x e 2 ( t ) ) ] } = S T [ l 0 S + l 1 S 2 m n + l 2 S m n + ( Δ ^ Δ ) ]
In the previous section, the lumped disturbance term Δ was accurately identified and compensated by the designed FT-DO in the USV trajectory tracking control, i.e., when t T , Δ ˜ = Δ Δ ^ = 0 . Then, the above formula can be simplified as follows:
V ˙ s = S T [ l 0 S + l 1 S 2 m n + l 2 S m n + ( Δ ^ Δ ) ] = S T ( l 0 S + l 1 S 2 m n + l 2 S m n ) = l 0 S T S l 1 S T S 2 m n l 2 S T S m n l 1 × 2 3 n m 2 n ( 1 2 S 2 ) 3 n m 2 n l 2 × 2 n + m 2 n ( 1 2 S 2 ) n + m 2 n 2 3 n m 2 n l 1 V s 2 n + m 2 n 2 n + m 2 n l 2 V s n + m 2 n
Let A 1 = 2 3 n m 2 n l 1 , A 2 = 2 n + m 2 n l 2 , B 1 = n + m , B 2 = 2 n . The above formula can be simplified as follows:
V ˙ s A 1 V s 2 B 1 B 2 A 2 V s B 1 B 2
According to Lemma 2, the maximum convergence time during the reaching phase is calculated as follows:
T S = B 2 π 2 A 1 A 2 ( B 2 B 1 )
After arriving at the sliding surface, S = 0 , S ˙ = 0 . Then, we can obtain
x ˙ e 2 ( t ) = k s ( μ ( x e 1 ( t ) ) + μ ( x e 2 ( t ) ) ) = a 1 k s s i g ϑ 1 ( x e 1 ( σ ) ) a 2 k s s i g ( x e 1 ( σ ) ) a 3 k s s i g ϑ 2 ( x e 1 ( σ ) ) b 1 k s s i g ϑ 3 ( x e 2 ( σ ) ) b 2 k s s i g ( x e 2 ( σ ) ) b 3 k s s i g ϑ 4 ( x e 2 ( σ ) )
According to Lemma 3, the tracking errors x e 1 ( t ) , x e 2 ( t ) will achieve fixed-time stability during the sliding stage and ultimately converge to zero.
In summary, the designed FTFISM-TTC can ensure fixed-time stability, and the trajectory tracking error quickly converges to zero to achieve precise tracking performance.
The proof of Theorem 2 is complete. □

3.3. Design of the Cooperative Trajectory Tracking Controller

In the previous subsection, the fixed-time control theory and fast integral sliding mode were combined to propose a single-USV trajectory tracking controller for quickly and accurately tracking a set trajectory and stabilizing navigation, and a rigorous theoretical derivation was conducted by using the Lyapunov stability theory. In this subsection, in order to further analyze the scalability of the designed tracking control strategy, the single-USV trajectory tracking control is extended to multiple-USV cooperative trajectory tracking.
For simplification, the leader–follower framework is used to design a cooperative trajectory tracking strategy for controlling three USVs to continuously maintain a fixed triangular formation; the relative position difference among the USVs is assumed to generate the desired trajectory for the follower USVs. Assuming that the tracking strategy given in the previous subsection is for the leader USV, the tracking control strategy for the follower USVs needs to be designed here. First, the simplified kinematic and dynamic models of the follower USVs can be rewritten as follows:
x ˙ i , 1 = x i , 2 x ˙ i , 2 = M ˜ 1 ( x i , 1 ) R ( x i , 1 ) τ i + Δ i
where i = 1 , 2 denotes follower USV1 and follower USV2. x i , 1 = η i , x i , 2 = η ˙ i , and Δ i represent the lumped disturbance term of each follower USV, which are shown as follows:
Δ i = M ˜ 1 δ ( t ) C ( x i , 1 , x i , 2 ) x i , 2 D ( x i , 1 , x i , 2 ) x i , 2
The cooperative trajectory tracking errors of the follower USVs are represented as follows:
x i , e 1 = x i , 1 η x i , e 2 = x i , 2 η ˙
and the derivative is governed by
x ˙ i , e 1 = x i , e 2 x ˙ i , e 1 = M ˜ 1 ( x i , 1 ) R ( x i , 1 ) τ i + Δ i η ¨
Considering the FTFISM (28), we have:
S i ( t ) = x i , e 2 ( t ) + k s 0 t ( μ ( x i , e 1 ( σ ) ) + μ ( x i , e 2 ( σ ) ) ) d σ μ ( x i , e 1 ( σ ) ) = a 1 s i g ϑ 1 ( x i , e 1 ( σ ) ) + a 2 s i g ( x i , e 1 ( σ ) ) + a 3 s i g ϑ 2 ( x i , e 1 ( σ ) ) μ ( x i , e 2 ( σ ) ) = b 1 s i g ϑ 3 ( x i , e 2 ( σ ) ) + b 2 s i g ( x i , e 2 ( σ ) ) + b 3 s i g ϑ 4 ( x i , e 2 ( σ ) )
The derivation of (42) is as follows:
S ˙ i ( t ) = x ˙ i , e 2 ( t ) + k s ( μ ( x i , e 1 ( t ) ) + μ ( x i , e 2 ( t ) ) ) = M ˜ 1 ( x i , 1 ) R ( x i , 1 ) τ + Δ i η ¨ d + k s ( μ ( x i , e 1 ( t ) ) + μ ( x i , e 2 ( t ) ) )
Combining (41) and Lemma 2, the fixed-time-convergence fast integral sliding-mode trajectory tracking controller (FTFISM-TTC) for the follower USVs is proposed as follows:
τ i = M ˜ R ( Δ ^ i η ¨ d + k s ( μ ( x i , e 1 ( t ) ) + μ ( x i , e 2 ( t ) ) ) + l i , 0 S i + l i , 1 S i 2 m n + l i , 2 S i m n )
where Δ i represents the lumped disturbance term for the follower USVs during the cooperative trajectory tracking control, and Δ ^ i is the observed value of the corresponding disturbance observer.
In a cooperative control scenario with multiple USVs, the formation is usually composed of the same type of USV, and due to experimental limitations, the expected distance between the USVs was not too far to avoid the reduction in control accuracy caused by communication errors. Hence, there were no significant differences in the lumped disturbance terms between the USVs, i.e., Δ 1 = Δ 2 .
It is worth mentioning that the process used for the proof of stability is similar to that used for the proof of stability of the FTFISM-TTC with a single USV in the previous subsection. Accordingly, the designed cooperative trajectory tracking strategy can ensure fixed-time stability for each follower USV, and the trajectory tracking error of the closed-loop cooperative tracking system will quickly converge to zero.

4. Simulations and Discussion

Through rigorous theoretical derivations, the stability of the proposed FT-DO and FTFISM-TTC was clearly demonstrated. Nevertheless, due to constraints such as actuator saturation and input constraints in the actual environment of USVs, it is impossible to arbitrarily adjust the convergence time. Therefore, there is actually a minimum lower bound for this convergence according to the maximum output of the actuator.
This section describes rigorous simulations that were conducted to verify the reliability of the designed FT-DO and FTFISM-TTC. The parameters of the FT-DO and FTFISM-TTC are shown in Table 2. The parameters of the Cybership II USV model [34] are shown in Table 3, as this was selected for the simulation experiments due to its relatively complete model parameters.
To ensure disturbance uncertainty, the following disturbances were set separately:
d l e a d e r = 4 × cos ( 1 10 × π × t 1 4 × π ) s i n ( 1 5 × π × t + 1 4 × π ) 6 cos ( 1 5 × π × t + 1 6 × π ) + 0.2 × t 0.05 × t
d f o l l o w e r = 4 × cos ( 3 20 × π × t + π 6 ) 2 6 × sin ( 1 4 × π × t + π 6 ) 0.2
The specific results of the comparative simulation experiments are shown in Figure 3, Figure 4, Figure 5, Figure 6, Figure 7, Figure 8, Figure 9, Figure 10, Figure 11, Figure 12, Figure 13, Figure 14 and Figure 15. Figure 3, Figure 4, Figure 5 and Figure 6 show the disturbance observation performance of the proposed FT-DO, which demonstrated that the designed FT-DO could quickly and accurately handle the lumped uncertainty terms Δ and Δ i . Specifically, in Figure 3 and Figure 5, the black line represents the actual set disturbance curve, and the other line is the observation of the FT-DO, which clearly demonstrates that the designed FT-DO could stably identify disturbances in real time.
To further demonstrate the superiority of the designed disturbance observer, the norms of the disturbance identification errors are shown in Figure 4 and Figure 6. the black line represents the trajectory tracking error curve without disturbance processing, and the red line represents the tracking control effect after the disturbance was identified by FT-DO. The error level is shown in Table 4, which further demonstrates the excellent disturbance identification ability of the proposed FT-DO.
In order to verify the excellent performance of the designed single-USV trajectory tracking controller (FTFISM-TTC), the initial states of the desired trajectories and the USV are shown in Table 5, and the desired trajectories T D , 1 a n d T D , 2 were set as follows:
T D , 1 = [ 6 × s i n ( 0.05 × π × t ) , 2 × c o s ( 0.05 × π × t ) , 0.2 × t + 2 ] T T D , 2 = [ s i n ( 0.05 × π × t ) + 0.15 × t , 0.2 × t , 0.2 × t ] T
Figure 7, Figure 8, Figure 9, Figure 10, Figure 11 and Figure 12 show the comprehensive results of the simulation experiments on the FTFISM-TTC with the TSM-TTC and backstepping-TTC [25]. Specifically, in Figure 7 and Figure 10, the blue line is the tracking curve obtained with the TSM-TTC strategy and backstepping-TTC strategy, and the red line is the tracking curve obtained with the FTFISM-TTC strategy. The results show that backstepping strategy and the TSM-TTC strategy could not effectively track the expected trajectory in real time, and the proposed FTFISM-TTC had excellent tracking performance.
To clearly demonstrate the differences in the tracking performance of different tracking control algorithms in different dimensions, Figure 8Figure 9, Figure 11, and Figure 12 show the tracking effects on different tracking velocity and tracking position dimensions with the state-of-the-art methods and the proposed FTFISM-TTC strategy, clearly indicating that the FTFISM-TTC had more reliable tracking performance than that of TSM-TTC and backstepping-TTC.
To further verify the scalability of the designed FTFISM-TTC, Figure 13 demonstrates that three USVs could continuously maintain the desired formation to achieve precise cooperative trajectory tracking. Specifically, after the leader USV navigated to the desired trajectory, the follower USVs quickly moved to the set position to ensure the desired triangular formation and steadily navigated along the desired trajectory, thus exhibiting the excellent cooperative trajectory tracking control performance of the proposed FTDO-based FTFISM-TTC strategy. The initial states of the desired trajectories and USVs are shown in Table 6. For further analysis, Figure 14 and Figure 15 show the detailed position tracking curves and velocity tracking curves during cooperative trajectory tracking control, which effectively verified that the proposed FTDO-based FTFISM-TTC had strong robustness and could stably expand to the collaborative control of multiple USVs. It is worth emphasizing that the FT-DO and FTFISM-TTC proposed in this article have excellent disturbance identification ability and precise trajectory tracking performance, but still have the following limitations: due to the rigid structure limitations of the leader–follower cooperative trajectory tracking framework, the overall formation lacks flexibility, and the scalability of the algorithm needs to be further improved. Secondly, the disturbance settings in this article have certain limitations, as there are various static and dynamic obstacles that cannot be ignored in the actual marine environment, which seriously affect the safe navigation of the USV. This article provides a great research direction for precise trajectory tracking of USVs.

5. Conclusions

In motion trajectory tracking for USVs, internal model uncertainties and external environmental disturbances seriously affect the tracking accuracy. For multiple-USV cooperative trajectory tracking control with complex disturbances, a novel tracking controller was designed based on fixed-time theory and integral sliding-mode control. In the disturbance identification subsystem, a fixed-time convergent disturbance observer (FT-DO) was designed to achieve continuous and accurate observation of the lumped disturbance term and effectively eliminate the impact of initial disturbance observation errors on the observation accuracy. Then, a fixed-time-convergence fast integral sliding-mode trajectory tracking controller (FTFISM-TTC) was designed to ensure that the USV could quickly and stably track the desired trajectory and further optimize the convergence speed and tracking accuracy. Moreover, the extremely strong scalability of the proposed FTFISM-TTC was further demonstrated in multiple-USV cooperative trajectory tracking control. A rigorous stability analysis using the Lyapunov stability theory and comprehensive simulation experiments proved that the designed FT-DO and FTFISM-TTC could ensure convergence within a fixed time, and the controller’s performance was superior to that of state-of-the-art methods, such as TSM and backstepping.
Future research will focus on improving the disturbance identification accuracy and the avoidance of dynamic and static obstacles. After a rigorous theoretical demonstration and comprehensive verification through simulations, in the future, experiments with real USVs will be conducted if the experimental conditions allow.

Author Contributions

Methodology, X.L. (Xiaosong Li) and X.L. (Xiaochen Li); software, X.L. (Xiaosong Li) and X.L. (Xiaochen Li); validation, X.L. (Xiaosong Li) and X.L. (Xiaochen Li); formal analysis, X.L. (Xiaosong Li) and X.L. (Xiaochen Li); resources, D.M.; data curation, D.M. and X.K.; writing—review and editing, X.L. (Xiaosong Li) and X.L. (Xiaochen Li); writing—original draft preparation, D.M. and X.K. All authors have read and agreed to the published version of the manuscript.

Funding

Joint research on the ecological intelligent monitoring and impact assessment of inland waterway engineering (No. 2019YFE0121000); Guangxi Science and Technology Major Project (No. AA23023009).

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 conflicts of interest in the publication of this paper.

References

  1. Peng, Y.; Li, Y. Autonomous Trajectory Tracking Integrated Control of Unmanned Surface Vessel. J. Mar. Sci. Eng. 2023, 11, 568. [Google Scholar] [CrossRef]
  2. Lee, J.-H.; Jeong, S.-K.; Ji, D.-H.; Park, H.-Y.; Kim, D.-Y.; Choo, K.-B.; Jung, D.-W.; Kim, M.-J.; Oh, M.-H.; Choi, H.-S. Unmanned Surface Vehicle Using a Leader–Follower Swarm Control Algorithm. Appl. Sci. 2023, 13, 3120. [Google Scholar] [CrossRef]
  3. Xu, H.; Zhang, X.K. Tracking Control of Ship at Sea based on MPC with Virtual Ship Bunch under Frenet Frame. Ocean Eng. 2022, 247, 110737. [Google Scholar]
  4. Yang, T.T.; Zhang, P.F.; Chen, H.Y. Distributed Prescribed-Time Leader–Follower Formation Control of Surface Vehicles with Unknowns and Input Saturation. Ocean Eng. 2023, 134, 16–27. [Google Scholar] [CrossRef]
  5. Song, H.; Hu, S.; Jiang, W.; Guo, Q.; Zhu, M. Artificial Potential Field-Based Multi-UAV Formation Control and Target Tracking. Int. J. Aerosp. Eng. 2022, 2022, 4253558. [Google Scholar] [CrossRef]
  6. Wen, J.B.; Yang, J.C.; Li, Y.; He, J.Y.; Li, Z.J.; Song, H.B. Behavior-Based Formation Control Digital Twin for Multi-AUG in Edge Computing. IEEE Trans. Netw. Sci. Eng. 2022, 1–11. [Google Scholar] [CrossRef]
  7. Zhen, Q.Z.; Wan, L.; Li, Y.L.; Jiang, D.P. Formation Control of A Multi-AUVs System based on Virtual Structure and Artificial Potential Field on SE(3). Ocean Eng. 2022, 253, 111148. [Google Scholar] [CrossRef]
  8. Pang, W.; Zhu, D.Q.; Liu, C.X.; Wang, L.L. The Multi-AUV Time-Varying Formation Reconfiguration Control based on Rigid-Graph Theory and Affine Transformation. Ocean Eng. 2023, 270, 113521. [Google Scholar] [CrossRef]
  9. Wang, D.; Kong, M.; Zhang, G.; Liang, X. Adaptive Second-Order Fast Terminal Sliding-Mode Formation Control for Unmanned Surface Vehicles. J. Mar. Sci. Eng. 2022, 10, 1782. [Google Scholar] [CrossRef]
  10. Liu, Z.; Cai, W.; Zhang, M.; Lv, S. Improved Integral Sliding Mode Control-Based Attitude Control Design and Experiment for High Maneuverable AUV. J. Mar. Sci. Eng. 2022, 10, 795. [Google Scholar] [CrossRef]
  11. Nguyen, N.P.; Park, D.; Ngoc, D.N.; Xuan-Mung, N.; Huynh, T.T.; Nguyen, T.N.; Hong, S.K. Quadrotor Formation Control via Terminal Sliding Mode Approach: Theory and Experiment Results. Drones 2022, 6, 172. [Google Scholar] [CrossRef]
  12. Souissi, S.; Boukattaya, M. Time-Varying Nonsingular Terminal Sliding Mode control of Autonomous Surface Vehicle with predefined convergence time. Ocean Eng. 2022, 263, 112264. [Google Scholar] [CrossRef]
  13. Oliveira, T.R.; Melo, T.G.; Hsu, L.; Cunha, J.P.V.S. Monitoring Functions Applied to Adaptive Sliding Mode Control for Disturbance Rejection. IFAC Papers-OnLine 2017, 50, 2684–2689. [Google Scholar] [CrossRef]
  14. Hsu, L.; Oliveira, T.R.; Cunha, J.P.V.; Yan, L. Adaptive Unit Vector Control of Multivariable Systems Using Monitoring Functions. Int. J. Robust Nonlinear Control 2019, 29, 583–600. [Google Scholar] [CrossRef]
  15. 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]
  16. Wang, N.; Karimi, H.R. Successive Waypoints Tracking of An Underactuated Surface Vehicle. IEEE Trans. Ind. Inform. 2020, 16, 898–908. [Google Scholar] [CrossRef]
  17. Wang, N.; Su, S.F. 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] [CrossRef]
  18. Chen, D.; Zhang, J.; Li, Z. 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]
  19. Vo, A.T.; Truong, T.N.; Kang, H.J. A Novel Fixed-Time Control Algorithm for Trajectory Tracking Control of Uncertain Magnetic Levitation Systems. IEEE Access 2021, 9, 47698–47712. [Google Scholar] [CrossRef]
  20. Polyakov, A. Nonlinear Feedback Design for Fixed-Time Stabilization of Linear Control Systems. IEEE Trans. Automat. Control 2012, 57, 2106–2110. [Google Scholar] [CrossRef] [Green Version]
  21. Liu, W.; Ye, H.; Yang, X. Super-Twisting Sliding Mode Control for the Trajectory Tracking of Underactuated USVs with Disturbances. J. Mar. Sci. Eng. 2023, 11, 636. [Google Scholar] [CrossRef]
  22. 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]
  23. Wang, N.; Zhu, Z.; Qin, H.; Deng, Z.; Sun, Y. Finite-Time Extended State Observer-based Exact Tracking Control of An Unmanned Surface Vehicle. Int. J. Robust Nonlinear Control 2021, 31, 1704–1719. [Google Scholar] [CrossRef]
  24. Wang, N.; Ki Ahn, C. Hyperbolic-Tangent LOS Guidance-Based Finite-Time Path Following of Underactuated Marine Vehicles. IEEE Trans. Ind. Electron. 2020, 67, 8566–8575. [Google Scholar] [CrossRef]
  25. Lu, L.; Dan, W.; Peng, Z.H. Eso-based Line-of-Sight Guidance Law for Path Following of Underactuated Marine Surface Vehicles with Exact Sideslip Compensation. IEEE J. Ocean. Eng. 2017, 42, 477–487. [Google Scholar] [CrossRef]
  26. Pinto, H.L.C.P.; Oliveira, T.R.; Hsu, L. Fault Reconstruction for Delay Systems via Least Squares and Time-Shifted Sliding Mode Observers. Asian J. Control 2019, 21, 52–69. [Google Scholar] [CrossRef]
  27. Pinto, H.L.C.P.; Oliveira, T.R.; Hsu, L. Sliding Mode Observer for Fault Reconstruction of Time-Delay and Sampled-Output Systems-A Time Shift Approach. Automatica 2019, 106, 390–400. [Google Scholar] [CrossRef]
  28. Wang, N.; He, L. Leader-Follower Formation Control of Surface Vehicles: A Fixed-Time Control Approach. ISA. Trans. 2022, 124, 356–364. [Google Scholar] [CrossRef]
  29. Bhat, S.P.; Bernstein, D.S. Continuous Finite-Time Stabilization of The Translational and Rotational Double Integrators. IEEE Trans. Automat. Control 1998, 43, 678–682. [Google Scholar] [CrossRef] [Green Version]
  30. Zuo, Z. Nonsingular Fixed-Time Consensus Tracking for Second-Order Multi-Agent Networks. Automatica 2015, 54, 305–309. [Google Scholar] [CrossRef]
  31. Zuo, Z.; Tian, B.; Defoort, M. Fixed-Time Consensus Tracking for Multiagent Systems with High-Order Integrator Dynamics. IEEE Trans. Autom. Control 2017, 63, 563–570. [Google Scholar] [CrossRef] [Green Version]
  32. Fiori, S. Model Formulation Over Lie Groups and Numerical Methods to Simulate the Motion of Gyrostats and Quadrotors. Mathematics 2019, 7, 935. [Google Scholar] [CrossRef] [Green Version]
  33. Tarsi, A.; Fiori, S. Lie-Group Modeling and Numerical Simulation of a Helicopter. Mathematics 2021, 9, 2682. [Google Scholar] [CrossRef]
  34. Skjetne, R.; Smogeli, Ø.; Fossen, T.I. Modeling, Identification, and Adaptive Maneuvering of Cybership II: A Complete Design with Experiments. IFAC Proc. 2004, 37, 203–208. [Google Scholar] [CrossRef]
Figure 1. (a) Cybership II USV model. (b) Earth-fixed coordinate system error and body-fixed relative coordinate system error of a USV.
Figure 1. (a) Cybership II USV model. (b) Earth-fixed coordinate system error and body-fixed relative coordinate system error of a USV.
Electronics 12 02896 g001
Figure 2. Cooperative trajectory tracking framework for multiple USVs.
Figure 2. Cooperative trajectory tracking framework for multiple USVs.
Electronics 12 02896 g002
Figure 3. Observation results of the FTDO leader.
Figure 3. Observation results of the FTDO leader.
Electronics 12 02896 g003
Figure 4. Norm of the FTDO leader’s tracking errors and derivatives.
Figure 4. Norm of the FTDO leader’s tracking errors and derivatives.
Electronics 12 02896 g004
Figure 5. Observation results of the FTDO follower.
Figure 5. Observation results of the FTDO follower.
Electronics 12 02896 g005
Figure 6. Norm of the FTDO follower’s tracking errors and derivatives.
Figure 6. Norm of the FTDO follower’s tracking errors and derivatives.
Electronics 12 02896 g006
Figure 7. Trajectory tracking curve of backstepping-TTC and the FTFISM-TTC.
Figure 7. Trajectory tracking curve of backstepping-TTC and the FTFISM-TTC.
Electronics 12 02896 g007
Figure 8. Position tracking of backstepping-TTC and the FTFISM-TTC.
Figure 8. Position tracking of backstepping-TTC and the FTFISM-TTC.
Electronics 12 02896 g008
Figure 9. Velocity tracking of backstepping-TTC and the FTFISM-TTC.
Figure 9. Velocity tracking of backstepping-TTC and the FTFISM-TTC.
Electronics 12 02896 g009
Figure 10. Trajectory tracking curve of TSM-TTC and the FTFISM-TTC.
Figure 10. Trajectory tracking curve of TSM-TTC and the FTFISM-TTC.
Electronics 12 02896 g010
Figure 11. Position tracking of TSM-TTC and the FTFISM-TTC.
Figure 11. Position tracking of TSM-TTC and the FTFISM-TTC.
Electronics 12 02896 g011
Figure 12. Velocity tracking of TSM-TTC and the FTFISM-TTC.
Figure 12. Velocity tracking of TSM-TTC and the FTFISM-TTC.
Electronics 12 02896 g012
Figure 13. Collaborative trajectory tracking curve of the three USVs.
Figure 13. Collaborative trajectory tracking curve of the three USVs.
Electronics 12 02896 g013
Figure 14. Position tracking of the three USVs.
Figure 14. Position tracking of the three USVs.
Electronics 12 02896 g014
Figure 15. Velocity tracking of the three USVs.
Figure 15. Velocity tracking of the three USVs.
Electronics 12 02896 g015
Table 1. Detailed matrix parameters for M , C , D .
Table 1. Detailed matrix parameters for M , C , D .
ParameterFormulaParameterFormula
m 11 m X u ˙ m 22 m Y v ˙
m 23 m x g Y r ˙ m 32 m x g N v ˙
m 33 I z N r ˙ c 13 ( ν ) m 11 m 23 r
c 23 ( ν ) m 11 u d 11 ( ν ) X u X | u | u | u | X u u u u 2
d 22 ( ν ) Y v Y v s . v v s . d 23 ( ν ) Y r Y v s . r v s . Y r r r
d 32 ( ν ) N v N v s . v v s .     N r v r d 33 ( ν ) N r N v s . r v s . N r r r
Table 2. Parameter values of FT-DO and FTFISM-TTC.
Table 2. Parameter values of FT-DO and FTFISM-TTC.
ParametersValuesParametersValuesParametersValues
λ 1 α i , 1 0.15 α i , 2 0.15
α i , 3 0.15 β i , 1 0.85 β i , 2 1.15
k s 1 a i . ( i = 1 , 2 , 3 ) 4 b i . ( i = 1 , 2 , 3 ) 4
ϑ 1 , ϑ 3 0.3 ϑ 2 , ϑ 4 1.3 l 0 0.1
l 1 0.7 l 2 0.5 m , n 5, 7
Table 3. Detailed model parameters of the CyberShip II USV.
Table 3. Detailed model parameters of the CyberShip II USV.
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
Table 4. Observation error of the FT-DO.
Table 4. Observation error of the FT-DO.
T1020304050607080
Δ 0.11570.25480.31800.35470.44440.59660.71730.7962
Δ F T D O 0 . 0043 0 . 0260 0 . 0049 0 . 0240 0 . 0035 0 . 0211 0 . 0067 0 . 0244
Δ ˙ 0.03600.02740.01940.02640.02790.02750.01950.0200
Δ ˙ F T D O 0 . 0019 0 . 0018 0 . 0039 0 . 0045 0 . 0019 0 . 0018 0 . 0049 0 . 0028
Δ i 0.06890.22210.07700.21740.07140.21920.07130.2370
Δ i F T D O 0 . 0053 0 . 0158 0 . 0036 0 . 0128 0 . 0035 0 . 0100 0 . 0058 0 . 0126
Δ ˙ i 0.03920.03630.04000.03810.03720.04460.03920.0486
Δ ˙ i F T D O 0 . 0073 0 . 0067 0 . 0056 0 . 0070 0 . 0060 0 . 0062 0 . 0062 0 . 0080
Table 5. Initial states of the desired trajectory and the single tracking USV.
Table 5. Initial states of the desired trajectory and the single tracking USV.
ParametersValuesParametersValues
η d ( 0 ) Figure 7 [ 0 , 10 , 0 ] T ν d ( 0 ) Figure 7 [ 0 , 0 , 0 ] T
η USV ( 0 ) Figure 7 [ 0 , 0 , 0 ] T ν USV ( 0 ) Figure 7 [ 0 , 0 , 0 ] T
η d ( 0 ) Figure 10 [ 4 , 0 , 0 ] T ν d ( 0 ) Figure 10 [ 0 , 0 , 0 ] T
η USV ( 0 ) Figure 10 [ 0 , 2 , 0 ] T ν USV ( 0 ) Figure 10 [ 0 , 0 , 0 ] T
Table 6. Initial states of the three USVs.
Table 6. Initial states of the three USVs.
ParametersValuesParametersValues
η d ( 0 ) [ 0 , 0 , 1.5 ] T ν d ( 0 ) [ 3 , 0 , 0 ] T
η l e a d e r U S V ( 0 ) [ 2 , 30 , 0 ] T ν l e a d e r U S V ( 0 ) [ 0 , 0 , 0 ] T
η f o l l o w e r U S V 1 ( 0 ) [ 4 , 30 , 0.2 ] T ν f o l l o w e r U S V 1 ( 0 ) [ 0 , 0 , 0 ] T
η f o l l o w e r U S V 2 ( 0 ) [ 4 , 10 , 0.5 ] T ν f o l l o w e r U S V 2 ( 0 ) [ 0 , 0 , 0 ] T
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.

Share and Cite

MDPI and ACS Style

Li, X.; Li, X.; Ma, D.; Kong, X. Trajectory Tracking Control of Unmanned Surface Vehicles Based on a Fixed-Time Disturbance Observer. Electronics 2023, 12, 2896. https://doi.org/10.3390/electronics12132896

AMA Style

Li X, Li X, Ma D, Kong X. Trajectory Tracking Control of Unmanned Surface Vehicles Based on a Fixed-Time Disturbance Observer. Electronics. 2023; 12(13):2896. https://doi.org/10.3390/electronics12132896

Chicago/Turabian Style

Li, Xiaosong, Xiaochen Li, Dianguang Ma, and Xianwei Kong. 2023. "Trajectory Tracking Control of Unmanned Surface Vehicles Based on a Fixed-Time Disturbance Observer" Electronics 12, no. 13: 2896. https://doi.org/10.3390/electronics12132896

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