CN113238567B - Benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on extended state observer - Google Patents

Benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on extended state observer Download PDF

Info

Publication number
CN113238567B
CN113238567B CN202110482857.1A CN202110482857A CN113238567B CN 113238567 B CN113238567 B CN 113238567B CN 202110482857 A CN202110482857 A CN 202110482857A CN 113238567 B CN113238567 B CN 113238567B
Authority
CN
China
Prior art keywords
auv
benthonic
sliding mode
buffeting
derivative
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202110482857.1A
Other languages
Chinese (zh)
Other versions
CN113238567A (en
Inventor
孙延超
杜雨桐
孙超伟
万磊
曹禹
秦洪德
夏光庆
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN202110482857.1A priority Critical patent/CN113238567B/en
Publication of CN113238567A publication Critical patent/CN113238567A/en
Application granted granted Critical
Publication of CN113238567B publication Critical patent/CN113238567B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/04Control of altitude or depth
    • G05D1/06Rate of change of altitude or depth
    • G05D1/0692Rate of change of altitude or depth specially adapted for under-water vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

A benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on an extended state observer relates to the field of underwater vehicle control, aims at the problems of limited control precision and low adjusting speed of a control method in the prior art, and comprises the following steps: the method comprises the following steps: establishing a benthonic AUV motion equation, and constructing a benthonic AUV error model according to the benthonic AUV motion equation; step two: constructing a benthonic AUV point stabilized tracking error model according to the benthonic AUV error model; step three: designing a self-adaptive supercoiled extended state observer; step four: constructing a second-order buffeting-free nonsingular integral terminal sliding mode surface; step five: and designing a controller according to a benthonic AUV point stabilized tracking error model, a self-adaptive supercoiled extended state observer and a second-order buffeting-free nonsingular integral terminal sliding mode surface. The method and the device can converge to a stable state within a limited time, can keep better stability after the pose error converges to zero, and have high convergence speed.

Description

Benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on extended state observer
Technical Field
The invention relates to the field of underwater vehicle control, in particular to a benthonic AUV weak trembling integral sliding mode point stabilizing control method based on an extended state observer.
Background
The ocean occupies two thirds of the total area of the earth, and the abundant mineral and aquatic resources are deeply valued by all countries in the world. As an important tool for marine information detection and marine resource development, Autonomous Underwater Vehicles (AUVs) play a very large role in various fields. At present, as the development demand for deeper and wider oceans increases, the existing cruise-type AUV suitable for large-range operation and hover-type AUV suitable for small-range operation have not been able to meet the demand. The main reasons are that the fixed-point observation capability of the cruise AUV is poor, and the large-range investigation capability of the hovering AUV is poor. Under the background, the concept of the benthonic AUV is also proposed, and as a novel underwater vehicle combining all characteristics of the hovering AUV and the cruise AUV, the benthonic AUV is characterized in that the benthonic AUV can meet the requirement for identifying a tiny target while completing a submarine seat elevation precision detection task. However, due to the complex motion system, such modified AUV is also a typical nonlinear strong coupling system, which not only has the research obstacles of AUV commonalities such as poor convergence performance of control method, complex working environment, difficult accurate solution of hydrodynamic parameters, but also has the influence factors of hydrodynamic coefficient perturbation, easy collision of carriers (huge, sea peak correction. intelligent underwater robot research progress [ J ] Science and Technology introduction, 2015,33(23):66-71.pan sho, JIU haifeng. The concept diagram of the benthic AUV is shown in figure 1, figure 2 and figure 3, and the outline diagram is shown in figure 4.
The final goal of the benthonic AUV navigation motion is that the benthonic AUV can sit in a fixed circle with the preset position as the center of the circle from the bottom to the sea bottom. Accurate trajectory tracking precision and point stabilization precision are important determinants that the AUV can accurately reach a preset seabed area. In navigation and fixed-point hovering, factors such as external interference, uncertainty of parameters of the benthonic AUV model, limitation of an actuator and the like have great influence on the control precision and stability of the benthonic AUV. Therefore, high point-stabilizing control accuracy and stability are important for accurate landing of the benthonic AUV, and the fixed-point hovering motion of the benthonic AUV after reaching the offshore fixed area is an extremely important step for landing the benthonic AUV to the seabed fixed position by adjusting the vertical reverse thrust. The premise for enabling the benthonic AUV to realize fixed-point hovering motion and complete specified tasks is to design an effective control law and guarantee high-precision sitting at a fixed point on the sea bottom in a short time (Xuyu such as Xiaokun. Intelligent ocean robot technical progress [ J ]. Automation report, 2007(05):518-521.Xu yuru, Xiao Kun. technical progress of intracellular ocean robot [ J ]. Acta Automatica Sinica,2007(05): 518-521). The current common AUV point stabilization method is usually to design a robust controller for external disturbance or to approximate the total interference of the system by a neural network. However, such methods have the following disadvantages: firstly, the control precision is limited or the calculated amount is overlarge; and secondly, the adjusting speed is slower. Therefore, the existing AUV point stabilization control method cannot meet the requirement of the benthonic AUV on the bottom movement.
Disclosure of Invention
The purpose of the invention is: aiming at the problems of limited control precision and low adjustment speed of a control method in the prior art, the benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on the extended state observer is provided.
The technical scheme adopted by the invention to solve the technical problems is as follows:
a benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on an extended state observer comprises the following steps:
the method comprises the following steps: establishing a benthonic AUV motion equation, and constructing a benthonic AUV error model according to the benthonic AUV motion equation;
step two: constructing a benthonic AUV point stabilized tracking error model according to the benthonic AUV error model;
step three: designing a self-adaptive supercoiled extended state observer;
step four: constructing a second-order buffeting-free nonsingular integral terminal sliding mode surface;
step five: and designing a controller according to a benthonic AUV point stabilized tracking error model, a self-adaptive supercoiled extended state observer and a second-order buffeting-free nonsingular integral terminal sliding mode surface.
Further, the benthonic AUV equation of motion is expressed as:
Figure BDA0003049061180000021
Figure BDA0003049061180000022
Figure BDA0003049061180000023
where M is a mass inertia matrix, η [ [ ξ n ζ φ θ ψ [ ]]ΤWhen a benthonic AUV moves under a fixed coordinate system, the position and the posture of six degrees of freedom in a three-dimensional space are divided into upsilon [ uv w p q r ═ v]ΤThe speed and the angular speed in the three-dimensional space when moving under the carrier coordinate system,
Figure BDA0003049061180000024
when the benthonic AUV moves, a coordinate transformation matrix between a coordinate system and a carrier coordinate system is fixed,
Figure BDA0003049061180000025
for the nominal values of the parameters of the model,
Figure BDA0003049061180000026
the control force and the moment vector generated when the benthonic AUV actuator operates,
Figure BDA0003049061180000027
for model parameter uncertainty and ambianceThe time-varying interference is superposed with the comprehensive interference item,
Figure BDA0003049061180000028
perturbation values of model parameters, τd(t) is the external time-varying interference,
Figure BDA0003049061180000029
is the first derivative of v and,
Figure BDA0003049061180000031
is a comprehensive interference item formed by superposing model parameter uncertainty and external time-varying interference,
Figure BDA0003049061180000032
the first derivative of η.
Further, the benthonic AUV point stabilized tracking error model is expressed as:
Figure BDA0003049061180000033
Figure BDA0003049061180000034
Figure BDA0003049061180000035
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000036
as an auxiliary variable, the number of variables,
Figure BDA0003049061180000037
is omegaeThe first derivative of (a) is,
Figure BDA0003049061180000038
is omegaeThe second derivative of (a) is,
Figure BDA0003049061180000039
is etaeFirst derivative of, ηeIs the position tracking error;
b=R(η)M-1
Figure BDA00030490611800000310
the above-mentioned
Figure BDA00030490611800000311
The following relationship is satisfied:
||F(t)||<Dm
Figure BDA00030490611800000312
Dmactual value of unknown boundary, δ, of F (t)mIs composed of
Figure BDA00030490611800000313
Is determined by the actual value of the unknown boundary,
Figure BDA00030490611800000314
is deltamIs determined by the estimated value of (c),
Figure BDA00030490611800000315
is composed of
Figure BDA00030490611800000316
B is the control gain, F (t) is the auxiliary variable,
Figure BDA00030490611800000317
is the first derivative of F (t),
Figure BDA00030490611800000318
is the first derivative of b and is,
Figure BDA00030490611800000319
the first derivative of τ.
Further, the adaptive supercoiled extended state observer is represented as:
Figure BDA00030490611800000320
Figure BDA00030490611800000321
in the formula (I), the compound is shown in the specification,
Figure BDA00030490611800000322
is an observer variable, K1、K2To observer gain, K1、K2Are all positive fixed diagonal arrays,
Figure BDA00030490611800000323
as an auxiliary variable, the auxiliary variable expression is as follows:
K1=diag(K11,K12,K13,K14,K15,K16)
K2=diag(K21,K22,K23,K24,K25,K26)
Figure BDA00030490611800000324
Figure BDA00030490611800000325
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000041
the expression of i ═ 1,2,3,4,5,6 is as follows:
Figure BDA0003049061180000042
Figure BDA0003049061180000043
in the formula, mu1i2iAre all normal numbers, i is 1,2,3,4,5,6,
Figure BDA0003049061180000044
estimating an error for an observer;
the adaptation law is represented as:
Figure BDA0003049061180000045
Figure BDA0003049061180000046
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000047
K1i(t) are all adaptive variables, c1i、c2i、c3i、HiAre all control parameters and are positive numbers.
Further, the second-order bufferless nonsingular integral terminal sliding mode surface is expressed as:
Figure BDA0003049061180000048
wherein λ is a positive number, and β ∈ R6×6Is a diagonal matrix, s is a sliding mode surface function, sigma is an auxiliary variable,
Figure BDA0003049061180000049
for the control parameter, d τ is the integration operator.
Further, the control law of the second-order buffeting-free nonsingular integral terminal sliding mode surface is expressed as:
τ=τ12
in the formula (I), the compound is shown in the specification,
Figure BDA00030490611800000410
Figure BDA00030490611800000411
Figure BDA00030490611800000412
Figure BDA00030490611800000413
Figure BDA0003049061180000051
in the formula, k4For switching term gain, normal, k6Is a positive number,/1And l2In order to control the parameters of the device,
Figure BDA0003049061180000052
is an estimated value of the observer state variable,
Figure BDA0003049061180000053
is tau2The first derivative of (d), phi are integral operators,
Figure BDA0003049061180000054
is composed of
Figure BDA0003049061180000055
The first derivative of (a);
the self-adaptive law of the second-order buffeting-free nonsingular integral terminal sliding mode surface is expressed as follows:
Figure BDA0003049061180000056
in the formula, k5Is a normal number.
The invention has the beneficial effects that:
the algorithm improves a discontinuous time invariant control method, ensures the continuity of a control law by designing a second-order buffeting-free nonsingular integral terminal sliding mode controller, and can obtain required steady-state precision within limited time. The convergence algorithm can converge to a stable state within a limited time, the pose error can keep better stability after converging to zero, the convergence speed is high, the change of the controller is more gentle, the curve is smoother, and the convergence speed and the robustness of the controller are superior to those of the existing controller in the error convergence process. Compared with the existing controller, the controller has the advantages that the convergence time is shortened by 47%, and in response curves of the vertical speed, the yaw rate and the pitch angle rate, the convergence time is shortened by 25% compared with the existing controller.
Drawings
FIG. 1 is a conceptual diagram of a benthic AUV 1;
FIG. 2 is a conceptual diagram of a benthic AUV 2;
FIG. 3 is a conceptual diagram of a benthic AUV of FIG. 3;
FIG. 4 is a schematic view of a submersible AUV;
FIG. 5 is a graph of AUV longitudinal tracking error response;
FIG. 6 is a graph of AUV lateral tracking error response;
FIG. 7 is a graph of AUV vertical tracking error response;
FIG. 8 is a AUV pitch angle tracking error response graph;
FIG. 9 is a graph of AUV yaw angle tracking error response;
FIG. 10 is a graph of AUV longitudinal velocity response;
FIG. 11 is a graph of AUV lateral velocity response;
FIG. 12 is a graph of AUV vertical velocity response;
FIG. 13 is an AUV yaw rate response graph;
fig. 14 is an AUV pitch rate response plot.
Detailed Description
It should be noted that, in the present invention, the embodiments disclosed in the present application may be combined with each other without conflict.
The first embodiment is as follows: the present embodiment is specifically described with reference to fig. 1, fig. 2, fig. 3, and fig. 4, and a benthic AUV weak buffeting integral sliding mode point stabilization control method based on an extended state observer according to the present embodiment includes the following steps:
the method comprises the following steps: establishing a benthonic AUV motion equation, and constructing a benthonic AUV error model according to the benthonic AUV motion equation;
step two: constructing a benthonic AUV point stabilized tracking error model according to the benthonic AUV error model;
step three: designing a self-adaptive supercoiled extended state observer;
step four: constructing a second-order buffeting-free nonsingular integral terminal sliding mode surface;
step five: and designing a controller according to a benthonic AUV point stabilized tracking error model, a self-adaptive supercoiled extended state observer and a second-order buffeting-free nonsingular integral terminal sliding mode surface.
Related Key technology
The kinematic and kinetic equations of benthic AUV are expressed in Newton-Euler equations based on rigid body motion in fluids as proposed by Fossen (Debitto P A. fuzzy logic for depth control of infinite undersea vessels. Proeekings of Symposium of Autonomus Underwater vessel Technology [ J ].1994: 233-241.):
Figure BDA0003049061180000061
where M is a mass inertia matrix, η [ ξ n ζ φ θ ψ ]]ΤRepresenting six-degree-of-freedom position and posture in three-dimensional space when the benthonic AUV moves under a fixed coordinate system, and upsilon ═ u v w p q r]ΤRepresenting the speed and angular velocity in three-dimensional space when moving under a carrier coordinate systemThe degree of the magnetic field is measured,
Figure BDA0003049061180000062
when representing the benthonic AUV, fixing a coordinate transformation matrix between a coordinate system and a carrier coordinate system;
Figure BDA0003049061180000063
a Coriolis matrix containing additional mass items and a centripetal force matrix;
Figure BDA0003049061180000064
is a fluid damping matrix;
Figure BDA0003049061180000065
the restoring force and restoring moment vector generated by the gravity and buoyancy acting on the bentable AUV.
Figure BDA0003049061180000066
The control force and moment vector quantity generated when the benthonic AUV actuator operates;
Figure BDA0003049061180000067
the disturbance vector caused by the external interference.
The external disturbances experienced by an AUV in the ocean are quite complex and have a significant impact on the dynamics and control performance of the underwater vehicle. The method considers model uncertainty and ocean current disturbance, considers the model uncertainty and the ocean current disturbance as a disturbance lumped term, and considers feasible mathematical expression forms of the disturbance lumped term.
Sliding mode control: sliding Mode Control (SMC) is also called variable structure control, and from the aspect of control characteristics, sliding mode control belongs to a nonlinear control method, and the control strategy is different from other controls in that the "structure" of a system is not fixed, but can be purposefully and continuously changed according to the current state of the system in a dynamic process, so that the system is forced to move according to a state track of a predetermined "sliding mode". The control law designed based on the sliding mode control method is usually discontinuous, and the sliding mode control has the advantages of fast output response, simple engineering application, strong robustness and the like.
And (3) expanding the state observer: the disturbance action suffered by the control system is expanded into a new state variable, the new state variable is observed and approximated by using a feedback mechanism, and the expanded state observer does not need to measure the disturbance action or know a specific model of the disturbance, so that the method is widely applied to engineering practice. For the underwater robot control system with the characteristics of strong coupling and nonlinearity, the finite time supercoiled extended state observer can carry out online observation on the total disturbance of the system, and the method is a method for effectively solving the problem of unknown total disturbance in the system.
Parameter definition: m is a mass inertia matrix; eta ═ ξ n ζ phi psi]ΤThe six-degree-of-freedom position and attitude value of the benthonic AUV under the fixed coordinate system; etad=[ξd nd ζd φd θd ψd]ΤThe six-degree-of-freedom position and attitude expected value of the benthonic AUV under a fixed coordinate system; etaeIs the position tracking error; omega is an auxiliary state variable; υ ═ u v w p q r]ΤThe speed and the angular velocity quantity under the motion coordinate system are obtained; r (eta) is a conversion matrix between a fixed coordinate system and a motion coordinate system; c (upsilon) is a Coriolis force and centripetal force matrix of a rigid body; d (upsilon) is a hydrodynamic damping matrix; g (η) is a force vector and a moment vector generated by gravity and buoyancy; tau is the control force and moment generated by the propulsion system; tau isdExternal interference; z is an observer system auxiliary variable;
Figure BDA0003049061180000071
observing the observer system; f is a comprehensive interference item;
Figure BDA0003049061180000072
the observed value of the comprehensive interference item is obtained;
Figure BDA0003049061180000073
adapting parameters for the controller; s is a sliding mode surface function;
the key steps of the invention patent are as follows: the invention designs a self-adaptive buffeting-free non-singular integral sliding mode controller based on an AUV point stabilization control error model to solve the problem of benthic AUV point stabilization control. In the controller design, firstly, an adaptive supercoiled extended state observer is adopted to eliminate the influence of external interference and model parameter uncertainty on a control system, then a new second-order bufferless nonsingular integral sliding mode function is designed, an AUV point stabilizing control law is designed based on the sliding mode function, and a self-adaptive method is adopted to eliminate the first order derivative of disturbance in second-order sliding mode control. The designed controller proves the limited time convergence performance through the Lyapunov stability theory. Finally, simulation tests prove that the designed controller has better control performance compared with the existing controller.
By adopting the method, the benthonic AUV motion control system can realize point stabilization control in a limited time under the condition of external interference, and a good expected effect is achieved.
Benthonic AUV motion system model
The formula (1) is used for establishing a benthonic AUV motion equation considering external interference
Figure BDA0003049061180000081
Where M is a mass inertia matrix, η [ ξ n ζ φ θ ψ ]]ΤRepresenting six-degree-of-freedom position and posture in three-dimensional space when the benthonic AUV moves under a fixed coordinate system, and upsilon ═ u v w p q r]ΤRepresenting the velocity and angular velocity in three-dimensional space when moving in the carrier coordinate system,
Figure BDA0003049061180000082
when representing the benthonic AUV, fixing a coordinate transformation matrix between a coordinate system and a carrier coordinate system;
Figure BDA0003049061180000083
a Coriolis matrix containing additional mass items and a centripetal force matrix;
Figure BDA0003049061180000084
is a fluid damping matrix;
Figure BDA0003049061180000085
restoring force and restoring moment vectors generated by the action of gravity and buoyancy on the bentable AUV;
Figure BDA0003049061180000086
the control force and moment vectors are generated when the benthonic AUV actuator operates;
Figure BDA0003049061180000087
the disturbance vector caused by the external interference. For the AUV motion mathematical model (2), the model uncertainty is represented by inertia uncertainty, hydrodynamic coefficient uncertainty and uncertainty of gravity and buoyancy, namely the values of M, C (upsilon), D (upsilon) and g (eta) matrixes are not completely accurate. Model uncertainty is typically expressed in the form:
Figure BDA0003049061180000088
Figure BDA0003049061180000089
Figure BDA00030490611800000810
in the formula, C (ν), D (ν), and g (η) represent actual values of model parameters.
Figure BDA00030490611800000811
The nominal values (estimated values) of the model parameters are represented.
Figure BDA00030490611800000812
Perturbation values representing model parameters.
And substituting the model parameter uncertainty model (3) into the AUV motion mathematical model (2) to obtain:
Figure BDA00030490611800000813
Figure BDA00030490611800000814
in the formula (I), the compound is shown in the specification,
Figure BDA00030490611800000815
AUV motion mathematical model reference formula (4) considering external time-varying interference and model uncertainty, in the form:
Figure BDA00030490611800000816
Figure BDA00030490611800000817
in the formula (I), the compound is shown in the specification,
Figure BDA00030490611800000818
and a comprehensive interference item representing superposition of model parameter uncertainty and external time-varying interference, and the form is as follows:
Figure BDA00030490611800000819
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000091
representing model parametersPerturbation portions of numbers, and all with unknown boundaries; tau isd(t) represents an external time-varying disturbance.
Assume that 1: the invention assumes that the external interference is taudThe boundary is existed, the boundary is unknown, and the first derivative thereof is existed, namely the following relation is satisfied:
Figure BDA0003049061180000092
Figure BDA0003049061180000093
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000094
is an unknown positive number.
Definition variable d (t) RM-1τd(t) from τd(t) and
Figure BDA0003049061180000095
is known as the boundedness of d (t) and
Figure BDA00030490611800000917
also with boundaries, the boundary conditions being unknown, i.e. satisfying the formula
Figure BDA0003049061180000096
Figure BDA0003049061180000097
In the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000098
is an unknown positive number.
Assume 2: defining variables
Figure BDA0003049061180000099
P represents a model parameter in the model, wherein the superposition term is animated, and a boundary exists in P, and the first derivative of P with respect to time also exists in the boundary, and the boundary is unknown, namely the following relation is satisfied:
Figure BDA00030490611800000910
Figure BDA00030490611800000911
in the formula (I), the compound is shown in the specification,
Figure BDA00030490611800000912
are all unknown positive numbers.
Point-stabilized control error model
For the convenience of the controller design of the invention, on the basis of the benthonic AUV error model (5), the model needs to be further deformed, and a new state variable is defined firstly:
ω=R(η)υ (6)
in the formula (I), the compound is shown in the specification,
Figure BDA00030490611800000913
deriving from (6):
Figure BDA00030490611800000914
the benthonic AUV motion mathematical model can be converted into the following form through formulas (5), (6) and (7):
Figure BDA00030490611800000915
Figure BDA00030490611800000916
defining the benthonic AUV point stabilized tracking error variable as follows:
ηe=η-ηd
Figure BDA0003049061180000101
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000102
indicating that the AUV is in the desired pose,
Figure BDA0003049061180000103
and (3) converting the AUV point stabilization control problem into an error convergence problem by establishing an error model in a vertical (8) form. The basic goal of the control law design of the invention is to make the pose error etaeCan converge to zero within a limited time and maintain a steady state.
For omegaeThe formula is derived:
Figure BDA0003049061180000104
thus, the AUV three-dimensional point stabilized control error model is expressed as follows:
Figure BDA0003049061180000105
Figure BDA0003049061180000106
Figure BDA0003049061180000107
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000108
b=R(η)M-1
Figure BDA0003049061180000109
and the comprehensive interference item represents the superposition of the external time-varying interference and the uncertainty of the model parameter.
From hypotheses 1 and 2, the synthetic interference f (t) is bounded, and the boundary unknown, whose first derivative with respect to time is also bounded, i.e., satisfies the following relationship:
Figure BDA00030490611800001010
in the formula, Dm、δmAre all unknown positive numbers. The deviation variables are defined as follows:
Figure BDA00030490611800001011
in the formula, deltamTo represent
Figure BDA00030490611800001012
Is determined by the actual value of the unknown boundary,
Figure BDA00030490611800001013
represents deltamIs determined by the estimated value of (c),
Figure BDA00030490611800001014
to represent
Figure BDA00030490611800001015
Is estimated. The invention can be realized by an adaptive control method during the design of the controller
Figure BDA00030490611800001016
The finite time of (c) converges.
Design of self-adaptive supercoiled extended state observer
The self-adaptive supercoiled extended state observer is designed to carry out on-line observation on the comprehensive interference and eliminate the influence of the comprehensive interference on the stability of a control system.
The method comprises the following steps: the observer auxiliary state variable z is defined according to the (10) AUV mathematical model, of the form:
z=ωe+Ληe (11)
wherein z is [ z ]1,z2,z3,z4,z5,z6]T
Figure BDA0003049061180000111
Is a positive fixed constant diagonal matrix.
Taking the derivative with respect to time for (11):
Figure BDA0003049061180000112
let G (η, ν, t) f (η, ν, t) + Λ ωeEquation (12) can be expressed as:
Figure BDA0003049061180000113
step two: taking the integrated interference term f (t) in equation (9) as an extended state variable, equation (9) can be extended to:
Figure BDA0003049061180000114
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000115
representing the derivative of the extended state variable f (t) with respect to time.
Figure BDA0003049061180000116
Will be used in the design of a supercoiled state observer.
Step three: the observer state variable error model is defined as follows:
Figure BDA0003049061180000117
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000118
is an estimate of the observer state variable,
Figure BDA0003049061180000119
representing the observer state variable error.
The state variable error based on (15) defines a supercoiled disturbance observer of the form:
Figure BDA00030490611800001110
in the formula, K1、K2Is the observer gain, which is a positive fixed diagonal matrix, K1、K2
Figure BDA00030490611800001111
The expression is as follows:
K1=diag(K11,K12,K13,K14,K15,K16)
K2=diag(K21,K22,K23,K24,K25,K26)
Figure BDA00030490611800001112
Figure BDA00030490611800001113
in the formula,
Figure BDA00030490611800001114
The expression of i ═ 1,2,3,4,5,6 is as follows:
Figure BDA00030490611800001115
Figure BDA00030490611800001116
in the formula, mu1i2iAll of (i ═ 1,2,3,4,5, and 6) are normal numbers.
K1i,K2i(i ═ 1,2,3,4,5,6) is updated in real time through an adaptive law, so that the disturbance observer achieves a better convergence effect, and the adaptive law is designed as follows:
Figure BDA0003049061180000121
Figure BDA0003049061180000126
in the formula, c1i、c2i、c3i、HiAre all known positive numbers.
For the extended state system (15), the observer state variable error is adaptively modified by the gain of the generalized supercoiled extended state observer (17) of (16)
Figure BDA0003049061180000122
Can converge to zero in a finite time.
Second-order buffeting-free sliding mode controller design
Based on a better buffeting eliminating effect of a second-order slip form, the invention provides a novel second-order buffeting-free nonsingular integral terminal slip form controller which is applied to AUV point stabilization control.
Designing a new second-order integral sliding mode function form as follows:
Figure BDA0003049061180000123
wherein λ is a known positive number, and β ∈ R6×6Known as diagonal matrix.
The following is derived from equation (18):
Figure BDA0003049061180000124
in order to enable the control system (9) to reach the sliding mode switching surface s equal to 0 within a limited time and then converge to an origin along the sliding mode surface within the limited time, a second-order sliding mode function in the form of a formula (18) is adopted, and a control law is designed as follows:
τ=τ12 (20)
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000125
Figure BDA0003049061180000131
Figure BDA0003049061180000132
Figure BDA0003049061180000133
Figure BDA0003049061180000134
in the formula, k4Is the switching term gain, which is a normal number. k is a radical of6Is a known positive number.
The equation (23) proves that the actual control law is continuous and smooth by integrating the differential control input containing the sign function, and no high-frequency switching term exists, so that the buffeting problem in the traditional sliding mode control is eliminated. The second-order buffeting-free terminal sliding mode controller provided by the invention is added with the integral term, so that the fast convergence can be realized, and a good control effect can be obtained.
The second-order integral sliding mode function based on the form of the formula (18) can generate a first derivative of comprehensive disturbance after derivation, and in order to eliminate the influence of the uncertain term, an adaptive law form of the following form is designed:
Figure BDA0003049061180000135
in the formula, k5Known as normal.
The adaptive law enables approximation of the first derivative of the synthetic disturbance with respect to time.
Theoretical basis
Benthonic AUV motion system model
The formula (1) is used for establishing a benthonic AUV motion equation considering external interference
Figure BDA0003049061180000136
Where M is a mass inertia matrix, η [ ξ n ζ φ θ ψ ]]ΤRepresenting six-degree-of-freedom position and posture in three-dimensional space when the benthonic AUV moves under a fixed coordinate system, and upsilon ═ u v w p q r]ΤRepresenting the velocity and angular velocity in three-dimensional space when moving in the carrier coordinate system,
Figure BDA0003049061180000137
when representing the benthonic AUV, fixing a coordinate transformation matrix between a coordinate system and a carrier coordinate system;
Figure BDA0003049061180000138
a Coriolis matrix containing additional mass items and a centripetal force matrix;
Figure BDA0003049061180000139
is a fluid damping matrix;
Figure BDA00030490611800001310
restoring force and restoring moment vectors generated by the action of gravity and buoyancy on the bentable AUV;
Figure BDA00030490611800001311
the control force and moment vectors are generated when the benthonic AUV actuator operates;
Figure BDA0003049061180000141
the disturbance vector caused by the external interference. For the AUV motion mathematical model (2), the model uncertainty is represented by inertia uncertainty, hydrodynamic coefficient uncertainty and uncertainty of gravity and buoyancy, namely the values of M, C (upsilon), D (upsilon) and g (eta) matrixes are not completely accurate. Model uncertainty is typically expressed in the form:
Figure BDA0003049061180000142
Figure BDA0003049061180000143
Figure BDA0003049061180000144
in the formula, C (ν), D (ν), and g (η) represent actual values of model parameters.
Figure BDA0003049061180000145
The nominal values (estimated values) of the model parameters are represented.
Figure BDA0003049061180000146
Perturbation values representing model parameters.
Substituting the model parameter uncertainty model (26) into the AUV motion mathematical model (25) yields:
Figure BDA0003049061180000147
Figure BDA0003049061180000148
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000149
AUV motion mathematical model reference equation (27) considering external time-varying interference and model uncertainty, in the form:
Figure BDA00030490611800001410
Figure BDA00030490611800001411
in the formula (I), the compound is shown in the specification,
Figure BDA00030490611800001412
and a comprehensive interference item representing superposition of model parameter uncertainty and external time-varying interference, and the form is as follows:
Figure BDA00030490611800001413
in the formula (I), the compound is shown in the specification,
Figure BDA00030490611800001414
representing the perturbed part of the model parameters, and all having unknown boundaries; tau isd(t) represents an external time-varying disturbance.
Assume that 1: the invention assumes that the external interference is taudThe boundary is existed, the boundary is unknown, and the first derivative thereof is existed, namely the following relation is satisfied:
Figure BDA00030490611800001415
Figure BDA00030490611800001416
in the formula (I), the compound is shown in the specification,
Figure BDA00030490611800001417
is an unknown positive number.
Definition variable d (t) RM-1τd(t) from τd(t) and
Figure BDA00030490611800001418
is known as the boundedness of d (t) and
Figure BDA00030490611800001419
also with boundaries, the boundary conditions being unknown, i.e. satisfying the formula
Figure BDA0003049061180000151
Figure BDA0003049061180000152
In the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000153
is an unknown positive number.
Assume 2: defining variables
Figure BDA0003049061180000154
P represents a model parameter in the model, wherein the superposition term is animated, and a boundary exists in P, and the first derivative of P with respect to time also exists in the boundary, and the boundary is unknown, namely the following relation is satisfied:
Figure BDA0003049061180000155
Figure BDA0003049061180000156
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000157
are all unknown positive numbers.
Point-stabilized control error model
For the design of the controller, the model needs to be further deformed on the basis of the benthonic AUV error model (28), and a new state variable is defined firstly:
ω=R(η)υ (29)
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000158
deriving (29) as:
Figure BDA0003049061180000159
the benthonic AUV motion mathematical model can be converted into the following form through formulas (28), (29) and (30):
Figure BDA00030490611800001515
Figure BDA00030490611800001510
defining the benthonic AUV point stabilized tracking error variable as follows:
ηe=η-ηd
Figure BDA00030490611800001511
in the formula (I), the compound is shown in the specification,
Figure BDA00030490611800001512
indicating that the AUV is in the desired pose,
Figure BDA00030490611800001513
and converting the AUV point stabilization control problem into an error convergence problem by establishing an error model in a vertical (31) form. The basic goal of the control law design of the invention is to make the pose error etaeCan converge to zero within a limited time and maintain a steady state.
For omegaeThe formula is derived:
Figure BDA00030490611800001514
thus, the AUV three-dimensional point stabilized control error model is expressed as follows:
Figure BDA0003049061180000161
Figure BDA0003049061180000162
Figure BDA0003049061180000163
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000164
b=R(η)M-1
Figure BDA0003049061180000165
and the comprehensive interference item represents the superposition of the external time-varying interference and the uncertainty of the model parameter.
From hypotheses 1 and 2, the synthetic interference f (t) is bounded, and the boundary unknown, whose first derivative with respect to time is also bounded, i.e., satisfies the following relationship:
Figure BDA0003049061180000166
in the formula, Dm、δmAre all unknown positive numbers. The deviation variables are defined as follows:
Figure BDA0003049061180000167
in the formula, deltamTo represent
Figure BDA0003049061180000168
Is determined by the actual value of the unknown boundary,
Figure BDA0003049061180000169
represents deltamIs determined by the estimated value of (c),
Figure BDA00030490611800001610
to represent
Figure BDA00030490611800001611
Is estimated. The invention can be realized by an adaptive control method during the design of the controller
Figure BDA00030490611800001612
The finite time of (c) converges.
Theorem of finite time convergence
Consider the following control system:
Figure BDA00030490611800001613
it is assumed that there is a continuous differentiable function V (x) and an open set
Figure BDA00030490611800001614
Let Lyapunov function V (x) satisfy the following relation:
Figure BDA00030490611800001615
wherein, omega is more than 0 and less than 1, and lambda is positive number. Then, from
Figure BDA00030490611800001616
Starting from any point as a starting position, V (x) can reach V (x) 0 in a limited time, and the convergence time meets the following relation:
Figure BDA00030490611800001617
defining a vector
Figure BDA00030490611800001618
If x represents a two-norm of x, then x satisfies the following relationship:
||x||≤|x|
design of self-adaptive supercoiled extended state observer
The self-adaptive supercoiled extended state observer is designed to carry out on-line observation on the comprehensive interference and eliminate the influence of the comprehensive interference on the stability of a control system.
The method comprises the following steps: an observer auxiliary state variable z is defined according to the AUV mathematical model (32), of the form:
z=ωe+Ληe (34)
wherein z is [ z ]1,z2,z3,z4,z5,z6]T
Figure BDA0003049061180000171
Is a positive fixed constant diagonal matrix.
Taking the derivative with respect to time for (34):
Figure BDA0003049061180000172
let G (η, ν, t) f (η, ν, t) + Λ ωeEquation (34) can be expressed as:
Figure BDA0003049061180000173
step two: taking the integrated interference term f (t) in equation (33) as the extended state variable, equation (9) can be extended to:
Figure BDA0003049061180000174
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000175
representing the derivative of the extended state variable f (t) with respect to time.
Figure BDA0003049061180000176
Will be used in the design of a supercoiled state observer.
Step three: the observer state variable error model is defined as follows:
Figure BDA0003049061180000177
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000178
is an estimate of the observer state variable,
Figure BDA0003049061180000179
representing the observer state variable error.
The supercoiled disturbance observer of the form is defined based on the state variable error of (38):
Figure BDA00030490611800001710
in the formula, K1、K2Is the observer gain, which is a positive fixed diagonal matrix, K1、K2
Figure BDA00030490611800001711
The expression is as follows:
K1=diag(K11,K12,K13,K14,K15,K16)
K2=diag(K21,K22,K23,K24,K25,K26)
Figure BDA00030490611800001712
Figure BDA00030490611800001713
in the formula (I), the compound is shown in the specification,
Figure BDA00030490611800001714
the expression is as follows:
Figure BDA0003049061180000181
Figure BDA0003049061180000182
in the formula, mu1i2iAll of (i ═ 1,2,3,4,5, and 6) are normal numbers.
K1i,K2i(i ═ 1,2,3,4,5,6) is updated in real time through an adaptive law, so that the disturbance observer achieves a better convergence effect, and the adaptive law is designed as follows:
Figure BDA0003049061180000183
Figure BDA0003049061180000184
in the formula, c1i、c2i、c3i、HiAre all known positive numbers.
For extended state systems (34), the observer state variable error is adaptively scaled by a generalized supercoiled extended state observer of (39) and gain of (40)
Figure BDA0003049061180000187
Can converge to zero in a finite time. The process of identification is described in the literature (Guerrero J A, Torres J, Creuze V, et al]Ocean Engineering,2020,200: 107080.). The interference observer adopted by the invention introduces adaptive gain, so that the control system has better robustness to external interference and perturbation of model parameters, meanwhile, the requirement on interference prior knowledge is relaxed, and the interference boundary is not necessary information for the controller any more, thus having good control effect on processing complex interference or interference with larger amplitude.
Second-order buffeting-free sliding mode controller design
Based on a better buffeting eliminating effect of a second-order slip form, the invention provides a novel second-order buffeting-free nonsingular integral terminal slip form controller which is applied to AUV point stabilization control.
Designing a new second-order integral sliding mode function form as follows:
Figure BDA0003049061180000185
wherein λ is a known positive number, and β ∈ R6×6Known as diagonal matrix.
The following is derived from equation (41):
Figure BDA0003049061180000186
in order to enable the control system (32) to reach the sliding mode switching surface s equal to 0 within a limited time and then converge to an origin along the sliding mode surface within the limited time, a second-order sliding mode function in the form of a formula (41) is adopted, and a control law is designed as follows:
τ=τ12 (43)
Figure BDA0003049061180000191
Figure BDA0003049061180000192
Figure BDA0003049061180000193
Figure BDA0003049061180000194
Figure BDA0003049061180000195
in the formula, k4Is the switching term gain, which is a normal number. k is a radical of6Is a known positive number.
Equation (46) proves that the actual control law is continuous and smooth by integrating the differential control input containing the sign function, and no high-frequency switching term exists, so that the buffeting problem in the traditional sliding mode control is eliminated. The second-order buffeting-free terminal sliding mode controller provided by the invention is added with the integral term, so that the fast convergence can be realized, and a good control effect can be obtained.
The second-order integral sliding mode function based on the form of the formula (41) can generate a first derivative of comprehensive disturbance after derivation, and in order to eliminate the influence of the uncertain term, an adaptive law form of the following form is designed:
Figure BDA0003049061180000196
in the formula, k5Known as normal.
The adaptive law enables approximation of the first derivative of the synthetic disturbance with respect to time.
The limited time convergence of the designed controller is proved by the Lyapunov stability theory, and the proving process is divided into the following two steps:
(1) the consistent bounded stability of the closed-loop system is proved, so that the bounded property of the adaptive error variable is proved;
(2) the finite time convergence of the sliding-mode variable sigma is demonstrated.
To verify consistent bounded convergence of the controller of the present invention, a Lyapunov function of the form:
Figure BDA0003049061180000197
deriving (48) as:
Figure BDA0003049061180000201
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000202
(49) the transformation can be as follows:
Figure BDA0003049061180000203
bringing (28) and (38) into (50) to obtain:
Figure BDA0003049061180000204
bringing equations (39) and (40) into (51) results:
Figure BDA0003049061180000205
the generalized supercoiled disturbance observer proposed by the formulas (34), (35) can be used for a finite time T1Realizing effective approximation to comprehensive interference F (T), i.e. when T > T1When the temperature of the water is higher than the set temperature,
Figure BDA0003049061180000206
therefore, equation (52) can be transformed into:
Figure BDA0003049061180000207
substituting (41) into (53) to obtain:
Figure BDA0003049061180000208
Figure BDA0003049061180000211
analytically available, V1>0,
Figure BDA0003049061180000212
V is bounded, estimation error
Figure BDA0003049061180000213
Is consistent and ultimately bounded. Thus, it can be assumed that there is a positive constant
Figure BDA0003049061180000214
So that the inequality
Figure BDA0003049061180000215
This is true.
To demonstrate the system's finite time convergence, a lyapunov function of the form:
Figure BDA0003049061180000216
deriving (55) as:
Figure BDA0003049061180000217
substituting (38), (39), (40) and (41) into (56) to obtain:
Figure BDA0003049061180000218
in the formula (I), the compound is shown in the specification,
Figure BDA0003049061180000219
only the appropriate positive number k needs to be selected6Value of (a), guarantee k6>δmThen p can be ensuredk>0。
According to the finite time convergence theorem, the sliding mode variable sigma can be converged to zero in finite time, and the convergence time meets the following requirements:
Figure BDA0003049061180000221
the controller designed by the invention can solve the problem of stabilizing control of the benthonic AUV point under the condition of considering external unknown interference and model parameter uncertainty, ensures that the benthonic AUV can realize accurate fixed-point hovering when sailing to the offshore bottom, and lays a foundation for accurate setting and smooth completion of monitoring tasks.
Comparison with the prior art solution
In the research of point stabilization control of the AUV, in order to meet the control requirement of benthic AUV point stabilization, a great deal of work has been done by the predecessors, besides the method mentioned in the algorithm of the present invention, schemes based on ordinary sliding mode control, discontinuous time-invariant control, and the like are also available.
Scheme based on common sliding mode control
The sliding mode control method has a good control effect on processing a nonlinear system with uncertain model parameters and external interference, but the sliding mode control usually introduces a switching term in the input of the sliding mode control to cause discontinuous control variables to generate a buffeting phenomenon. In a nonlinear system, discontinuity can excite high-frequency characteristics, weaken the control effect and even directly cause an uncontrollable state of the system, which is an inevitable problem in the conventional sliding mode control. A more common method of attenuating buffeting is to introduce boundary layer functions. The boundary layer method has good effect on inhibiting buffeting, but the method has high requirement on boundary layer width selection, the increase of system variable steady-state error can be caused by larger boundary layer, and the buffeting effect can not be obviously reduced by narrower boundary layer (Xu J, Kang X, Chen X. turbulent object based stabilizing and sizing mode dynamic configuration for UUV under wave disturbance [ C ]. Control and Decision reference 2016: 6345-. The document (Wan L, Chen G, Sheng M, et al. adaptive damping-free damping-mode control for full-order nonlinear Systems with unbounded damping and model uncategorized [ J ]. International Journal of Advanced fibrous Systems,2020,17(3): 172988142092529.) proposes a new adaptive full-order slip-mode controller without buffeting, which obtains a continuous smooth control law by integrating the differential control law with a sign function, thus well avoiding the influence of buffeting, the document (Mondal S, Mass C. adaptive controlled polar slip-mode controller for fibrous Systems [ J ]. 351. 20146. the problem of the second-order integral control is also well solved by integrating the differential control law with a sign function, thus obtaining a second-order slip-mode controller with continuous buffeting. Based on the better buffeting eliminating effect of the second-order slip form, the invention provides a novel second-order buffeting-free nonsingular integral terminal slip form controller, which is applied to AUV point stabilization control and can obtain a better control effect.
Scheme based on discontinuous time invariant control
Time invariant feedback controllers of under-actuated surface vessels are designed by a Reyhanogli (Paliotta C, Lefeber E, Pettersen K Y, Pinto J, Costa M.Transmission Tracking and Path Following for extracting marked minerals [ J ]. IEEE Transactions on Control System technology.2019,27:1423 + 1437.) by a sigma transformation method; aguiar (Reyhanoglu M.Control and stability of an understated surface vessel [ C ] Proceedings of the 35th IEEE Conference on Decision and Control,1996, 3:2371 and 2376.) and the like, use coordinate transformation to solve the problem of surface ballast Control of under-driven AUVs. The AUV point stabilizing controller is designed by adopting a discontinuous time-invariant control method, the design process is relatively simple, but the designed control law is discontinuous, the requirement of global asymptotic stability of a control system is difficult to ensure, and the AUV point stabilizing controller is difficult to be applied to actual engineering.
The algorithm improves a discontinuous time invariant control method, ensures the continuity of a control law by designing a second-order buffeting-free nonsingular integral terminal sliding mode controller, and can obtain required steady-state precision within limited time.
Simulation test
The performance of the AUV point stabilizing controller under the conditions of considering external interference and model uncertainty is verified through a reasonably designed simulation test, the self-adaptive buffeting-free integral terminal sliding mode controller designed by the invention is marked as an ACFIMC controller, the test model adopts an AUV six-degree-of-freedom model established in step (32), and the model parameters refer to a table 1. The simulation parameter settings in the ACFIMC controller designed by the invention are shown in the table 2.
TABLE 1 submersible AUV model parameters
Figure RE-GDA0003137816180000231
In the simulation test, the initial position of the AUV is set to be [ [1,1,1,1,1,1 ] 1 (0) ]]ΤDesired target point set to ηd=[0,0.5,2,0.5,0.5,0.5]ΤAdaptive law initial value set to
Figure BDA0003049061180000241
Model uncertainty and external interference in simulation test are shown in a formula (57).
Figure BDA0003049061180000242
The simulation test adopts a self-adaptive second-order terminal sliding mode controller (of an unknown automatic water vehicle with a parameter modeling and utilizing Lyapunov functions [ C ]. Proceedings of the 40th IEEE Conference on Decision and Control,2001, 5:4178 and 4183.) as a comparison controller to verify the Control effect of the sliding mode Control method designed by the invention, wherein the comparison controller is marked as an ASOTMC controller, and the ASOTMC controller is in a form of a formula (58). The simulation test results are shown in fig. 5 to 14.
Figure BDA0003049061180000243
TABLE 2 ACFIMC controller parameter settings
Figure BDA0003049061180000244
Fig. 5 to 9 show AUV pose error response curves. As can be seen from fig. 5 to 9, both controllers can converge to a stable state within a limited time, and the pose error can maintain good stability after converging to zero, but the convergence speeds of both controllers are significantly different. In the initial phase of the initial movement of the AUV, the ACFIMC controller converges faster than the astmc controller, and the ACFIMC controller is shorter than the astmc controller in the time when the error converges to zero in each direction. In the error convergence curve, the convergence curves of the two controllers are overshot, but the ASOTMC fluctuation amplitude is larger than that of the ACFIMC controller when the error converges to a stage close to zero, which reflects that the ACFIMC controller is more sensitive to the output change of an actuator than that of the ASOTMC controller, and has a good early braking effect. When the error converges to zero, the ASOTMC error response curve has less jitter, the ACFIMC controller changes more smoothly, and the curve is smoother. In summary, the convergence speed and robustness of the ACFIMC are better than those of the astmc controller in the error convergence process.
Fig. 10 to 14 are speed response curves of the AUV point stabilization control. As can be seen from fig. 10 to 14, the speeds of both controllers converge to the steady state within a limited time, but the convergence speed of the ACFIMC controller is significantly better than that of the astomc controller. In the longitudinal and transverse speed response curves, the convergence time of the ACFIMC controller is reduced by 47% compared with the convergence time of the ASOTMC controller, and in the response curves of the vertical speed, the yaw rate and the pitch rate, the convergence time of the ACFIMC controller is reduced by 25% compared with the convergence time of the ASOTMC controller. In the speed convergence response curves in all directions, when the speed is converged to a near-steady state, the ASOTMC controller fluctuates, the curve change of the ACFIMC controller is smooth, and the output of the ACFIMC controller actuator is stable. In summary, in the speed response curve, the convergence speed and robustness of the ACFIMC controller are better than those of the ASOTMC controller.
It should be noted that the detailed description is only for explaining and explaining the technical solution of the present invention, and the scope of protection of the claims is not limited thereby. It is intended that all such modifications and variations be included within the scope of the invention as defined in the following claims and the description.

Claims (4)

1. A benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on an extended state observer comprises the following steps:
the method comprises the following steps: establishing a benthonic AUV motion equation, and constructing a benthonic AUV error model according to the benthonic AUV motion equation;
step two: constructing a benthonic AUV point stabilized tracking error model according to the benthonic AUV error model;
step three: designing a self-adaptive supercoiled extended state observer;
step four: constructing a second-order buffeting-free nonsingular integral terminal sliding mode surface;
step five: designing a controller according to a benthonic AUV point stabilized tracking error model, a self-adaptive supercoiled extended state observer and a second-order buffeting-free nonsingular integral terminal sliding mode surface;
the method is characterized in that the second-order buffeting-free nonsingular integral terminal sliding mode surface is expressed as follows:
Figure FDA0003297414520000011
wherein λ is a positive number, and β ∈ R6×6Is a diagonal matrix, s is a sliding mode surface function, sigma is an auxiliary variable,
Figure FDA0003297414520000012
for the control parameters, d τ is the integral operator,
Figure FDA0003297414520000013
is etaeFirst derivative of, ηeIn order to be able to determine the position tracking error,
Figure FDA0003297414520000014
can be used as a benthonicThe control force and moment vector generated when the AUV actuator operates;
the control law of the second-order buffeting-free nonsingular integral terminal sliding mode surface is expressed as follows:
τ=τ12
in the formula (I), the compound is shown in the specification,
Figure FDA0003297414520000015
Figure FDA0003297414520000016
Figure FDA0003297414520000017
Figure FDA0003297414520000018
Figure FDA0003297414520000019
in the formula, k4For switching term gain, normal, k6Is a positive number,/1And l2In order to control the parameters of the device,
Figure FDA00032974145200000110
is an estimated value of the observer state variable,
Figure FDA0003297414520000021
is tau2The first derivative of (d), phi are integral operators,
Figure FDA0003297414520000022
is composed of
Figure FDA0003297414520000023
F (η, ν, t) is an auxiliary variable;
the self-adaptive law of the second-order buffeting-free nonsingular integral terminal sliding mode surface is expressed as follows:
Figure FDA0003297414520000024
in the formula, k5Is a normal number, b is a control gain,
Figure FDA0003297414520000025
is the first derivative of b and is,
Figure FDA0003297414520000026
is an observer variable, δmIs composed of
Figure FDA0003297414520000027
Is determined by the actual value of the unknown boundary,
Figure FDA0003297414520000028
is deltamIs determined by the estimated value of (c),
Figure FDA0003297414520000029
is the first derivative of s.
2. The benthonic AUV weak buffeting integral sliding mode point stabilization control method based on the extended state observer as recited in claim 1, wherein the benthonic AUV motion equation is expressed as:
Figure FDA00032974145200000210
Figure FDA00032974145200000211
Figure FDA00032974145200000212
where M is a mass inertia matrix, η [ [ ξ n ζ φ θ ψ [ ]]ΤWhen a benthonic AUV moves under a fixed coordinate system, the position and the posture of six degrees of freedom in a three-dimensional space are divided into upsilon [ uv w p q r ═ v]ΤThe speed and the angular speed in the three-dimensional space when moving under the carrier coordinate system,
Figure FDA00032974145200000213
is a coordinate transformation matrix between a fixed coordinate system and a carrier coordinate system when the benthonic AUV moves on a horizontal plane,
Figure FDA00032974145200000214
for the nominal values of the parameters of the model,
Figure FDA00032974145200000215
the control force and the moment vector generated when the benthonic AUV actuator operates,
Figure FDA00032974145200000216
is a comprehensive interference item formed by superposing model parameter uncertainty and external time-varying interference,
Figure FDA00032974145200000217
perturbation values of model parameters, τd(t) is the external time-varying interference,
Figure FDA00032974145200000218
is the first derivative of v and,
Figure FDA00032974145200000219
comprehensive trunk for superposing model parameter uncertainty and external time-varying interferenceThe items of interference are displayed on the screen,
Figure FDA00032974145200000220
the first derivative of η.
3. The method according to claim 2, wherein the benthonic AUV weak buffeting integral sliding mode point stabilized control method based on the extended state observer is characterized in that the benthonic AUV point stabilized tracking error model is expressed as:
Figure FDA00032974145200000221
Figure FDA00032974145200000222
Figure FDA00032974145200000223
in the formula (I), the compound is shown in the specification,
Figure FDA00032974145200000224
as an auxiliary variable, the number of variables,
Figure FDA00032974145200000225
is omegaeThe first derivative of (a) is,
Figure FDA0003297414520000031
is omegaeThe second derivative of (a) is,
Figure FDA0003297414520000032
is etaeFirst derivative of, ηeIn order to be able to determine the position tracking error,
Figure FDA0003297414520000033
the first derivative of the rotation matrix is represented,
Figure FDA0003297414520000034
a second derivative representing the desired position;
b=R(η)M-1
Figure FDA0003297414520000035
the above-mentioned
Figure FDA0003297414520000036
The following relationship is satisfied:
||F(t)||<Dm
Figure FDA0003297414520000037
Dmactual value of unknown boundary, δ, of F (t)mIs composed of
Figure FDA0003297414520000038
Is determined by the actual value of the unknown boundary,
Figure FDA0003297414520000039
is deltamIs determined by the estimated value of (c),
Figure FDA00032974145200000310
is composed of
Figure FDA00032974145200000311
B is the control gain, F (t) is the auxiliary variable,
Figure FDA00032974145200000312
is the first derivative of F (t),
Figure FDA00032974145200000313
is a first order of bThe derivative(s) of the signal(s),
Figure FDA00032974145200000314
the first derivative of τ.
4. The extended state observer-based benthic AUV weak buffeting integral sliding mode point stabilization control method according to claim 3, wherein the adaptive supercoiled extended state observer is represented as:
Figure FDA00032974145200000315
Figure FDA00032974145200000316
wherein G (eta, upsilon, t),
Figure FDA00032974145200000317
Is an observer variable, K1、K2To observer gain, K1、K2Are all positive definite diagonal matrix, K1、K2
Figure FDA00032974145200000318
As an auxiliary variable, the auxiliary variable expression is as follows:
K1=diag(K11,K12,K13,K14,K15,K16)
K2=diag(K21,K22,K23,K24,K25,K26)
Figure FDA00032974145200000319
Figure FDA00032974145200000320
in the formula (I), the compound is shown in the specification,
Figure FDA00032974145200000321
the expression is as follows:
Figure FDA00032974145200000322
Figure FDA00032974145200000323
in the formula, mu1i2iAre all normal numbers, i is 1,2,3,4,5,6,
Figure FDA00032974145200000324
estimating an error for an observer;
the adaptation law is represented as:
Figure FDA0003297414520000041
Figure FDA0003297414520000042
in the formula (I), the compound is shown in the specification,
Figure FDA0003297414520000043
K1i(t) are all adaptive variables, c1i、c2i、c3i、HiAre all control parameters and are positive numbers.
CN202110482857.1A 2021-04-30 2021-04-30 Benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on extended state observer Active CN113238567B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110482857.1A CN113238567B (en) 2021-04-30 2021-04-30 Benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on extended state observer

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110482857.1A CN113238567B (en) 2021-04-30 2021-04-30 Benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on extended state observer

Publications (2)

Publication Number Publication Date
CN113238567A CN113238567A (en) 2021-08-10
CN113238567B true CN113238567B (en) 2021-12-10

Family

ID=77131876

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110482857.1A Active CN113238567B (en) 2021-04-30 2021-04-30 Benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on extended state observer

Country Status (1)

Country Link
CN (1) CN113238567B (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113659897B (en) * 2021-08-11 2023-11-03 沈阳工程学院 Sliding mode control method of permanent magnet linear synchronous motor
CN113485127B (en) * 2021-08-24 2022-05-31 中国科学院长春光学精密机械与物理研究所 Method for improving dynamic target tracking performance of photoelectric measurement equipment
CN116088548B (en) * 2022-12-30 2023-09-29 西北工业大学 Four-rotor unmanned aerial vehicle attitude control method based on rapid nonsingular terminal sliding mode
CN116430730B (en) * 2023-04-11 2023-11-21 天津大学 Helicopter active vibration damping control method based on limited time expansion state observer

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108241292A (en) * 2017-12-07 2018-07-03 西北工业大学 A kind of underwater robot sliding-mode control based on extended state observer
CN108828955A (en) * 2018-08-16 2018-11-16 大连海事大学 Accurate Track In Track control method based on finite time extended state observer
CN109814392A (en) * 2019-02-21 2019-05-28 大连海事大学 A kind of drive lacking underwater robot actuator failures robust Fault-Tolerant Control method
CN110308735A (en) * 2019-03-08 2019-10-08 哈尔滨工程大学 A kind of drive lacking UUV track following sliding-mode control for input delay
CN111650948A (en) * 2020-06-10 2020-09-11 哈尔滨工程大学 Quick tracking control method for horizontal plane track of benthonic AUV
CN111831011A (en) * 2020-08-07 2020-10-27 大连海事大学 Method for tracking and controlling plane track of underwater robot
CN112527018A (en) * 2020-12-26 2021-03-19 九江职业技术学院 Three-dimensional stabilization control method for under-actuated autonomous underwater vehicle

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108241292A (en) * 2017-12-07 2018-07-03 西北工业大学 A kind of underwater robot sliding-mode control based on extended state observer
CN108828955A (en) * 2018-08-16 2018-11-16 大连海事大学 Accurate Track In Track control method based on finite time extended state observer
CN109814392A (en) * 2019-02-21 2019-05-28 大连海事大学 A kind of drive lacking underwater robot actuator failures robust Fault-Tolerant Control method
CN110308735A (en) * 2019-03-08 2019-10-08 哈尔滨工程大学 A kind of drive lacking UUV track following sliding-mode control for input delay
CN111650948A (en) * 2020-06-10 2020-09-11 哈尔滨工程大学 Quick tracking control method for horizontal plane track of benthonic AUV
CN111831011A (en) * 2020-08-07 2020-10-27 大连海事大学 Method for tracking and controlling plane track of underwater robot
CN112527018A (en) * 2020-12-26 2021-03-19 九江职业技术学院 Three-dimensional stabilization control method for under-actuated autonomous underwater vehicle

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
Error Analysis of ADRC Linear Extended State Observer for the System with Measurement Noise;jia song;《IFAC PapersOnLine》;20201231;全文 *
Finite-time extended state observer-based exact tracking control of an unmanned surface vehicle;NingWang, Zhongben Zhu;《Int J Robust Nonlinear Control》;20191231;全文 *
作业型水下机器人运动控制系统研究;薛乃耀;《中国优秀硕士学位论文全文数据库》;20210215;第47页 *
欠驱动AUV的运动控制技术综述;王芳;《中国造船》;20100630;第51卷(第2期);全文 *
自主式无人水下航行器航向自适应滑模控制;赵贺伟;《舰船科学技术》;20140531;第36卷(第5期);全文 *

Also Published As

Publication number Publication date
CN113238567A (en) 2021-08-10

Similar Documents

Publication Publication Date Title
CN113238567B (en) Benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on extended state observer
CN108803632B (en) Water surface unmanned ship all-state constraint trajectory tracking control method based on saturation compensation technology
Peng et al. Path-following control of autonomous underwater vehicles subject to velocity and input constraints via neurodynamic optimization
Khodayari et al. Modeling and control of autonomous underwater vehicle (AUV) in heading and depth attitude via self-adaptive fuzzy PID controller
CN104898688B (en) The adaptive anti-interference System with Sliding Mode Controller of UUV four-degree-of-freedom dynamic positionings and control method
Qiao et al. Design of three exponentially convergent robust controllers for the trajectory tracking of autonomous underwater vehicles
CN109100939B (en) Input saturation considered water surface unmanned ship all-state constraint trajectory tracking control method
CN111736600B (en) Track tracking control method for unmanned surface vehicle under time-lag asymmetric time-varying all-state constraint
CN111650832B (en) Method for tracking and controlling mechanical foot posture of underwater multi-foot walking robot
CN111650948A (en) Quick tracking control method for horizontal plane track of benthonic AUV
CN109189103B (en) Under-actuated AUV trajectory tracking control method with transient performance constraint
Han et al. Modeling and fuzzy decoupling control of an underwater vehicle-manipulator system
CN113821030B (en) Fixed time track tracking control method for under-actuated unmanned ship
Liu et al. Adaptive command filtered backstepping tracking control for AUVs considering model uncertainties and input saturation
CN111880409A (en) Autonomous underwater vehicle track tracking control method based on data driving
Yan et al. Bottom-following control for an underactuated unmanned undersea vehicle using integral-terminal sliding mode control
Pezeshki et al. Adaptive robust control of autonomous underwater vehicle
Dai et al. Dual closed loop AUV trajectory tracking control based on finite time and state observer
von Ellenrieder et al. A higher order sliding mode controller-observer for marine vehicles
Ruiz-Duarte et al. Higher order sliding mode control for autonomous underwater vehicles in the diving plane
CN114839883B (en) Depth-fixed anti-interference robust L of nonlinear under-actuated underwater vehicle 1 Control method
CN113110512B (en) Benthonic AUV self-adaptive trajectory tracking control method for weakening unknown interference and buffeting influence
CN115576335A (en) Self-adaptive neural network trajectory tracking method for autonomous underwater helicopter
CN115047891A (en) AUV propeller fault-tolerant control method based on finite time extended state observer
CN109062232B (en) Seabed seismic wave detection flight node distributed finite time anti-shake configuration inclusion control method

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant