EP0378554A1 - Procede et dispositif de correction de la position des bras de robots industriels - Google Patents
Procede et dispositif de correction de la position des bras de robots industrielsInfo
- Publication number
- EP0378554A1 EP0378554A1 EP19880907301 EP88907301A EP0378554A1 EP 0378554 A1 EP0378554 A1 EP 0378554A1 EP 19880907301 EP19880907301 EP 19880907301 EP 88907301 A EP88907301 A EP 88907301A EP 0378554 A1 EP0378554 A1 EP 0378554A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- measuring
- robot arm
- drive
- connecting element
- laser beam
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Withdrawn
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1638—Programme controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/404—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39176—Compensation deflection arm
Definitions
- the present invention relates to a method for correcting the position of a free end of a robot arm, in particular deflected by bending and / or torsion from its desired position, by means of a displacement measuring system, the robot arm being a continuation of at least one joint or a corresponding base Has connecting element, and wherein the deflection from the target position at the end of the connecting element is measured with the aid of an energy beam emanating from an energy radiator arranged at the other end of the connecting element of the robot arm and as a function of the measured deflection of the robot arm into the target position is automatically readjusted, according to patent .... (patent application P 36 14 122.4-32).
- the invention also relates to a robot arm consisting of at least one joint or a corresponding base, at least one connecting element which is arranged downstream of the joint or the base, and at least one displacement measuring system for measuring deflections of the connecting element, the displacement measuring system has at least one energy radiator arranged on or in the upstream joint at the beginning of the connecting element and at least one measuring field at the other end of the connecting element, preferably in or on a downstream joint, according to the patent (patent application P 36 14 122.4-32).
- the path measuring system proposed in the main patent and integrated into the robot arm has proven itself extremely well, since deflections of the robot arm, e.g. can be caused by torsion of the gear and / or bending deformations of the connecting elements, can be corrected, and the end of the arm can be guided exactly into the desired position.
- the present invention is based on the object of further improving the proposed method and the proposed robot arm with regard to the tracking accuracy, but the robot arm should still be of simple construction and thus be inexpensive.
- this is achieved in that the energy beam is guided by means of an essentially unloaded measuring drive on the basis of the predetermined target value.
- This advantageously results in the tracking or position correction of the robot arm in its target position All deformations of the actual, loaded arm drive caused by the load are also taken into account.
- the robot arm according to the invention is characterized in that the energy radiator is arranged at an output of an essentially unloaded measuring drive and is movable relative to the joint or the connecting element.
- the measuring drive can be formed by an unloaded model gear, which is arranged parallel to a main gear of a common drive.
- the measuring drive can also be formed by an unloaded measuring drive system of a separate position control loop. Because the measuring drive is practically unloaded, it can be formed from mechanically very simple but nevertheless very precise, small-scale components. This contributes to the desired simple design of the robot arm.
- 1 is a schematic side view of part of a robot arm
- FIG. 2 shows a schematic block diagram of a first embodiment of a tracking control according to the invention
- Fig. 3 is a schematic block diagram of a second
- FIG. 4 is a schematic side view of part of a robot arm with a device for tracking a power laser beam and
- FIG. 5 shows a schematic block diagram of a control of the tracking device according to FIG. 4.
- the joint 1 shows part of a robot arm with a joint 1 and a connecting element 2, wherein in practice a robot arm can have a plurality of joints 1 and a connecting element 2 between two joints 1 in each case.
- a robot hand (not shown) is usually arranged at the end of the last joint 1.
- the joint 1 is a self-sufficient unit consisting of two drive systems, one of the drive systems allowing rotations about an axis 3 in the double arrow direction 4 and the other drive system allowing swivel movements about a swivel axis in the double arrow direction 5 perpendicular to the plane of the drawing.
- the exact structure of the joint 1 is e.g. described in EP-OS 85 11 40 49.1 and therefore need not be explained in the context of the present application.
- the robot arm is equipped with an integrated measuring system, which measures deflections at the end of the robot arm or the connecting element 2 caused by bending and / or torsion caused by the load. Depending on the measured deflection, the robot arm or the connecting element 2 is automatically readjusted to its target position.
- a related method and a robotic arm for performing the method are in the
- the measuring system has an energy radiator, in particular a laser radiator 6, which transmits an energy or laser beam 7 in the direction of the distal end of the connecting element 2, where a measuring field 8 is arranged.
- the laser beam 7 strikes a defined center of the measuring field 8.
- the measuring field 8 is able to generate, on the basis of the deviations, output signals ⁇ ⁇ and / or ⁇ ⁇ which correspond to pivoting deviations and / or torsional deviations of the arm. Based on these output signals, the robot arm is automatically readjusted to the desired position in accordance with the procedure of the main patent.
- the laser emitter 6 is now guided over an unloaded measuring drive, so that all deformations of the actual, loaded arm drive caused by the load are also taken into account when the robot arm is readjusted to the desired position.
- the measuring drive is formed according to the invention by an unloaded, highly precise model gear 11, at the output of which the laser emitter 6 is arranged.
- This embodiment is particularly suitable for robotic arms which predominantly work statically.
- the model of transmission 11 is mechanically connected in parallel to a main gear 12, both gears 11 and 12 are driven by a common drive. 13
- the main transmission 12 is in contrast to the model transmission 11 loaded by the swivel arm to be driven or the connecting element 2.
- both transmissions 11 and 12 have the same transmission ratio.
- the model gearbox can be both a purely mechanical gearbox and the gearbox of an angle measuring system, for example the gearbox of an absolute encoder.
- the common drive 13 of model and main transmission 11, 12 has a drive control 14 (speed control) in a manner known per se. If deformations now occur in the loaded part, ie in the main gear 12 and / or the connecting element 2, the measuring field 8 fixedly arranged at the end of the connecting element 2 determines a difference ⁇ , which is added to the target value ⁇ sol . This sum T soll + ⁇ ⁇ is fed to the drive 13 as a corrected setpoint, which thus adjusts the robot arm or the respective connecting element 2 into the corrected setpoint position X soll + ⁇ via the main gear 12. The difference _ ⁇ remains as long as deformations or deviations occur, since the drive 13, together with the main transmission 12, also moves the model transmission 11 and thus also the laser emitter 6.
- a mirror system 15 - here, for example, a prism - is arranged at the output of the model transmission 11 and serves to carry a power laser beam 16 through the joint 1.
- the power laser beam 16 is positioned according to the invention by the mirror system 15 for laser beam processing methods (e.g. welding, cutting, etc.), which is moved via the model gear 11 together with the laser emitter 6, in an extremely precise and advantageous manner while compensating for load-related deviations of the robot arm or the connecting element 2, specifically with the determined deviation
- the mirror system 15 is formed, for example, as a partially transparent prism and, instead of the laser emitter 6, a deflecting mirror is used which deflects the out-coupled partial beam of the power laser beam 16 as a measuring beam 7 in the direction of the measuring field 8.
- a deflecting mirror is used which deflects the out-coupled partial beam of the power laser beam 16 as a measuring beam 7 in the direction of the measuring field 8.
- the measuring drive according to the invention is formed by an unloaded measuring drive system 21 of a separate position control circuit 22.
- the measuring drive system 21 is preferably followed by its own high-resolution angle measuring system 23, the output of which is arranged the laser emitter 6.
- the laser emitter 6 can also advantageously be arranged on the output side of the motor 21.
- the mirror system 15 can also be arranged at the output of the angle measuring system 23, analogously to the embodiment according to FIG. 2 described above. However, it is also advantageous to arrange the mirror system 15 on the driven side of the motor 21.
- part of the power laser beam 16 can be coupled out and used as a measuring beam 7.
- the separate, essentially unloaded position control circuit 22 is separate from the loaded drive system of the robot arm or the connecting element 2, consisting of the drive 13 and the main gear 12, but on the same "basis” or arranged at the same "reference point" of the joint 1, the drive here also having the drive control 14, as is known.
- a target value f c ⁇ a X 1 is the Meßantriebs- System 21 predetermined, which "starts up” and aligns the measuring laser beam 7 and possibly also the power laser beam 16 in the desired target position via the position control loop 22.
- the measuring laser beam 7 moves out of the center of the measuring field 8, so that the latter a difference signal corresponding to the deviation ⁇ ⁇ & __ & ug ⁇ r which is fed to the drive 13, and which causes the robot arm or the connecting element 2 with the Measuring field 8 is "tracked” via the main transmission 12 until the measuring laser beam 7 hits the defined center of the measuring field 8 again and thus the difference A ⁇ ⁇ zv. Becomes "zero".
- the target position of the end of the robot arm or the connecting element 2 is always exactly reached, even if deformations (twists, bends) occur within the main gear 12 and / or the robot arm or connecting element 2.
- Figs. 4 and 5 is illustrated an advantageous further development 'of the invention.
- the robot arm or its loaded drive is relatively sluggish compared to the unloaded measuring drive, ie positional deviations of the arm are compensated for during a certain transition period, which can be approximately i • range from 20 to 30 ms, by "tracking" the arm.
- a further mirror system 15a is arranged, which, according to the invention, is movably guided in such a way that, in accordance with the correction variable f measured in each case, if the joint la deviates from its desired position (for example by bends of the connecting element 2) the power laser beam 16 is nevertheless deflected exactly into its desired orientation.
- the measuring laser beam 7 is also used for this control (see FIG. 5).
- a movable slide 25 is arranged in or on the downstream joint 1 a, which can be moved by a fast drive 26, preferably on a circular path 27 with a radius corresponding to the distance between the joints 1, 1 a (FIG. 4).
- the carriage 25 has a further measuring field 8a, which interacts with the measuring laser beam 7 in the manner already described above in relation to the measuring field 8.
- the measuring field 8a lies in the direction of the laser beam 7 behind the first measuring field 8, the latter being partially permeable, so that the measuring laser beam 7 is "split" on the one hand for guiding the arm or the connecting element 2 and on the other hand for guiding the slide 25 .
- the slower main drive 13 runs behind the measuring drive 11/23; however, so that the power laser beam 16 nevertheless points to the same defined point of the mirror system 15a and is thus still deflected exactly in the desired direction
- the mirror system 15a is guided via the fast drive 26 using the difference Af ⁇ determined by the second measuring field 8a until the measuring field 8a again detects a difference "zero".
- the arm or the connecting element 2 will now "follow” so that the carriage 25 is moved back to its original position at the speed of the arm, ie the carriage 25 only deviates from its starting position during transitional processes and moves back to the starting position after the arm deviation has been corrected.
- the unloaded transmission can expediently also carry an unloaded arm, the end of which carries the mirror system for the power laser.
- part of the power laser beam 16 can of course be used as the measuring laser beam 7, i.e. decoupled via the mirror system 15 who e.
- the described control for the power laser beam 16 and also the tracking of the arm or the connecting element 2 can be used for swiveling movements, but according to the invention can also be transferred to double mirror arrangements for rotating and swiveling movements.
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
Un procédé permet de corriger au moyen d'un système de mesure des déplacements la position de l'extrémité libre du bras d'un robot, notamment lorsque celle-ci a quitté sa position de consigne suite à des flexions et/ou des torsions. Le bras du robot comprend au moins un élément de liaison qui prolonge au moins une articulation ou base correspondante. La déviation par rapport à la position de consigne à l'extrémité de l'élément de liaison est mesurée au moyen d'un faisceau d'énergie émis par un émetteur d'énergie agencé à l'autre extrémité de l'élément de liaison et est corrigée automatiquement, selon le procédé décrit dans le brevet P36 14 122.4-32 en fonction de la déviation mesurée du bras du robot, qui est ainsi ramené à la position de consigne. Le faisceau d'énergie est dirigé au moyen d'un entraînement de mesure essentiellement non soumis à des charges en fonction d'une valeur prédéterminée de consigne.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE19873729161 DE3729161A1 (de) | 1986-04-25 | 1987-09-01 | Verfahren und vorrichtung zur positionskorrektur von industrieroboterarmen |
DE3729161 | 1987-09-01 |
Publications (1)
Publication Number | Publication Date |
---|---|
EP0378554A1 true EP0378554A1 (fr) | 1990-07-25 |
Family
ID=6334961
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP19880907301 Withdrawn EP0378554A1 (fr) | 1987-09-01 | 1988-08-30 | Procede et dispositif de correction de la position des bras de robots industriels |
Country Status (2)
Country | Link |
---|---|
EP (1) | EP0378554A1 (fr) |
WO (1) | WO1989002101A1 (fr) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102010052503B4 (de) * | 2010-11-26 | 2012-06-21 | Wenzel Scantec Gmbh | Verfahren zur Steuerung eines Koordinatenmessgeräts sowie Koordinatenmessgerät |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1983000834A1 (fr) * | 1981-09-02 | 1983-03-17 | FAXÖ, Per, Göran | Procede et moyen de determination de la position d'un bras de travail |
DE3441332A1 (de) * | 1984-11-12 | 1986-05-22 | Forschungsinstitut für Steuerungstechnik der Werkzeugmaschinen und Fertigungseinrichtungen in der Institutsgemeinschaft Stuttgart e.V., 7000 Stuttgart | Gelenkantrieb, insbesondere fuer industrieroboter |
DE3614122A1 (de) * | 1986-04-25 | 1987-11-05 | Forsch Steuerungstechnik Der W | Verfahren und vorrichtung zur positionskorrektur von industrieroboterarmen |
-
1988
- 1988-08-30 EP EP19880907301 patent/EP0378554A1/fr not_active Withdrawn
- 1988-08-30 WO PCT/EP1988/000775 patent/WO1989002101A1/fr not_active Application Discontinuation
Non-Patent Citations (1)
Title |
---|
See references of WO8902101A1 * |
Also Published As
Publication number | Publication date |
---|---|
WO1989002101A1 (fr) | 1989-03-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE2841284C2 (de) | Vorrichtung zum Programmieren eines Handhabungsgeräts | |
EP0158722B1 (fr) | Manipulateur pourvu d'un dispositif pour engendrer des mouvements rectilignes | |
DE3614105A1 (de) | Verfahren und einrichtung fuer die abtastmontage von zwei ineinander eindringenden teilen | |
EP1433576B1 (fr) | Robot de type à bras articulé muni d'un laser disposé au niveau de son deuxième axe | |
DE3440930A1 (de) | Robotersystem zur fuehrung von elektromagnetischen wellen | |
DE2119864A1 (de) | Röntgenuntersuchungsgerät insbesondere zur Herstellung von Röntgenschicht- und Schrägaufnahmen | |
DE3603033C2 (fr) | ||
DE3531156C1 (de) | Verfahren zum Ausrichten der Achse eines zweiten Halters in bezug auf die Achse eines ersten Halters bei einer Pruef- oder Bearbeitungsmaschine | |
DE3346825A1 (de) | Automatenarm mit aufgeteilter handgelenksbewegung | |
EP0378554A1 (fr) | Procede et dispositif de correction de la position des bras de robots industriels | |
DE3717541A1 (de) | Koordinatenmessvorrichtung | |
DE102009003355B4 (de) | Laserschweißkopf zum Schweißen von Metallteilen und Verfahren zum Strahlschweißen von Metallteilen | |
DE3530365A1 (de) | Handgelenk fuer industrieroboter | |
DE3729161A1 (de) | Verfahren und vorrichtung zur positionskorrektur von industrieroboterarmen | |
DE3614122C2 (fr) | ||
DE4428488C1 (de) | Handgelenk für die Arbeitshand eines Roboters | |
DE8711827U1 (de) | Vorrichtung zur Positionskorrektur von Industrieroboterarmen | |
EP1212002A1 (fr) | Robots de precision a cinematique parallele ayant un systeme detecteur redondant | |
DE10344056B4 (de) | Schweißzange mit fixierbarer Ausgleichsvorrichtung | |
EP0635339B1 (fr) | Manipulateur | |
DE10249202B4 (de) | Schweißzange mit fixierbarer Ausgleichsvorrichtung | |
DE3143609A1 (de) | Analysenmanipulator zur zerstoerungsfreien werkstoffpruefung und verfahren zur koordinatensteuerung desselben | |
DE19819721A1 (de) | Vorrichtung zum mechanischen Fügen von aufeinanderliegenden Fügeteilen | |
EP0728544A1 (fr) | Dispositif permettant de transférer des pièces dans une série de postes de travail | |
DE1447344C (de) | Mechanismus zur Verstellung eines Ob jekttragers um geringe Strecken in einer vorgegebenen Verstellnchtung |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
17P | Request for examination filed |
Effective date: 19900221 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AT BE CH DE FR GB IT LI LU NL SE |
|
17Q | First examination report despatched |
Effective date: 19920710 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE APPLICATION IS DEEMED TO BE WITHDRAWN |
|
18D | Application deemed to be withdrawn |
Effective date: 19950301 |