Multi-under-actuated AUV distributed anti-saturation sliding mode formation control method based on adaptive fixed time disturbance observer
Through the adaptive fixed-time interference observer and fixed-time integral sliding mode surface controller, the poor control performance problem of AUV formation under external interference and model uncertainty is solved, and efficient and robust formation trajectory tracking is achieved, avoiding Input saturation effect.
Patent Information
- Application Number
- CN202411099830.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-12
- Publication Date
- 2024-11-22
AI Technical Summary
The existing AUV formation control method has poor control performance and insufficient robustness when facing external interference and model parameter uncertainty, especially in the case of input saturation, and it is difficult to maintain stable and efficient performance.
The multi-underdrive AUV distributed anti-saturation sliding mode formation control method based on adaptive fixed-time interference observer is adopted. By designing an adaptive fixed-time interference observer and a fixed-time integral sliding mode surface controller, the lumped interference is estimated and reduced. Enhance the trajectory tracking capability of the formation and avoid the impact of input saturation.
Stable estimation of aggregate interference in fixed time improves the trajectory tracking accuracy and control performance of AUV formations, enhances the robustness of the system, and ensures the efficient performance of the controller under interference and input saturation conditions.
Smart Images

Figure CN119002528A_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the field of formation control of unmanned underwater vehicles, and in particular relates to a distributed anti-saturation sliding mode formation control method for multiple under-actuated AUVs based on an adaptive fixed-time interference observer. Background Art
[0002] As technology continues to advance, autonomous underwater vehicle (AUV) formation control has become an important force driving the frontier of marine science and technology. This research field has great potential in enhancing our understanding and exploration of the underwater world, and developing these formation control technologies is crucial. Multiple underactuated AUV systems have obvious advantages such as high flexibility, scalability and maintainability, and therefore have enhanced robustness in dealing with interference and failures, which are superior to single AUVs in all of the above aspects.
[0003] A key challenge in the trajectory tracking control of multiple underactuated AUV formations is the adverse effects of lumped disturbances (external disturbances and model parameter uncertainties) on the performance of the control system. External disturbances usually come from the dynamic ocean environment, including natural phenomena such as waves, tides, and ocean currents. The complexity of the ocean environment extends to changes in temperature, salinity, and depth, which can significantly change the hydrodynamic coefficients that affect the performance of AUVs. Such changes inevitably undermine the accuracy of the AUV model and exacerbate the uncertainty of the model parameters. To address these challenges, researchers have explored and improved sliding mode control in depth. Although sliding mode control is well known for its anti-disturbance properties, it sometimes comes at the expense of control performance, especially in terms of transient response and system efficiency. At the same time, researchers have combined sliding mode control algorithms with fixed-time theory and proposed a series of fixed-time formation controllers. So far, the application of this theoretical framework has been somewhat limited, mainly confined to the dynamics of multiple surface vessels.
[0004] Input saturation is also an important challenge that cannot be ignored in the trajectory tracking control process of multiple underactuated AUV formations. Input saturation is related to the inherent limitations of actuator inputs, which stems from physical limitations such as the limited ability of actuators to produce maximum force or torque. Actuator saturation occurs when the control algorithm requires inputs that exceed these limits. Excessive inputs requested by the controller, but cannot be achieved due to saturation, can lead to deviations from the expected trajectory, increased tracking errors, and may even cause system instability. Therefore, given that the control system needs to maintain stable and efficient performance in complex and changing environments, it is imperative to address the critical issue of input saturation.
[0005] In summary, due to the influence of external disturbances and model parameter uncertainty, as well as input saturation, the control performance of existing formation control methods is still poor, and the robustness of the control methods is poor. Therefore, it is very necessary to propose a new autonomous underwater vehicle formation control method. Summary of the invention
[0006] The purpose of the present invention is to solve the problems of poor control performance and poor robustness of existing formation control methods due to external interference, model parameter uncertainty and input saturation, and propose a distributed anti-saturation sliding mode formation control method for multiple under-actuated AUVs based on an adaptive fixed-time disturbance observer.
[0007] The technical solution adopted by the present invention to solve the above technical problems is: a distributed anti-saturation sliding mode formation control method for multiple under-actuated AUVs based on an adaptive fixed-time interference observer, the method specifically comprising the following steps:
[0008] Step 1: Establish the kinematic and dynamic model of the underactuated AUV formation considering external disturbances and model parameter uncertainties;
[0009] Step 2: Define a directed graph G = (V, ε, A) used to describe the communication topology relationship between multiple AUVs in the formation, where V represents a set of nodes, each node represents an AUV in the formation, ε represents the set of edges between nodes, and A represents the adjacency matrix;
[0010] Step 3: Design an adaptive fixed-time interference observer and use the designed interference observer to estimate the aggregate interference;
[0011] Step 4: Define the position tracking error of each AUV according to the communication relationship between the formation AUVs in the directed graph, and design an outer loop fixed time integral sliding surface controller based on the position tracking error of each AUV;
[0012] Step 5: Design an inner-loop fixed-time integral sliding surface controller based on the outer-loop fixed-time integral sliding surface controller, and use the designed inner-loop fixed-time integral sliding surface controller to control the AUV formation.
[0013] The beneficial effects of the present invention are:
[0014] The adaptive fixed-time disturbance observer designed in the present invention can stabilize the estimation error of the lumped disturbance in the vicinity of zero within a fixed time. The adaptive fixed-time disturbance observer is used to enhance the formation trajectory tracking capability of multiple underactuated AUVs, avoiding the influence of external disturbances and model parameter uncertainty. The anti-saturation distributed fixed-time sliding mode control scheme based on the fixed-time dynamic auxiliary system is designed to ensure the performance of the controller under disturbance and input saturation conditions, reduce the influence of input saturation, thereby achieving precise and efficient control and ensuring control performance.
[0015] Adaptive parameter design is used to estimate the upper limit of aggregate interference, so there is no need to know the upper limit of aggregate interference, which improves the robustness of the system and enhances the convergence performance of the formation. BRIEF DESCRIPTION OF THE DRAWINGS
[0016] Figure 1 Schematic diagram of the fixed coordinate system and the moving coordinate system of the AUV;
[0017] Figure 2 This is the overall framework diagram of the controller;
[0018] Figure 3 This is the communication topology diagram of multiple underactuated AUV formations;
[0019] Figure 4 This is a comparison chart of the estimation performance of the adaptive fixed-time disturbance observer (AFDO), disturbance observer (DO) and extended state observer (ESO) for lumped disturbances, taking AUV1 as an example;
[0020] Figure 5 This is a curve diagram of the trajectory tracking results of multiple under-actuated AUV formations;
[0021] Figure 6 It is a position state curve diagram of a multi-underactuated AUV formation;
[0022] Figure 7 It is the attitude state curve diagram of multiple under-actuated AUV formation;
[0023] Figure 8 It is a velocity state curve diagram of a multi-underactuated AUV formation;
[0024] Fig. 9 Control input curve diagram for multiple underactuated AUV formations. DETAILED DESCRIPTION
[0025] Specific implementation method 1: Combination Figure 2 This embodiment describes a distributed anti-saturation sliding mode formation control method for multiple under-actuated AUVs based on an adaptive fixed-time interference observer, and the method specifically includes the following steps:
[0026] Step 1: Establish the kinematic and dynamic model of the underactuated AUV formation considering external disturbances and model parameter uncertainties;
[0027] Step 2: Define a directed graph G = (V, ε, A) used to describe the communication topology relationship between multiple AUVs in the formation, where V represents a set of nodes, each node represents an AUV in the formation, ε represents the set of edges between nodes, and A represents the adjacency matrix;
[0028] Each AUV in the formation is regarded as a follower of the virtual leader, and the information relationship between the followers is jointly depicted by V, ε, and A. If there is an edge (i, j) ∈ ε, it means that the i-th AUV can obtain the motion state information of the j-th AUV, where the j-th AUV is called the neighbor of the i-th AUV, and a ij =1, if it does not exist, then a ij = 0. Set N i ={j|a ij =1} represents the neighboring set of the i-th AUV. Equation L = DA = [l ij ] N×N The Laplace matrix L of the graph is defined, where D = diag{d1,d2,Λ,d N} is the degree matrix, represents the degree of the i-th AUV. The virtual leader and follower are named 0 and 1, 2, Λ, N respectively. In addition, the matrix A0 = diag{a i0} shows whether the followers and the virtual leader exchange information. If a i0 =1, it means that the i-th AUV can obtain the communication information of the virtual leader; otherwise, a i0 =0;
[0029] Step 3: Design an adaptive fixed-time interference observer (AFDO) and use the designed interference observer to estimate the aggregate interference;
[0030] Step 4: Define the position tracking error of each AUV according to the communication relationship between the formation AUVs in the directed graph, and design an outer loop fixed time integral sliding surface controller based on the position tracking error of each AUV;
[0031] Step 5: Design an inner-loop fixed-time integral sliding surface controller based on the outer-loop fixed-time integral sliding surface controller, and use the designed inner-loop fixed-time integral sliding surface controller to control the AUV formation.
[0032] Specific implementation method 2: This implementation method is different from the specific implementation method 1 in that the specific process of step 1 is as follows:
[0033] Since the roll motion of AUV is self-stable and has a small amplitude, the effect of roll motion on the three-dimensional navigation motion of AUV can be ignored, and the 6-DOF AUV model can be approximated as a 5-DOF model. The kinematic and dynamic models of underactuated AUV formation are expressed as follows:
[0034]
[0035] Where i represents the i-th AUV, i = 1, 2, K, N, and N is the total number of AUVs in the formation. is η i The first derivative of i =[x i ,y i ,z i ,θ i ,ψ i ] T represents the position state vector of the i-th AUV, x i represents the x-axis coordinate of the i-th AUV in the motion coordinate system, y i represents the y-axis coordinate of the i-th AUV in the motion coordinate system, z i represents the z-axis coordinate of the i-th AUV in the motion coordinate system, ψ i is the heading angle of the i-th AUV, θ i is the longitudinal inclination angle of the i-th AUV, the superscript T represents transposition, J(η i ) represents the transformation matrix from the moving coordinate system to the fixed coordinate system, τ i =[τ ui ,0,0,τ qi ,τ ri ] T and τ di =[τ du ,0,0,τ dq ,τ dr ] T denote the control input and external environment disturbance of the i-th AUV, τ ui represents the longitudinal thrust of the ith AUV, τ qi represents the pitch moment of the ith AUV, τ ri represents the yaw moment of the i-th AUV, τ du represents the external disturbance in the longitudinal velocity direction, τ dq represents the external disturbance in the pitch direction, τ dr Indicates external disturbance in the heading direction. yes The first derivative of represents the velocity state vector of the ith AUV, u i is the longitudinal velocity of the ith AUV, v iis the lateral velocity of the ith AUV, w i is the vertical velocity of the ith AUV, q i is the pitch angular velocity of the ith AUV, r i is the yaw angular velocity of the i-th AUV, M i is the inertia matrix of the ith AUV, is the Coriolis force and centripetal force matrix of the ith AUV, is the hydrodynamic damping matrix of the ith AUV, g(η i ) represents the static moment and dynamic moment matrix of the i-th AUV;
[0036] Considering that the AUV will be disturbed by external environmental factors such as waves during its movement, the impact of environmental disturbances on the hydrodynamic coefficients and AUV model parameters must be considered, which leads to the uncertainty of the model parameters.
[0037]
[0038] Among them, M ai , and are all nominal matrices, ΔM i , All are uncertain items;
[0039] The kinematic and dynamic model of underactuated AUV formation is rewritten as:
[0040]
[0041] Among them, the superscript -1 represents the inverse of the matrix, τ li represents the aggregate interference of the i-th AUV:
[0042]
[0043] The other steps and parameters are the same as those in the first embodiment.
[0044] like Figure 1 As shown, the fixed coordinate system E-ξηζ in the present invention is defined as:
[0045] The sea level or a certain point in the nautical mile is taken as the origin of the fixed coordinate system, and ξ, η, and ζ are the three coordinate axes in the fixed coordinate system. The coordinate of the ξ axis represents the north position of the AUV, the coordinate of the η axis represents the east position of the AUV, the coordinate of the ζ axis represents the longitudinal position of the AUV, ψ is the heading angle, θ is the longitudinal inclination angle, and φ is the heel angle.
[0046] The motion coordinate system O-xyz is defined as:
[0047] The center of gravity O of the AUV is taken as the origin of the motion coordinate system, x, y, and z are the three coordinate axes in the motion coordinate system, the positive direction of the x-axis is the direction from the origin O to the bow of the AUV, the positive direction of the y-axis is the direction from the origin O to the starboard side of the AUV, the positive direction of the z-axis is the vertical downward direction of the AUV, u is the longitudinal velocity, v is the lateral velocity, w is the vertical velocity, p is the roll angular velocity, q is the pitch angular velocity, and r is the bow angular velocity.
[0048] Specific implementation method three: This implementation method is different from specific implementation method one or two in that the transformation matrix J (η i )for:
[0049]
[0050] in,
[0051] The other steps and parameters are the same as those in the first or second embodiment.
[0052] Matrix M i , and g(η i ) are:
[0053]
[0054]
[0055] Among them, m ii represents the sum of the inertia term and the additional mass term, d ii represents the linear fluid dynamic parameters, represents the gravity of the AUV, It indicates that the steady center of the AUV is high.
[0056] Specific implementation method 4: This implementation method is different from any one of the specific implementation methods 1 to 3 in that the specific process of step 3 is as follows:
[0057] Introduce auxiliary variable E i :
[0058]
[0059] Among them, i is an intermediate variable;
[0060]
[0061] in, Yes i The first derivative of 1i >0,λ 2i >0,0<α<1,β>1, Indicates Ei α to the power of Indicates E i β power, k i Represents τ li The upper limit value of Indicates k i An estimated value of
[0062] Updated according to the following adaptive rule:
[0063]
[0064] in, yes The first derivative of express α to the power of express β to the power of , ||·|| represents the norm, μ>0.
[0065] The other steps and parameters are the same as those in Specific Embodiments 1 to 3.
[0066] The disturbance observer designed by the present invention can reduce the observation error to the maximum extent and ensure that the error can converge to zero within a fixed time.
[0067] Specific implementation method 5: This implementation method is different from any one of the specific implementation methods 1 to 4 in that, in step 4, the position tracking error of each AUV is defined according to the communication relationship between the formation AUVs in the directed graph, specifically:
[0068]
[0069] Among them, e iη is the position tracking error of the ith AUV, N i represents the neighboring set of the i-th AUV, r ij Represents the i-th AUV relative to the set N i The expected position of the jth AUV in i represents the expected relative position of the ith AUV relative to the formation reference point. When the ith AUV exchanges information with the virtual leader, a i0 =1, otherwise a i0 =0,η j represents the position state vector of the jth AUV, η d is the expected trajectory, η d =[x d ,y d ,z d ,θ d ,ψ d ] T , the expected pitch angle is The expected yaw angle is x d represents the expected coordinate of the AUV in the x-axis direction of the motion coordinate system, y d represents the expected coordinate of the AUV in the y-axis direction of the motion coordinate system, z d represents the expected coordinate of the AUV in the z-axis direction of the motion coordinate system, is x d The first derivative of Yes d The first derivative of Yes d The first derivative of .
[0070] The other steps and parameters are the same as those in Specific Embodiments 1 to 4.
[0071] Specific implementation method 6: This implementation method is different from any one of the specific implementation methods 1 to 5 in that the outer loop fixed time integral sliding surface controller is designed in combination with the position tracking error of each AUV, specifically:
[0072] Step 41. Design the outer ring fixed time integral sliding surface s iη for:
[0073]
[0074] Among them, c1>0, b1>0, b2>0, sig α (x) = sign(x) | x α , sign(x) is a sign function, S η is an intermediate variable, YesS η The first derivative of ;
[0075] The outer loop fixed time integral sliding mode surface s iη The derivative is:
[0076]
[0077] Among them, a id =d i +a i0 , d i represents the degree of the i-th AUV, is η d The first derivative of ;
[0078] Step 4.2: Design the outer loop fixed time integral sliding surface controller v of the i-th AUV i0 for:
[0079]
[0080] Among them, ρ1>0, ρ2>0.
[0081] The other steps and parameters are the same as those in Specific Implementations 1 to 5.
[0082] Specific implementation method 7: This implementation method is different from the specific implementation methods 1 to 6 in that the specific process of step 5 is as follows:
[0083] Step 51: Define the fixed-time dynamic auxiliary system χ i for:
[0084]
[0085] in, is x i The first derivative of, intermediate variable τ i0 The control force output by the designed inner loop fixed time integral sliding surface controller is, δ is a known constant, and the auxiliary state χ i Generated by the auxiliary dynamic system, b3>0, b4>0, where h i is a matrix The i-th row of
[0086] Step 52: Define the speed tracking error e of the i-th AUV iv for:
[0087] e iv =v i -v i0 -x i
[0088] Step 5.3: Design the inner loop fixed time integral sliding surface s of the i-th AUV iv for:
[0089]
[0090] Among them, c2>0, b5>0, b6>0, S v is an intermediate variable, YesS v The first derivative of ;
[0091] The fixed time integral sliding surface s of the inner loop iv The derivative is:
[0092]
[0093] Step 54: Design the inner loop fixed time integral sliding surface controller τ of the i-th AUV based on the inner loop fixed time integral sliding surface i0 :
[0094]
[0095] Among them, ρ3>0, ρ4>0;
[0096] The output of the controller is used as the control input of the i-th AUV (the control force output by the controller is used as the input of the kinematic and dynamic models, that is, the control force output by the controller is substituted into the τ in the kinematic and dynamic models). i ) to realize the control of the AUV formation.
[0097] The other steps and parameters are the same as those in Specific Embodiments 1 to 6.
[0098] In this implementation, the fixed-time dynamic auxiliary system is designed to avoid the influence of input saturation and improve the control performance.
[0099] Example
[0100] This embodiment proposes a distributed anti-saturation sliding mode formation control method for multiple under-actuated AUVs based on an adaptive fixed-time interference observer, specifically:
[0101] like Figure 1 As shown, first the fixed coordinate system E-ξηζ is defined as:
[0102] The sea level or a certain point in the nautical mile is taken as the origin of the fixed coordinate system, and ξ, η, and ζ are the three coordinate axes in the fixed coordinate system. The coordinate of the ξ axis represents the north position of the AUV, the coordinate of the η axis represents the east position of the AUV, the coordinate of the ζ axis represents the longitudinal position of the AUV, ψ is the heading angle, θ is the longitudinal inclination angle, and φ is the heel angle.
[0103] The motion coordinate system O-xyz is defined as:
[0104] The center of gravity O of the AUV is taken as the origin of the motion coordinate system, x, y, and z are the three coordinate axes in the motion coordinate system, the positive direction of the x-axis is the direction from the origin O to the bow of the AUV, the positive direction of the y-axis is the direction from the origin O to the starboard side of the AUV, the positive direction of the z-axis is the vertical downward direction of the AUV, u is the longitudinal velocity, v is the lateral velocity, w is the vertical velocity, p is the roll angular velocity, q is the pitch angular velocity, and r is the bow angular velocity.
[0105] Step 1: Since the roll motion of AUV is self-stable and has a small amplitude, the effect of roll motion on the three-dimensional navigation motion of AUV is ignored, and the 6-DOF AUV model can be approximated as a 5-DOF model. The kinematic and dynamic model of the underactuated AUV formation considering external interference and model parameter uncertainty is expressed as:
[0106]
[0107] Where i represents the i-th AUV, i = 1, 2, K, N, and N is the total number of AUVs in the formation. is η i The first derivative of i =[x i ,y i ,z i ,θ i ,ψ i ] T represents the position state vector of the i-th AUV, x i represents the x-axis coordinate of the i-th AUV in the motion coordinate system, y i represents the y-axis coordinate of the i-th AUV in the motion coordinate system, z i represents the z-axis coordinate of the i-th AUV in the motion coordinate system, ψ i is the heading angle of the i-th AUV, θ i is the longitudinal inclination angle of the i-th AUV, the superscript T represents transposition, J(η i ) represents the transformation matrix from the moving coordinate system to the fixed coordinate system, τ i =[τ ui ,0,0,τ qi ,τ ri ] T and τ di =[τ du ,0,0,τ dq ,τ dr ] T denote the control input and external environment disturbance of the i-th AUV, τ ui represents the longitudinal thrust of the ith AUV, τ qi represents the pitch moment of the ith AUV, τ ri represents the yaw moment of the i-th AUV, τ du represents the external disturbance in the longitudinal velocity direction, τ dq represents the external disturbance in the pitch direction, τ dr Indicates external disturbance in the heading direction. yes The first derivative of represents the velocity state vector of the ith AUV, u i is the longitudinal velocity of the ith AUV, v i is the lateral velocity of the ith AUV, w i is the vertical velocity of the ith AUV, q i is the pitch angular velocity of the ith AUV, r i is the yaw angular velocity of the i-th AUV, M i is the inertia matrix of the ith AUV, is the Coriolis force and centripetal force matrix of the ith AUV, is the hydrodynamic damping matrix of the ith AUV, g(η i ) represents the static moment and dynamic moment matrix of the i-th AUV;
[0108] Considering that the AUV will be disturbed by external environmental factors such as waves during its movement, the impact of environmental disturbances on the hydrodynamic coefficients and AUV model parameters must be considered, which leads to the uncertainty of the model parameters.
[0109]
[0110] Among them, M ai , and are all nominal matrices, ΔM i , All are uncertain items;
[0111] The kinematic and dynamic model of underactuated AUV formation is rewritten as:
[0112]
[0113] Among them, the superscript -1 represents the inverse of the matrix, τ li represents the aggregate interference of the i-th AUV:
[0114]
[0115] The correlation matrix is further explained as follows:
[0116]
[0117] in,
[0118]
[0119] Among them, m ii represents the sum of the inertia term and the additional mass term, d ii represents the linear fluid dynamic parameters, represents the gravity of the AUV, It indicates that the steady center of the AUV is high.
[0120] Step 2: Treat each AUV in the formation as a follower of the virtual leader, and define a directed graph G = (V, ε, A) to describe the communication topology relationship between multiple AUVs in the formation. V, ε and A are used to jointly describe the information relationship between followers.
[0121] If there is an edge (i, j)∈ε, it means that the i-th AUV can obtain the motion state information of the j-th AUV, where the j-th AUV is called the neighbor of the i-th AUV. ij =1, if it does not exist, then a ij = 0. Set N i ={j|a ij =1} represents the neighboring set of the i-th AUV. Equation L = DA = [l ij ] N×N The Laplace matrix L of the graph is defined, where D = diag{d1,d2,Λ,d N} is the degree matrix, represents the degree of the i-th AUV. The virtual leader and follower are named 0 and 1, 2, Λ, N respectively. In addition, the matrix A0 = diag{a i0} shows whether the followers and the virtual leader exchange information. If a i0 =1, it means that the i-th AUV can obtain the communication information of the virtual leader; otherwise, a i0 =0.
[0122] Step 3: Design an adaptive fixed-time interference observer (AFDO). Using the designed interference observer to estimate the aggregate interference can minimize the observation error and ensure that the error can converge to zero within a fixed time.
[0123] The specific process of designing a disturbance observer is as follows:
[0124] Introduce auxiliary variable E i :
[0125]
[0126] Among them, i is an intermediate variable;
[0127]
[0128] in, Yes i The first derivative of 1i >0,λ 2i >0,0<α<1,β>1, Indicates E i α to the power of Indicates E i β power, k i Represents τ li The upper limit value of Indicates k i An estimated value of
[0129] Updated according to the following adaptive rule:
[0130]
[0131] in, yes The first derivative of express α to the power of express β to the power of , ||·|| represents the norm, μ>0.
[0132] Step 4: Define the position tracking error of each AUV based on the communication relationship between the formation AUVs in the directed graph:
[0133]
[0134] Among them, e iη is the position tracking error of the ith AUV, N i represents the neighboring set of the i-th AUV, r ij Represents the i-th AUV relative to the set N i The expected position of the jth AUV in i represents the expected relative position of the ith AUV relative to the formation reference point. When the ith AUV exchanges information with the virtual leader, a i0 =1, otherwise a i0 =0,η j represents the position state vector of the jth AUV, η d is the expected trajectory, η d =[x d ,y d ,z d ,θ d ,ψ d ] T , the expected pitch angle is The expected yaw angle is x d represents the expected coordinate of the AUV in the x-axis direction of the motion coordinate system, y d represents the expected coordinate of the AUV in the y-axis direction of the motion coordinate system, z d represents the expected coordinate of the AUV in the z-axis direction of the motion coordinate system, is x d The first derivative of Yes d The first derivative of Yes d The first derivative of ;
[0135] Combined with the position tracking error of each AUV, the outer loop fixed time integral sliding surface controller is designed. The specific process is as follows:
[0136] Step 41. Design the outer ring fixed time integral sliding surface s iη for:
[0137]
[0138] Among them, c1>0, b1>0, b2>0, sig α (x) = sign(x) | x α , sign(x) is a sign function, S η is an intermediate variable, YesS η The first derivative of ;
[0139] The outer loop fixed time integral sliding mode surface s iη The derivative is:
[0140]
[0141] Among them, a id =d i +a i0 , d i represents the degree of the i-th AUV, is η d The first derivative of ;
[0142] Step 4.2: Design the outer loop fixed time integral sliding surface controller v of the i-th AUV i0 for:
[0143]
[0144] Among them, ρ1>0, ρ2>0.
[0145] Step 5: Design an inner-loop fixed-time integral sliding surface controller based on the outer-loop fixed-time integral sliding surface controller, and use the designed inner-loop fixed-time integral sliding surface controller to control the AUV formation. The design process of the inner-loop fixed-time integral sliding surface controller is as follows:
[0146] Step 51: Define the fixed-time dynamic auxiliary system χ i for:
[0147]
[0148] in, is x i The first derivative of, intermediate variable τ i0 The control force output by the designed inner loop fixed time integral sliding surface controller is, δ is a known constant, and the auxiliary state χ iGenerated by the auxiliary dynamic system, b3>0, b4>0, where h i is a matrix The i-th row of
[0149] Step 52: Define the speed tracking error e of the i-th AUV iv for:
[0150] e iv =v i -v i0 -x i
[0151] Step 5.3: Design the inner loop fixed time integral sliding surface s of the i-th AUV iv for:
[0152]
[0153] Among them, c2>0, b5>0, b6>0, S v is an intermediate variable, YesS v The first derivative of ;
[0154] The fixed time integral sliding surface s of the inner loop iv The derivative is:
[0155]
[0156] Step 54: Design the inner loop fixed time integral sliding surface controller τ of the i-th AUV based on the inner loop fixed time integral sliding surface i0 :
[0157]
[0158] Among them, ρ3>0, ρ4>0.
[0159] Experimental Section
[0160] The following numerical simulation experiments are given to verify the effectiveness of the formation controller of the present invention. In the present invention, a formation system consisting of five underactuated AUVs is studied, and underactuated AUVs with the same physical model structure are selected for the simulation experiment.
[0161] In the numerical simulation experiment, it is assumed that the physical parameters of the AUV have a 10% uncertainty margin to take into account the possible errors in practical applications. The interference is a combination of sine and cosine functions with different amplitudes and frequencies. Therefore, the lumped interference is selected as:
[0162]
[0163] The communication topology between AUVs is as follows: Figure 3 In the figure, 0 represents the virtual leader, and 1-5 represent the five underactuated AUVs. The expected positions between the five underactuated AUVs and the virtual leader are r1 = [0, 0, 0, 0, 0] T , r2=[0,5,0,0,0] T , r3=[-5,0,0,0,0] T , r4=[0,-5,0,0,0] T and r5 = [5,0,0,0,0] T The initial velocity of each AUV is v i (0) = [0,0,0,0,0] T .
[0164] In order to present the simulation results more clearly and understandably, the present invention selects AUV1 as a representative AUV for comparing the estimation performance of various observers. Figure 4 The simulation results of the estimation performance comparison between AFDO, DO and ESO are shown. As can be seen from the figure, the estimation of interference by AFDO, DO and ESO can converge quickly in a short time. Among them, AFDO can quickly identify the aggregated interference. As can be seen from the enlarged part of the figure, compared with DO and ESO, AFDO converges faster and has the smallest estimation error, which verifies the effectiveness of AFDO.
[0165] like Figures 5 to 9 As shown in Figure 3, the performance of the multi-underactuated AUV formation controller is verified by simulation results.
[0166] Figures 5 to 7 The tracking trajectory, position state and attitude state of the multi-underactuated AUV formation are described respectively. Figure 5 The AUV formation trajectory is shown, and the AUVs in the formation follow their respective ideal formation tracking trajectories. Figure 6 As shown in the figure, all AUVs successfully tracked the virtual leader, and the distance maintained with the virtual leader met the specified formation parameters. In addition, all AUVs in the formation converged to the ideal formation position within 10 seconds, and all AUVs in the formation were able to converge to the desired formation position within 50 seconds, and the pitch and yaw angles also converged to a unified value. Therefore, even in the presence of lumped interference, once these interferences are reduced by applying AFDO, the AUV position tracking signal can achieve global fixed-time convergence.
[0167] Figure 8 The velocity state of the multi-underactuated AUV formation is shown. As can be seen from the figure, the longitudinal velocity of each AUV in the formation converges to 0.37m / s within 25 seconds, the pitch angular velocity converges to 0rad / s within 45 seconds, and the bow angular velocity converges to 0rad / s within 40 seconds.
[0168] Fig. 9 The control inputs of the multi-underactuated AUV formation system are shown. As can be seen from the figure, the longitudinal thrust of each AUV in the formation converges to 40N within 25 seconds, the pitch torque converges to 20N.m within 40 seconds, and the yaw torque converges to 0N.m within 40 seconds, all of which converge within the fixed time. In addition, the control inputs are all within the acceptable saturation range without any oscillation, which reflects the effectiveness of the fixed-time auxiliary dynamic system and AFDO.
[0169] Likewise, if Figures 6 to 9 As shown in the figure, although the initial state of each AUV in the formation is different, the convergence speed of the curves in the figure tends to be consistent, indicating that the designed controller has fixed-time convergence.
[0170] The above calculation examples of the present invention are only used to explain the calculation model and calculation process of the present invention in detail, and are not intended to limit the implementation methods of the present invention. For ordinary technicians in the relevant field, other different forms of changes or modifications can be made based on the above description. It is impossible to list all the implementation methods here. All obvious changes or modifications derived from the technical solution of the present invention are still within the scope of protection of the present invention.
Claims
1. A distributed anti-saturation sliding mode formation control method for multiple underactuated AUVs based on an adaptive fixed-time disturbance observer, characterized in that: The method specifically comprises the following steps: Step 1: Establish the kinematic and dynamic model of the underactuated AUV formation considering external disturbances and model parameter uncertainties; Step 2: Define a directed graph G = (V, ε, A) used to describe the communication topology relationship between multiple AUVs in the formation, where V represents a set of nodes, each node represents an AUV in the formation, ε represents the set of edges between nodes, and A represents the adjacency matrix; Step 3: Design an adaptive fixed-time interference observer and use the designed interference observer to estimate the aggregate interference; Step 4: Define the position tracking error of each AUV according to the communication relationship between the formation AUVs in the directed graph, and design an outer loop fixed time integral sliding surface controller based on the position tracking error of each AUV; Step 5: Design an inner-loop fixed-time integral sliding surface controller based on the outer-loop fixed-time integral sliding surface controller, and use the designed inner-loop fixed-time integral sliding surface controller to control the AUV formation.
2. According to claim 1, a distributed anti-saturation sliding mode formation control method for multiple underactuated AUVs based on an adaptive fixed-time interference observer is characterized in that: The specific process of step one is: Where i represents the i-th AUV, i = 1, 2, K, N, and N is the total number of AUVs in the formation. is η i The first derivative of i =[x i ,y i ,z i ,θ i ,ψ i ] T represents the position state vector of the i-th AUV, x i represents the x-axis coordinate of the i-th AUV in the motion coordinate system, y i represents the y-axis coordinate of the i-th AUV in the motion coordinate system, z i represents the z-axis coordinate of the i-th AUV in the motion coordinate system, ψ i is the heading angle of the i-th AUV, θ i is the longitudinal inclination angle of the i-th AUV, the superscript T represents transposition, J(η i ) represents the transformation matrix from the moving coordinate system to the fixed coordinate system, τ i =[τ ui ,0,0,τ qi ,τ ri ] T and τ di =[τ du ,0,0,τ dq ,τ dr ] T denote the control input and external environment disturbance of the i-th AUV, τ ui represents the longitudinal thrust of the ith AUV, τ qi represents the pitch moment of the ith AUV, τ ri represents the yaw moment of the i-th AUV, τ du represents the external disturbance in the longitudinal velocity direction, τ dq represents the external disturbance in the pitch direction, τ dr Indicates external disturbance in the heading direction. yes The first derivative of represents the velocity state vector of the ith AUV, u i is the longitudinal velocity of the ith AUV, v i is the lateral velocity of the ith AUV, w i is the vertical velocity of the ith AUV, q i is the pitch angular velocity of the ith AUV, r i is the yaw angular velocity of the i-th AUV, M i is the inertia matrix of the ith AUV, is the Coriolis force and centripetal force matrix of the ith AUV, is the hydrodynamic damping matrix of the ith AUV, g(η i ) represents the static moment and dynamic moment matrix of the i-th AUV; Among them, M ai , and are all nominal matrices, ΔM i , All are uncertain items; The kinematic and dynamic model of underactuated AUV formation is rewritten as: Among them, the superscript -1 represents the inverse of the matrix, τ li represents the aggregate interference of the i-th AUV:
3. The method for distributed anti-saturation sliding mode formation control of multiple underactuated AUVs based on adaptive fixed-time interference observer according to claim 2 is characterized in that: The transformation matrix J(η i )for: in, 4. The method for distributed anti-saturation sliding mode formation control of multiple underactuated AUVs based on adaptive fixed-time disturbance observer according to claim 2 is characterized in that: The specific process of step three is: Introduce auxiliary variable E i : Among them, i is an intermediate variable; in, Yes i The first derivative of 1i >0,λ 2i >0,0<α<1,β>1, Indicates E i α to the power of Indicates E i β power, k i Represents τ li The upper limit value of Indicates k i An estimated value of in, yes The first derivative of express α to the power of express β to the power of , ||·|| represents the norm, μ>
0.
5. The method for distributed anti-saturation sliding mode formation control of multiple underactuated AUVs based on adaptive fixed-time disturbance observer according to claim 4 is characterized in that: In step 4, the position tracking error of each AUV is defined according to the communication relationship between the formation AUVs in the directed graph, specifically: Among them, e iη is the position tracking error of the ith AUV, N i represents the neighboring set of the i-th AUV, r ij Represents the i-th AUV relative to the set N i The expected position of the jth AUV in i represents the expected relative position of the ith AUV relative to the formation reference point. When the ith AUV exchanges information with the virtual leader, a i0 =1, otherwise a i0 =0,η j represents the position state vector of the jth AUV, η d is the expected trajectory, η d =[x d ,y d ,z d ,θ d ,ψ d ] T , the expected pitch angle is The expected yaw angle is x d represents the expected coordinate of the AUV in the x-axis direction of the motion coordinate system, y d represents the expected coordinate of the AUV in the y-axis direction of the motion coordinate system, z d represents the expected coordinate of the AUV in the z-axis direction of the motion coordinate system, is x d The first derivative of Yes d The first derivative of Yes d The first derivative of .
6. The method for distributed anti-saturation sliding mode formation control of multiple underactuated AUVs based on adaptive fixed-time disturbance observer according to claim 5 is characterized in that: The outer loop fixed time integral sliding surface controller is designed in combination with the position tracking error of each AUV, specifically: Step 41. Design the outer ring fixed time integral sliding surface s iη for: Among them, c1>0, b1>0, b2>0, sig α (x) = sign(x) | x α , sign(x) is a sign function, S η is an intermediate variable, YesS η The first derivative of ; The outer loop fixed time integral sliding mode surface s iη The derivative is: Among them, a id =d i +a i0 , d i represents the degree of the i-th AUV, is η d The first derivative of ; Step 4.2: Design the outer loop fixed time integral sliding surface controller v of the i-th AUV i0 for: Among them, ρ1>0, ρ2>0.
7. The method for distributed anti-saturation sliding mode formation control of multiple underactuated AUVs based on adaptive fixed-time disturbance observer according to claim 6 is characterized in that: The specific process of step five is as follows: Step 51: Define the fixed-time dynamic auxiliary system χ i for: in, is x i The first derivative of, intermediate variable τ i0 The control force output by the designed inner loop fixed time integral sliding surface controller is, δ is a known constant, b3>0, b4>0, where h i is a matrix The i-th row of Step 52: Define the speed tracking error e of the i-th AUV iv for: yes iv =v i -v i0 -χ i Step 5.3: Design the inner loop fixed time integral sliding surface s of the i-th AUV iv for: Among them, c2>0, b5>0, b6>0, S v is an intermediate variable, YesS v The first derivative of ; The fixed time integral sliding surface s of the inner loop iv The derivative is: Step 54: Design the inner loop fixed time integral sliding surface controller of the i-th AUV based on the inner loop fixed time integral sliding surface: Among them, ρ3>0, ρ4>0; The output of the controller is used as the control input of the i-th AUV to realize the control of the AUV formation.
Citation Information
Cited By
Underwater vehicle tracking control method with state constraint under input saturation
CN119536321A
Underactuated underwater vehicle three-dimensional robust formation control method based on super-spiral observer
CN121477948A
Intelligent unmanned vehicle formation reconstruction control method and device based on adaptive potential field
CN122219471A
