CN113820956B - High-speed AUV motion control method - Google Patents
High-speed AUV motion control method Download PDFInfo
- Publication number
- CN113820956B CN113820956B CN202111393837.3A CN202111393837A CN113820956B CN 113820956 B CN113820956 B CN 113820956B CN 202111393837 A CN202111393837 A CN 202111393837A CN 113820956 B CN113820956 B CN 113820956B
- Authority
- CN
- China
- Prior art keywords
- sliding mode
- speed
- auv
- function
- mode control
- 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 36
- 238000013528 artificial neural network Methods 0.000 claims abstract description 19
- 239000013535 sea water Substances 0.000 claims description 6
- 230000003044 adaptive effect Effects 0.000 claims description 3
- 230000008859 change Effects 0.000 abstract description 2
- 230000006870 function Effects 0.000 description 31
- 230000006872 improvement Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 238000013135 deep learning Methods 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000009189 diving Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012549 training Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
- 230000003313 weakening effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
The invention discloses a motion control method of an Autonomous Underwater Vehicle (AUV), which improves the control precision of the AUV during high-speed motion and effectively inhibits buffeting of a control system by integrating a radial basis function neural network and a boundary layer method into the traditional sliding mode control. Compared with the traditional AUV model simplification method, the high-speed AUV motion control method adds a parameter model with self-adaptive change during model simplification, so that the established model is closer to the actual situation; compared with the traditional AUV sliding mode control method, the method adds the compensation of the radial basis function neural network in the sliding mode control, and improves the switching surface of the sliding mode through a boundary layer method, so that the sliding mode control system can keep higher control precision and inhibit buffeting.
Description
Technical Field
The invention relates to the field of Autonomous Underwater Vehicle (AUV) control, in particular to a high-speed AUV motion control method.
Background
An Autonomous Underwater Vehicle (AUV) is one of powerful tools for exploring ocean space, and is increasingly widely applied to the fields of military ocean technology, oil field survey, seabed salvage, pipeline overhaul, seabed survey and the like. However, the conventional underwater robot generally has the problems of low navigational speed, poor environmental adaptability and the like, and the exploration of the motion control method of the high-speed AUV is an important direction for research around the urgent needs of quick emergency search in deep sea, quick underwater environment evaluation and the like.
PID Control (performance Integration Differentiation Control), backstepping Control (Back Stepping Control), Fuzzy Control (Fuzzy Control), Sliding Mode Control (Sliding Mode Control), Neural network Control (Neural network Control), and the like are some Control methods commonly used in current AUVs, and in recent years, the application of Deep Learning (Deep Learning) in the Control field has also greatly promoted the development of Control technology. The PID control is only suitable for simple control under some AUV weak maneuvers, but is sensitive to environmental parameter change, and setting optimization is troublesome; the backstepping control depends on an accurate mathematical model, but the accurate model of the novel high-speed AUV is difficult to obtain; the sliding mode variable structure control has the characteristic of high response speed, but the sliding mode variable structure control is easy to cause buffeting; fuzzy controllers rely on a priori knowledge; although the neural network control has strong nonlinear approximation capability, the number of network layers and the number of nodes of each layer are difficult to determine; deep learning has powerful complex nonlinear modeling capability, but training thereof is time-consuming, and model correctness verification is complex and cumbersome.
Disclosure of Invention
The invention aims to provide a high-speed AUV motion control method aiming at the defects of the prior art.
The purpose of the invention is realized by the following technical scheme: a high-speed AUV motion control method comprises the following steps:
(1) obtaining a functional relation between system parameters and the navigational speed through polynomial fitting, and obtaining a high-speed AUV simplified motion model according to the functional relation; taking the navigational speed as the input of a high-speed AUV simplified motion model;
(2) selecting a radial basis function, defining a sliding mode function, designing a sliding mode control law and a self-adaptive law, calculating a sliding mode surface switching function based on a boundary layer method, and improving the sliding mode control law;
(3) and (3) performing motion control on the high-speed AUV by using the improved sliding mode control law obtained in the step (2).
Further, the high-speed AUV simplified motion model in step (1) is specifically:
wherein, it is provided withIs provided with,Is the longitudinal speed of the AUV and,the vertical velocity is the velocity of the gas,in order to be at a longitudinal-inclination angle,as to the speed of the pitch angle,for the purpose of the depth value,in order to be a pitching moment,is the rudder angle of the stern rudder,is a positive number, and the number of the positive number,、taking the hydrodynamic coefficient of AUV,The density of the seawater is shown as the density of the seawater,is the length of the high-speed AUV,andis a polynomial coefficient.
Further, the sliding mode function in the step (2) is obtained based on a stability theory, and specifically includes:
Further, the sliding mode control law in the step (2) is as follows:
wherein,,in order to be the pitch angle,is the output of the gaussian-based function,in order to be a coefficient of hydrodynamic force,is the weight of the neural network;
further, the sliding mode surface switching function in the step (2) is as follows:
in the formula,in order to be a function of the sign,is a natural constant and is a natural constant,is a positive number.
Further, the step (3) is specifically: and (3) obtaining a depth error by subtracting the expected depth from the feedback depth, inputting the depth error into a sliding mode function to perform sliding mode control, improving a sliding mode control law by using a radial basis function and a boundary layer method, obtaining an output rudder angle through the sliding mode control law, and finishing the feedback control by changing the depth of the high-speed AUV through the rudder angle.
The sliding mode switching method has the advantages that the sliding mode switching method is used for switching functions through the sliding modeAnd replacement is carried out, buffeting of the sliding mode control system is effectively weakened under the condition that strong robustness of the system is ensured, and practicability of a control algorithm is improved. In the method, the influence of internal and external disturbance of the high-speed AUV during high-speed maneuvering can be effectively inhibited through the compensation of the radial basis function neural network on the sliding mode control, so that the control precision of the high-speed AUV at different navigational speeds is ensured, and the working performance of the system is improved.
In order to realize the motion Control of the high-speed AUV, the invention improves the AUV Control system by applying a radial basis function neural network and a nonlinear switching surface to a Sliding Mode Control (SMC) Mode, so as to achieve the purposes of weakening the buffeting of the system and improving the motion Control precision.
Drawings
FIG. 1 is a schematic diagram of the working principle of high-speed AUV depth control;
FIG. 2 is a schematic diagram showing depth comparison before and after improvement of the high-speed AUV diving algorithm at the speed of 10 knots;
FIG. 3 is a schematic diagram showing a comparison of rudder angles before and after the improvement of the high-speed AUV by the 10-joint cruise latency algorithm.
Detailed Description
The invention is further illustrated by the following figures and examples. The invention provides a high-speed AUV motion control method, which specifically comprises the following steps:
(1) obtaining a functional relation between system parameters and the navigational speed through polynomial fitting, and obtaining a high-speed AUV simplified motion model according to the functional relation; and taking the navigational speed as the input of the high-speed AUV simplified motion model. The method specifically comprises the following steps:
fig. 1 is a schematic diagram of a high-speed AUV inertial coordinate system and a carrier coordinate system, and simplifies a dynamic model of the high-speed AUV. The method is characterized in that the depth control is carried out on the high-speed AUV under different navigation speeds, and when the AUV maneuvers according to the depth, the longitudinal speed is assumedThe longitudinal speed being provided solely by the thrust system and being able to be maintained at a stable valueIs constant, neglecting the effect of rolling, then there are,Is a positive number, and the number of the positive number,in order to achieve a longitudinal navigational speed,the speed of the ship is vertical to the ship,is the pitch angle. The high-speed AUV is assumed to have symmetrical shape structure left and right and approximately symmetrical up and down, and under the condition of high-speed motion, the high-speed AUV has longitudinal speedCompared with the heave motion speedMuch smaller, no possibility of making the heave movement speedSeen as a small perturbation, say。
The simplified dynamic model of the vertical plane motion is as follows:
wherein,,is provided withFor the influence of internal and external disturbances on the uncertainty of the modeling model,is the longitudinal speed of the AUV and,the vertical velocity is the velocity of the gas,in order to be at a longitudinal-inclination angle,as to the speed of the pitch angle,for the purpose of the depth value,in order to be a pitching moment,is the rudder angle of the stern rudder,is a positive number, and the number of the positive number,、hydrodynamic coefficient of AUV, their and speedThe functional relationship of (A) can be obtained by polynomial fitting, preferablyWhereinIs the longitudinal speed of the high-speed AUV,the density of the seawater is shown as the density of the seawater,is the length of the high-speed AUV,andis a polynomial coefficient;the same is true. In this example, take、、、And。
(2) selecting a radial basis function neural network, defining a sliding mode surface, calculating the self-adaption rate of the neural network, calculating a sliding mode surface switching function, and designing a sliding mode control law and a self-adaption law; the method specifically comprises the following steps:
(2.1) selecting a radial basis function neural network:
because the Radial Basis Function (RBF) neural network has the capability of infinite approximation, the RBF neural network is adopted for approximationNetwork input fetchThe network output is:then, there are:wherein。
(2.2) defining a sliding mode function:
in order to reduce the number of the parameters of the controller, the parameter adjusting efficiency is improved. Based on the Hurwitz stability theory, a characteristic equation of a Hurwitz criterion is set as follows:whereinFor Laplace operators, i.e. requiring polynomialsThe real part of the eigenvalue of (d) is negative. Is not to takeI.e. byGet itThe requirements of Hurwitz can be met, wherein,, ,,Is a positive number. The sliding mode function can be expressed as:whereinIs an error.
(2.3) designing a sliding mode control law and an adaptive law:
according to the Lyapunov function (Lyapunov function)And step ofThe sliding mode control law of the sliding mode function defined in the step (2.2) is as follows:
wherein,,in order to be the pitch angle,is the output of the gaussian-based function,in order to be a coefficient of hydrodynamic force,is the weight of the neural network.
Based on the controller design of the sliding mode control law and the self-adaptive law, the system stability can be simply proved as follows:
based on the stability of Lyapunov:
(2.4) designing a sliding mode surface switching function by using a boundary layer method, and improving a sliding mode control law:
the switching function of the boundary layer in the traditional sliding mode control is a sign functionThe discontinuity is liable to cause a buffeting phenomenon of the system. In order to weaken the buffeting phenomenon of the traditional sliding mode control, the sliding mode control law designed in the step (2.3) is improved by utilizing a boundary layer method, and a nonlinear function (namely a sliding mode surface switching function) with smooth continuous characteristic is adoptedFunction of substitution signK is a positive number for adjusting the non-linear functionAt the switching speed near the zero point, the switching characteristics can be improved. The post-replacement control law is:
(3) And (3) performing motion control on the high-speed AUV by using the improved sliding mode control law obtained in the step (2):
referring to the attached drawing 1, the working principle of the high-speed AUV depth control in the scheme of the invention is schematically shown.
And obtaining a depth error by subtracting the expected depth from the feedback depth, inputting the depth error into a sliding mode function to perform sliding mode control, improving a sliding mode control law by using a Radial Basis Function (RBF) neural network and a boundary layer method, obtaining an output rudder angle through the sliding mode control law (namely a rudder angle control law), and changing the depth through the rudder angle by using a high-speed AUV (autonomous underwater vehicle). And finally, outputting the actual depth to realize a negative feedback control process.
In order to verify the effectiveness of the method, assuming that the high-speed AUV 10 is submerged at a navigational speed of 10 meters (5.145 meters/second), the sliding mode control method based on the radial basis function neural network (after improvement) and the traditional sliding mode control method (before improvement) of the invention are verified to be effective in improving the control precision, as shown in fig. 2 and 3, it can be seen that after the improvement based on the idea of the invention, the steady-state error is reduced, the control precision is improved, and the buffeting is effectively weakened.
In summary, the present invention is applicable to a sliding mode switching functionAnd replacement is carried out, buffeting of the sliding mode control system is effectively weakened under the condition that strong robustness of the system is ensured, and practicability of a control algorithm is improved. In the method, the influence of internal and external disturbance of the high-speed AUV during high-speed maneuvering can be effectively inhibited through the compensation of the radial basis function neural network on the sliding mode control, so that the control precision of the high-speed AUV at different navigational speeds is ensured, and the working performance of the system is improved. The invention utilizes a sliding mode control method based on a radial basis function neural network to carry out depth control on the high-speed AUV under the conditions of different navigational speeds and different loads, thereby realizing depth maneuver under different tasks.
Claims (1)
1. A high-speed AUV motion control method is characterized by comprising the following steps:
(1) obtaining a functional relation between system parameters and the navigational speed through polynomial fitting, and obtaining a high-speed AUV simplified motion model according to the functional relation; taking the navigational speed as the input of a high-speed AUV simplified motion model;
the high-speed AUV simplified motion model specifically comprises the following steps:
wherein, it is provided withIs provided with,Is the longitudinal speed of the AUV and,the vertical velocity is the velocity of the gas,in order to be at a longitudinal-inclination angle,as to the speed of the pitch angle,for the purpose of the depth value,in order to be a pitching moment,is the rudder angle of the stern rudder,is a positive number, and the number of the positive number,、taking the hydrodynamic coefficient of AUV,The density of the seawater is shown as the density of the seawater,is the length of the high-speed AUV,andis a polynomial coefficient;
(2) selecting a radial basis function, defining a sliding mode function, designing a sliding mode control law and a self-adaptive law, calculating a sliding mode surface switching function based on a boundary layer method, and improving the sliding mode control law;
the sliding mode function is obtained based on a stability theory, and specifically comprises the following steps:
the sliding mode control law is as follows:
wherein,,in order to be the pitch angle,is the output of the gaussian-based function,in order to be a coefficient of hydrodynamic force,is the weight of the neural network;
the sliding mode surface switching function is as follows:
in the formula,in order to be a function of the sign,is a natural constant and is a natural constant,is a positive number;
(3) performing motion control on the high-speed AUV by using the improved sliding mode control law obtained in the step (2); the method specifically comprises the following steps: and (3) obtaining a depth error by subtracting the expected depth from the feedback depth, inputting the depth error into a sliding mode function to perform sliding mode control, improving a sliding mode control law by using a radial basis function and a boundary layer method, obtaining an output rudder angle through the sliding mode control law, and finishing the feedback control by changing the depth of the high-speed AUV through the rudder angle.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111393837.3A CN113820956B (en) | 2021-11-23 | 2021-11-23 | High-speed AUV motion control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111393837.3A CN113820956B (en) | 2021-11-23 | 2021-11-23 | High-speed AUV motion control method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113820956A CN113820956A (en) | 2021-12-21 |
CN113820956B true CN113820956B (en) | 2022-02-22 |
Family
ID=78919732
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111393837.3A Active CN113820956B (en) | 2021-11-23 | 2021-11-23 | High-speed AUV motion control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113820956B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115639747A (en) * | 2022-09-30 | 2023-01-24 | 浙江大学 | AUV navigation intelligent system and method |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109946976A (en) * | 2019-04-15 | 2019-06-28 | 东北大学 | A kind of width speed of a ship or plane AUV motion control method |
CN110427040A (en) * | 2019-07-16 | 2019-11-08 | 哈尔滨工程大学 | A kind of drive lacking cableless underwater robot depth backstepping control method based on dynamic surface sliding formwork |
CN113359785A (en) * | 2021-06-18 | 2021-09-07 | 河南科技学院 | Microminiature AUV underwater motion and hovering control method |
-
2021
- 2021-11-23 CN CN202111393837.3A patent/CN113820956B/en active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109946976A (en) * | 2019-04-15 | 2019-06-28 | 东北大学 | A kind of width speed of a ship or plane AUV motion control method |
CN110427040A (en) * | 2019-07-16 | 2019-11-08 | 哈尔滨工程大学 | A kind of drive lacking cableless underwater robot depth backstepping control method based on dynamic surface sliding formwork |
CN113359785A (en) * | 2021-06-18 | 2021-09-07 | 河南科技学院 | Microminiature AUV underwater motion and hovering control method |
Non-Patent Citations (6)
Title |
---|
Design of novel sliding-mode controller for high-velocity AUV with consideration of residual dead load;JIANG Chun-meng 等;《J. Cent. South Univ》;20181231;第25卷;全文 * |
Smooth transition of AUV motion control: From fully-actuated to under-actuated configuration;X. Xiang 等;《Robotics and Autonomous Systems》;20151231;全文 * |
单桨微型高速AUV运动控制策略;施涤凡 等;《装备制造技术》;20210517(第2期);第1章节-5章节 * |
基于观测器的动态终端滑模控制器在高速小型水下机器人姿态角控制上的应用;胡广睿;《中国优秀博硕学位论文全文数据库 信息科技辑》;20130215(第2期);全文 * |
大尺度欠驱动高速AUV导航系统研制;翟云峰 等;《中国舰船研究》;20181231;第13卷(第6期);全文 * |
面向海底地形勘探的欠驱动AUV运动控制;霍宇彤;《中国优秀硕士学位论文全文数据库基础科学辑》;20200615(第6期);说明书第2-4章 * |
Also Published As
Publication number | Publication date |
---|---|
CN113820956A (en) | 2021-12-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Skjetne et al. | A nonlinear ship manoeuvering model: Identification and adaptive control with experiments for a model ship | |
CN102385316B (en) | Deepening controlling method of underactuated automatic underwater vehicle based on neural network back stepping method | |
CN108052009B (en) | Water surface target rescue tracking observation controller design method based on filtering backstepping method | |
CN114879671B (en) | Unmanned ship track tracking control method based on reinforcement learning MPC | |
CN109946976B (en) | Wide-navigational-speed AUV motion control method | |
Xia et al. | Adaptive energy-efficient tracking control of a X rudder AUV with actuator dynamics and rolling restriction | |
Liu et al. | A hierarchical disturbance rejection depth tracking control of underactuated AUV with experimental verification | |
Yu et al. | Output feedback spatial trajectory tracking control of underactuated unmanned undersea vehicles | |
Deng et al. | UKF based nonlinear offset-free model predictive control for ship dynamic positioning under stochastic disturbances | |
CN109521798A (en) | AUV motion control method based on finite time extended state observer | |
CN113820956B (en) | High-speed AUV motion control method | |
Tang et al. | Robust fixed-time trajectory tracking control of the dynamic positioning ship with actuator saturation | |
Dai et al. | Dual closed loop AUV trajectory tracking control based on finite time and state observer | |
CN113110512B (en) | Benthonic AUV self-adaptive trajectory tracking control method for weakening unknown interference and buffeting influence | |
CN114296449A (en) | Water surface unmanned ship track rapid tracking control method based on fixed time H-infinity control | |
Nguyen et al. | Robust Adaptive Depth Control of hybrid underwater glider in vertical plane | |
CN117420850A (en) | Depth setting control algorithm of under-actuated underwater vehicle | |
CN115951693B (en) | Robust track tracking control method for under-actuated underwater robot | |
Shikai et al. | Trajectory tracking for underactuated UUV using terminal sliding mode control | |
Liu et al. | ADRC‐SMC‐based disturbance rejection depth‐tracking control of underactuated AUV | |
Huang et al. | SHSA-based adaptive roll-safety 3D tracking control of a X-Rudder AUV with actuator dynamics | |
Wan et al. | Fractional order PID motion control based on seeker optimization algorithm for AUV | |
CN114004035B (en) | Target tracking control method for unmanned surface vehicle | |
CN118112918A (en) | Autonomous underwater robot motion control method | |
CN112904719B (en) | Annular area tracking control method suitable for underwater robot position |
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 |