CN115407788B - Fixed-time convergence second-order sliding mode control method and control system for underwater high-speed navigation body - Google Patents
Fixed-time convergence second-order sliding mode control method and control system for underwater high-speed navigation body Download PDFInfo
- Publication number
- CN115407788B CN115407788B CN202211035340.9A CN202211035340A CN115407788B CN 115407788 B CN115407788 B CN 115407788B CN 202211035340 A CN202211035340 A CN 202211035340A CN 115407788 B CN115407788 B CN 115407788B
- Authority
- CN
- China
- Prior art keywords
- sliding mode
- module
- navigation body
- cavitation
- order
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 53
- 238000004088 simulation Methods 0.000 claims abstract description 16
- 230000000694 effects Effects 0.000 claims abstract description 9
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 8
- 238000013461 design Methods 0.000 claims description 31
- 239000011159 matrix material Substances 0.000 claims description 30
- 238000004458 analytical method Methods 0.000 claims description 20
- 238000013459 approach Methods 0.000 claims description 18
- 230000006870 function Effects 0.000 claims description 18
- 238000013178 mathematical model Methods 0.000 claims description 18
- 230000005484 gravity Effects 0.000 claims description 13
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 10
- PXFBZOLANLWPMH-UHFFFAOYSA-N 16-Epiaffinine Natural products C1C(C2=CC=CC=C2N2)=C2C(=O)CC2C(=CC)CN(C)C1C2CO PXFBZOLANLWPMH-UHFFFAOYSA-N 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 6
- 230000003190 augmentative effect Effects 0.000 claims description 6
- 238000004590 computer program Methods 0.000 claims description 6
- 238000009736 wetting Methods 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000003313 weakening effect Effects 0.000 claims description 3
- 238000012795 verification Methods 0.000 abstract description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000007788 liquid Substances 0.000 description 2
- 238000000418 atomic force spectrum Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000002309 gasification Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/04—Control of altitude or depth
- G05D1/06—Rate of change of altitude or depth
- G05D1/0692—Rate of change of altitude or depth specially adapted for under-water vehicles
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Abstract
The invention provides a control method and a control system for a second-order sliding mode of fixed-time convergence of an underwater high-speed navigation body, which are characterized in that firstly, an underwater high-speed navigation body dynamics model is established, a second-order sliding mode control algorithm is based on the second-order sliding mode, a second-order sliding mode controller of the underwater high-speed navigation body with the fixed-time convergence is designed, the stability of the controller is proved through Lyapunov, and finally, mathematical simulation verification is carried out; the invention can effectively control the depth, has high control precision and quick convergence time, and effectively weakens the buffeting effect of the sliding mode controller, so that the depth can smoothly and quickly reach the appointed depth.
Description
Technical Field
The invention belongs to the technical field of power energy, and particularly relates to a fixed time convergence second-order sliding mode control method and a fixed time convergence second-order sliding mode control system for an underwater high-speed navigation body.
Background
The supercavitation means that when the navigation body sails under water at a high speed, the surrounding liquid pressure is reduced due to the higher speed, a layer of supercavitation is formed after gasification, the projectile body is wrapped by the cavitation and is separated from the surrounding liquid, and the supercavitation technology can effectively reduce the resistance of the navigation body in the navigation process, so that the navigation speed is greatly improved, and the supercavitation technology is a hot spot for current research. Compared with the traditional all-wet navigation body, the stress mode of the underwater high-speed navigation body is completely different, and the system has strong nonlinearity and strong time-varying characteristics due to the mutual coupling of the cavitation bubbles and the cavitation bubbles only under the action of the front-end cavitation device, the tail rudder, the gravity and the tail sliding force, so that the design of the controller is greatly challenged, and the existence of external interference and system uncertainty also brings new difficulties to the design of the controller.
Disclosure of Invention
Aiming at the problems, the invention provides a method and a system for controlling a fixed-time convergence second-order sliding mode of an underwater high-speed navigation body; firstly, an underwater high-speed navigation body dynamics model is established, then a controller with fixed time convergence is designed based on a second-order sliding mode control algorithm, lyapunov stability is proved, and finally mathematical simulation verification is carried out.
The invention is realized by the following technical scheme:
a fixed time convergence second order sliding mode control method for an underwater high-speed navigation body comprises the following steps:
the method specifically comprises the following steps:
step 1: establishing an underwater high-speed navigation body dynamics model;
step 2: designing an underwater high-speed navigation body second-order sliding mode controller converging at fixed time based on a second-order sliding mode control algorithm;
step 3: performing stability demonstration on the second-order sliding mode controller obtained in the step 2 through a Lyapunov function;
step 4: based on steps 1 to 3, mathematical simulation analysis is performed.
Further, in step 1, the process comprises,
step 1.1: in the process of underwater high-speed navigation of the supercavitation navigation body, most of the projectile body is wrapped by cavitation bubbles and is only controlled by the control force F of the cavitation device cav Gravity F g Stress F of tail rudder fin And the sliding force F due to contact of the projectile with the cavity wall plane These forces and the effect on the moment of stress, the mathematical model is as follows:
wherein z, θ, w, q represent the depth, pitch angle, vertical velocity and pitch angle velocity of the vehicle, respectively, V represents the axial velocity of the vehicle, m is the mass of the vehicle, J y For moment of inertia of the craft, L c For the distance from the head of the navigation body to the mass center, L f For the tail-to-centroid distance of the vehicle,
step 1.2: the mathematical model in step 1.1 is rewritten into the form of a state equation:
in the formula ,δc 、δ f Represents the rudder deflection angle of the cavitation device and the rudder deflection angle of the tail rudder, F p (t, τ) represents the magnitude of the tail-biting force experienced by the vehicle;
step 1.3: the specific form of the matrix of the model is:
wherein ,g is gravity acceleration, R n The cavitation radius is the cavitation radius, ρ is the density of water, σ is the cavitation number, n is the similarity coefficient, and I (t, τ) is the tail vane wetting rate.
Further, in step 2, the process comprises,
step 2.1: definition x 1 =[z θ] T ,x 2 =[w q] T Control input u= [ delta ] c δ f ] T The model can be rewritten as affine:
each system matrix isC 1 =[g 0] T ,
The design slip form surface is as follows:
wherein :k 1 、k 2 the constant is V, and the navigation speed of the navigation body is V;
step 2.2: in order to weaken buffeting, a second-order sliding mode approach law is designed:
wherein S= [ S ] 1 s 2 ] T Is a sliding die surface; z= [ Z ] 1 z 2 ] T An augmented state for the system; m is a positive constant, reflects the sliding mode approach law order, and has m more than or equal to 2; lambda (lambda) 1 ≥0、λ 2 The gain is equal to or more than 0;
the following control laws can be derived:
further, in step 3, the process comprises,
step 3.1: performing stability demonstration, and enabling:
then for i=1, 2 there is:
the finishing method can obtain:
in the formula :
taking the Lyapunov function as:
in the formula :is a positive definite matrix;
the Lyapunov function is derived from:
in the formula ,when lambda is satisfied 1 >0,/>When Q is a positive definite matrix;
then there are:
in the formula :λQmax Is the maximum eigenvalue of Q, lambda Qmin Is the minimum eigenvalue of Q; then there are:
step 3.2: order theIt can be converted into:
solving the above method to obtain a convergence time boundary:
when (when)Then there are:
thus, the state error can converge to zero within a finite time, the maximum convergence time being
An underwater high-speed navigation body fixed time convergence second order sliding mode control system:
the system comprises a model building module, a sliding mode controller design module, a stability proving module and a simulation analysis module:
the model building module is used for building an underwater high-speed navigation body dynamics model;
the sliding mode controller design module is used for designing a second-order sliding mode controller of the underwater high-speed navigation body, which converges in a fixed time, based on a second-order sliding mode control algorithm;
the stability proving module is used for proving the stability of the second-order sliding mode controller obtained in the step 2 through a Lyapunov function;
and the simulation analysis module is used for carrying out mathematical simulation analysis.
Further, the method comprises the steps of,
the model building module further comprises a mathematical model analysis module, a state equation building module and a matrix building module;
mathematical model analysis module: in the process of the supercavitation navigation body navigating under water at high speed, most of the projectile body is wrapped by cavitation, and only the cavitation control force F is applied cav Gravity F g Stress F of tail rudder fin And the sliding force F due to contact of the projectile with the cavity wall plane These forces and the effect on the moment of stress, the mathematical model is as follows:
wherein z, θ, w, q represent the depth, pitch angle, vertical velocity and pitch angle velocity of the vehicle, respectively, V represents the axial velocity of the vehicle, m is the mass of the vehicle, J y For moment of inertia of the craft, L c For the distance from the head of the navigation body to the mass center, L f For the tail-to-centroid distance of the vehicle,
the state equation establishment module: the mathematical model is rewritten into the form of a state equation:
in the formula ,δc 、δ f Represents the rudder deflection angle of the cavitation device and the rudder deflection angle of the tail rudder, F p (t,τ) represents the magnitude of the tail slapping force exerted by the vehicle;
and a matrix establishment module: the specific form of the matrix of the model is:
wherein ,g is gravity acceleration, R n The cavitation radius is the cavitation radius, ρ is the density of water, σ is the cavitation number, n is the similarity coefficient, and I (t, τ) is the tail vane wetting rate.
Further, the method comprises the steps of,
the sliding mode controller design module further comprises a sliding mode surface design module and a sliding mode approach law design module;
and a sliding mode surface design module: definition x 1 =[z θ] T ,x 2 =[w q] T Control input u= [ delta ] c δ f ] T The model can be rewritten as affine:
each system matrix isC 1 =[g 0] T ,
The design slip form surface is as follows:
wherein :k 1 、k 2 the constant is V, and the navigation speed of the navigation body is V;
the sliding mode approach law design module: the method is used for weakening buffeting and designing a second-order sliding mode approach law:
wherein S= [ S ] 1 s 2 ] T Is a sliding die surface; z= [ Z ] 1 z 2 ] T An augmented state for the system; m is a positive constant, reflects the sliding mode approach law order, and has m more than or equal to 2; lambda (lambda) 1 ≥0、λ 2 The gain is equal to or more than 0;
the following control laws can be derived:
further, the method comprises the steps of,
the stability proving module further comprises a Lyapunov module and a time boundary calculating module;
lyapunov module: performing stability demonstration, and enabling:
then for i=1, 2 there is:
the finishing method can obtain:
in the formula :
taking the Lyapunov function as:
in the formula :is a positive definite matrix;
the Lyapunov function is derived from:
in the formula ,when lambda is satisfied 1 >0,/>When Q is a positive definite matrix;
then there are:
in the formula :λQmax Is the maximum eigenvalue of Q, lambda Qmin Is the minimum eigenvalue of Q; then there are:
and a time boundary calculation module: order theCan be converted into:
Solving the above method to obtain a convergence time boundary:
when (when)Then there are:
thus, the state error can converge to zero within a finite time, the maximum convergence time being
An electronic device comprising a memory storing a computer program and a processor implementing the steps of any one of the methods described above when the processor executes the computer program.
A computer readable storage medium storing computer instructions which, when executed by a processor, implement the steps of the method of any of the preceding claims.
The invention has the beneficial effects that
The invention can effectively control the depth, has high control precision and quick convergence time, and effectively weakens the buffeting effect of the sliding mode controller, so that the depth can smoothly and quickly reach the appointed depth.
Drawings
FIG. 1 is a diagram of a stress analysis of an underwater high-speed vehicle;
FIG. 2 is a vehicle depth profile;
FIG. 3 is a vertical velocity profile of a vehicle;
FIG. 4 is a graph of pitch angle of a vehicle;
FIG. 5 is a graph of pitch rate of a vehicle;
FIG. 6 is a graph of a taxiing force profile for a vehicle;
FIG. 7 is a graph of cavitation rudder deflection angle;
fig. 8 is a tail rudder deflection angle graph.
Detailed Description
The following description of the embodiments of the present invention will be made clearly and completely with reference to the accompanying drawings, in which it is apparent that the embodiments described are only some embodiments of the present invention, but not all embodiments. All other embodiments, which can be made by those skilled in the art based on the embodiments of the invention without making any inventive effort, are intended to be within the scope of the invention.
With reference to fig. 1 to 8.
A fixed time convergence second order sliding mode control method for an underwater high-speed navigation body comprises the following steps:
the method specifically comprises the following steps:
step 1: establishing an underwater high-speed navigation body dynamics model;
step 2: designing an underwater high-speed navigation body second-order sliding mode controller converging at fixed time based on a second-order sliding mode control algorithm;
step 3: performing stability demonstration on the second-order sliding mode controller obtained in the step 2 through a Lyapunov function;
step 4: based on steps 1 to 3, mathematical simulation analysis is performed.
In step 1, as shown in fig. 1,
step 1.1: in the process of underwater high-speed navigation of the supercavitation navigation body, most of the projectile body is wrapped by cavitation bubbles and is only controlled by the control force F of the cavitation device cav Gravity F g Stress F of tail rudder fin And the sliding force F due to contact of the projectile with the cavity wall plane These forces and the effect on the moment of stress, the mathematical model is as follows:
wherein z, θ, w, q each represent the vehicleDepth, pitch angle, vertical speed and pitch angle speed, V denotes the axial speed of the vehicle, m is the mass of the vehicle, J y For moment of inertia of the craft, L c For the distance from the head of the navigation body to the mass center, L f For the tail-to-centroid distance of the vehicle,
step 1.2: the mathematical model in step 1.1 is rewritten into the form of a state equation:
in the formula ,δc 、δ f Represents the rudder deflection angle of the cavitation device and the rudder deflection angle of the tail rudder, F p (t, τ) represents the magnitude of the tail-biting force experienced by the vehicle;
step 1.3: the specific form of the matrix of the model is:
wherein ,g is gravity acceleration, R n The cavitation radius is the cavitation radius, ρ is the density of water, σ is the cavitation number, n is the similarity coefficient, and I (t, τ) is the tail vane wetting rate.
In the step 2 of the process, the process is carried out,
step 2.1: definition x 1 =[z θ] T ,x 2 =[w q] T Control input u= [ delta ] c δ f ] T The model can be rewritten as affine:
each system inThe matrix isC 1 =[g 0] T ,
The design slip form surface is as follows:
wherein :k 1 、k 2 the constant is V, and the navigation speed of the navigation body is V;
step 2.2: in order to weaken buffeting, a second-order sliding mode approach law is designed:
wherein S= [ S ] 1 s 2 ] T Is a sliding die surface; z= [ Z ] 1 z 2 ] T An augmented state for the system; m is a positive constant, reflects the sliding mode approach law order, and has m more than or equal to 2; lambda (lambda) 1 ≥0、λ 2 The gain is equal to or more than 0;
the following control laws can be derived:
in the step (3) of the process,
step 3.1: performing stability demonstration, and enabling:
then for i=1, 2 there is:
the finishing method can obtain:
in the formula :
taking the Lyapunov function as:
in the formula :is a positive definite matrix;
the Lyapunov function is derived from:
in the formula ,when lambda is satisfied 1 >0,/>When Q is a positive definite matrix;
then there are:
in the formula :λQmax Is the maximum eigenvalue of Q, lambda Qmin Is the minimum eigenvalue of Q; then there are:
/>
step 3.2: order theIt can be converted into:
solving the above method to obtain a convergence time boundary:
when (when)Then there are:
thus, the state error can converge to zero within a finite time, the maximum convergence time being
An underwater high-speed navigation body fixed time convergence second order sliding mode control system:
the system comprises a model building module, a sliding mode controller design module, a stability proving module and a simulation analysis module:
the model building module is used for building an underwater high-speed navigation body dynamics model;
the sliding mode controller design module is used for designing a second-order sliding mode controller of the underwater high-speed navigation body, which converges in a fixed time, based on a second-order sliding mode control algorithm;
the stability proving module is used for proving the stability of the second-order sliding mode controller obtained in the step 2 through a Lyapunov function;
and the simulation analysis module is used for carrying out mathematical simulation analysis.
The model building module further comprises a mathematical model analysis module, a state equation building module and a matrix building module;
mathematical model analysis module: in the process of the supercavitation navigation body navigating under water at high speed, most of the projectile body is wrapped by cavitation, and only the cavitation control force F is applied cav Gravity F g Stress F of tail rudder fin And the sliding force F due to contact of the projectile with the cavity wall plane These forces and the effect on the moment of stress, the mathematical model is as follows:
wherein z, θ, w, q represent the depth, pitch angle, vertical velocity and pitch angle velocity of the vehicle, respectively, V represents the axial velocity of the vehicle, m is the mass of the vehicle, J y For moment of inertia of the craft, L c For the distance from the head of the navigation body to the mass center, L f For the tail-to-centroid distance of the vehicle,
the state equation establishment module: the mathematical model is rewritten into the form of a state equation:
in the formula ,δc 、δ f Represents the rudder deflection angle of the cavitation device and the rudder deflection angle of the tail rudder, F p (t, τ) represents the magnitude of the tail-biting force experienced by the vehicle;
and a matrix establishment module: the specific form of the matrix of the model is:
wherein ,g is gravity acceleration, R n Is a cavitation device halfDiameter ρ is the density of water, σ is the cavitation number, n is the similarity coefficient, and I (t, τ) is the tail vane wetting rate.
The sliding mode controller design module further comprises a sliding mode surface design module and a sliding mode approach law design module;
and a sliding mode surface design module: definition x 1 =[z θ] T ,x 2 =[w q] T Control input u= [ delta ] c δ f ] T The model can be rewritten as affine:
each system matrix isC 1 =[g 0] T ,
The design slip form surface is as follows:
wherein :k 1 、k 2 the constant is V, and the navigation speed of the navigation body is V;
the sliding mode approach law design module: the method is used for weakening buffeting and designing a second-order sliding mode approach law:
wherein S= [ S ] 1 s 2 ] T Is a sliding die surface; z= [ Z ] 1 z 2 ] T An augmented state for the system; m is a positive constant, reflects the sliding mode approach law order, and has m more than or equal to 2; lambda (lambda) 1 ≥0、λ 2 The gain is equal to or more than 0;
the following control laws can be derived:
the stability proving module further comprises a Lyapunov module and a time boundary calculating module;
lyapunov module: performing stability demonstration, and enabling:
then for i=1, 2 there is:
the finishing method can obtain:
in the formula :
taking the Lyapunov function as:
in the formula :is a positive definite matrix;
the Lyapunov function is derived from:
in the formula ,when lambda is satisfied 1 >0,/>When Q is a positive definite matrix;
then there are:
in the formula :λQmax Is the maximum eigenvalue of Q, lambda Qmin Is the minimum eigenvalue of Q; then there are:
/>
and a time boundary calculation module: order theIt can be converted into:
solving the above method to obtain a convergence time boundary:
when (when)Then there are:
thus, the state error can converge to zero within a finite time, the maximum convergence time being
In step 4, the control parameters are takenm=8,k 1 =4,k 2 =0.4, and design the desired depth to be z d =3, mathematical simulation analysis was performed;
as can be seen from the simulation result of the drawing, the second-order sliding mode control can effectively control the depth, has high control precision and quick convergence time, effectively weakens the buffeting effect of the sliding mode controller, and enables the depth to smoothly and quickly reach the designated depth.
An electronic device comprising a memory storing a computer program and a processor implementing the steps of any one of the methods described above when the processor executes the computer program.
A computer readable storage medium storing computer instructions which, when executed by a processor, implement the steps of the method of any of the preceding claims.
The above detailed description of the method and the system for controlling the fixed time convergence second order sliding mode of the underwater high-speed navigation body is provided, the principle and the implementation mode of the invention are explained, and the above description of the embodiment is only used for helping to understand the method and the core idea of the invention; meanwhile, as those skilled in the art will have variations in the specific embodiments and application scope in accordance with the ideas of the present invention, the present description should not be construed as limiting the present invention in view of the above.
Claims (4)
1. A fixed time convergence second order sliding mode control method for an underwater high-speed navigation body is characterized by comprising the following steps of:
the method specifically comprises the following steps:
step 1: establishing an underwater high-speed navigation body dynamics model;
in step 1, step 1.1: in the process of underwater high-speed navigation of the supercavitation navigation body, most of the projectile body is wrapped by cavitation bubbles and is only controlled by the control force F of the cavitation device c Gravity F g Stress F of tail rudder fin And the sliding force F due to contact of the projectile with the cavity wall p These forces and the effect on the moment of stress, the mathematical model is as follows:
wherein z, θ, w, q represent the depth, pitch angle, vertical velocity and pitch angle velocity of the vehicle, respectively, V represents the axial velocity of the vehicle, m is the mass of the vehicle, J y For moment of inertia of the craft, L c For the distance from the head of the navigation body to the mass center, L f For the tail-to-centroid distance of the vehicle,
step 1.2: the mathematical model in step 1.1 is rewritten into the form of a state equation:
in the formula ,δc 、δ f Represents the rudder deflection angle of the cavitation device and the rudder deflection angle of the tail rudder, F p (t, τ) represents the magnitude of the tail-biting force experienced by the vehicle;
step 1.3: the specific form of the matrix of the model is:
wherein ,g is gravity acceleration, R n The cavitation radius is the cavitation radius, ρ is the density of water, σ is the cavitation number, n is the similarity coefficient, and I (t, τ) is the tail vane wetting rate;
step 2: designing an underwater high-speed navigation body second-order sliding mode controller converging at fixed time based on a second-order sliding mode control algorithm;
in the step 2 of the process, the process is carried out,
step 2.1: definition x 1 =[z θ] T ,x 2 =[w q] T Control input u= [ delta ] c δ f ] T The model can be rewritten as affine:
each system matrix isC 1 =[g 0] T ,/>
The design slip form surface is as follows:
wherein :k 1 、k 2 the constant is V, and the navigation speed of the navigation body is V;
step 2.2: in order to weaken buffeting, a second-order sliding mode approach law is designed:
wherein S= [ S ] 1 s 2 ] T Is a sliding die surface; z is Z=[z 1 z 2 ] T An augmented state for the system; m is a positive constant, reflects the sliding mode approach law order, and has m more than or equal to 2; lambda (lambda) 1 ≥0、λ 2 The gain is equal to or more than 0;
the following control laws can be derived:
step 3: performing stability demonstration on the second-order sliding mode controller obtained in the step 2 through a Lyapunov function;
in the step (3) of the process,
step 3.1: performing stability demonstration, and enabling:
then for i=1, 2 there is:
the finishing method can obtain:
in the formula :
taking the Lyapunov function as:
in the formula :is a positive definite matrix;
the Lyapunov function is derived from:
in the formula ,when lambda is satisfied 1 >0,/>When Q is a positive definite matrix;
then there are:
in the formula :λQmax Is the maximum eigenvalue of Q, lambda Qmin Is the minimum eigenvalue of Q; then there are:
step 3.2: order theIt can be converted into:
solving the above method to obtain a convergence time boundary:
when (when)v 0 Not less than 0, the following are:
thus, the stateThe error can be converged to zero in a limited time, and the maximum convergence time is
Step 4: based on steps 1 to 3, mathematical simulation analysis is performed.
2. An underwater high-speed navigation body fixed time convergence second order sliding mode control system is characterized in that:
the system comprises a model building module, a sliding mode controller design module, a stability proving module and a simulation analysis module:
the model building module is used for building an underwater high-speed navigation body dynamics model;
the model building module further comprises a mathematical model analysis module, a state equation building module and a matrix building module;
mathematical model analysis module: in the process of the supercavitation navigation body navigating under water at high speed, most of the projectile body is wrapped by cavitation, and only the cavitation control force F is applied c Gravity F g Stress F of tail rudder fin And the sliding force F due to contact of the projectile with the cavity wall p These forces and the effect on the moment of stress, the mathematical model is as follows:
wherein z, θ, w, q represent the depth, pitch angle, vertical velocity and pitch angle velocity of the vehicle, respectively, V represents the axial velocity of the vehicle, m is the mass of the vehicle, J y For moment of inertia of the craft, L c For the distance from the head of the navigation body to the mass center, L f For the tail-to-centroid distance of the vehicle,
the state equation establishment module: the mathematical model is rewritten into the form of a state equation:
in the formula ,δc 、δ f Represents the rudder deflection angle of the cavitation device and the rudder deflection angle of the tail rudder, F p (t, τ) represents the magnitude of the tail-biting force experienced by the vehicle;
and a matrix establishment module: the specific form of the matrix of the model is:
wherein ,g is gravity acceleration, R n The cavitation radius is the cavitation radius, ρ is the density of water, σ is the cavitation number, n is the similarity coefficient, and I (t, τ) is the tail vane wetting rate;
the sliding mode controller design module is used for designing a second-order sliding mode controller of the underwater high-speed navigation body, which converges in a fixed time, based on a second-order sliding mode control algorithm; the sliding mode controller design module further comprises a sliding mode surface design module and a sliding mode approach law design module;
and a sliding mode surface design module: definition x 1 =[z θ] T ,x 2 =[w q] T Control input u= [ delta ] c δ f ] T The model can be rewritten as affine:
each system matrix isC 1 =[g 0] T ,/>
The design slip form surface is as follows:
wherein :k 1 、k 2 the constant is V, and the navigation speed of the navigation body is V;
the sliding mode approach law design module: the method is used for weakening buffeting and designing a second-order sliding mode approach law:
wherein S= [ S ] 1 s 2 ] T Is a sliding die surface; z= [ Z ] 1 z 2 ] T An augmented state for the system; m is a positive constant, reflects the sliding mode approach law order, and has m more than or equal to 2; lambda (lambda) 1 ≥0、λ 2 The gain is equal to or more than 0;
the following control laws can be derived:
the stability proving module is used for proving the stability of the second-order sliding mode controller obtained by the sliding mode controller design module through the Lyapunov function; the stability proving module further comprises a Lyapunov module and a time boundary calculating module;
lyapunov module: performing stability demonstration, and enabling:
then for i=1, 2 there is:
the finishing method can obtain:
in the formula :
taking the Lyapunov function as:
in the formula :is a positive definite matrix;
the Lyapunov function is derived from:
in the formula ,when lambda is satisfied 1 >0,/>When Q is a positive definite matrix;
then there are:
in the formula :λQmax Is the maximum eigenvalue of Q, lambda Qmin Is the minimum eigenvalue of Q; then there are:
and a time boundary calculation module: order theIt can be converted into:
solving the above method to obtain a convergence time boundary:
when (when)v 0 Not less than 0, the following are:
thus, the state error can converge to zero within a finite time, the maximum convergence time being
And the simulation analysis module is used for carrying out mathematical simulation analysis.
3. An electronic device comprising a memory and a processor, the memory storing a computer program, characterized in that the processor implements the steps of the method of claim 1 when executing the computer program.
4. A computer readable storage medium storing computer instructions which, when executed by a processor, implement the steps of the method of claim 1.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211035340.9A CN115407788B (en) | 2022-08-26 | 2022-08-26 | Fixed-time convergence second-order sliding mode control method and control system for underwater high-speed navigation body |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211035340.9A CN115407788B (en) | 2022-08-26 | 2022-08-26 | Fixed-time convergence second-order sliding mode control method and control system for underwater high-speed navigation body |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115407788A CN115407788A (en) | 2022-11-29 |
CN115407788B true CN115407788B (en) | 2023-09-15 |
Family
ID=84161148
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211035340.9A Active CN115407788B (en) | 2022-08-26 | 2022-08-26 | Fixed-time convergence second-order sliding mode control method and control system for underwater high-speed navigation body |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115407788B (en) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109298636A (en) * | 2018-11-21 | 2019-02-01 | 东北大学 | A kind of improved integral sliding mode control method |
CN111666628A (en) * | 2020-05-13 | 2020-09-15 | 哈尔滨工业大学 | Adaptive fault-tolerant control method for supercavitation navigation body |
CN111752158A (en) * | 2020-07-17 | 2020-10-09 | 哈尔滨工业大学 | Second-order sliding mode control method for finite time convergence |
CN111913390A (en) * | 2020-07-08 | 2020-11-10 | 北京电子工程总体研究所 | Steady-state bifurcation control method for supercavitation navigation body |
CN112230547A (en) * | 2020-10-26 | 2021-01-15 | 哈尔滨工程大学 | Supercavitation navigation body H∞Controller design method |
-
2022
- 2022-08-26 CN CN202211035340.9A patent/CN115407788B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109298636A (en) * | 2018-11-21 | 2019-02-01 | 东北大学 | A kind of improved integral sliding mode control method |
CN111666628A (en) * | 2020-05-13 | 2020-09-15 | 哈尔滨工业大学 | Adaptive fault-tolerant control method for supercavitation navigation body |
CN111913390A (en) * | 2020-07-08 | 2020-11-10 | 北京电子工程总体研究所 | Steady-state bifurcation control method for supercavitation navigation body |
CN111752158A (en) * | 2020-07-17 | 2020-10-09 | 哈尔滨工业大学 | Second-order sliding mode control method for finite time convergence |
CN112230547A (en) * | 2020-10-26 | 2021-01-15 | 哈尔滨工程大学 | Supercavitation navigation body H∞Controller design method |
Non-Patent Citations (2)
Title |
---|
Adaptive fault-tolerant control for longitudinal motion of supercavitating vehicles;Yuliang Bai 等;European Journal of Control;全文 * |
基于自适应滑模的超空泡航行体控制;范加利 等;华中科技大学学报(自然科学版);第38卷(第1期);第109-112页 * |
Also Published As
Publication number | Publication date |
---|---|
CN115407788A (en) | 2022-11-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107942651B (en) | Near space vehicle control system | |
CN110716566B (en) | Limited time trajectory tracking control method of under-actuated unmanned ship | |
CN107065554B (en) | Near space can be changed the adaptive winglet handover control system of rotor aircraft and working method | |
CN103558009B (en) | The subsection-linear method of supercavitating vehicle dynamical property analysis | |
CN110989628A (en) | CFD-based under-actuated surface ship course control method | |
CN105807789A (en) | UUV control method based on T-S fuzzy observer compensation | |
CN112230547A (en) | Supercavitation navigation body H∞Controller design method | |
CN114265308A (en) | Anti-saturation model-free preset performance track tracking control method for autonomous water surface vehicle | |
CN113885539A (en) | Design method of super-cavity navigation body LPV controller | |
CN108919824A (en) | Shipborne UAV it is longitudinal warship control method | |
CN107748494A (en) | A kind of supercavitating vehicle motion state handover control method | |
CN108873923B (en) | Method for controlling warship surface emergency takeoff of fixed-wing unmanned aerial vehicle through emergency command | |
KR101658112B1 (en) | Method for stabilizing gliding motion of underwater glide | |
CN112051742A (en) | MPC-based full-drive ship track tracking method | |
CN115407788B (en) | Fixed-time convergence second-order sliding mode control method and control system for underwater high-speed navigation body | |
Tang et al. | Adaptive fuzzy nonlinear integral sliding mode control for unmanned underwater vehicles based on ESO | |
CN114637312A (en) | Unmanned aerial vehicle energy-saving flight control method and system based on intelligent deformation decision | |
Geder et al. | Fuzzy logic PID based control design and performance for a pectoral fin propelled unmanned underwater vehicle | |
CN112987771A (en) | Motor sailing ship path tracking control method based on multi-port output error triggering mechanism | |
CN112256046A (en) | Course control method for underwater vehicle | |
Fan et al. | Longitudinal dynamics modeling and MPC strategy for high-speed supercavitating vehicles | |
CN114019985B (en) | Unmanned rudder direction control design method based on fractional order PID and particle swarm algorithm | |
CN113110512B (en) | Benthonic AUV self-adaptive trajectory tracking control method for weakening unknown interference and buffeting influence | |
CN115755891A (en) | Near-surface aircraft motion control method under high sea condition | |
CN112446126B (en) | Simulation method for tail beat motion state of supercavitation navigation body |
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 |