CN107463097B - Self-adaptive quantitative fault-tolerant control device and method for underwater robot - Google Patents
Self-adaptive quantitative fault-tolerant control device and method for underwater robot Download PDFInfo
- Publication number
- CN107463097B CN107463097B CN201710890830.XA CN201710890830A CN107463097B CN 107463097 B CN107463097 B CN 107463097B CN 201710890830 A CN201710890830 A CN 201710890830A CN 107463097 B CN107463097 B CN 107463097B
- Authority
- CN
- China
- Prior art keywords
- underwater robot
- fault
- actuator
- control
- adaptive
- 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 20
- 238000013139 quantization Methods 0.000 claims abstract description 25
- 230000007246 mechanism Effects 0.000 claims abstract description 20
- 239000011159 matrix material Substances 0.000 claims abstract description 16
- 230000003044 adaptive effect Effects 0.000 claims abstract description 8
- 230000006978 adaptation Effects 0.000 claims abstract description 5
- 239000013598 vector Substances 0.000 claims description 8
- 238000013461 design Methods 0.000 claims description 6
- 238000009795 derivation Methods 0.000 claims description 4
- 238000004458 analytical method Methods 0.000 claims description 3
- 230000000903 blocking effect Effects 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims description 2
- 238000011160 research Methods 0.000 description 3
- 238000003745 diagnosis Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 2
- 241000282414 Homo sapiens Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000011002 quantification Methods 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 self-adaptive quantization fault-tolerant control device and a method thereof for an underwater robot, wherein the device comprises an inner ring control module, wherein the inner ring control module controls a compensation and feedback module and generates a quantization control signal through a signal quantizer to control the underwater robot; the compensation and feedback module comprises an actuating mechanism fault self-adaptive compensation module, a nonlinear feedback module and an uncertainty self-adaptive compensation module; the inner ring control module generates a quantized control signal through a signal quantizer based on the underwater robot kinematic model, the underwater robot dynamic model and the expectation module. The adaptive fault compensator is designed, and can process the gain fault and perturbation fault of the actuating mechanism; by designing the inverse adaptation law, the control distribution matrix drift caused by control signal quantization is compensated.
Description
Technical Field
The invention belongs to the technical field of underwater robot control; relates to a self-adaptive quantitative fault-tolerant control device of an underwater robot; the method also relates to a self-adaptive quantitative fault-tolerant control method of the underwater robot.
Background
In engineering control systems, signal quantization is of great significance. Quantized control signals are common in digital circuitry, network control systems, and hybrid control systems. Quantization of the control input signal generally refers to the conversion of a continuous control signal into a series of discrete control variables, which introduces drift and the occurrence of additional uncertainty in the control distribution matrix in the control system. On the other hand, the underwater robot has important application value in many aspects such as ocean resource utilization, underwater engineering construction and the like, and is a powerful tool for researching and developing deep sea resources by human beings. In a digital control system of an underwater robot, quantization of control input is inevitable. Therefore, the research on the quantitative motion control method of the underwater robot has important theoretical and practical significance.
Due to the special complex underwater environment, the fault of the underwater robot executing mechanism is difficult to avoid, and the fault-tolerant control under the condition of researching the fault is also necessary. Many researchers have studied about the fault-tolerant control technology of underwater robots. Yang and the like research the fault-tolerant control technology of the steering oar joint control type underwater robot. Fang et al studied fault diagnosis techniques for underwater robots, including fault detection of sensors and fault identification of thrusters. Yang and the like research a fault diagnosis and fault-tolerant control method of the underwater robot based on a Gaussian particle filter. However, the above documents are all studied for continuous measurement signals and control signals, and not for discontinuous quantized fault-tolerant control systems. Based on the situation that input signal quantification and an actuating mechanism fault coexist, the uncertainty and the additional uncertainty of the control distribution matrix are compensated based on the self-adaptive thought, and the underwater robot can be guaranteed to track the expected signal by using the quantified signal under the fault situation.
Disclosure of Invention
The invention provides a self-adaptive quantitative fault-tolerant control device of an underwater robot, which is provided with a self-adaptive fault compensator and can process gain faults and perturbation faults of an execution mechanism.
The invention also provides a self-adaptive quantization fault-tolerant control method of the underwater robot, which compensates the control distribution matrix drift caused by control signal quantization by designing a reverse self-adaptive law.
The technical scheme of the invention is as follows: an adaptive quantization fault-tolerant control device of an underwater robot comprises an inner ring control module, wherein the inner ring control module controls a compensation and feedback module and generates a quantization control signal through a signal quantizer to control the underwater robot; the compensation and feedback module comprises an actuating mechanism fault self-adaptive compensation module, a nonlinear feedback module and an uncertainty self-adaptive compensation module; the inner ring control module generates a quantized control signal through a signal quantizer based on the underwater robot kinematic model, the underwater robot dynamic model and the expectation module.
The other technical scheme of the invention is as follows: an adaptive quantitative fault-tolerant control method for an underwater robot comprises the following steps:
step 1, constructing a kinematic dynamics model of an underwater robot;
and 4, establishing a self-adaptive quantitative control model of the underwater robot.
Furthermore, the invention is characterized in that:
wherein the quantization model in step 2 can be decomposed into a linear part and a non-linear unsealed part.
Wherein the failure of the actuator in step 3 comprises: the actuator outputs a measure of the fault, the offset fault of the actuator, and the gain fault of the actuator.
Wherein the types of the faults of the actuating mechanism in the step 3 comprise: no fault type, partial fault type, and full fault type.
And step 4, designing an inner ring virtual control law.
Wherein step 4 further comprises approximating the inner loop tracking error by fuzzy logic.
Compared with the prior art, the invention has the beneficial effects that: the method starts from the kinematic dynamics of the underwater robot, and can use a quantitative control signal to realize the motion control of the underwater robot under the condition that an executing mechanism has a fault; the invention can overcome the influence of time-varying external interference and has stronger robustness and self-adaptability. The control method provided by the invention can realize fault-tolerant control and has non-vulnerability; the control gain varies according to external interference and fault situation changes, and is non-conservative. In addition, the controller has simple structure, can reduce the operation load of the computer and has higher practical value.
Drawings
FIG. 1 is a schematic diagram of a control structure according to the present invention;
fig. 2 is a schematic diagram of efficiency loss and offset failure of the underwater robot actuator according to the present invention.
In the figure: 1 is a desired module; 2 is an inner ring control module; 3, an executing mechanism fault self-adaptive compensation module; 4 is a nonlinear feedback module; 5, an underwater robot kinematic model; 6, an underwater robot dynamic model; 7 is an uncertainty adaptive compensation module; 8 is the nonlinear model of the actuating mechanism; and 9 is a signal quantizer.
Detailed Description
The technical solution of the present invention is further explained with reference to the accompanying drawings and specific embodiments.
The invention provides a self-adaptive quantization fault-tolerant control device of an underwater robot, which comprises an inner ring control module 2, wherein the inner ring control module 2 is connected with a compensation and feedback module consisting of an execution mechanism fault self-adaptive compensation module 3, a nonlinear feedback module 4 and an uncertainty self-adaptive compensation module 7, and the inner ring control module 2 enables a signal quantizer 8 to generate a quantization control signal through fault information of the underwater robot provided by the compensation and feedback module; simultaneously, a nonlinear model 8 of the actuator is constructed, a dynamic model 6 of the underwater robot and a kinematic model 5 of the underwater robot are constructed on the basis again, and the inner-loop control module 2 is controlled jointly based on the dynamic model 6 of the underwater robot, the kinematic model 5 of the underwater robot and the expected signal generated by the expected module 1.
The invention also provides a self-adaptive quantitative fault-tolerant control method of the underwater robot, which comprises the following steps:
step 1, constructing a kinematic dynamics model of an underwater robot; the kinematics dynamics model of the underwater robot is as follows:
wherein M is an inertia matrix, C (v) is a Coriolis force and centripetal force matrix, D (v) is a hydrodynamic matrix, g (η) is a restoring force and moment vector, N is the number of actuating mechanisms, and taudJ (η) is a transformation matrix for external disturbance forces and moments, η represents position and attitude vectors of the underwater robot,representing the velocity vector of the underwater robot.Control output vector representing an actuator of the underwater robot, u ═ u1,u2,…,un]T,Q(u)=[Q1(u1),Q2(u2),…,Qn(un)]TWherein Q isi(ui) Is composed ofQuantitative value of (a), F [ Q (u)]Indicating a quantized signal in a fault situation.
whereinj=1,2,…,ui,min> 0 for q (u)i) The dead zone parameter 0 < rhoi<1,δi=(1-ρi)/(1+ρi) Constant ρiE (0,1) is a measure of the quantization density, that is, ρiThe smaller the quantizer, the coarser the quantizer. In general, Qi(ui) Is decomposed into a linear part and a non-linear part:
Qi(ui)=ui+Δi(3)
Fi[Qi(ui)]=hi(t)Qi(ui)+di,u(t)=hi(t)ui+hi(t)Δi+di,u(t) (4)
wherein Fi[Qi(ui)]In order to be the output of the actuator,representing an offset failure of the actuator, hi(t) represents a measure of actuator gain failure at [0, 1%]Taking values in between. Three types of faults may be represented by hi(t) is expressed as:
hi(t) ═ 1: the actuator works at full efficiency.
0<hi(t) < 1, the actuator partially loses its efficiency. E.g. hiA value of (t) 0.8 characterizes a 20% loss of efficiency of the actuator. h isiAnd (t) is 0, the actuating mechanism is in a blocking state, and the output of the actuating mechanism is not influenced by the input any more.
the outer ring virtual control law is designed as follows:
wherein k is1> 0 is a design parameter. Further, defining the inner loop tracking error as ev=v-vvirtualThen the dynamic equation for the inner loop tracking error can be expressed as:
since C (v), g (η) and the hydrodynamic matrix D (v) are also assumed to be unknown, the present invention introduces fuzzy logic to approximate them.
-C(v)v-D(v)v=θT(t)φ(v)+εφ(10)
Wherein,for a matrix of unknown parameters, NlIn order to number the fuzzy logic,a fuzzy approximation function, whose components can be expressed as:
wherein k is 0.2785, the ratio of k to k,in order to design the constants of the two-phase,further obtaining:
definition of d ═ supt≥0||ui,min+di,u(t)+τd,i(t) |, then
thus, it can be seen that:
the virtual control law is designed as follows:
in order to overcome the control efficiency drift caused by good signals, the following analysis is carried out:
definition Hi=1/inft≥0||hi||,As an estimate of the value of the error,the actual control law is designed as follows:
Claims (4)
1. An adaptive quantitative fault-tolerant control method for an underwater robot is characterized by comprising the following steps:
step 1, constructing a kinematic dynamics model of the underwater robot:
wherein M is an inertia matrix, C (v) is a Coriolis force and centripetal force matrix, D (v) is a hydrodynamic matrix, g (η) is a restoring force and moment vector, N is the number of actuating mechanisms, and taudFor external disturbance forces and moments, J (η) is a transformation matrix, η represents the position and attitude vectors of the underwater robot, v ∈ RnRepresenting a velocity vector of the underwater robot; u is an element of RnControl output vector representing an actuator of the underwater robot, u ═ u1,u2,…,un]T;
Q(u)=[Q1(u1),Q2(u2),…,Qn(un)]TWherein Q isi(ui) Is uiE is the quantized value of R; f [ Q (u)]A quantized signal representing a fault condition;
step 2, controlling and inputting the underwater robot, finishing signal quantization by adopting a signal quantizer (8), and establishing a quantization model of the signal quantization;
the quantization model in the step 2 is expressed as:
whereinui,min> 0 for q (u)i) The dead zone parameter 0 < rhoi<1,δi=(1-ρi)/(1+vi) (ii) a Constant rhoiE (0,1) is a measure of the quantization density, that is, ρiThe smaller, the coarser the quantizer; and Qi(ui) Can be decomposed into a linear part and a non-linear part which are not sealed;
step 3, establishing a fault model of an executing mechanism of the underwater robot;
the step 3, the failure of the actuator comprises: the scale of actuator output failure, actuator offset failure, and actuator gain failure;
the actuator failure model is as follows:
Fi[Qi(ui)]=hi(t)Qi(ui)+di,u(t)=hi(t)ui+hi(t)Δi+di,u(t) (4)
wherein Fi[Qi(ui)]As output of the actuator, di,u(t) E R represents the offset fault of the actuator, hi(t) represents a measure of actuator gain failure at [0, 1%]Taking values; three types of faults may be represented by hi(t) is expressed as:
hi(t) ═ 1: the actuator works at full efficiency;
0<hi(t) < 1, the actuator partially loses its efficiency; e.g. hi(t) 0.8 characterizes a 20% loss of efficiency of the actuator; h isi(t) is 0, the actuating mechanism is in a blocking state, and the output of the actuating mechanism is not influenced by the input any more;
step 4, establishing a self-adaptive quantitative control model of the underwater robot, and assuming that the expected signal is ηdDefining the tracking error as eη=η-ηdThe dynamic equation from which the tracking error is derived is:
the outer ring virtual control law is designed as follows:
wherein k is1More than 0 is a design parameter; further, defining the inner loop tracking error as ev=v-vvirtualThen the dynamic equation for the inner loop tracking error can be expressed as:
since C (v), g (η) and the hydrodynamic matrix D (v) are also assumed to be unknown, fuzzy logic is introduced to approximate them, ideally:
-C(v)v-D(v)v=θT(t)φ(v)+εφ(10)
wherein,for a matrix of unknown parameters, NlIn order to number the fuzzy logic,a fuzzy approximation function, whose components can be expressed as:
wherein k is 0.2785, the ratio of k to k,in order to design the constants of the two-phase,further obtaining:
Wherein tau isd,i(t) satisfies τd=[τd,1,τd,2,…,τd,n]T(ii) a Further derivation shows that:
definition of d ═ supt≥0||ui,min+di,u(t)+τd,i(t) |, then
thus, it can be seen that:
the virtual control law is designed as follows:
in order to overcome the control efficiency drift caused by good signals, the following analysis is carried out:
definition Hi=1/inft≥0||hi||,As an estimate of the value of the error,the actual control law is designed as follows:
2. The adaptive quantitative fault-tolerant control method of an underwater robot according to claim 1, wherein the types of the fault of the actuator in the step 3 include: no fault type, partial fault type, and full fault type.
3. The adaptive quantitative fault-tolerant control method of the underwater robot as claimed in claim 1, wherein the step 4 further comprises designing an inner-loop virtual control law.
4. The adaptive quantitative fault-tolerant control method of an underwater robot according to any one of claims 1 or 3, characterized in that the step 4 further comprises approximating the inner-loop tracking error by fuzzy logic.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710890830.XA CN107463097B (en) | 2017-09-27 | 2017-09-27 | Self-adaptive quantitative fault-tolerant control device and method for underwater robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710890830.XA CN107463097B (en) | 2017-09-27 | 2017-09-27 | Self-adaptive quantitative fault-tolerant control device and method for underwater robot |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107463097A CN107463097A (en) | 2017-12-12 |
CN107463097B true CN107463097B (en) | 2020-04-07 |
Family
ID=60553712
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710890830.XA Active CN107463097B (en) | 2017-09-27 | 2017-09-27 | Self-adaptive quantitative fault-tolerant control device and method for underwater robot |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107463097B (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110794811B (en) * | 2019-11-07 | 2021-02-26 | 浙江工业大学 | Safety control method of networked motion control system with quantification |
CN112327622B (en) * | 2020-11-02 | 2022-11-22 | 西北工业大学 | Consistency fault-tolerant control method for neutral buoyancy robot |
CN115357037B (en) * | 2022-09-14 | 2023-05-09 | 中国科学院声学研究所 | Adaptive quantitative control method and system for underwater vehicle |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201362352Y (en) * | 2008-05-22 | 2009-12-16 | 上海海事大学 | Fault-tolerant control device of unmanned underwater robot sensor |
CN102795323B (en) * | 2011-05-25 | 2015-03-11 | 中国科学院沈阳自动化研究所 | Unscented Kalman filter (UKF)-based underwater robot state and parameter joint estimation method |
KR20160126555A (en) * | 2015-04-24 | 2016-11-02 | 대양전기공업 주식회사 | Apparatus for diagnosing fault of underwater launcher and operating method thereof |
-
2017
- 2017-09-27 CN CN201710890830.XA patent/CN107463097B/en active Active
Non-Patent Citations (2)
Title |
---|
Adaptive Backstepping Stabilization of Nonlinear Uncertain Systems With Quantized Input Signal;Jing Zhou,;《IEEE TRANSACTIONS ON AUTOMATIC CONTROL》;20140228;第59卷(第2期);第460-464页 * |
Adaptive neural network-based backstepping fault tolerant control;YujiaWang,et al.;《Ocean Engineering》;20151022;第15-24页 * |
Also Published As
Publication number | Publication date |
---|---|
CN107463097A (en) | 2017-12-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Huang et al. | Adaptive prescribed performance tracking control for underactuated autonomous underwater vehicles with input quantization | |
Peng et al. | Adaptive dynamic surface control for formations of autonomous surface vehicles with uncertain dynamics | |
Zhu et al. | Global robust adaptive trajectory tracking control for surface ships under input saturation | |
Dai et al. | An EKF-based fast tube MPC scheme for moving target tracking of a redundant underwater vehicle-manipulator system | |
Chen et al. | Adaptive neural control of uncertain MIMO nonlinear systems with state and input constraints | |
Huang et al. | Robust practical fixed-time leader–follower formation control for underactuated autonomous surface vessels using event-triggered mechanism | |
Dai et al. | An adaptive EKF-FMPC for the trajectory tracking of UVMS | |
Xia et al. | Optimal robust trajectory tracking control of a X-rudder AUV with velocity sensor failures and uncertainties | |
CN111650832B (en) | Method for tracking and controlling mechanical foot posture of underwater multi-foot walking robot | |
CN108170151B (en) | Self-adaptive motion control device and method for underwater robot | |
CN107463097B (en) | Self-adaptive quantitative fault-tolerant control device and method for underwater robot | |
Tijjani et al. | Robust adaptive tracking control of underwater vehicles: Design, stability analysis, and experiments | |
Zhang et al. | A novel event-triggered robust neural formation control for USVs with the optimized leader–follower structure | |
Yang et al. | A recurrent neural network based fuzzy sliding mode control for 4-DOF ROV movements | |
Lv et al. | Event-triggered neural network control of autonomous surface vehicles over wireless network | |
Li et al. | Soft-switching proximate time optimal heading control for underactuated autonomous underwater vehicle | |
Fu et al. | Formation control for water-jet USV based on bio-inspired method | |
CN114296449B (en) | Water surface unmanned ship track rapid tracking control method based on fixed time H-infinity control | |
Wu et al. | Transient-reinforced tunnel coordinated control of underactuated marine surface vehicles with actuator faults | |
Fang et al. | Composite learning control of overactuated manned submersible vehicle with disturbance/uncertainty and measurement noise | |
Zhang et al. | Improved event-triggered robust adaptive control for marine vehicle with the fault compensating mechanism | |
Gong et al. | Three-dimensional optimal trajectory tracking control of underactuated AUVs with uncertain dynamics and input saturation | |
Ma et al. | Trajectory tracking control for autonomous underwater vehicle with disturbances and input saturation based on contraction theory | |
Xu et al. | Trajectory tracking control for differential-driven unmanned surface vessels considering propeller servo loop | |
Yang et al. | Concurrent learning-based adaptive control of underactuated robotic systems with guaranteed transient performance for both actuated and unactuated motions |
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 |