CN113799143B - Safe cooperation method and device of multiple robots in working area - Google Patents

Abstract

The invention discloses a safe cooperation method and a safe cooperation device of multiple robots in a working area, which belong to the technical field of robot safety control, and comprise the following steps: acquiring first position coordinate information and first motion information of each robot; acquiring a second coordinate position and second motion information of the operation mechanical arm by taking the robot as an original point; acquiring a terminal coordinate position and terminal operation motion information; obtaining a first predicted relative distance and a second predicted relative distance based on first position coordinate information, first motion information, a tail end coordinate position and tail end operation motion information between two adjacent robots; performing collision risk prediction processing of safe cooperation to obtain a collision prediction risk result; and formulating a corresponding cooperative control instruction based on the collision prediction risk result to perform multi-robot safe cooperative control. According to the invention, the operation safety control of two adjacent robots can be realized when the robots work cooperatively.

Description

Safe cooperation method and device of multiple robots in working area

Technical Field

The invention relates to the technical field of robot safety control, in particular to a safety cooperation method and device of multiple robots in a working area.

Background

Under the rapid development of industrial intelligence, advanced robots are gradually introduced to achieve manual replacement in the traditional manufacturing industry, due to the development of technology and the requirement of work, a plurality of mobile robots work in cooperation with one another in the same working area, and at the moment, how to ensure the working safety of the mobile robots in cooperative work is achieved.

Disclosure of Invention

The invention aims to overcome the defects of the prior art, and provides a safe cooperation method and device of multiple robots in a working area, which can realize the operation safety control of two adjacent robots when the multiple robots work together.

In order to solve the technical problem, an embodiment of the present invention provides a method for secure collaboration of multiple robots in a work area, where the method includes:

acquiring first position coordinate information and first motion information of each robot in a working area, wherein the first motion information comprises first motion speed information and first motion direction information;

acquiring a second coordinate position and second motion information of a working mechanical arm of each robot by taking the robot as an origin during working, wherein the second motion information comprises second motion speed information and second motion direction information;

substituting the second coordinate position and the second motion information of the operation mechanical arm into the first position coordinate information and the first motion information of the robot corresponding to the operation mechanical arm to obtain the tail end coordinate position and the tail end operation motion information of the tail end of the operation mechanical arm in a working area, wherein the tail end operation motion information comprises tail end motion speed information and tail end motion direction information;

performing relative distance prediction calculation processing at the next moment based on the first position coordinate information, the first motion information, the tail end coordinate position and the tail end operation motion information between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots and a second predicted relative distance between the operation mechanical arms of the two adjacent robots;

performing safe cooperative collision risk prediction processing based on the first predicted relative distance and the second predicted relative distance to obtain a collision prediction risk result;

and formulating a corresponding cooperative control instruction based on the collision prediction risk result to perform multi-robot safe cooperative control.

Optionally, the acquiring first position coordinate information and first motion information of each robot in the working area includes:

establishing a three-dimensional coordinate system according to the working area, and acquiring first position coordinate information of each robot in the three-dimensional coordinate system in the working area;

and obtaining first motion information corresponding to each robot based on the built-in controller of each robot.

Optionally, the obtaining a second coordinate position and second motion information of the working mechanical arm of each robot using the robot as an origin during working includes:

and establishing a robot three-dimensional coordinate system by taking each robot as an original point, and acquiring a second coordinate position and second motion information of the operation mechanical arm by taking the corresponding robot as the original point during operation of each robot based on joint motion data of the operation mechanical arm during operation.

Optionally, the substituting the second coordinate position and the second motion information of the work robot arm into the first position coordinate information and the first motion information of the robot corresponding to the work robot arm to obtain the terminal coordinate position and the terminal work motion information of the terminal of the work robot arm in the work area includes:

and substituting the second coordinate position and the second motion information of the operation mechanical arm into the first position coordinate information and the first motion information of the robot corresponding to the operation mechanical arm to perform coordinate operation processing, and obtaining the tail end coordinate position and the tail end operation motion information of the tail end of the operation mechanical arm in a working area.

Optionally, the performing, at the next time, a relative distance prediction calculation process based on the first position coordinate information, the first motion information, the end coordinate position, and the end work motion information between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots and a second predicted relative distance between work arms of the two adjacent robots includes:

performing relative distance prediction calculation processing at the next moment based on the first position coordinate information and the first motion information between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots;

and performing relative distance prediction calculation processing at the next moment based on the terminal coordinate position and the terminal operation motion information between the working mechanical arms of the two adjacent robots to obtain a second predicted relative distance between the working mechanical arms of the two adjacent robots.

Optionally, the performing, based on the first position coordinate information and the first motion information between two adjacent robots, a relative distance prediction calculation process at a next time to obtain a first predicted relative distance between two adjacent robots includes:

performing prediction calculation processing on position coordinate information between two adjacent robots at the next moment based on first position coordinate information between the two adjacent robots, first movement speed information and first movement direction information in the first movement information, and obtaining predicted position coordinate information at the next moment between the two adjacent robots;

and calculating the predicted relative distance by using the coordinate information of the predicted position at the next moment between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots.

Optionally, the obtaining a second predicted relative distance between the working mechanical arms of two adjacent robots by performing relative distance prediction calculation processing at the next time based on the end coordinate position and the end work motion information between the working mechanical arms of two adjacent robots includes:

performing prediction calculation processing on the tail end position coordinate information between the adjacent working mechanical arms at the next moment based on the tail end position coordinate information between the working mechanical arms of the two adjacent robots, the tail end movement speed information and the tail end movement direction information in the tail end working movement information, and obtaining predicted tail end position coordinate information at the next moment between the working mechanical arms of the two adjacent robots;

and calculating the predicted relative distance by using the coordinate information of the predicted end position at the next moment between the working mechanical arms of the two adjacent robots to obtain a second predicted relative distance between the working mechanical arms of the two adjacent robots.

Optionally, the performing collision risk prediction processing of safe cooperation based on the first predicted relative distance and the second predicted relative distance to obtain a collision predicted risk result includes:

calculating the distance according to the first position coordinate information between two adjacent robots to obtain a first relative distance, and calculating the distance according to the tail end coordinate position between the mechanical arms of two adjacent robots to obtain a second relative distance;

obtaining a relative first motion trend based on a first relative distance and the first predicted relative distance, and obtaining a relative second motion trend based on a second relative distance and the second predicted relative distance;

and performing safe cooperative collision risk prediction processing according to the first movement trend and the second movement trend to obtain a collision prediction risk result.

Optionally, the formulating a corresponding cooperative control instruction based on the collision prediction risk result to perform multi-robot safety cooperative control includes:

formulating a cooperative control instruction between two adjacent robots based on the collision prediction risk result;

and performing safe cooperative control on two adjacent robots based on the cooperative control instruction.

In addition, the embodiment of the invention also provides a device for safely cooperating multiple robots in a working area, which comprises:

a first obtaining module: the robot motion control system is used for acquiring first position coordinate information and first motion information of each robot in a working area, wherein the first motion information comprises first motion speed information and first motion direction information;

a second obtaining module: the robot control system comprises a robot control unit, a first coordinate position acquisition unit, a second coordinate position acquisition unit, a first motion information acquisition unit and a second motion information acquisition unit, wherein the first coordinate position acquisition unit is used for acquiring a first coordinate position and a first motion information of a working mechanical arm of each robot in working, wherein the first motion information comprises first motion speed information and first motion direction information;

and substituting the module: the robot working system comprises a working mechanical arm, a robot, a first position coordinate information acquisition unit, a second position coordinate information acquisition unit, a first motion information acquisition unit and a second motion information acquisition unit, wherein the first position coordinate information acquisition unit is used for acquiring a first position coordinate information and a first motion information of the robot corresponding to the working mechanical arm;

a calculation module: the system comprises a first position coordinate information acquisition unit, a first motion information acquisition unit, a second position coordinate information acquisition unit, a second motion information acquisition unit, a second position coordinate information acquisition unit and a second motion information acquisition unit, wherein the first position coordinate information acquisition unit is used for acquiring a first position coordinate information of two adjacent robots;

a collision risk prediction module: collision risk prediction processing for performing safe cooperation based on the first predicted relative distance and the second predicted relative distance to obtain a collision prediction risk result;

a safety cooperation control module: and the system is used for formulating a corresponding cooperative control instruction based on the collision prediction risk result to carry out multi-robot safe cooperative control.

In the invention, when the multiple robots cooperatively work, the risk of collision between two adjacent robots, such as position, movement speed and movement direction, needs to be considered; therefore, collision risk prediction is realized according to the predicted relative distance between two adjacent robots, so that safety response control on multi-robot cooperative operation is realized, safety risk control can be effectively realized, collision risks between the adjacent robots are avoided, and the safety and flexibility of the multi-robot cooperative operation are improved.

Drawings

In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings used in the description of the embodiments or the prior art will be briefly described below, it is obvious that the drawings in the following description are only some embodiments of the present invention, and for those skilled in the art, other drawings can be obtained according to the drawings without creative efforts.

FIG. 1 is a flow chart illustrating a method for secure collaboration of multiple robots within a work area in an embodiment of the invention;

fig. 2 is a schematic structural diagram of a secure collaboration device of multiple robots in a work area according to an embodiment of the present invention.

Detailed Description

The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments 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.

Example one

Referring to fig. 1, fig. 1 is a flowchart illustrating a method for secure collaboration of multiple robots in a work area according to an embodiment of the present invention.

As shown in fig. 1, a method for secure collaboration of multiple robots within a work area, the method comprising:

s11: acquiring first position coordinate information and first motion information of each robot in a working area, wherein the first motion information comprises first motion speed information, first motion direction information and first motion track information;

in a specific implementation process of the present invention, the acquiring first position coordinate information and first motion information of each robot in a working area includes: establishing a three-dimensional coordinate system according to the working area, and acquiring first position coordinate information of each robot in the three-dimensional coordinate system in the working area; and obtaining first motion information corresponding to each robot based on a built-in controller of each robot, wherein the motion information comprises first motion speed information, first motion direction information and first motion track information.

Specifically, a working area for cooperative work of multiple robots (multiple robots which are movable) is determined, a three-dimensional coordinate system is established by using the working area, then the multiple robots in the area can be positioned in a visual positioning mode or a corresponding positioning sensor mode is arranged in the cooperative working area, and first position coordinate information of each robot in the three-dimensional coordinate system in the working area is obtained through the positioning; then, obtaining first motion information corresponding to each robot by calling control information in a controller built in the multiple robots, wherein the first motion information comprises first motion speed information, first motion direction information and first motion track information.

S12: acquiring a second coordinate position and second motion information of a working mechanical arm of each robot by taking the robot as an origin during working, wherein the second motion information comprises second motion speed information, second motion direction information and second motion track information;

in a specific implementation process of the present invention, the obtaining second coordinate positions and second motion information of the working mechanical arms of the robots using the robot as an origin during working includes: and establishing a robot three-dimensional coordinate system by taking each robot as an original point, and acquiring a second coordinate position and second motion information of the operation mechanical arm by taking the corresponding robot as the original point during operation of each robot based on joint motion data of the operation mechanical arm during operation.

Specifically, another three-dimensional coordinate system needs to be established by taking each robot as an origin, and then parameters and related data of joint motion of the working mechanical arm of each robot during working are combined to the three-dimensional coordinate system, so that a second coordinate position of the working mechanical arm of each robot during working by taking the corresponding robot as the origin can be obtained; meanwhile, second motion information corresponding to the joint motion parameters and the related data of the operation mechanical arm during operation can be obtained, wherein the second motion information comprises second motion speed information, second motion direction information and second motion track information; in the step, the coordinate calibration and positioning are carried out on the operation mechanical arm by adopting the mode, so that the deviation which is possibly generated when the coordinate positioning is carried out on the operation mechanical arm in a working area by utilizing visual positioning or sensor positioning can be solved; the method of the invention is adopted to carry out coordinate positioning on the operation mechanical arm, can realize coordinate positioning processing with higher precision, and is more beneficial to safe cooperative control of all rows.

S13: substituting the second coordinate position and the second motion information of the operation mechanical arm into the first position coordinate information and the first motion information of the robot corresponding to the operation mechanical arm to obtain the tail end coordinate position and the tail end operation motion information of the tail end of the operation mechanical arm in a working area, wherein the tail end operation motion information comprises tail end motion speed information, tail end motion direction information and tail end motion track information;

in a specific implementation process of the present invention, the substituting the second coordinate position and the second motion information of the work robot arm into the first position coordinate information and the first motion information of the robot corresponding to the work robot arm to obtain the end coordinate position and the end work motion information of the end of the work robot arm in the work area includes: and substituting the second coordinate position and the second motion information of the operation mechanical arm into the first position coordinate information and the first motion information of the robot corresponding to the operation mechanical arm to perform coordinate operation processing, and obtaining the tail end coordinate position and the tail end operation motion information of the tail end of the operation mechanical arm in a working area.

Specifically, because there is a correlation between the second coordinate position and the second motion information in the work robot arm and the first position coordinate information and the first motion information of the robot corresponding to the work robot arm, the second coordinate position and the second motion information are substituted into the first position coordinate information and the first motion information of the robot corresponding to the second coordinate position and the second motion information to perform coordinate operation processing, and the end coordinate position and the end work motion information of the end of the work robot arm in the work area can be obtained.

S14: performing relative distance prediction calculation processing at the next moment based on the first position coordinate information, the first motion information, the tail end coordinate position and the tail end operation motion information between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots and a second predicted relative distance between the operation mechanical arms of the two adjacent robots;

in a specific implementation process of the present invention, the performing a relative distance prediction calculation process at a next time based on the first position coordinate information, the first motion information, the end coordinate position, and the end work motion information between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots and a second predicted relative distance between work arms of the two adjacent robots includes: performing relative distance prediction calculation processing at the next moment based on the first position coordinate information and the first motion information between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots; and performing relative distance prediction calculation processing at the next moment based on the terminal coordinate position and the terminal operation motion information between the two adjacent robots to obtain a second predicted relative distance between the operation mechanical arms of the two adjacent robots.

Further, the obtaining a first predicted relative distance between two adjacent robots by performing a relative distance prediction calculation process at a next time based on the first position coordinate information and the first motion information between the two adjacent robots includes: performing prediction calculation processing on position coordinate information between two adjacent robots at the next moment based on first position coordinate information between the two adjacent robots, first movement speed information and first movement direction information in the first movement information, and obtaining predicted position coordinate information at the next moment between the two adjacent robots; and calculating the predicted relative distance by using the coordinate information of the predicted position at the next moment between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots.

Further, the obtaining a second predicted relative distance between the working mechanical arms of the two adjacent robots by performing relative distance prediction calculation processing at the next time based on the end coordinate position and the end work motion information between the working mechanical arms of the two adjacent robots includes: performing prediction calculation processing on the tail end position coordinate information between the adjacent working mechanical arms at the next moment based on the tail end position coordinate information between the working mechanical arms of the two adjacent robots, the tail end movement speed information and the tail end movement direction information in the tail end working movement information, and obtaining predicted tail end position coordinate information at the next moment between the working mechanical arms of the two adjacent robots; and calculating the predicted relative distance by using the coordinate information of the predicted end position at the next moment between the working mechanical arms of the two adjacent robots to obtain a second predicted relative distance between the working mechanical arms of the two adjacent robots.

Specifically, the relative distance at the next moment can be predicted and calculated through the first position coordinate information and the corresponding first motion information between two adjacent robots, and the first predicted relative distance between two adjacent robots can be obtained; and the relative distance at the next moment can be predicted and calculated through the terminal coordinate position and the terminal operation motion information between two adjacent robots, so that a second predicted relative distance between the operation mechanical arms of the two adjacent robots is obtained.

The method comprises the steps that first coordinate position information between two adjacent robots can be determined, then after first operation information of the two adjacent robots is determined, coordinate position information of the two adjacent robots at the next moment can be predicted, the first motion information comprises first motion speed information and first motion direction information, namely, the distance of the robot moving in unit time can be known by obtaining time t and first motion speed information v at the next moment, the distance of the robot moving in unit time in the release direction can be obtained according to the first motion direction information, and the predicted position coordinate information of the next moment between the two adjacent robots can be calculated in a substituted mode under the condition that the first coordinate position information is known; and then, the predicted relative distance is calculated by using the coordinate information of the predicted position at the next moment between two adjacent robots, so that the first predicted relative distance between the two adjacent robots is obtained.

Similarly, predicted end position coordinate information of the next moment between the working mechanical arms of the two adjacent robots can be calculated according to the end position coordinate information between the working mechanical arms of the two adjacent robots, the end movement speed information and the end movement direction information in the end working movement information, and then predicted relative distance calculation is performed by using the predicted end position coordinate information of the next moment between the working mechanical arms of the two adjacent robots, so that a second predicted relative distance between the working mechanical arms of the two adjacent robots is obtained.

S15: performing safe cooperative collision risk prediction processing based on the first real-time equivalent distance and the second real-time equivalent distance to obtain a collision prediction risk result;

in a specific implementation process of the present invention, the performing collision risk prediction processing of safe cooperation based on the first predicted relative distance and the second predicted relative distance to obtain a collision predicted risk result includes: calculating the distance according to the first position coordinate information between two adjacent robots to obtain a first relative distance, and calculating the distance according to the tail end coordinate position between the mechanical arms of two adjacent robots to obtain a second relative distance; obtaining a relative first motion trend based on a first relative distance and the first predicted relative distance, and obtaining a relative second motion trend based on a second relative distance and the second predicted relative distance; and performing safe cooperative collision risk prediction processing according to the first movement trend and the second movement trend to obtain a collision prediction risk result.

Specifically, a first relative distance is obtained by performing distance calculation according to first position coordinate information between two adjacent robots, and a second relative distance is obtained by performing distance calculation according to end coordinate positions between mechanical arms of two adjacent robots; then, a first movement trend is obtained by comparing the first relative distance with the first predicted relative distance, namely when the first relative distance is larger than the first predicted relative distance, the relative first movement trend can be regarded as a back-to-back movement trend; when the first relative distance is smaller than the first predicted relative distance, the relative first motion trend can be considered as a relative motion trend; when the first relative distance is equal to the first predicted relative distance, the relative first motion trend can be considered as a motion maintaining trend; in the same way, a relative second motion trend between the second relative distance and the second predicted relative distance can be obtained.

Then, performing safe cooperative collision risk prediction processing according to the first movement trend and the second movement trend, specifically, judging whether the first predicted relative distance is greater than or equal to a preset safe distance or not, and judging whether the second predicted relative distance is greater than or equal to the preset safe distance or not; under the condition that the first predicted relative distance is greater than or equal to the preset safety distance, when the first movement trend is a back-to-back movement trend or a movement maintaining trend, the collision prediction risk is safe, and when the first movement trend is a reverse movement trend, the collision prediction risk is dangerous; under the condition that the first prediction relative distance is smaller than the preset safety distance, when the first movement trend is a back-to-back movement trend, the collision prediction risk is safe, and when the first movement trend is a movement maintaining trend, the collision prediction risk is dangerous; when the first motion trend is a relative motion trend, the collision prediction risk is very dangerous; and similarly, performing safe cooperative collision risk prediction processing according to the second movement trend to obtain a collision prediction risk result.

S16: and formulating a corresponding cooperative control instruction based on the collision prediction risk result to perform multi-robot safe cooperative control.

In the specific implementation process of the invention, the step of formulating a corresponding cooperative control instruction based on the collision prediction risk result to perform multi-robot safe cooperative control comprises the following steps: formulating a cooperative control instruction between two adjacent robots based on the collision prediction risk result; and performing safe cooperative control on two adjacent robots based on the cooperative control instruction.

Specifically, a cooperative control instruction for controlling two adjacent robots can be formulated according to the collision prediction risk result; and performing safe cooperative control on two adjacent robots according to the cooperative control instruction; for example, under the condition that the collision prediction risk result is safe, a cooperative control instruction for controlling two adjacent robots is made to be an instruction for keeping the existing movement speed to move according to a preset path; under the condition that a collision prediction risk result is dangerous, making a cooperative control instruction for controlling two adjacent robots to reduce the existing movement speed and move according to a preset path; and under the condition that the collision prediction risk result is very dangerous, making a cooperative control instruction for controlling two adjacent robots as an instruction for immediately stopping the movement.

In the embodiment of the invention, when the multiple robots cooperatively work, the risk of whether the position, the movement speed, the movement direction and the like of two adjacent robots are possibly collided needs to be considered; therefore, collision risk prediction is realized according to the predicted relative distance between two adjacent robots, so that safety response control on multi-robot cooperative operation is realized, safety risk control can be effectively realized, collision risks between the adjacent robots are avoided, and the safety and flexibility of the multi-robot cooperative operation are improved.

Example two

Referring to fig. 2, fig. 2 is a schematic structural diagram of a security cooperation apparatus of multiple robots in a working area according to an embodiment of the present invention.

As shown in fig. 2, a device for secure collaboration of multiple robots within a work area, the device comprising:

the first acquisition module 21: the robot motion control system is used for acquiring first position coordinate information and first motion information of each robot in a working area, wherein the first motion information comprises first motion speed information and first motion direction information;

in a specific implementation process of the present invention, the acquiring first position coordinate information and first motion information of each robot in a working area includes: establishing a three-dimensional coordinate system according to the working area, and acquiring first position coordinate information of each robot in the three-dimensional coordinate system in the working area; and obtaining first motion information corresponding to each robot based on a built-in controller of each robot, wherein the motion information comprises first motion speed information, first motion direction information and first motion track information.

Specifically, a working area for cooperative work of multiple robots (multiple robots which are movable) is determined, a three-dimensional coordinate system is established by using the working area, then the multiple robots in the area can be positioned in a visual positioning mode or a corresponding positioning sensor mode is arranged in the cooperative working area, and first position coordinate information of each robot in the three-dimensional coordinate system in the working area is obtained through the positioning; then, obtaining first motion information corresponding to each robot by calling control information in a controller built in the multiple robots, wherein the first motion information comprises first motion speed information, first motion direction information and first motion track information.

The second acquisition module 22: the robot control system comprises a robot control unit, a first coordinate position acquisition unit, a second coordinate position acquisition unit, a first motion information acquisition unit and a second motion information acquisition unit, wherein the first coordinate position acquisition unit is used for acquiring a first coordinate position and a first motion information of a working mechanical arm of each robot in working, wherein the first motion information comprises first motion speed information and first motion direction information;

in a specific implementation process of the present invention, the obtaining second coordinate positions and second motion information of the working mechanical arms of the robots using the robot as an origin during working includes: and establishing a robot three-dimensional coordinate system by taking each robot as an original point, and acquiring a second coordinate position and second motion information of the operation mechanical arm by taking the corresponding robot as the original point during operation of each robot based on joint motion data of the operation mechanical arm during operation.

Specifically, another three-dimensional coordinate system needs to be established by taking each robot as an origin, and then parameters and related data of joint motion of the working mechanical arm of each robot during working are combined to the three-dimensional coordinate system, so that a second coordinate position of the working mechanical arm of each robot during working by taking the corresponding robot as the origin can be obtained; meanwhile, second motion information corresponding to the joint motion parameters and the related data of the operation mechanical arm during operation can be obtained, wherein the second motion information comprises second motion speed information, second motion direction information and second motion track information; in the step, the coordinate calibration and positioning are carried out on the operation mechanical arm by adopting the mode, so that the deviation which is possibly generated when the coordinate positioning is carried out on the operation mechanical arm in a working area by utilizing visual positioning or sensor positioning can be solved; the method of the invention is adopted to carry out coordinate positioning on the operation mechanical arm, can realize coordinate positioning processing with higher precision, and is more beneficial to safe cooperative control of all rows.

Substitution module 23: the robot working system comprises a working mechanical arm, a robot, a first position coordinate information acquisition unit, a second position coordinate information acquisition unit, a first motion information acquisition unit and a second motion information acquisition unit, wherein the first position coordinate information acquisition unit is used for acquiring a first position coordinate information and a first motion information of the robot corresponding to the working mechanical arm;

in a specific implementation process of the present invention, the substituting the second coordinate position and the second motion information of the work robot arm into the first position coordinate information and the first motion information of the robot corresponding to the work robot arm to obtain the end coordinate position and the end work motion information of the end of the work robot arm in the work area includes: and substituting the second coordinate position and the second motion information of the operation mechanical arm into the first position coordinate information and the first motion information of the robot corresponding to the operation mechanical arm to perform coordinate operation processing, and obtaining the tail end coordinate position and the tail end operation motion information of the tail end of the operation mechanical arm in a working area.

Specifically, because there is a correlation between the second coordinate position and the second motion information in the work robot arm and the first position coordinate information and the first motion information of the robot corresponding to the work robot arm, the second coordinate position and the second motion information are substituted into the first position coordinate information and the first motion information of the robot corresponding to the second coordinate position and the second motion information to perform coordinate operation processing, and the end coordinate position and the end work motion information of the end of the work robot arm in the work area can be obtained.

The calculation module 24: the system comprises a first position coordinate information acquisition unit, a first motion information acquisition unit, a second position coordinate information acquisition unit, a second motion information acquisition unit, a second position coordinate information acquisition unit and a second motion information acquisition unit, wherein the first position coordinate information acquisition unit is used for acquiring a first position coordinate information of two adjacent robots;

in a specific implementation process of the present invention, the performing a relative distance prediction calculation process at a next time based on the first position coordinate information, the first motion information, the end coordinate position, and the end work motion information between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots and a second predicted relative distance between work arms of the two adjacent robots includes: performing relative distance prediction calculation processing at the next moment based on the first position coordinate information and the first motion information between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots; and performing relative distance prediction calculation processing at the next moment based on the terminal coordinate position and the terminal operation motion information between the two adjacent robots to obtain a second predicted relative distance between the operation mechanical arms of the two adjacent robots.

Further, the obtaining a first predicted relative distance between two adjacent robots by performing a relative distance prediction calculation process at a next time based on the first position coordinate information and the first motion information between the two adjacent robots includes: performing prediction calculation processing on position coordinate information between two adjacent robots at the next moment based on first position coordinate information between the two adjacent robots, first movement speed information and first movement direction information in the first movement information, and obtaining predicted position coordinate information at the next moment between the two adjacent robots; and calculating the predicted relative distance by using the coordinate information of the predicted position at the next moment between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots.

Further, the obtaining a second predicted relative distance between the working mechanical arms of the two adjacent robots by performing relative distance prediction calculation processing at the next time based on the end coordinate position and the end work motion information between the working mechanical arms of the two adjacent robots includes: performing prediction calculation processing on the tail end position coordinate information between the adjacent working mechanical arms at the next moment based on the tail end position coordinate information between the working mechanical arms of the two adjacent robots, the tail end movement speed information and the tail end movement direction information in the tail end working movement information, and obtaining predicted tail end position coordinate information at the next moment between the working mechanical arms of the two adjacent robots; and calculating the predicted relative distance by using the coordinate information of the predicted end position at the next moment between the working mechanical arms of the two adjacent robots to obtain a second predicted relative distance between the working mechanical arms of the two adjacent robots.

Specifically, the relative distance at the next moment can be predicted and calculated through the first position coordinate information and the corresponding first motion information between two adjacent robots, and the first predicted relative distance between two adjacent robots can be obtained; and the relative distance at the next moment can be predicted and calculated through the terminal coordinate position and the terminal operation motion information between two adjacent robots, so that a second predicted relative distance between the operation mechanical arms of the two adjacent robots is obtained.

The method comprises the steps that first coordinate position information between two adjacent robots can be determined, then after first operation information of the two adjacent robots is determined, coordinate position information of the two adjacent robots at the next moment can be predicted, the first motion information comprises first motion speed information and first motion direction information, namely, the distance of the robot moving in unit time can be known by obtaining time t and first motion speed information v at the next moment, the distance of the robot moving in unit time in the release direction can be obtained according to the first motion direction information, and the predicted position coordinate information of the next moment between the two adjacent robots can be calculated in a substituted mode under the condition that the first coordinate position information is known; and then, the predicted relative distance is calculated by using the coordinate information of the predicted position at the next moment between two adjacent robots, so that the first predicted relative distance between the two adjacent robots is obtained.

Similarly, predicted end position coordinate information of the next moment between the working mechanical arms of the two adjacent robots can be calculated according to the end position coordinate information between the working mechanical arms of the two adjacent robots, the end movement speed information and the end movement direction information in the end working movement information, and then predicted relative distance calculation is performed by using the predicted end position coordinate information of the next moment between the working mechanical arms of the two adjacent robots, so that a second predicted relative distance between the working mechanical arms of the two adjacent robots is obtained.

Collision risk prediction module 25: collision risk prediction processing for performing safe cooperation based on the first predicted relative distance and the second predicted relative distance to obtain a collision prediction risk result;

in a specific implementation process of the present invention, the performing collision risk prediction processing of safe cooperation based on the first predicted relative distance and the second predicted relative distance to obtain a collision predicted risk result includes: calculating the distance according to the first position coordinate information between two adjacent robots to obtain a first relative distance, and calculating the distance according to the tail end coordinate position between the mechanical arms of two adjacent robots to obtain a second relative distance; obtaining a relative first motion trend based on a first relative distance and the first predicted relative distance, and obtaining a relative second motion trend based on a second relative distance and the second predicted relative distance; and performing safe cooperative collision risk prediction processing according to the first movement trend and the second movement trend to obtain a collision prediction risk result.

Specifically, a first relative distance is obtained by performing distance calculation according to first position coordinate information between two adjacent robots, and a second relative distance is obtained by performing distance calculation according to end coordinate positions between mechanical arms of two adjacent robots; then, a first movement trend is obtained by comparing the first relative distance with the first predicted relative distance, namely when the first relative distance is larger than the first predicted relative distance, the relative first movement trend can be regarded as a back-to-back movement trend; when the first relative distance is smaller than the first predicted relative distance, the relative first motion trend can be considered as a relative motion trend; when the first relative distance is equal to the first predicted relative distance, the relative first motion trend can be considered as a motion maintaining trend; in the same way, a relative second motion trend between the second relative distance and the second predicted relative distance can be obtained.

Then, performing safe cooperative collision risk prediction processing according to the first movement trend and the second movement trend, specifically, judging whether the first predicted relative distance is greater than or equal to a preset safe distance or not, and judging whether the second predicted relative distance is greater than or equal to the preset safe distance or not; under the condition that the first predicted relative distance is greater than or equal to the preset safety distance, when the first movement trend is a back-to-back movement trend or a movement maintaining trend, the collision prediction risk is safe, and when the first movement trend is a reverse movement trend, the collision prediction risk is dangerous; under the condition that the first prediction relative distance is smaller than the preset safety distance, when the first movement trend is a back-to-back movement trend, the collision prediction risk is safe, and when the first movement trend is a movement maintaining trend, the collision prediction risk is dangerous; when the first motion trend is a relative motion trend, the collision prediction risk is very dangerous; and similarly, performing safe cooperative collision risk prediction processing according to the second movement trend to obtain a collision prediction risk result.

The secure collaboration control module 26: and the system is used for formulating a corresponding cooperative control instruction based on the collision prediction risk result to carry out multi-robot safe cooperative control.

In the specific implementation process of the invention, the step of formulating a corresponding cooperative control instruction based on the collision prediction risk result to perform multi-robot safe cooperative control comprises the following steps: formulating a cooperative control instruction between two adjacent robots based on the collision prediction risk result; and performing safe cooperative control on two adjacent robots based on the cooperative control instruction.

Specifically, a cooperative control instruction for controlling two adjacent robots can be formulated according to the collision prediction risk result; and performing safe cooperative control on two adjacent robots according to the cooperative control instruction; for example, under the condition that the collision prediction risk result is safe, a cooperative control instruction for controlling two adjacent robots is made to be an instruction for keeping the existing movement speed to move according to a preset path; under the condition that a collision prediction risk result is dangerous, making a cooperative control instruction for controlling two adjacent robots to reduce the existing movement speed and move according to a preset path; and under the condition that the collision prediction risk result is very dangerous, making a cooperative control instruction for controlling two adjacent robots as an instruction for immediately stopping the movement.

In the embodiment of the invention, when the multiple robots cooperatively work, the risk of whether the position, the movement speed, the movement direction and the like of two adjacent robots are possibly collided needs to be considered; therefore, collision risk prediction is realized according to the predicted relative distance between two adjacent robots, so that safety response control on multi-robot cooperative operation is realized, safety risk control can be effectively realized, collision risks between the adjacent robots are avoided, and the safety and flexibility of the multi-robot cooperative operation are improved.

Those skilled in the art will appreciate that all or part of the steps in the methods of the above embodiments may be implemented by associated hardware instructed by a program, which may be stored in a computer-readable storage medium, and the storage medium may include: a Read Only Memory (ROM), a Random Access Memory (RAM), a magnetic or optical disk, or the like.

In addition, the method and the device for the secure collaboration of multiple robots in a working area provided by the embodiment of the present invention are described in detail above, a specific example should be used herein to explain the principle and the implementation manner of the present invention, and the description of the above embodiment is only used to help understanding the method and the core idea of the present invention; meanwhile, for a person skilled in the art, according to the idea of the present invention, there may be variations in the specific embodiments and the application scope, and in summary, the content of the present specification should not be construed as a limitation to the present invention.

Claims (8)

1. A method for secure collaboration of multiple robots within a work area, the method comprising:

acquiring first position coordinate information and first motion information of each robot in a working area, wherein the first motion information comprises first motion speed information and first motion direction information;

acquiring a second coordinate position and second motion information of a working mechanical arm of each robot by taking the robot as an origin during working, wherein the second motion information comprises second motion speed information and second motion direction information;

substituting the second coordinate position and the second motion information of the operation mechanical arm into the first position coordinate information and the first motion information of the robot corresponding to the operation mechanical arm to obtain the tail end coordinate position and the tail end operation motion information of the tail end of the operation mechanical arm in a working area, wherein the tail end operation motion information comprises tail end motion speed information and tail end motion direction information;

performing relative distance prediction calculation processing at the next moment based on the first position coordinate information, the first motion information, the tail end coordinate position and the tail end operation motion information between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots and a second predicted relative distance between the operation mechanical arms of the two adjacent robots;

performing safe cooperative collision risk prediction processing based on the first predicted relative distance and the second predicted relative distance to obtain a collision prediction risk result;

formulating a corresponding cooperative control instruction based on the collision prediction risk result to carry out multi-robot safe cooperative control;

the collision risk prediction processing for performing safe cooperation based on the first predicted relative distance and the second predicted relative distance to obtain a collision predicted risk result includes:

calculating the distance according to the first position coordinate information between two adjacent robots to obtain a first relative distance, and calculating the distance according to the tail end coordinate position between the mechanical arms of two adjacent robots to obtain a second relative distance; obtaining a relative first motion trend based on a first relative distance and the first predicted relative distance, and obtaining a relative second motion trend based on a second relative distance and the second predicted relative distance; performing safe cooperative collision risk prediction processing according to the first movement trend and the second movement trend to obtain a collision prediction risk result;

firstly, judging whether the first predicted relative distance is greater than or equal to a preset safety distance or not, and judging whether the second predicted relative distance is greater than or equal to the preset safety distance or not; under the condition that the first predicted relative distance is greater than or equal to the preset safety distance, when the first movement trend is a back-to-back movement trend or a movement maintaining trend, the collision prediction risk is safe, and when the first movement trend is a reverse movement trend, the collision prediction risk is dangerous; under the condition that the first prediction relative distance is smaller than the preset safety distance, when the first movement trend is a back-to-back movement trend, the collision prediction risk is safe, and when the first movement trend is a movement maintaining trend, the collision prediction risk is dangerous; when the first motion trend is a relative motion trend, the collision prediction risk is very dangerous; in the same way, collision risk prediction processing of safe cooperation is carried out according to the second movement trend, and a collision prediction risk result can be obtained;

the step of formulating a corresponding cooperative control instruction based on the collision prediction risk result to carry out multi-robot safety cooperative control comprises the following steps:

formulating a cooperative control instruction between two adjacent robots based on the collision prediction risk result; performing safe cooperative control on two adjacent robots based on the cooperative control instruction;

under the condition that the collision prediction risk result is safe, making a cooperative control instruction for controlling two adjacent robots to be an instruction for keeping the existing movement speed to move according to a preset path; under the condition that a collision prediction risk result is dangerous, making a cooperative control instruction for controlling two adjacent robots to reduce the existing movement speed and move according to a preset path; and under the condition that the collision prediction risk result is very dangerous, making a cooperative control instruction for controlling two adjacent robots as an instruction for immediately stopping the movement.

2. The secure collaboration method of claim 1, wherein the obtaining of the first position coordinate information and the first motion information of each robot in the work area comprises:

establishing a three-dimensional coordinate system according to the working area, and acquiring first position coordinate information of each robot in the three-dimensional coordinate system in the working area;

and obtaining first motion information corresponding to each robot based on the built-in controller of each robot.

3. The safe cooperation method according to claim 1, wherein the obtaining of the second coordinate position and the second motion information of the working arm with the robot as an origin of the working arm of each robot during the working includes:

and establishing a robot three-dimensional coordinate system by taking each robot as an original point, and acquiring a second coordinate position and second motion information of the operation mechanical arm by taking the corresponding robot as the original point during operation of each robot based on joint motion data of the operation mechanical arm during operation.

4. The safe cooperation method according to claim 1, wherein the obtaining of the end coordinate position and the end work movement information of the end of the work robot in the work area by substituting the second coordinate position and the second movement information of the work robot into the first position coordinate information and the first movement information of the robot corresponding to the work robot comprises:

and substituting the second coordinate position and the second motion information of the operation mechanical arm into the first position coordinate information and the first motion information of the robot corresponding to the operation mechanical arm to perform coordinate operation processing, and obtaining the tail end coordinate position and the tail end operation motion information of the tail end of the operation mechanical arm in a working area.

5. The safety cooperation method according to claim 1, wherein the obtaining of the first predicted relative distance between two adjacent robots and the second predicted relative distance between working arms of the two adjacent robots by performing the relative distance prediction calculation processing at the next time based on the first position coordinate information, the first motion information, the end coordinate position, and the end work motion information between the two adjacent robots includes:

performing relative distance prediction calculation processing at the next moment based on the first position coordinate information and the first motion information between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots;

and performing relative distance prediction calculation processing at the next moment based on the terminal coordinate position and the terminal operation motion information between the working mechanical arms of the two adjacent robots to obtain a second predicted relative distance between the working mechanical arms of the two adjacent robots.

6. The safety cooperation method according to claim 5, wherein the obtaining of the first predicted relative distance between two adjacent robots by performing a relative distance prediction calculation process at the next time based on the first position coordinate information and the first motion information between the two adjacent robots includes:

performing prediction calculation processing on position coordinate information between two adjacent robots at the next moment based on first position coordinate information between the two adjacent robots, first movement speed information and first movement direction information in the first movement information, and obtaining predicted position coordinate information at the next moment between the two adjacent robots;

and calculating the predicted relative distance by using the coordinate information of the predicted position at the next moment between two adjacent robots to obtain a first predicted relative distance between the two adjacent robots.

7. The safe cooperation method according to claim 5, wherein the obtaining of the second predicted relative distance between the working arms of the two adjacent robots by performing the relative distance prediction calculation processing at the next time based on the end coordinate position and the end working movement information between the working arms of the two adjacent robots includes:

performing prediction calculation processing on the tail end position coordinate information between the adjacent working mechanical arms at the next moment based on the tail end position coordinate information between the working mechanical arms of the two adjacent robots, the tail end movement speed information and the tail end movement direction information in the tail end working movement information, and obtaining predicted tail end position coordinate information at the next moment between the working mechanical arms of the two adjacent robots;

and calculating the predicted relative distance by using the coordinate information of the predicted end position at the next moment between the working mechanical arms of the two adjacent robots to obtain a second predicted relative distance between the working mechanical arms of the two adjacent robots.

8. A secure collaboration apparatus for multiple robots within a work area, the apparatus comprising:

a first obtaining module: the robot motion control system is used for acquiring first position coordinate information and first motion information of each robot in a working area, wherein the first motion information comprises first motion speed information and first motion direction information;

a second obtaining module: the robot control system comprises a robot control unit, a first coordinate position acquisition unit, a second coordinate position acquisition unit, a first motion information acquisition unit and a second motion information acquisition unit, wherein the first coordinate position acquisition unit is used for acquiring a first coordinate position and a first motion information of a working mechanical arm of each robot in working, wherein the first motion information comprises first motion speed information and first motion direction information;

and substituting the module: the robot working system comprises a working mechanical arm, a robot, a first position coordinate information acquisition unit, a second position coordinate information acquisition unit, a first motion information acquisition unit and a second motion information acquisition unit, wherein the first position coordinate information acquisition unit is used for acquiring a first position coordinate information and a first motion information of the robot corresponding to the working mechanical arm;

a calculation module: the system comprises a first position coordinate information acquisition unit, a first motion information acquisition unit, a second position coordinate information acquisition unit, a second motion information acquisition unit, a second position coordinate information acquisition unit and a second motion information acquisition unit, wherein the first position coordinate information acquisition unit is used for acquiring a first position coordinate information of two adjacent robots;

a collision risk prediction module: collision risk prediction processing for performing safe cooperation based on the first predicted relative distance and the second predicted relative distance to obtain a collision prediction risk result;

a safety cooperation control module: the system is used for formulating a corresponding cooperative control instruction based on the collision prediction risk result to carry out multi-robot safety cooperative control;

the collision risk prediction processing for performing safe cooperation based on the first predicted relative distance and the second predicted relative distance to obtain a collision predicted risk result includes:

calculating the distance according to the first position coordinate information between two adjacent robots to obtain a first relative distance, and calculating the distance according to the tail end coordinate position between the mechanical arms of two adjacent robots to obtain a second relative distance; obtaining a relative first motion trend based on a first relative distance and the first predicted relative distance, and obtaining a relative second motion trend based on a second relative distance and the second predicted relative distance; performing safe cooperative collision risk prediction processing according to the first movement trend and the second movement trend to obtain a collision prediction risk result;

firstly, judging whether the first predicted relative distance is greater than or equal to a preset safety distance or not, and judging whether the second predicted relative distance is greater than or equal to the preset safety distance or not; under the condition that the first predicted relative distance is greater than or equal to the preset safety distance, when the first movement trend is a back-to-back movement trend or a movement maintaining trend, the collision prediction risk is safe, and when the first movement trend is a reverse movement trend, the collision prediction risk is dangerous; under the condition that the first prediction relative distance is smaller than the preset safety distance, when the first movement trend is a back-to-back movement trend, the collision prediction risk is safe, and when the first movement trend is a movement maintaining trend, the collision prediction risk is dangerous; when the first motion trend is a relative motion trend, the collision prediction risk is very dangerous; in the same way, collision risk prediction processing of safe cooperation is carried out according to the second movement trend, and a collision prediction risk result can be obtained;

the step of formulating a corresponding cooperative control instruction based on the collision prediction risk result to carry out multi-robot safety cooperative control comprises the following steps:

formulating a cooperative control instruction between two adjacent robots based on the collision prediction risk result; performing safe cooperative control on two adjacent robots based on the cooperative control instruction;

under the condition that the collision prediction risk result is safe, making a cooperative control instruction for controlling two adjacent robots to be an instruction for keeping the existing movement speed to move according to a preset path; under the condition that a collision prediction risk result is dangerous, making a cooperative control instruction for controlling two adjacent robots to reduce the existing movement speed and move according to a preset path; and under the condition that the collision prediction risk result is very dangerous, making a cooperative control instruction for controlling two adjacent robots as an instruction for immediately stopping the movement.

Images