CN111625012A - Distributed cooperative operation method for multi-space robot - Google Patents

Distributed cooperative operation method for multi-space robot Download PDF

Info

Publication number
CN111625012A
CN111625012A CN202010515768.8A CN202010515768A CN111625012A CN 111625012 A CN111625012 A CN 111625012A CN 202010515768 A CN202010515768 A CN 202010515768A CN 111625012 A CN111625012 A CN 111625012A
Authority
CN
China
Prior art keywords
robot
robots
interface
detection information
control
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202010515768.8A
Other languages
Chinese (zh)
Other versions
CN111625012B (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
Original Assignee
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 filed Critical Northwestern Polytechnical University
Priority to CN202010515768.8A priority Critical patent/CN111625012B/en
Publication of CN111625012A publication Critical patent/CN111625012A/en
Application granted granted Critical
Publication of CN111625012B publication Critical patent/CN111625012B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G05D1/0833Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using limited authority control

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Security & Cryptography (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (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 relates to a distributed cooperative operation method for multiple space robots, which realizes stable control of a combined system by using information interaction among robots. The method is suitable for different network-like connection topologies among the robots, avoids the requirement of a central node, and can flexibly increase or reduce the number of the robots in the system and the connection configurations thereof. Compared with the conventional spacecraft control method, the method has the following advantages: 1) the method is a distributed algorithm, and the robot unit control moment calculation, control parameter coordination and updating do not need a central unit, so that the flexibility and robustness of the system are improved; 2) the method is suitable for various connection topologies such as a network topology structure, a bus topology and the like, and has wide practicability; 3) the method is suitable for distributed cooperative control among heterogeneous robots, and is suitable for thrustor robots and reaction flywheel robots.

Description

Distributed cooperative operation method for multi-space robot
Technical Field
The invention belongs to the field of spacecraft control, relates to a distributed cooperative operation method of a multi-space robot, and particularly relates to a stable control method for realizing a combination body by a plurality of space robots through distributed calculation.
Background
With the development of aerospace technology, the spacecraft plays more and more important roles in communication, navigation positioning, earth observation and the like. Direct and indirect losses caused by the on-orbit failure of the spacecraft are huge, and the development of an on-orbit service technology is the key development direction of each aerospace major country in the world. For this reason, various researchers have developed various types of space robots such as a space robot based on a space manipulator, a space tether robot based on a tether, a space cell robot based on a cellularization concept, and a space fly net robot based on a rope net. For a large-scale failure spacecraft, the quality of the large-scale failure spacecraft is up to several tons, after a plurality of small space robots are in butt joint with the failure spacecraft, information interaction and cooperation are needed, take-over control is carried out on the failure spacecraft, and stable control of the whole combined system is achieved. Unlike a single robot system, the structure of this system is distributed, and thus it is necessary to design a distributed cooperative control scheme suitable for the system structure thereof.
In order to solve the problem of cooperative control of a plurality of space robots on a combined system, the invention provides a distributed cooperative control method, which realizes stable control on the combined system by utilizing information interaction among the robots. The method is suitable for different network-like connection topologies among the robots, avoids the requirement of a central node, and can flexibly increase or reduce the number of the robots in the system and the connection configurations thereof.
Disclosure of Invention
Technical problem to be solved
In order to avoid the defects of the prior art, the invention provides a distributed cooperative operation method for multiple space robots, which realizes distributed cooperative control among multiple robots, namely realizes stable control on a combined system by utilizing multiple robots with control capability.
Technical scheme
A distributed cooperative operation method of a multi-space robot is characterized in that: the system comprises N robots, each robot has a unique identity ID, the set of the IDs of all the robots is X, and the defined ID is 0 and is an illegal identity; let the identity be IDiThe robot of (1) is a robot i; the robot i records the ID list of all the connected robots in the system and records the ID list as
Figure BDA0002530034610000021
Wherein each element represents an interface 1 to an interface n of the robot iiThe initial value of the ID value of the connected robot is 0; the operation steps are as follows:
step 1, connection topology detection and updating: each robot j belongs to X and performs connection topology detection and updating every T seconds, wherein T is more than or equal to D delta T, D is the diameter of an undirected graph of the multi-robot link topology and is determined by the robot network topology; delta t is the time interval of information interaction between the robots, and each robot actively sends connection detection information or replies the connection detection information of adjacent robots;
the process of the robot j actively sending the connection detection information:
the robot j adopts a network communication field identification method to send a connection request through all data interfaces of the robot, and the transmitted information comprises the identification ID of the robotj(ii) a If the interface p of the robot j is more than or equal to 1 and less than or equal to njReceiving the connection detection information replied by the adjacent robot, reading the ID of the robot connected with the interface p contained in the connection detection informationkThen let ljp=IDk(ii) a If the interface p does not receive the reply, it means that the interface p is not connected with the robot or the connected robot is invalid, and let ljp=0;
The process of replying the connection detection information of the adjacent robot comprises the following steps:
the interface r of the robot j receives the connection detection information of the adjacent robot, reads the ID of the robot connected with the interface r contained in the connection detection informationkLet Ljr=IDkAnd reply the connection detection information of oneself through the interface r; the interface r of the robot j receives the connection detection information of the adjacent robot, reads the ID of the robot connected with the interface r contained in the connection detection informationkLet Ljr=IDkAnd reply the connection detection information of oneself through the interface r;
the step is executed continuously in a timing cycle;
step 2, initializing control parameters:
the set of all robots for receiving ground remote control commands is CcomSet size Ncom1≤Ncom≤N;
All robot IDl∈CcomReceiving expected attitude sigma sent by ground measurement and control stationdRecording the reception time Tl
The robot l believes according to selfConnection list LlWill σdAnd TlIs sent to LlAll neighboring robots m in (1), robot m receives σdAnd TlThen, T is comparedlAnd Tm
If Tl>TmIf yes, then update the recorded sigmadLet Tm=TlAnd will bedAnd an update time TmFurther forwarding to all adjacent robots except the robot l; otherwise, ignoring;
and 3, calculating the control moments of all the robots:
robot IDξ∈ X use sensors to measure spacecraft attitude σ in terms of modified rodgers parametersξ∈R3Angular velocity omegaξ∈R3And angular acceleration
Figure BDA0002530034610000031
Each robot control parameter is three groups:
including parameters
Figure BDA0002530034610000032
Parameter Dξ=diag(ξ1,ξ2,ξ3)、Kξ=diag(κξ1ξ2ξ3) Wherein
Figure BDA0002530034610000033
ξ1,ξ2,ξ3≥0,κξ1ξ2ξ3If the initial values of the control parameters of all the robots are more than 0, the initial values of the control parameters of all the robots are set to be consistent, and the control parameters are updated in step 5; according to the control parameter Jξ、Dξ、KξAnd the desired attitude σdCalculating control moment τ of robot ξξThe calculation method is as follows:
Figure BDA0002530034610000034
wherein: sigmaeCorrecting attitude errors under the representation of the Rodris parameter;
step 4, calculating parameter scale factors:
each robot calculates its own parameter scale factor according to its own residual energy, for robot IDζ∈ X, parameter scale factor Wζ=[Wζ1Wζ2Wζ3]Wherein each element has a value range of [ 01 ]]The calculation method is as follows:
case 1: if the zeta executor of the robot is a thruster, the residual propellant is calculated as:
Figure BDA0002530034610000035
wherein: a is a constant and has a value range of 3-100; b is a constant, and the value range is 1-10; e.g. of the typeζFor the remaining propellant mass of the robot, efullThe total amount of the robot fuel storage tank;
case 2: if the zeta executor of the robot is three reaction flywheels which are installed in an orthogonal mode, the residual energy is calculated as follows:
Figure BDA0002530034610000041
wherein: r isζ1、rζ2、rζ3The rotating speeds of the three reaction flywheels of the robot are respectively zeta; r isfullIs the saturation speed of flywheel αζ1,αζ2,αζ3Calculated using the following formula, respectively:
Figure BDA0002530034610000042
wherein:
Figure BDA00025300346100000418
Tζconfiguring a matrix for a zeta flywheel of the robot, wherein the matrix represents a rotation matrix of a flywheel rotation axis coordinate system and an inertia coordinate system;
and 5, updating control parameters:
all robots regularly update control parameters and parameter scale factors with adjacent robots
Figure BDA0002530034610000043
Case 1: robot
Figure BDA0002530034610000044
The specific way of actively sending information is as follows:
robot
Figure BDA0002530034610000045
According to
Figure BDA0002530034610000046
And the recorded IDs of the adjacent robots sequentially exchange data with the robots connected with the adjacent robots:
step (1): q is 1;
step (2): judgment of
Figure BDA0002530034610000047
A value of, if
Figure BDA0002530034610000048
Jumping to the step (3); if it is
Figure BDA0002530034610000049
Suppose that
Figure BDA00025300346100000410
Presentation robot
Figure BDA00025300346100000411
The interface q is connected with the robot pi, and the robot
Figure BDA00025300346100000412
Will be provided with
Figure BDA00025300346100000413
Figure BDA00025300346100000414
Figure BDA00025300346100000415
Sending the data to the robot pi, and the robot pi replies the W of the robot piπ
Figure BDA00025300346100000416
π1,π2,π3,κπ1π2π3Data; robot after finishing information interaction
Figure BDA00025300346100000417
And the robot pi updates the parameter scale factor and the control parameter thereof according to the following formulas
Figure BDA0002530034610000051
Figure BDA0002530034610000052
Figure BDA0002530034610000053
And (3): q is q +1, if
Figure BDA0002530034610000057
Returning to the step 3, otherwise, performing the step (2);
case 2: robot
Figure BDA0002530034610000054
Receiving information of adjacent robots, wherein the processing mode is consistent with the processing step of the robot pi in the step (2);
and returning to the step 3 after the step is executed.
Case 1 in step 4: if the zeta executor of the robot is a thruster, the residual propellant is calculated as:
Figure BDA0002530034610000055
wherein: b is a constant, and the value range is 1-10; e.g. of the typeζFor the remaining propellant mass of the robot, efullThe total amount of the robot fuel storage tank.
Case 2 in step 4: if the zeta executor of the robot is three reaction flywheels which are installed in an orthogonal mode, the residual energy is calculated as follows:
Figure BDA0002530034610000056
wherein: r isζ1、rζ2、rζ3The rotating speeds of the three reaction flywheels of the robot are respectively zeta; r isfullIs the saturation speed of flywheel αζ1,αζ2,αζ3Calculated using the following formula, respectively:
Figure BDA0002530034610000061
wherein:
Figure BDA0002530034610000062
Tζa matrix is configured for the zeta flywheel of the robot, and the matrix represents a rotation matrix of a flywheel rotation axis coordinate system and an inertia coordinate system.
Advantageous effects
The distributed cooperative operation method for the multi-space robots provided by the invention realizes stable control of a combined system by utilizing information interaction among the robots. The method is suitable for different network-like connection topologies among the robots, avoids the requirement of a central node, and can flexibly increase or reduce the number of the robots in the system and the connection configurations thereof. Compared with the conventional spacecraft control method, the method has the following advantages: 1) the method is a distributed algorithm, and the robot unit control moment calculation, control parameter coordination and updating do not need a central unit, so that the flexibility and robustness of the system are improved; 2) the method is suitable for various connection topologies such as a network topology structure, a bus topology and the like, and has wide practicability; 3) the method is suitable for distributed cooperative control among heterogeneous robots, and is suitable for thrustor robots and reaction flywheel robots.
Drawings
FIG. 1: topology probing and updating data connection relationships
FIG. 2: control parameter initialization data connection relation
FIG. 3: robot information interaction and parameter update
Detailed Description
The invention will now be further described with reference to the following examples and drawings:
the method comprises the following steps that N robots are assumed to exist in a system, each robot has a unique identity ID, the set of the IDs of all the robots is X, and the defined ID is 0 and is an illegal identity; let the identity be IDiRobot i, having at most niAn interface, niThe number is more than or equal to 1, and the specific number is determined by the structural design of the robot. The robot i records the ID list of all the connected robots in the system and records the ID list as
Figure BDA0002530034610000063
Wherein each element represents an interface 1 to an interface n of the robot iiThe ID value of the connected robot, the initial value is 0.
In order to achieve the purpose, the technical scheme adopted by the invention comprises the following steps:
the method comprises the following steps: connection topology probing and updating
The purpose of this step is to establish connection with the adjacent robot by probing the adjacent robot, and update the connection relation at regular time. This step is performed continuously in a timed loop.
Each robot j belongs to X and performs connection topology detection and updating every T seconds, wherein T is more than or equal to D delta T, D is the diameter of an undirected graph of the multi-robot link topology and is determined by the robot network topology; and delta t is the time interval of information interaction between the robots, and each robot needs to actively send connection detection information or reply the connection detection information of the adjacent robots.
Wherein, the process of actively sending the connection detection information by the robot j is (1), and the process of replying the connection detection information of the adjacent robot is (2):
(1) the robot j actively sends connection detection information to the adjacent robots: sending connection request through all data interfaces of the robot, wherein the transmitted information at least comprises the identification ID of the robotjThe specific method is a network communication field communication method, which is not described in detail. If the interface p of the robot j (p is more than or equal to 1 and less than or equal to n)j) Receiving the connection detection information replied by the adjacent robot, and setting the identifier of the robot connected with the interface p contained in the connection detection information as IDkThen let ljp=IDk(ii) a If the interface p (1 is more than or equal to p and less than or equal to n)j) If the reply is not received, it means that the interface p is not connected with the robot or the connected robot is invalid, and let ljp=0。
(2) And the robot j replies the connection detection information of the adjacent robot: if the interface r of the robot j receives the connection detection information of the adjacent robot, the ID of the robot connected with the interface r contained in the connection detection information is readkLet Ljr=IDkAnd replies the connection detection information of the interface r.
Step two: control parameter initialization
The purpose of this step is to receive ground remote control commands and gradually update the control expectation values of all robots through information interaction between the robots.
The set of all robots capable of receiving ground remote control commands is set as CcomSet size Ncom(1≤Ncom≤N)。
For all robot IDsl∈CcomWhich receives the expected attitude σ sent by the ground measurement and control stationdRecording the reception time Tl
The robot L connects the list L according to the information thereoflWill σdAnd TlIs sent to LlAll neighboring robots. A certain adjacent robot is not set as m, and the robot m receives the sigmadAnd TlThen, T is comparedlAnd Tm
If Tl>TmIf yes, then update the recorded sigmadLet Tm=TlAnd will bedAnd an update time TmFurther forwarding to all adjacent robots except the robot l; otherwise, it is ignored.
Step three: calculating control moment
All robots perform control moment calculation, for robot IDξ∈ X, which uses sensors to measure the attitude σ of the spacecraft expressed by the modified Rodrigues parameterξ∈R3Angular velocity omegaξ∈R3And angular acceleration
Figure BDA0002530034610000081
Calculating the control torque according to the self measurement data and the control parameters:
each robot control parameter is three groups:
including parameters
Figure BDA0002530034610000082
Parameter Dξ=diag(ξ1,ξ2,ξ3)、Kξ=diag(κξ1ξ2ξ3) Wherein
Figure BDA0002530034610000083
ξ1,ξ2,ξ3≥0,κξ1ξ2ξ3And if the initial values of the control parameters of all the robots are consistent, updating in a step five. According to the control parameter Jξ、Dξ、KξAnd the desired attitude σdCalculating control moment τ of robot ξξThe calculation method is as follows:
Figure BDA0002530034610000084
wherein sigmaeIn order to correct the attitude error under the representation of the Rodris parameter, the method is an industry-recognized method, which does not belong to the content of the invention, and the specific expression is as follows:
Figure BDA0002530034610000085
step four: parametric scale factor calculation
Each robot calculates its own parameter scale factor according to its own residual energy, for robot IDζ∈ X, parameter scale factor Wζ=[Wζ1Wζ2Wζ3]Wherein each element has a value range of [ 01 ]]. The specific calculation method is as follows:
(1) if the zeta executor of the robot is a thruster, the calculation of the residual propellant can adopt one of the following two formulas (3) and (4)
Figure BDA0002530034610000091
Figure BDA0002530034610000092
Wherein A is a constant and has a value range of 3-100; b is a constant, and the value range is 1-10; e.g. of the typeζFor the remaining propellant mass of the robot, efullThe total amount of the robot fuel storage tank.
(2) If the zeta executor of the robot is three orthogonally installed reaction flywheels, the residual energy can be calculated by one of the following two formulas (5) and (6)
Figure BDA0002530034610000093
Figure BDA0002530034610000094
Wherein r isζ1、rζ2、rζ3The rotating speeds of the three reaction flywheels of the robot are respectively zeta; r isfullIs the saturation speed of flywheel αζ1,αζ2,αζ3Respectively calculated by the following formula
Figure BDA0002530034610000101
Wherein
Figure BDA0002530034610000102
TζAnd configuring a matrix for the zeta flywheel of the robot, wherein the matrix represents a rotation matrix of a flywheel rotation axis coordinate system and an inertia coordinate system, and the method is a method generally known in the industry and is not described any more.
Step five: control parameter update
All robots regularly update control parameters and parameter scale factors with adjacent robots
Figure BDA0002530034610000103
Case 1: robot
Figure BDA0002530034610000104
The specific way of actively sending information is as follows:
robot
Figure BDA0002530034610000105
According to
Figure BDA0002530034610000106
And the recorded IDs of the adjacent robots sequentially exchange data with the robots connected with the adjacent robots:
step (1): q is 1;
step (2): judgment of
Figure BDA0002530034610000107
A value of, if
Figure BDA0002530034610000108
Jumping to the step (3); if it is
Figure BDA0002530034610000109
Suppose that
Figure BDA00025300346100001010
Presentation robot
Figure BDA00025300346100001011
The interface q is connected with the robot pi, and the robot
Figure BDA00025300346100001012
Will be provided with
Figure BDA00025300346100001013
Figure BDA00025300346100001014
Figure BDA00025300346100001020
Sending the data to the robot pi, and the robot pi replies the W of the robot piπ
Figure BDA00025300346100001015
π1,π2,π3,κπ1π2π3And (4) data. Robot after finishing information interaction
Figure BDA00025300346100001016
And the robot pi updates the parameter scale factor and the control parameter thereof according to the following formulas
Figure BDA00025300346100001017
Figure BDA00025300346100001018
Figure BDA00025300346100001019
And (3): q ═ q +1 if
Figure BDA0002530034610000112
And returning to the step three, otherwise, performing the step (2).
Case 2: robot
Figure BDA0002530034610000113
And (3) receiving the information of the adjacent robot, wherein the processing mode is consistent with the processing step of the robot pi in the step (2).
And returning to the third step after the step is executed.

Claims (3)

1. A distributed cooperative operation method of a multi-space robot is characterized in that: the system comprises N robots, each robot has a unique identity ID, the set of the IDs of all the robots is X, and the defined ID is 0 and is an illegal identity; let the identity be IDiThe robot of (1) is a robot i; the robot i records the ID list of all the connected robots in the system and records the ID list as
Figure FDA0002530034600000011
Wherein each element represents an interface 1 to an interface n of the robot iiThe initial value of the ID value of the connected robot is 0; the operation steps are as follows:
step 1, connection topology detection and updating: each robot j belongs to X and performs connection topology detection and updating every T seconds, wherein T is more than or equal to D delta T, D is the diameter of an undirected graph of the multi-robot link topology and is determined by the robot network topology; delta t is the time interval of information interaction between the robots, and each robot actively sends connection detection information or replies the connection detection information of adjacent robots;
the process of the robot j actively sending the connection detection information:
the robot j adopts a network communication field identification method to send a connection request through all data interfaces of the robot, and the transmitted information comprises the identification ID of the robotj(ii) a If the interface p of the robot j is more than or equal to 1 and less than or equal to njReceiving the connection detection information replied by the adjacent robot, reading the ID of the robot connected with the interface p contained in the connection detection informationkThen let ljp=IDk(ii) a If the interface p does not receive the reply, it means that the interface p is not connected with the robot or the connected robot is invalid, and let ljp=0;
The process of replying the connection detection information of the adjacent robot comprises the following steps:
the interface r of the robot j receives the connection detection information of the adjacent robot, reads the ID of the robot connected with the interface r contained in the connection detection informationkLet Ljr=IDkAnd reply the connection detection information of oneself through the interface r; the interface r of the robot j receives the connection detection information of the adjacent robot, reads the ID of the robot connected with the interface r contained in the connection detection informationkLet Ljr=IDkAnd reply the connection detection information of oneself through the interface r;
the step is executed continuously in a timing cycle;
step 2, initializing control parameters:
the set of all robots for receiving ground remote control commands is CcomSet size Ncom1≤Ncom≤N;
All robot IDl∈CcomReceiving expected attitude sigma sent by ground measurement and control stationdRecording the reception time Tl
The robot L connects the list L according to the information thereoflWill σdAnd TlIs sent to LlAll neighboring robots m in (1), robot m receives σdAnd TlThen, T is comparedlAnd Tm
If Tl>TmIf yes, then update the recorded sigmadLet Tm=TlAnd will bedAnd an update time TmFurther forwarding to all adjacent robots except the robot l; otherwise, ignoring;
and 3, calculating the control moments of all the robots:
robot IDξ∈ X use sensors to measure spacecraft attitude σ in terms of modified rodgers parametersξ∈R3Angular velocity omegaξ∈R3And angular acceleration
Figure FDA0002530034600000021
Each robot control parameter is three groups:
including parameters
Figure FDA0002530034600000022
Parameter Dξ=diag(ξ1,ξ2,ξ3)、Kξ=diag(κξ1ξ2ξ3) Wherein
Figure FDA0002530034600000023
ξ1,ξ2,ξ3≥0,κξ1ξ2ξ3If the initial values of the control parameters of all the robots are more than 0, the initial values of the control parameters of all the robots are set to be consistent, and the control parameters are updated in step 5; according to the control parameter Jξ、Dξ、KξAnd the desired attitude σdCalculating control moment τ of robot ξξThe calculation method is as follows:
Figure FDA0002530034600000024
wherein: sigmaeCorrecting attitude errors under the representation of the Rodris parameter;
step 4, calculating parameter scale factors:
each robot calculates its own parameter scale factor according to its own residual energy, for robot IDζ∈ X, parameter scale factor Wζ=[Wζ1Wζ2Wζ3]Wherein each element has a value range of [ 01 ]]The calculation method is as follows:
case 1: if the zeta executor of the robot is a thruster, the residual propellant is calculated as:
Figure FDA0002530034600000025
wherein: a is a constant and has a value range of 3-100; b is a constant, and the value range is 1-10; e.g. of the typeζFor the remaining propellant mass of the robot, efullFor robot fuel storageThe total amount of bins;
case 2: if the zeta executor of the robot is three reaction flywheels which are installed in an orthogonal mode, the residual energy is calculated as follows:
Figure FDA0002530034600000031
wherein: r isζ1、rζ2、rζ3The rotating speeds of the three reaction flywheels of the robot are respectively zeta; r isfullIs the saturation speed of flywheel αζ1,αζ2,αζ3Calculated using the following formula, respectively:
Figure FDA0002530034600000032
wherein:
Figure FDA0002530034600000033
Tζconfiguring a matrix for a zeta flywheel of the robot, wherein the matrix represents a rotation matrix of a flywheel rotation axis coordinate system and an inertia coordinate system;
and 5, updating control parameters:
all robots regularly update control parameters and parameter scale factors with adjacent robots
Figure FDA0002530034600000034
Case 1: robot
Figure FDA0002530034600000035
The specific way of actively sending information is as follows:
robot
Figure FDA0002530034600000036
According to
Figure FDA0002530034600000037
Recorded neighboring robot IDs, in turn, therewithThe connected robots exchange data:
step (1): q is 1;
step (2): judgment of
Figure FDA0002530034600000038
A value of, if
Figure FDA0002530034600000039
Jumping to the step (3); if it is
Figure FDA00025300346000000310
Suppose that
Figure FDA00025300346000000311
Presentation robot
Figure FDA00025300346000000312
The interface q is connected with the robot pi, and the robot
Figure FDA00025300346000000313
Will be provided with
Figure FDA00025300346000000314
Figure FDA00025300346000000315
Figure FDA00025300346000000316
Sending the data to the robot pi, and the robot pi replies the W of the robot piπ
Figure FDA00025300346000000317
π1,π2,π3,κπ1π2π3Data; robot after finishing information interaction
Figure FDA00025300346000000318
And a machineThe human pi respectively updates the self parameter scale factor and the control parameter according to the following formula
Figure FDA0002530034600000041
Figure FDA0002530034600000042
Figure FDA0002530034600000043
And (3): q is q +1, if
Figure FDA0002530034600000044
Returning to the step 3, otherwise, performing the step (2);
case 2: robot
Figure FDA0002530034600000045
Receiving information of adjacent robots, wherein the processing mode is consistent with the processing step of the robot pi in the step (2);
and returning to the step 3 after the step is executed.
2. The distributed cooperative operation method of a multi-space robot according to claim 1, characterized in that: case 1 in step 4: if the zeta executor of the robot is a thruster, the residual propellant is calculated as:
Figure FDA0002530034600000046
wherein: b is a constant, and the value range is 1-10; e.g. of the typeζFor the remaining propellant mass of the robot, efullThe total amount of the robot fuel storage tank.
3. The distributed cooperative operation method of a multi-space robot according to claim 1, characterized in that: case 2 in step 4: if the zeta executor of the robot is three reaction flywheels which are installed in an orthogonal mode, the residual energy is calculated as follows:
Figure FDA0002530034600000047
wherein: r isζ1、rζ2、rζ3The rotating speeds of the three reaction flywheels of the robot are respectively zeta; r isfullIs the saturation speed of flywheel αζ1,αζ2,αζ3Calculated using the following formula, respectively:
Figure FDA0002530034600000051
wherein:
Figure FDA0002530034600000052
Tζa matrix is configured for the zeta flywheel of the robot, and the matrix represents a rotation matrix of a flywheel rotation axis coordinate system and an inertia coordinate system.
CN202010515768.8A 2020-06-09 2020-06-09 Distributed cooperative operation method for multi-space robot Active CN111625012B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010515768.8A CN111625012B (en) 2020-06-09 2020-06-09 Distributed cooperative operation method for multi-space robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010515768.8A CN111625012B (en) 2020-06-09 2020-06-09 Distributed cooperative operation method for multi-space robot

Publications (2)

Publication Number Publication Date
CN111625012A true CN111625012A (en) 2020-09-04
CN111625012B CN111625012B (en) 2022-12-06

Family

ID=72271437

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010515768.8A Active CN111625012B (en) 2020-06-09 2020-06-09 Distributed cooperative operation method for multi-space robot

Country Status (1)

Country Link
CN (1) CN111625012B (en)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107291094A (en) * 2017-05-08 2017-10-24 大陆智源科技(北京)有限公司 Unmanned plane robot cooperating system
CN108927803A (en) * 2018-07-25 2018-12-04 西北工业大学 One kind arresting antihunt means in continuous impact conditions down space robot target
CN109164822A (en) * 2018-09-26 2019-01-08 北京航空航天大学 It is a kind of based on have mixing executing agency Spacecraft Attitude Control method
CN109459931A (en) * 2018-05-09 2019-03-12 南京理工大学 A kind of Spacecraft formation finite time posture fault tolerant control method
CN109540150A (en) * 2018-12-26 2019-03-29 北京化工大学 One kind being applied to multi-robots Path Planning Method under harmful influence environment
CN110134018A (en) * 2019-06-17 2019-08-16 哈尔滨工程大学 A kind of underwater multi-foot robot system polypody cooperative control method
CN110231029A (en) * 2019-05-08 2019-09-13 西安交通大学 A kind of underwater robot Multi-sensor Fusion data processing method
CN110262256A (en) * 2019-07-18 2019-09-20 浙江大学 A kind of polygon adaptive sliding-mode observer method of non-linear remote control system
US20200166952A1 (en) * 2018-11-27 2020-05-28 Institute For Information Industry Coach apparatus and cooperative operation controlling method for coach-driven multi-robot cooperative operation system

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107291094A (en) * 2017-05-08 2017-10-24 大陆智源科技(北京)有限公司 Unmanned plane robot cooperating system
CN109459931A (en) * 2018-05-09 2019-03-12 南京理工大学 A kind of Spacecraft formation finite time posture fault tolerant control method
CN108927803A (en) * 2018-07-25 2018-12-04 西北工业大学 One kind arresting antihunt means in continuous impact conditions down space robot target
CN109164822A (en) * 2018-09-26 2019-01-08 北京航空航天大学 It is a kind of based on have mixing executing agency Spacecraft Attitude Control method
US20200166952A1 (en) * 2018-11-27 2020-05-28 Institute For Information Industry Coach apparatus and cooperative operation controlling method for coach-driven multi-robot cooperative operation system
CN109540150A (en) * 2018-12-26 2019-03-29 北京化工大学 One kind being applied to multi-robots Path Planning Method under harmful influence environment
CN110231029A (en) * 2019-05-08 2019-09-13 西安交通大学 A kind of underwater robot Multi-sensor Fusion data processing method
CN110134018A (en) * 2019-06-17 2019-08-16 哈尔滨工程大学 A kind of underwater multi-foot robot system polypody cooperative control method
CN110262256A (en) * 2019-07-18 2019-09-20 浙江大学 A kind of polygon adaptive sliding-mode observer method of non-linear remote control system

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
HAITAO CHANG: "Inertia parameters identication for cellular space robot through interaction", 《AEROSPACE SCIENCE AND TECHNOLOGY》 *
PANFENG HUANG: "Approach Trajectory Planning of Space Robot for Impact Minimization", 《PROCEEDINGS OF THE 2006 IEEE INTERNATIONAL CONFERENCE ON INFORMATION ACQUISITION》 *
翟光等: "基于集群空间机器人的合作目标协同定位技术", 《北京理工大学学报》 *

Also Published As

Publication number Publication date
CN111625012B (en) 2022-12-06

Similar Documents

Publication Publication Date Title
Sheng et al. Distributed multi-robot coordination in area exploration
CN109359408B (en) Air-to-surface missile control full-process simulation system and method
CN113342037B (en) Multi-rotor unmanned aerial vehicle time-varying formation control method and system with input saturation
CN103010491B (en) Control method for mechanical arm capture test on air-floating tables
CN106055522A (en) Minimum base attitude disturbance track planning method for redundant space manipulator
CN113296507B (en) Multi-power positioning ship cooperative formation control method based on space-time decoupling
CN109582036A (en) Quadrotor drone consistency formation control method
CN108540311B (en) Fault detection deep learning network processing method and device of satellite actuating mechanism
CN109164824A (en) A kind of probabilistic Spacecraft Attitude Control method of consideration flywheel
CN111522341A (en) Multi-time-varying formation tracking control method and system for network heterogeneous robot system
CN104570736B (en) A kind of kinetic parameter in-orbit identification method and apparatus of star arm coupled system
CN105259793A (en) AODV protocol wireless intelligent network-based satellite attitude control simulation system
CN108445768B (en) Augmented self-adaptive fuzzy control method for operation space trajectory tracking of space robot
CN112859915A (en) High-rise fire-fighting unmanned aerial vehicle formation control method and system based on saturation threshold event triggering
CN111625012B (en) Distributed cooperative operation method for multi-space robot
CN110262484A (en) Wheeled robot uniform rectilinear's formation control method based on adaptive event triggering
CN113885548A (en) Many four rotor unmanned aerial vehicle output restraint state unanimous game controller
CN114253288A (en) Multi-spacecraft orbit distributed cooperative tracking optimal control method
CN116774735B (en) Unmanned aerial vehicle cluster track planning method and system based on edge calculation
CN113467244A (en) Multi-rotor unmanned aerial vehicle fault-tolerant control method and device based on control matrix redistribution
CN111633656B (en) Distributed energy balancing method for cooperative operation of multiple space robots
CN116540740A (en) Intelligent vehicle group distributed control device under communication fault and cooperative control method
CN111552317B (en) Multi-spacecraft four-dimensional collaborative track determination method
CN114326819A (en) Unmanned aerial vehicle modeling and structural damage self-adaptive fault-tolerant control method based on coupling force field
CN117332229B (en) Fault diagnosis-oriented inter-satellite interaction information optimization method

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