Calibrating a system with a conveying means and at least one robot
10940590 · 2021-03-09
Assignee
Inventors
- Thomas Purrucker (Munich, DE)
- Robert Miller (Scheuring, DE)
- Ralf Mittmann (Mering, DE)
- Daniele Sagnotti (Augsburg, DE)
- Manuela Hauschild (Aindling, DE)
- Benno Eichner (Schöngeising, DE)
- Stephan Clair (Lauingen, DE)
- Felix Lückert (Augsburg, DE)
- Markus Hager (Augsburg, DE)
- Maximilian Lindner (Kissing, DE)
Cpc classification
Y02P90/02
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
G05B2219/39022
PHYSICS
B25J9/0093
PERFORMING OPERATIONS; TRANSPORTING
International classification
G05B19/418
PHYSICS
Abstract
A method for calibrating a system with a conveying apparatus and at least a first robot includes determining the positions of at least three measuring points of a first component transported by the conveying apparatus in a first transport position using the first robot. The method further includes determining the position of at least one of the measuring points in a second transport position using the first robot, or determining the positions of at least two of the measuring points of the component in a third transport position and the position of at least one other measuring point in the third transport position or at least one of these measuring points in a fourth transport position using at least one second robot.
Claims
1. A method for calibrating a system with a translational conveying means and at least a first robot, the method comprising: determining with the first robot the positions of at least three measuring points of a first measuring point system transported via curvilinear translation by the conveying means in a first transport position; at least one of: A) determining the position of at least one of the measuring points in a second transport position with the first robot, or B) determining with at least one second robot of the system: (i) the positions of at least two measuring points of the first measuring point system in a third transport position, and (ii) the position of at least one other measuring point in the third transport position, or at least one of the measuring points in a fourth transport position; and calibrating at least one measuring point system associated with the robot, the conveying means, or a component transported by the conveying means based on the determination.
2. The method of claim 1, wherein at least one of: determining the positions of at least three measuring points in the first transport position comprises determining the positions of exactly three measuring points; the first measuring point system is a measuring point system of a component transported by the conveying means; determining the position of at least one of the measuring points in a second transport position comprises determining exactly one of the measuring points; determining the positions of at least two measuring points in the third transport position comprises determining the positions of exactly two measuring points; determining the position of at least one other measuring point in the third transport position comprises determining the position of exactly one other measuring point; or determining the position of at least one of the measuring points in the fourth transport position comprises determining the position of exactly one of the measuring points.
3. The method of claim 1, further comprising determining at least one of: a transformation between a conveying means base-fixed coordinate system and a robot-fixed coordinate system of the first robot; or a transformation between a measuring point system-fixed coordinate system of the first measuring point system and a conveying means base-fixed coordinate system of the first robot; wherein the transformation is determined on the basis of at least four positions determined with the first robot.
4. The method of claim 3, wherein at least one of: the measuring point system-fixed coordinate system is a component-fixed coordinate system; or the transformation is determined on the basis of exactly four positions determined with the first robot.
5. The method of claim 1, further comprising: determining a transformation between a robot-fixed coordinate system and a conveying means base-fixed coordinate system of the second robot on the basis of at least three positions determined with the second robot.
6. The method as of claim 1, further comprising: determining a transformation between a measuring point system-fixed coordinate system of the first measuring point system or another measuring point system transported by the conveying means, and a conveying means base-fixed coordinate system of the second robot; wherein the transformation is determined based on a transformation between the measuring point system-fixed coordinate system of the measuring point system and one of: a conveying means base-fixed coordinate system of the first robot, or a measuring point system-fixed coordinate system of a second measuring point system and the first robot.
7. The method of claim 6, wherein at least one of: at least one of the measuring point system-fixed coordinate systems is a component-fixed coordinate system; or at least one of the measuring point systems is a component transported by the conveying means.
8. The method of claim 1, further comprising calibrating a transport position determining means for determining transport positions on the basis of the position, determined by the first robot, of at least one of the measuring points in the first transport position and in at least one of the second, third, or fourth transport positions.
9. The method of claim 1, further comprising: modifying a transport position determining means for determining transport positions; determining at least one measuring point system-fixed coordinate system of a measuring point system and the first robot using the modified transport position determining means; and determining a transformation between the measuring point system-fixed coordinate system of the respective measuring point system and a conveying means base-fixed coordinate system of the second robot on the basis of the determined measuring point system-fixed coordinate system of the measuring point system and the first robot.
10. The method of claim 9, wherein at least one of: at least one of the measuring point system-fixed coordinate systems is a component-fixed coordinate system; or at least one of the measuring point systems is a component transported by the conveying means.
11. The method of claim 1, further comprising: exchanging the second robot with a third robot; determining a transformation between a measuring point system-fixed coordinate system of a measuring point system transported by the conveying means and a conveying means base-fixed coordinate system of the first robot; and determining a transformation between a conveying means base-fixed coordinate system and a robot-fixed coordinate system of the third robot on the basis of the determined transformation between the measuring point system-fixed coordinate system and the conveying means base-fixed coordinate system of the first robot.
12. The method of claim 11, wherein at least one of: the measuring point system-fixed coordinate system is a component-fixed coordinate system; or the measuring point system is a component transported by the conveying means.
13. The method of claim 1, wherein transport positions are determined on the basis of a detected movement of the conveying means relative to a synchronization position.
14. The method of claim 13, wherein the synchronization position is determined on the basis of a detection of the corresponding measuring point system transported by the conveying means.
15. The method of claim 14, wherein the measuring point system is a component transported by the conveying means.
16. The method of claim 1, wherein at least one of the first measuring point system or another measuring point system is a measuring point arrangement that is permanently connected to the conveying means and having measuring points arranged on the conveying means or a calibration component; wherein at least one of: the measuring points are at least one of geometrically or optically defined, or the orientation and position of the measuring point system transverse to a direction of transport of the conveying means corresponds to a component to be transported by the conveying means and to be at least one of handled or machined by robots of the system.
17. The method of claim 16, wherein the measuring point arrangement is integrally formed with the conveying means.
18. A system for handling and/or machining components transported by a conveying means of the system, by robots of the system, the system comprising a controller configured for carrying out the method of claim 1.
19. A computer program product having a program code stored on a non-transitory, computer-readable storage medium, the program code, when executed by one or more processors, causes the one or more processors to: determine with a first robot the positions of at least three measuring points of a first measuring point system transported via curvilinear translation by translational conveying means associated with the first robot in a first transport position; at least one of: A) determine the position of at least one of the measuring points in a second transport position with the first robot, or B) determine with at least one second robot: i) the positions of at least two measuring points of the first measuring point system in a third transport position, and ii) the position of at least one other measuring point in the third transport position, or at least one of the measuring points in a fourth transport position; and calibrate at least one measuring point system associated with the first robot, the second robot, the conveying means, or a component transported by the conveying means based on the determination.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate exemplary embodiments of the invention and, together with a general description of the invention given above, and the detailed description given below, serve to explain the principles of the present invention.
(2)
(3)
(4)
(5)
DETAILED DESCRIPTION
(6)
(7) The invention is described below by way of example with reference to the two robots and types of component; it goes without saying that analogous to the one second robot, additional (second) robots and/or, analogous to the one second component, additional (second) components may also be present; the and/or their orientation and/or position perpendicular to the direction of transport of the conveyor belt differ/differs from that or those of the first and a second component(s), where in this case the features described herein can be realized in the same way even for these additional robots and/or components.
(8) In a step illustrated in
(9) Calibration component W1 has three measuring points P.sub.1, 1, P.sub.1, 2, and P.sub.1, 3, which are geometrically defined in such a way that they can be probed by the robots 10, 20 with precision. As an alternative, one of the first components can also be used directly. As an alternative, the measuring points can also be arranged or formed on the conveyor belt itself; or a measuring point system, formed integrally with the conveyor belt, can be used.
(10) A camera of a transport position determining means 40 is used for capturing, as soon as the calibration plate W1 passes a synchronization position, indicated in
(11) In this case, in the position shown in
(12) In a step shown in
(13) On the basis of these positions, a controller 11 of the first robot 10 defines a component-fixed coordinate system W11(.sub.a) of the calibration plate W1 and the first robot, with the origin of said coordinate system lying at the point P.sub.1, 1; with the X axis of said coordinate system passing through the point P.sub.1, 2; with the Z axis of said coordinate system being perpendicular to the plane of transport, defined by the points P.sub.1, 1, 1, 2 and P.sub.1, 3; and with said coordinate system being indicated by x.sub.W11, y.sub.W11.
(14) In a step shown in
(15) On the basis of the positions p.sub.1, 1 (.sub.a), p.sub.1, 1 (.sub.b) and p.sub.1, 2 (.sub.a) or p.sub.1, 3 (.sub.a) the controller 11 defines a conveying means base-fixed coordinate system C1 of the first robot, with the X axis of said coordinate system passing through the positions p.sub.1, 1 (.sub.a), p.sub.1, 1 (.sub.b) and, thus, aligned with the direction of transport; with the Z axis of said coordinate system being perpendicular to the transport plane, defined by three of the positions p.sub.1, 1 (.sub.a), p.sub.1, 1 (.sub.b), p.sub.1, 2 (.sub.a) and p.sub.1, 3 (.sub.a); with the origin of said coordinate system lying, for example, in the positions p.sub.1, 1 (.sub.a) or p.sub.1, 1 (.sub.b); and said coordinate being indicated by means of x.sub.C1, y.sub.C1.
(16) In addition, a rotary encoder transmission ratio of the encoder of the transport position determining means 40 is calibrated on the basis of the position p.sub.1, 1 (.sub.a), determined by means of the first robot 10, of the measuring point P.sub.1, 1 in the one transport position and on the basis of the position p.sub.1, 1 (.sub.b), determined by means of the first robot 10, of the same measuring point P.sub.1, 1 in the other transport position: by determining the positions of the same measuring point in the one and in the other transport position it is possible to determine, in particular, a (transport) distance, traveled by the measuring point P.sub.1, 1 and, thus, also by the conveying means 30. By comparing this (transport) distance with the angle of rotation , which the rotary encoder of the transport position determining means 40 has detected between the one and the other transport position, it is possible to determine a rotary encoder transmission ratio between the (transport) distance of the conveying means 30 and the angle of rotation of the rotary encoder of the transport position determining means 40: [|p.sub.1, 1 (.sub.b)p.sub.1, 1 (.sub.a)|/]
(17) Subsequently, the component-fixed coordinate system W11 of the calibration plate W1 and the first robot is rotated by .sub.a, i.e., displaced into the synchronization position (W11=W11 (=0)), in the direction opposite to the X axis of the coordinate system C1, so that later in operation the origin of the component-fixed coordinate system is in the synchronous position after the synchronization switch has been triggered, and determines the transformations T.sub.R1, C1 between the conveying means base-fixed coordinate system C1 and the robot-fixed coordinate system R1 as well as T.sub.C1, W11 between the component-fixed coordinate system W11 and the conveying means base-fixed coordinate system C1.
(18) It can be seen that advantageously both coordinate systems C1, W11 or transformations T.sub.R1, C1, T.sub.C1, W11 are determined advantageously on the basis of only four determined positions p.sub.1, 1 (.sub.a), p.sub.1, 1 (.sub.b), p.sub.1, 2 (.sub.a) and p.sub.1, 3 (.sub.a).
(19) In a step illustrated in
(20) On the basis of the positions p.sub.1, 1 (.sub.c), p.sub.1, 1 (.sub.d) and p.sub.1, 2 (.sub.c) or p.sub.1, 3 (.sub.c) a controller 21 of the second robot 20 defines a conveying means base-fixed coordinate system C2 of the second robot, with the X axis of said coordinate system passing through the positions p.sub.1, 1 (.sub.c), p.sub.1, 1 (.sub.d) and, as a result, is aligned with the direction of transport; with the Z axis of said coordinate system being perpendicular to the transport plane, defined by three of the positions p.sub.1, 1 (.sub.c), p.sub.1, 1 (.sub.d), p.sub.1, 2 (.sub.c) and p.sub.1, 3 (.sub.c); and with the origin of said coordinate system being, for example, in the position p.sub.1, 1 (.sub.c) or p.sub.1, 1 (.sub.d); and said coordinate system is indicated by x.sub.C2, y.sub.C2.
(21) A transformation T.sub.C2, W12 between this conveying means base-fixed coordinate system C2 of the second robot 20 and a component-fixed coordinate system W12 of the calibration plate W1 and the second robot 20 is determined by the controller 21 on the basis of the transformation T.sub.C1, W11 between the conveying means base-fixed coordinate system C1 of the first robot 10 and the component-fixed coordinate system W11 of the calibration plate W1 and the first robot 10. For this purpose the controller 11 transmits the (parameters of) T.sub.C1, W11 to the controller 21, which is connected or communicates with said controller by data technology.
(22) Since the two coordinate systems C1, C2 of the first and second robot are displaced relative to each other only along their aligned X axis, the rotation into the component-fixed coordinate system or the transformation T.sub.C1, W11 can be applied directly or unchanged. The component-fixed coordinate system W12 of the calibration plate W1 and the second robot 20 is also displaced relative to the X axis of the coordinate system C2 into the synchronization position; this displacement can also be determined, in the same manner as the displacement of the coordinate systems C1, C2, directly from the transport positions.
(23) If in a modification the origin of the conveying means base-fixed coordinate system C2 of the second robot 20 and the origin of the conveying means base-fixed coordinate system C1 of the first robot 10 coincide, since, for example, the coordinate system C2 has been moved correspondingly (.sub.a/b.sub.c/d) relative to the X axis of the coordinate system C2 into the origin of the coordinate system C1, then the transformation T.sub.C1, W12 can be applied even completely directly or unchanged (T.sub.C2, W12=T.sub.C1, W11).
(24) It can be seen that both coordinate systems C2, W12 or transformations T.sub.R2, C2, T.sub.C2, W12 are determined advantageously on the basis of only three determined positions p.sub.1, 1 (.sub.c), p.sub.1, 1 (.sub.d) and p.sub.1, 2 (.sub.c) or p.sub.1, 3 (.sub.c) and the transmitted transformation T.sub.C1, W11 between the conveying means base-fixed coordinate system C1 of the first robot 10 and the component-fixed coordinate system W11 of the calibration plate W1 and the first robot 10.
(25)
(26) In an analogous manner, explained above with reference to W1 and
(27) In an analogous manner explained above with reference to W11, W12 and
(28) Similarly, the controller 11 can determine then the transformation T.sub.W1, W21 between the two component-fixed coordinate systems W11, W21 and the first robot, for example, according to T.sub.W11, W21=T.sub.C1, W21 (T.sub.C1, W11).sup.1. This transformation can be transmitted by the controller 11 to the controller 21, which can easily determined therefrom and the already determined transformation T.sub.C2, W12 the transformation T.sub.C2, W22, for example, according to T.sub.C2, W22=T.sub.W11, W21 T.sub.C2, W12.
(29) It can be seen that advantageously a new component, in the example explained above, has to calibrate, as an example, the second component or its corresponding calibration plate W2, only for or by the first robot 10; and the transformations between the conveying means base-fixed and the component-fixed coordinate system of the other robot, in the example explained above, as an example, the second robot 20, are determined on the basis of the transformations between the two component-fixed coordinate systems W11, W21 and the first robot. Instead of this transformation T.sub.W11, W21, it is also possible for the transformation T.sub.C1, W21 to be transmitted to the controller 21, which can determine from this in turn the transformation T.sub.C2, W22 in the manner explained above.
(30) If the second robot 20 is exchanged with a third robot, then the positions p.sub.1, 1 (.sub.a), p.sub.1, 2 (.sub.a) and p.sub.1, 3 (.sub.a) are determined, in an analogous manner explained above with reference to
(31) The distance between these two transport positions .sub.a, .sub.c corresponds to the distance between the two transport positions .sub.a, .sub.c, at which the positions p.sub.1, 1 (.sub.a), p.sub.1, 2 (.sub.a) and p.sub.1, 3 (.sub.a) were determined by means of the first robot, and the positions p.sub.1, 1 (.sub.c) and p.sub.1, 2 (.sub.c) or p.sub.1, 3 (.sub.c) were determined (.sub.c.sub.a=.sub.c.sub.a) by means of the exchanged second robot, so that the displacement of the two conveying means base-fixed coordinate systems of the original and of the exchanged robot to the conveying means base-fixed coordinate system of the first robot remains the same. In one embodiment the original transport positions were stored for this purpose.
(32) The controller 11 determines on the basis of the positions p.sub.1, 1 (.sub.a), p.sub.1, 2 (.sub.a) and p.sub.1, 3 (.sub.a), in the manner explained above, a component-fixed coordinate system W11, on the basis of which a transformation T.sub.C1, W11 between this component-fixed coordinate system W11 and the conveying means base-fixed coordinate system C1 of the first robot, and transmits this transformation T.sub.C1, W11 (or its parameters) to the controller of the new, third robot. Said controller determines, on the basis of the positions p.sub.1, 1 (.sub.c), p.sub.1, 2 (.sub.c) and p.sub.1, 3 (.sub.c), in the manner explained above, a component-fixed coordinate system W12; from this the transformation T.sub.R2, W12 between the component-fixed coordinate system W12 and the coordinate system R2 of the new robot, and therefrom the transformation T.sub.R2, C2 between a robot-fixed coordinate system R2 and the corresponding conveying means base-fixed coordinate system C2 of the new robot, for example, according to T.sub.R2, C2=(T.sub.C1, W11).sup.1 T.sub.R2, W12, provided the coordinate systems C1, C2 match.
(33) It can be seen that advantageously when exchanging a robot only its conveying means base-fixed coordinate system is recalibrated in a simple manner.
(34) If the camera 40 is exchanged, then this corresponds to a modification of the transport position determining means, since another synchronization position is defined by the exchanged camera.
(35) Therefore, in such a case, in an analogous manner explained above with reference to
(36) In an analogous manner explained above with reference to W11, W12 and
(37) For this purpose, in particular, the controller 11 can determine then, in an analogous manner explained above, for each calibration plate respectively the transformation T.sub.W11, W11 or T.sub.W21, W21 between the two component-fixed coordinate systems and the first robot for the old and new synchronization position: T.sub.W11, W11=T.sub.C1, W11 (T.sub.C1, W11).sup.1 or T.sub.W12, W12=T.sub.C1, W12 (T.sub.C1, W12).sup.1. This transformation can be transmitted by the controller 11 to the controller 21, which can determine therefrom and the already determined transformation T.sub.C2, W12 or T.sub.C2, W22 in a simple way the transformations T.sub.C2, W12, T.sub.C2, W22: T.sub.C2, W12=T.sub.W11, W11 T.sub.C2, W12 or T.sub.C2, W22=T.sub.W21, W21 T.sub.C2, W22. Similarly the controller 11 can also transmit the transformations T.sub.C1, W11, T.sub.C1, W21 to the controller 21.
(38) It can be seen that advantageously when modifying the transport position determining means only the component-fixed coordinate systems of the first robot are recalibrated.
(39) Although exemplary embodiments have been explained in the foregoing description, it should be pointed out that a variety of modifications are possible. It should also be noted that the exemplary embodiments are merely examples that are not intended to limit the scope of protection, the applications and the configuration in any way. Instead, the preceding description gives the skilled person a guide for the implementation of at least one exemplary embodiment, where in this case various changes, in particular, with regard to the function and arrangement of the described components, can be made without departing from the scope of protection, which will become apparent from the claims and combinations of features equivalent thereto.
(40) While the present invention has been illustrated by a description of various embodiments, and while these embodiments have been described in considerable detail, it is not intended to restrict or in any way limit the scope of the appended claims to such detail. The various features shown and described herein may be used alone or in any combination. Additional advantages and modifications will readily appear to those skilled in the art. The invention in its broader aspects is therefore not limited to the specific details, representative apparatus and method, and illustrative example shown and described. Accordingly, departures may be made from such details without departing from the spirit and scope of the general inventive concept.
LIST OF REFERENCE NUMERALS AND SYMBOLS
(41) TABLE-US-00001 10 first robot 11 robot controller of the first robot 20 second robot 21 robot controller of the second robot 30 conveyor belt 40 transport position determining means (camera, encoder) P.sub.i, j measuring point j of the calibration body Wi Wi calibration plate (component) .sub.(a, a , a, b, c, c, d) transport position(s) T.sub.Ri, Ci transformation between robot-fixed and conveying means base-fixed coordinate system of the i. robot T.sub.Ci, Wji transformation between conveying means base- fixed and component-fixed coordinate system of the component j and the i. robot