Under-actuated water surface emergency robot speed stabilization control method and system

By designing an adaptive anti-saturation controller based on hyperbolic tangent function and Nussbaum compensation method in under-driven water surface emergency robot, the control difficulty and equipment damage caused by the saturation nonlinearity of the system model are solved, and high-precision calming control and System performance improvement.

CN118939017APending Publication Date: 2024-11-12NORTH CHINA INSTITUTE OF SCIENCE & TECHNOLOGY (NATIONAL SAFETY TRAINING CENTER OF COAL MINES)
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410894106.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-04
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

The system model of under-driven water surface emergency robot has saturation nonlinearity, resulting in input saturation when the control signal amplitude is large, affecting control performance, increasing control difficulty and uncertainty, and long-term input saturation may lead to equipment damage, reducing system reliability and stability.

Method used

Design an adaptive anti-saturation controller based on hyperbolic tangent function combined with Nussbaum compensation method. By defining auxiliary variables and Nussbaum compensation system, designing saturated nonlinear compensation system, and designing a priori bounded linear velocity and Angular velocity controls the input to avoid the occurrence of input saturation and ensures the stability of the saturated nonlinear compensation system variables.

Benefits of technology

It realizes high-precision tracking of position and attitude command signals, avoids control input saturation, improves system performance and control accuracy, ensures the stability of saturated nonlinear compensation system, and expands the application range.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118939017A_ABST
    Figure CN118939017A_ABST
Patent Text Reader

Abstract

The invention provides an under-actuated water surface emergency robot speed stabilization control method and system, and the method comprises the following steps: defining an auxiliary variable xi containing a time variable t; defining auxiliary variables beta ud and beta rd based on the auxiliary variable xi; designing a Nussbaum compensation system based on the auxiliary variables beta ud and beta rd, and obtaining variables x1 and x2 of the Nussbaum compensation system; and designing a saturated nonlinear compensation system based on a Nussbaum compensation system to obtain a saturated nonlinear compensation system variable # imgabs0 #, and designing prior bounded linear velocity control input ud and angular velocity control input rd by using a hyperbolic tangent saturation function based on the saturated nonlinear compensation system. The self-adaptive anti-saturation controller is designed on the basis of the hyperbolic tangent function in combination with the Nussbaum compensation method, the input saturation phenomenon is avoided, meanwhile, it can be ensured that variables # imgabs1 # and # imgabs2 # of the saturation nonlinear compensation system are stable, and the system performance is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of surface emergency robot control, and in particular to a speed stabilization control method and system for an underactuated surface emergency robot. Background Art

[0002] Due to the complexity and nonlinearity of the underactuated surface emergency robot, the system model has saturated nonlinearity, which makes the control complicated. When the amplitude of the control signal is large, it will lead to input saturation, causing the key parameters of the robot to be unable to be effectively controlled, thus affecting the control performance; at the same time, input saturation may trigger the nonlinear behavior of the system, increasing the control difficulty and uncertainty. When the control input exceeds its saturation limit, the closed-loop performance of the system will degrade sharply, which may make it impossible for the robot to achieve precise stabilization control. In addition, long-term operation under input saturation conditions will cause damage to the equipment and reduce the reliability and stability of the system.

[0003] Existing technologies such as Chinese patent document CN115542929A discloses an adaptive stabilization control method and system for an underactuated underwater vehicle, but do not fully consider the adverse effects of the above-mentioned input saturation on the system. Chinese patent document CN118011812A discloses an adaptive anti-saturation stabilization control method and system for an underactuated underwater vehicle, and proposes a design idea of ​​combining a hyperbolic tangent function with a saturated nonlinear compensation system. However, the saturated auxiliary system designed by the system cannot guarantee its own stability, which will cause the final controller to oscillate and deteriorate the control effect. Summary of the invention

[0004] The present invention proposes a speed stabilization control method and system for an underactuated surface emergency robot. An adaptive anti-saturation controller is designed based on a hyperbolic tangent function combined with a Nussbaum compensation method to avoid the occurrence of input saturation and ensure that the saturated nonlinear compensation system variables are within the range of 0.040 saturation. Be stable and improve system performance.

[0005] The technical solution of the present invention is implemented as follows: a speed stabilization control method for an underactuated surface emergency robot comprises the following steps:

[0006] (1) Define an auxiliary variable ξ that explicitly contains the time variable t;

[0007] (2) Based on the auxiliary variable ξ, define the auxiliary variable and Based on auxiliary variables and Design the Nussbaum compensation system and obtain the Nussbaum compensation system variables χ1 and χ2;

[0008] (3) Based on the Nussbaum compensation system, a saturated nonlinear compensation system is designed. The variables of the saturated nonlinear compensation system are Based on the saturated nonlinear compensation system, the hyperbolic tangent saturation function is used to design a priori bounded linear velocity control input u d and angular velocity control input r d .

[0009] Furthermore, in step (1), the auxiliary variable ξ that explicitly contains the time variable t is defined as

[0010] ξ=z3+Φ(Z)h t (4)

[0011] Among them, the variable In the robot's body coordinate system, variable z1 is the longitudinal position error, variable z2 is the lateral position error, and variable z3 is the angular velocity error; Φ(Z) is a smooth κ-type saturated function with respect to variable Z, and its derivatives of all orders satisfy h t is a smooth function of the time variable t, whose derivatives satisfy and

[0012] Furthermore, in step (2), define the auxiliary variable and for

[0013]

[0014] The design parameters Design parameters v is the lateral velocity of the robot in the body coordinate system, and is the auxiliary signal generated by the saturation nonlinear compensation system, u Max and r Max are the maximum linear speed and angular speed rated for the robot respectively;

[0015] Defining constants m 11 、m 22 is the system inertia parameter, including mass and additional mass; is the system hydrodynamic damping parameter; m 11 、m 22 and All are normal numbers;

[0016] The auxiliary variable in formula (8) and Defined as

[0017]

[0018] The design parameter k2>0;

[0019] definition

[0020]

[0021] Furthermore, in step (2), the adaptive law of Nussbaum compensation system variables χ1 and χ2 is designed as

[0022]

[0023] The constant is the design parameter;

[0024] By integrating equation (7) using equation (8), we can obtain the Nussbaum compensation system variables χ1 and χ2.

[0025] Furthermore, in step (3), the saturated nonlinear compensation system variables are designed for

[0026]

[0027] The constant is the design parameter; N(χ1) is the Nussbaum function of the auxiliary signal variable χ1; N(χ2) is the Nussbaum function of the auxiliary signal variable χ2.

[0028] Furthermore, in step (3), a priori bounded linear velocity control input u is designed d and angular velocity control input r d for

[0029]

[0030] tanh(·) is an arbitrary variable The hyperbolic tangent function of ;

[0031] Using equation (5) to integrate equation (6), we can get the saturated nonlinear compensation system variable:

[0032] Using equation (5), calculate the a priori bounded linear velocity control input u d , angular velocity control input r d .

[0033] Furthermore, the method further comprises step (4) closed-loop system stability analysis.

[0034] Definition η e =[x e ,y e ,ψ e ]T is the full-state stabilization error vector of the underactuated robot in the geodetic coordinate system, z = [z1, z2, z3] T is the full-state stabilization error vector of the underactuated robot in the body coordinate system, and the two have the following relationship:

[0035]

[0036] Among them, x e is the position error in the x direction, y e is the position error in the y direction, ψ e is the heading angle error, ψ is the heading angle;

[0037] Combining equations (2), (10) and (9), the system model of the underactuated surface emergency robot is established as follows:

[0038]

[0039] Constructing Lyapunov functions

[0040]

[0041] From equations (12) and (14), we can see that

[0042]

[0043] in

[0044] Defining the Lyapunov function

[0045]

[0046] Combining equations (4), (9), (10), and (14), we can see that

[0047]

[0048] From equations (20), (15), and (17), we can see that

[0049]

[0050] Defining the Lyapunov function

[0051]

[0052] From equations (5), (6), (21), (22), (7), and (8), we can see that

[0053]

[0054] Integrating both sides of equation (26) over [0, t), we can obtain

[0055]

[0056] Notice

[0057]

[0058] It can be seen that the Lyapunov function V1, V2, V3∈L ∞ , variables z1,z2,Z,v,ξ, because It can be seen that z3∈L ∞ ; And then we know

[0059] Depend on Consistently continuous, V3 ≥ 0, It can be seen that

[0060]

[0061] Depend on Consistent, continuous Combining (14), (32), (9) and It can be seen that

[0062]

[0063] From formula (37) and It can be seen that Combining equation (2) and equation (32), we can get So the system is asymptotically stable.

[0064] From formula (5), we can know that u d With r d Satisfy | d |≤u Max ,|r d |≤r Max , so they are bounded a priori; therefore, u is bounded a priori d With r d All derivatives of exist, and under the condition of considering the maximum angular velocity and linear velocity that the system can achieve, a bounded time-varying smooth velocity control signal is provided for the robot.

[0065] A speed stabilization control system for an underactuated surface emergency robot comprises a memory, a processor and a computer program stored in the memory and executable on the processor, wherein the control method is implemented when the processor executes the computer program.

[0066] Beneficial effects of the present invention:

[0067] The present invention designs an adaptive anti-saturation controller based on the hyperbolic tangent function combined with the Nussbaum compensation method to avoid the occurrence of input saturation, realize the tracking of position and posture command signals, have higher control accuracy, and avoid the occurrence of control input saturation, and have a wider range of applications. The designed compensation system based on the Nussbaum function can ensure that the saturated nonlinear compensation system variables Be stable and improve system performance. BRIEF DESCRIPTION OF THE DRAWINGS

[0068] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0069] Figure 1 This is a simulation effect diagram of the control method of the present invention. DETAILED DESCRIPTION

[0070] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0071] Define η=[x,y,ψ] T are the x-axis position coordinates, y-axis position coordinates and heading angle ψ of the robot in the geodetic coordinate system; v is the lateral velocity v of the robot in the body coordinate system; u d is the linear speed control input, r d is the angular velocity control input. The kinematic differential equation of the underactuated robot is

[0072]

[0073] Among them, the robot model parameter m 11 、m 22 is the system inertia parameter, including mass and additional mass; is the system hydrodynamic damping parameter; the above system model parameter m 11 、m 22 and All are normal numbers.

[0074] The full-state stabilization control goal is: considering the maximum linear velocity and angular velocity that the robot can achieve, in order to avoid the occurrence of input saturation, a bounded speed control law u is designed d and r d , so that the robot can navigate from the initial state to the target point η in the geodetic coordinate system d =[x d ,y d ,ψ d ] T , while maintaining the specified position and heading; where x d is the position instruction in the x direction, y d is the position command in the y direction, ψ d is the heading angle command.

[0075] Definition η e =η-η d =[x e ,y e ,ψ e ] T is the full-state stabilization error vector of the underactuated robot in the geodetic coordinate system, z = [z1, z2, z3] T is the full-state stabilization error vector of the underactuated robot in the body coordinate system, and the two have the following relationship

[0076]

[0077] Combining formula (1) and taking the derivative of the above formula, we can get Defining constants The system model (1) can be rewritten as:

[0078]

[0079] Among them, variable z1 is the longitudinal position error, variable z2 is the lateral position error, and variable z3 is the angular velocity error.

[0080] Since the system has underactuated constraints, the underactuated problem needs to be solved. According to the transformed equation (3), it can be seen that the above state transformation process (2) is globally reversible and there is no singularity. Therefore, the global asymptotic stabilization problem of the system model (1) is ( ) is equivalent to: Considering the case of instruction saturation, the designed u d With r d is bounded, and eventually the errors z1, z2, and z3 tend to zero.

[0081] In order to facilitate the design and analysis of control systems, the following definitions and lemmas are introduced:

[0082] Definition 1. For all variables Φ(ξ i ) is about ξ i κ-type function.

[0083] Definition 2.h t (t) is a smooth function of the time variable t, denoted by h t , satisfying: |h t |, and

[0084] Definition 3. A continuous function N(χ) is called a Nussbaum function if it satisfies the following bilateral properties:

[0085]

[0086] Among them, s is the element in the integral.

[0087] Lemma 1. For all variables Consider the differentiable function: If there exists a constant M>0, satisfying

[0088]

[0089] Then f Consistently continuous.

[0090] Lemma 2. A uniformly continuous function V defined on the interval [0,∞) is: If the limit

[0091]

[0092] exists and is bounded, then

[0093] Lemma 3. For any variable if and Let V∈L p ,but

[0094] Example 1

[0095] A speed stabilization control method for an underactuated surface emergency robot comprises the following steps:

[0096] Define auxiliary variables that explicitly include the time variable t

[0097] ξ=z3+Φ(Z)h t (4)

[0098] Among them, the variable Using Definition 1, Φ(Z) is defined as a smooth κ-type saturation function with respect to the variable Z, whose derivatives satisfy Using Definition 2, h t (t) is defined as a smooth function of the time variable t, whose derivatives satisfy and

[0099] Using the hyperbolic tangent saturation function to design a priori bounded u d 、r d for

[0100]

[0101] where u Max and r Max are the maximum linear velocity and angular velocity of the robot respectively; tanh(·) is an arbitrary variable The hyperbolic tangent function of is or abbreviation of; and The auxiliary signal generated for the saturation nonlinear compensation system is defined as

[0102]

[0103] The constant is the design parameter; using Definition 3, we know that N(χ1) is the Nussbaum function of the auxiliary signal variable χ1; N(χ2) is the Nussbaum function of the auxiliary signal variable χ2. The adaptive law for designing Nussbaum compensation system variables χ1 and χ2 is

[0104]

[0105] The constant is the design parameter; auxiliary variable and Defined as

[0106]

[0107] The design parameters The design parameters need to be selected to meet This ensures Design parameters

[0108] The auxiliary variable in formula (8) and Defined as

[0109] α ud =-k1z1

[0110]

[0111] The design parameter k2>0.

[0112] By integrating equation (7) using equation (8), we can obtain the Nussbaum compensation system variables χ1 and χ2.

[0113] By integrating equation (5) with equation (6), we can obtain the saturated nonlinear compensation system variable generated by the saturated nonlinear compensation system:

[0114] Using equation (5), calculate the a priori bounded linear velocity control input u d , angular velocity control input r d .

[0115] Closed-loop system stability analysis

[0116] Ideal speed command u d With r d The stability analysis of system (1) can be summarized as the following theorem.

[0117] Theorem 1. Consider the underactuated emergency robot system described by equation (1), using u defined by equations (5) to (9) d and r d When used as the control input of the underactuated surface emergency robot system (1), if the controller design parameters satisfy: Then the speed guidance command u designed according to equations (5) to (9) is d With r d The outer loop subsystem (1) can be made globally asymptotically stable.

[0118] Proof: Definition

[0119]

[0120] Auxiliary signal and line speed control input u d , angular velocity control input r d Therefore, according to formula (10), we can know

[0121]

[0122] Constructing Lyapunov functions

[0123]

[0124] in At the same time, the design parameters need to be selected according to assumption 1 to meet This ensures

[0125] Taking the derivative of V1 and substituting equation (1) into it, we can get

[0126]

[0127] In the derivation process, when For z1z2r and u d vr d When the coefficients of these two terms are expanded into

[0128] In formula (11), And in formula (9) Substituting into formula (3) we can get

[0129]

[0130] Substituting equation (14) into equation (13), we can obtain

[0131]

[0132] in

[0133] It can be found from formula (15) that when there is no saturation nonlinearity, that is, When , only by using the formula (9) The ideal linear velocity guidance command u is defined d , the variables z1 and v can be made to converge to the origin asymptotically. Therefore, the ideal angular velocity guidance command r to be designed is d The remaining variables z2 and z3 of the outer loop subsystem must converge asymptotically to the origin.

[0134] Defining the Lyapunov function

[0135]

[0136] Notice

[0137]

[0138] Combining formula (11) For equation (4), ξ=z3+Φ(Z)h t Taking the derivative and substituting equation (18) into the equation, we get

[0139]

[0140] In formula (9), Substituting into formula (19) we can get

[0141]

[0142] Taking the derivative of equation (17) and substituting equation (15) and equation (20) into equation (17) yields

[0143]

[0144] Defining the Lyapunov function

[0145]

[0146] Note that for any variable Combining formula (5), we can know

[0147]

[0148] Note that for any variable ·for or This means that there is no singular point in equation (23). Substituting equation (6) into equation (23), we can get

[0149]

[0150] Therefore, by taking the derivative of equation (22) and combining equations (21), (24) and (26), we can obtain

[0151]

[0152] Substituting formula (8) into formula (25) and combining it with formula (7), we can get

[0153]

[0154] Integrating both sides of equation (26) over [0, t), we can obtain

[0155]

[0156] Notice

[0157]

[0158] It can be seen that the Lyapunov function V1, V2, V3∈L ∞ ,variable because Combining formula (4), we can know that z3∈L ∞ Combining the above results with equation (9) and equation (5), we can get Therefore, according to formula (14), we can know Combining formula (20), we can know

[0159]

[0160] According to formula (24), we can get

[0161]

[0162] Taking the derivative of equation (25) and using the above results, we can get

[0163]

[0164] Combining formula (31) with Lemma 2, we can see that Uniformly continuous. And because V3 ≥ 0, according to Lemma 3, This means

[0165]

[0166] For formula (9) Taking the derivative, combining equation (18) and substituting equation (29) into equation (29), we can get

[0167]

[0168] therefore Combining formula (30), we can know Using formula (23), we can know

[0169] Deriving the first equation of equation (14), and substituting the above result into

[0170]

[0171] Therefore, using Lemma 2, we can see that Consistently continuous. limit Exists and is bounded. Using Lemma 3, we can get

[0172]

[0173] According to formula (32), we can get

[0174]

[0175] In formula (9), Substitute, combine And formula (32) can be obtained

[0176]

[0177] According to Definition 2, Therefore, we can get Combining equation (2) and equation (32), we can get So the system is asymptotically stable. The proof is complete.

[0178] Note 2: From formula (5), we can see that the designed u d With r d Satisfy | d |≤u Max ,|r d |≤r Max , so they are bounded a priori. Therefore, u is bounded a priori d With r d All derivatives of exist, and under the condition of considering the maximum angular velocity and linear velocity that the system can achieve, a bounded time-varying smooth velocity control signal is provided for the robot.

[0179] Using the stabilization control method of this embodiment, the simulation effect is as follows: Figure 1 shown.

[0180] Example 2

[0181] A speed stabilization control system for an underactuated surface emergency robot, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the control method described in Example 1 when executing the computer program.

[0182] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims

1. A speed stabilization control method for an underactuated surface emergency robot, characterized in that: The following steps are involved: (1) Define an auxiliary variable ξ that explicitly contains the time variable t; (2) Based on the auxiliary variable ξ, define the auxiliary variable and Based on auxiliary variables and Design the Nussbaum compensation system and obtain the Nussbaum compensation system variables χ1 and χ2; (3) Based on the Nussbaum compensation system, a saturated nonlinear compensation system is designed to obtain the saturated nonlinear compensation system variables. Based on the saturated nonlinear compensation system, the hyperbolic tangent saturation function is used to design a priori bounded linear velocity control input u d and angular velocity control input r d .

2. The speed stabilization control method of an underactuated surface emergency robot according to claim 1, characterized in that: In step (1), the auxiliary variable ξ that explicitly contains the time variable t is defined as ξ=z3+Φ(Z)h t (4) Among them, the variable In the robot's body coordinate system, variable z1 is the longitudinal position error, variable z2 is the lateral position error, and variable z3 is the angular velocity error; Φ(Z) is a smooth κ-type saturated function with respect to variable Z, and its derivatives of all orders satisfy h t is a smooth function of the time variable t, whose derivatives satisfy and 3. The speed stabilization control method of an underactuated surface emergency robot according to claim 2, characterized in that: In step (2), define auxiliary variables and for The design parameters Design parameters v is the lateral velocity of the robot in the body coordinate system, and is the auxiliary signal generated by the saturation nonlinear compensation system, u Max and r Max are the maximum linear speed and angular speed rated for the robot respectively; Defining constants m 11 、m 22 is the system inertia parameter, including mass and additional mass; is the system hydrodynamic damping parameter; m 11 、m 22 and All are normal numbers; The auxiliary variable in formula (8) and Defined as The design parameter k2>0; definition 4. The speed stabilization control method of an underactuated surface emergency robot according to claim 3, characterized in that: In step (2), the adaptive law of Nussbaum compensation system variables χ1 and χ2 is designed as The constant is the design parameter; By integrating equation (7) using equation (8), we can obtain the Nussbaum compensation system variables χ1 and χ2.

5. The speed stabilization control method of an underactuated surface emergency robot according to claim 4, characterized in that: In step (3), the saturated nonlinear compensation system variables are designed for The constant is the design parameter; N(χ1) is the Nussbaum function of the auxiliary signal variable χ1; N(χ2) is the Nussbaum function of the auxiliary signal variable χ2.

6. The speed stabilization control method of an underactuated surface emergency robot according to claim 5, characterized in that: In step (3), design a priori bounded linear velocity control input u d and angular velocity control input r d for tanh(·) is an arbitrary variable The hyperbolic tangent function of ; Using equation (5) to integrate equation (6), we can get the saturated nonlinear compensation system variable: Using equation (5), calculate the a priori bounded linear velocity control input u d , angular velocity control input r d .

7. The speed stabilization control method of an underactuated surface emergency robot according to claim 6, characterized in that: The method also includes step (4) of closed-loop system stability analysis, and the specific method is as follows: Definition η e =[x e ,y e ,ψ e ] T is the full-state stabilization error vector of the underactuated robot in the geodetic coordinate system, z = [z1, z2, z3] T is the full-state stabilization error vector of the underactuated robot in the body coordinate system, and the two have the following relationship: Among them, x e is the position error in the x direction, y e is the position error in the y direction, ψ e is the heading angle error, ψ is the heading angle; Combining equations (2), (10) and (9), the system model of the underactuated surface emergency robot is established as follows: Constructing Lyapunov functions From equations (12) and (14), we can see that in Defining the Lyapunov function Combining equations (4), (9), (10), and (14), we can see that From equations (20), (15), and (17), we can see that Defining the Lyapunov function From equations (5), (6), (21), (22), (7), and (8), we can see that Integrating both sides of equation (26) over [0, t), we can obtain Notice It can be seen that the Lyapunov function V1, V2, V3∈L ∞ ,variable because It can be seen that z3∈L ∞ ; And then we know Depend on Consistently continuous, V3 ≥ 0, It can be seen that Depend on Consistent, continuous Combining (14), (32), (9) and It can be seen that From formula (37) and It can be seen that Combining equation (2) and equation (32), we can get So the system is asymptotically stable. From formula (5), we can see that u d With r d Satisfy | d |≤u Max ,|r d |≤r Max , so they are bounded a priori; therefore, u is bounded a priori d With r d All derivatives of exist, and under the condition of considering the maximum angular velocity and linear velocity that the system can achieve, a bounded time-varying smooth velocity control signal is provided for the robot.

8. A speed stabilization control system for an underactuated surface emergency robot, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the control method according to any one of claims 1 to 7 is implemented.