Multi-robot collaboration system and implementation method
Technical Field
The invention belongs to the technical field of robots, and relates to a multi-robot cooperation system and an implementation method.
Background
In the current industrial application, for the production task of flexible large-scale loads, as a single robot cannot complete, the system cost problem is considered, and the design and manufacture of a large-scale robot capable of meeting various large-scale loads are impossible. The multi-robot system has the characteristics of strong load capacity, high flexibility, high reliability and the like, so that a cooperative system which uses multiple robots to cooperatively work and jointly bear load is provided. However, in the cooperative work of multiple robots, the capacity of each robot has a large difference, so that the problem of load distribution among the multiple robots is an important research problem of the coordination of the multiple robot systems.
The problem of load distribution of robots among high-load robots, the problem of dynamic moment of joints of each robot and the problem of stability of a moving process robot are all problems which are urgently needed to be solved at the present stage of the high-load robots. In the prior art, a plurality of documents focus on the coordination problem of two robots, discuss a master-slave control theory, take one robot as a master machine, the other robot as a slave machine, follow the motion of the master machine, focus on analyzing the delay of the slave machine following the motion of the master machine, but do not consider the problem that the capability of each robot is different under a large load, and the load distribution is uneven easily.
Disclosure of Invention
The invention aims at the problems existing in the prior art, and provides a multi-robot cooperation system which can adjust the posture and the position of a robot in the carrying process in real time and improve the coordination of a multi-robot assistance system.
The aim of the invention can be achieved by the following technical scheme:
the multi-robot cooperation system comprises a plurality of robots, wherein each robot is provided with a tail end clamp, and the multi-robot cooperation system is characterized in that each robot is also provided with a gesture/position controller, each tail end clamp is provided with a dynamometer, and each dynamometer is electrically connected with the corresponding gesture/position controller.
The multi-robot cooperation system is a system comprising two or more robots, wherein the robots can be small robots bearing low load, large robots bearing high load or the combination of the small robots and the large robots, end clamps are arranged on mechanical arms of the robots, when the multi-robot cooperation system works, the end clamps on the robots are used for fixing loads, dynamometers are arranged on the end clamps, the force born by the corresponding end clamps when the corresponding end clamps bear the loads can be measured, the measured values of the dynamometers are sent to gesture/position controllers, the gesture/position controllers control the corresponding robots according to the collected values of the forces, and the gesture/position controllers adjust the gesture and the position of the robots to enable the robots to be in an optimal working state. The multi-robot cooperation system can adjust the gesture and the position of the robot in the carrying process in real time, and the coordination and the stability of the multi-robot assistance system are improved.
In the multi-robot cooperation system, the terminal clamp comprises a base, a bottom plate and a plurality of damping rods, one end of each damping rod is fixedly connected with the base, the other end of each damping rod is fixedly connected with the bottom plate, and each damping rod is provided with the dynamometer. In this embodiment, the base is used for being connected with the terminal ring flange on the robot arm, and the bottom plate is used for being connected with the load.
In the multi-robot cooperation system, each damping rod comprises a damping connecting rod, two end parts of each damping connecting rod are respectively connected with a first universal joint and a second universal joint, each first universal joint is fixedly connected with the base, and each second universal joint is fixedly connected with the bottom plate. The first universal joint and the second universal joint can rotate, the corresponding bottom plate can be correspondingly adjusted in position according to the stress condition and the positions of the robots through the structure, the adjustment mode is fine adjustment, and all the robots can be in the optimal working state and the coordination among the robots is improved.
In the multi-robot cooperative system, a force measuring interface is arranged on the damping connecting rod. The force measuring interface is a plug interface, so that data in the force measuring meter can be conveniently transmitted.
In the multi-robot cooperation system, the multi-robot cooperation system further comprises a frame for mounting the robots. The robot can be conveniently installed through the frame, when the robot is a small robot bearing a low load, the small robot is installed on the frame, the overall height of the small robot can be increased, the robot can be matched with the large robot better, and the coordination of a system is improved.
Another object of the present invention is to provide a method for implementing a multi-robot collaboration system, where the purpose of the present invention can be achieved by the following technical scheme:
the method for realizing the multi-robot collaboration system is characterized by comprising the following steps:
A. fixing the load through the tail end clamp on each robot;
B. the force measuring meters on the end clamps measure the force values born by the corresponding end clamps when carrying the load, and respectively send the measured values to the gesture/position controller;
C. the posture/position controller controls the corresponding robot according to the collected numerical value of each force, and adjusts the posture and position of each robot.
Compared with the prior art, the invention has the following advantages:
1. the multi-robot cooperation system can adjust the gesture and the position of the robot in the carrying process in real time, and the coordination and the stability of the multi-robot assistance system are improved.
2. The multi-robot cooperation system can well solve the problem of errors of the tail ends in the coordinated movement of the multiple robots when processing high load.
Drawings
Fig. 1 is a schematic structural view of the multi-robot collaboration system.
Fig. 2 is a schematic structural view of the end clamp.
Fig. 3 is a schematic structural view of the damper rod.
Fig. 4 is a functional block diagram of the multi-robot collaboration system.
In the figure, 1, a robot; 2. an end clamp; 2a, a base; 2b, a bottom plate; 2c, a damping rod; 2c1, a damping connecting rod; 2c2, a first universal joint; 2c3, a second universal joint; 2c4, a force measuring interface; 3. a frame; 4. and (3) loading.
Detailed Description
The following are specific embodiments of the present invention and the technical solutions of the present invention will be further described with reference to the accompanying drawings, but the present invention is not limited to these embodiments.
As shown in fig. 1, the multi-robot cooperation system includes a plurality of robots 1, wherein each robot 1 is provided with a terminal fixture 2 on a mechanical arm, each robot 1 is further provided with a gesture/position controller, each terminal fixture 2 is provided with a dynamometer, and each dynamometer is electrically connected with a corresponding gesture/position controller.
As shown in fig. 2, in this embodiment, the end fixture 2 includes a base 2a, a bottom plate 2b, and a plurality of damping rods 2c, one end of each damping rod 2c is fixedly connected to the base 2a, the other end of each damping rod 2c is fixedly connected to the bottom plate 2b, and each damping rod 2c is provided with a load cell. In this embodiment, the base 2a is used for connecting with a terminal flange on a mechanical arm of the robot 1, and the bottom plate 2b is used for connecting with the load 4.
As another solution, the end fixture 2 may be replaced by another connecting piece, such as a spring, and the end of the mechanical arm is connected by using the spring, so as to reduce the increase of internal force between the robots 1 caused by the error of the end, avoid the instability of the system, and certainly use other force measuring modes to detect the end force.
As shown in fig. 3, preferably, each damping rod 2c includes a damping connecting rod 2c1, two end portions of each damping connecting rod 2c1 are respectively connected with a first universal joint 2c2 and a second universal joint 2c3, each first universal joint 2c2 is fixedly connected with the base 2a, and each second universal joint 2c3 is fixedly connected with the base plate 2 b. The first universal joint 2c2 and the second universal joint 2c3 can rotate, the corresponding base plate 2b can correspondingly adjust the position of the base plate 2b according to the stress condition and the position of the robot 1, the adjustment mode is fine adjustment, and each robot 1 can be in the optimal working state and the coordination between the two robots is improved.
As shown in fig. 3, the damper link 2c1 is preferably provided with a load port 2c4. The force measuring interface 2c4 is a plug interface, which is convenient for the data transmission in the force measuring meter.
As shown in fig. 1, in the present embodiment, the multi-robot cooperation system further includes a frame 3 for mounting the robot 1. Can make things convenient for the installation of robot 1 through frame 3, when robot 1 is the little robot 1 of bearing low load 4, little robot 1 installs in frame 3, can increase little robot 1's overall height, makes it can cooperate with big robot 1 better, improves the harmony of system.
As shown in fig. 4, the implementation method of the multi-robot collaboration system includes the following steps:
A. fixing the load 4 by the end clamps 2 on each robot 1;
B. the force measuring meter on each end clamp 2 measures the value of the force applied when the corresponding end clamp 2 bears the load 4, and sends the measured value to the gesture/position controller respectively;
C. the posture/position controller controls the corresponding robot 1 based on the values of the collected forces, and adjusts the posture and position of each robot 1.
In this embodiment, the number of robots 1 is two, during operation, the end jigs 2 on each robot 1 are used to fix the load 4, the load gauges provided on each end jig 2 can measure the force received by the corresponding end jigs 2 when carrying the load 4, each load gauge sends the measured values to the posture/position controller, and the posture/position controller controls the corresponding robot 1 according to the collected values of the forces, and adjusts the posture and position of each robot 1 so that each robot 1 is in an optimal operation state.
The specific embodiments described herein are offered by way of example only to illustrate the spirit of the invention. Those skilled in the art may make various modifications or additions to the described embodiments or substitutions thereof without departing from the spirit of the invention or exceeding the scope of the invention as defined in the accompanying claims.