CN112286056B - Consistency control method for multi-neutral buoyancy robot - Google Patents

Consistency control method for multi-neutral buoyancy robot Download PDF

Info

Publication number
CN112286056B
CN112286056B CN202011204444.9A CN202011204444A CN112286056B CN 112286056 B CN112286056 B CN 112286056B CN 202011204444 A CN202011204444 A CN 202011204444A CN 112286056 B CN112286056 B CN 112286056B
Authority
CN
China
Prior art keywords
neutral buoyancy
robot
matrix
buoyancy robot
disturbance observer
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202011204444.9A
Other languages
Chinese (zh)
Other versions
CN112286056A (en
Inventor
袁源
王英杰
朱战霞
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Northwestern Polytechnical University
Shenzhen Institute of Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
Shenzhen Institute of Northwestern Polytechnical University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Northwestern Polytechnical University, Shenzhen Institute of Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN202011204444.9A priority Critical patent/CN112286056B/en
Publication of CN112286056A publication Critical patent/CN112286056A/en
Application granted granted Critical
Publication of CN112286056B publication Critical patent/CN112286056B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive 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/042Adaptive 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)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses a consistency control method for a multi-neutral buoyancy robot, provides a parameter adjusting method according to a linear matrix inequality, and belongs to the field of robot control; firstly, establishing a neutral buoyancy robot system model under an inertial coordinate system, and establishing an input item and an output item of the system; then establishing a multi-neutral buoyancy robot information interaction model into a directed topology model, and giving important assumptions of the interaction model; on the basis of the two, a distributed reduced order disturbance observer is designed to estimate a consistency error state and unknown disturbance in real time, and a parameter adjusting method of the disturbance observer is provided; finally, a feedback controller is designed according to the distributed reduced-order forced disturbance observer, and consistency and strong robustness of the multi-neutral buoyancy robot system are guaranteed. The invention combines the characteristics of the neutral buoyancy robot model, and the designed control strategy has good control performance and is suitable for engineering application.

Description

Consistency control method for multi-neutral buoyancy robot
Technical Field
The invention belongs to the field of robot control, and particularly relates to a consistency control method for a multi-neutral buoyancy robot.
Background
Due to deepening of space research and improvement of space application capability, research on microgravity environment simulation experiments for ground verification is receiving more and more extensive attention at home and abroad. In the research of microgravity environment simulation experiments, the application of a neutral buoyancy system to the simulation experiments in the microgravity environment is one of the important methods. In addition, as space operation tasks are complex and changeable, a single large-scale spacecraft cannot well complete the tasks, and therefore the problem that multiple neutral buoyancy robots simulate multiple spacecrafts to complete the operation tasks is urgently needed to be solved. The neutral buoyancy robot is a typical Lagrangian system, the coupling exists in the internal state, and the viscous resistance in water is large, so when a plurality of neutral buoyancy robots are designed to work cooperatively, the influence on the system caused by external disturbance and internal uncertainty must be considered. Meanwhile, the conditions of sudden failure of the sensor and the like can cause the wild value of the sensor, further cause system oscillation and even cause system instability, so that the designed distributed attitude control algorithm still can well realize the consistency control of the multi-neutral buoyancy robot under the condition that various uncertainties exist.
The robustness performance of the consistency control strategy for the multi-neutral buoyancy robot is poor at present, but the control accuracy has very important significance for improving the robustness performance of the system for the neutral buoyancy robot with strong coupling, strong nonlinearity and space external disturbance; meanwhile, the influence of the sensor outlier on the system is well considered by aiming at the consistency control strategy of the multi-neutral buoyancy robot at present, and in order to process the sensor outlier problem and improve the robustness of the system, a control method based on a distributed reduced-order forced disturbance observer is adopted.
For a traditional disturbance observer, the disturbance observer is usually designed for a single system, and in addition, the influence of a sensor field value on a multi-robot system is rarely considered, so that the disturbance observer has a limitation in engineering application.
Disclosure of Invention
The invention aims to provide a consistency control method for a multi-neutral buoyancy robot, which aims to solve the problems.
In order to achieve the purpose, the invention adopts the following technical scheme:
a consistency control method for a multi-neutral buoyancy robot comprises the following steps:
step 1, establishing a neutral buoyancy robot attitude kinematics and dynamics model under an inertial coordinate system;
step 2, establishing a multi-neutral buoyancy robot information interaction model;
step 3, constructing a distributed reduced order forced disturbance observer, providing a distributed reduced order forced disturbance observer and a saturation upper bound function parameter adjusting method, and adjusting parameters of the disturbance observer by solving a linear matrix inequality;
step 4, designing a distributed controller based on the reduced-order forced disturbance observer, providing a parameter adjustment method of the distributed controller, and adjusting the parameters of the controller by solving a linear matrix inequality;
and 5, finishing a control strategy of consistency of the multi-neutral buoyancy robot.
Further, step 1 specifically includes:
the underwater six-degree-of-freedom robot dynamics and kinematics model comprises the following steps:
Figure BDA0002756580280000021
Figure BDA0002756580280000022
wherein M is RB Representing the body inertia matrix, C RB Representing the Kerio force matrix of the body, M AM Representing the water flow medium inertia matrix, C, associated with the body AM Representing the body-related Corio force matrix of the aqueous flow medium, D r (v r (t)) v (t) is the viscous drag and g (η (t)) is the negative buoyancy; tau. c (t) represents a control torque; j (η (t)) represents a Jacobian matrix; eta (t), v (t) and v r (t)=v(t)-v c (t) respectively representing the position and velocity of the body in a body coordinate system and the generalized velocity of the fluid in the body coordinate system, v c (t) is the speed of the water flow in the body coordinate system;
suppose that:
1. water velocity v in body coordinate system c Being slowly time-varying, i.e. v c (t)≈0;
2.v c The velocity v of the underwater robot is small, and is approximately C (v (t)) v (t) ≈ C (v (t) r (t))v r (t);
Equation (1) is simplified to the form:
Figure BDA0002756580280000023
Figure BDA00027565802800000311
wherein M = M RB +M AM ,C=C RB +C AM
Finally, the equation of motion under the inertial system is obtained:
Figure BDA0002756580280000031
in the formula (I), the compound is shown in the specification,
M * =J -T (η(t))MJ -1 (η(t))
Figure BDA0002756580280000032
D * (v(t),η(t))=J -T (η(t))D(v(t))J -1 (η(t))
g * (η(t))=J -T (η(t))g(η(t))
wherein D * (v(t),η(t))v(t),g * And (η (t)) is an unknown term.
Further, step 2 specifically includes:
consider first that there are N +1 neutrally buoyant robots, consider i =0 as the leader robot, consider i =1, 2.. The.n as the follower robot; wherein leader system state η is assumed 0 ,
Figure BDA0002756580280000033
Is bounded; neutral buoyancy robot information interaction model established as directed topology
Figure BDA0002756580280000034
Wherein
Figure BDA0002756580280000035
Representing a set of respective neutral buoyancy robots;
Figure BDA0002756580280000036
represents the set of all transmissions; the adjacency matrix of the follower is defined as
Figure BDA0002756580280000037
Wherein, when the l posture information of the follower neutral buoyancy robot is directly transmitted to the neutral buoyancy robot i, a il > 0, otherwise, a il =0, and is adjacent to the matrix diagonal element a ii =0;N i Representing the set of all the received neighbor neutral buoyancy robots of the neutral buoyancy robot i; defining the Laplace matrix as L = [ ] il ]∈R N×N Wherein, when i = l,
Figure BDA00027565802800000312
when i ≠ L, L il =-a il (ii) a When the neutral buoyancy robot i can directly receive the posture information of the leader, b i > 0, otherwise, b i =0; definition matrix
Figure BDA0002756580280000038
It is assumed that each follower neutrally buoyant robot can receive information directly or indirectly from the leader neutrally buoyant robot.
Further, step 3 specifically includes:
firstly, defining the consistency error of the local neighbor of the ith follower neutral buoyancy robot as
Figure BDA0002756580280000039
Wherein, the first and the second end of the pipe are connected with each other,
Figure BDA00027565802800000310
is leader following consistency error;
considering the neutral buoyancy robot attitude kinematics and a second-order equation of a kinetic equation, constructing a reduced-order forced disturbance observer for estimating the system uncertainty and the environment external disturbance:
Figure BDA0002756580280000041
Figure BDA0002756580280000042
wherein beta is i2i3 For observer gain, ρ is a positive constant, z i2 And z i3 Is a reduced order observer state estimation, γ i =diag{σ i1 ,…,σ i6 },
Figure BDA0002756580280000043
σ ij Is the dynamic upper bound of the saturation function, obtained by the differential equation
Figure BDA0002756580280000044
Wherein the content of the first and second substances,
Figure BDA0002756580280000045
and j =1,2,3,4,5,6;
the parameters of the disturbance observer are adjusted by solving the following linear matrix inequality, so that the disturbance observer achieves a good estimation effect;
Figure BDA0002756580280000046
Figure BDA0002756580280000047
in the formula (I), the compound is shown in the specification,
Figure BDA0002756580280000048
denotes the kronecker product, I N Is an N-dimensional identity matrix, P i =S i -1 ,R i Is a positive definite symmetric matrix, J is a diagonal matrix and satisfies J = T -1 LT, wherein T -1 Is a non-singular matrix, m i Is that the positive definite constant satisfies M i -1 <m i I 6 ,c i Positive definite constant satisfies
Figure BDA0002756580280000049
Figure BDA00027565802800000410
C=[I 6 0],b i =diag{β i2i3 },
Figure BDA00027565802800000411
Further, step 4 specifically includes:
the following states are defined first:
Figure BDA0002756580280000051
according to the transformed system state, the following distributed controllers are designed:
Figure BDA0002756580280000052
in the formula, k i1 ,k i2 Is the gain of the controller and is,
Figure BDA0002756580280000053
it is unknown disturbance information observed by the disturbance observer that is used to compensate the uncertainty inside the system and the varying external disturbance in real time,
the distributed controller parameter adjusting method is given below, and the controller parameters are adjusted by solving the following linear matrix inequality, so that the multi-neutral buoyancy robot system obtains a good control effect;
Figure BDA0002756580280000054
wherein the content of the first and second substances,
Figure BDA0002756580280000055
is a positive definite symmetric matrix, B i And D i Is defined asLower part
B i =[0,I 6 ] T ,
Figure BDA0002756580280000056
Wherein λ is i Is the ith eigenvalue of matrix J.
Further, step 5 specifically includes:
finally obtaining the control torque tau i And (t) carrying out control in a neutral buoyancy robot system model (4) under an inertial coordinate system, respectively designing a distributed reduced order forced disturbance observer and a controller for the neutral buoyancy robot according to a control strategy, and controlling the neutral buoyancy robot so as to enable the multiple neutral buoyancy robots to achieve consistency.
Compared with the prior art, the invention has the following technical effects:
the invention provides a consistency control method of a multi-neutral buoyancy robot based on a distributed reduced-order forced disturbance observer, which comprises the steps of designing the distributed reduced-order forced disturbance observer aiming at a neutral buoyancy robot by establishing a neutral buoyancy robot system model under an inertial coordinate system, and providing parameters of the disturbance observer by solving a linear matrix inequality; the distributed controller is designed to control the neutral buoyancy robot, real-time compensation is carried out on uncertainty of the system, robustness of a control algorithm is strong, higher control accuracy and higher response speed can be obtained, and engineering implementation is facilitated.
The invention provides a distributed reduced order forced disturbance observer, obtains parameters of the distributed reduced order forced observer by solving a linear matrix inequality, simultaneously considers the condition that a sensor has a wild value, improves the robustness of a system and is convenient for engineering realization;
on the basis of a distributed reduced-order forced disturbance observer, a multi-robot consistency controller is designed, and when a consistency result is obtained, real-time compensation is performed on internal uncertainty and external disturbance of a system, so that more excellent control performance is obtained;
based on a distributed control strategy, the information interaction of the multi-neutral-buoyancy robot under the directed topology is realized, the information transmission is reduced, and the application scene of the multi-neutral-buoyancy robot is greatly expanded.
Drawings
FIG. 1 is a flow chart of the present invention.
Detailed Description
The invention is further described below with reference to the accompanying drawings:
referring to fig. 1, a consistency control method for a multi-neutral-buoyancy robot includes:
the first step is as follows: establishing neutral buoyancy robot attitude kinematics and dynamics model under inertial coordinate system
Consider the underwater six-degree-of-freedom robot dynamics and kinematics models of equations (1) - (2).
Figure BDA0002756580280000061
Figure BDA0002756580280000062
Wherein M is RB Representing the body inertia matrix, C RB Representing the Kerio force matrix of the body, M AM Representing the inertia matrix of the water flow medium, C, associated with the body AM Representing the body-related Corio force matrix of the aqueous flow medium, D r (v r (t)) v (t) is the viscous drag and g (η (t)) is the negative buoyancy; tau is c (t) represents a control torque; j (η (t)) represents a Jacobian matrix; eta (t), v (t) and v r (t)=v(t)-v c (t) respectively representing the position and velocity of the body in a body coordinate system and the generalized velocity of the fluid in the body coordinate system, v c And (t) is the speed of the water flow under the body coordinate system.
For ease of design, the following assumptions are generally made:
1. water velocity v in body coordinate system c Being slowly time-varying, i.e. v c (t)≈0;
2.v c The velocity v relative to the underwater robot is small, and is approximately C (v (t)) v (t) ≈ C (v (t) r (t))v r (t)。
Equation (1) is simplified to the form:
Figure BDA0002756580280000063
Figure BDA0002756580280000071
wherein M = M RB +M AM ,C(v(t))=C RB +C AM
Finally, the motion equation under the inertial system is obtained:
Figure BDA0002756580280000072
in the formula (I), the compound is shown in the specification,
M * =J -T (η(t))MJ -1 (η(t))
Figure BDA0002756580280000073
D * (v(t),η(t))=J -T (η(t))D(v(t))J -1 (η(t))
g * (η(t))=J -T (η(t))g(η(t))
wherein D * (v(t),η(t))v(t),g * And (η (t)) is an unknown term.
The relevant parameters are defined as follows:
r B =[x B ,y B ,z B ] T =[0,0,0] T ,r G =[x G ,y G ,z G ] T =[0,0,0.05] T ,m=125,
Figure BDA0002756580280000074
Figure BDA0002756580280000075
Figure BDA0002756580280000076
Figure BDA0002756580280000077
C=C AM +C RB
Figure BDA0002756580280000081
wherein x is B ,y B And z B Is the floating center coordinate, x G ,y G And z G Representing coordinates of the centroid, m representing mass, I 0 Is a matrix of moments of inertia, v 1 =[μ υ ω] T And v 2 =[p q r] T Is the translational and angular velocity components of the velocity v (t), C AM And C RB Respectively, the coriolis matrix and the coriolis matrix that the motion of the fluid being discharged has.
The second step is that: establishing multi-neutral buoyancy robot information interaction model
First we consider N +1 neutrally buoyant robots, we consider i =0 as the leader robot and i =1,2. Wherein, for design convenience, we assume leader System State η 0 ,
Figure BDA0002756580280000082
Is bounded. The information interaction model of the neutral buoyancy robot can be established into a directed topology
Figure BDA0002756580280000083
Wherein
Figure BDA0002756580280000084
Representing a collection of respective neutral buoyancy robots.
Figure BDA0002756580280000085
Representing the set of all transmissions. The neighbor matrix of the follower is defined as
Figure BDA0002756580280000086
Wherein, when the posture information of the follower neutral buoyancy robot is directly transmitted to the neutral buoyancy robot i, a il > 0, otherwise, a il =0, and is adjacent to the matrix diagonal element a ii =0。N i Represents the set of all the received neighbor neutral buoyancy robots of the neutral buoyancy robot i. We define the Laplace matrix as L = [ ] il ]∈R N×N Wherein, when i = l,
Figure BDA0002756580280000087
when i ≠ L, L il =-a il . When the neutral buoyancy robot i can directly receive the posture information of the leader, b i > 0, otherwise, b i =0. We define a matrix
Figure BDA0002756580280000088
Here, we assume that each follower neutrally buoyant robot can receive information of the leader neutrally buoyant robot, either directly or indirectly.
In this example, consider 4 neutrally buoyant robots, one of which is the leader neutrally buoyant robot, and the remaining 3 which are the follower neutrally buoyant robots. The relevant topological parameters are given below
Figure BDA0002756580280000089
The third step: construction of distributed reduced-order forced disturbance observer
Firstly, defining the consistency error of the local neighbor of the ith follower neutral buoyancy robot as
Figure BDA0002756580280000091
Wherein, the first and the second end of the pipe are connected with each other,
Figure BDA0002756580280000092
is the leader following consistency error.
Considering the attitude kinematics and the second order equation of the dynamic equation of the neutral buoyancy robot, a reduced order forced disturbance observer is constructed for estimating the system uncertainty and the environmental external disturbance:
Figure BDA0002756580280000093
Figure BDA0002756580280000094
wherein, beta i2i3 For observer gain, ρ is a positive constant, z i2 And z i3 Is a reduced order observer state estimation, γ i =diag{σ i1 ,…,σ i6 },
Figure BDA0002756580280000095
σ ij Is the dynamic upper bound of the saturation function, obtained by the differential equation
Figure BDA0002756580280000096
Wherein the content of the first and second substances,
Figure BDA0002756580280000097
and j =1,2,3,4,5,6.
The parameters of the disturbance observer can be adjusted by solving the following linear matrix inequality, so that the disturbance observer achieves a good estimation effect.
Figure BDA0002756580280000098
Figure BDA0002756580280000099
In the formula (I), the compound is shown in the specification,
Figure BDA00027565802800000910
denotes the kronecker product, I N Is an N-dimensional identity matrix, P i =S i -1 ,R i Is a positive definite symmetric matrix, J is a diagonal matrix and satisfies J = T -1 LT, wherein T -1 Is a non-singular matrix, m i Is that the positive definite constant satisfies M i -1 <m i I 6 ,c i Positive definite constant satisfies
Figure BDA00027565802800000911
Figure BDA00027565802800000912
C=[I 6 0],b i =diag{β i2i3 },
Figure BDA00027565802800000913
In this example, ρ =1.5,m i =187.5,c i =125,β i2i3 The values of (A) are as follows:
β i2 =diag{500 500 1500 500 1500 1500},
β i3 =diag{100 100 200 100 200 200},
the fourth step: design distributed controller based on reduced order compulsory observer
Based on a reduced order observer, we design the following distributed controller.
The following states are defined first:
Figure BDA0002756580280000101
according to the transformed system state, the following distributed controllers are designed:
Figure BDA0002756580280000102
in the formula, k i1 ,k i2 Is the gain of the controller and is,
Figure BDA0002756580280000103
it is unknown disturbance information observed by the disturbance observer that is used to compensate for uncertainty and varying external disturbance inside the system in real time,
the distributed controller parameter adjusting method is given below, and the controller parameters can be adjusted by solving the following linear matrix inequality, so that the multi-neutral-buoyancy-force robot system can obtain a good control effect.
Figure BDA0002756580280000104
Wherein, the first and the second end of the pipe are connected with each other,
Figure BDA0002756580280000105
is a positive definite symmetric matrix, B i And D i Is defined as follows
B i =[0,I 6 ] T ,
Figure BDA0002756580280000106
Wherein λ is i Is the ith eigenvalue of the matrix J.
In this example, the values of the adjustable parameters are:
k i1 =15,k i2 =15,λ i =1。
the fifth step: control strategy for achieving consistency of multi-neutral buoyancy robot
Finally obtaining the control torque tau i (t) bringing into an inertial coordinate systemAnd controlling the neutral buoyancy robot system model (4), respectively designing a distributed reduced-order forced disturbance observer and a controller for the neutral buoyancy robot according to a control strategy, and controlling the neutral buoyancy robot to ensure that the multiple neutral buoyancy robots reach consistency.
This invention is not described in detail and is within the ordinary knowledge of a person skilled in the art.

Claims (2)

1. A consistency control method for a multi-neutral buoyancy robot is characterized by comprising the following steps:
step 1, establishing a neutral buoyancy robot attitude kinematics and dynamics model under an inertial coordinate system;
step 2, establishing a multi-neutral buoyancy robot information interaction model;
step 3, constructing a distributed reduced order forced disturbance observer, providing a distributed reduced order forced disturbance observer and a saturation upper bound function parameter adjusting method, and adjusting parameters of the disturbance observer by solving a linear matrix inequality;
step 4, designing a distributed controller based on the reduced order forced disturbance observer, providing a parameter adjustment method of the distributed controller, and adjusting the parameters of the controller by solving a linear matrix inequality;
step 5, completing a control strategy of consistency of the multi-neutral buoyancy robot;
the step 1 specifically comprises:
the underwater six-degree-of-freedom robot dynamics and kinematics model comprises the following steps:
Figure FDA0003867550940000011
Figure FDA0003867550940000012
wherein, M RB Representing the body inertia matrix, C RB Representing the Kerio force matrix of the body, M AM Display and machineBody-related water flow medium inertia matrix, C AM Representing the body-related Corio force matrix of the aqueous flow medium, D r (v r (t))v r (t) is viscous drag, g (η (t)) is negative buoyancy; tau. c (t) represents a control torque; j (η (t)) represents a Jacobian matrix; eta (t), v (t) and v r (t)=v(t)-v c (t) respectively representing the position and velocity of the body in a body coordinate system and the generalized velocity of the fluid in the body coordinate system, v c (t) is the speed of the water flow under the body coordinate system;
suppose that:
1. water velocity v in body coordinate system c Being slowly time-varying, i.e. v c (t)≈0;
2.v c The velocity v relative to the underwater robot is small, and is approximately C (v (t)) v (t) ≈ C (v (t) r (t)) v r (t);
Equation (1) is simplified to the form:
Figure FDA0003867550940000013
wherein M = M RB +M AM ,C=C RB +C AM
Finally, the motion equation under the inertial system is obtained:
Figure FDA0003867550940000014
in the formula (I), the compound is shown in the specification,
M * =J -T (η(t))MJ -1 (η(t))
Figure FDA0003867550940000021
D * (v(t),η(t))=J -T (η(t))D(v(t))J -1 (η(t))
g * (η(t))=J -T (η(t))g(η(t))
wherein D * (v(t),η(t))v(t),g * (η (t)) is unknown;
the step 2 specifically comprises the following steps:
first consider that there are N +1 neutral buoyancy robots, consider i =0 as the leader robot, and i =1, 2. Wherein leader system state η is assumed 0
Figure FDA0003867550940000022
Is bounded; neutral buoyancy robot information interaction model established as directed topology
Figure FDA0003867550940000023
Wherein
Figure FDA0003867550940000024
Representing a set of respective neutral buoyancy robots;
Figure FDA0003867550940000025
represents the set of all transmissions; the neighbor matrix of the follower is defined as
Figure FDA0003867550940000026
Wherein, when the l posture information of the follower neutral buoyancy robot is directly transmitted to the neutral buoyancy robot i, a il > 0, otherwise, a il =0, and is adjoined by the matrix diagonal element a ii =0;N i Representing the set of all the received neighbor neutral buoyancy robots of the neutral buoyancy robot i; defining the Laplace matrix as L = [ L ] il ]∈R N×N Wherein, when i = l,
Figure FDA0003867550940000027
when i ≠ L, L il =-a il (ii) a When the neutral buoyancy robot i can directly receive the posture information of the leader, b i > 0, otherwise, b i =0; definition matrix
Figure FDA0003867550940000028
Assuming that each follower neutral buoyancy robot can directly or indirectly receive the information of the leader neutral buoyancy robot;
the step 3 specifically comprises the following steps:
firstly, defining the consistency error of the local neighbor of the ith follower neutral buoyancy robot as
Figure FDA0003867550940000029
Wherein the content of the first and second substances,
Figure FDA00038675509400000210
is leader following consistency error;
considering the attitude kinematics and the second order equation of the dynamic equation of the neutral buoyancy robot, a reduced order forced disturbance observer is constructed for estimating the system uncertainty and the environmental external disturbance:
Figure FDA00038675509400000211
Figure FDA0003867550940000031
wherein, beta i,2 ,β i,3 For observer gain, ρ is a positive constant, z i,2 And z i,3 Is the ith reduced order observer state estimate, γ i =diag{σ i1 ,…,σ i6 },
Figure FDA0003867550940000032
σ ij J =1,2,3,4,5,6 is the dynamic upper bound of the saturation function;
σ ij obtained by the following differential equation
Figure FDA0003867550940000033
Wherein the content of the first and second substances,
Figure FDA0003867550940000034
and j =1,2,3,4,5,6;
the parameters of the disturbance observer are adjusted by solving the following linear matrix inequality, so that the disturbance observer achieves a good estimation effect;
Figure FDA0003867550940000035
Figure FDA0003867550940000036
in the formula (I), the compound is shown in the specification,
Figure FDA0003867550940000037
denotes the kronecker product, I N Is an N-dimensional identity matrix, P i =S i -1 ,R i Is a positive definite symmetric matrix, J is a diagonal matrix and satisfies J = T -1 LT, wherein T -1 Is a non-singular matrix, m i Is that the positive definite constant satisfies M i -1 <m i I 6 ,c i Positive definite constant satisfies
Figure FDA0003867550940000038
Figure FDA0003867550940000039
b i =diag{β i,2 ,β i,3 },
Figure FDA00038675509400000310
The step 4 specifically comprises the following steps:
the following states are defined first:
Figure FDA00038675509400000311
according to the transformed system state, the following distributed controllers are designed:
Figure FDA00038675509400000312
in the formula, k i1 ,k i2 Is the gain of the controller(s),
Figure FDA00038675509400000313
it is unknown disturbance information observed by the disturbance observer that is used to compensate the uncertainty inside the system and the varying external disturbance in real time,
the distributed controller parameter adjusting method is given below, and the controller parameters are adjusted by solving the following linear matrix inequality, so that the multi-neutral buoyancy robot system obtains a good control effect;
Figure FDA0003867550940000041
wherein the content of the first and second substances,
Figure FDA0003867550940000042
is a positive definite symmetric matrix, B i And D i Is defined as follows
B i =[0,I 6 ] T
Figure FDA0003867550940000043
Wherein λ is i Is the ith eigenvalue of the matrix J.
2. The consistency control method of the multi-neutral-buoyancy robot according to claim 1, wherein the step 5 specifically comprises:
finally obtaining the control moment tau i (t) model of the neutrally buoyant robot system brought into the inertial coordinate system ( 4 ) The method comprises the steps of controlling, respectively designing a distributed reduced-order forced disturbance observer and a controller for the neutral buoyancy robot according to a control strategy, and controlling the neutral buoyancy robot, so that the multiple neutral buoyancy robots achieve consistency.
CN202011204444.9A 2020-11-02 2020-11-02 Consistency control method for multi-neutral buoyancy robot Active CN112286056B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011204444.9A CN112286056B (en) 2020-11-02 2020-11-02 Consistency control method for multi-neutral buoyancy robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011204444.9A CN112286056B (en) 2020-11-02 2020-11-02 Consistency control method for multi-neutral buoyancy robot

Publications (2)

Publication Number Publication Date
CN112286056A CN112286056A (en) 2021-01-29
CN112286056B true CN112286056B (en) 2022-11-22

Family

ID=74353951

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011204444.9A Active CN112286056B (en) 2020-11-02 2020-11-02 Consistency control method for multi-neutral buoyancy robot

Country Status (1)

Country Link
CN (1) CN112286056B (en)

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107065564B (en) * 2017-05-18 2020-04-14 西北工业大学 Neutral buoyancy robot posture and track control method based on active disturbance rejection
CN108181914B (en) * 2017-12-11 2020-04-14 西北工业大学 Neutral buoyancy robot posture and track active disturbance rejection control method
CN108415422B (en) * 2018-01-30 2020-11-06 上海交通大学 Multi-unmanned vehicle formation driving control method based on disturbance observer
CN108829109B (en) * 2018-07-25 2021-06-08 西北工业大学 Neutral buoyancy robot posture and track control method based on distributed model predictive control
CN110609467B (en) * 2019-06-30 2022-06-21 南京理工大学 Time-lag multi-agent system consistency control method based on PID
CN110456807B (en) * 2019-07-02 2021-01-12 西北工业大学 Multi-spacecraft consistency dynamic gain control method

Also Published As

Publication number Publication date
CN112286056A (en) 2021-01-29

Similar Documents

Publication Publication Date Title
Li et al. Adaptive formation control of networked robotic systems with bearing-only measurements
He et al. Neural-learning-based control for a constrained robotic manipulator with flexible joints
CN104589349B (en) With the autonomous control method of assembly of simple joint mechanical arm under a kind of mix suspending microgravity environment
Yan et al. Consensus formation tracking for multiple AUV systems using distributed bioinspired sliding mode control
CN113433955B (en) Multi-AUV formation consistency control method under directed switching topology
CN109634307A (en) A kind of compound Track In Track control method of UAV navigation
CN109032137B (en) Distributed tracking control method for multi-Euler-Lagrange system
CN110376882A (en) Pre-determined characteristics control method based on finite time extended state observer
CN111650832B (en) Method for tracking and controlling mechanical foot posture of underwater multi-foot walking robot
CN110543184B (en) Fixed time neural network control method for rigid aircraft
CN108445768B (en) Augmented self-adaptive fuzzy control method for operation space trajectory tracking of space robot
Yang et al. Event-triggered finite-time formation control for multiple unmanned aerial vehicles with input saturation
CN111522341A (en) Multi-time-varying formation tracking control method and system for network heterogeneous robot system
CN108267952B (en) Self-adaptive finite time control method for underwater robot
CN110543183B (en) Rigid body aircraft fixed time attitude tracking control method considering actuator limitation problem
CN108663936B (en) Model does not know spacecraft without unwinding Attitude Tracking finite-time control method
CN114047773A (en) Underwater ore collection robot backstepping sliding mode self-adaptive attitude control method based on extended state observer
Stacey et al. A passivity-based approach to formation control using partial measurements of relative position
CN113268084A (en) Intelligent fault-tolerant control method for unmanned aerial vehicle formation
CN110488854B (en) Rigid aircraft fixed time attitude tracking control method based on neural network estimation
Wu et al. Distributed Formation Control for Manipulator End Effectors
CN116923730B (en) Spacecraft attitude active fault-tolerant control method with self-adjusting preset performance constraint
CN112327622B (en) Consistency fault-tolerant control method for neutral buoyancy robot
CN113485395A (en) Fixed time relative attitude and orbit tracking control method under error constraint
CN112286056B (en) Consistency control method for multi-neutral buoyancy robot

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