Patent Application
20050027394
The invention relates to a method for controlling a first robot and at least one other robot, the at least one other robot is calibrated relative to the first robot by determining a coordinate transformation of the first robot relative to the other robot and said transformation is stored in a control device of the other robot, as well as a system for controlling a first robot and at least one other robot with a device for calibrating at least one other robot relative to the first robot by determining a coordinate transformation of the first robot relative to the other robot and with a memory means in the control device of the other robot for storing this transformation.
U.S. Pat. No. 6,330,493 B1 relates to the coordinated or cooperative operation of a plurality of robots. In such an operation one of the robots functions as master robot and the other as slave robots. For this purpose, by calibration, a transformation matrix between the robots is determined, in that e.g. in the world coordinate system of a first robot the position of another robot is determined. According to this document the transformation determining the position of the first robot in the world coordinate system of the second robot is the inverted, first-mentioned transformation, so that the transformation only has to be determined once, e.g. that of the other robot in the system of the first robot and the inverted transformation can be used for determining the first robot in the system of the second robot, without a further determination being necessary. This academic approach implies in the same way that in the case of three robots the third robot only has to be determined in the coordinate system of one of the two robots, e.g. the second robot and all the other coordinate transformations can be obtained mathematically from the determined one.
As a result of robot kinematics this academic approach is incorrect, because the transformation of one robot relative to another cannot be simply inverted in order to determine a precise transformation of the other robot relative to the first robot. This more particularly applies when operating robots under a load, because there is then a significant deflection of up to 10 mm in the case of certain robots and this is also dependent on the location of a robot within the working area.
In addition, the calibration of a robot in the system of another robot normally takes place in such a way that the robots move to up to three positions in the area not located on a line and the positions are determined in the given coordinate systems of the robots and subsequently from the three position data the transformation of one robot relative to the other is calculated.
If for calibration purposes use is made of a fourth position of each robot, then an overdetermination occurs, as a result of which by iterative optimization the roots of the sum of the squares (L2 standardization) of the given 12 vector (3 coordinates of 4 points) implying the difference between the locations of the components of the coordinate system of one robot and the transformed coordinate components of the four points of the other robot is minimized. This gives a nonlinear equation with several minima. Thus, the robots can find different local minima, so that in this case the transformation are from a first robot to another is not necessarily the inverse of the transformation from the other robot to the first.
The problem of the invention is to provide a method and a system by means of which the control of cooperating robots is improved and can be optimized for all the partial regions of their common operating areas.
According to the invention this problem is solved by a method of the aforementioned type, which is further on characterized in that also the first robot is calibrated relative to the other robot by the determination of at least one independent coordinate transformation and said at least one independent transformation is stored in a control device of the first robot. For solving the said problem the invention also provides a system for controlling robots, having a determination device for calibrating the first robot relative to the other robot by the determination of at least one independent coordinate transformation of at least one other robot relative to the first robot and by a memory device in a control device of the first robot for storing at least one independent transformation.
According to a preferred variant of the invention, in the case of at least three robots, each robot is calibrated relative to the others by at least one independent determination of coordinate transformations and the at least one transformation of the calibration of each robot is stored in a control device thereof or that in the case of at least three robots, each of the robots has in its control device a means for the calibration thereof relative to each of the other robots by determining at least one coordinate transformation with respect to each of the other robots, as well as a memory means for storing the in each case at least one coordinate transformation.
In a preferred development of the method according to the invention, for each robot several calibrations are performed each at different positions, and the thus obtained transformations are stored. This implies that the calibration of one robot relative to the other robot takes place at another, different position to the calibration of the other robot relative to the first robot. This also implies that for different positions and therefore different operating regions in each case individual calibrations or determinations of the coordinate transformations can be performed for each robot.
In a further preferred development of the inventive method, in the case of cooperating operation of at least two robots, the coordinates of the independent robot and the coordinates transformed relative thereto of the independent robot or robots are used and in particular in operating area-dependent manner the coordinates of one robot and the coordinates transformed relative thereto of one or more other robots are used. Whereas in principle both systems in the coordinate system of the independent robot and consequently the independent robot or robots operate in the transformed coordinate system obtained from the coordinate system of the independent robot, in operating area-dependent manner it is also possible despite maintaining the feature as an independent robot, such an independently operating robot can operate with the coordinate system obtained from the transformation of the coordinate system of a dependently operating robot and the corresponding dependently operating robot operates in its original coordinate system—as well as optionally further dependently operating robots in their transformed coordinate system obtained from the original coordinate system of the one dependent robot.
In a further preferred development of the method according to the invention, in the case of cooperating operation of at least two robots, as desired, one of the robots can be used as an independent robot and the at least one other robot as a dependent robot and in particular during an operating process the characteristic of the robots as independent or dependent robots is changed.
In a preferred embodiment the system according to the invention is implemented for the performance of the above-defined method variants.
The invention makes it possible in the case of cooperating operation of the robots not only to use the robot as an independent robot and also at least one other as a dependent robot, but also to use an appropriate coordinate system according to which one of the robots is the independent robot and the other is the dependent robot also dependent of operating areas, in which the position differences resulting from real technology are minimized and the use of different positions is avoided for mathematical reasons. The invention makes the following possible: When two or more robots cooperate, one robot A can be independent with another robot B dependent on robot A. In this case, robot B uses a transformation obtained by its calibration to robot A. When robot B becomes the independent and robot A is then dependent on robot B, robot A uses a transformation obtained by its calibration to robot B. One transformations are more precise because they take into account the physical area of operation where the robots cooperate. Calibration was performed in the region of cooperation.
It is also possible in the first case to operate in certain operating areas with the coordinate systems of the second robot and also the transformed system of the second robot obtained therein by the calibration of the first robot, because the thus determined positions in such partial areas are more precise than when operating in the world coordinate system of the first robot and the transformation thereof to the second robot.
The same applies for cooperative operation of more than two robots, in which each can be used as an independent robot and for specific partial areas of the cooperation of robots it is possible to assume a suitable world coordinate system of one of the cooperating robots.
Due to the fact that the calibration of each of the robots takes place relative to each other robot and is stored in the control device of the correspondingly calibrated robot, according to the invention independently determined transformations are stored, which can be different from the in each case inverted transformations.
Thus, each robot can obtain its measurements from different positions. Multiple local regions for each pair of two robots can be calibrated in each direction.
The invention is decided below with reference to embodiments in the drawing.
a to 6c shows flow diagrams of the movement of the robots when gripping and transferring an object.
Each of the two cooperating robots A, B has a control device A.1 or B.1, which implies a device A.2, B.2 for calibrating one robot (A, B) in the coordinate system of the other robot (A, B) and for determining the corresponding coordinate transforms robot B.regioni.transform, robot A.regioni.transform in regions i=1,2. . . (represented in the form of continuous line arrows) and a storage device A.3, B.3 for storing the corresponding coordinate transforms robot B.regioni.transform, robot A.regioni.transform (illustrated by broken line arrows).
In
Known calibration tools A.4, B.4 are mounted to the face-plates of each robot.
First robot A is calibrated to robot B in region 1. In a first step calibration is initiated from robot A. Then robot A is jogged into region 1. Robot A is jogged so that its calibration tool tip touches Robot B's calibration tool tip. The current position of Robot A is stored and the current position of Robot B is sent to Robot A. This procedure is repeated for three other positions in region 1. Standardized algorithms are employed to calculated the transform from robot A to robot B. The fourth point is used for iterative optimization. The transform is stored on the controller for robot A as robot B.regionl.transform={x,y,z,a,b,c}.
Subsequently other calibrations having identical procedures for robot A to robot B in regions 2 and 3 are performed resulting in transforms robotB.region2.transform and robot B.region3.transform and for robot B to robot A in regions 1 to 3 are performed resulting in transforms robot A.region1.transform, robotA.region2.transform and robotA. region3.transform.
When robot A is calibrated to robot B in region 1 and robot B is calibrated to robot A in region 1, different calibration points can be used because each calibration is performed separately.
Once the robots are calibrated to each other, frames of reference relative to the opposite robot are created so that the robots can spatially cooperate or link. Here a frame is a transform. In
Programmed positions are defined relative to frames. A position defined relative to the robot's world frame represents a location and orientation that are fixed with respect to the robot base. A position defined relative to any of the PartInGripper frames is relative to the position of Robot A. As the robot moves, so does the frame and the position.
The calibrations made are used with cooperting robots as follows:
Robot A starts as the independent robot and moves from region 1 to region 2 to region 3. Robot B is dependent on robot A and will follow robot A in all three regions. The programmed motion essentially specifies the region.
First robot a picks up a part and moves it moves into region 1 (step A of
Robot B moves to a programmed position relative to PartInGripper-1 frame. For this motion, the controller must determine what PartIn-Gripper-1 frame is relative to (Bb1). During setup, this frame was assigned to be relative to robot A.region1. This causes B to link to A (Bb3), crating a dependency on robot A as described in the coopending U.S. patent application Ser.No. 10/406,521 of Apr. 3, 2003 “Method and Control System for controlling a Plurality of Robots” to Kenneth A. Stoddard et. al. The actually linking process involves communications between the robots. The programs on both rendezvous when “linked” (Ac, Bc). Robot A moves within Region 1. Robot B follows (Ad, Bd). The programs on both rendezvous to signify they are ready to unlink (Ae, Be). Robot B moves to a position ultimately relative to its own world frame (Be1). The link is broken by this motion command as described in the above mentioned application Ser. 10/406,521 a Robot B is no longer dependent on robot A (Af, Bf). The programs on both robot rendezvous when unlinked. The program continues in exactly the same fashion for the two other regions, except the calibration for each region is based on the PartInGripper frame used. PartInGripper-2 frame is relative to a robot A in region 2, so the calibration data RobotA.Region2.Transform is used when a link is performed in region 2—likewise for region 3. This is given in flow diagrampats
Since a load can cause different amounts of deflection based on the position of the robot, calibration can to do this, the calibration procedure must be performed with the load in place. This way the deflection occurs and the calibration includes the deflection.
