CN110045751A - There is cable underwater robot seabed accuracy motion control method based on SI control - Google Patents
There is cable underwater robot seabed accuracy motion control method based on SI control Download PDFInfo
- Publication number
- CN110045751A CN110045751A CN201910398059.3A CN201910398059A CN110045751A CN 110045751 A CN110045751 A CN 110045751A CN 201910398059 A CN201910398059 A CN 201910398059A CN 110045751 A CN110045751 A CN 110045751A
- Authority
- CN
- China
- Prior art keywords
- control
- face
- established
- rov
- seabed
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 63
- 230000008569 process Effects 0.000 claims abstract description 13
- 239000011159 matrix material Substances 0.000 description 9
- 230000000694 effects Effects 0.000 description 8
- 238000004088 simulation Methods 0.000 description 8
- 230000003044 adaptive effect Effects 0.000 description 4
- 238000013528 artificial neural network Methods 0.000 description 4
- 238000006073 displacement reaction Methods 0.000 description 3
- 230000005484 gravity Effects 0.000 description 3
- 230000006872 improvement Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000013016 damping Methods 0.000 description 2
- 238000009795 derivation Methods 0.000 description 2
- 238000005183 dynamical system Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 241000251511 Holothuroidea Species 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000003466 anti-cipated effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 239000003208 petroleum Substances 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000009738 saturating Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
- 230000017105 transposition Effects 0.000 description 1
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
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/0088—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/04—Control of altitude or depth
- G05D1/048—Control of altitude or depth specially adapted for water vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
Landscapes
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Health & Medical Sciences (AREA)
- Medical Informatics (AREA)
- Evolutionary Computation (AREA)
- Artificial Intelligence (AREA)
- Software Systems (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Business, Economics & Management (AREA)
- Game Theory and Decision Science (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
There is cable underwater robot seabed accuracy motion control method based on SI control, the present invention relates to underwater robot seabed accuracy motion control methods.The problem of the purpose of the present invention is to solve mostly using manual hand manipulation to land greatly when existing ROV carries out seabed landing, time-consuming and laborious, accuracy precision is poor, is easy the even accident that collides with submerged structure, causes serious economic loss.Detailed process are as follows: Step 1: establishing the control of the face s;Step 2: establishing PID control based on the face the s control that step 1 is established;Step 3: controlling based on the face s that step 1 is established, the PID control that step 2 is established, SI control is established.The present invention is used for underwater robot seabed accuracy motion control field.
Description
Technical field
The present invention relates to underwater robot seabed accuracy motion control methods.
Background technique
Having cable underwater robot (Remote Operated Vehicle, abbreviation ROV) is a national marine equipment technology
Horizontal one of the important signs that.The relevant technologies for studying ROV salvage national economy, seabed space utilization, deep-sea tourism, deep-sea
Immeasurable strategic importance is suffered from lifesaving etc..
The hot spot for complying with ROV research, has studied the method in relation to the seabed ROV accuracy motor control problems.For
The coordinate of known landing point and ideal head are automatically moved to the control of landing point to the ROV near landing point in the case where
Problem is studied.
(1) currently, ROV carries out the mode for mostly using manual hand manipulation to land greatly when the landing of seabed, this mode
Veteran operator's reciprocating operation is generally required repeatedly and can just make ROV to land a relatively satisfied position, it is time-consuming to take
Power.
(2) currently, ROV carries out the mode for mostly using manual hand manipulation to land greatly when the landing of seabed, this mode
Accuracy precision it is poor, especially in more severe underwater environment.
(3) currently, due to ROV underwater operation complication, operator generally requires very stringent Professional Certification.
(4) since the ken of underwater ROV is limited and image transmitting has delay and artificial operation error, this is just led
The landing of the cause seabed manual operation ROV is easy to collide with submerged structure or even accident, causes serious economic loss.
Summary of the invention
The purpose of the present invention is to solve mostly use manual hand manipulation to carry out greatly when existing ROV carries out seabed landing
Land, time-consuming and laborious, accuracy precision is poor, is easy the even accident that collides with submerged structure, causes serious economic damage
The problem of mistake, and propose there is cable underwater robot seabed accuracy motion control method based on what SI was controlled.
There is cable underwater robot seabed accuracy motion control method detailed process based on SI control are as follows:
Step 1: establishing the control of the face s;Detailed process are as follows:
The control law of the face s control method are as follows:
Wherein, τ is the control force and torque that control system generates;S is s surface function,k1、k2For the face s
Control parameter, e ' are position tracking error;For the derivative of position tracking error;esFor the e index of s;
Step 2: establishing PID control based on the face the s control that step 1 is established;
Step 3: controlling based on the face s that step 1 is established, the PID control that step 2 is established, SI control is established.
The invention has the benefit that
Present invention research ROV accuracy motion control is adjusted through row using the method for control, ROV is made to land faster
To the predetermined area, improve working efficiency (faster), it is time saving and energy saving.
Present invention research ROV accuracy motion control can be very good the precision for improving the accuracy of the seabed ROV, more
The homework precision of good guarantee ROV and the fine observation of satisfaction require, and improve accuracy precision (more quasi-).
The seabed fixed-point motion of present invention research ROV controls, and makes ROV more intelligent, allows everyone, can be easily
ROV is operated, his purpose (such as fisherman fishes out sea cucumber with ROV) is realized, reduces the use difficulty (more intelligent) of ROV.This is for ROV
Popularization and use it is significant.
Present invention research ROV accuracy motion control, makes ROV accuracy more safe and reliable, reduces the underwater thing of ROV
Therefore (safer), it is not easy to collide with submerged structure, reduces economic loss.
The present invention conducts a research for the accuracy motion control of the seabed ROV, based on the control of the classical face s, in conjunction with PID
Integral term I in control, proposes SI control method, make ROV faster, it is more quasi-, more intelligent, more safely reach operation or sight
Geodetic point.
It can be seen that from the simulation result of Fig. 2,3,4,5 in different ocean currents, SI control is in control steady-state error
The ability of aspect is better than the traditional face s control, is significantly improved in the control precision of ROV accuracy motion control.
And it is found in emulation experiment, t0Take that will to generate effect in preceding 2-3 seconds of steady-state error in system preferable.Simulation example is tested
The validity of inventive algorithm is demonstrate,proved.
Detailed description of the invention
Fig. 1 is SI control algolithm structure chart;
Fig. 2 is 2 constant section transverse direction ocean current (t0=8s) swaying tracking error ey figure, t0For the introducing for integral term in PID
Time delay;T is time variable, and ey is the ROV position tracking error in y-axis direction;
1 Fig. 3 constant section transverse direction ocean current (t0=15s) swaying tracking error ey figure;
Fig. 4 meets with the 2 section transverse direction ocean current (t of (t=8s) suddenly0=8s) swaying tracking error ey figure, t is time variable;
Fig. 5 is the 1 section transverse direction ocean current (t for meeting with (t=8s) suddenly0=15s) swaying tracking error ey figure.
Specific embodiment
Specific embodiment 1: present embodiment has cable underwater robot seabed accuracy campaign control based on what SI was controlled
Method detailed process processed are as follows:
(1) ROV studies the definition of relative coordinate system: inertial coodinate system (E- ξ η ζ): origin E can be selected in the certain point on sea,
E ξ axis and E η axis are placed in horizontal plane and orthogonal, E ξ axis forward direction direction direct north.E ζ refers to perpendicular to E ξ η plane, forward direction
To the earth's core;
Kinetic coordinate system G-xyz: origin G takes in the center of gravity of ROV, and x-axis, y-axis and z-axis are respectively to pass through the waterline of origin
The intersection in face, cross section and central fore-and-aft vertical plane;
(2) modeling technique of ROV: six degree of freedom linear R OV model [1] ([1] Fossen T I. based on Fossen
Handbook of Marine Craft Hydrodynamics and Motion Control[M].2011.).The model with
Based on dynamics of rigid bodies, rigid body kinematics, hydrodynamics etc., complicated derivation is carried out, and carried out relatively reasonable letter
Change.The blueness of numerous scientists is received in the emulation of control field currently based on Fossen six degree of freedom linear R OV model
It looks at.The present invention is based on the six degree of freedom linear R OV models of Fossen to have carried out in detail to ROV accuracy motion control method
Research.
The kinetics equation of ROV: it is indicated using the six degree of freedom nonlinear model based on Fossen are as follows:
In formula: η is six-degree of freedom position and attitude value of the ROV under fixed coordinate system, η=[x, y, z, φ, θ, ψ]T;x
It is ROV in the displacement of x-axis direction, y is displacement of the ROV in y-axis direction, and z is displacement of the ROV in z-axis direction, and φ is the cross of ROV
Inclination angle, θ are the Angle of Trim of ROV, and ψ is to shake first angle;For six-degree of freedom position of the ROV under fixed coordinate system and attitude value clock synchronization
Between first derivative;The second dervative of the six-degree of freedom position for being ROV under fixed coordinate system and attitude value to the time;T is
Transposition;
M is mass inertia matrix;M*Mass inertia matrix after being transformed into kinetic coordinate system for property coordinate system, M*=J- TMJ-1, J is the transition matrix that inertial coodinate system is transformed into kinetic coordinate system;
CRBFor the coriolis force and centripetal force matrix of rigid body;Rigid body after kinetic coordinate system is transformed into for inertial coodinate system
Coriolis force and centripetal force matrix;
CAFor the coriolis force and centripetal force matrix of additional mass;It is added after being transformed into kinetic coordinate system for inertial coodinate system
The coriolis force and centripetal force matrix of quality;
D is hydrodynamic damping matrix;D*Hydrodynamic damping matrix after being transformed into kinetic coordinate system for inertial coodinate system, D*
=J-TDJ-1;
G is the power and torque vector that gravity and buoyancy generate;g*Gravity after kinetic coordinate system is transformed into for inertial coodinate system
The power and torque vector generated with buoyancy, g*=J-Tg;
τ is the control force and torque that control system generates;τ*System is controlled after being transformed into kinetic coordinate system for inertial coodinate system
The control force and torque that system generates, τ*=J-Tτ;
(3) face s control method: the control of the face s and is carried out fuzzy control rule table non-from fuzzy control
Linear fit replaces fuzzy rule base with Sigmoid curved surface, and then obtains the face s controller [2] ([2] Liu Xuemin, Xu Yuru
The face s control method [J] ocean engineering of underwater robot movement, 2001,19 (3): 81-84).The face s is controlled in 2001 and is mentioned
After out, it have passed through multi-party improvement, make some progress, but few experts and scholars provide in the improved face s controls
Stringent theoretical convergence proves.
The control of the face s is substantially to carry out nonlinear fitting from fuzzy control, and by fuzzy control rule table, is used
Sigmoid curved surface replaces fuzzy rule base, and then obtains the face s controller
The control law of the face s control method are as follows:
Wherein, τ is the control force and torque that control system generates;S is s surface function,k1、k2For the face s
Control parameter, e ' are position tracking error;For the derivative of position tracking error;esFor the e index of s;
The face s control methods are fitted the control object with strong nonlinearity characteristic using nonlinear function, and control effect is better than
PID control can effectively improve robot in the control precision of anchor point operation, so the present invention considers kind of a method and exists
The control of the face s is improved, has obtained good effect by the application in the seabed ROV accuracy motion control method.
(4) Lyapunov Theory of Stability: it can be used to describe the stability of a dynamical system.If this dynamical system is appointed
What track of the primary condition near equilibrium state can maintain near equilibrium state, and such case is known as Lyapunov and stablizes.
Lyapunov Theory of Stability is that the hot topic of current control field is theoretical, and the present invention ingeniously borrows Lyapunov stability
Reason, it was demonstrated that the stability of SI control algolithm realizes certain theoretical breakthrough.
If it is the continuous function in the decimal greater than zero that function V (x), which is in Phase Coordinates original neighborhood of a point P, P < H, H,
V (x) continuously differentiable in Phase Coordinates original neighborhood of a point P, and V (x) and be positive definite, i.e., other than V (0)=0, for P
In all other equal V (x) > 0 of point, such function is known as Lyapunov function.
If theorem 1 is for kinetics equation, there are a Lyapunov function V (x), total derivativesIt is negative half
It is fixed (i.e. for all the points in P), then the equation is stable.
If theorem 2 is for equation, there are a Lyapunov function V (x), total derivativesBe negative definite (i.e.
It removesOutside, have for point every other in P), then the fixed point of equation is asymptotically stable.
(5) PID control method: PID control is exactly the error according to system, and proportion of utilization, integral, difference gauge calculate control
What amount was controlled.The basis of PID control is ratio control;Integration control can eliminate steady-state error, but can increase overshoot;It is micro-
Sub-control system can accelerate Great inertia system response speed and weaken overshoot trend.PID control has been studied relatively saturating at present
It is thorough and relatively broad in practical applications.
Step 1: establishing the control of the face s;Detailed process are as follows:
The control of the face s is substantially to carry out nonlinear fitting from fuzzy control, and by fuzzy control rule table, is used
Sigmoid curved surface replaces fuzzy rule base, and then obtains the face s controller;
The control law of the face s control method are as follows:
Wherein, τ is the control force and torque that control system generates;S is s surface function,k1、k2For the face s
Control parameter, e ' are position tracking error;For the derivative of position tracking error;esFor the e index of s;
The face s control methods are fitted the control object with strong nonlinearity characteristic using nonlinear function, and control effect is better than
PID control, can effectively improve robot in the control precision of anchor point operation, so the present invention considers kind of a method and exists
The control of the face s is improved, has obtained good effect by the application in the seabed ROV accuracy motion control method.
Step 2: establishing PID control based on the face the s control that step 1 is established;
Step 3: controlling based on the face s that step 1 is established, the PID control that step 2 is established, SI control is established.
Specific embodiment 2: the present embodiment is different from the first embodiment in that: based on step in the step 2
Rapid one face the s control established, establishes PID control;Detailed process are as follows:
Pid control algorithm calculates corresponding thrust according to the deviation of amount each in motion process, right for position control
The basic demand of controller is to can control latent device to make various movements, such as avoidance, positioning.For motion state, to controller
It is required that be can guarantee latent device it is anticipated that speed or acceleration movement.Such as remote-controlled vehicle needs two kinds of control modes,
When far from target point, it is desirable that submersible is moved with fixed speed to target point, i.e., does PID control by velocity deviation;When with
When the distance of target point is less than certain value, opsition dependent deviation does PID control.The present invention is to the coordinate and ideal in known landing point
Head studies the control problem for being automatically moved to landing point of the ROV near landing point in the case where, and selection is position
Set deviation PID control.
PID control control rate is as follows:
Wherein, kp、ki、kdFor pid control parameter;T is time variable.
Other steps and parameter are same as the specific embodiment one.
Specific embodiment 3: the present embodiment is different from the first and the second embodiment in that: base in the step 3
In the PID control that the face s that step 1 is established control, step 2 are established, SI control is established;Detailed process are as follows:
The control of the face s can easily be accommodated since parameter is less receives the favor of numerous researchers.With going deep into for research,
The shortcomings that face s controls also embodies, when the complicated marine environment of the face s control reply ocean current etc., it may appear that the phenomenon that steady-state error.
The improvement of a variety of methods has been attempted to solve this problem.Wherein missed in the method for the face ART network s parameter to eliminate stable state
The correlative study of difference is the most mature.But this change is increased than complex based on the face the s control method of ART network parameter
Into the practical application difficulty of the face s control method.The present invention blends the integral term I of the face s control method and PID control method,
A kind of novel face s control method is proposed, and is named as SI control.Also, the present invention is based on Lyapunov Theory of Stability
Stringent proof is carried out to the convergence of SI method, the preciseness for the theory of algorithm for controlling SI, integrality are calculated higher than the original face s
Method.This is also a big innovative point of the invention.
The control law of SI method is as follows
Wherein, t0For the introducing time delay of integral term in PID;T is time variable;k3For SI control parameter.
Only k in entire control law1、k2、k3Three simulation parameters ensure that practicability and easy modulability that SI is controlled.And
And SI control is controlled compared to traditional face s, the marine environment severe to ocean current has fine anti-interference ability.
Other steps and parameter are the same as one or two specific embodiments.
It is as follows based on proof procedure of the Lyapunov Theory of Stability to SI control algolithm:
It enables
It enables
Work as τ > τ0When, s > 0
E=x-xd
Because of s > 0 and x=xdWhen
So
I.e.
As τ < τ0When, s < 0
Because of s < 0 and x=xdWhen
So
I.e.
To sum up it can be concluded thatSgn is sign function.
Enable intermediate variable
From derivation above
Then
Due to will not influence the positive and negative of function divided by a positive number t, so to h- τ0Do Local treatment.And because
So
According to Lyapunov Theory of Stability, SI control algolithm is stable.
Embodiment:
The face s control method:
The face s control algolithm is applied in ROV, when encountering the influence of ocean current, can generate steady-state error.It is controlled when adjusting the face s
When two parameters of system, discovery steady-state error is difficult to eliminate, or has paid the very big cost of overshoot to eliminate steady-state error,
Cause control effect undesirable, especially (Z-direction is impermissible for occurring in practical applications in the seabed ROV accuracy control
Overshoot, otherwise ROV can hit seabed).And SI algorithm dexterously passes through the introducing of time delay integration item, solves ROV and encounters sea
Control leads to the problem of steady-state error after stream, and the introducing of integral term not will lead to over control in the PID of delay process
Generation.
The adaptive face s control method:
The adaptive face s control method also can be well solved control after ROV encounters ocean current and lead to the problem of steady-state error, but
It is that the adaptive face s control method is increasingly complex compared to the SI control algolithm in the present invention, practical application difficulty is higher.It solves identical
The problem of in the case of, the control of the easy modulability of SI control algolithm, the practicability more adaptive face s is stronger.This is also the face s control from now on
The practical application of system and improvement open new road.
Neural network control method:
The stability of SI control algolithm is significantly better than neural network.Although the study of neural network be it is comprehensive, just
Because its study mechanism be it is comprehensive, the amplitudes such as the acoustic jamming of signal and approximation or the interference in periods is waited all very likely to make
It is even dissipated at the oscillation of study, therefore the control effect of neural network is undesirable under relatively harsh conditions.
Simulation example
Emulation prepares:
Based on document [3] (the open-shelf observation type ROV spot hover control method of [3] Gao Sheng, Chen Kun, Zhang Liwei, et al.
Study [J] petroleum machinery, 2019 (2): 55-64.) in ROV model to it is proposed by the present invention based on SI control the seabed ROV
Accuracy motion control method has carried out simulating, verifying.
1 ROV hydrodynamic force coefficient of table
2 ROV inertia coeffeicent of table
3 ROV initial position of table and posture table
4 ROV accuracy position of table and posture table
Simulation analysis:
It is primarily based on Simulink, has built SI control algolithm structure chart such as Fig. 1.
Introducing for integral term in different ocean current situations and different PID postpones t0, the present invention to SI control and
The traditional face s control has carried out contrast simulation research.Such as Fig. 2,3,4,5;
It can be seen that from the simulation result of Fig. 2,3,4,5 in different ocean currents, SI control is in control steady-state error
The ability of aspect is better than the traditional face s control, is significantly improved in the control precision of ROV accuracy motion control.
And it is found in emulation experiment, t0Take that will to generate effect in preceding 2-3 seconds of steady-state error in system preferable.Simulation example is tested
The validity of inventive algorithm is demonstrate,proved.
The present invention can also have other various embodiments, without deviating from the spirit and substance of the present invention, this field
Technical staff makes various corresponding changes and modifications in accordance with the present invention, but these corresponding changes and modifications all should belong to
The protection scope of the appended claims of the present invention.
Claims (3)
1. having cable underwater robot seabed accuracy motion control method based on SI control, it is characterised in that: the method
Detailed process are as follows:
Step 1: establishing the control of the face s;Detailed process are as follows:
The control law of the face s control method are as follows:
Wherein, τ is the control force and torque that control system generates;S is s surface function,k1、k2For the control of the face s
Parameter, e ' are position tracking error;For the derivative of position tracking error;esFor the e index of s;
Step 2: establishing PID control based on the face the s control that step 1 is established;
Step 3: controlling based on the face s that step 1 is established, the PID control that step 2 is established, SI control is established.
2. accuracy motion control method in cable underwater robot seabed is had based on SI control according to claim 1,
Be characterized in that: PID control is established in the face the s control established in the step 2 based on step 1;Detailed process are as follows:
PID control control rate is as follows:
Wherein, kp、ki、kdFor pid control parameter;T is time variable.
3. according to claim 1 or claim 2 have cable underwater robot seabed accuracy motion control method based on SI control,
It is characterized by: controlling in the step 3 based on the face s that step 1 is established, the PID control that step 2 is established, SI control is established
System;Detailed process are as follows:
The control law of SI method is as follows
Wherein, t0For the introducing time delay of integral term in PID;k3For SI control parameter.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910398059.3A CN110045751B (en) | 2019-05-14 | 2019-05-14 | Submarine fixed-point landing motion control method for cabled underwater robot based on SI control |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910398059.3A CN110045751B (en) | 2019-05-14 | 2019-05-14 | Submarine fixed-point landing motion control method for cabled underwater robot based on SI control |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110045751A true CN110045751A (en) | 2019-07-23 |
CN110045751B CN110045751B (en) | 2022-10-04 |
Family
ID=67281946
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910398059.3A Active CN110045751B (en) | 2019-05-14 | 2019-05-14 | Submarine fixed-point landing motion control method for cabled underwater robot based on SI control |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110045751B (en) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1261279A1 (en) * | 2000-02-04 | 2002-12-04 | Institut National De La Recherche Agronomique | Method for analysing irregularities in human locomotion |
WO2004003680A2 (en) * | 2002-04-22 | 2004-01-08 | Neal Solomon | System, method and apparatus for automated collective mobile robotic vehicles used in remote sensing surveillance |
CN1718378A (en) * | 2005-06-24 | 2006-01-11 | 哈尔滨工程大学 | S face control method of flotation under water robot motion |
US20100305912A1 (en) * | 2009-05-28 | 2010-12-02 | General Electric Company | Real-time scheduling of linear models for control and estimation |
WO2013055441A2 (en) * | 2011-08-16 | 2013-04-18 | Unmanned Innovation Inc. | Modular flight management system incorporating an autopilot |
CN106950974A (en) * | 2017-04-19 | 2017-07-14 | 哈尔滨工程大学 | Drive lacking Autonomous Underwater Vehicle is understood three-dimensional path and tracking and controlling method |
CN108238220A (en) * | 2016-12-27 | 2018-07-03 | 中国科学院沈阳自动化研究所 | A kind of long-term ocean weather station observation device of deep-sea ecological process |
-
2019
- 2019-05-14 CN CN201910398059.3A patent/CN110045751B/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1261279A1 (en) * | 2000-02-04 | 2002-12-04 | Institut National De La Recherche Agronomique | Method for analysing irregularities in human locomotion |
WO2004003680A2 (en) * | 2002-04-22 | 2004-01-08 | Neal Solomon | System, method and apparatus for automated collective mobile robotic vehicles used in remote sensing surveillance |
CN1718378A (en) * | 2005-06-24 | 2006-01-11 | 哈尔滨工程大学 | S face control method of flotation under water robot motion |
US20100305912A1 (en) * | 2009-05-28 | 2010-12-02 | General Electric Company | Real-time scheduling of linear models for control and estimation |
WO2013055441A2 (en) * | 2011-08-16 | 2013-04-18 | Unmanned Innovation Inc. | Modular flight management system incorporating an autopilot |
CN108238220A (en) * | 2016-12-27 | 2018-07-03 | 中国科学院沈阳自动化研究所 | A kind of long-term ocean weather station observation device of deep-sea ecological process |
CN106950974A (en) * | 2017-04-19 | 2017-07-14 | 哈尔滨工程大学 | Drive lacking Autonomous Underwater Vehicle is understood three-dimensional path and tracking and controlling method |
Non-Patent Citations (4)
Title |
---|
SUN YUSHAN,等: "S Plane Control based on Parameters Optimization with Simulated Annealing for UnderwaterVehicle", 《2011 INTERNATIONAL CONFERENCE ON ELECTRONIC & MECHANICAL ENGINEERING AND INFORMATION TECHNOLOGY》 * |
徐健,等: "UUV 环境自适应坐底策略与控制方法研究", 《仪器仪表学报》 * |
王建国,等: "水下航行体的改进S面运动控制器", 《中国舰船研究》 * |
郭冰洁: ""微小型水下机器人运动控制"", 《中国优秀博硕士学位论文全文数据库(硕士) 信息科技辑》 * |
Also Published As
Publication number | Publication date |
---|---|
CN110045751B (en) | 2022-10-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108803632A (en) | Unmanned surface vehicle total state constrained trajectory tracking and controlling method based on saturation compensation technology | |
CN105807789B (en) | UUV control methods based on the compensation of T-S Fuzzy Observers | |
CN109634307A (en) | A kind of compound Track In Track control method of UAV navigation | |
CN105573327B (en) | The drive lacking UUV vertical plane control methods of Time-Delay model are obscured based on T-S | |
CN108663938A (en) | A kind of UUV cluster-coordinator control methods considering communication topological transformation | |
CN111857165B (en) | Trajectory tracking control method of underwater vehicle | |
CN108089589A (en) | A kind of underwater robot attitude control method | |
CN110618606A (en) | Under-actuated AUV (autonomous Underwater vehicle) backstepping self-adaptive fuzzy sliding mode control method under combined interference | |
Zhu et al. | A hybrid control strategy of 7000 m-human occupied vehicle tracking control | |
CN107656530A (en) | Variable-parameter open-frame type ocean underwater robot trajectory tracking control method, device and system | |
CN113238567A (en) | Benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on extended state observer | |
Zhu et al. | A MIMO nonlinear robust controller for work-class ROVs positioning and trajectory tracking control | |
Guo et al. | Spatial path-following control of underactuated auv with multiple uncertainties and input saturation | |
Dai et al. | Dual closed loop AUV trajectory tracking control based on finite time and state observer | |
CN117250971B (en) | Control method of microminiature AUV | |
CN110007604A (en) | There is the accuracy of cable underwater robot seabed to be saturated control method based on sliding mode technology | |
Wei et al. | Back-stepping control of underactuated AUV's depth based on nonlinear disturbance observer | |
CN114839883B (en) | Depth-fixed anti-interference robust L of nonlinear under-actuated underwater vehicle 1 Control method | |
CN110045751A (en) | There is cable underwater robot seabed accuracy motion control method based on SI control | |
CN106094842A (en) | A kind of UUV diving plane H based on T S model and PDC∞control method | |
CN115599108A (en) | Bionic underwater robot control method based on carangidae model | |
Guo et al. | Study on autonomous hovering of the spherical underwater robot based on fuzzy pd controller | |
Li et al. | Underactuated Autonomous Underwater Vehicle Trajectory Tracking Control in Three Dimensions Based on Fractional Order Sliding Mode | |
Chen et al. | LTVMPC for Dynamic Positioning of An Autonomous Underwater Vehicle | |
Liu et al. | Operated ROV thrust distribution control system based on adaptive back-stepping controller |
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 |