AUV (Autonomous Underwater Vehicle) preset time trajectory tracking control method considering performance constraint and interference influence

By introducing performance functions and adaptive lumped interference estimator in AUV trajectory tracking control, the convergence rate and steady-state performance of trajectory tracking errors are optimized, and the problem that AUV trajectory tracking control is difficult to complete within the expected time in the prior art is solved. , ensuring the safety and control accuracy of AUV.

CN119087812AActive Publication Date: 2024-12-06HARBIN ENG UNIV

Patent Information

Application Number
CN202411228092.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-03
Publication Date
2024-12-06
Estimated Expiration
2044-09-03

AI Technical Summary

Technical Problem

The existing AUV trajectory tracking control methods are difficult to accurately complete trajectory tracking within the expected time, and the convergence time is difficult to determine, which may lead to exceeding the expected time or excessive steady-state error, affecting the safety of AUV.

Method used

A preset time trajectory tracking control method for AUV considering performance constraints and interference effects is proposed. By establishing performance functions and adaptive lumped interference estimator, an adaptive attitude tracking controller is designed, and a unified arrangement of current perturbations and model uncertainties are carried out. The convergence rate and steady-state performance of trajectory tracking errors are optimized using preset time control technology.

Benefits of technology

The AUV trajectory tracking error converges to the preset steady-state error within the preset time, reducing the overshoot, ensuring that the trajectory tracking task is accurately completed within the expected time, and avoiding AUV security threats.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119087812A_ABST
    Figure CN119087812A_ABST
Patent Text Reader

Abstract

The invention discloses an AUV (Autonomous Underwater Vehicle) preset time trajectory tracking control method considering performance constraint and interference influence, and relates to the technical field of trajectory tracking control. The invention aims to solve the problem that an existing AUV trajectory tracking control method is difficult to accurately complete trajectory tracking within expected time. The method comprises the following steps: establishing an AUV kinematic model by using the six-degree-of-freedom position and attitude of the AUV under an inertial coordinate system; an AUV kinetic model is established in combination with the AUV kinematic model; establishing a performance function, and converting the trajectory tracking error by using the performance function and the AUV kinetic model to obtain a trajectory tracking error vector; designing an adaptive lumped interference estimator by using the trajectory tracking error vector; and designing a self-adaptive attitude tracking controller by using the trajectory tracking error vector and a self-adaptive lumped interference estimator. The method is used for AUV trajectory tracking control.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of trajectory tracking control, and in particular to an AUV preset time trajectory tracking control method considering performance constraints and interference effects. Background Art

[0002] The ocean occupies about 71% of the earth's surface and is the largest ecosystem on earth, containing abundant marine oil and natural gas resources. However, the development of marine resources faces many problems and challenges, such as the complex and changeable marine environment, and the existence of extremely harsh conditions such as high pressure and low temperature, which greatly increases the difficulty of human development of the ocean. As a special application of advanced robotics technology underwater, autonomous underwater vehicles (AUVs) play an important strategic role in marine resource exploration and marine environment monitoring. Many sophisticated underwater mission requirements also make the control accuracy and maneuverability of AUVs increasingly demanding. Among them, trajectory tracking is the most basic and primary mission goal of AUVs when performing tasks. In the process of AUV trajectory tracking, many problems will be encountered, such as external ocean current disturbances, AUV's own model uncertainty, etc., and sophisticated and complex underwater tasks require the AUV's trajectory tracking process to have higher control accuracy and faster response speed. Therefore, it is of great engineering significance to carry out research on AUV trajectory tracking control methods and design advanced controllers with better control accuracy and faster response speed under the influence of various external interferences.

[0003] At present, the trajectory tracking control of AUV includes methods such as neural network control and fuzzy control. The neural network control method has a strong approximation ability for unknown nonlinear systems, especially for research objects that are subject to external interference and have their own model uncertainty. Its weight matrix, central parameters, etc. can be continuously updated through the reinforcement learning process. The literature (Zhou JJ, Zhao XY, Chen T, et al. Trajectory Tracking Control of an Underactuated AUV Based on Backstepping Sliding Mode With State Prediction [J]. Ieee Access, 2019, 7: 181983-181993.) takes AUV as the research object, combines the radial basis function neural network method with the state prediction sliding mode control method, and uses the radial basis function neural network to estimate the external ocean current disturbance and its own model uncertainty, and combines the non-singular terminal sliding mode technology to complete the trajectory tracking control. The final simulation experiment verifies that the radial basis function neural network has excellent approximation performance for nonlinear external interference and has a good trajectory tracking effect. However, this control method lacks control over the system convergence time, and the system convergence time is difficult to determine and design. It is impossible to limit the transient performance of the control system, which may cause the convergence time to exceed the expected time. Therefore, the trajectory tracking method of AUV based on neural network control has the problem of difficulty in completing trajectory tracking within the expected time. Therefore, this method cannot be applied in situations where the convergence time is strictly required. Fuzzy control is often used in control systems that are difficult to model. This control method has the characteristics of fast response speed and strong anti-interference ability. The literature (Elhaki O, Shojaei K. Neural network-based target tracking control of underactuated autonomous underwater vehicles with a prescribed performance [J]. Ocean Engineering, 2018, 167 (NOV. 1): 239-256.) takes underactuated AUV as the research object, constructs the sliding mode term using the Sigmoid function, and designs the sliding mode controller using the backstepping method to solve the model uncertainty problem, and effectively reduces the chattering phenomenon generated during the convergence of the system error. Finally, the simulation experiment verifies that the controller has strong robustness in AUV trajectory tracking control.However, this method lacks optimization of the entire trajectory tracking convergence performance, such as reducing overshoot, shortening convergence time, and reducing steady-state error. This may result in excessive overshoot, which exceeds the acceptable range during the convergence process and cannot accurately complete the tracking task. In severe cases, it may threaten the safety of the AUV itself. Summary of the invention

[0004] The purpose of the present invention is to solve the problem that the existing AUV trajectory tracking control method is still difficult to accurately complete trajectory tracking within the expected time, and proposes an AUV preset time trajectory tracking control method taking into account performance constraints and interference effects.

[0005] A preset time trajectory tracking control method for AUV considering performance constraints and interference effects is specifically as follows:

[0006] Step 1: Establish the AUV kinematic model using the six-degree-of-freedom position and attitude of the AUV in the inertial coordinate system;

[0007] Step 2: Establish an AUV dynamic model by combining the AUV kinematic model obtained in step 1;

[0008] Step 3: Establish a performance function, use the performance function and the AUV dynamics model to convert the trajectory tracking error, and obtain the converted trajectory tracking error vector, specifically:

[0009] Step 31: Establish performance functions, specifically:

[0010] ρ(t)=(ρ0-ρ ∞ ) -kt +ρ ∞

[0011] ρ(t) satisfies the following conditions at the same time:

[0012] (1)ρ(t) is positive and strictly decreasing;

[0013] (2)

[0014] Among them, ρ0, k, ρ ∞ is a preset positive constant, t is time;

[0015] Step 32: Use the performance function ρ(t) and the AUV dynamics model established in step 31 to transform the trajectory tracking error and obtain the transformed trajectory tracking error vector;

[0016] Step 4: Use the trajectory tracking error vector obtained in step 3 to design an adaptive lumped interference estimator, specifically:

[0017]

[0018] Among them, k di is a constant, i∈[1,6], i is the degree of freedom label, ε i is the transformation error of the trajectory tracking of the ith degree of freedom, s i is the trajectory tracking error of the i-th degree of freedom;

[0019] Step 5: Design an adaptive attitude tracking controller using the trajectory tracking error vector obtained in step 3 and the adaptive lumped disturbance estimator obtained in step 4.

[0020] The beneficial effects of the present invention are:

[0021] The present invention first constrains the error by using the performance function in the preset performance control technology, and then obtains a new error variable by error conversion to simplify the subsequent derivation process, ensuring that when the new error preset performance converges, the error e is the preset performance convergence, and then performs a preset time control design on the new error and combines it with an adaptive lumped interference estimator to obtain the AUV preset time trajectory tracking controller u c , ensuring that the trajectory tracking error can achieve the desired effect. The present invention organizes the ocean current disturbance and model uncertainty into external lumped interference, uses an adaptive lumped interference estimator to estimate the external lumped interference, and introduces the preset time control technology to improve the convergence time limit, so that the trajectory tracking error of the AUV converges to the preset steady-state error within the preset time, thereby completing the trajectory tracking within the expected time, which is closer to the actual engineering needs. The present invention constrains the trajectory tracking error by introducing a preset performance method, ensuring the preset transient performance and convergence steady-state performance, and at the same time constrains the convergence rate of the trajectory tracking error in combination with the preset time control, further optimizing the trajectory tracking process from the time dimension, so that the steady-state error when the trajectory tracking error converges is within the preset range and reduces the overshoot, so that the overshoot is kept within an acceptable range during the convergence process, so that the AUV can accurately complete the trajectory tracking task within the expected time, avoiding the problem that the AUV safety will be threatened. BRIEF DESCRIPTION OF THE DRAWINGS

[0022] Figure 1 A schematic diagram of the coordinate system definition for the AUV;

[0023] Figure 2 This is the propulsion layout diagram of Xinghai Z3000 demersal AUV;

[0024] Figure 3(a) is a graph of the AUV trajectory tracking error in the sway direction;

[0025] Figure 3(b) is a graph of the AUV's trajectory tracking error in the sway direction;

[0026] Figure 3(c) is a graph of the AUV's trajectory tracking error in the vertical swing direction;

[0027] Figure 3(d) is a curve diagram of the AUV rolling direction trajectory tracking error;

[0028] Figure 3(e) is a graph of the AUV's pitch direction trajectory tracking error;

[0029] Figure 3(f) is a graph of the AUV bow-swing direction trajectory tracking error;

[0030] Figure 4 This is an enlarged view of the AUV six-degree-of-freedom trajectory tracking error curve;

[0031] Figure 5 is the output control torque curve of the AUV thruster;

[0032] Figure 6 is the output control force curve of the AUV thruster;

[0033] Figure 7 It is the trajectory curve of AUV in the longitudinal direction;

[0034] Figure 8 It is the trajectory curve of AUV in the longitudinal direction;

[0035] Fig. 9 It is the trajectory curve of AUV in the vertical swing direction;

[0036] Fig.10 It is the motion trajectory curve of AUV in three-dimensional space;

[0037] Fig.11 This is the external interference diagram. DETAILED DESCRIPTION

[0038] The coordinate system involved in the present invention is as follows Figure 1 As shown, it includes: inertial coordinate system (E-ξηζ), motion coordinate system (O-XYZ);

[0039] Inertial coordinate system (E-ξηζ): also known as "fixed coordinate system". The origin E can be selected at a certain point on the sea surface. The Eξ axis and the Eη axis are placed in the horizontal plane and are perpendicular to each other. The positive direction of the Eξ axis points to the due north. The Eζ axis is perpendicular to the Eξη plane and its positive direction points to the center of the earth.

[0040] Motion coordinate system (O-XYZ): The origin O is taken at the center of gravity of the AUV, and the X-axis, Y-axis and Z-axis are the intersection lines of the waterline, the cross section and the mid-longitudinal section passing through the origin respectively. The X-axis points to the longitudinal direction of the AUV and the bow direction is positive, the Y-axis points to the transverse direction of the AUV and the starboard side is positive, and the Z-axis points to the bottom of the AUV and is positive downward. Next, the present invention is explained in conjunction with specific embodiments.

[0041] Specific implementation method 1: In this implementation method, a preset time trajectory tracking control method of an AUV considering performance constraints and interference effects is specifically performed as follows:

[0042] Step 1: Use the six-degree-of-freedom position and attitude of the AUV in the inertial coordinate system to establish the AUV kinematic model:

[0043] First, define the linear velocity transfer matrix J1(η a ) and the angular velocity transfer matrix J2(η a ):

[0044]

[0045]

[0046] in, is the six-degree-of-freedom position and attitude of the AUV in the inertial coordinate system, x is the linear displacement of the AUV in the longitudinal direction in the inertial coordinate system, y is the linear displacement of the AUV in the transverse direction in the inertial coordinate system, and z is the linear displacement of the AUV in the vertical direction in the inertial coordinate system. is the angular displacement of the AUV in the roll direction in the inertial coordinate system, θ is the angular displacement of the AUV in the pitch direction in the inertial coordinate system, and ψ is the angular displacement of the AUV in the bow direction in the inertial coordinate system;

[0047] Then, using the linear velocity transfer matrix J1(η a ) and the angular velocity transfer matrix J2(η a ) Establish AUV kinematic model:

[0048]

[0049] Among them, J(η a ) is the transformation matrix between the inertial coordinate system and the motion coordinate system, V = [u, v, w, p, q, r] T is the speed and angular velocity of the AUV in the motion coordinate system, u is the speed of the AUV in the longitudinal direction in the motion coordinate system, v is the speed of the AUV in the transverse direction in the motion coordinate system, w is the speed of the AUV in the vertical direction in the motion coordinate system, p is the angular velocity of the AUV in the roll direction in the motion coordinate system, q is the angular velocity of the AUV in the pitch direction in the motion coordinate system, r is the angular velocity of the AUV in the bow direction in the motion coordinate system, O 3×3 is a three-row, three-column zero matrix.

[0050] Step 2: Combine the AUV kinematic model obtained in step 1 to establish the AUV dynamic model, specifically:

[0051] Step 2.1 The dynamic equation of the AUV is expressed by a six-degree-of-freedom nonlinear model based on the Fossen outline, as follows:

[0052]

[0053] M η =MJ -1 (η a ) (5)

[0054]

[0055] C Aη =C A (V r )J -1 (η a ) (7)

[0056] D η =D(V r )J -1 (η a ) (8)

[0057] g η =g(η a ) (9)

[0058]

[0059] V r =VV c (11)

[0060] Among them, M η , C RBη , C Aη , D η , is the intermediate matrix, is η a The second derivative of g η , g(η a ) is the force and torque vector generated by gravity and buoyancy, τ is the control force and torque generated by the propulsion system, M is the coefficient matrix, C RB (V) is the Coriolis force and centripetal force matrix of the rigid body, C A (V r ) is the Coriolis force and centripetal force matrix of the additional mass, D(V r ) is the hydrodynamic damping matrix, V r is the speed of the AUV relative to the ocean current, V c is the speed of the ocean current in the moving coordinate system;

[0061] In this step, the six-degree-of-freedom nonlinear model based on the Fossen outline is derived from the literature (Fossen TI. Handbook of Marine Craft Hydrodynamics and Motion Control[M]. 2011.).

[0062] The coefficient matrix M in the above formula is composed of the rigid body mass and inertia matrix and the hydrodynamic additional matrix, that is, M = M RB +M A , M RB and M A The specific expression is as follows:

[0063]

[0064]

[0065] Among them, M RB is the rigid body mass and inertia matrix, M A is the hydrodynamic additional matrix, m is the AUV body mass, I X is the moment of inertia of the AUV about the X axis, I Y is the moment of inertia of the AUV about the Y axis, I Z is the moment of inertia of the AUV about the Z axis, I XY is the inertia product of the AUV about the X-axis and Y-axis, I XZ is the inertia product of the AUV about the X-axis and Z-axis, I YZ is the inertia product of the AUV about the Y and Z axes, About The first-order hydrodynamic coefficient of About The first-order hydrodynamic coefficient of About The first-order hydrodynamic coefficient of About The first-order hydrodynamic coefficient of About The first-order hydrodynamic coefficient of About The first-order hydrodynamic coefficient of

[0066] The Coriolis force and centripetal force matrix is ​​composed of the rigid body centripetal force matrix and the Coriolis force-like matrix, that is, C(V) = C RB (V)+C A (V r ), C RB (V) and C A (V r ) The specific expression is as follows:

[0067]

[0068]

[0069]

[0070] Among them, C RB (V) is the rigid body centripetal force matrix, C A (V r ) is a quasi-Coriolis force matrix, a1, a2, a3, b1, b2, b3 are intermediate variables;

[0071] The hydrodynamic damping matrix D(V r ), as follows:

[0072] D(V r )=-diag{D L +D Q |v|} (17)

[0073] D L =diag{X u ,Y v ,Z w ,K p ,M q ,N r} (18)

[0074] D Q =diag{X uu ,Y vv ,Z ww ,K pp ,M qq ,N rr} (19)

[0075] Among them, D L is the linear motion resistance coefficient matrix, D Q is the angular motion drag coefficient matrix, X u is the hydrodynamic coefficient about u, Y v is the hydrodynamic coefficient about v, Z w is the hydrodynamic coefficient about w, K p is the hydrodynamic coefficient about p, M q is the hydrodynamic coefficient about q, N r is the hydrodynamic coefficient about r, X uu is the hydrodynamic coefficient about u|u|, Y νν is the hydrodynamic coefficient about v|v|, Z ww is the hydrodynamic coefficient about w|w|, K pp is the hydrodynamic coefficient about p|p|, Mqq is the hydrodynamic coefficient about q|q|, N rr is the hydrodynamic coefficient about r|r|;

[0076] The force and torque vectors generated by gravity and buoyancy are:

[0077]

[0078] Where W is the total gravity on the AUV, B is the total buoyancy on the AUV, and Z B is the vertical coordinate value of the center of buoyancy;

[0079] Step 22: Based on the AUV dynamics model established in step 21, considering model uncertainty and ocean current disturbance, the AUV dynamics model is rewritten as follows:

[0080]

[0081]

[0082]

[0083] Among them, M η0 It is M η is the nominal value of the thrust distribution matrix, F is the total uncertainty of the system, and C RBη0 It is C RBη The nominal value, C Aη0 It is C Aη The nominal value, D η0 Yes D η Nominal value, g η0 are the nominal values ​​of the force and torque vectors due to gravity and buoyancy, u c is the control quantity of the thruster, ΔM η , ΔC RBη , ΔC Aη , Δg η M η , C RBη , C Aη , g η The uncertainty of It is the interference of external ocean currents. The term represents the uncertainty of the AUV’s own model;

[0084] Then, define the intermediate variable Then formula (21) can be rewritten as follows:

[0085]

[0086]

[0087]

[0088]

[0089] Among them, formula (23) is the AUV dynamic model after deformation;

[0090] The purpose of this invention is to design a new controller by combining the preset time control technology with the preset performance control technology to optimize the trajectory tracking effect from the two dimensions of convergence time and control performance constraints. In addition, an adaptive lumped disturbance estimator is designed to estimate ocean current disturbances and model uncertainties. The following assumptions are made in combination with actual engineering conditions:

[0091] Assumption 1: The first and second derivatives of the desired position and AUV attitude vector are known bounded functions.

[0092] Assumption 2: Aggregate interference Unknown but bounded, that is where k di is a known constant, i=1,2,3,4,5,6.

[0093] In the design process of the AUV controller, the present invention mainly uses the stability proof theory. The Lyapunov stability theory considers a nonlinear system in continuous time:

[0094]

[0095] Among them, x s ∈R n , f:R n ×R + →R n , x s is the state vector, t is the time, f(x s ,t) is the same as x s Functions related to t;

[0096] In this step, the Lyapunov stability theory comes from the literature (KrsticM, Kokotovic PV, Kanellakopoulos I. Nonlinear and adaptive control design[M]. John Wiley&Sons, Inc, 1995.); the nonlinear system comes from the literature (Sánchez-Torres JD, Gómez-Gutiérrez D, López E, et al. A class of predefined-timestable dynamical systems[J]. IMA Journal of Mathematical Control and Information, 2018.).

[0097] If the origin of the system is at the convergence time T(x s0 ) is asymptotically stable within , and the convergence time function is bounded, that is, there exists a positive constant T c , so that the following conditions are met, and T can be set in advance c .

[0098]

[0099] Then the nonlinear system (3) is said to be in the preset time T c Internally stable.

[0100] At time t0≥0, the initial value of the above nonlinear system is x s (t0; x s0 ,t0)=x s0 , then the solution of the nonlinear system is denoted by x s (t; x s0 ,t0). The solution can be divided into the following cases:

[0101] (1) Bounded, assuming that there exists a constant B(x s0 ,t0)>0, satisfying:

[0102]

[0103] Among them, t0 is the initial time, x s0 is the state vector at the initial moment;

[0104] (2) Stable: For any ε>0, there exists a constant value δ(ε,t0)>0, satisfying:

[0105]

[0106] in, is xs0 The state vector after perturbation;

[0107] (3) Asymptotically stable, there exists a constant r(t0)>0, and for any ε>0, there exists a constant T(ε,t0)>0, satisfying:

[0108]

[0109] (4) Unstable, there exists a certain ε>0, no matter how small the value δ(ε,t0) is, there exists:

[0110]

[0111] Step 3: Establish a performance function, and use the performance function and the deformed AUV dynamics model to transform the trajectory tracking error, so as to obtain the transformed trajectory tracking error vector:

[0112] Define the trajectory tracking error e i (t):

[0113] e i (t) = η ai -η di

[0114] Among them, e i (t) is the trajectory tracking error of the i-th degree of freedom at time t, where η ai , η di Refers to η ai (t), η di (t), represents the actual position and attitude of AUV at time t and the expected position and attitude of AUV at time t, respectively;

[0115] In order to constrain the trajectory error of the AUV, the present invention introduces a performance function as its upper and lower bounds. The performance function is defined as follows:

[0116] For a continuous function ρ(t):R + →R, if the function satisfies both of the following conditions:

[0117] (1) ρ(t) is positive and strictly decreasing;

[0118] (2)

[0119] Among them, ρ ∞ is a preset positive constant;

[0120] Then this function is a performance function. A common performance function is as follows:

[0121] ρ(t)=(ρ0-ρ ∞ )-kt +ρ ∞ (twenty four)

[0122] Among them, ρ0, k are preset positive constants;

[0123] The performance function comes from the literature (Bechlioulis CP, Rovithakis GA. Prescribed performance adaptive control of SISO feedback linearizable system with disturbances [C]. Proceedings of 16th Mediterranean Conference on Control and Automation, 2008: 1035-1040.);

[0124] The tracking error is expressed using the performance function as:

[0125]

[0126] Where 0≤δ i ≤1,δ i is the performance function coefficient of the trajectory tracking of the i-th degree of freedom, ρ i (t) is the performance function of trajectory tracking at the i-th degree of freedom at time t, e i (t) is the error of trajectory tracking of the i-th degree of freedom at time t;

[0127] According to the performance function formula (25), if the initial value of the tracking error satisfies 0≤|e i (0)|≤ρ i (0), then the parameter k i limits the minimum convergence rate of the tracking error, and ρ i∞ Given the upper and lower bounds of the allowable steady-state tracking error, the overshoot of the system response will not exceed δ i ρ i (t). Therefore, design an appropriate performance function ρ i (t) and δ i The desired system error response can be obtained;

[0128] Among them, e i (0) is the tracking error at the start of the ith degree of freedom, ρ i (0) is the tracking performance function value at the starting moment of the i-th degree of freedom, e i (t) is the tracking error of the i-th degree of freedom at time t;

[0129] In actual controller design, if the above tracking error constraint inequality is directly processed, it is difficult and the process is cumbersome. Therefore, it is necessary to transform the error to obtain a new error conversion function S i (ε i ) is used to design the controller and the constraint properties remain unchanged. The error change process is as follows:

[0130] Define the error transfer function S i (ε i ), with the following properties:

[0131] (1) S i (ε i ) is smooth and strictly monotonically increasing;

[0132] (2)

[0133] (3)

[0134] Among them, ε i ∈(-∞,+∞), ε i is the transformation error, a function S that satisfies the above conditions i (ε i ) is given by:

[0135]

[0136] According to S i (ε i ), formula (26) can be equivalently expressed as:

[0137] e i (t) = ρ i (t)S i (ε i ) (27)

[0138] Because S i (ε i ) is strictly monotonically increasing, so there exists an inverse function:

[0139]

[0140] If we can control ε i If bounded, then equation (25) can be guaranteed to hold, and then the performance function ρ i (t) to make the tracking error reach the desired target. At this time, the tracking control problem of the system is transformed into i is the stable control problem of a closed-loop system with variables.

[0141] Let z i =e i(t) / ρ i (t), error conversion function S i (ε i ) is converted to the following form:

[0142]

[0143] Let ε i Take the first and second derivatives with respect to time t:

[0144]

[0145]

[0146]

[0147] Among them, r i is an intermediate variable, e i ,ρ i ,S i -1 That is is the second-order derivative of the actual position and attitude of the AUV, is the second-order derivative of the desired position and attitude of the AUV;

[0148] because and ρ i (t)>0, we know that r i Always greater than zero, r i The upper and lower bounds of When the error e i When the trajectory of (t) is strictly limited to the range of formula (25), r and Is a normal number.

[0149] New error variable s∈R 6 The following forms are possible:

[0150]

[0151] In the formula, ε = [ε1, ε2, ε3, ε4, ε5, ε6] T , ε is the transformation error vector, ε i is the transformation error of the trajectory tracking of the i-th degree of freedom, λ=diag[λ1,λ2,λ3,λ4,λ5,λ6]>0, λ is the pre-set controller parameter vector, λ i is the controller parameter of the ith degree of freedom;

[0152] Combined with formula (23), the trajectory tracking error vector after conversion is obtained:

[0153]

[0154] L=[l1,l2,l3,l4,l5,l6] T

[0155]

[0156] R = diag[r1,r2,r3,r4,r5,r6]

[0157] Among them, R and L are intermediate vectors, l i is an intermediate variable, s = [s1, s2, s3, s4, s5, s6] is the trajectory tracking error vector, s i is the trajectory tracking error of the i-th degree of freedom;

[0158] Then when the controller u c To ensure that s is asymptotically convergent, ε i and The preset performance control method introduces performance functions and error transformation to make the convergence speed, overshoot and tracking error obtain the preset performance, which relaxes the requirements for the selection of control parameters to a certain extent.

[0159] The convergence time can be preset and is independent of the initial state of the system. Before designing the preset time controller, the following lemma related to the preset time stability needs to be introduced.

[0160] Lemma 1: Consider a class of nonlinear systems make is a set containing the origin. For nonlinear systems Construct a quasi-smooth positive definite function V defined on the set U a (x s ). If there exists a set For any x s ∈U0\{0}, then V a (x s ) can satisfy the following inequality:

[0161]

[0162] where λ a >0,λ b >0, T c >0,0<β<1,0<η b <+∞. Then the nonlinear system is stable over the preset time. In addition, there exists a positive constant θ a <1, so that the state of the nonlinear system can be Internal convergence. That is:

[0163]

[0164] And the lemma needed in the subsequent Lyapunov stability proof.

[0165] Lemma 1 comes from the literature (Wu CH, Yan JG, Shen JH, et al. Predefined-time attitudestabilization of receiver aircraft in aerial refueling[J]. IEEE Transactionson Circuits and Systems II: Express Briefs, 2021, 68(10): 3321-3325.).

[0166] Lemma 2: For a vector x v ∈R n and a matrix Q∈R n×n , if the matrix Q is a positive definite symmetric matrix, then for any x v ≠0, both have x v T Qx v >0 holds, and x v T Qx v Satisfies the following inequality:

[0167] λ min (Q)||x v || 2 ≤x v T Qx v ≤λ max (Q)||x v || 2

[0168] Lemma 2 comes from the literature (Rami MA, Zhou

[0169] Lemma 3: For any constant z c ∈R, there exists any positive real number ε a >0, Make And usually take

[0170] Lemma 3 comes from the literature (Polycarpou M M, Stable adaptive neural control scheme for nonlinear systems [J]. IEEE Trans. Autom. Control, vol. 41, no. 3, pp. 447-451, Mar. 1996.).

[0171] Step 4: Use the trajectory tracking error vector obtained in step 3 to design an adaptive lumped interference estimator, specifically:

[0172] The present invention considers the ocean current disturbance and model uncertainty problems as a lumped disturbance The hyperbolic tangent function is used to ensure that the estimated value and the actual value can converge smoothly. The expression of the adaptive lumped interference estimator is as follows:

[0173]

[0174] Among them, ε i is the transformation error of the trajectory of the ith degree of freedom, s i is the component of vector s (the trajectory tracking error of the ith degree of freedom), k di is a constant.

[0175] Step 5: Design an adaptive attitude tracking controller using the trajectory tracking error variable obtained in step 3 and the adaptive lumped disturbance estimator designed in step 4. Specifically:

[0176] Combining the above lumped disturbance estimator and based on the preset performance control error form and the preset time control theorem form, the final AUV preset time trajectory tracking controller u considering external disturbances and performance function constraints can be obtained. c :

[0177]

[0178]

[0179]

[0180] Among them, λ min (R) is the smallest eigenvalue of matrix R, T c is the preset time period, T c >0,λ a >0,λ b >0,0<β<1,β,λ a , b is a positive constant.

[0181] Step 6: Verify the preset time convergence characteristics of the adaptive attitude tracking controller designed in step 5, specifically:

[0182] Theorem 1: For the AUV dynamic model considering the influence of ocean current disturbance and model uncertainty, under the action of the preset time trajectory tracking controller and adaptive lumped disturbance estimator of the AUV, the trajectory tracking error of the AUV can converge within the preset time and achieve the preset control accuracy.

[0183] Proof: Choose the following Lyapunov function:

[0184]

[0185] Take the derivative with respect to time and substitute the control rate u c We can get:

[0186]

[0187] From Lemma 2, we can get:

[0188] λ min (R)||s|| 2 ≤s T Rs≤λ max (R)||s|| 2 (38)

[0189] Substituting formula (38) into formula (37) yields:

[0190]

[0191] There are also:

[0192]

[0193] Substituting formula (34) into formula (40), we can obtain:

[0194]

[0195] From Lemma 3, we can see that the above formula can be transformed into:

[0196]

[0197] make Substituting formula (42) into formula (39) yields:

[0198]

[0199] It conforms to the form in Lemma 1 and has the preset time convergence property. The proof is complete.

[0200] Theorem 2: Under the above conditions, the AUV’s trajectory tracking error will be Converge to a certain set within a certain time, and have the preset time convergence characteristics through the controller u c Preset convergence time

[0201] Proof: Rewrite formula (43) as:

[0202]

[0203] or

[0204]

[0205] There are two situations for discussion:

[0206] Situation 1: When When:

[0207]

[0208] Scenario 2: When When:

[0209]

[0210] The stability analysis is carried out for case 1. From formula (46), we can get:

[0211]

[0212] Let s0 represent the initial state of the AUV system, and t(s0) represent the time from the initial state to the system stabilization. Integrating both sides of the equation at t∈(0,t(s0)) yields:

[0213]

[0214] The expression on the right is calculated as:

[0215]

[0216] Substituting into formula (49) we get:

[0217]

[0218] because Substituting into equation (51) we can get In the following scenario, the AUV system will time converges to the set:

[0219]

[0220] Similarly, according to the above derivation process, in case 2, the AUV system will time converges to the set:

[0221]

[0222] In summary, the AUV preset time trajectory tracking controller can ensure that the trajectory tracking error is within time converges to the set:

[0223]

[0224] So far, the proof of Theorem 2 is complete.

[0225] Example:

[0226] In order to verify the effectiveness of the present invention, the "Xinghai Z3000" bottom-dwelling AUV was selected for numerical simulation experiments. The schematic diagram of the full-drive AUV and its thruster layout is shown in Figure 2 The hydrodynamic coefficient and inertia coefficient of the AUV are shown in Table 1 and Table 2 respectively. The hydrodynamic coefficient includes the inertia force coefficient, the viscosity force coefficient and the additional mass coefficient. Due to the thrust upper limit of the actual propeller, a saturated output thrust upper limit of 100N is set in the simulation experiment.

[0227] Table 1 AUV hydrodynamic coefficients

[0228]

[0229] Table 2 AUV inertia coefficient

[0230]

[0231] In order to solve the problem of ocean current disturbance and model uncertainty, the present invention proposes an adaptive disturbance estimator to estimate it. In the simulation experiment, a nominal value of 20% is set as the model uncertainty effect, which is expressed as:

[0232]

[0233] The selected ocean current disturbance d is in the form of a trigonometric function, and the ocean current disturbance form is set as follows:

[0234]

[0235] The descending spiral trajectory is a commonly used trajectory in AUV simulation experiments, which includes multiple degrees of freedom when the AUV moves. Therefore, the present invention selects the spiral as the expected trajectory and selects the expected trajectory η d as follows:

[0236]

[0237] The set AUV initial position and attitude η0 are shown in Table 3;

[0238] Table 3 AUV initial position and attitude

[0239]

[0240] Based on the above AUV simulation model establishment and external interference parameter setting, the parameters of the adaptive interference estimator are set. d , the ε parameter is set to k d =[2,2,2,2,2,2] T ,ε=[0.1,0.1,0.1,0.1,0.1,0.1] T The parameters of the performance function are set to ρ0 = [1.8, 1.8, 2.3, 2.4, 1.8, 2.8], ρ ∞ =0.001, k = 0.3. The parameters of the preset time trajectory tracking controller are set to β = 0.5, T c =15,λ a =1,λ b = 1. According to Theorem 2, the AUV trajectory tracking error will be It converges to the preset control steady state within 21.210s.

[0241] Based on the settings of the parameters of the adaptive disturbance estimator, the parameters of the performance function and the preset time controller parameters, the controller of the present invention is simulated and verified using numerical simulation software. The simulation results of the AUV preset time trajectory tracking controller considering external disturbances and performance function constraints are shown in Figures 3(a) to 3(b). Fig.11 shown.

[0242] When the AUV preset time trajectory tracking controller considering external interference and performance function constraints is used, the AUV six-degree-of-freedom trajectory tracking error curve is as follows: Figure 3(a)-Figure 3(f) As shown in , ρ and -ρ represent the upper and lower bounds of the trajectory tracking error respectively; Figure 3(a) is the trajectory tracking error curve of the AUV in the sway direction, Figure 3(b) is the trajectory tracking error curve of the AUV in the sway direction, Figure 3(c) is the trajectory tracking error curve of the AUV in the heave direction, Figure 3(d) is the trajectory tracking error curve of the AUV in the roll direction, Figure 3(e) is the trajectory tracking error curve of the AUV in the pitch direction, and Figure 3(f) is the trajectory tracking error curve of the AUV in the bow direction. The enlarged diagram at the preset time is shown in Figure 4 As shown. Figure 3(a)-Figure 3(f) It can be seen that the performance function constraint method proposed in the present invention can ensure that the trajectory error of the six degrees of freedom of the AUV is constrained within the upper and lower bounds of the performance function, and the final steady-state error also reaches the preset value. Figure 4It can be seen that the AUV preset time trajectory tracking controller proposed in the present invention can track the AUV at a preset time. The six-degree-of-freedom trajectory tracking error converges to meet the preset time control effect. Figure 5 and Figure 6 The output control torque and control force curves of the AUV thruster are given respectively. It can be seen that under the action of the above controller, the output force is within the set output saturation upper limit of 100N, which meets the actual needs of the AUV. Figures 7 to 9 The trajectory curves of AUV in the longitudinal, transverse and vertical directions are given. Fig.10 The motion trajectory curve of AUV in three-dimensional space is given, and the arrow in the figure indicates the motion direction of AUV. Fig.11 It shows the influence of external interference on AUV. It can be seen that the AUV preset time trajectory tracking controller designed by the present invention considering external interference and performance function constraints can ensure that the AUV moves to the desired trajectory under the influence of external ocean current disturbances and model uncertainty, that is, it realizes the trajectory tracking task.

[0243] The above simulation results demonstrate the effectiveness of the AUV preset time trajectory tracking controller that takes into account external interference and performance function constraints in the present invention, and prove that the controller proposed in the present invention can ensure that the AUV trajectory tracking error converges within a preset time and is constrained within the upper and lower bounds of the performance function under ocean current disturbances and model uncertainty, thereby achieving the purpose of desired trajectory tracking.

Claims

1. A method for tracking and controlling an AUV preset time trajectory considering performance constraints and interference effects, characterized in that The specific process of the method is: Step 1: Establish the AUV kinematic model using the six-degree-of-freedom position and attitude of the AUV in the inertial coordinate system; Step 2: Establish an AUV dynamic model by combining the AUV kinematic model obtained in step 1; Step 3: Establish a performance function, use the performance function and the AUV dynamics model to convert the trajectory tracking error, and obtain the converted trajectory tracking error vector, specifically: Step 31: Establish performance functions, specifically: ρ(t)=(ρ0-ρ ∞ )e -kt +r ∞ ρ(t) satisfies the following conditions at the same time: (1) ρ(t) is positive and strictly decreasing; (2) Among them, ρ0, k, ρ ∞ is a preset positive constant, t is time; Step 32: Use the performance function ρ(t) and the AUV dynamics model established in step 31 to transform the trajectory tracking error and obtain the transformed trajectory tracking error vector; Step 4: Use the trajectory tracking error vector obtained in step 3 to design an adaptive lumped interference estimator, specifically: Among them, k di is a constant, i∈[1,6], i is the degree of freedom label, ε i is the transformation error of the trajectory tracking of the ith degree of freedom, s i is the trajectory tracking error of the i-th degree of freedom; Step 5: Design an adaptive attitude tracking controller using the trajectory tracking error vector obtained in step 3 and the adaptive lumped disturbance estimator obtained in step 4.

2. The AUV preset time trajectory tracking control method considering performance constraints and interference effects according to claim 1 is characterized in that: The kinematic model of the AUV is established by using the six-degree-of-freedom position and posture of the AUV in the inertial coordinate system in step 1, specifically: in, x is the linear displacement of the AUV in the longitudinal direction in the inertial coordinate system, y is the linear displacement of the AUV in the transverse direction in the inertial coordinate system, and z is the linear displacement of the AUV in the vertical direction in the inertial coordinate system. is the angular displacement of the AUV in the roll direction in the inertial coordinate system, θ is the angular displacement of the AUV in the pitch direction in the inertial coordinate system, ψ is the angular displacement of the AUV in the bow direction in the inertial coordinate system, J(η a ) is the transformation matrix between the inertial coordinate system and the motion coordinate system, J1(η a ) is the linear velocity transfer matrix, J2(η a ) is the angular velocity transfer matrix, O 3×3 It is a three-row and three-column zero matrix, V = [u,v,w,p,q,r] T are the speed and angular velocity of the AUV in the motion coordinate system, u is the speed of the AUV in the longitudinal direction in the motion coordinate system, v is the speed of the AUV in the transverse direction in the motion coordinate system, w is the speed of the AUV in the heaving direction in the motion coordinate system, p is the angular velocity of the AUV in the roll direction in the motion coordinate system, q is the angular velocity of the AUV in the pitch direction in the motion coordinate system, and r is the angular velocity of the AUV in the bow direction in the motion coordinate system.

3. The AUV preset time trajectory tracking control method considering performance constraints and interference effects according to claim 2 is characterized in that: The AUV dynamics model is established by combining the AUV kinematic model obtained in step 1 in step 2, specifically: Step 21: Establish the dynamic model of AUV, specifically: M η =MJ -1 (η a ) V r =VV c Among them, M η , C RBη , C Aη , D η , is the intermediate matrix, is η a The second-order derivative of is η a The first derivative of η are the force and torque vectors generated by gravity and buoyancy, M is the coefficient matrix, C RB (V) is the rigid body centripetal force matrix, τ is the control force and torque generated by the propulsion system, W is the total gravity on the AUV, B is the total buoyancy on the AUV, and Z B is the vertical coordinate value of the center of buoyancy, V r is the speed of the AUV relative to the ocean current, V c is the velocity of the ocean current in the moving coordinate system, I X is the inertia moment of the AUV about the X-axis of the motion coordinate system, I Y is the inertia moment of the AUV about the Y axis of the motion coordinate system, I Z is the inertia moment of the AUV about the Z axis of the motion coordinate system, I XY is the inertia product of the AUV about the X-axis and Y-axis of the motion coordinate system, I XZ is the inertia product of the AUV about the X-axis and Z-axis of the motion coordinate system, I YZ is the inertia product of the AUV about the Y and Z axes of the motion coordinate system, and m is the mass of the AUV body; Step 22: Based on the AUV dynamics model established in step 21, the AUV dynamics model is rewritten taking into account system uncertainty and ocean current disturbances.

4. The AUV preset time trajectory tracking control method considering performance constraints and interference effects according to claim 3 is characterized in that: The coefficient matrix M is specifically: M=M RB +M A Among them, M RB is the rigid body mass and inertia matrix, M A is the hydrodynamic addition matrix, About The first-order hydrodynamic coefficient of About The first-order hydrodynamic coefficient of About The first-order hydrodynamic coefficient of About The first-order hydrodynamic coefficient of About The first-order hydrodynamic coefficient of About The first-order hydrodynamic coefficient.

5. The AUV preset time trajectory tracking control method considering performance constraints and interference effects according to claim 4 is characterized in that: Intermediate Matrix C Aη Specifically: C Aη =C A (V r )J -1 (η a ) Among them, C A (V r ) is a quasi-Coriolis force matrix, and a1, a2, a3, b1, b2, and b3 are intermediate variables.

6. The AUV preset time trajectory tracking control method considering performance constraints and interference effects according to claim 5 is characterized in that: In step 22, based on the AUV dynamics model established in step 21, the AUV dynamics model is rewritten taking into account system uncertainty and ocean current disturbances, specifically: Among them, A, H, is the intermediate variable, M η0 It is M η The nominal value of u c is the control quantity of the thruster, C RBη0 It is C RBη The nominal value, C Aη0 It is C Aη The nominal value, D η0 Yes D η Nominal value, g η0 Yes η is the nominal value of the thrust distribution matrix, and F is the total uncertainty of the system.

7. The AUV preset time trajectory tracking control method considering performance constraints and interference effects according to claim 6 is characterized in that: Intermediate matrix D η , specifically D η =D(V r )J -1 (η a ) D(V r )=-diag{D L +D Q |ν|} D L =diag{X u ,Y v ,Z w ,K p ,M q ,N r } D Q =diag{X u|u| ,Y v|v| ,Z w|w| ,K p|p| ,M q|q| ,N r|r| } Among them, D(V r ) is the hydrodynamic damping matrix, D L is the linear motion resistance coefficient matrix, D Q is the angular motion drag coefficient matrix, X u is the hydrodynamic coefficient about u, Y v is the hydrodynamic coefficient about v, Z w is the hydrodynamic coefficient about w, K p is the hydrodynamic coefficient about p, M q is the hydrodynamic coefficient about q, N r is the hydrodynamic coefficient about r, X u|u| is the hydrodynamic coefficient about u|u|, Y ν|ν is the hydrodynamic coefficient about v|v|, Z w|w| is the hydrodynamic coefficient about w|w|, K p|p| is the hydrodynamic coefficient about p|p|, M q|q| is the hydrodynamic coefficient about q|q|, N r|r| is the hydrodynamic coefficient about r|r|.

8. The AUV preset time trajectory tracking control method considering performance constraints and interference effects according to claim 7 is characterized in that: In step 22 Specifically: Among them, ΔM η , ΔC RBη , ΔC Aη , Δg η M η , C RBη , C Aη , g η The uncertainty value of It is the interference of external ocean currents.

9. The AUV preset time trajectory tracking control method considering performance constraints and interference effects according to claim 8, characterized in that: In step 32, the trajectory tracking error is converted using the performance function ρ(t) established in step 31 and the AUV dynamics model to obtain the converted trajectory tracking error vector, which is specifically: First, define the trajectory tracking error e of the i-th degree of freedom at time t: i (t): e i (t)=η ai (t)-η di (t) Among them, η ai (t) is the actual position and attitude of the AUV at time t, η di (t) is the expected position and attitude of the AUV at time t; Then, the trajectory tracking error e i (t) is converted to obtain the converted trajectory tracking error: λ=diag[λ1,λ2,λ3,λ4,λ5,λ6]>0 e=[e1,e2,e3,e4,e5,e6] T R = diag[r1,r2,r3,r4,r5,r6] L=[l1,l2,l3,l4,l5,l6] T z i =e i (t) / ρ i (t) Where s is the converted trajectory tracking error vector, s i is the trajectory tracking error of the i-th degree of freedom after transformation, ε is the transformation error vector, is the first-order derivative of ε, is the second-order derivative of ε, ε i is the transformation error of the trajectory tracking of the ith degree of freedom, λ is the controller parameter vector, and λ i is the controller parameter of the i-th degree of freedom, L and R are intermediate vectors, and l i 、z i 、r i is an intermediate variable, is the error transfer function, e i (0) is the tracking error at the start of the ith degree of freedom, e i (t) is the tracking error of the i-th degree of freedom at time t, δ i is the performance function coefficient of the trajectory tracking of the i-th degree of freedom, ρ i (t) is the performance function of the trajectory tracking of the ith degree of freedom, is the second-order derivative of the actual position and attitude of the AUV at time t, It is the second-order derivative of the expected position and attitude of the AUV at time t.

10. The AUV preset time trajectory tracking control method considering performance constraints and interference effects according to claim 9, characterized in that: The step 5 uses the trajectory tracking error vector obtained in step 3 and the adaptive lumped disturbance estimator obtained in step 4 to design an adaptive attitude tracking controller, specifically: Among them, λ min (R) is the smallest eigenvalue of matrix R, T c is the preset time period, T c >0,λ a >0,λ b >0,0<β<1,β,λ a , b is a constant.

Citation Information

Patent Citations

  • Preset performance ocean bottom flying node trajectory tracking control method based on disturbance observer

    CN109283941A

  • Benthic AUV adaptive terminal sliding mode trajectory tracking control method based on auxiliary dynamic system

    CN113110532A

  • Self-adaptive neural network trajectory tracking method for autonomous underwater helicopter

    CN115576335A

  • Underwater helicopter preset performance tracking control method considering propeller abnormity

    CN115617056A

  • Neural network-based fault-tolerant control method of underactuated autonomous vehicle

    KR101706367B1

Cited By

  • Underwater glider attitude control method and system

    CN119311030A