Next Article in Journal
Investigating the Operation of an LNG Carrier as a Floating Power Generating Plant (FPGP)
Previous Article in Journal
Research on High-Speed Catamaran Motion Reduction with Semi-Active Control of Flexible Pontoon
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Research on Practical Path Tracking Control of Autonomous Underwater Vehicle Based on Constructive Dynamic Gain Controller

1
School of Information and Electrical Engineering, Hangzhou City University, Hangzhou 310015, China
2
Science and Technology on Underwater Vehicle Technology Laboratory, Harbin Engineering University, Harbin 150001, China
3
School of Mechanical Engineering, Hangzhou Dianzi University, Hangzhou 310018, China
4
School of Mechanical and Electrical Engineering, China University of Mining and Technology, Xuzhou 221116, China
*
Author to whom correspondence should be addressed.
J. Mar. Sci. Eng. 2023, 11(9), 1748; https://doi.org/10.3390/jmse11091748
Submission received: 4 August 2023 / Revised: 2 September 2023 / Accepted: 3 September 2023 / Published: 6 September 2023
(This article belongs to the Section Ocean Engineering)

Abstract

:
In this study, the stochastic nonlinear system-based trajectory tracking control problem of an autonomous underwater vehicle (AUV) is studied. We investigate the time-varying gain adaptive control method to find possible approaches to reduce the excessive computational burden. Enhanced adaptive algorithms are devised by considering the dynamic characteristics of AUV motion. By transforming the original controller design problems into parameter selection problems and subsequently solving them using the functional time-varying observer technical theorem, we can achieve optimal control performance. The control system is shown to constrain system state error due to stochastic disturbances within arbitrarily small domains. A coordinate transformation is proposed for all system states to meet boundedness conditions. We show that the closed-loop stability is confirmed, the system is asymptotically probabilistically stable, and contraction limits given in the stability analysis may be used to certify the convergence of the AUV trajectory errors. A large number of simulation studies using an underwater vehicle model have proved the effectiveness and robustness of the proposed approach. A real-time, time-varying gain constructive control strategy is further developed for the hardware-in-the-loop simulation; the effectiveness of the controller design is confirmed by introducing the controller into the AUV actuator model.

1. Introduction

Scientific research and underwater exploration both frequently use autonomous underwater vehicles (AUVs). In AUV research, the control system of underwater thrusters can be said to be its neural center and the most complex technology, so the control of underwater thrusters is one of the most difficult issues in the control industry. Due to the crucial role played by AUVs in deep-sea environmental resource exploration in recent decades, tracking control, state maintenance, and the path planning of AUVs have received attention from researchers, causing a pressing need to develop new control theories in the theoretical and engineering fields of AUV output feedback control, making them fit for intricate systems impacted by a variety of elements, including randomness, delays in time and nonlinearity. In addition, stochastic nonlinear systems no longer work with a control framework developed for deterministic systems [1,2,3,4,5,6,7,8,9,10,11]. As a result, it is very difficult to use the classical control theory and other associated mathematical techniques to address the output feedback control problem for stochastic nonlinear systems. In engineering practice, there is a high probability that the input and output of a controlled system are random signals. Therefore, stochastic nonlinear systems that combine nonlinear and stochastic characteristics are a field of study that the community of control theory is very interested in.
The application of trajectory tracking control is essential for autonomous underwater robots. However, due to the complex system, uncertain working environments, and the highly coupled nonlinear characteristics of underwater robots [1,2], the controller design of AUVs becomes very challenging. In the past decades, the design of trajectory tracking controllers [3] for underwater vehicles has been a problem worthy of attention. Traditional PID, LQR, and Kalman filtering [4] can control the trajectory of an underwater robot. In addition, nonlinear PID controllers also have good performance in control. However, when the target trajectory being tracked is nonlinear, the curved trajectory makes nonlinear PID no longer applicable in vehicle driving. Feedback linearization [5] presents a powerful tool for dealing with nonlinear characteristics. However, applying feedback linearization to the AUV requires a system model with highly accurate hydraulic dynamic coefficients [6]. In this context, the adaptive [7,8,9] Lyapunov method has become the mainstream method for AUV trajectory control. In article [10], a dynamic controller is used for the first time in the backstepping control technique. AUV output backstep control can be found in article [11,12]; another popular AUV trajectory tracking control method is sliding mode control. It is well-known that this method has an excellent and robust effect when the parameters are uncertain, but the sliding effect of the sliding mode control tends to appear discrete. The sliding mode control is frequently used in conjunction with other control strategies, such as robust control, adaptive control, and PID, to lessen this problem [13,14,15].
Nonetheless, the above control methods have, as a general deficiency, the inability to deal with the stochastic characteristics and uncertain disturbances of the system. For AUVs, these factors are prevalent [16,17], and the actuator must manage them in the working environment. Adaptive control is featured in dealing with randomness and uncertainties [18], proposing a robust control structure in the face of this wide range of control problems. In addition, adaptive control can solve complex nonlinear problems for the control of AUV dynamic systems. So far, we do not have a very effective control method for the trajectory tracking control problems. In article [19], a self-correcting adaptive method is proposed, to solve problems including dynamic parameters, where the model structure often changes. Trajectory tracking control algorithms for AUV stochastic uncertain nonlinear systems have been proposed. In paper [20], the concept of the stochastic system model is creatively introduced. In article [21,22], a comprehensive trajectory tracking control and path planning problem is researched. A unified optimization framework [23] is developed for the problem of combined motion control for AUVs.
Although an adaptive control based on a key idea in high-order sliding modes provides a good algorithm for nonlinear systems with random and uncertain disturbances [13] when solving, this method heavily burdens the computer. In theoretical research, the computation time is often ignored, but in practice, the computational difficulty increases exponentially with the increase in stochastic and uncertain interference problems. Due to the short sampling period, many strategies such as iterative methods, precomputation, and numerical continuation [24] have been proposed to decrease the computational complexity and reduce the computation time. Ref. [25] explores the motion characteristics of underwater robots, combining a dynamic-static system model with a high-gain observer to develop an effective output feedback adaptive control algorithm. However, the closed-loop system’s stability evidence is omitted. Dynamic gain control algorithms may fix the underwater robots’ trajectory tracking and control issues. The stability analysis of the closed-loop system is made more difficult by the implicit coupling of the system state and the control signal. It is urgent to find a better stability analysis method. Refs. [26,27,28,29] mainly focus on the study of control strategies in finite time using multi-parameter uncertainty mathematical models, and the robust control part has an important reference value for our paper.
This paper hopes to provide a method to eliminate the influence of random and uncertain disturbances on AUV trajectory tracking and simultaneously ensure closed-loop system stability. Here, a reference augmentation technique is applied in modeling the AUV system so that the coupling between the systems is weakened [30]. Then, a dynamic gain method is studied to reduce the computational stress of stochastic uncertain nonlinear systems. The complex control problem has thereby been changed into a parameter selection and construction problem through dynamic gain. The computational complexity is significantly reduced, and the computation time is significantly reduced. The following are the article’s contributions:
  • An established stochastic uncertain nonlinear dynamic adaptive control algorithm is offered to examine the dynamic properties of the AUV’s motion with the goal of controlling the problem of tracking the AUV’s trajectory.
  • The computational complexity of the control method is dramatically reduced via a novel dynamic-static combination of high-gain observers that are provided, turning the controller design challenge into a problem of parameter calculation and selection.
  • We investigate the fundamental properties of closed-loop systems. The control time and control error of numerical nonlinear model trajectory tracking is remarkably reduced, the control effect is optimized, and the sensitivity is improved. According to [7], the numerical model in our paper can match the actual AUV model in certain key feature parameters.
  • Numerical simulations and additional experiments reveal that the proposed dynamic-static high-gain adaptive control algorithm has excellent and robust performance against stochastic and uncertain disturbances.
The remainder of this essay is structured as follows: The motion model for AUVs is discussed in the second part. The third section is the dynamic and static high-gain adaptive control algorithm. Section 4 presents simulation studies and additional experiments. The fifth section is the conclusion and prospects.

2. Description of Dynamic Modelling of Robot

The dynamics study of the AUV is completed in this part. Through the analysis of the power, resistance, and inertial force when moving underwater, we can obtain general dynamic equations. To model the complexity and uncertainty of the underwater environment [2,26,31], we have added a stochastic process to the model. This work is based on an established underwater robot model with underactuated control, as illustrated in Figure 1.
The following is an example of the 6-DOF dynamic model of the AUV:
M 𝓋 ˙ + C ( 𝓋 ) 𝓋 + D ( 𝓋 ) 𝓋 + g ( ϵ ) = F
where the inertia mass matrix, which includes an added mass term to model the effect of the surrounding water on the acceleration of the AUV, is M = M A + M R B . C ( 𝓋 ) is the underwater vehicles’ Coriolis force matrix. The underwater vehicle fluid damping matrix is represented by the symbol D ( 𝓋 ) . g ( ϵ ) stands for the undersea vehicle’s operating gravity and the buoyancy-generated restoring force (moment) matrix. F = [ F x , F y , F z , F k , F m , F n ] T stands for the resulting forces and moments. v ˙ = [ u ˙ , 𝓋 ˙ , ω ˙ , p ˙ , q ˙ , r ˙ ] T are the linear and angular accelerations of the body (moving) frame in the direction of pitch, roll, and heave; v = [ u , 𝓋 , ω , p , q , r ] T stands for the angular and linear speed in relation to the body (moving) frame; u stands for surge velocity; 𝓋 stands for sway velocity; ω stands for heave velocity; p stands for roll rate; q stands for pitch rate; and r stands for yaw rate. ϵ = [ x , y , z , α , β , γ ] T are the position and orientation in the inertial (earth-fixed) frame; x stands for surge position, y for sway position, z for heave position, α for roll angle, β for pitch angle, and γ for yaw angle.
According to the above, the six-degree-of-freedom (6-DOF) model of the underwater robot has complex nonlinearity and state coupling. If we want to design a controller with six degrees of freedom, these factors will pose a great challenge to the controller design and physical characteristics. Here, we decompose the 6-DOF motion model into two kinematic models, separating linear velocity variables v 1 = [ u , 𝓋 , ω ] T and angular velocity variables v 2 = [ p , q , r ] T . The pose can similarly be divided into two kinematic models in the earth-fixed frame, underwater robot position ϵ 1 = [ x , y , z ] T and underwater robot orientation ϵ 2 = [ α , β , γ ] T , which can highly simplify the AUV model. In this study, we solely consider velocity variables v 1 = [ u , v , ω ] T and position ϵ 1 = [ x , y , z ] T of the AUV underwater.
In terms of linear velocity, the fixed frame and body frame have the following relationship:
ϵ ˙ 1 = J ( ϵ ) v 1
where J(ϵ) is the kinematic transformation matrix of the following structure:
J ( ϵ ) = ( c γ c β s γ c α + c γ s β s α s γ s α + c γ c β s α s γ c β c γ c α + s γ s β s α c γ s α + s γ s β c α s β c β s α c β c α )
where, accordingly, s = sin , c = cos and ϵ 2 = [ α , β , γ ] T is the angle between the direction of the surge, sway, and heave, and the earth frame. When β = ± 90 ° , this transformation is undefined, and the quaternion method must be considered. In practice, most robots are made to work at pitch angles below ± 90 ° . Thus, this restriction does not matter in this case. To better understand and analyze the motion state, we will study the AUV system based on the earth reference frame. To unify the signal states, using Equation (2) for coordinate transformation ( ϵ 1 , v 1 ) μ ( ϵ 1 , ϵ ˙ 1 ) , we obtain:
( ϵ 1 ϵ ˙ 1 ) = [ I 0 0 J ( ϵ ) ] ( ϵ 1 v 1 )
A similarity transformation in a linear system is an analog of the coordinate transformation, which is a global diffeomorphism. The dynamic underwater vehicle model in a fixed reference frame for the earth looks like this:
M ϵ 1 ϵ ¨ 1 + C ϵ 1 ϵ ˙ 1 + D ϵ 1 ϵ ˙ 1 + g ϵ 1 = F ϵ 1
where
M ϵ 1 = J ( ϵ ) T M J ( ϵ ) 1 C ϵ 1 = J ( ϵ ) T ( C ( ν ) M J ( ϵ ) 1 J ˙ ( ϵ ) ) J ( ϵ ) 1 D ϵ 1 = J ( ϵ ) T D ( ν ) J ( ϵ ) 1 g ϵ 1 = J ( ϵ ) T g ( ϵ ) F ϵ 1 = J ( ϵ ) T F
We need some assumptions as follows.
Assumption 1.
In this paper, there is only consideration for the velocity between the self-position and the fixed frame, that the velocity is  l ˙ = ( x ˙ 2 + y ˙ 2 + z ˙ 2 ) 1 2 . Suppose the origin state  ϵ 1 ( 0 ) = [ 0   0   0 ]  and  ϵ ˙ 1 ( 0 ) = [ 0   0   0 ] .
Assumption 2.
In this paper, the position  ϵ 1 = [ x   y   z ]  and the angle  ϵ 2 = [ α   β   γ   ]  are known from the sensors.
For a class of stochastic uncertain nonlinear systems, we concentrate on the problem of trajectory tracking control in this study. For the underwater robot’s trajectory tracking control issue with nonlinear dynamics, to better design the control algorithm, we convert the dynamic model of the system into a broad numerical model as follows.
d l 1 = l 2 d t + φ 1 ( t , l ( t ) , u ) d ω d l 2 = u d t + φ 2 ( t , l ( t ) , u ) d ω                       y = l 1 y r                                                                            
In stochastic nonlinear systems, l = ( l 1 , l 2 ) T R 2 , u R , y R represent the system’s states, input, and output, respectively; y r is the target trajectory to be tracked. Here, state l 2 and y r are unmeasurable. The stochastic process of the system is introduced in this paper: An m -dimensional standard Wiener process called ω defined on the entire probability space ( Ω ,   Γ ,   P ) , where p is the probability measure, Γ is the filter, and Ω is the sample space. The nonlinear term φ i : + × × 2 , i = 1 , 2 is satisfied continuous polynomial growth conditions and local Lipschitz.
In this paper, we assume that system (5) satisfies the following assumptions and implements output feedback tracking control.
Assumption 3.
There is a known integer  q 1  and a positive constant  c 0 0  such that the following disparity exists
| φ i ( t , l , u ) | c 0 ( 1 + | l 1 | q ) ( | l 1 | + | l 2 | + + | l i | ) + c 0 ,   i = 1 , 2
This assumption shows that an output polynomial growth rate governs this system (5).
Assumption 4.
The target trajectory  m a x ( | y r ( t ) | ,   | y ˙ r ( t ) | ) c 1 ,  c 1  is a known constant. According to the description of the above system, the purpose of this part is to develop a time-variable gain constructive control algorithm: for any given tolerance  δ > 0 . All of the states in the closed-loop system must be clearly defined and globally bounded on  [ 0 , + )  in finite time  T δ > 0 , for instance,  | y ( t ) | = | l 1 ( t ) y r ( t ) | δ ,   t T δ .
Remark 1.
It should be pointed out that the output feedback tracking control problems studied in previous pieces of literature [32,33] are mainly aimed at nonlinear systems or nonlinear systems with parameter uncertainty and unknown control direction. The system (5) under study in this research is a stochastic uncertain nonlinear system with the introduction of random elements. At the same time, system (5) is observable by Assumption 3, which depends on the unmeasurable state and nonlinear growth conditions satisfying a polynomial growth condition based on Assumption 4. As can be observed, the upper bound value of the derivative as well as the upper bound value of the reference trajectory  y r  are provided; therefore, it is not essential to provide a specific description, function, or additional details for the reference trajectory  y r .
Based on Assumptions 3 and 4 and system (5), for l 1 = y + y r ,   i = 1 ,   2 , we have:
| φ i ( t , l , u ) | c 0 ( 1 + | y + y r | q ) ( | l 1 | + | l 2 | + + | l i | ) + c 0 c ( 1 + | y | q ) ( | l 1 | + | l 2 | + + | l i | ) + c
where c = c 0 m a x { 1 + 2 q 1 c 1 q ,   2 q 1 } is a known constant.

3. Dynamic and Static High-Gain Adaptive Control Algorithm

The complexity of the stochastic uncertain nonlinear underwater robot system will be studied in two parts using the dynamic gain observer technique that we suggest in this section, which will provide a dynamic adaptive tracking controller. The first step is the dynamic gain observer and controller design; the second step is stability analysis and implementation.

3.1. Dynamic Gain Observer and Controller Design

We introduce the following state transformation:
z 1 = y = l 1 y r z 2 = l 2                
Then, combining (5) and (8), the updated system can be obtained as:
z ˙ 1 = z 2 + f 1 ( t , z , u ) ω ˙ z ˙ 2 = u + f 2 ( t , z , u ) ω ˙ y = z 1                      
where
f 1 ( t , z , u ) = φ 1 ( t , z 1 + y r , z 2 , u ) d y r d ω f 2 ( t , z , u ) = φ 2 ( t , z 1 + y r , z 2 , u )            
Since the states of the stochastic system are unmeasurable except for l 1 , which is a measurable state, the time-varying observers are first constructed:
z ^ ˙ 1 = z 2 + K 1 h 1 ( z 1 z ^ 1 ) , z ^ ˙ 2 = u + K 2 h 2 ( z 1 z ^ 1 ) ,  
We choose constant design parameters h i ,   i = 1 ,   2 , satisfying the Hurwitz condition for the polynomial s 2 + h 1 s + h 2 . The dynamic gain parameter K = A B ( t ) is made up of two components: a constant ( A > 1 ) and a time-varying function B ( t ) that is updated by
B ˙ ( t ) = μ 1 B 2 + μ 2 ( 1 + | y | q ) 2 B B ( 0 ) = 1
Theorem 1.
Assuming that all closed-loop system states are bounded on  [ 0 ,   T ) , we can deduce that  T  must be infinite. Otherwise, the closed-loop system’s continuity will be violated since at least one state will escape at time  T . The type of stochastic uncertain nonlinear system (5), has an output of the form  y = l 1 y r , and its nonlinear term satisfies Assumptions 3 and 4. If we choose the suitable parameters   A ,   μ 1   μ 2  and use observer (11), the design of an output feedback controller can be as follows:
u = ( K 2 a 1 z ^ 1 + K a 2 z ^ 2 )
where the parameter  a = [ a 1 ,   a 2 ] T  is a constant vector satisfying Hurwitz’s condition  h i = a 3 i . Next, we will demonstrate that when  A  is large enough, practical global tracking can be accomplished. Furthermore, it is possible to track paths effectively. There is a finite period  T δ  such that  | y ( t ) | δ ,   t T δ  for any  δ > 0 .
Remark 2.
Through Equation (8), we can turn complex systems into simple ones. According to the unmeasurable state of the system, we introduce a dynamic gain observer (11). Unlike previous conditions, the observer gain in this paper is an observer combined with dynamic  B ( t )  and static  A  gain parameters. The observed effect is close to the actual value of the system, which provides a good condition for the controller to control the error variable. The typical tracking control methods, including the Model Predictive Control (MPC) method, are no longer able to resolve the issues in this section due to the lack of information about the system and the tracking signal, as well as the instability of the system following the introduction of random elements. For these challenging problems, this article has used stochastic nonlinear systems satisfying Assumptions 3 and 4 to construct an output feedback dynamic adaptive tracking controller ground using a combination of static and dynamic gain observers to achieve control of the original system (5) that includes the tracking control target.

3.2. Stability Analysis and Implementation

The key findings of the paper are given and rigorously shown in this subsection. We require the next scaling transformation in the closed-loop system for the stability study.
e i = z i z ^ i ,   ( i = 1 ,   2 ) is the definition of the state estimate error. Then the dynamics of e i satisfy:
e ˙ 1 = e 2 K 1 h 1 e 1 + f 1 ( t , z , u ) ω ˙ e ˙ 2 = K 2 h 2 e 1 + f 2 ( t , z , u ) ω ˙      
To make the controller’s design easier, we need to transform the estimated state z ^ i and the error state e i as follows:
ε i = e i K b + i 1 ( i = 1 , 2 ) τ i = z ^ i K b + i 1 ( i = 1 , 2 )
where 0 < b < 1 4 q is a known constant, ε = ( ε 1 ,   ε 2 ) T ,   τ = ( τ 1 ,   τ 2 ) T ,   h = ( h 1 ,   h 2 ) T . According to (15), the following conversions can be made for stochastic nonlinear systems (9) and (11):
ε ˙ = K H ε K ˙ K C b ε + G ( a , K ) ω ˙ τ ˙ = K H b τ K h ε 1 + h ˙ h C b τ      
Meantime, G ( z , K ) = [ f 1 K b , f 2 K b + 1 ] T , H = ( h 1 1 h 2 0 ) , H b = ( 0 1 h 1 h 2 ) , C b = ( b 0 0 b + 1 ) .
Then, we discuss the gain B and the boundedness of the states ε and τ . Above all, we must choose parameters r 1 , r 2 ,   r 3 ,   r 4 , so that the relationship between the positive definite matrices P , Q and the matrix H ,   H b ,   C b satisfies:
H T P + P A H I 2 r 1 I 2 C b P + P C b r 2 I 2 H b T Q + Q H b T 2 I 2 r 3 I 2 C b Q + Q C b r 4 I 2
Let V ( ε ( t ) ,   τ ( t ) ) = ε T ( t ) P   ε ( t ) + τ T Q τ ( t ) be a Lyapunov function candidate. The time derivative of V on [ 0 ,   T ) then meets the following inequality along the path of (16):
L V = + 2 ε T G P | ε | 2 K 2 ε T K ˙ K ( C b P + P C b ) ε + 2 K τ T ε 1 h 2 K | τ | 2 T r ( G T ( P + Q ) G ) K ˙ K τ T ( C b P + P C b ) τ
From Remark 2, we can know h > 1 . And by Assumption 4, (8), (12), (15), (17) and the fact h > 1 we have:
K ˙ K ε T ( C b P + P C b ) ε r 2 μ 1 B | ε | 2 r 1 μ 2 ( 1 + | y | q ) 2 | ε | 2 K ˙ K τ T ( C b Q + Q C b ) τ r 4 μ 1 B | τ | 2 r 3 μ 2 ( 1 + | y | q ) 2 | τ | 2
| G | = ( | G 1 | 2 + | G 2 | 2 ) 1 2 = ( ( f 1 K b ) 2 + ( f 2 K b + 1 ) 2 ) 1 2
where
| G 1 | [ 1 + ( | ε | + | τ | + c 1 ) ( 1 + | y | q ) ] c + c 1                   | G 2 | [ 1 + ( c 1 + 2 ( | ε | + | τ | ) ) ( 1 + | y | q ) ] c + c 1
Split and enlarge the terms in Formula (18), and we can get:
2 G ε T P 2 ε P c 1 + y q 2 ε + τ + c 1 + c 1 + c P c 1 + c 1 ε 2 + τ 2 1 + y q 2 + 2 K ε 1 h τ T c c 1 + c + c 1 + 5 c + c 1 ε 2 K τ 2 + ε 2 h 2
Therefore, combining Equations (14)–(22), the system (14)’s Ito differential equation is attainable as:
L V K ε 2 + c P 1 + c 1 1 + y q 2 ε 2 + τ 2 + P 5 c + c 1 ε 2 + P c c 1 + c + c 1 + α 1 B r 2 ε 2 + r 4 τ 2 α 2 1 + y q 2 r 1 ε 2 + r 3 τ 2 2 K τ 2 + τ T ε 1 h + T r G T P + Q G K ε 2 + c P 1 + c 1 1 + y q 2 ε 2 + τ 2 + P 5 c + c 1 ε 2 + P c c 1 + c + c 1 + r 2 α 1 B ε 2 α 2 1 + y q 2 r 1 ε 2 + τ 2 2 K τ 2 + r 4 α 1 B τ 2 + K τ 2 + h 2 ε 2 P + G c 1 + y q 2 ε + τ + c 1 + c + c 1 2
where the last term of Formula (23) can be enlarged as:
G + P c 1 + y q 2 ε + τ + c 1 + c + c 1 2 2 P + G c 2 1 + y q 2 2 ε + τ + c 1 2 + c + c 1 2 2 P + G 2 c 2 1 + y q 2 2 ε + τ 2 + c 1 2 + c + c 1 2 2 P + G 2 c 2 1 + y q 2 4 ε 2 + τ 2 + c 1 2 + c + c 1 2 = P + G 16 c 2 1 + y q 2 ε 2 + τ 2 + 4 c 2 1 + y q 2 c 1 2 + 2 c + c 1 2
After completion, we receive:
L V K ( 1 h 2 ) 5 c + c 1 P r 2 B μ 2 ε 2 y q + 1 2 r 1 μ 2 P c c 1 + 1 16 Q + P ε 2 + r 4 μ 1 B K τ 2 y q + 1 2 r 3 μ 2 c P 1 + c 1 16 c 2 Q + P ε 2 + P c c 1 + c + c 1 + 4 c 2 1 + y q 2 c 1 2 + 2 c + c 1 2 P + Q
According to Formula (25), selection μ 2 satisfies:
μ 2 c ( 1 + c 1 ) P + 16 c 2 ( Q + P ) r 1 μ 2 c ( 1 + c 1 ) P + 16 c 2 ( Q + P ) r 3 μ 2 μ 1 > 0
According to B > 1 , choose A to satisfy:
A P ( 5 c + c 1 ) + r 2 μ 1 1 | h | 2 A r 4 μ 1 A 1
According to the above selection of parameters, the Formula (25) is capable of transformation:
L V K ( | τ | 2 + | ε | 2 ) + P ( c c 1 + c 1 + c ) + ( P + Q ) ( 4 c 1 2 c 2 ( 1 + | y | q ) 2 + 2 ( c + c 1 ) 2 ) A V m a x ( λ m a x ( P ) + λ m a x ( Q ) ) + ( c c 1 + c 1 + c ) P + ( P + Q ) ( 4 c 2 c 1 2 ( 1 + | y | q ) 2 + 2 ( c + c 1 ) 2 )
These are the defined relevant parameters:
E 1 = A m a x ( λ m a x ( P ) + λ m a x ( Q ) ) E 2 = P ( c c 1 + c + c 1 ) + ( 4 c 2 ( 1 + | y | q ) 2 c 1 2 + 2 ( c + c 1 ) 2 ) ( P + Q )
The closed-loop system, as was already mentioned, has a singular solution on the maximal time period [ 0 , T ) , where 0 < T + .
V ( ε ( t ) , τ ( t ) ) V ( ε ( 0 ) , τ ( 0 ) ) e E 1 A t + E 2 E 1 ,   t [ 0 , T )
which shows that τ are confined to [ 0 , T ) .
Then demonstrate the confinement of B on [ 0 , T ) because ε   and   τ are bounded on the interval in [ 0 , T ) , and ε 1 + τ 1 = z 1 K b = y K b , we get | y | ( A B ) b E 3 . Then from this, (12) and 0 < b < 1 4 q , it is easy to get that:
B ˙ = μ 1 B 2 + μ 2 ( 1 + | y | q ) 2 B μ 1 B 2 + μ 2 ( ( ( A B ) b E 3 ) q + 1 ) 2 B μ 1 B 2 + 2 μ 2 ( ( ( A B ) b E 3 ) 2 q + 1 ) B μ 1 B 2 + 2 μ 2 B ( ( A B ) 1 2 E 3 2 q + 1 )
It means that:
B ( t ) 4 μ 2 2 ( 1 + E 3 2 q A ) 2 μ 1 2 ,   t [ 0 , T )
And hence B is bounded on [ 0 , T ) .
Proof. 
In the open neighborhood of the initial conditions of ( x , x ^ , A ) , it is simple to confirm that the ensuing closed-loop system is locally Lipschitz. Therefore, the closed-loop system has a singular solution on a narrow interval [ 0 , t ) . The greatest interval over which a singular solution occurs is [ 0 , T ) , where 0 < T + . Equation (30) asserts that the closed-loop system states have been established on [ 0 , + ) when T = + .
V ( ε ( 0 ) , τ ( 0 ) ) e E 1 A t E 2 E 1 , t > T
In the next step we can get:
V ( ε ( t ) , τ ( t ) ) 2 E 2 E 1 ,   t > T
The presence of parameter A in E 1 should be highlighted at this point. From this, it is evident that:
λ m i n ( P ) | ε | 2 + λ m i n ( Q ) | τ | 2 V ( ε ( t ) , τ ( t ) )
Next, we have:
ε 1 2 ( t ) + τ 1 2 ( t ) E 4 A
Combining (34), (36) and | y ( t ) | ( A B ) b E 3 , we can get:
| y ( t ) | A b B b ( | ε 1 ( t ) | , | τ 1 ( t ) | ) 2 ( ε 1 2 ( t ) + τ 1 2 ( t ) ) 2 E 4 A ,   t > T
Then, we are aware that for all t [ T , + ) ,
B ( t ) 4 μ 2 2 μ 1 2 ( 1 + ( 2 E 4 A ) q A ) 2
Combining (37) and in turn:
y 2 ( t ) = ( A b B b ) 2 ( | ε 1 ( t ) | , | τ 1 ( t ) | ) 2 2 A 2 b B 2 b ( ε 1 2 ( t ) + τ 1 2 ( t ) ) 2 16 b μ 2 4 b E 4 μ 1 4 b A 1 2 b ( 1 + 2 q E 4 q A q 1 2 ) 2 b
From this and 1 2 b > 1 1 2 q > 0 ( s i n c e   0 < b < 1 4 q ) , when t > T , by choosing A big enough to make | y ( t ) | arbitrarily small, so as to realize the actual path tracking. □
Remark 3.
By analyzing the dynamic gain parameter  B ( t )  of the dynamic observer, we can see that this method turns the control problem into a parameter selection problem through analysis, from which it can be deduced that the more prominent the parameter  B ( t )  selection area is, the better the control effect will be. A dynamic high-gain state observer is constructed. The real tracking controller for output feedback is created using the Ito stochastic calculus theory. The closed-loop stochastic nonlinear system’s state and high-gain parameters are guaranteed to be constrained by choosing the right design parameters, and the system tracking error can converge to zero in a limited area. Statistical systems are included in the investigation of output feedback tracking control for nonlinear systems. First-ever research is carried out on the actual tracking of output feedback for a group of stochastic nonlinear systems that satisfy the growth condition of the output polynomial function.

4. Model of an Underwater Robot Transportation System

In this piece of literature, we will simulate and verify the proposed stochastic uncertain dynamic gain adaptive control algorithm through specific numerical simulation. The dynamic model is converted into a specific mathematical model according to the dynamic characteristics of the underwater vehicle. For simplicity, consider the following stochastic nonlinear system:
l ˙ 1 = l 2 + s i n l 1 ω ˙               l ˙ 2 = u + l 2 l n ( 1 + l 1 2 ) ω ˙ y = l 1 y r                              
which has no explicit relationship to the dynamics given in Section 2. In this section, we apply Theorem 1 and Assumptions 3 and 4 to specify the underwater robot path tracking control system described in Figure 1 with c 0 = 0.21 , I = 2 , and c 1 = 1 . So, by utilizing Remark 3, one can create an adaptive output feedback controller. The implementation of the relevant control laws starts at u = K 2 a 1 z ^ 1 + K a 2 z ^ 2 . As well-known in Section 2, the estimates of y and l 2 are z ^ 1   and z ^ 2 , respectively. These variables are selected as b = 0.1 ,   h = [ 0.5 , 1 ] T ,   h = [ 1 , 0.5 ] T ,   μ 1 = 7.2 ,   μ 2 = 9.8 and N = 117 .
Initial stations l 0 = [ 1 , 0.5 ] T and z ^ 0 = 0 indicate that Figure 2, Figure 3, Figure 4, Figure 5, Figure 6, Figure 7 and Figure 8 display the simulation’s outcomes. These figures show l , z ^ , B and B ˙ are all bounded, which must be confirmed to determine whether the route tracking controller is functional. In addition, the tracking error | l 1 y r | 0.001 occurs after 0.04 s.
Through experimental results, the theoretical achievements of the control strategy in this paper have been demonstrated to successfully achieve hover stability control of AUVs. The control time is relatively short, which has played a very good control effect on robot movement under realistic working conditions, achieving safe and stable operation of the robot.
At present, the methods existing in the literature mainly focus on PID control. By comparing the curves of the two controllers in Figure 9 and Figure 10, our control strategy is significantly superior to PID control in terms of time required and energy consumption. According to the curves of the two controllers, the PID control strategy requires a much longer time than our latest control strategy. The energy consumed by PID control is much greater than that of our controller compared to PID control. Our control strategy is more stable, with fewer fluctuations, and can achieve hover control stability of the AUV in the shortest possible time.

5. Concluding and Future Prospects

In this study, we researched the application of this dynamic adaptive control to AUV trajectory tracking. The nonlinear characteristics of underwater robot motion were studied, and a novel dynamic-static gain observer strategy was proposed to reduce the computational burden. Numerical simulations and additional experiments validate the efficiency and robustness of the proposed strategy and highlight the advantages of dynamic-static high-gain adaptive control algorithms. It can decrease the controlled system’s reaction time and the control state’s error, and it also has a great inhibitory effect on stochastic and uncertain interference.
In applied engineering and research, we identified a family of nonlinear systems with piecewise linearization. A nonlinear system is broken down into several finite or infinite linear subsystems using piecewise linearization. This combination can approximate nonlinear systems. In the control process, piecewise linearization has the same characteristics as nonlinear and simplifies the control process and method. According to the known situation, this method has been applied in many practical projects and has achieved a perfect control effect. However, the current application scope of this method is still minimal and has special conditions for nonlinear systems. The following work will expand the application range of piecewise linearization of nonlinear systems, which will be the next hotspot of nonlinear control research.
In our current research, we have started to apply the simulation results obtained in this article to actual underwater robots. At present, we have the experimental pool and experimental robot, and we have started to implant our latest control algorithm in the electronic cabin. Meanwhile, in the conclusion section of the paper submitted after the latest revisions, we have added prospects for future practical applications in robotics research.

Author Contributions

Conceptualization, F.W.; Methodology, Y.P.; Validation, Y.P.; Formal analysis, F.W. and L.G.; Investigation, F.W.; Resources, L.G.; Data curation, Y.P. and L.G. All authors have read and agreed to the published version of the manuscript.

Funding

This work was supported by the Stable Supporting Fund of Science and Technology on Underwater Vehicle Technology (JCKYS2022SXJQR-01).

Data Availability Statement

All data generated or analyzed during this research are included in this paper.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Zhang, Y.; Liu, X.; Luo, M.; Yang, C. MPC-based 3-D trajectory tracking for an autonomous underwater vehicle with constraints in complex ocean environments. Ocean. Eng. 2019, 18, 106309. [Google Scholar] [CrossRef]
  2. Bi, F.; Wei, Y.; Zhang, Z.J.; Cao, W. Position-tracking control of underactuated autonomous underwater vehicles in the presence of unknown ocean currents. Iet Control. Theory Appl. 2010, 4, 2369–2380. [Google Scholar] [CrossRef]
  3. Yuh, J. Design and Control of Autonomous Underwater Robots: A Survey. Auton. Robot. 2000, 8, 7–24. [Google Scholar] [CrossRef]
  4. Haj-Ali, A.; Ying, H. Structural analysis of fuzzy controllers with nonlinear input fuzzy sets in relation to nonlinear PID control with variable gains. Automatica 2004, 40, 1551–1559. [Google Scholar] [CrossRef]
  5. Krstic, M. Feedback Linearizability and Explicit Integrator Forwarding Controllers for Classes of Feedforward Systems. IEEE Trans. Autom. Control. 2004, 49, 1668–1682. [Google Scholar] [CrossRef]
  6. Tsai, W.C.; Wu, C.H.; Cheng, M.Y. Tracking Accuracy Improvement Based on Adaptive Nonlinear Sliding Mode Control. IEEE/ASME Trans. Mechatron. 2021, 26, 179–190. [Google Scholar] [CrossRef]
  7. Zhu, C.; Huang, B.; Zhou, B.; Su, Y.; Zhang, E. Adaptive model-parameter-free fault-tolerant trajectory tracking control for autonomous underwater vehicles. ISA Trans. 2021, 114, 57–71. [Google Scholar] [CrossRef]
  8. Wadi, A.; Mukhopadhyay, S.; Lee, J.H. Adaptive observer design for wave PDEs with nonlinear dynamics and parameter uncertainty. Automatica 2021, 123, 109295. [Google Scholar]
  9. Wen, L.; Tao, G.; Song, G. Higher-order tracking properties of nonlinear adaptive control systems. Syst. Control. Lett. 2020, 145, 104781. [Google Scholar] [CrossRef]
  10. Zhang, X.; Baron, L.; Liu, Q.; Boukas, E.K. Design of Stabilizing Controllers with a Dynamic Gain for Feedforward Nonlinear Time-Delay Systems. IEEE Trans. Autom. Control. 2011, 56, 692–697. [Google Scholar] [CrossRef]
  11. Elmokadem, T.; Zribi, M.; Youcef-Toumi, K. Terminal sliding mode control for the trajectory tracking of underactuated Autonomous Underwater Vehicles. Ocean Eng. 2017, 129, 613–625. [Google Scholar] [CrossRef]
  12. Wang, Y.; Pu, H.; Shi, P.; Ahn, C.K.; Luo, J. Sliding mode control for singularly perturbed Markov jump descriptor systems with nonlinear perturbation. Automatica 2021, 127, 109515. [Google Scholar]
  13. Taleb, M.; Plestan, F.; Bououlid, B. An adaptive solution for robust control based on integral high-order sliding mode concept. Int. J. Robust Nonlinear Control. 2015, 25, 1201–1213. [Google Scholar]
  14. Liu, K.; Liu, K.; Wang, Y.; Ji, H.; Wang, S. Adaptive saturated tracking control for spacecraft proximity operations via integral terminal sliding mode technique. Int. J. Robust Nonlinear Control. 2021, 31, 9372–9396. [Google Scholar]
  15. Khan, S.; Guivant, J.; Li, X. Design and experimental validation of a robust model predictive control for the optimal trajectory tracking of a small-scale autonomous bulldozer. Robot. Auton. Syst. 2022, 147, 103903. [Google Scholar]
  16. Jo, H.W.; Choi, H.L.; Lim, J.T. Observer based output feedback regulation of a class of feedforward nonlinear systems with uncertain input and state delays using adaptive gain. Syst. Control. Lett. 2014, 71, 45–53. [Google Scholar] [CrossRef]
  17. Chen, X.; Zhang, X.; Liu, Q. Prescribed-time decentralized regulation of uncertain nonlinear multi-agent systems via output feedback. Syst. Control. Lett. 2020, 137, 104640. [Google Scholar]
  18. Krishnamurthy, P.; Khorrami, F. Feedforward Systems with ISS Appended Dynamics: Adaptive Output-Feedback Stabilization and Disturbance Attenuation. IEEE Trans. Autom. Control. 2008, 53, 405–412. [Google Scholar] [CrossRef]
  19. Machado, J.E.; Ortega, R.; Astolfi, A.; Arocas-Perez, J.; Pyrkin, A.; Bobtsov, A.A.; Grino, R. An Adaptive Observer-Based Controller Design for Active Damping of a DC Network with a Constant Power Load. IEEE Trans. Control. Syst. Technol. 2021, 29, 2312–2324. [Google Scholar] [CrossRef]
  20. Chaudhari, S.; Shendge, P.D.; Phadke, S.B. Disturbance Observer Based Controller Under Noisy Measurement for Tracking of n DOF Uncertain Mismatched Nonlinear Interconnected Systems. IEEE/ASME Trans. Mechatron. 2020, 25, 1600–1611. [Google Scholar] [CrossRef]
  21. Liu, S.; Wang, D.; Poh, E. Output feedback control design for station keeping of AUVs under shallow water wave disturbances. Int. J. Robust Nonlinear Control. 2010, 19, 1447–1470. [Google Scholar] [CrossRef]
  22. Negahdaripour, S.; Xu, X.; Khamene, A.; Awan, Z. 3-D motion and depth estimation from sea-floor images for mosaic-based station-keeping and navigation of ROVs/AUVs and high-resolution sea-floor mapping. In Proceedings of the 1998 Workshop on Autonomous Underwater Vehicles, Cambridge, MA, USA, 21–21 August 1998; pp. 191–200. [Google Scholar]
  23. Zhuan, X.; Xia, X. Optimal Scheduling and Control of Heavy Haul Trains Equipped with Electronically Controlled Pneumatic Braking Systems. IEEE Trans. Control. Syst. Technol. 2007, 15, 1159–1166. [Google Scholar] [CrossRef]
  24. Du, T.; Hughes, J.; Wah, S.; Matusik, W.; Rus, D. Underwater Soft Robot Modeling and Control with Differentiable Simulation. IEEE Robot. Autom. Lett. 2021, 6, 4994–5001. [Google Scholar] [CrossRef]
  25. Chen, Y.L.; Ma, X.W.; Bai, G.Q.; Sha, Y.; Liu, J. Multi-autonomous underwater vehicle formation control and cluster search using a fusion control strategy at complex underwater environment. Ocean Eng. 2020, 216, 108048. [Google Scholar]
  26. Vu, M.T.; Le Thanh, H.N.N.; Huynh, T.-T.; Thang, Q.; Duc, T.; Hoang, Q.D.; Le, T.H. Station-Keeping Control of a Hovering Over-Actuated Autonomous Underwater Vehicle Under Ocean Current Effects and Model Uncertainties in Horizontal Plane. IEEE Access 2021, 9, 6855–6867. [Google Scholar] [CrossRef]
  27. Vu, M.T.; Le, T.-H.; Thanh, H.L.N.N.; Huynh, T.-T.; Van, M.; Hoang, Q.-D.; Do, T.D. Robust Position Control of an Over-actuated Underwater Vehicle under Model Uncertainties and Ocean Current Effects Using Dynamic Sliding Mode Surface and Optimal Allocation Control. Sensors 2021, 21, 747. [Google Scholar] [CrossRef]
  28. 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]
  29. Mofid, O.; Amirkhani, S. Finite-time convergence of perturbed nonlinear systems using adaptive barrier-function nonsingular sliding mode control with experimental validation. J. Vib. Control. 2022, 29, 3326–3339. [Google Scholar] [CrossRef]
  30. Hu, C.; Fu, L.; Yang, Y. Cooperative navigation and control for surface-underwater autonomous marine vehicles. In Proceedings of the 2nd Information Technology, Networking, Electronic and Automation Control Conference (ITNEC), Chengdu, China, 15–17 December 2017. [Google Scholar]
  31. Liang, Z.; Liu, Q. Design of stabilizing controllers of upper triangular nonlinear time-delay systems. Syst. Control. Lett. 2015, 75, 1–7. [Google Scholar] [CrossRef]
  32. Li, D.J. Adaptive output feedback control of uncertain nonlinear chaotic systems based on dynamic surface control technique. Nonlinear Dyn. 2012, 68, 235–243. [Google Scholar] [CrossRef]
  33. Huang, Y.; Meng, Z. Global finite-time distributed attitude synchronization and tracking control of multiple rigid bodies without velocity measurements. Automatica 2021, 132, 109796. [Google Scholar] [CrossRef]
Figure 1. Simulator with an underwater robot that uses hardware-in-the-loop technology.
Figure 1. Simulator with an underwater robot that uses hardware-in-the-loop technology.
Jmse 11 01748 g001
Figure 2. The trajectory of output.
Figure 2. The trajectory of output.
Jmse 11 01748 g002
Figure 3. The trajectory of Station l 1 .
Figure 3. The trajectory of Station l 1 .
Jmse 11 01748 g003
Figure 4. The trajectory of Station l 2 .
Figure 4. The trajectory of Station l 2 .
Jmse 11 01748 g004
Figure 5. The trajectory of Observers l ^ 1 (a) and l ^ 2 (b).
Figure 5. The trajectory of Observers l ^ 1 (a) and l ^ 2 (b).
Jmse 11 01748 g005
Figure 6. The trajectory of Errors l 1 (a) and l ^ 2 (b).
Figure 6. The trajectory of Errors l 1 (a) and l ^ 2 (b).
Jmse 11 01748 g006
Figure 7. The trajectory of Controller u .
Figure 7. The trajectory of Controller u .
Jmse 11 01748 g007
Figure 8. The trajectory of B (a) and B ˙ (b).
Figure 8. The trajectory of B (a) and B ˙ (b).
Jmse 11 01748 g008
Figure 9. Station results for PID method with the underwater robot system.
Figure 9. Station results for PID method with the underwater robot system.
Jmse 11 01748 g009
Figure 10. PID controller of the underwater robot system.
Figure 10. PID controller of the underwater robot system.
Jmse 11 01748 g010
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

Wang, F.; Peng, Y.; Guo, L. Research on Practical Path Tracking Control of Autonomous Underwater Vehicle Based on Constructive Dynamic Gain Controller. J. Mar. Sci. Eng. 2023, 11, 1748. https://doi.org/10.3390/jmse11091748

AMA Style

Wang F, Peng Y, Guo L. Research on Practical Path Tracking Control of Autonomous Underwater Vehicle Based on Constructive Dynamic Gain Controller. Journal of Marine Science and Engineering. 2023; 11(9):1748. https://doi.org/10.3390/jmse11091748

Chicago/Turabian Style

Wang, Fang, Yudong Peng, and Longchuan Guo. 2023. "Research on Practical Path Tracking Control of Autonomous Underwater Vehicle Based on Constructive Dynamic Gain Controller" Journal of Marine Science and Engineering 11, no. 9: 1748. https://doi.org/10.3390/jmse11091748

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