1. Introduction
Due to their critical role in undersea exploration and hydrographic observation, autonomous underwater vehicles (AUVs) have emerged as the most effective tools for ocean development thus far [1]. In contrast to the limitations of individual AUVs, multi-AUV systems offer a broader detection range, heightened operational efficiency, and enhanced redundancy performance. Given these significant advantages, research on AUV formation control has garnered increasing attention [2]. The primary challenge is to ensure the stability of the formation motion in intricate underwater environments with multiple constraints [3]. Addressing this issue, researchers have undertaken extensive studies in recent years. A behavioral decision-making-based path planning method for AUVs was proposed in [4], but the built-in model creates challenges for mathematical analysis. The leader–follower method, introduced for AUV formation tracking control in [5], confronts challenges related to poor robustness and fault tolerance due to the presence of a designated leader. Consequently, there has been a growing focus on the more promising leaderless formation approach [6]. In [7], a virtual structure-based method for AUV formation control was developed, but its flexibility and applicability are constrained. Despite substantial research in this domain, crafting a control scheme that provides optimal control performance while accommodating multiple constraints remains a primary research objective for multi-AUV systems.
The most typical constraints are the various disturbances encountered by AUVs. These include internal disturbances within the system, such as model uncertainties caused by coupled dynamics and varying system parameters [8]. Another significant factor is the unpredictable external disturbances caused by currents in the actual ocean environment [9]. Additionally, system constraints impose considerable challenges on AUV formation motion. For instance, the cruising speed and attitude angle of an AUV are subject to specific limitations [10]. These intrinsic state constraints place substantial demands on the design of the controller. Furthermore, actuator saturation constraints are a pertinent concern in real applications, stemming from limitations in the active drive force due to the physical characteristics of the actuator. If the control inputs violate this limit, it will degrade the control performance of the system [11]. The traditional control methods in the aforementioned studies have difficulty in achieving optimal control performance. In contrast, model predictive control (MPC) offers notable advantages in explicitly managing system constraints and optimizing performance [12]. It has found widespread application in various control systems subject to multiple constraints. In terms of AUV formation control, distributed model predictive control (DMPC) has garnered increased attention among researchers. As a result, there is an urgent need to provide an AUV formation control strategy that guarantees closed-loop system stability under external disturbances, internal model uncertainties, and system constraints.
In response to the above facts and challenges, we propose a novel FFTESO-based hierarchical DLMPC strategy for AUV formation tracking systems subject to multiple constraints in the complex ocean environment. The scheme precisely compensates for lumped disturbances while concurrently accounting for system constraints, such as actuator saturation and state constraints. The Lyapunov-based backstepping method is employed to ensure closed-loop stability.
The subsequent sections of this paper are organized as follows. Section 2 overviews related works on responses to multiple constraints and MPC. Section 3 presents the AUV modeling and problem formulation. Section 4 proposes the methodology, including the design of the FFTESO and DLMPC-based hierarchical tracking controllers, as well as the theoretical analysis of the system stability. In Section 5, the comparative simulation results are demonstrated. Finally, conclusions are drawn in Section 6.
2. Related Work
In recent decades, to enhance the robustness and adaptability of formation control systems against disturbances, diverse advanced methods have been explored. These encompass disturbance observers [13], adaptive control methods [14], and strategies involving neural networks [15]. Notably, the extended state observer (ESO) stands out due to its superior property of not requiring precise information about the controlled object. In recent years, the ESO technique proposed in [16] has demonstrated potential for disturbance compensation. It treats internal uncertainties and external environmental disturbances as lumped disturbances, extending them into a new state. In [17], an output feedback motion control method employing a high-gain ESO was developed. This method effectively compensates for measurement errors, external disturbances, and model uncertainties in remotely operated vehicles. Additionally, Ref. [18] introduced AUV tracking controllers based on a generalized ESO and a harmonic ESO, which are intended to ensure path tracking even in the presence of lumped disturbances. Despite the diversity of ESOs developed by researchers, their capability is often constrained to ensuring asymptotic convergence on the observation error without effectively limiting the convergence time. To enhance higher estimation accuracy in complex environments, there is a growing attraction towards finite-time ESO.
The design strategy for conventional FTESOs is presented in [19] and the estimation of the convergence time under different cases is given for the first time. A robust fault-tolerant controller based on FTESO was designed in [20] to estimate the lumped disturbances of spacecraft. The control algorithm incorporates nonsingular terminal sliding mode and super-twisting methods. The authors of [21] investigated a safety control based on the FTESO adaptive neural network for unmanned aerial vehicles. The double-power FTESO was utilized to compensate for lumped disturbances. Nevertheless, there is room for further optimization of the observer’s structure to enhance compensation performance.
To cope with actuator saturation and state constraints, an adaptive energy-saving trajectory tracking control strategy for AUVs was proposed in [22]. A compensator based on radial basis function neural network was used to solve the problems of saturation of the actuator and multi-objective optimization. In [23], an adaptive super-twisting algorithm-based sliding mode controller (ASTASMC) was introduced for the formation control problem in a multi-AUV recovery system. This controller utilizes a robust adaptive law to estimate unclear hydrodynamic parameters and unknown environmental disturbances in real time.
DMPC addresses constrained optimization problems based on information from the AUV itself and its neighboring vehicles. In [24], a DMPC-based formation tracking method for AUV systems subject to input constraints was introduced. However, it is important to note that this approach solely considered the kinematics of the AUV and did not support a realistic AUV model. Addressing the AUV formation control under compound disturbances, Ref. [25] proposed a FTESO-based dual closed-loop DMPC scheme. However, stability analysis for optimal control problems within a finite horizon has proved challenging, often requiring the addition of suitable terminal constraint sets or selecting sufficiently large prediction horizons [26]. To overcome these limitations, a Lyapunov-based MPC (LMPC) method was proposed in [27], ensuring the stability of the control system through the construction of Lyapunov contraction constraints. This method inherits the stability and robustness of the Lyapunov-based control law, offering valuable insights for the design of AUV formation controllers. Based on stochastic Lyapunov feedback control strategies, Ref. [28] developed a Lyapunov-based MPC method for nonlinear systems subject to stochastic uncertainties. The authors of [29] studied iterative DMPC method for large-scale nonlinear systems subject to asynchronous and delayed state feedback. The stability constraints of the iterative DMPC were formulated by utilizing the Lyapunov-based control technique. To the best of our knowledge, a Lyapunov-based distributed predictive control law was only proposed in [30] to solve the three degrees-of-freedom (DOF) AUV formation tracking issue under time-varying disturbances. However, its applicability is limited to plane motion and does not consider model uncertainties. The state-of-the-art methods related to DLMPC are summarized in Table 1.
With respect to existing works, the principal contributions of this scheme include:
Compared with the existing DLMPC method [30], we have considered the lumped disturbances and improved the control structure. A hierarchical structure is employed, comprising a position controller and a velocity controller, aimed at generating the desired velocity and control force. This adaptation not only mitigates the challenge of accessing the optimal solution but also augments the controllability of the velocity, thereby improving the spatial tracking accuracy of the formation system.
Compared to the FTESO utilized in [19,31], we have enhanced convergence speed by augmenting linear terms. This enables faster compensation of the disturbances for online updating of the prediction model. It not only enhances the estimation accuracy and convergence speed but also effectively mitigates the fluctuations of lumped disturbances. Hence, the robustness of the multi-AUV system is enhanced.
The Lyapunov-based backstepping control law is utilized to institute stability constraints within the DMPC problem. This choice ensures the recursive feasibility of the control algorithm and the stability of the closed-loop system. The conditions and attraction regions sufficient to ensure stability are explicitly given. The control performance of formation tracking is substantially improved.
3. Preliminaries
In this section, we present the AUV model and problem formulation, where a new version of the dynamic equation is demonstrated based on the task constraints.
3.1. AUV Modeling
The article selects a fully-actuated torpedo-type AUV from the literature [32] aligning with the task objectives. As shown in Figure 1, a 6DOF AUV is typically described by two reference frames: an earth-fixed frame and a body-fixed frame . Since this AUV can be regarded as a highly metacentric stable vehicle with self-stable roll motion, we ignore the effect of roll; that is, roll angle , roll angular velocity , and the spatial motion of AUV is regarded as a 5DOF motion process. The kinematics and dynamics of the ith AUV are expressed as [33]:
(1)
(2)
where , denotes the states of position and orientation of AUV, denotes the velocity states of the AUV. is a rotation transformation matrix from the body-fixed frame to the earth-fixed frame and is assumed to be invertible (i.e., ), expressed as:(3)
denotes the inertial matrix. and represent the Coriolis and centripetal and hydrodynamic damping matrix, respectively. The gravitational and buoyancy forces of this AUV are balanced with each other such that the restoring force is approximated to be zero. denotes the control force and moment, and represents the time-varying unknown external disturbance. Specific expressions for these matrices are given in [34].In practical applications, acquiring precise hydrodynamic coefficients for the AUV model might be challenging. It can generally be assumed that the coefficients are subject to certain perturbations ranging from −20% to 20% [35]. Thus, the parameter matrices are divided into , , and , represents the nominal part that can be determined by the computational fluid dynamics (CFD) [36]. denotes the difference between the actual and nominal parts, i.e., model uncertainties.
Then, the dynamic model (2) of ith AUV with the above constraints is rewritten as:
(4)
where is considered as the lumped disturbance, including environmental disturbances and model uncertainties. In general, external disturbances exhibit limited energy and periodic variations. The model uncertainties are limited by the actual state and physical features of the AUV. Therefore, we make the following rational assumption:([37]). The external disturbance and its first derivative are bounded, and the model uncertainties , , and are unknown and bounded. Therefore, the lumped disturbance is bounded and satisfies , .
3.2. Problem Formulation
To better characterize the information exchange between the AUVs, we adopted a directed topology graph to describe the formation communication. The node set denotes the N AUVs, and an edge set describes the information interaction from the node to the node . Define as an adjacency matrix, where denotes the connection weight and if , while if . Presume that the ith AUV has the capability to receive local information from the virtual leader and the neighbors [38].
Next, we formulate the AUV formation tracking control problem. In order for the AUV formation to track the reference trajectory smoothly while maintaining the prescribed shape, the ith AUV is driven to satisfy: (1) Tracking: ; . (2) Formation: , with denoting the formation configuration vector and denoting the relative distance vector between the ith AUV and the jth AUV.
4. Methodology
In this section, to address the AUV formation control issue subject to complex constraints, we develop a novel distributed Lyapunov-based model predictive tracking control scheme. Initially, recognizing the presence of lumped disturbances that cannot be directly measured, a fast FTESO is devised to compensate for this constraint. Then, we make structural adaptation to the existing DLMPC method that uses a hierarchical design of position and velocity tracking controllers to handle the other constraints. Stability constraints are constructed based on Lyapunov theory. Finally, we analyze the feasibility and stability of the AUV formation system.
4.1. Design and Stability Analysis of FFTESO
Given the efficacy of the extended state observation method in estimating disturbances and model uncertainties, we propose a novel FFTESO to concurrently compensate for the lumped disturbances within the AUV formation.
To facilitate the FFTESO design, the AUV dynamics model (4) with respect to the earth-fixed frame can be further transformed as:
(5)
where , , . Then, define the auxiliary variables , , , so the AUV’s system model (1) and (2) are transformed to(6)
Next, we define some new variables , , and the lumped disturbances are regarded as an extended state , denoted as with . In Assumption 1, is bounded and continuously differentiable as well, and the components of its first derivative satisfies , , where is an unknown upper bound. Afterward, the mathematical model of the ith AUV can be extended as:
(7)
Denote , , and as the estimation of states , and in the extended system (7), and , , as the estimation errors of the position, velocity, and lumped disturbance, respectively. Then, the FFTESO for the ith AUV is designed as:
(8)
with the observer gains satisfying , , and , , , with . Based on the model (7) and the designed FFTESO (8), the observation error dynamics are:(9)
The convergence analysis of the FFTESO (8) is presented in the following theorem.
Consider the formation control system of the AUV model (7) under Assumption 1. If the FFTESO is designed as in (8) to satisfy the specified observer gain constraints, then the estimation errors will converge to the stability region within a finite time .
See Appendix A. □
4.2. Position Tracking Controller
In this subsection, we explain our design of the DLMPC-based position tracking controller. It makes the ith AUV track the reference trajectory by outputting the desired driving speed, thereby converging the position tracking error. It supplies the optimal desired speed needed by the velocity tracking controller.
The reference trajectory is defined as . Here, to avoid singularities in the reference trajectory, we make the following assumption:
([25]). The reference trajectory and its derivatives are smooth and bounded, satisfying the equation , , with positive constants , , .
The kinematic model for the ith AUV position tracking can be established by (1):
(10)
where and are the state and the control input of the ith AUV, respectively. To fulfill the control objective of each AUV, the DLMPC optimization problem for the position tracking controller can be formulated as:(11a)
(11b)
(11c)
(11d)
(11e)
(11f)
where denotes the predicted state trajectory, , . represents the cluster of piecewise functions featured by the sampling period h, denotes the prediction horizon. , and represent weighting matrices that are diagonal and positive-definite. (11c) is the initial state condition. (11d) represents the position state constraint. (11e) represents the control input constraint. (11f) is the stability constraint constructed by the Lyapunov-based virtual control law and the relevant Lyapunov function , which explicitly characterizes the guaranteed region of attraction. This is designed to circumvent the local linearization of the standard DMPC while guaranteeing the stability of the formation tracking. One should note that does not actually control the vehicle but only ensures system stability.Then, we construct the concrete expression of the stability constraints in (11f), which involves determining an appropriate state-feedback controller and the corresponding Lyapunov function. Various nonlinear control techniques, such as sliding mode control and backstepping, can be employed. For the trajectory tracking problem, we select the backstepping method to develop the Lyapunov-based nonlinear controller.
Let denote the trajectory of the ith AUV, and be the desired path; represents the position tracking error of ith AUV. Define the following Lyapunov function:
(12)
where is a specified control gain matrix, diagonal and positive-definite. Taking the time derivative of , we can obtain:(13)
To stabilize the position tracking, we choose the following control law:
(14)
where is another specified control gain matrix. Then, the derivative of (13) becomes the following form:(15)
From (12) and (15), it can be seen that and , so based on Lyapunov’s direct method, the position tracking subsystem with virtual control law (14) is globally asymptotically stable with respect to the equilibrium . Therefore, we can obtain the concrete expression of the stability constraint (11f) as follows:
(16)
The stability constraint (16) facilitates the verification that the DLMPC inherits the stability properties of the state-feedback control law (14) [39]. Moreover, owing to the online optimization process, the DLMPC-based position controller will automatically execute the optimal control performance obeying the system constraints.
4.3. Velocity Tracking Controller
In this subsection, we design a DLMPC-based velocity tracking controller to obtain the optimal control forces and moments of the ith AUV, aiming to track the desired velocity. It is used to stabilize the velocity tracking error in the AUV dynamics subsystem.
The dynamic model for the ith AUV velocity tracking can be modeled by (4):
(17)
where the state is defined as and the control input is defined as . Based on the effect of FFTESO (8) and the control objective, the DLMPC optimization problem for the velocity tracking controller can be formulated as:(18a)
(18b)
(18c)
(18d)
(18e)
(18f)
where is the predicted state trajectory, and denotes the tracking error. The desired speed is derived from the position tracking controller (11). and represent positive-definite weighting matrices. Similar to the optimization problem (11), the condition (18c) denotes the initial state. (18d) represents the velocity state constraint. (18e) represents the control input constraint. (18f) is the stability constraint constructed by the virtual control law and the corresponding Lyapunov function . The DLMPC controller (18) inherits the stability and robustness of the virtual controller. Then, we construct the concrete expression of the stability constraints.Let denote the velocity of the ith AUV, where represents the velocity tracking error of ith AUV. Consider the following Lyapunov function:
(19)
where is a positive-definite diagonal matrix. Taking the time derivative of , we can derive:(20)
To achieve stable velocity tracking, based on the backstepping method and the lumped disturbances compensated by FFTESO, we choose the following control law:
(21)
where is a specified gain matrix. Then, (13) becomes the following form:(22)
From (19) and (22), it can be seen that and , so according to Lyapunov’s direct method, the velocity tracking subsystem with virtual control law (21) is globally asymptotically stable with respect to the equilibrium . Thus, the concrete expression of the stability constraint (18f) is:
(23)
Likewise, the DLMPC-based velocity controller exerts excellent control performance thanks to online optimization. Leveraging the designed position controller (11) and velocity controller (18), the distributed Lyapunov-based model predictive formation control will be implemented for each AUV in the receding horizon mode.
The implementation process of DLMPC is described in Algorithm 1. The core of the algorithm consists of two parts: solving the optimization problem (11) of the position tracking layer and solving the optimization problem (18) of the velocity tracking layer. Firstly, the optimization problem (11) is solved, yielding the optimal control input related to AUV linear and angular velocity variables. Then, the control inputs of the position tracking layer are passed as reference velocity to the velocity tracking layer. By solving the optimization problem (18), the optimal control force and torque are obtained. Finally, the control inputs of the velocity tracking layer are applied to the AUV system. Figure 2 shows the flow diagram of the proposed Algorithm 1.
Algorithm 1. DLMPC Implementation |
1: The ith AUV samples the current state . Input the cost function in (11a). |
2: The ith AUV receives the state trajectory of its neighbor AUV , , . |
3: Solve the optimization problem (11) provided , generate , and let it be the (sub-)optimal solution. |
4: Implement for only one sampling period, i.e., for . |
5: Let , input the cost function in (18a). |
6: Solve the optimization problem (18) provided, , generating . |
7: Implement for only one sampling period, i.e., for . |
8: At next sampling time instant, set , and repeat from step 1. |
In the next section, we demonstrate that both system stability and recursive feasibility are not dependent on obtaining the precise solution from the optimization process. Therefore, suboptimal solutions are deemed acceptable in Algorithm 1. The use of iterative methods ensures that DLMPC optimization problems (11) and (18) possess locally optimal solutions. We can trade off numerical efficacy and control effect by setting the maximum iteration number without compromising the stability of the formation control. Additionally, the compensation of lumped disturbances is continuously applied throughout the iterative optimization process, ensuring the success of the formation tracking task under multiple constraints.
4.4. Stability Analysis
In the previous subsection, stability constraints were constructed using the Lyapunov-based backstepping method. In this subsection, we will analyze the recursive feasibility and closed-loop stability of Algorithm 1.
First, we give the following theorem to show the recursive feasibility of the designed position tracking controller.
Choose the positive-definite gain matrix as . Let denote the largest entity in the control gain . For , under Assumption 2, if the following relation can be ensured
(24)
where denotes the maximum generalized velocity, then the DLMPC-based position controller is recursively feasible, i.e., , for all .See Appendix B. □
Then, we give the following theorem to show the recursive feasibility of the velocity controller.
Choose the positive definite gain matrix as . Let denote the largest entity in the control gain . For , under Assumption 1 and Assumption 2, if the following relation can be ensured
(25)
where , , is the maximum possible generalized thrust force, is a known constant bound for . Then, the velocity controller is recursively feasible, i.e., , for all .See Appendix C. □
Finally, we give the following theorem to show the stability of closed-loop system.
Consider the AUV formation control system described by (10) and (17) with lumped disturbances. If Assumption 1 and Assumption 2 hold, then the DLMPC-based position controller (11) renders the equilibrium asymptotically stable, and the velocity controller (18) renders the equilibrium asymptotically stable. In other words, the AUV formation tracking task can be realized under the control inputs produced by Algorithm 1.
See Appendix D. □
5. Simulation
In this section, we conduct some simulation analyses to verify the effectiveness of the proposed hierarchical DLMPC algorithm for the AUV formation system. The formation network comprises four AUVs and a virtual leader (AUV0). Figure 3 illustrates the adopted communication topology, with the arrows indicating the communication direction between the AUVs. The simulation results demonstrate the promising formation tracking performance and robustness of the proposed method.
5.1. Simulation Setup
The initial states for each AUV are selected as , , and , respectively. The model parameters for the homogeneous AUV were extracted from previous work [40]. We selected a diamond-shaped formation conducive to omnidirectional marine exploration, setting the formation configuration vectors as , , , . , , , , and . The model uncertainties are reflected by considering 15% of the nominal value as the model error, implying that the AUV parameters in the simulation characterize only 85% of the nominal system. To assess the system’s robustness, the external disturbances are modeled as follows:
(26)
There are guidelines for selecting each parameter: considering that AUVs navigate at slower speeds, a smaller T is planned to be adopted. During debugging, if the rate is not fast enough, adjust it down, and if the stability is poor, adjust it up. As we place more attention on the position tracking performance, is set as slightly bigger than ; to attenuate the interaction between angles, the angle weights in are set a little smaller; and are set as small as possible while ensuring the stability of the system. The connection among the observer gains and is obtained by solving the Lyapunov equation (29), and then tuned to select appropriate values. Following the above guidelines, the simulation parameters of the proposed algorithm in Table 2 were chosen.
Moreover, the prediction horizon is h, and the limitation of each actuator is 500 N. The upper and lower bound of velocity states are set as m/s, m/s, m/s, rad/s, rad/s. The reference trajectory generated by a virtual leader is a helical curve:
(27)
5.2. Performance Tests for Lumped Disturbances Estimation
Firstly, to assess the disturbance rejection capability of the formation system under spatial disturbance constraints, we conducted comparative tests with the conventional FTESO in [19], the improved third-order FTESO in [31], and the designed FFTESO (8). Figure 4 illustrates the disturbance estimation error norms for each AUV under different observers. It is evident from the figure that the conventional FTESO exhibits slow convergence time and slight chattering. While the third-order FTESO achieves finite-time stabilization, it starts with a large initial error and displays slow convergence speed. In contrast, the proposed FFTESO not only ensures the convergence of the estimation error to a small neighborhood of the origin within a finite time but also outperforms the other two observers in terms of dynamic response speed and estimation accuracy. Therefore, owing to the advantages of fast transient response and high accuracy of the designed FFTESO (8), each AUV can more swiftly and accurately compensate for both external disturbances and internal uncertainties. This markedly fortifies the active disturbance rejection capability of the formation control system.
5.3. Performance Tests for Formation Trajectory Tracking
To evaluate the tracking control performance of the designed scheme, comparative tests were conducted under uniform parameter and disturbance settings: scheme (a) corresponds to our proposed FFTESO-based hierarchical DLMPC algorithm; scheme (b) corresponds to the conventional DLMPC algorithm for AUV formation in [30]; and scheme (c) corresponds to the ASTASMC algorithm proposed for AUV formation control in [23]. In the following section, we analyze the performance metrics of formation tracking control: convergence speed, tracking accuracy, and smoothness of control inputs.
Figure 5, Figure 6, Figure 7, Figure 8 and Figure 9 depict the trajectories of the position and attitude angles of each AUV during formation tracking under both schemes. Figure 10, Figure 11, Figure 12, Figure 13 and Figure 14 depict the trajectories of linear and angular velocities. Observing the results, it is evident that the three schemes successfully guided the four AUVs to the desired state. However, the tracking performance differed. In terms of convergence speed, scheme (a) achieved full-state stable tracking within 150 s, scheme (b) required 220 s, while in scheme (c) the entire process convergence took about 300 s. In terms of tracking accuracy, unlike the observers used in (a) and (b), scheme (c) compensated for lumped disturbances through a robust adaptive law designed to mitigate high-frequency measurement noise. However, from the state trajectories, it is discernible that the state variables in (c) exhibited longer stabilization times and were accompanied by chattering. This indicates a weaker disturbance rejection capability compared to our proposed scheme. Furthermore, the comparison of (a) and (b) shows that the hierarchical structure enhances the rate of convergence and the controllability of the velocity state. The simulation results affirm that combining disturbance compensation from FFTESO and the online optimization of DLMPC strongly enhanced the formation control performance.
Figure 15 visually illustrates the formation tracking trajectory in three-dimensional space. In conjunction with Figure 5, Figure 6, Figure 7, Figure 8, Figure 9, Figure 10, Figure 11, Figure 12, Figure 13 and Figure 14, it is evident that under the same initial conditions, all three schemes performed the formation helical dive task. However, scheme (c) was characterized by continuous fluctuations during the tracking process, posing an increased risk of the AUV formation deviating from the desired trajectory. Conversely, the formation members in schemes (a) and (b) smoothly tracked the reference trajectory while maintaining the preset distance. This difference arose from the distinct compensation principles of the disturbance rejection methods. The robust adaptive law in scheme (c) proved less robust to lumped disturbances with fast time-varying characteristics. On further observation, the proposed control scheme facilitated each AUV in forming the predefined configuration more rapidly, showcasing the superior response speed of the designed control system. Consequently, under multiple constraints such as lumped disturbances, state constraints, and stability constraints, the FFTESO-based DLMPC algorithm exhibited greater adaptability to complex underwater environments than the other two algorithms in terms of disturbance rejection, convergence speed, and tracking performance. Figure 16 gives the tracking error for each AUV under the three schemes. Table 3 presents the convergence time of all states and the average of AUV3’s tracking error after 130 s for the three schemes. We can clearly conclude that the proposed method had the optimal convergence speed and tracking accuracy.
Without loss of generality, Figure 17 illustrates the actual control forces and moments applied to AUV1 under the three algorithms. The blue curve represents the ASTASMC scheme, the green curve represents the traditional DLMPC scheme, and the red curve depicts the proposed DLMPC scheme. Compared with schemes (b) and (c), the control signals under the proposed scheme were regulated more swiftly, and the force and moment varied smoothly, allowing for steady trajectory tracking of the AUV formation when subjected to constraints. It is worth mentioning that the AUVs under the ASTASMC scheme required continual correction of the driving force and moment, leading to persistent chattering. This observation underscores the robustness and superiority of the FFTESO-based hierarchical DLMPC algorithm. It is noteworthy that, at the onset of the task, the proposed scheme made use of the propulsion capability to achieve the fastest possible convergence, all while adhering to the physical limitations of the thrusters. In other words, the variation of the control signals continually remained within prescribed limits, effectively avoiding actuator saturation and reducing the failure rate.
6. Conclusions
In summary, this paper proposes a FFTESO-based hierarchical DLMPC scheme for AUV formation tracking under multiple constraints. The scheme leverages the faster and more precise compensation of lumped disturbances by FFTESO to dynamically update the prediction model online. Position tracking and velocity tracking controllers were particularly designed to determine the optimal velocities and control forces for the formation system while adhering to specified constraints. The Lyapunov-based backstepping controllers were then employed to construct stability constraints in the DMPC optimization problem, ensuring both recursive feasibility and closed-loop stability of the control algorithm. The simulation results demonstrated that compared with the conventional DLMPC and the ASTASMC method, we enhanced the convergence speed by 31.8% and 50%, and the tracking accuracy by 38.8% and 62.1%, respectively. This demonstrates that the proposed scheme significantly improved the formation tracking performance and anti-disturbance capability. The theoretical results lay a robust foundation for the practical design and implementation of AUV formation controllers.
The main limitation of DLMPC is that it relies heavily on timely and reliable inter-subsystem communication. In the future work, we will focus on the design of a DLMPC controller for AUV formation systems subject to communication delays to overcome the communication challenges in real-world applications. In addition, in response to the issue that finite-time convergence is sensitive to the initial values of the states, we intend to investigate an extended state observer with fixed-time convergence.
Conceptualization, Z.Y.; data curation, J.Z.; funding acquisition, Z.Y.; investigation, J.Z.; methodology, Z.Y. and M.Z.; resources, L.Y.; software, J.Z.; supervision, Z.Y.; validation, M.Z.; visualization, L.Y.; writing—original draft, M.Z.; writing—review and editing, M.Z. All authors have read and agreed to the published version of the manuscript.
Not applicable.
Not applicable.
Data is contained within the article.
The authors declare no conflict of interest.
Footnotes
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.
Figure 4. The estimation error norm [Forumla omitted. See PDF.] for the lumped disturbance of the ith AUV.
Figure 5. State [Forumla omitted. See PDF.] trajectories for multi-AUV systems. (a) The proposed hierarchical DLMPC scheme. (b) The conventional DLMPC scheme. (c) The ASTASMC scheme.
Figure 6. State [Forumla omitted. See PDF.] trajectories for multi-AUV systems. (a) The proposed hierarchical DLMPC scheme. (b) The conventional DLMPC scheme. (c) The ASTASMC scheme.
Figure 7. State [Forumla omitted. See PDF.] trajectories for multi-AUV systems. (a) The proposed hierarchical DLMPC scheme. (b) The conventional DLMPC scheme. (c) The ASTASMC scheme.
Figure 8. State [Forumla omitted. See PDF.] trajectories for multi-AUV systems. (a) The proposed hierarchical DLMPC scheme. (b) The conventional DLMPC scheme. (c) The ASTASMC scheme.
Figure 9. State [Forumla omitted. See PDF.] trajectories for multi-AUV systems. (a) The proposed hierarchical DLMPC scheme. (b) The conventional DLMPC scheme. (c) The ASTASMC scheme.
Figure 10. State [Forumla omitted. See PDF.] trajectories for multi-AUV systems. (a) The proposed hierarchical DLMPC scheme. (b) The conventional DLMPC scheme. (c) The ASTASMC scheme.
Figure 11. State [Forumla omitted. See PDF.] trajectories for multi-AUV systems. (a) The proposed hierarchical DLMPC scheme. (b) The conventional DLMPC scheme. (c) The ASTASMC scheme.
Figure 12. State [Forumla omitted. See PDF.] trajectories for multi-AUV systems. (a) The proposed hierarchical DLMPC scheme. (b) The conventional DLMPC scheme. (c) The ASTASMC scheme.
Figure 13. State [Forumla omitted. See PDF.] trajectories for multi-AUV systems. (a) The proposed hierarchical DLMPC scheme. (b) The conventional DLMPC scheme. (c) The ASTASMC scheme.
Figure 14. State [Forumla omitted. See PDF.] trajectories for multi-AUV systems. (a) The proposed hierarchical DLMPC scheme. (b) The conventional DLMPC scheme. (c) The ASTASMC scheme.
Figure 15. Three-dimensional trajectories of the multi-AUV systems under three schemes. (a) The designed hierarchical DLMPC scheme. (b) The conventional DLMPC scheme. (c) The ASTASMC scheme.
Figure 16. Tracking errors of the multi-AUV under three schemes. (a) The proposed hierarchical DLMPC scheme. (b) The conventional DLMPC scheme. (c) The ASTASMC scheme.
Comparison between state-of-the-art methods.
Methods | Applications | Main Contributions | Limitations |
---|---|---|---|
LMPC [ | Trajectory tracking for AUVs | Stability constraints for LMPC systems of AUVs are given for the first time | The lumped disturbances are ignored and the closed-loop stability is conservative |
Stochastic LMPC [ | Nonlinear systems with unbounded stochastic uncertainties | Stability constraints are explicitly characterized in a probabilistic sense | Applicability and scalability can be further improved |
Iterative DLMPC [ | Nonlinear systems with asynchronous and delayed state feedback | Iterations can be terminated at any number without loss of closed-loop stability | Stability is limited by the dynamic behavior of the open-loop process |
DLMPC [ | Formation tracking for 3DOF AUVs | Contraction constraints are given for the stability of AUV disturbed formation | Only planar motion is considered and the control structure is simple |
Control parameters of the designed algorithm.
Parameter | Value | Parameter | Value |
---|---|---|---|
| | h | 0.1 s |
| | | 0.75 |
| | | 0.8 |
| | | 0.7 |
| | | 0.2 |
| | | |
| | | |
Comparison of performance metrics.
Control Scheme | Convergence Time | Tracking Error Averages |
---|---|---|
Scheme (a) | 150 s | 0.508 m |
Scheme (b) | 220 s | 0.830 m |
Scheme (c) | 300 s | 1.341 m |
Appendix A
Introducing an auxiliary error variable
If the designed observer gain is restricted to
From
Accordingly, inequality (A4) can be further derived as:
With the stable region
Appendix B
Given the current system state
Taking the infinity norm on both sides of (14), we have
From (15),
Accordingly, (A9) can be further derived as:
If (24) can be satisfied, then the relation
Appendix C
Given the current system state
Consider the following Lyapunov function:
Since the desired speed in the velocity tracking controller is derived from the position controller, we have
Based on the above analysis, taking the infinity norms on both sides of (21) yields:
If (25) can be satisfied, then the relation
Appendix D
Since we have constructed a Lyapunov function
In view of the stability constraint (11f) and the optimal solution
From the Lyapunov argument of Theorem 4.8 in [
Similarly, the following conclusion can be obtained: the velocity tracking subsystem under Algorithm 1 is asymptotically stable within an attraction region
This ensures the stability of the overall AUV formation system. Since there are no other limitations on
It is noteworthy that the tracking control performance of the backstepping technique-based virtual control law relies on the amplitude of the control gains. As seen in (14) and (21), smaller values of
References
1. Shi, Y.; Shen, C.; Fang, H.; Li, H. Advanced control in marine mechatronic systems: A survey. IEEE-ASME Trans. Mechatron.; 2017; 22, pp. 1121-1131. [DOI: https://dx.doi.org/10.1109/TMECH.2017.2660528]
2. Wang, C.; Cai, W.; Lu, J.; Ding, X.; Yang, J. Design, modeling, control, and experiments for multiple AUVs formation. IEEE Trans. Autom. Sci. Eng.; 2021; 19, pp. 2776-2787. [DOI: https://dx.doi.org/10.1109/TASE.2021.3094539]
3. Yu, H.; Zeng, Z.; Guo, C. Coordinated formation control of discrete-time autonomous underwater vehicles under alterable communication topology with time-varying delay. J. Mar. Sci. Eng.; 2022; 10, 712. [DOI: https://dx.doi.org/10.3390/jmse10060712]
4. Chen, G.; Shen, Y.; Qu, N.; He, B. Path planning of AUV during diving process based on behavioral decision-making. Ocean Eng.; 2021; 234, 109073. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2021.109073]
5. Cui, R.; Ge, S.S.; How, B.V.E.; Choo, Y.S. Leader–follower formation control of underactuated autonomous underwater vehicles. Ocean Eng.; 2010; 37, pp. 1491-1502. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2010.07.006]
6. He, X.; Geng, Z. Globally convergent leaderless formation control for unicycle-type mobile robots. IET Control Theory Appl.; 2020; 14, pp. 2651-2662. [DOI: https://dx.doi.org/10.1049/iet-cta.2019.1354]
7. Zhen, Q.; Wan, L.; Li, Y.; Jiang, D. Formation control of a multi-AUVs system based on virtual structure and artificial potential field on SE(3). Ocean Eng.; 2022; 253, 111148. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2022.111148]
8. Hu, C.D.; Wu, D.F.; Liao, Y.X.; Hu, X. Sliding mode control unified with the uncertainty and disturbance estimator for dynamically positioned vessels subjected to uncertainties and unknown disturbances. Appl. Ocean Res.; 2021; 109, 102564. [DOI: https://dx.doi.org/10.1016/j.apor.2021.102564]
9. Zhang, W.; Wu, W.; Li, Z.; Du, X.; Yan, Z. Three-Dimensional Trajectory Tracking of AUV Based on Nonsingular Terminal Sliding Mode and Active Disturbance Rejection Decoupling Control. J. Mar. Sci. Eng.; 2023; 11, 959. [DOI: https://dx.doi.org/10.3390/jmse11050959]
10. Peng, Z.; Wang, J.; Wang, J. Constrained control of autonomous underwater vehicles based on command optimization and disturbance estimation. IEEE Trans. Ind. Electron.; 2018; 66, pp. 3627-3635. [DOI: https://dx.doi.org/10.1109/TIE.2018.2856180]
11. Miao, J.; Sun, X.; Chen, Q.; Zhang, H.; Liu, W.; Wang, Y. Robust Path-Following Control for AUV under Multiple Uncertainties and Input Saturation. Drones; 2023; 7, 665. [DOI: https://dx.doi.org/10.3390/drones7110665]
12. 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; 189, 106309. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2019.106309]
13. Yong, K.; Chen, M.; Wu, Q. Anti-disturbance control for nonlinear systems based on interval observer. IEEE Trans. Ind. Electron.; 2019; 67, pp. 1261-1269. [DOI: https://dx.doi.org/10.1109/TIE.2019.2898575]
14. Chen, C.; Wen, C.; Liu, Z.; Xie, K.; Zhang, Y.; Chen, C.P. Adaptive consensus of nonlinear multi-agent systems with non-identical partially unknown control directions and bounded modelling errors. IEEE Trans. Autom. Control.; 2016; 62, pp. 4654-4659. [DOI: https://dx.doi.org/10.1109/TAC.2016.2628204]
15. Guo, P.; Lyu, M.R.; Chen, C.L.P. Regularization parameter estimation for feedforward neural networks. IEEE Trans. Syst. Man Cybern. Part B-Cybern.; 2003; 33, pp. 35-44.
16. Han, J. From PID to active disturbance rejection control. IEEE Trans. Ind. Electron.; 2009; 56, pp. 900-906. [DOI: https://dx.doi.org/10.1109/TIE.2008.2011621]
17. Fernandes, D.D.A.; Sørensen, A.J.; Pettersen, K.Y.; Donha, D.C. Output feedback motion control system for observation class ROVs based on a high-gain state observer: Theoretical and experimental results. Control Eng. Pract.; 2015; 39, pp. 90-102. [DOI: https://dx.doi.org/10.1016/j.conengprac.2014.12.005]
18. Lamraoui, H.C.; Qidan, Z. Path following control of fully-actuated autonomous underwater vehicle in presence of fast-varying disturbances. Appl. Ocean Res.; 2019; 86, pp. 40-46. [DOI: https://dx.doi.org/10.1016/j.apor.2019.02.015]
19. Basin, M.; Yu, P.; Shtessel, Y. Finite-and fixed-time differentiators utilising HOSM techniques. IET Control Theory Appl.; 2017; 11, pp. 1144-1152. [DOI: https://dx.doi.org/10.1049/iet-cta.2016.1256]
20. Li, B.; Hu, Q.; Yang, Y. Continuous finite-time extended state observer based fault tolerant control for attitude stabilization. Aerosp. Sci. Technol.; 2019; 84, pp. 204-213. [DOI: https://dx.doi.org/10.1016/j.ast.2018.10.006]
21. Cai, X.; Zhu, X.; Yao, W. FTESO-adaptive neural network based safety control for a quadrotor UAV under multiple disturbances: Algorithm and experiments. Int. J. Robot. Res. Appl.; 2024; 51, pp. 20-33. [DOI: https://dx.doi.org/10.1108/IR-09-2023-0196]
22. Xia, Y.; Xu, K.; Huang, Z.; Wang, W.; Xu, G.; Li, Y. Adaptive energy-efficient tracking control of a X rudder AUV with actuator dynamics and rolling restriction. Appl. Ocean Res.; 2022; 118, 102994. [DOI: https://dx.doi.org/10.1016/j.apor.2021.102994]
23. Xia, G.; Zhang, Y.; Zhang, W.; Zhang, K.; Yang, H. Robust adaptive super-twisting sliding mode formation controller for homing of multi-underactuated AUV recovery system with uncertainties. ISA Trans.; 2022; 130, pp. 136-151. [DOI: https://dx.doi.org/10.1016/j.isatra.2022.04.010]
24. Li, H.; Xie, P.; Yan, W. Receding horizon formation tracking control of constrained underactuated autonomous underwater vehicles. IEEE Trans. Ind. Electron.; 2016; 64, pp. 5004-5013. [DOI: https://dx.doi.org/10.1109/TIE.2016.2589921]
25. Zhang, M.; Yan, Z.; Zhou, J.; Yue, L. Distributed Dual Closed-Loop Model Predictive Formation Control for Collision-Free Multi-AUV System Subject to Compound Disturbances. J. Mar. Sci. Eng.; 2023; 11, 1897. [DOI: https://dx.doi.org/10.3390/jmse11101897]
26. Liu, C.; Sun, T.; Hu, Q.Z. Synchronization Control of Dynamic Positioning Ships Using Model Predictive Control. J. Mar. Sci. Eng.; 2021; 9, 1239. [DOI: https://dx.doi.org/10.3390/jmse9111239]
27. Shen, C.; Shi, Y.; Buckham, B. Trajectory tracking control of an autonomous underwater vehicle using Lyapunov-based model predictive control. IEEE Trans. Ind. Electron.; 2017; 65, pp. 5796-5805. [DOI: https://dx.doi.org/10.1109/TIE.2017.2779442]
28. Mahmood, M.; Mhaskar, P. Lyapunov-based model predictive control of stochastic nonlinear systems. Automatica; 2012; 48, pp. 2271-2276. [DOI: https://dx.doi.org/10.1016/j.automatica.2012.06.033]
29. Liu, J.; Chen, X.; de la Pena, D.M.M.; Christofides, P.D. Iterative distributed model predictive control of nonlinear systems: Handling asynchronous, delayed measurements. IEEE Trans. Autom. Control; 2011; 57, pp. 528-534.
30. Wei, H.; Shen, C.; Shi, Y. Distributed Lyapunov-based model predictive formation tracking control for autonomous underwater vehicles subject to disturbances. IEEE Trans. Syst. Man Cybern. Syst.; 2019; 51, pp. 5198-5208. [DOI: https://dx.doi.org/10.1109/TSMC.2019.2946127]
31. Meng, C.; Zhang, W.; Du, X. Finite-time extended state observer based collision-free leaderless formation control of multiple AUVs via event-triggered control. Ocean Eng.; 2023; 268, 113605. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2022.113605]
32. Yan, Z.; Gong, P.; Zhang, W.; Li, Z.; Teng, Y. Autonomous underwater vehicle vision guided docking experiments based on L-shaped light array. IEEE Access; 2019; 7, pp. 72567-72576. [DOI: https://dx.doi.org/10.1109/ACCESS.2019.2917791]
33. Fossen, T.I. Handbook of Marine Craft Hydrodynamics and Motion Control; John Wiley & Sons: Hoboken, NJ, USA, 2011.
34. Xu, J.; Cui, Y.; Xing, W.; Huang, F.; Yan, Z.; Wu, D.; Chen, T. Anti-disturbance fault-tolerant formation containment control for multiple autonomous underwater vehicles with actuator faults. Ocean Eng.; 2022; 266, 112924. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2022.112924]
35. Zhang, Z.; Lin, M.; Li, D. A double-loop control framework for AUV trajectory tracking under model parameters uncertainties and time-varying currents. Ocean Eng.; 2022; 265, 112566. [DOI: https://dx.doi.org/10.1016/j.oceaneng.2022.112566]
36. Chen, C.W.; Lu, Y.F. Computational fluid dynamics study of water entry impact forces of an airborne-launched, axisymmetric, disk-type Autonomous underwater hovering vehicle. Symmetry; 2019; 11, 1100. [DOI: https://dx.doi.org/10.3390/sym11091100]
37. Cui, R.; Chen, L.; Yang, C.; Chen, M. Extended state observer-based integral sliding mode control for an underwater robot with unknown disturbances and uncertain nonlinearities. IEEE Trans. Ind. Electron.; 2017; 64, pp. 6785-6795. [DOI: https://dx.doi.org/10.1109/TIE.2017.2694410]
38. Majeed, A.; Rauf, I. Graph Theory: A Comprehensive Survey about Graph Theory Applications in Computer Science and Social Networks. Inventions; 2020; 5, 10. [DOI: https://dx.doi.org/10.3390/inventions5010010]
39. Liu, J.; de la Peña, D.M.; Christofides, P.D. Distributed model predictive control of nonlinear systems subject to asynchronous and delayed measurements. Automatica; 2010; 46, pp. 52-61. [DOI: https://dx.doi.org/10.1016/j.automatica.2009.10.033]
40. Yan, Z.; Wang, M.; Xu, J. Integrated guidance and control strategy for homing of unmanned underwater vehicles. J. Frankl. Inst.-Eng. Appl. Math.; 2019; 356, pp. 3831-3848. [DOI: https://dx.doi.org/10.1016/j.jfranklin.2018.11.042]
41. Hu, Q.; Jiang, B. Continuous finite-time attitude control for rigid spacecraft based on angular velocity observer. IEEE Trans. Aerosp. Electron. Syst.; 2018; 54, pp. 1082-1092. [DOI: https://dx.doi.org/10.1109/TAES.2017.2773340]
42. Khalil, H.K. Nonlinear Systems; Prentice Hall Inc.: Upper Saddle River, NJ, USA, 2002.
You have requested "on-the-fly" machine translation of selected content from our databases. This functionality is provided solely for your convenience and is in no way intended to replace human translation. Show full disclaimer
Neither ProQuest nor its licensors make any representations or warranties with respect to the translations. The translations are automatically generated "AS IS" and "AS AVAILABLE" and are not retained in our systems. PROQUEST AND ITS LICENSORS SPECIFICALLY DISCLAIM ANY AND ALL EXPRESS OR IMPLIED WARRANTIES, INCLUDING WITHOUT LIMITATION, ANY WARRANTIES FOR AVAILABILITY, ACCURACY, TIMELINESS, COMPLETENESS, NON-INFRINGMENT, MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Your use of the translations is subject to all use restrictions contained in your Electronic Products License Agreement and by using the translation functionality you agree to forgo any and all claims against ProQuest or its licensors for your use of the translation functionality and any output derived there from. Hide full disclaimer
© 2024 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (https://creativecommons.org/licenses/by/4.0/). Notwithstanding the ProQuest Terms and Conditions, you may use this content in accordance with the terms of the License.
Abstract
This paper focuses on the formation tracking issue of autonomous underwater vehicles (AUVs) subject to multiple constraints in three-dimensional space. We developed a novel distributed Lyapunov-based model predictive controller (DLMPC) with a fast finite-time extended state observer (FFTESO). Initially, the external disturbances and internal uncertainties of each AUV were precisely compensated using the designed FFTESO. Subsequently, we proposed DLMPC-based position tracking and velocity tracking controllers, which solved an online optimization problem to determine optimal velocities and control forces. This hierarchical framework effectively managed system constraints, such as state constraints and actuator saturation. Additionally, the Lyapunov-based backstepping control law was applied to construct stability constraints in the distributed optimization problem, ensuring the recursive feasibility and closed-loop system stability of the proposed scheme. Sufficient conditions and attraction regions to ensure stability were explicitly provided. Finally, the simulation results demonstrated that the proposed method improved both the convergence speed and tracking accuracy by at least 30% compared to other methods.
You have requested "on-the-fly" machine translation of selected content from our databases. This functionality is provided solely for your convenience and is in no way intended to replace human translation. Show full disclaimer
Neither ProQuest nor its licensors make any representations or warranties with respect to the translations. The translations are automatically generated "AS IS" and "AS AVAILABLE" and are not retained in our systems. PROQUEST AND ITS LICENSORS SPECIFICALLY DISCLAIM ANY AND ALL EXPRESS OR IMPLIED WARRANTIES, INCLUDING WITHOUT LIMITATION, ANY WARRANTIES FOR AVAILABILITY, ACCURACY, TIMELINESS, COMPLETENESS, NON-INFRINGMENT, MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Your use of the translations is subject to all use restrictions contained in your Electronic Products License Agreement and by using the translation functionality you agree to forgo any and all claims against ProQuest or its licensors for your use of the translation functionality and any output derived there from. Hide full disclaimer