EP0378554A1 - Process and device for correcting the position of industrial robot arms - Google Patents

Process and device for correcting the position of industrial robot arms

Info

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
Application number
EP19880907301
Other languages
German (de)
French (fr)
Inventor
Karl-Heinz Wurst
Günter PRITSCHOW
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fisw Forschungs- und Ingenieursgesellschaft fur Steuerungstechnik GmbH
Original Assignee
Fisw Forschungs- und Ingenieursgesellschaft fur Steuerungstechnik GmbH
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Priority claimed from DE19873729161 external-priority patent/DE3729161A1/en
Application filed by Fisw Forschungs- und Ingenieursgesellschaft fur Steuerungstechnik GmbH filed Critical Fisw Forschungs- und Ingenieursgesellschaft fur Steuerungstechnik GmbH
Publication of EP0378554A1 publication Critical patent/EP0378554A1/en
Withdrawn legal-status Critical Current

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.A method makes it possible to correct, by means of a displacement measurement system, the position of the free end of the arm of a robot, in particular when the latter has left its set position following bending and / or twisting. The robot arm includes at least one connecting element which extends at least one corresponding articulation or base. The deviation from the set position at the end of the connection element is measured by means of an energy beam emitted by an energy transmitter arranged at the other end of the connection element and is automatically corrected, according to the method described in patent P36 14 122.4-32 according to the measured deviation of the robot arm, which is thus brought back to the set position. The energy beam is directed by means of a measurement drive which is essentially not subjected to loads as a function of a predetermined set value.

Description

Verfahren und Vorrichtung zur Positionskorrektur von IndustrieroboterarmenMethod and device for correcting the position of industrial robot arms
Die vorliegende Erfindung betrifft ein Verfahren zum Korrigieren der Position eines freien Endes eines insbeson¬ dere durch Verbiegungen und/oder Torsionen aus seiner Soll- position ausgelenkten Roboterarmes mittels eines Wegme߬ systems, wobei der Roboterarm als Fortsetzung mindestens eines Gelenkes oder einer entsprechenden Basis mindestens ein Verbindungselement aufweist, und wobei die Auslenkung aus der Sollposition am Ende des Verbindungselementes mit Hilfe eines von einem am anderen Ende des Verbindungselemen¬ tes des Roboterarmes angeordneten Energiestrahler ausgehen¬ den Energiestrahl gemessen und in Abhängigkeit von der gemessenen Auslenkung der Roboterarm in die Sollposition automatisch nachgeregelt wird, nach Patent .... (Patent¬ anmeldung P 36 14 122.4-32).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).
Weiterhin betrifft die Erfindung auch einen Roboterarm, bestehend aus mindestens einem Gelenk oder einer entspre¬ chenden Basis, mindestens einem Verbindungselement, das dem Gelenk bzw. der Basis nachgeordnet ist, sowie mindestens einem Wegmeßsystem zum Messen von Auslenkungen des Verbin¬ dungselementes, wobei das Wegmeßsystem mindestens einen am oder im vorgeordneten Gelenk angeordneten Energiestrahler am Anfang des Verbindungselementes sowie mindestens ein Meßfeld am anderen Ende des Verbindungselementes, vorzugsweise in oder an einem nachgeordneten Gelenk, aufweist, nach Patent (Patentanmeldung P 36 14 122.4-32).Furthermore, 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).
Das in dem Hauptpatent vorgeschlagene, in den Roboterarm integrierte Wegmeßsystem hat sich ausgezeichnet bewährt, da Auslenkungen des Roboterarmes, die z.B. durch Torsionen des Getriebes und/oder Biegeverformungen der Verbindungselemente verursacht sein können, ausgeregelt werden können, und das Ende des Armes exakt in die Sollposition geführt werden kann.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.
Der vorliegenden Erfindung liegt die Aufgabe zugrunde, das vorgeschlagene Verfahren sowie den vorgeschlagenen Roboter¬ arm hinsichtlich der Nachführgenauigkeit weiter zu verbes¬ sern, wobei der Roboterarm aber nach wie vor konstruktiv einfach aufgebaut und damit preisgünstig sein soll.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.
Erfindungsgemäß wird dies dadurch erreicht, daß der Energie¬ strahl mittels eines im wesentlichen unbelasteten Meßantrie¬ bes anhand des vorgegebenen Sollwertes geführt wird. Hier¬ durch werden vorteilhafterweise bei der Nachführung bzw. Positionskorrektur des Roboterarmes in seine Sollposition auch alle belastungsbedingten Verformungen des eigentlichen, belasteten Armantriebes mit berücksichtigt.According to the invention, 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.
Der erfindungsgemäße Roboterarm zeichnet sich dadurch aus, daß der Energiestrahler an einem Ausgang eines im wesentli¬ chen unbelasteten Meßantriebes angeordnet und gegenüber dem Gelenk bzw. dem Verbindungselement beweglich ist. Der Me߬ antrieb kann erfindungsgemäß von einem unbelasteten Modell¬ getriebe gebildet sein, das parallel zu einem Hauptgetriebe eines gemeinsamen Antriebes angeordnet ist. Alternativ hierzu kann der Meßantrieb aber auch durch ein unbelastetes Meßantriebssystem eines separaten Lage-Regelkreises gebildet sein. Dadurch, daß der Meßantrieb praktisch unbelastet ist, kann er von mechanisch sehr einfachen aber dennoch sehr genauen, kleinbauenden Komponenten gebildet sein. Dies trägt zu der angestrebten, einfachen Ausbildung des Roboter¬ armes bei.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. According to the invention, the measuring drive can be formed by an unloaded model gear, which is arranged parallel to a main gear of a common drive. Alternatively, 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.
Weitere vorteilhafte Ausgestaltungsmerkmale der Erfindung sind in den Unteransprüchen enthalten.Further advantageous design features of the invention are contained in the subclaims.
Anhand der Zeichnung soll im folgenden die Erfindung bei¬ spielhaft näher erläutert werden. Dabei zeigen:The invention is to be explained in more detail by way of example with reference to the drawing. Show:
Fig. 1 eine schematische Seitenansicht eines Teils eines Roboterarmes,1 is a schematic side view of part of a robot arm,
Fig. 2 ein schematisches Blockdiagramm einer ersten Aus¬ führungsform einer Nachführ-Steuerung gemäß der Erfindung,2 shows a schematic block diagram of a first embodiment of a tracking control according to the invention,
Fig. 3 ein schematisches Blockdiagramm einer zweitenFig. 3 is a schematic block diagram of a second
Ausführungsform einer Nachführ-Steuerung gemäß der Erfindung, Fig. 4 eine schematische Seitenansicht eines Teils eines Roboterarmes mit einer Einrichtung zum Nachführen eines Leistungslaserstrahles undEmbodiment of a tracking control according to the invention, 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 ein schematisches Blockschaltbild einer Steuerung der Nachführeinrichtung gemäß Fig. 4.5 shows a schematic block diagram of a control of the tracking device according to FIG. 4.
Fig. 1 zeigt einen Teil eines Roboterarmes mit einem Gelenk 1 und einem Verbindungselement 2, wobei ein Roboterarm in der Praxis mehrere Gelenke 1 sowie jeweils zwischen zwei Gelenken 1 ein Verbindungselement 2 aufweisen kann. Am Ende des letzten Gelenkes 1 ist üblicherweise eine Roboterhand (nicht dargestellt) angeordnet. Das Gelenk 1 ist eine autarke Einheit aus zwei Antriebssystemen, wobei eines der Antriebssysteme Drehungen um eine Achse 3 in Doppelpfeil¬ richtung 4 und das andere Antriebssystem Schwenkbewegungen um eine senkrecht zur Zeichenebene liegende Schwenkachse in Doppelpfeilrichtung 5 gestattet. Der genaue Aufbau des Gelenkes 1 ist z.B. in der EP-OS 85 11 40 49.1 beschrieben und braucht daher im Rahmen der vorliegenden Anmeldung nicht näher erläutert zu werden.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.
Der Roboterarm ist mit einem integrierten Meßsystem ausge¬ stattet, welches durch belastungsbedingte Verbiegungen und/oder Torsionen verursachte Auslenkungen am Ende des Roboterarmes bzw. des Verbindungselementes 2 mißt. In Abhängigkeit von der gemessenen Auslenkung wird der Roboter¬ arm bzw. das Verbindungselement 2 automatisch in seine Soll- Position nachgeregelt. Ein diesbezügliches Verfahren sowie ein Roboterarm zur Durchführung des Verfahrens sind in demThe 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
Hauptpatent ... (Patentanmeldung P 36 14 122.4-32) vorgeschlagen, und es wird an dieser Stelle auf dessen Inhalt voll Bezug genommen. Das Meßsystem weist im vorgeordneten Gelenk 1 einen Energie¬ strahler, insbesondere einen Laserstrahler 6 auf, der einen Energie- bzw. Laserstrahl 7 in Richtung des entfernt liegenden Endes des Verbindungselementes 2 sendet, wo ein Meßfeld 8 angeordnet ist. Im unbelasteten, d.h. unausge- lenkten Zustand des Verbindungselementes 2 trifft der Laser¬ strahl 7 in ein definiertes Zentrum des Meßfeldes 8. Treten nun belastungsbedingte Verbiegungen und/oder Torsionen des Roboterarmes, d.h. des Gelenkes 1 und/oder des Verbindungs¬ elementes 2 auf, so bewegt sich das Meßfeld 8 gegenüber dem Laserstrahl 7, so daß letzterer aus dem Zentrum abweicht. Das Meßfeld 8 ist in der Lage, anhand der Abweichungen Ausgangssignale ^α und/oder ^ ψ zu erzeugen, die Schwenkab¬ weichungen und/oder Torsionsabweichungen des Armes entspre¬ chen. Anhand dieser Ausgangssignale wird gemäß dem Verfah¬ ren des Hauptpatentes der Roboterarm automatisch in die Soll-Position nachgeregelt.Main patent ... (patent application P 36 14 122.4-32) proposed, and reference is made here in full to its content. In the upstream joint 1, 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. In the unloaded, ie undeflected state of the connecting element 2, the laser beam 7 strikes a defined center of the measuring field 8. Now, bending and / or torsion of the robot arm, ie of the joint 1 and / or of the connecting element 2, occur due to load. the measuring field 8 moves relative to the laser beam 7 so that the latter deviates from the center. 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.
Gemäß der vorliegenden Erfindung wird nun der Laserstrahler 6 über einen unbelasteten Meßantrieb geführt, so daß auch alle belastungsbedingten Verformungen des eigentlichen, belasteten Arm-Antriebes bei der Nachregelung des Roboter¬ armes in die Sollposition mit berücksichtigt werden.According to the present invention, 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.
Im Ausführungsbeispiel gemäß Fig. 2 wird der Meßantrieb erfindungsgemäß durch ein unbelastetes, hochgenaues Modell¬ getriebe 11 gebildet, an dessen Ausgang der Laserstrahler 6 angeordnet ist. Diese Ausführungsform eignet sich insbeson¬ dere für solche Roboterarme, die überwiegend statisch arbeiten. 'Das Modellgetriebe 11 ist mechanisch parallel zu einem Hauptgetriebe 12 geschaltet, wobei beide Getriebe 11 und 12 von einem gemeinsamen Antrieb 13 angetrieben werden. Das Hauptgetriebe 12 ist im Gegensatz zu dem Modellgetriebe 11 durch den anzutreibenden Schwenkarm bzw. das Verbindungs¬ element 2 belastet. Beide Getriebe 11 und 12 weisen erfindungsgemäß die gleiche Übersetzung auf. Das Modell¬ getriebe kann sowohl ein rein mechanisches Getriebe, als auch das Getriebe eines Winkelmeßsystems, z.B. das Getriebe eines Absolutwertgebers, sein. Der gemeinsame Antrieb 13 von Modell- und Hauptgetriebe 11, 12 weist in an sich bekannter Weise eine Antriebsregelung 14 (Drehzahlregelung) auf. Treten nun Verformungen in dem belasteten Teil, d.h. in dem Hauptgetriebe 12 und/oder dem Verbindungselement 2, auf, so ermittelt das am Ende des Verbindungselementes 2 fest angeordnete Meßfeld 8 eine Differenz & ψ , die zu dem Sollwert ψs o l addiert wird. Diese Summe Ts o l l +Δ^wird dem Antrieb 13 als korrigierter Sollwert zugeführt, der somit über das Hauptgetriebe 12 den Roboterarm bzw. das jeweilige Verbindungselement 2 in die korrigierte Soll¬ position Xsoll +Δ nachregelt. Die Differenz _ ψbleibt dabei solange bestehen, wie Verformungen bzw. Abweichungen auftreten, da a der Antrieb 13 zusammen mit dem Haupt¬ getriebe 12 auch das Modellgetriebe 11 und damit auch den Laserstrahler 6 verfährt.In the exemplary embodiment according to FIG. 2, 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. According to the invention, 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.
In einer vorteilhaften Weiterbildung der Erfindung ist am Ausgang des Modellgetriebes 11 zusätzlich zu dem Laser¬ strahler 6 ein Spiegelsystem 15 - hier z.B. ein Prisma - angeordnet, das zum Mitführen eines Leistungslaserstrahles 16 durch das Gelenk 1 dient. Der Leistungslaserstrahl 16 wird erfindungsgemäß durch das über das Modellgetriebe 11 zusammen mit dem Laserstrahler 6 bewegte Spiegelsystem 15 für Laserstrahlbearbeitungsverfahren (z.B. Schweißen, Schneiden usw. ) äußerst exakt sowie vorteilhafterweise unter Kompensierung von belastungsbedingten Abweichungen des Roboterarmes bzw. des Verbindungselementes 2 positioniert, und zwar anhand der ermittelten Abweichung Es ist erfindungsgemäß weiterhin möglich, über das Spiegel¬ system 15 einen Teil des Leistungslaserstrahles 16 auszu¬ koppeln und als Meß-Laserstrahl 7 zu verwenden. Hierzu wird das Spiegelsystem 15 z.B. als teildurchlässiges Prisma aus¬ gebildet und anstelle des Laserstrahlers 6 ein Umlenkspiegel verwendet, der den ausgekoppelten Teilstrahl des Leistungs¬ laserstrahles 16 als Meßstrahl 7 in Richtung des Meßfeldes 8 umlenkt. Hierdurch erübrigt sich vorteilhafterweise der Laserstrahler 6, bzw. wird dieser von einem einfachen Umlenkspiegel gebildet.In an advantageous development of the invention, in addition to 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 It is also possible according to the invention to couple out part of the power laser beam 16 via the mirror system 15 and to use it as the measuring laser beam 7. For this purpose, 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. This advantageously eliminates the need for the laser emitter 6, or it is formed by a simple deflecting mirror.
Im Ausführungsbeispiel nach Fig. 3, das sich insbesondere für dynamische Vorgänge eignet, wird der Meßantrieb erfin¬ dungsgemäß durch ein unbelastetes Meßantriebssystem 21 eines separaten Lage-Regelkreises 22 gebildet. Dem Meßantriebs¬ system 21 ist vorzugsweise ein eigenes, hochauflösendes Win¬ kelmeßsystem 23 nachgeordnet, ah dessen Ausgang der Laser¬ strahler 6 angeordnet ist. Der Laserstrahler 6 kann auch in vorteilhafter Weise an der Abtriebsseite des Motors 21 an¬ geordnet sein. Zum Mitführen des Leistungslaserstrahles 16 kann - analog zu der oben beschriebenen Ausführung gemäß Fig. 2 - am Ausgang des Winkelmeßsystems 23 ebenfalls das Spiegelsystem 15 angeordnet sein. Vorteilhaft ist aber auch, das Spiegelsystem 15 an der Abtriebsseite des Motors 21 anzu¬ ordnen. Auch hier kann ein Teil des Leistungslaserstrahles 16 ausgekoppelt und als Meßstrahl 7 verwendet werden. Bei dieser Ausführung ist der separate, im wesentlichen unbela¬ stete Lage-Regelkreis 22 getrennt von dem belasteten, aus dem Antrieb 13 und dem Hauptgetriebe 12 bestehenden Antriebs¬ system des Roboterarms bzw. des Verbindungselementes 2, aber auf der gleichen "Basis" bzw. dem gleichen "Bezugspunkt" des Gelenkes 1 angeordnet, wobei der Antrieb auch hier - wie be¬ kannt - die Antriebsregelung 14 besitzt.In the exemplary embodiment according to FIG. 3, which is particularly suitable for dynamic processes, 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. In order to carry the power laser beam 16, 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. Here too, part of the power laser beam 16 can be coupled out and used as a measuring beam 7. In this embodiment, 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.
Der erfindungsgemäße Folgeregelkreis gemäß Fig. 3 arbeitet nun wie folgt. Ein Sollwert cfΞ a X 1 wird dem Meßantriebs- system 21 vorgegeben, das hierdurch "anläuft" und über den Lage-Regelkreis 22 den Meß-Laserstrahl 7 und ggf. auch den Leistungslaserstrahl 16 in die gewünschte Sollposition ausrichtet. Hierdurch bewegt sich der Meß-Laserstrahl 7 aus dem Zentrum des Meßfeldes 8 hinaus, so daß letzteres ein der Abweichung entsprechendes Differenzsignal ^ψ& __&ug~ r welches dem Antrieb 13 zugeführt wird, und welches bewirkt, daß der Roboterarm bzw. das Verbindungselement 2 mit dem Meßfeld 8 über das Hauptgetriebe 12 solange "nachgeführt" wird, bis der Meß-Laserstrahl 7 wieder in das definierte Zentrum des Meßfeldes 8 trifft und somit die Differenz Aψ ~zv. "Null" wird. Hierdurch wird stets exakt die Sollposition des Endes des Roboterarmes bzw. des Verbindungselementes 2 erreicht, auch-wenn innerhalb des Hauptgetriebes 12 und/oder des Roboterarmes bzw. Verbindungselementes 2 Verformungen (Verdrehungen, Verbiegungen) auftreten.The slave control circuit of the invention shown in Fig. 3 operates as fo l gt. 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. As a result, 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". As a result, 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.
In den Fig. 4 und 5 wird eine vorteilhafte Weiterbildung' der Erfindung veranschaulicht. Der Roboterarm bzw. dessen belasteter Antrieb ist im Vergleich zu dem unbelasteten Meßantrieb relativ träge, d.h. Lageabweichungen des Arms werden während einer bestimmten Übergangszeit, die etwa i • Bereich von 20 bis 30 ms liegen kann, ausgeglichen, indem der Arm "nachgeführt" wird. Um nun während diesem "Über¬ gangsvorgang" den über das Spiegelsystem 15 durch das vorgeordnete Gelenk 1 mitgeführten Leistungslaserstrahl 16 durch ein nachgeordnetes Gelenk la in Richtung eines nachgeordneten Verbindungselementes 2a verzerrungsfrei, d.h. exakt in seine Sollposition bzw. Sollausrichtung weiterzuführen, ist in dem nachfolgenden Gelenk la ein weiteres Spiegelsystem 15a angeordnet,, das erfindungs¬ gemäß derart beweglich geführt wird, daß entsprechend der jeweils gemessenen Korrekturgröße &f- bei Abweichungen des Gelenkes la aus seiner Sollposition (z.B. durch Ver- biegungen des Verbindungselementes 2) der Leistungslaser¬ strahl 16 dennoch exakt in seine Sollausrichtung umgelenkt wird. Auch.für diese Steuerung (s. Fig. 5) wird erfindungs¬ gemäß der Meßlaserstrahl 7 verwendet. In oder an dem nach- geordneten Gelenk la ist ein beweglicher Schlitten 25 ange¬ ordnet, der von einem schnellen Antrieb 26 vorzugsweise auf einer Kreisbahn 27 mit einem dem Abstand der Gelenke 1, la entsprechenden Radius (Fig. 4) bewegbar ist. Der Schlitten 25 weist ein weiteres Meßfeld 8a auf, das mit dem Meßlaser¬ strahl 7 in der oben bereits in bezug auf das Meßfeld 8 beschriebenen Weise zusammenwirkt. Das Meßfeld 8a liegt in Richtung des Laserstrahles 7 gesehen hinter dem ersten Me߬ feld 8, wobei letzteres teildurchlässig ausgebildet ist, so daß der Meßlaserstrahl 7 zum Nachführen des Armes bzw. des Verbindungselementes 2 einerseits und zum Führen des Schlittens 25 andererseits "aufgeteilt" wird.In 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. In order to continue the power laser beam 16 carried by the upstream joint 1 via the mirror system 15 through a downstream joint 1a in the direction of a downstream connecting element 2a during this “transition process” without distortion, ie exactly in its desired position or desired orientation, the following joint must be used 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. According to the invention, 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 .
Die Funktion dieser erfindungsgemäßen Nachführeinrichtung für den Leistungslaserstrahl 16 ist nun wie folgt. Im unbelasteten, unausgelenkten Zustand des Verbindungselemen¬ tes 2 sind die erfaßten Differenzen Afsowohl des Meßfeldes 8 als auch des zweiten Meßfeldes 8a gleich "Null". Der Leistungslaserstrahl 16 zeigt auf einen definierten Punkt des Spiegelsystems 15a. Bei Sollwertänderungen und/oder bei auftretenden, belastungsbedingten Abweichungen des Armendes aus der Sollposition läuft der langsamere Hauptantrieb 13 dem Meßantrie'b 11/23 hinterher; damit aber der Leistungs¬ laserstrahl 16 dennoch in den gleichen definierten Punkt des Spiegelsystems 15a zeigt und somit nach wie vor exakt in die Sollrichtung umgelenkt wird, wird anhand der von dem zweiten Meßfeld 8a ermittelten Differenz Af^ über den schnellen Antrieb 26 das Spiegelsystem 15a naσhgeführt, bis das Meßfeld 8a wieder eine Differenz "Null" erfaßt. Der Arm bzw. das Verbindungselement 2 wird nun "nachkommen", so daß der Schlitten 25 in der Geschwindigkeit des Armes wieder in seine ursprüngliche Position zurückbewegt wird, d.h. der Schlitten 25 weicht nur während Übergangsvorgängen aus seiner Ausgangsstellung ab und bewegt sich nach Ausregelung der Armabweichung wieder in die Ausgangsstellung zurück.The function of this tracking device according to the invention for the power laser beam 16 is now as follows. In the unloaded, undeflected state of the connecting element 2, the detected differences Afso both the measuring field 8 and the second measuring field 8a are "zero". The power laser beam 16 points to a defined point of the mirror system 15a. In the event of setpoint changes and / or if the arm end deviates from the setpoint position due to load, 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.
Zweckmäßigerweise kann das unbelastete Getriebe neben dem Laserstrahler 6 auch einen unbelasteten Arm führen, dessen Ende das SpiegelSystem für den Leistungslaser trägt.In addition to the laser emitter 6, the unloaded transmission can expediently also carry an unloaded arm, the end of which carries the mirror system for the power laser.
Auch bei dieser Weiterbildung der Erfindung kann natürlich als Meßlaserstrahl 7 ein Teil des Leistungslaserstrahles 16 verwendet, d.h. über das Spiegelsystem 15 ausgekoppelt wer e .In this development of the invention, too, 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.
Die beschriebene Nachführsteuerung für den -Leistungslaser¬ strahl 16 sowie auch die Nachführung des Armes bzw. des Verbindungselementes 2 lassen sich für Schwenkbewegungen verwenden, sind jedoch erfihdungsgemäß auch auf Doppel¬ spiegelanordnungen für Dreh- und Schwenkbewegungen übertrag¬ bar. 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.

Claims

AnsprücheExpectations
Verfahren zum Korrigieren der Position eines freien Endes eines insbesondere durch Verbiegungen und/oder Torsionen aus seiner Sollposition ausgelenkten Roboterarmes mittels eines Wegmeßsystems, wobei der Roboterarm als Fortsetzung mindestens eines Gelenks oder einer entsprechenden Basis mindestens ein Verbindungselement aufweist, und wobei die Auslenkung aus der Sollposition am Ende des Verbindungselementes mit Hilfe eines von einem am anderen Ende des Verbindungselementes des Roboterarmes angeordneten Energiestrahler ausgehenden Energiestrahls gemessen und in Abhängigkeit von der gemessenen Auslenkung der Roboterarm in die Sollposition automatisch nachgere¬ gelt wird, nach Patent .... (Patentanmeldung P 36 14 122.4-32), d a d u r c h g e k e n n z e i c h n e t , daß der Energiestrahl mittels eines im wesentlichen unbe¬ lasteten Meßantriebes anhand eines vorgegebenen Sollwertes geführt wird.Method for correcting the position of a free end of a robot arm deflected from its desired position, in particular by bending and / or torsion, by means of a displacement measuring system, the robot arm having at least one connecting element as a continuation of at least one joint or a corresponding base, and wherein the deflection from the desired position on 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 is automatically readjusted depending on the measured deflection of the robot arm into the desired position, according to patent .... (patent application P 36 14 122.4 -32), characterized in that the energy beam is guided by means of a substantially unloaded measuring drive based on a predetermined target value.
2. Verfahren nach Anspruch 1, d a d u r c h g e k e n n z e i c h n e t , daß der Energiestrahl durch ein im wesentlichen unbelastetes, parallel zu einem belasteten Hauptgetriebe geschal¬ tetes Modellgetriebe geführt wird.2. The method of claim 1, d a d u r c h g e k e n n z e i c h n e t that the energy beam is guided through a substantially unloaded, parallel to a loaded main gear switched model gear.
3. Verfahren nach Anspruch 1, d a d u r c h g e k e n n z e i c h n e t , daß der Energiestrahl durch ein im wesentlichen unbelastetes, von dem eigentlichen, belasteten Hauptantrieb getrenntes Meßantriebssystem geführt wird.3. The method of claim 1, d a d u r c h g e k e n n z e i c h n e t that the energy beam is guided by a substantially unloaded, separated from the actual, loaded main drive measuring drive system.
4. Verfahren nach Anspruch 3, d a d u r c h g e k e n n z e i c h n e t , daß das Meßantriebssystem den Energiestrahl anhand des Soll¬ wertes in die Sollposition vorführt und das Verbin¬ dungselement durch den Hauptantrieb automatisch nach¬ geführt wird.4. The method of claim 3, so that the measuring drive system shows the energy beam based on the target value in the target position and the connecting element is automatically tracked by the main drive.
5. Verfahren nach einem oder mehreren der Ansprüche 1 bis 4, d a d u r c h g e k e n n z e i c h n e t , daß zusammen mit dem Meß-Energiestrahl ein Leistungs¬ laserstrahl mitgeführt wird.5. The method according to one or more of claims 1 to 4, d a d u r c h g e k e n n z e i c h n e t that a power laser beam is carried along with the measuring energy beam.
6. Verfahren nach Anspruch 5, d a d u r c h g e k e n n z e i c h n e t , daß ein Teil des Leistungslaserstrahles ausgekoppelt und als Meß-Energiestrahl verwendet wird. 6. The method according to claim 5, characterized in that part of the power laser beam is coupled out and used as a measuring energy beam.
7. Verfahren nach Anspruch 5 oder 6, d a d u r c h g e k e n n z e i c h n e t , daß während .eines Übergangsvorganges, während dem der Hauptantrieb dem Meßantrieb nachläuft, der Leistungs¬ laserstrahl in einem nachgeordneten Gelenk anhand der gemessenen Auslenkung des Roboterarmes automatisch in seine Sollrichtung geführt wird.7. The method according to claim 5 or 6, d a d u r c h g e k e n n z e i c h n e t that during a transition process during which the main drive runs after the measuring drive, the power laser beam is automatically guided in its downstream direction in a subordinate joint on the basis of the measured deflection of the robot arm.
8. Roboterarm insbesondere zur Anwendung des Verfahrens nach einem der Ansprüche 1 bis 7, bestehend aus mindestens einem Gelenk oder einer entsprechenden Basis, mindestens einem Verbindungselement, das dem Gelenk bzw. der Basis nachgeordnet ist, sowie mindestens einem Wegmeßsystem zum Messen von Auslen¬ kungen des Verbindungselementes, wobei das Wegmeß^ System mindestens einen am oder im vorgeordneten Gelenk angeordneten Energiestrahler sowie mindestens ein Meßfeid vorzugsweise in oder an dem nachgeordne¬ ten Gelenk aufweist, nach Patent .... (Patentanmel¬ dung P 36 14 122.4-32), d a d u r c h g e k e n n z e i c h n e t , daß der Energiestrahler (6) an einem Ausgang eines im wesent¬ lichen unbelasteten Meßantriebes angeordnet und gegenüber dem Gelenk (1) bzw. dem Verbindungselement (2) beweglich ist.8. Robot arm in particular for using the method according to one of claims 1 to 7, 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 having at least one energy radiator arranged on or in the upstream joint and at least one measuring field preferably in or on the downstream joint, according to patent ... (patent application P 36 14 122.4-32), characterized in that the energy radiator (6) is arranged at an output of an essentially unloaded measuring drive and is movable relative to the joint (1) or the connecting element (2).
9. Roboterarm nach Anspruch 8, d a d u r c h g e k e n n z e i c h n e t , daß der Meßantrieb von einem unbelasteten Modellgetriebe (11) gebildet ist, das parallel zu einem Hauptgetriebe (12) eines gemeinsamen Antriebes (13) angeordnet ist. 9. Robot arm according to claim 8, characterized in that the measuring drive is formed by an unloaded model gear (11) which is arranged parallel to a main gear (12) of a common drive (13).
10. Roboterarm nach Anspruch 9, d a d u r c h g e k e n n z e i c h n e t , daß das Modellgetriebe (11) und das Hauptgetriebe (12) die gleiche Übersetzung aufweisen.10. Robot arm according to claim 9, d a d u r c h g e k e n n z e i c h n e t that the model gear (11) and the main gear (12) have the same translation.
11. Roboterarm nach Anspruch 9 oder 10, d a d u r c h g e k e n n z e i c h n e t , daß das Modellgetriebe (11) ein mechanisches Getriebe oder ein Getriebe eines Winkelmeßsystems, z.B. eines Absolutwertgebers, ist.11. Robot arm according to claim 9 or 10, that the model gear (11) is a mechanical gear or a gear of an angle measuring system, e.g. an absolute encoder.
12. Roboterarm nach Anspruch 8, d a d u r c h g e k e n n z e i c h n e t , daß der Meßantrieb von einem unbelasteten Meßantriebssystem (21) eines separaten Lage-Regelkreises (22) gebildet ist, wobei dem Meßantriebssystem (21) vorzugsweise ein eigenes, hochau lösendes Winkelmeßsystem (23) nachgeordnet ist, an dessen Ausgang der Energie- strahler (6) angeordnet ist.12. Robot arm according to claim 8, characterized in that the measuring drive is formed by an unloaded measuring drive system (21) of a separate position control circuit (22), the measuring drive system (21) preferably having its own, highly resolving angle measuring system (23) arranged downstream the output of which is arranged the energy radiator (6).
13. Roboterarm nach einem oder mehreren der Ansprüche 8 bis 12, d a d u r c h g e k e n n z e i c h n e t , daß am Ausgang des Modellgetriebes (11) bzw. des WinkelmeßSystems (23) zusätzlich zu dem Energie¬ strahler (6) ein Spiegelsystem (15) zum Mitführen eines Leistungslaserstrahles (16) angeordnet ist.13. Robot arm according to one or more of claims 8 to 12, characterized in that at the output of the model gear (11) or the angle measuring system (23) in addition to the energy source (6) a mirror system (15) for carrying a power laser beam (16 ) is arranged.
14. Roboterarm nach Anspruch 13, d a d u r c h g e k e n n z e i c h n e t , daß das Spiegelsystem (15) teildurchlässig ausgebildet ist, wobei in Richtung des einfallenden Leistungslaser¬ strahles (16) gesehen hinter dem Spiegelsystem (15) ein den Laserstrahler (6) bildender Umlenkspiegel für einen den Meß-Energiestrahl (7) bildenden, ausgekop¬ pelten Teilstrahl des Leistungslaserstrahls (16) .angeordnet ist.14. Robot arm according to claim 13, characterized in that the mirror system (15) is partially permeable, being seen in the direction of the incident power laser beam (16) behind the mirror system (15) forming a laser beam (6) deflecting mirror for a decoupled partial beam of the power laser beam (16) forming the measuring energy beam (7) is arranged.
15. Roboterarm nach Anspruch 13 oder 14, d a d u r c h g e k e n n z e i c h n e t , daß an oder in dem nachgeordneten Gelenk (la) ein weiteres Spiegelsystem (15a) für den Leistungslaserstrahl (16) angeordnet ist, wobei das weitere Spiegelsystem (15a) vorzugsweise auf einer Kreisbahn (27) mit einem dem Abstand zwischen den Gelenken (1, la) entsprechenden Radius beweglich geführt ist.15. Robot arm according to claim 13 or 14, characterized in that a further mirror system (15a) for the power laser beam (16) is arranged on or in the downstream joint (la), the further mirror system (15a) preferably on a circular path (27) is movably guided with a radius corresponding to the distance between the joints (1, la).
16. Roboterarm nach Anspruch 15, d a d u r c h g e k e n n z e i c h n e t , daß das weitere Spiegelsystem (15a) mittels eines Antriebes (26) in Abhängigkeit von der gemessenen Auslenkung des Armes bewegbar ist.16. Robot arm according to claim 15, so that the further mirror system (15a) can be moved by means of a drive (26) depending on the measured deflection of the arm.
17. Roboterarm nach Anspruch 15 oder 16, d a d u r c h g e k e n n z e i c h n e t , daß das weitere Spiegelsystem (15a) auf einem beweglichen Schlitten (25) angeordnet ist, der vorzugsweise ein weiteres, in Richtung des Meß-Energiestrahls (7) gesehen hinter dem ersten Meßfeld (8) angeordnetes Meßfeld (8a) trägt, wobei das erste Meßfeld (8) teildurchlässig ausgebildet ist.17. Robot arm according to claim 15 or 16, characterized in that the further mirror system (15a) is arranged on a movable carriage (25), which is preferably another, seen in the direction of the measuring energy beam (7) behind the first measuring field (8) arranged measuring field (8a), the first measuring field (8) being partially permeable.
18. Roboterarm nach einem oder mehreren der Ansprüche 1 bis 17, d a d u r c h g e k e n n z e i c h n e t, daß der Laserstrahler (6) an der Abtriebsseite des Motors (21) angeordnet ist. 18. Robot arm according to one or more of claims 1 to 17, characterized in that the laser emitter (6) is arranged on the output side of the motor (21).
19. Roboterarm nach einem oder mehreren der Ansprüche 1 bis 18, d a d u r c h g e k e n n z e i c h n e t, daß das Spiegelsystem (15) an der Abtriebsseite des Motors (21) angeordnet ist. 19. Robotic arm according to one or more of claims 1 to 18, that the mirror system (15) is arranged on the output side of the motor (21).
EP19880907301 1987-09-01 1988-08-30 Process and device for correcting the position of industrial robot arms Withdrawn EP0378554A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
DE19873729161 DE3729161A1 (en) 1986-04-25 1987-09-01 Method and device for correcting the position of industrial robot arms
DE3729161 1987-09-01

Publications (1)

Publication Number Publication Date
EP0378554A1 true EP0378554A1 (en) 1990-07-25

Family

ID=6334961

Family Applications (1)

Application Number Title Priority Date Filing Date
EP19880907301 Withdrawn EP0378554A1 (en) 1987-09-01 1988-08-30 Process and device for correcting the position of industrial robot arms

Country Status (2)

Country Link
EP (1) EP0378554A1 (en)
WO (1) WO1989002101A1 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102010052503B4 (en) * 2010-11-26 2012-06-21 Wenzel Scantec Gmbh Method for controlling a coordinate measuring machine and coordinate measuring machine

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1983000834A1 (en) * 1981-09-02 1983-03-17 FAXÖ, Per, Göran Method and means for determination of the position of a work arm
DE3441332A1 (en) * 1984-11-12 1986-05-22 Forschungsinstitut für Steuerungstechnik der Werkzeugmaschinen und Fertigungseinrichtungen in der Institutsgemeinschaft Stuttgart e.V., 7000 Stuttgart JOINT DRIVE, ESPECIALLY FOR INDUSTRIAL ROBOTS
DE3614122A1 (en) * 1986-04-25 1987-11-05 Forsch Steuerungstechnik Der W METHOD AND DEVICE FOR THE POSITION CORRECTION OF INDUSTRIAL ROBOT ARMS

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See references of WO8902101A1 *

Also Published As

Publication number Publication date
WO1989002101A1 (en) 1989-03-09

Similar Documents

Publication Publication Date Title
DE60128666T2 (en) Method and apparatus for friction stir welding
DE2841284C2 (en) Device for programming a handling device
DE112010000685T5 (en) Head for the continuous precision machining of three-dimensional bodies and machining equipment that includes the head
EP0158722B1 (en) A straight motion device for manipulators
DE3614105A1 (en) METHOD AND DEVICE FOR THE SCAN ASSEMBLY OF TWO INTERMEDIATE PARTS
EP1433576B1 (en) Jointed arm type robot with a laser device arranged at its second axis
DE2119864A1 (en) X-ray examination device, in particular for the production of X-ray slices and oblique images
DE3440930A1 (en) ROBOTIC SYSTEM FOR GUIDING ELECTROMAGNETIC SHAFTS
DE3531156C1 (en) Method for aligning the axis of a second holder with respect to the axis of a first holder in a testing or processing machine
DE3346825A1 (en) AUTOMATIC ARM WITH DIVIDED WRIST MOVEMENT
EP0378554A1 (en) Process and device for correcting the position of industrial robot arms
DE3717541A1 (en) COORDINATE MEASURING DEVICE
DE3530365A1 (en) WRIST FOR INDUSTRIAL ROBOTS
DE3729161A1 (en) Method and device for correcting the position of industrial robot arms
DE3614122C2 (en)
DE102009003355B4 (en) Laser welding head for welding metal parts and method for beam welding of metal parts
DE4428488C1 (en) Wrist for the working hand of a robot
DE10344056B4 (en) Welding tongs with fixable balancing device
EP0635339B1 (en) Manupulator
DE10249202B4 (en) Welding tongs with fixable balancing device
DE10249201B4 (en) Method and device for fixing the welding position
DE3143609A1 (en) ANALYZER MANIPULATOR FOR DESTRUCTION-FREE MATERIAL TESTING AND METHOD FOR COORDINATE CONTROL THEREOF
DE19819721A1 (en) Joining apparatus, e.g. stamp for assembly of motor vehicle and other machines
EP0779126A1 (en) Machine tool with several drive units
EP0728544A1 (en) Device for transferring workpieces between processing stations

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