CN106926238B - The cooperative control method and device of multi-redundant mechanical arm system based on impact degree - Google Patents
The cooperative control method and device of multi-redundant mechanical arm system based on impact degree Download PDFInfo
- Publication number
- CN106926238B CN106926238B CN201710084020.5A CN201710084020A CN106926238B CN 106926238 B CN106926238 B CN 106926238B CN 201710084020 A CN201710084020 A CN 201710084020A CN 106926238 B CN106926238 B CN 106926238B
- Authority
- CN
- China
- Prior art keywords
- redundant manipulator
- target
- reference point
- joint
- target redundant
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 40
- 230000001133 acceleration Effects 0.000 claims abstract description 82
- 238000004891 communication Methods 0.000 claims abstract description 74
- 239000011159 matrix material Substances 0.000 claims abstract description 74
- 238000005457 optimization Methods 0.000 claims abstract description 27
- 239000012636 effector Substances 0.000 claims description 21
- 230000036461 convulsion Effects 0.000 claims description 8
- 238000010276 construction Methods 0.000 claims description 7
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 150000001875 compounds Chemical class 0.000 claims 1
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 238000004519 manufacturing process Methods 0.000 description 3
- 238000003860 storage Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 206010062310 Joint hyperextension Diseases 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000003252 repetitive effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1643—Programme controls characterised by the control loop redundant control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1612—Programme controls characterised by the hand, wrist, grip control
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Software Systems (AREA)
- Medical Informatics (AREA)
- Evolutionary Computation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Artificial Intelligence (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Manipulator (AREA)
Abstract
The present invention relates to mechanical arm control fields, propose the cooperative control method and device of a kind of multi-redundant mechanical arm system based on impact degree.The described method includes: determining the target redundancy degree mechanical arm in multi-redundant mechanical arm system;Obtain position, the velocity and acceleration information of the adjacent redundant degree mechanical arm of the target redundancy degree mechanical arm;Obtain the reference point trace information of the target redundancy degree mechanical arm;The corresponding Jacobian matrix equation of the target redundancy degree mechanical arm is constructed according to default rule according to the position, velocity and acceleration information and the reference point trace information;The control signal of the target redundancy degree mechanical arm is determined according to quadratic form optimization and standard QUADRATIC PROGRAMMING METHOD FOR;The target redundancy degree mechanical arm is controlled according to the control signal, each redundancy mechanical arm in the system is made to realize distributed collaboration movement.The present invention can realize the distributed collaboration movement of the Multi-arm robots based on impact degree in the case where communication is limited.
Description
Technical Field
The invention relates to the field of mechanical arm control, in particular to a cooperative control method and device of a multi-redundancy mechanical arm system based on an abrupt increase degree.
Background
The redundant manipulator has the characteristic that the degree of freedom is greater than the minimum degree of freedom required by a task space, is widely applied to national economic production activities such as equipment manufacturing, product processing, machine operation and the like, and can greatly improve the production efficiency compared with the traditional manual operation.
However, in a wide operating environment, each redundant robot in the multiple redundant robot system based on the sudden increase generally does not have the capability of global communication due to the limitation of the distance and the communication load, and it is difficult for the control center to access all the robots to perform direct communication. In a large-scale environment, communication load is too large and communication is difficult due to the fact that the number of redundant mechanical arms is large, information cannot be shared at any time and any place, and distributed cooperative motion of a multi-mechanical-arm system based on the adding degree is seriously hindered.
Disclosure of Invention
The invention provides a cooperative control method and a cooperative control device for a multi-redundancy mechanical arm system based on an abrupt increase degree, and aims to solve the problem of how to realize distributed cooperative motion of the multi-mechanical arm system based on the abrupt increase degree under the condition of limited communication.
The first aspect of the embodiment of the invention provides a cooperative control method for a multi-redundancy mechanical arm system based on an abrupt increase degree, wherein the multi-redundancy mechanical arm system comprises more than two redundancy mechanical arms which are communicated in a communication topological graph;
the control method comprises the following steps:
determining at least one redundant manipulator of the more than two redundant manipulators as a target redundant manipulator;
acquiring position, speed and acceleration information of an adjacent redundant manipulator of the target redundant manipulator, wherein the adjacent redundant manipulator and the target redundant manipulator are adjacently connected in a communication topological graph;
acquiring reference point track information of the target redundant manipulator, wherein the reference point track information is determined by a preset target reference point and an expected track of the target reference point;
constructing a Jacobian matrix equation corresponding to the target redundant manipulator according to the position, speed and acceleration information and the reference point track information and a preset rule;
determining a control signal of the target redundant manipulator according to quadratic optimization and a standard quadratic programming method under the constraint of the Jacobian matrix equation, the joint angle limit, the joint speed limit, the joint acceleration limit and the joint sudden acceleration limit;
and controlling the target redundant manipulator according to the control signal, so that the more than two redundant manipulators realize distributed cooperative motion.
A second aspect of the embodiments of the present invention provides a cooperative control apparatus for a multiple-redundancy manipulator system based on an abrupt increase degree, where the multiple-redundancy manipulator system includes two or more redundancy manipulators, and the two or more redundancy manipulators are connected in a communication topological graph;
the control device includes:
a target manipulator determining module, configured to determine that at least one redundant manipulator of the more than two redundant manipulators is a target redundant manipulator;
the information acquisition module is used for acquiring the position, the speed and the acceleration information of an adjacent redundant manipulator of the target redundant manipulator, and the adjacent redundant manipulator and the target redundant manipulator are adjacently connected in a communication topological graph;
a reference point track information acquisition module, configured to acquire reference point track information of the target redundant manipulator, where the reference point track information is determined by a preset target reference point and an expected track of the target reference point;
the equation building module is used for building a Jacobi matrix equation corresponding to the target redundant manipulator according to the position, speed and acceleration information and the reference point track information according to a preset rule;
the control signal determining module is used for determining a control signal of the target redundant manipulator according to quadratic optimization and a standard quadratic programming method under the constraints of the Jacobian matrix equation, the joint angle limit, the joint speed limit, the joint acceleration limit and the joint sudden acceleration limit;
and the mechanical arm control module is used for controlling the target redundant mechanical arm according to the control signal so as to enable the more than two redundant mechanical arms to realize distributed cooperative motion.
In an embodiment of the invention, a target redundant manipulator in a multi-redundancy manipulator system is determined; acquiring position, speed and acceleration information of adjacent redundant manipulator of the target redundant manipulator; acquiring reference point track information of the target redundant manipulator; constructing a Jacobian matrix equation corresponding to the target redundant manipulator according to the position, speed and acceleration information and the reference point track information and a preset rule; determining a control signal of the target redundant manipulator according to a quadratic optimization and standard quadratic programming method; and controlling the target redundant manipulator according to the control signal, so that each redundant manipulator in the multi-redundant manipulator system realizes distributed cooperative motion. By utilizing the cooperative control method provided by the embodiment of the invention, the target redundant manipulator only needs to communicate with a small number of adjacent redundant manipulators, so that the communication load is greatly reduced, and the distributed cooperative motion of a multi-manipulator system based on the sudden increase degree can be realized under the condition of limited communication.
Drawings
Fig. 1 is a flowchart illustrating an embodiment of a cooperative control method for a multi-redundancy robot system based on an abrupt increase degree according to an embodiment of the present invention;
FIG. 2 is a detailed flowchart of one embodiment of step 104 of FIG. 1;
FIG. 3 is a detailed flowchart of one embodiment of step 1042 in FIG. 2;
FIG. 4 is a detailed flowchart of one embodiment of step 105 of FIG. 1;
fig. 5 is a block diagram of an embodiment of a cooperative control apparatus of a multi-redundancy arm system based on an abrupt increase in accordance with an embodiment of the present invention.
Detailed Description
The invention provides a cooperative control method and a cooperative control device for a multi-redundancy mechanical arm system based on an abrupt increase degree, and aims to solve the problem of how to realize distributed cooperative motion of the multi-mechanical arm system based on the abrupt increase degree under the condition of limited communication.
In order to make the objects, features and advantages of the present invention more obvious and understandable, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present invention, and it is obvious that the embodiments described below are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
FIG. 1 is a flow diagram illustrating an embodiment of a coordinated control method for a multiple redundancy robot system based on an abrupt increase, the multiple redundancy robot system comprising two or more redundancy robots, the two or more redundancy robots being connected in a communication topology;
as shown in fig. 1, the control method includes:
101. determining at least one redundant manipulator of the more than two redundant manipulators as a target redundant manipulator;
the more than two redundant manipulator are distributed in the working space according to the needs, and one or more redundant manipulators are determined as the target redundant manipulator, so that the target redundant manipulator realizes repeated motion.
102. Acquiring position, speed and acceleration information of an adjacent redundant manipulator of the target redundant manipulator, wherein the adjacent redundant manipulator and the target redundant manipulator are adjacently connected in a communication topological graph;
after a target redundant manipulator is determined, position, speed and acceleration information of an adjacent redundant manipulator of the target redundant manipulator is obtained. The adjacent redundant manipulator refers to a redundant manipulator which is adjacently connected with the target redundant manipulator in a communication topological graph, and the target redundant manipulator belong to the same multi-redundant manipulator system. Because the multiple redundant manipulator systems are interconnected in a communication topology, the number of adjacent redundant manipulators for a target redundant manipulator is one or more. The position information may be the position information of the end effector of the redundant manipulator or the position information of other parts of the redundant manipulator. Similarly, the speed information may be speed information for the end effector of the redundant manipulator or may be speed information for other portions of the redundant manipulator; the acceleration information may be acceleration information of the end effector of the redundant manipulator or acceleration information of other portions of the redundant manipulator. The target redundant manipulator may exchange the position, velocity, and acceleration information with its neighboring redundant manipulator.
103. Acquiring reference point track information of the target redundant manipulator, wherein the reference point track information is determined by a preset target reference point and an expected track of the target reference point;
the target reference point is a preset position reference point located in a working space of the target redundant manipulator, and the reference point track information is determined by the expected position, speed and acceleration of the target reference point. A control center may be provided in the working space of the multi-redundancy robot system, and the reference point trajectory information may be sent to each target redundancy robot by the control center, or may be sent to each target redundancy robot by an adjacent redundancy robot or by other means.
104. Constructing a Jacobian matrix equation corresponding to the target redundant manipulator according to the position, speed and acceleration information and the reference point track information and a preset rule;
after the position, the speed and the acceleration information of the adjacent redundant manipulator of the target redundant manipulator and the reference point track information of the target redundant manipulator are obtained, a Jacobian matrix equation corresponding to the target redundant manipulator is constructed according to the position, the speed and the acceleration information and the reference point track information according to a preset rule.
Further, as shown in fig. 2, step 104 may specifically include:
1041. constructing a weight matrix corresponding to the target redundant manipulator, wherein each element in the weight matrix is a first connection weight value respectively corresponding to the target redundant manipulator and each manipulator in the more than two redundant manipulators;
the number of elements of the weight matrix is determined by the number of robots in the multi-redundancy robot system, and the first connection weight represents a communication connection relationship between the target redundancy robot and each of the two or more redundancy robots. Such as defining a weight matrixThe ijth element is defined as the first communication weight between the ith redundant manipulator and the jth redundant manipulator on the communication topological graph.
1042. Determining a second communication weight of the target redundant manipulator according to the acquisition state of the reference point track information;
the second communication weight represents the acquisition state of the target redundant manipulator for the reference point track information, and may be represented by rhoiTo represent a second communication weight for the ith redundant manipulator.
1043. And constructing a Jacobian matrix equation corresponding to the target redundant manipulator according to the position, speed and acceleration information, the reference point track information, the weight matrix and the second communication weight.
After the weight matrix is constructed and the second communication weight is determined, a Jacobian matrix equation corresponding to the target redundant manipulator can be constructed according to the position, speed and acceleration information, the reference point track information, the weight matrix and the second communication weight.
Further, the first connection weight may be determined by:
(1) setting a first communication weight between the target redundant manipulator and the target redundant manipulator to be 1;
(2) setting a first communication weight between the target redundant manipulator and an adjacent redundant manipulator to be 1;
(3) setting a first connection weight between the target redundant manipulator and a non-self and non-adjacent redundant manipulator of the more than two redundant manipulators to 0.
For step (1), the target redundant manipulator and the target redundant manipulator have a communication connection relationship, and therefore the first connection weight is set to 1. For step (2) above, the target redundant manipulator and the adjacent redundant manipulator may exchange information directly, and thus the first connection weight is set to 1. For the step (3), the target redundant manipulator does not need to directly exchange information with a non-self redundant manipulator and a non-adjacent redundant manipulator, and therefore the first connection weight is set to 0.
As shown in fig. 3, step 1042 may specifically include:
10421. judging whether the target redundant manipulator acquires the reference point track information or not;
10422. if the target redundant manipulator acquires the reference point track information, setting the second communication weight value to be 1;
10423. and if the target redundant manipulator does not acquire the reference point track information, setting the second communication weight value to be 0.
And determining a second communication weight of the target redundant manipulator according to the acquisition state of the reference point track information, if the target redundant manipulator acquires the reference point track information, setting the second communication weight to be 1, otherwise, setting the second communication weight to be 0.
The general expression of the jacobian matrix equation may specifically be:
wherein
JiA jacobian matrix representing the target redundant manipulator i,andare respectively JiFirst and second time derivatives of;represents the joint velocity vector for the target redundant manipulator i,andare respectively asFirst and second time derivatives of;representing the number of the mechanical arm with the first communication weight value of 1 between the mechanical arm and the target redundant mechanical arm i; a. theijRepresenting a weight matrix of a target redundant manipulator i, wherein each element in the weight matrix is a first connection weight between the target redundant manipulator i and a redundant manipulator j; rhoiRepresenting a second communication weight of the target redundant manipulator i; deltai=ri-rirpFor the position information, riPosition of the end effector, r, for a target redundant manipulator iirpA distance vector of an end effector of a preset target redundant manipulator i relative to the target reference point;in order to be able to determine the speed information,the speed of the end effector of the target redundant manipulator i;for the purpose of the acceleration information, it is,acceleration of an end effector of a target redundant manipulator i; r isdIs the desired position of the target reference point,for the desired speed of the target reference point,a desired acceleration for the target reference point; c. C0>0、c1> 0 and c2The more 0 is a parameter for controlling the convergence rate of the algorithm, and the larger the parameter is, the faster the convergence rate is represented.
The jacobian matrix equation (1) is mainly responsible for realizing distributed cooperative motion constraint among multiple mechanical arms, and the expected jerk constraint of the ith redundant mechanical arm can be set as a weighted average of the relative positions, speeds and accelerations of the other redundant mechanical arms (the weight is the right of jacobian equation constraint) by acquiring the position, speed and acceleration information of the end effectors of the other redundant mechanical arms, so that cooperative motion is realized. The multi-mechanical-arm cooperative motion system constructed based on the Jacobian matrix equation constraint (1) has the characteristics of high robustness and low communication cost, and particularly, for a multi-mechanical-arm system, the stability of the system is not influenced when one mechanical arm is added or withdrawn. In addition, each mechanical arm only needs to communicate with a small number of adjacent mechanical arms, and the requirement of global communication does not need to be met. If there are 100 mechanical arms, the total number of communication links required in the case of global communication is 100 × 99/2 — 4950; the distributed scheme provided by the embodiment of the invention only needs 99 communication links at least, thereby greatly reducing the communication load.
105. Determining a control signal of the target redundant manipulator according to quadratic optimization and a standard quadratic programming method under the constraint of the Jacobian matrix equation, the joint angle limit, the joint speed limit, the joint acceleration limit and the joint sudden acceleration limit;
after a Jacobian matrix equation corresponding to the target redundant manipulator is constructed, under the constraint of the Jacobian matrix equation, the joint angle limit, the joint speed limit, the joint acceleration limit and the joint sudden acceleration limit, a control signal of the target redundant manipulator is determined according to quadratic optimization and a standard quadratic programming method.
Further, as shown in fig. 4, step 105 may specifically include:
1051. setting a performance index as the minimum of the abrupt increase norm, and determining a quadratic optimization result under the constraint of the Jacobian matrix equation, the joint angle limit, the joint speed limit, the joint acceleration limit and the joint abrupt increase limit;
according to the embodiment of the invention, distributed cooperative motion of a multi-mechanical arm system based on the abrupt acceleration degree needs to be realized, so that the minimization performance index is set to be the abrupt acceleration degree norm minimization in the quadratic optimization process, and then the quadratic optimization result is determined under the constraint of the Jacobian matrix equation, the joint angle limit, the joint speed limit, the joint acceleration limit and the joint abrupt acceleration limit.
Further, if the jacobian matrix equation is shown in formula (1), the quadratic optimization may specifically be:
minimizing the first pattern under a first constraint;
the first constraint includes:
jacobian equation constraints
Joint angle limit constraint
Joint velocity limit constraints
Joint acceleration limit constraint
Constraint condition of joint sudden increase degree limit
The first formula is
Wherein, superscript T represents the transpose of the matrix and vector;representing the upper and lower limits of the joint angle of the target redundant manipulator i;representing the upper and lower limits of the joint speed of the target redundant manipulator i,representing the upper and lower limits of the joint acceleration of the target redundant manipulator i,representing the upper and lower limits of the joint jerk of the target redundant manipulator i.
1052. Converting the quadratic optimization result into a standard quadratic programming;
and converting the quadratic optimization result into a standard quadratic programming so as to solve.
Further, if the quadratic optimization is shown in equations (2) to (7), considering that the above optimization problem is solved on the abrupt increase level, the joint angle constraint (3), the joint speed constraint (4), the joint acceleration constraint (5) and the joint abrupt increase constraint (6) of the ith redundant manipulator need to be combined, so that the following abrupt increase-based constraint can be obtainedThe double-ended inequality constraint of:
wherein,andrespectively represent the upper and lower limits of the synthetic double-ended constraint of the ith redundant manipulator, and the p-th elements of the two-ended constraint are respectively defined asAndwhereinFor margin, ip denotes the joint number of the i-th redundant robot arm, p is 1, 2, …, m is the number of degrees of freedom of the robot arm, and k is1>0,k2> 0 and k3A feasible region > 0 is used to adjust and ensure that the joint hyperextension is sufficiently large. By xiIndicating the jerk of the ith redundant robot armThe quadratic optimization schemes (2) to (7) described above can be described as standard quadratic programming schemes as follows:
constraint conditions are as follows: cixi=di (8)
And (3) minimizing:
wherein x isiTo representW is an identity matrix, Ci=Ji,
1053. Solving the standard quadratic programming to obtain a solving result;
the standard quadratic programming problem can be solved by using a standard quadratic programming solver or a numerical method to obtain an optimal solution of the acceleration repetitive motion planning method of each target redundant manipulator.
1054. And determining a control signal of the target redundant manipulator according to the solving result.
And determining a control signal of the target redundant manipulator according to the solving result, and then controlling the target redundant manipulator by using the control signal.
106. And controlling the target redundant manipulator according to the control signal, so that the more than two redundant manipulators realize distributed cooperative motion.
And after the control signal of the target redundant manipulator is determined, controlling the target redundant manipulator to move according to the control signal. Finally, under the condition that the relative distance between each mechanical arm end effector and a reference point is kept unchanged, the redundant mechanical arm system based on the abrupt increase degree realizes distributed cooperative motion.
In an embodiment of the invention, a target redundant manipulator in a multi-redundancy manipulator system is determined; acquiring position, speed and acceleration information of adjacent redundant manipulator of the target redundant manipulator; acquiring reference point track information of the target redundant manipulator; constructing a Jacobian matrix equation corresponding to the target redundant manipulator according to the position, speed and acceleration information and the reference point track information and a preset rule; determining a control signal of the target redundant manipulator according to a quadratic optimization and standard quadratic programming method; and controlling the target redundant manipulator according to the control signal, so that each redundant manipulator in the multi-redundant manipulator system realizes distributed cooperative motion. By utilizing the cooperative control method provided by the embodiment of the invention, the target redundant manipulator only needs to communicate with a small number of adjacent redundant manipulators, so that the communication load is greatly reduced, and the distributed cooperative motion of a multi-manipulator system based on the sudden increase degree can be realized under the condition of limited communication.
The above mainly describes a cooperative control method of a multi-redundancy arm system based on an abrupt increase degree, and a detailed description will be given below of a cooperative control apparatus of a multi-redundancy arm system based on an abrupt increase degree.
Referring to fig. 5, a cooperative control apparatus of a multiple redundancy robot arm system based on abrupt increase is shown, in an embodiment of the present invention, where the multiple redundancy robot arm system includes more than two redundancy robot arms, and the more than two redundancy robot arms are connected in a communication topology;
the control device includes:
a target manipulator determining module 501, configured to determine that at least one redundant manipulator of the more than two redundant manipulators is a target redundant manipulator;
an information obtaining module 502, configured to obtain position, speed, and acceleration information of an adjacent redundant manipulator of the target redundant manipulator, where the adjacent redundant manipulator and the target redundant manipulator are adjacently connected in a communication topological graph;
a reference point track information obtaining module 503, configured to obtain reference point track information of the target redundant manipulator, where the reference point track information is determined by a preset target reference point and an expected track of the target reference point;
an equation constructing module 504, configured to construct a jacobian matrix equation corresponding to the target redundant manipulator according to the position, the speed, the acceleration information, and the reference point trajectory information according to a preset rule;
a control signal determining module 505, configured to determine a control signal of the target redundant manipulator according to quadratic optimization and a standard quadratic programming method under the constraints of the jacobian matrix equation, the joint angle limit, the joint speed limit, the joint acceleration limit, and the joint jerk limit;
and a manipulator control module 506, configured to control the target redundant manipulator according to the control signal, so that the two or more redundant manipulators realize distributed cooperative motion.
Further, the equation constructing module 504 may specifically include:
a weight matrix construction unit, configured to construct a weight matrix corresponding to the target redundant manipulator, where each element in the weight matrix is a first connection weight corresponding to each of the target redundant manipulator and each of the two or more redundant manipulators;
the first determining unit is used for determining a second communication weight of the target redundant manipulator according to the acquisition state of the reference point track information;
and the equation construction unit is used for constructing a Jacobian matrix equation corresponding to the target redundant manipulator according to the position, speed and acceleration information, the reference point track information, the weight matrix and the second communication weight.
Further, the weight matrix constructing unit may specifically include:
a first setting module, configured to set a first connection weight between the target redundant manipulator and the target redundant manipulator to 1;
a second setting module, configured to set a first connection weight between the target redundant manipulator and an adjacent redundant manipulator to 1;
a third setting module, configured to set a first connection weight between the target redundant manipulator and a non-self and non-adjacent redundant manipulator of the more than two redundant manipulators to 0;
the first determining unit may specifically include:
the judging module is used for judging whether the target redundant manipulator acquires the reference point track information or not;
the fourth setting module is configured to set the second communication weight to 1 if the target redundant manipulator acquires the reference point trajectory information;
a fifth setting module, configured to set the second communication weight to 0 if the target redundant manipulator does not obtain the reference point trajectory information;
the general expression of the jacobian matrix equation constructed by the equation construction unit may specifically be:
wherein
JiA jacobian matrix representing the target redundant manipulator i,andare respectively JiFirst and second time derivatives of;represents the joint velocity vector for the target redundant manipulator i,andare respectively asFirst and second time derivatives of;representing the number of the mechanical arm with the first communication weight value of 1 between the mechanical arm and the target redundant mechanical arm i; a. theijRepresenting a weight matrix of a target redundant manipulator i, wherein each element in the weight matrix is a first connection weight between the target redundant manipulator i and a redundant manipulator j; rhoiRepresenting a second communication weight of the target redundant manipulator i; deltai=ri-rirpFor the position information, riPosition of the end effector, r, for a target redundant manipulator iirpA distance vector of an end effector of a preset target redundant manipulator i relative to the target reference point;in order to be able to determine the speed information,the speed of the end effector of the target redundant manipulator i;for the purpose of the acceleration information, it is,acceleration of an end effector of a target redundant manipulator i; r isdIs the desired position of the target reference point,for the desired speed of the target reference point,a desired acceleration for the target reference point; c. C0>0、c1> 0 and c2The more 0 is a parameter for controlling the convergence rate of the algorithm, and the larger the parameter is, the faster the convergence rate is represented.
Further, the control signal determining module 505 may specifically include:
the second determining unit is used for setting the performance index to be the minimum of the abrupt acceleration norm and determining a quadratic optimization result under the constraint of the Jacobian matrix equation, the joint angle limit, the joint speed limit, the joint acceleration limit and the joint abrupt acceleration limit;
the conversion unit is used for converting the quadratic optimization result into a standard quadratic programming;
the solving unit is used for solving the standard quadratic programming to obtain a solving result;
and the control signal determining unit is used for determining the control signal of the target redundant manipulator according to the solving result.
Further, the quadratic optimization adopted by the control signal determination module may specifically be:
minimizing the first pattern under a first constraint;
the first constraint includes:
jacobian equation constraints
Joint angle limit constraint
Joint velocity limit constraints
Joint acceleration limit constraint
Constraint condition of joint sudden increase degree limit
The first formula is
Wherein, superscript T represents the transpose of the matrix and vector;representing the upper and lower limits of the joint angle of the target redundant manipulator i;representing the upper and lower limits of the joint speed of the target redundant manipulator i,representing the upper and lower limits of the joint acceleration of the target redundant manipulator i,representing the upper and lower limits of the joint jerk of the target redundant manipulator i.
It is clear to those skilled in the art that, for convenience and brevity of description, the specific working processes of the above-described systems, apparatuses and units may refer to the corresponding processes in the foregoing method embodiments, and are not described herein again.
In the several embodiments provided in the present application, it should be understood that the disclosed system, apparatus and method may be implemented in other manners. For example, the above-described apparatus embodiments are merely illustrative, and for example, the division of the units is only one logical division, and other divisions may be realized in practice, for example, a plurality of units or components may be combined or integrated into another system, or some features may be omitted, or not executed. In addition, the shown or discussed mutual coupling or direct coupling or communication connection may be an indirect coupling or communication connection through some interfaces, devices or units, and may be in an electrical, mechanical or other form.
The units described as separate parts may or may not be physically separate, and parts displayed as units may or may not be physical units, may be located in one place, or may be distributed on a plurality of network units. Some or all of the units can be selected according to actual needs to achieve the purpose of the solution of the embodiment.
In addition, functional units in the embodiments of the present invention may be integrated into one processing unit, or each unit may exist alone physically, or two or more units are integrated into one unit. The integrated unit can be realized in a form of hardware, and can also be realized in a form of a software functional unit.
The integrated unit, if implemented in the form of a software functional unit and sold or used as a stand-alone product, may be stored in a computer readable storage medium. Based on such understanding, the technical solution of the present invention may be embodied in the form of a software product, which is stored in a storage medium and includes instructions for causing a computer device (which may be a personal computer, a server, or a network device) to execute all or part of the steps of the method according to the embodiments of the present invention. And the aforementioned storage medium includes: a U-disk, a removable hard disk, a Read-only Memory (ROM), a Random Access Memory (RAM), a magnetic disk or an optical disk, and other various media capable of storing program codes.
The above-mentioned embodiments are only used for illustrating the technical solutions of the present invention, and not for limiting the same; although the present invention has been described in detail with reference to the foregoing embodiments, it will be understood by those of ordinary skill in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some technical features may be equivalently replaced; and such modifications or substitutions do not depart from the spirit and scope of the corresponding technical solutions of the embodiments of the present invention.
Claims (10)
1. The cooperative control method of the multi-redundancy mechanical arm system based on the sudden increase is characterized in that the multi-redundancy mechanical arm system comprises more than two redundancy mechanical arms, and the more than two redundancy mechanical arms are communicated in a communication topological graph;
the control method comprises the following steps:
determining at least one redundant manipulator of the more than two redundant manipulators as a target redundant manipulator;
acquiring position, speed and acceleration information of an adjacent redundant manipulator of the target redundant manipulator, wherein the adjacent redundant manipulator and the target redundant manipulator are adjacently connected in a communication topological graph;
acquiring reference point track information of the target redundant manipulator, wherein the reference point track information is determined by a preset target reference point and an expected track of the target reference point;
constructing a Jacobian matrix equation corresponding to the target redundant manipulator according to the position, speed and acceleration information and the reference point track information and a preset rule;
determining a control signal of the target redundant manipulator according to quadratic optimization and a standard quadratic programming method under the constraints of joint angle limit, joint speed limit, joint acceleration limit, joint sudden acceleration limit and the Jacobian matrix equation;
and controlling the target redundant manipulator according to the control signal, so that the more than two redundant manipulators realize distributed cooperative motion.
2. The cooperative control method according to claim 1, wherein the constructing a jacobian matrix equation corresponding to the target redundant manipulator according to the position, velocity, and acceleration information and the reference point trajectory information according to a preset rule specifically includes:
constructing a weight matrix corresponding to the target redundant manipulator, wherein each element in the weight matrix is a first connection weight value respectively corresponding to the target redundant manipulator and each manipulator in the more than two redundant manipulators;
determining a second communication weight of the target redundant manipulator according to the acquisition state of the reference point track information;
and constructing a Jacobian matrix equation corresponding to the target redundant manipulator according to the position, speed and acceleration information, the reference point track information, the weight matrix and the second communication weight.
3. The cooperative control method according to claim 2, wherein the first connection weight is determined by:
setting a first communication weight between the target redundant manipulator and the target redundant manipulator to be 1;
setting a first communication weight between the target redundant manipulator and an adjacent redundant manipulator to be 1;
setting a first connection weight value between the target redundant manipulator and a non-self and non-adjacent redundant manipulator of the more than two redundant manipulators to be 0;
the determining the second communication weight of the target redundant manipulator according to the acquired state of the reference point track information specifically includes:
judging whether the target redundant manipulator acquires the reference point track information or not;
if the target redundant manipulator acquires the reference point track information, setting the second communication weight value to be 1;
if the target redundant manipulator does not acquire the reference point track information, setting the second communication weight value to be 0;
the general expression of the jacobian matrix equation is:
wherein
JiA jacobian matrix representing the target redundant manipulator i,andare respectively JiFirst and second time derivatives of;represents the joint velocity vector for the target redundant manipulator i,andare respectively asFirst and second time derivatives of;representing the number of the mechanical arm with the first communication weight value of 1 between the mechanical arm and the target redundant mechanical arm i; a. theijRepresenting a weight matrix of a target redundant manipulator i, wherein each element in the weight matrix is a first connection weight between the target redundant manipulator i and a redundant manipulator j; rhoiRepresenting a second communication weight of the target redundant manipulator i; deltai=ri-rirpFor the position information, riPosition of the end effector, r, for a target redundant manipulator iirpA distance vector of an end effector of a preset target redundant manipulator i relative to the target reference point;is a stand forThe speed information is used for recording the speed information,the speed of the end effector of the target redundant manipulator i;for the purpose of the acceleration information, it is,acceleration of an end effector of a target redundant manipulator i; r isdIs the desired position of the target reference point,for the desired speed of the target reference point,a desired acceleration for the target reference point; c. C0>0、c1> 0 and c2The more 0 is a parameter for controlling the convergence rate of the algorithm, and the larger the parameter is, the faster the convergence rate is represented.
4. The cooperative control method according to any one of claims 1 to 3, wherein the determining the control signal of the target redundant manipulator according to quadratic optimization and standard quadratic programming method under the constraints of joint angle limit, joint velocity limit, joint acceleration limit, joint jerk limit, and the Jacobian matrix equation specifically comprises:
setting performance indexes to minimize the abrupt increment norm, and determining a quadratic optimization result under the constraint of joint angle limit, joint speed limit, joint acceleration limit, joint abrupt increment limit and the Jacobian matrix equation;
converting the quadratic optimization result into a standard quadratic programming;
solving the standard quadratic programming to obtain a solving result;
and determining a control signal of the target redundant manipulator according to the solving result.
5. The cooperative control method according to claim 3, characterized in that the quadratic form is optimized as:
minimizing the first pattern under a first constraint;
the first constraint includes:
jacobian equation constraints
Joint angle limit constraint
Joint velocity limit constraints
Joint acceleration limit constraint
Constraint condition of joint sudden increase degree limit
The first formula is
Wherein, superscript T represents the transpose of the matrix and vector;representing the upper and lower limits of the joint angle of the target redundant manipulator i;representing the upper and lower limits of the joint speed of the target redundant manipulator i,representing the upper and lower limits of the joint acceleration of the target redundant manipulator i,representing the upper and lower limits of the joint jerk of the target redundant manipulator i.
6. The cooperative control device of the multi-redundancy mechanical arm system based on the sudden increase is characterized in that the multi-redundancy mechanical arm system comprises more than two redundancy mechanical arms, and the more than two redundancy mechanical arms are communicated in a communication topological graph;
the control device includes:
a target manipulator determining module, configured to determine that at least one redundant manipulator of the more than two redundant manipulators is a target redundant manipulator;
the information acquisition module is used for acquiring the position, the speed and the acceleration information of an adjacent redundant manipulator of the target redundant manipulator, and the adjacent redundant manipulator and the target redundant manipulator are adjacently connected in a communication topological graph;
a reference point track information acquisition module, configured to acquire reference point track information of the target redundant manipulator, where the reference point track information is determined by a preset target reference point and an expected track of the target reference point;
the equation building module is used for building a Jacobi matrix equation corresponding to the target redundant manipulator according to the position, speed and acceleration information and the reference point track information according to a preset rule;
the control signal determining module is used for determining a control signal of the target redundant manipulator according to quadratic optimization and a standard quadratic programming method under the constraint of joint angle limit, joint speed limit, joint acceleration limit, joint sudden acceleration limit and the Jacobian matrix equation;
and the mechanical arm control module is used for controlling the target redundant mechanical arm according to the control signal so as to enable the more than two redundant mechanical arms to realize distributed cooperative motion.
7. The cooperative control apparatus according to claim 6, wherein the equation constructing module specifically includes:
a weight matrix construction unit, configured to construct a weight matrix corresponding to the target redundant manipulator, where each element in the weight matrix is a first connection weight corresponding to each of the target redundant manipulator and each of the two or more redundant manipulators;
the first determining unit is used for determining a second communication weight of the target redundant manipulator according to the acquisition state of the reference point track information;
and the equation construction unit is used for constructing a Jacobian matrix equation corresponding to the target redundant manipulator according to the position, speed and acceleration information, the reference point track information, the weight matrix and the second communication weight.
8. The cooperative control apparatus according to claim 7, wherein the weight matrix construction unit specifically includes:
a first setting module, configured to set a first connection weight between the target redundant manipulator and the target redundant manipulator to 1;
a second setting module, configured to set a first connection weight between the target redundant manipulator and an adjacent redundant manipulator to 1;
a third setting module, configured to set a first connection weight between the target redundant manipulator and a non-self and non-adjacent redundant manipulator of the more than two redundant manipulators to 0;
the first determining unit specifically includes:
the judging module is used for judging whether the target redundant manipulator acquires the reference point track information or not;
the fourth setting module is configured to set the second communication weight to 1 if the target redundant manipulator acquires the reference point trajectory information;
a fifth setting module, configured to set the second communication weight to 0 if the target redundant manipulator does not obtain the reference point trajectory information;
the general expression of the Jacobian matrix equation constructed by the equation construction unit is as follows:
wherein
JiA jacobian matrix representing the target redundant manipulator i,andare respectively JiFirst and second time derivatives of;representing the Joint velocity Direction of the target redundant manipulator iThe amount of the compound (A) is,andare respectively asFirst and second time derivatives of;representing the number of the mechanical arm with the first communication weight value of 1 between the mechanical arm and the target redundant mechanical arm i; a. theijRepresenting a weight matrix of a target redundant manipulator i, wherein each element in the weight matrix is a first connection weight between the target redundant manipulator i and a redundant manipulator j; rhoiRepresenting a second communication weight of the target redundant manipulator i; deltai=ri-rirpFor the position information, riPosition of the end effector, r, for a target redundant manipulator iirpA distance vector of an end effector of a preset target redundant manipulator i relative to the target reference point;in order to be able to determine the speed information,the speed of the end effector of the target redundant manipulator i;for the purpose of the acceleration information, it is,acceleration of an end effector of a target redundant manipulator i; r isdIs the desired position of the target reference point,for the desired speed of the target reference point,a desired acceleration for the target reference point; c. C0>0、c1> 0 and c2The more 0 is a parameter for controlling the convergence rate of the algorithm, and the larger the parameter is, the faster the convergence rate is represented.
9. The cooperative control apparatus according to any one of claims 6 to 8, wherein the control signal determination module specifically includes:
the second determination unit is used for setting the performance index to minimize the abrupt acceleration norm and determining a quadratic optimization result under the constraint of joint angle limit, joint speed limit, joint acceleration limit, joint abrupt acceleration limit and the Jacobian matrix equation;
the conversion unit is used for converting the quadratic optimization result into a standard quadratic programming;
the solving unit is used for solving the standard quadratic programming to obtain a solving result;
and the control signal determining unit is used for determining the control signal of the target redundant manipulator according to the solving result.
10. The cooperative control apparatus according to claim 8, wherein the quadratic form employed by the control signal determination module is optimized as:
minimizing the first pattern under a first constraint;
the first constraint includes:
jacobian equation constraints
Joint angle limit constraint
Joint velocity limit constraints
Joint acceleration limit constraint
Constraint condition of joint sudden increase degree limit
The first formula is
Wherein, superscript T represents the transpose of the matrix and vector;representing the upper and lower limits of the joint angle of the target redundant manipulator i;representing the upper and lower limits of the joint speed of the target redundant manipulator i,representing the upper and lower limits of the joint acceleration of the target redundant manipulator i,representing the upper and lower limits of the joint jerk of the target redundant manipulator i.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710084020.5A CN106926238B (en) | 2017-02-16 | 2017-02-16 | The cooperative control method and device of multi-redundant mechanical arm system based on impact degree |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710084020.5A CN106926238B (en) | 2017-02-16 | 2017-02-16 | The cooperative control method and device of multi-redundant mechanical arm system based on impact degree |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106926238A CN106926238A (en) | 2017-07-07 |
CN106926238B true CN106926238B (en) | 2019-06-14 |
Family
ID=59423172
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710084020.5A Expired - Fee Related CN106926238B (en) | 2017-02-16 | 2017-02-16 | The cooperative control method and device of multi-redundant mechanical arm system based on impact degree |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106926238B (en) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107398903B (en) * | 2017-09-04 | 2020-06-30 | 杭州电子科技大学 | Track control method for industrial mechanical arm execution end |
CN112605992A (en) * | 2020-12-09 | 2021-04-06 | 中山大学 | Method and device for controlling cyclic motion of double-arm robot |
CN112720481A (en) * | 2020-12-22 | 2021-04-30 | 中山大学 | Mechanical arm minimum motion planning and control method based on abrupt degree |
CN112621761B (en) * | 2020-12-24 | 2022-06-24 | 中国科学院重庆绿色智能技术研究院 | Communication time lag-oriented mechanical arm system multi-stage optimization coordination control method |
CN113442139B (en) * | 2021-06-29 | 2023-04-18 | 山东新一代信息产业技术研究院有限公司 | Robot speed control method and device based on ROS operating system |
CN114474066B (en) * | 2022-03-04 | 2024-02-20 | 全爱科技(上海)有限公司 | Intelligent humanoid robot control system and method |
CN115356920A (en) * | 2022-08-08 | 2022-11-18 | 深圳市优必选科技股份有限公司 | Single-leg jumping motion control method and device, readable storage medium and robot |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1426840A1 (en) * | 2002-12-02 | 2004-06-09 | United Technologies Corporation | Real-time quadratic programming for control of dynamical systems |
CN104281099A (en) * | 2014-10-28 | 2015-01-14 | 湘潭大学 | NURBS direct interpolation method and device with processing characteristics considered |
CN105538327A (en) * | 2016-03-03 | 2016-05-04 | 吉首大学 | Redundant manipulator repeated motion programming method based on abrupt acceleration |
CN105563490A (en) * | 2016-03-03 | 2016-05-11 | 吉首大学 | Fault tolerant motion planning method for obstacle avoidance of mobile manipulator |
CN106411206A (en) * | 2016-09-21 | 2017-02-15 | 北京精密机电控制设备研究所 | Master-slave type electromechanical servo cooperative motion control system |
-
2017
- 2017-02-16 CN CN201710084020.5A patent/CN106926238B/en not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1426840A1 (en) * | 2002-12-02 | 2004-06-09 | United Technologies Corporation | Real-time quadratic programming for control of dynamical systems |
CN104281099A (en) * | 2014-10-28 | 2015-01-14 | 湘潭大学 | NURBS direct interpolation method and device with processing characteristics considered |
CN105538327A (en) * | 2016-03-03 | 2016-05-04 | 吉首大学 | Redundant manipulator repeated motion programming method based on abrupt acceleration |
CN105563490A (en) * | 2016-03-03 | 2016-05-11 | 吉首大学 | Fault tolerant motion planning method for obstacle avoidance of mobile manipulator |
CN106411206A (en) * | 2016-09-21 | 2017-02-15 | 北京精密机电控制设备研究所 | Master-slave type electromechanical servo cooperative motion control system |
Also Published As
Publication number | Publication date |
---|---|
CN106926238A (en) | 2017-07-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106926238B (en) | The cooperative control method and device of multi-redundant mechanical arm system based on impact degree | |
CN106842907B (en) | Cooperative control method and device for multi-redundancy mechanical arm system | |
CN106826828B (en) | A kind of cooperative control method and device of multi-redundant mechanical arm system | |
Zhang et al. | RNN for perturbed manipulability optimization of manipulators based on a distributed scheme: A game-theoretic perspective | |
CN108326844B (en) | Motion planning method and device for optimizing operability of redundant manipulator | |
CN111531538B (en) | Consistency control method and device for multi-mechanical arm system under switching topology | |
Jin et al. | Perturbed manipulability optimization in a distributed network of redundant robots | |
CN109407520A (en) | The fault-tolerant consistency control algolithm of second order multi-agent system based on sliding mode control theory | |
CN110162035B (en) | Cooperative motion method of cluster robot in scene with obstacle | |
CN109032137B (en) | Distributed tracking control method for multi-Euler-Lagrange system | |
CN110286691B (en) | Multi-unmanned aerial vehicle formation control method based on linear differential inclusion | |
CN109986562A (en) | A kind of planar mechanical arm system and its distributing fault tolerant control method | |
CN111208829A (en) | Multi-mobile-robot formation method based on distributed preset time state observer | |
CN114527661A (en) | Collaborative formation method for cluster intelligent system | |
CN115431263A (en) | Multi-redundancy mechanical arm system cooperative control method under complex actuator fault | |
CN109079779B (en) | Multi-mobile mechanical arm optimal cooperation method based on terminal estimation and operation degree adjustment | |
CN115157262A (en) | Obstacle avoidance and optimization control method and system for joint-limited redundant mechanical arm and robot | |
CN117226849B (en) | Multi-mechanical arm self-adaptive sliding mode control method and system | |
Cook et al. | Experimental verification and algorithm of a multi-robot cooperative control method | |
CN111221318A (en) | Multi-robot state estimation method based on model predictive control algorithm | |
CN111844026A (en) | Event-triggered multi-robot distributed cooperative control method | |
Martinez et al. | On robust rendezvous for mobile autonomous agents | |
CN115903478A (en) | Dynamic event drive-based multi-robot fixed time consistency control method | |
CN110825092A (en) | Formation control method of multi-agent system | |
CN115903842A (en) | Multi-agent formation control method and system and electronic equipment |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20190614 Termination date: 20200216 |