DE60011458T2 - Vorrichtung und verfahren zur bestimmung von koordinaten und orientierung - Google Patents
Vorrichtung und verfahren zur bestimmung von koordinaten und orientierung Download PDFInfo
- Publication number
- DE60011458T2 DE60011458T2 DE60011458T DE60011458T DE60011458T2 DE 60011458 T2 DE60011458 T2 DE 60011458T2 DE 60011458 T DE60011458 T DE 60011458T DE 60011458 T DE60011458 T DE 60011458T DE 60011458 T2 DE60011458 T2 DE 60011458T2
- Authority
- DE
- Germany
- Prior art keywords
- coordinates
- orientation
- detection position
- detection
- acceleration
- 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.)
- Expired - Lifetime
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/16—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves
- G01S5/163—Determination of attitude
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/002—Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
-
- 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/37—Measurements
- G05B2219/37388—Acceleration or deceleration, inertial measurement
-
- 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/39039—Two cameras detect same reference on workpiece to define its position in space
Description
- Die vorliegende Erfindung betrifft eine Einrichtung zur Ermittlung von Koordinaten eines Punktes eines Gegenstandes in einem Koordinaten-Referenzsystem und der Orientierung des Gegenstandes im Raum in einer von dem Gegenstand eingenommenen Erfassungsposition und ein Verfahren gemäß den Oberbegriffen der beigefügten unabhängigen Ansprüche.
- Die Erfindung betrifft insbesondere, aber nicht ausschließlich, solche Einrichtungen, die zum Programmieren von Robotern verwendet werden, wie beispielsweise Schweißrobotern oder Robotern für Sprühaufbringung eines Anstrichmittels, die beispielsweise mit Fahrzeugkörpern "arbeiten". Dieses besondere Anwendungsgebiet derartiger Einrichtungen wird nachstehend zur Darstellung des Problems, auf dem die vorliegende Erfindung basiert, beschrieben werden.
- Der Gegenstand der Einrichtung wird gewöhnlich dadurch ausgebildet, dass ein Handwerkzeug von Hand von einer Person zwischen verschiedenen Positionen entlang eines Werkstücks bewegt wird, wie beispielsweise eines Fahrzeugkörpers, zum Speichern der Koordinaten und der Richtung eines Werkzeugs des Roboters in diesen Positionen. Die Steuerungseinheit für den Roboter interpoliert aufeinanderfolgend die verschiedenen gespeicherten Positionen, um eine Bewegungsbahn des Werkzeugs des Roboters zu halten.
- Die bekannten Koordinaten in einer Position, wie beispielsweise einer Startposition, werden gewöhnlich durch die Tatsache erhalten, dass eine oder mehrere Kameras verschiedene optische Punkte des in dieser Position angeordneten Gegenstandes beobachten und die wirklichen Koordinaten und die Orientierung des Gegenstandes in der Startposition durch die derart von der Kamera oder den Kameras erhaltenen Information bestimmt werden. Es ist jedoch manchmal notwendig, den Gegenstand zu Teilen entlang der Bewegungsbahn des Werkzeugs des Roboters zu bewegen, die beispielsweise durch den Gegenstand mit dem der Roboter "arbeiten" soll, wie beispielsweise einem Fahrzeugkörper, verdeckt werden. Dies ist beispielsweise bei verschiedenen Positionen der Fall, die innerhalb oder in irgendeiner Ecke des Fahrzeugkörpers gelegen sind. In solchen Fällen wird der Gegenstand, wie erwähnt, von der Startposition zu der verdeckten Erfassungsposition bewegt, wobei gleichzeitig mit der Bewegung verbundene Parameter ermittelt werden und die Berechnung von Koordinaten und Orientierung des Gegenstandes in der Erfassungsposition kann dann aus den Informationen von den Erfassungsmitteln über diese Parameter und über die Startposition ausgeführt werden.
- Bis jetzt wurde dies dadurch ausgeführt, dass der Roboter selbst zum Speichern solcher Positionen verwendet wurde und durch Erfassen der Drehung der verschiedenen Roboterarme um ihre Achsen. Dies ist jedoch ein sehr lästiger und Kosten-intensiver Weg zur Berechnung von Koordinaten und der Orientierung in der Erfassungsposition.
- Es ist beispielsweise bereits durch die DE 19626459-A1 und die BE-1010211-A6 bekannt, wie ein Gegenstand in der vorstehend genannten Weise bewegt werden kann, um die Bewegungsbahn eines Roboters zwischen verschiedenen Positionen zu speichern.
- Eine Einrichtung und ein Verfahren gemäß des Oberbegriffs sind durch die DE-A1-2731041 bekannt.
- Die Aufgabe der vorliegenden Erfindung besteht darin, eine Einrichtung und ein Verfahren des in dem Oberbegriff definierten Typs bereitzustellen, die in der Lage ist die Genauigkeit beim Erfassen der Koordinaten und der Orientierung des Gegenstandes in der Erfassungsposition zu erhöhen.
- Diese Aufgabe wird erfindungsgemäß durch die Tatsache gelöst, dass in einer derartigen Einrichtung der Gegenstand dazu vorgesehen ist, aus der Erfassungsposition in eine dritte Position mit bekannten Koordinaten und bekannter Orientierung des Gegenstandes bewegt zu werden, dass die Beschleunigungserfassungsvorrichtungen dafür ausgelegt sind, Beschleunigungen und Verzögerungen während dieser Bewegung zu ermitteln, dass das Berechnungselement dafür ausgelegt ist, die Koordinaten und die Orientierung des Gegenstandes in der dritten Position aus der Information von den Beschleunigungserfassungsvorrichtungen zu berechnen, dass ein Element dafür ausgelegt ist, die derart berechneten Werte der Koordinaten und der Orientierung mit den Wirklichen zu vergleichen, und dass das Berechnungselement dafür ausgelegt ist, die neuen Koordinaten und die neue Orientierung für den Gegenstand in der Erfassungsposition aus den Beschleunigungs- und Verzögerungsdaten zu berechnen, die während der ersten Bewegung ermittelt wurden, die möglicherweise gemäß in dem Vergleich erstellter Abweichungen von Koordinaten und Orientierung korrigiert sind. Dank des Ausgleichs möglicher Fehler bei der Erfassung der Beschleunigungserfassungsvorrichtung, der hier möglich gemacht wird, ist es durch diesen Vergleich möglich, die Genauigkeit weiter zu erhöhen, wenn die Koordinaten und die Richtung des Gegenstandes in der Erfassungsposition bestimmt werden.
- Gemäß einer bevorzugten erfindungsgemäßen Ausführungsform umfasst das Mittel sechs Beschleunigungserfassungsvorrichtungen, wobei drei dafür ausgelegt sind, die Beschleunigung und Verzögerung für die Drehung in drei, in Bezug aufeinander orthogonalen Ebenen zu ermitteln, und drei sind dafür ausgelegt, die Beschleunigung und Verzögerung des Gegenstandes in der Richtung der Senkrechten zu einer jeden der Ebenen zu ermitteln. Durch Anordnen von sechs derartigen Beschleunigungserfassungsvorrichtungen können alle Bestandteile der Bewegung des Gegenstandes bei der Bewegung zwischen der Startposition und der Erfassungsposition zuverlässig bestimmt werden.
- Gemäß einer anderen bevorzugten erfindungsgemäßen Ausführungsform umfasst die Vorrichtung ein Element, das dafür ausgelegt ist, die Zeit zu erfassen, die für die Bewegung des Gegenstandes zwischen der Startposition und der Erfassungsposition und zwischen der Erfassungsposition und der dritten Position benötigt wird, und dass das Berechnungselement dafür ausgelegt ist, eine Anwendung eines Gewichtungsfaktors auf die Korrektur als eine Folge der Abweichungen in Abhängigkeit von den Relationen zwischen den für die zwei Bewegungen benötigten Zeiten durchzuführen. Der Ausgleich kann auf diese Weise sogar verbessert werden und die Zuverlässigkeit der für die Koordinaten und die Orientierung in der Erfassungsposition berechneten Werte kann weiter erhöht werden.
- Gemäß einer anderen bevorzugten erfindungsgemäßen Ausführungsform ist der Gegenstand dafür ausgelegt, zwischen verschiedenen Positionen entlang einer erwünschten Bewegungsbahn für einen Teil eines Roboters bewegt zu werden, um die Koordinaten und die Orientierung des Teils des Roboters in diesen Positionen zu speichern. Eine Bewegungsbahn für einen Roboter kann dadurch auf schnelle und wirksame Weise und mit hoher Genauigkeit ebenso für Positionen, die keine optische Registrierung der Position eines derartigen Gegenstands gestatten, gespeichert werden. Dann ist es vorteilhaft, dass das Berechnungselement dafür ausgelegt ist, Koordinaten für einen Mittelpunkt eines Werkzeugs eines Roboters in der Erfassungsposition zu berechnen, in der dieser Mittelpunkt, beispielsweise in dem Fall eines Roboters, für Sprühanwendung eines Anstreichmittels dem erwünschten Treffmittelpunkt für den Anstrichmittelstrahl der Düse entspricht. In dem Fall eines Roboters für Punktschweißen entspricht die Erfassungsposition der erwünschten Position für die Spitze der Schweißelektrode des Roboters.
- Eine andere bevorzugte erfindungsgemäße Ausführungsform ist genau darauf ausgerichtet, dass der Gegenstand dafür ausgelegt ist, bewegt zu werden, um gegen einen Gegenstand zu lagern, den ein Roboter, der dafür vorgesehen ist, behandelt, während eines Einnehmens der Erfassungsposition, was es leicht macht, schnell und mit Genauigkeit, genau die angefragte Erfassungsposition zu erhalten.
- Gemäß einer anderen bevorzugten erfindungsgemäßen Ausführungsform sind eine oder mehrere Kameras angeordnet, um den Gegenstand zu beobachten, und Elemente angeordnet, um die bekannten Koordinaten und die bekannte Orientierung auf der Basis von der Information von der Kamera oder den Kameras zu berechnen, und dass die Erfassungsposition außerhalb des Gesichtsfelds (bzw. Sichtfeld) für die Kamera oder Kameras angeordnet ist. Die erfindungsgemäße Vorrichtung ist genau in einem solchen Fall von besonderem Nutzen, d.h. wenn eine optische Bestimmung verschiedener Positionen des Gegenstandes ausgeführt werden soll und einige dieser Positionen verdeckt sind und dadurch keine optische Bestimmung zulassen.
- Die Erfindung betrifft ebenfalls Verfahren zur Bestimmung von Koordinaten des Punktes eines Gegenstandes in einem Koordinaten-Referenzsystem und der Orientierung des Gegenstandes im Raum in einer von dem Gegenstand eingenommenen Erfassungsposition gemäß den beigefügten abhängigen Verfahrensansprüchen.
- Die Vorteile dieser Verfahren werden ohne Zweifel aus der voranstehenden Beschreibung der erfindungsgemäßen Vorrichtung und deren bevorzugten Ausführungsformen davon ersichtlich.
- Weitere Vorteile wie auch vorteilhafte Merkmale von erfindungsgemäßen Ausführungsformen werden aus der folgenden Beschreibung und den anderen abhängigen Ansprüchen ersichtlich.
- Hinsichtlich der beigefügten Zeichnungen, folgt nachfolgend eine Beschreibung einer bevorzugten erfindungsgemäßen Ausführungsform, die als ein Beispiel angeführt wird.
- In der Zeichnung:
- ist
1 eine schematische Ansicht, die eine Vorrichtung des Typs, zu der die Erfindung gehört, in einem Nutzungszustand darstellt, - ist
2 eine ausführliche Ansicht eines Gegenstandes, der Teil der Vorrichtung gemäß1 ist, - ist
3 eine schematische Ansicht, die darstellt wie Beschleunigungserfassungsvorrichtungen angeordnet und ausgeführt sind, um erfindungsgemäß für den Gegenstand gemäß2 , in einer Vorrichtung gemäß einer bevorzugten erfindungsgemäßen Ausführungsform zu wirken, und - ist
4 eine schematische Ansicht, die die erfindungsgemäßen aufeinanderfolgenden Positionen eines Gegenstandes darstellt und dafür vorgesehen ist die Erklärung des erfindungsgemäßen Verfahrens zu erleichtern. - In der
1 ist schematisch dargestellt, wie eine erfindungsgemäße Vorrichtung zur Bestimmung von Koordinaten eines Punktes eines Gegenstandes in einem Koordinaten-Referenzsystem und der Orientierung des Gegenstandes im Raum in einer von dem Gegenstand eingenommenen Erfassungsposition aussehen könnte. Sie ist hier dafür vorgesehen, so viele Positionen entlang einer Bewegungsbahn eines Roboters1 zu bestimmen, so dass ein Steuerungssystem die Bewegung zwischen diesen Positionen interpolieren kann und dadurch den Roboter entlang einer erwünschten Bewegungsbahn zu steuern. Das Steuerungsprogramm des Roboters wird auf diese Weise schnell und mit einer hohen Genauigkeit erhalten, in dem ein Gegenstand2 von einer Person bewegt wird, um gegen einen Gegenstand3 zu lagern, hier ein durch den Roboter zu behandelnden Fahrzeugkörper und die Koordinaten und die Orientierung des Gegenstandes werden für jede solche Position bestimmt. Dies wird erhalten, in dem zwei Kameras4 ,5 , vorzugsweise CCD Kameras, in Richtung des Fahrzeugkörpers gerichtet werden, so dass sie den größt möglichen Teil davon innerhalb ihres Sichtfelds haben. Die Kameras sind vorzugsweise in einem Abstand von 90° in Bezug aufeinander in Bezug auf einen vorgestellten Kreis um das Fahrzeug angeordnet. - Die Kameras sind dafür ausgelegt, Information über das Bild, das sie empfangen, an ein Element
6 zu senden, das in der Form eines Computers die Koordinaten eines gegebenen Punktes des Gegenstandes in dem Kartesischen Koordinatensystem und die Orientierung des Gegenstandes berechnet, und diese Information weiter an eine Einheit7 sendet, die dazu ausgelegt ist, den Roboter später auf der Basis der berechneten Positionswerte zu steuern. Dann ist es möglich, nur eine einzelne Kamera zu verwenden, wodurch es dann schwieriger wird, eine zuverlässige Positionsbestimmung des Gegenstandes zu erhalten. - In
2 wird dargestellt wie ein Gegenstand2 zur Verwendung in der Weise, wie hinsichtlich1 beschrieben, aussehen könnte. Dieser Gegenstand weist drei Arme auf, die gemäß einer Achse senkrecht zueinander stehen, jeder in einem Kartesischen Koordinatensystem. Ein optischer Bezugspunkt11 ,12 in der Form einer kleinen Kugel ist an dem äußersten Ende von zwei der Arme8 ,9 angeordnet. Solche optischen Bezugspunkte13 ,14 sind ebenfalls in dem Ursprung des Koordinatensystems beziehungsweise in einer Position entlang des Arms10 angeordnet. Die optischen Bezugspunkte11-14 können aktive Lichtsignale sein, die eine Beleuchtungssequenz aufweisen, die sie für das Steuerungselement6 einzeln leicht zu identifizieren macht. Es ist die Position dieser vier Punkte in der Bildinformation, die von den Kameras an das Berechnungselement ausgesendet wird, die durch das Berechnungselement zur Berechnung der Koordinaten eines Punktes des Gegenstandes verwendet wird, genauer die Spitze15 des längeren Arms10 . - Diese Spitze
15 , die dem Werkzeugmittelpunkt (TCP = Werkzeugmittelpunkt) entspricht, wird beim Bestimmen der verschiedenen Positionen dazu gebracht, gegen den in Frage stehenden Gegenstand zu lagern, derart wie ein Fahrzeugkörper3 gemäß1 . Zwei Markierzacken16 ,18 , die von dem Arm10 vorragen, werden ebenfalls verwendet, wobei die äußersten Punkte dieser durch eine Leitung, die durch die Spitze15 verläuft, verbunden sein können, um die genaue Orientierung des Gegenstandes in Bezug auf den Fahrzeugkörper einzustellen. Die Markierzacken16 ,17 können schrittweise mit 90° um die longitudinale Achse des Arms10 durch Lockern eines Einstellknopfes18 gedreht werden, um eine gute Geometrie der optischen Bezugspunkte in Bezug auf die Kameras4 ,5 beizubehalten. Die eingestellte Position wird automatisch in dem Steuerungselement6 registriert. Wenn der Bediener den Gegenstand in der gewünschten Position angeordnet hat, löst dies ein Einstellelement19 aus, das vorzugsweise ein Signal an das Berechnungselement6 sendet, damit sagend, dass es die Koordinaten und die Orientierung des Gegenstandes in der augenblicklichen Position davon berechnen soll, d.h. auf der Basis der Bildinformation genau als sie durch die Kameras aufgezeichnet wurde. - Es ist kennzeichnend für die erfindungsgemäße Vorrichtung, dass der Gegenstand, wie in
2 gezeigt, mit Beschleunigungserfassungsvorrichtungen bereitgestellt ist, die dazu ausgelegt sind, Beschleunigungen und Verzögerungen des Gegenstandes während der Bewegung davon zu ermitteln. Genauer, sechs Beschleunigungserfassungsvorrichtungen sind an den Armen des Gegenstandes angebracht, wobei drei 20-22, die Beschleunigung und Verzögerung für eine Drehung des Gegenstandes in drei Ebenen, die zueinander orthogonal sind, ermitteln und wobei drei 23-25, die Beschleunigung und Verzögerung des Gegenstandes in der Richtung der Senkrechten zu einer jeden der Ebenen ermitteln. Wie diese angeordnet sind, um die Beschleunigungen und Verzögerungen auf diese Weise zu ermitteln, ist schematisch in3 dargestellt. Diese Anordnung der Beschleunigungserfassungsvorrichtung macht es möglich, die Koordinaten und die Orientierung des Gegenstandes in den Positionen zu bestimmen, die nicht durch Information von den Kameras bestimmt werden können, da der Gegenstand in diesen Positionen durch den anderen Gegenstand oder durch den Bediener verdeckt ist. - Die Positionsbestimmung wird durch die Beschleunigungserfassungsvorrichtungen in der folgenden Weise durchgeführt. Wenn der Gegenstand in einer sogenannten Startposition
26 (siehe4 ) den Punkt15 einnimmt, dann können dessen Koordinaten und die Orientierung des Gegenstandes, die damit verbunden sind, als bekannt angesehen werden, da sie auf der Basis von Information von den Kameras berechnet werden können, und der Gegenstand wird mit der Spitze15 zu einer sogenannten Erfassungsposition27 bewegt, in der der Gegenstand vollständig oder teilweise verdeckt ist, wobei die Beschleunigungserfassungsvorrichtungen die Beschleunigungen und Verzögerungen des Gegenstandes während dieser Bewegung ermitteln, und die Information darüber an das Berechnungselement senden. Dieses Senden von dieser Information kann durch Auslösung des Einstellelements19 durch den Bediener durchgeführt werden, wenn einmal die Erfassungsposition27 erreicht wurde. Das Berechnungselement kann auf der Basis dieser Information und der Information von Koordinaten und Orientierung, die mit der Startposition verbunden sind, und der Information über die für die Bewegung benötigte Zeit, die Koordinaten für die Spitze15 in der Erfassungsposition27 berechnen und die Orientierung des Gegenstandes, wenn sie mit der Spitze15 in dieser Position gehalten wird. Es wäre sicherlich möglich die derart berechneten Werte als Daten für die verdeckte Erfassungsposition27 zu speichern, aber die Erfindung sieht vor, die Genauigkeit beim Bestimmen dieser Daten durch Vorgehen in der folgenden Weise zu erhöhen: sobald die Erfassungsposition27 von dem Gegenstand eingenommen worden ist, wird der Gegenstand zu der nächsten Position28 bewegt, hier die Dritte genannt, in der der Gegenstand angesehen werden kann, bekannte Koordinaten und eine bekannte Orientierung aufzuweisen, da der Gegenstand hier vollständig für die Kameras sichtbar ist. Während der Bewegung von der Erfassungsposition27 zu der dritten Position28 werden die Beschleunigung und Verzögerung des Gegenstandes durch die Beschleunigungserfassungsvorrichtungen20-25 erfasst. Die Koordinaten und Orientierung des Gegenstandes in dieser dritten Position werden dann aus der Information von dieser Erfassung berechnet. Es wird daher während dieser Berechnung berücksichtigt, dass der Gegenstand von der berechneten Erfassungsposition und dann zu einer neuen Position bewegt wurde. Daher sind die Koordinaten und die Orientierung des Gegenstandes, die in der dritten Position berechnet worden sind, durch zwei aufeinander folgende Berechnungen erhalten. Wenn dies ausgeführt worden ist, werden die Werte für die dritte Position28 mit denen verglichen, die durch die Kameras optisch mit einer hohen Genauigkeit bestimmt werden können. Wir nehmen jetzt an, dass die berechnete Position sowohl in Bezug auf die Koordinaten als auch auf die Orientierung von der dritten Position28 , wie durch den Ring29 in4 gezeigt, etwas abweicht. Ein Vergleich der berechneten und sogenannten wirklichen Positionsparameter wird ausgeführt und eine neue Berechnung der verdeckten Erfassungsposition wird auf der Basis der sich aus dem Vergleich ergebenden Differenz ausgeführt und die Erfassungsposition kann jetzt als falsch berechnet angesehen werden, am Ring30 angeordnet zu sein. Ein Gewichtungsfaktor wird auf diese Korrektur angewendet, abhängig von dem Verhältnis zwischen den für die Bewegung zwischen den Punkten26 und27 und27 und28 benötigten Zeiten, so dass, wenn beispielsweise eine Zeit von 0,3 sec für die erste Bewegung benötigt wird und 0,5 sec für die zweite, wird ein 3/8 der Abweichung, die in der dritten Position erhalten wurde für die Korrektur, der für die Erfassungsposition27 berechneten Werte, verwendet. Er kann auf diese Weise gegenüber Abweichungen in den Beschleunigungs- und den Verzögerungsparametern der Beschleunigungserfassungsvorrichtungen ausgeglichen werden. Es ist wichtig, dass die Bewegung des Gegenstandes zu der verdeckten Position und daraus dann zu einer sichtbaren Position vergleichbar schnell ist, um ein gutes Erfassungsergebnis zu erhalten. Eine Hintergrundaktivität, die ständig Daten von den Beschleunigungserfassungsvorrichtungen behandelt und sie mit optisch erfassten Positionen vergleicht, kann in dem Element6 zur weiteren Verbesserung der Genauigkeit ausgeführt werden. Dadurch dass dies ständig während der Bewegung des Gegenstandes zwischen verschiedenen Positionen ausgeführt wird, können verbundene „Verstärkungsfaktoren" und "Offset-Werte" durch eine bekannte Steuerungstheorie bestimmt werden, wobei gleichzeitig der Einfluss der Schwerkraft wegmaskiert werden kann. - Die Erfindung ist selbstverständlich nicht in irgendeiner Weise auf die vorstehend beschriebene bevorzugte Ausführungsform beschränkt, es werden aber viele Möglichkeiten zu deren Veränderungen einem Fachmann ersichtlich, ohne von dem Umfang der beigefügten Ansprüche abzuweichen.
- Es ist klar, dass die Erfindung überhaupt nicht auf die Tatsache beschränkt ist, dass der Gegenstand vollständig oder teilweise in der Erfassungsposition verdeckt ist, aber es ist ebenfalls denkbar, den Gegenstand zur Bestimmung von Koordinaten und Orientierung eines Gegenstandes in Positionen zu verwenden, in denen der Gegenstand gut sichtbar ist. Dies wäre in Situationen ohne irgendeine optische Bestimmung denkbar und, wenn bestimmte Positionen im Voraus bestimmt werden und der Gegenstand zwischen diesen bekannten Positionen zum Definieren einer oder mehrerer Positionen dazwischen bewegt wird.
- Ebenso ist es möglich, weniger als vier optische Bezugspunkte auf dem Gegenstand anzuordnen, aber die Erfassung kann dann in einigen Positionen schwieriger sein.
Claims (13)
- Verfahren zur Bestimmung von Koordinaten eines Punktes (
15 ) eines Gegenstands (2 ) in einem Koordinaten-Referenzsystem und der Orientierung des Gegenstands im Raum in einer von dem Gegenstand eingenommenen Erfassungsposition (27 ), wobei der Gegenstand von einer Startposition (26 ) mit bekannten Koordinaten und einer bekannten Orientierung zu der Erfassungsposition bewegt wird, während diese Bewegung ermittelt wird, wobei die Koordinaten und die Orientierung des Gegenstands in der Erfassungsposition aus Information über diese Ermittlung und über die Startposition berechnet werden, wobei die Beschleunigung und Verzögerung des Gegenstands während der Bewegung erfasst werden, und die Koordinaten und Orientierung des Gegenstands in der Erfassungsposition aus Information über diese Erfassung berechnet werden, dadurch gekennzeichnet, dass der Gegenstand aus der Erfassungsposition (27 ) in eine dritte Position (28 ) mit bekannten Koordinaten und Orientierung des Gegenstands bewegt wird, während die Beschleunigung und Verzögerung des Gegenstands während dieser Bewegung erfasst werden, dass Koordinaten und Orientierung des Gegenstands in dieser dritten Position aus Information von den zwei Erfassungen berechnet werden, dass die Koordinaten und die für die dritte Position berechnete Orientierung mit den Wirklichen verglichen werden, und dass Koordinaten und Orientierung des Gegenstands in der Erfassungsposition dann aus der Erfassung der Beschleunigung und Verzögerung bei der Bewegung von der Startposition zu der Erfassungsposition berechnet werden, während eine Korrektur gemäß möglicher, in dem Vergleich erstellter Abweichungen der Koordinaten und Orientierung erfolgt. - Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass die Beschleunigung und Verzögerung des Gegenstands bei dem Erfassen hinsichtlich einer Drehung in drei, zueinander orthogonalen Referenzebenen ermittelt werden, und hinsichtlich einer Translation in der Richtung der Senkrechten zu der jeweiligen Referenzebene in einem Kartesischen Koordinatensystem, das von diesen Senkrechten gebildet wird.
- Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, dass die Zeit, die für die Bewegung des Gegenstands zwischen der Startposition (
26 ) und der Erfassungsposition (27 ) und zwischen der Erfassungsposition und der dritten Position (28 ) benötigt wird, erfasst wird, und dass die Korrektur mit einem Gewichtungsfaktor erfolgt, der auf die Abweichungen in Abhängigkeit von der Relation zwischen den für die zwei Bewegungen benötigten Zeiten angewendet wird. - Verfahren nach einem der vorstehenden Ansprüche, dadurch gekennzeichnet, dass es sich um einen Gegenstand (
2 ) handelt, der zwischen den Positionen bewegt wird, um Koordinaten und Orientierung in diesen Positionen als Positionen für einen Teil eines Roboters auf einer Bewegungsbahn hierfür zu speichern. - Verfahren nach einem der vorstehenden Ansprüche, dadurch gekennzeichnet, dass die bekannten Koordinaten und Orientierung des Gegenstands durch die Tatsache erhalten werden, dass eine oder mehrere Kameras (
4 ,5 ) den Gegenstand in ihrem Gesichtsfeld in der fraglichen Position (26 ,28 ) haben, derart dass diese Koordinaten und Orientierung aus Information von der Kamera oder den Kameras berechnet werden können, und dass der Gegenstand aus dem Gesichtsfeld der Kamera oder der Kameras bei einem Bewegen von der Startposition (26 ) zu der Erfassungsposition (27 ) verschwindet. - Vorrichtung zur Bestimmung von Koordinaten eines Punktes (
15 ) eines Gegenstands (2 ) in einem Koordinaten-Referenzsystem und der Orientierung des Gegenstands in dem Raum in einer von dem Gegenstand eingenommenen Erfassungsposition (27 ), wobei der Gegenstand dafür ausgelegt ist, von einer Startposition (26 ) mit bekannten Koordinaten und Orientierung zu der Erfassungsposition bewegt zu werden, wobei die Vorrichtung umfasst, Mittel (20-25 ), die dafür ausgelegt sind, mit der Bewegung assoziierte Parameter zu ermitteln, und Elemente (6 ), die dafür ausgelegt sind, die Koordinaten und Orientierung des Gegenstands in der Erfassungsposition aus Information von den Ermittlungsmitteln über die Parameter und über die Startposition zu berechnen, wobei die Ermittlungsmittel umfassen, Beschleunigungserfassungsvorrichtungen (20-25 ), welche auf dem Gegenstand anzuordnen sind und dafür ausgelegt sind, Beschleunigungen und Verzögerungen des Gegenstands während der Bewegung zu ermitteln, und wobei das Berechnungselement (6 ) dafür ausgelegt ist, die Koordinaten und Orientierung des Gegenstands in der Erfassungsposition auf Basis von Information von den Beschleunigungserfassungsvorrichtungen zu berechnen, dadurch gekennzeichnet, dass der Gegenstand dazu vorgesehen ist, aus der Erfassungsposition (27 ) in eine dritte Position (28 ) mit bekannten Koordinaten und Orientierung des Gegenstands (2 ) bewegt zu werden, dass die Beschleunigungserfassungsvorrichtungen (20-25 ), dafür ausgelegt sind, Beschleunigungen und Verzögerungen während dieser Bewegung zu ermitteln, dass das Berechnungselement (6 ) dafür ausgelegt ist, die Koordinaten und die Orientierung des Gegenstands in der dritten Position aus Information von den Beschleunigungserfassungsvorrichtungen zu berechnen, dass ein Element dafür ausgelegt ist, die derart berechneten Werte der Koordinaten und Orientierung mit den Wirklichen zu vergleichen, und dass das Berechnungselement dafür ausgelegt ist, die neuen Koordinaten und Orientierung für den Gegenstand in der Erfassungsposition aus den Beschleunigungs- und Verzögerungsdaten zu berechnen, die während der ersten Bewegung ermittelt wurden, die möglicherweise gemäß in dem Vergleich erstellter Abweichungen von Koordinaten und Orientierung korrigiert sind. - Vorrichtung nach Anspruch 6, dadurch gekennzeichnet, dass die Mittel umfassen, sechs Beschleunigungserfassungsvorrichtungen (
20-25 ), wobei drei (20-22 ) ausgelegt sind, eine Beschleunigung und Verzögerung für eine Drehung in drei (23-25 ), zueinander orthogonalen Ebenen zu ermitteln, und drei für eine Ermittlung von Beschleunigung und Verzögerung des Gegenstands in der Richtung der Senkrechten zu jeweils einer der Ebenen ausgelegt sind. - Vorrichtung nach Anspruch 6 oder 7, dadurch gekennzeichnet, dass diese umfasst, ein Element, das dafür ausgelegt ist, die Zeit zu erfassen, die für die Bewegung des Gegenstands zwischen der Startposition (
26 ) und der Erfassungsposition (27 ) und zwischen der Erfassungsposition und der dritten Position (28 ) benötigt wird, und dass das Berechnungselement dafür ausgelegt ist, eine Anwendung eines Gewichtungsfaktors auf die Korrektur als eine Folge der Abweichungen in Abhängigkeit von den Relationen zwischen den für die zwei Bewegungen benötigten Zeiten durchzuführen. - Vorrichtung nach einem der Ansprüche 6 bis 8, dadurch gekennzeichnet, dass der Gegenstand (
2 ) dafür ausgelegt ist, zwischen verschiedenen Positionen (26-28 ) entlang einer erwünschten Bewegungsbahn für einen Teil eines Roboters zum Speichern von Koordinaten und Orientierung des Teils des Roboters in diesen Positionen bewegt zu werden. - Vorrichtung nach Anspruch 9, dadurch gekennzeichnet, dass das Berechnungselement (
6 ) dafür ausgelegt ist, Koordinaten für einen Zentralpunkt eines Werkzeugs eines Roboters in der Erfassungsposition zu berechnen. - Vorrichtung nach Anspruch 9 oder 10, dadurch gekennzeichnet, dass das Berechnungselement (
6 ) dafür ausgelegt ist, die Koordinaten und die Orientierung eines Punkts zu berechnen, der mit einer Sprühdüse eines Roboters für eine Sprühaufbringung eines Anstrichmittels assoziiert ist. - Vorrichtung nach einem der Ansprüche 9 bis 11, dadurch gekennzeichnet, dass der Gegenstand (
2 ) dafür ausgelegt ist, bewegt zu werden, um gegen einen Gegenstand (3 ) zu lagern, der ein Roboter ist, der dafür vorgesehen ist, während eines Einnehmens der Erfassungsposition eine Behandlung durchzuführen. - Vorrichtung nach einem der Ansprüche 6 bis 12, dadurch gekennzeichnet, dass eine oder mehrere Kameras (
4 ,5 ) angeordnet sind, um den Gegenstand (2 ) zu beobachten, und Elemente (6 ) angeordnet sind, um die bekannten Koordinaten und Orientierung auf der Basis von Information von der Kamera oder den Kameras zu berechnen, und dass die Erfassungsposition (27 ) außerhalb des Gesichtsfelds für die Kamera oder die Kameras angeordnet ist.
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
SE9903905 | 1999-10-29 | ||
SE9903905A SE515374C2 (sv) | 1999-10-29 | 1999-10-29 | Förfarande och anordning för bestämning av ett objekts koordinater och orientering i ett referenskoordinatsystem |
PCT/IB2000/001529 WO2001030545A1 (en) | 1999-10-29 | 2000-10-24 | A device and a method for determining coordinates and orientation |
Publications (2)
Publication Number | Publication Date |
---|---|
DE60011458D1 DE60011458D1 (de) | 2004-07-15 |
DE60011458T2 true DE60011458T2 (de) | 2005-06-30 |
Family
ID=20417530
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE60011458T Expired - Lifetime DE60011458T2 (de) | 1999-10-29 | 2000-10-24 | Vorrichtung und verfahren zur bestimmung von koordinaten und orientierung |
Country Status (7)
Country | Link |
---|---|
US (1) | US6584378B1 (de) |
EP (1) | EP1227914B1 (de) |
AT (1) | ATE268674T1 (de) |
AU (1) | AU1166801A (de) |
DE (1) | DE60011458T2 (de) |
SE (1) | SE515374C2 (de) |
WO (1) | WO2001030545A1 (de) |
Families Citing this family (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6845295B2 (en) * | 2002-03-07 | 2005-01-18 | Fanuc Robotics America, Inc. | Method of controlling a robot through a singularity |
US7709048B2 (en) | 2002-05-02 | 2010-05-04 | Labcoat, Ltd. | Method and apparatus for coating a medical device |
SE0303379D0 (sv) * | 2003-12-12 | 2003-12-12 | Abb Research Ltd | Method, device and system for programming a robot |
SE0400320D0 (sv) * | 2004-02-06 | 2004-02-06 | Abb Ab | Control method for robots |
WO2006071062A1 (en) * | 2004-12-30 | 2006-07-06 | Samsung Electronics Co., Ltd. | A terminal data format and a communication control system and method using the terminal data format |
DE102006006682B4 (de) * | 2005-07-20 | 2017-03-02 | Volkswagen Ag | Messsystem zur Vermessung eines Kraftfahrzeuges |
US7353135B2 (en) * | 2006-03-07 | 2008-04-01 | Robert Malm | Positioning and aligning the parts of an assembly |
EP2055446A1 (de) | 2007-10-31 | 2009-05-06 | Abb As | Tragbares Robotersteuerungsgerät und Verfahren zur Steuerung der Bewegungen eines Roboters |
EP2075096A1 (de) * | 2007-12-27 | 2009-07-01 | Leica Geosystems AG | Verfahren und System zum hochpräzisen Positionieren mindestens eines Objekts in eine Endlage im Raum |
EP2112465A1 (de) * | 2008-04-24 | 2009-10-28 | Snap-on Equipment Srl a unico socio. | Parametererkennungssystem für Räder |
DE102008062623B4 (de) | 2008-12-17 | 2016-08-04 | Kuka Roboter Gmbh | Verfahren und Vorrichtung zur Auswahl einer gespeicherten Position eines Arbeitspunktes eines Manipulators |
DE102008062624A1 (de) * | 2008-12-17 | 2010-06-24 | Kuka Roboter Gmbh | Handgerät und Verfahren zur Erfassung der Raumposition eines Arbeitspunktes eines Manipulators |
EP2322897A1 (de) * | 2009-11-11 | 2011-05-18 | Günther Battenberg | Optisches und mechanisches Verfahren und Vorrichtung zum Vermessen von Werkstücken |
DE102010019640A1 (de) | 2010-05-06 | 2011-11-10 | Kuka Roboter Gmbh | Handgerät und Verfahren zum Steuern und/oder Programmieren eines Manipulators |
EP2495627A1 (de) * | 2011-03-01 | 2012-09-05 | Siemens Aktiengesellschaft | Verfahren zum Betreiben eines mobilen Bediengeräts sowie mobiles Bediengerät |
US9008757B2 (en) | 2012-09-26 | 2015-04-14 | Stryker Corporation | Navigation system including optical and non-optical sensors |
US9067278B2 (en) | 2013-03-29 | 2015-06-30 | Photon Automation, Inc. | Pulse spread laser |
DE102014102803A1 (de) * | 2014-03-03 | 2015-09-03 | Stotz Feinmesstechnik Gmbh | Vorrichtung zur Vermessung von Objekten |
AU2017294796B2 (en) | 2016-07-15 | 2019-05-30 | Fastbrick Ip Pty Ltd | Brick/block laying machine incorporated in a vehicle |
AU2017294795B2 (en) | 2016-07-15 | 2019-06-13 | Fastbrick Ip Pty Ltd | Boom for material transport |
AU2018295572B2 (en) | 2017-07-05 | 2022-09-29 | Fastbrick Ip Pty Ltd | Real time position and orientation tracker |
EP3669138B1 (de) | 2017-08-17 | 2023-05-24 | Fastbrick IP Pty Ltd | Lasertracker mit verbesserter wankwinkelmessung |
CN111213098B (zh) | 2017-08-17 | 2024-03-15 | 快砖知识产权私人有限公司 | 用于交互系统的通信系统 |
US11401115B2 (en) | 2017-10-11 | 2022-08-02 | Fastbrick Ip Pty Ltd | Machine for conveying objects and multi-bay carousel for use therewith |
CN108050968B (zh) * | 2018-01-09 | 2019-06-04 | 山东大学 | 一种手持式空间物体表面坐标测量仪及测量方法 |
CN113597362A (zh) * | 2019-03-25 | 2021-11-02 | Abb瑞士股份有限公司 | 用于确定机器人坐标系与可移动装置坐标系之间的关系的方法和控制装置 |
Family Cites Families (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3795911A (en) * | 1961-02-02 | 1974-03-05 | C Hammack | Method and apparatus for automatically determining position-motion state of a moving object |
US3866229A (en) * | 1961-02-02 | 1975-02-11 | Hammack Calvin M | Method and apparatus for automatically determining position-motion state of a moving object |
DE2731041C3 (de) | 1976-07-09 | 1981-04-02 | Régie Nationale des Usines Renault, Boulogne-Billancourt, Hauts-de-Seine | Programmiervorrichtung für eine programmgesteuerten Anstrichmanipulator |
US4825394A (en) * | 1985-05-07 | 1989-04-25 | General Dynamics Corporation | Vision metrology system |
JP2532529B2 (ja) | 1987-11-26 | 1996-09-11 | 松下電器産業株式会社 | 電動調理機 |
IT1239878B (it) | 1990-02-02 | 1993-11-15 | Fiat Auto Spa | Sistema per la rilevazione dei parametri di movimento di robot industriali e simili. |
JPH05318359A (ja) | 1992-05-20 | 1993-12-03 | Tokico Ltd | 工業用ロボット |
US5615132A (en) | 1994-01-21 | 1997-03-25 | Crossbow Technology, Inc. | Method and apparatus for determining position and orientation of a moveable object using accelerometers |
JP3394322B2 (ja) * | 1994-05-19 | 2003-04-07 | ファナック株式会社 | 視覚センサを用いた座標系設定方法 |
FR2737024B1 (fr) | 1995-07-20 | 1997-10-10 | Patenotre Laurent | Procede d'apprentissage de forme geometrique, notamment de trajectoire ou de contour, et systemes mettant en oeuvre ce procede |
EP0850730B1 (de) * | 1995-09-14 | 2002-07-24 | Kabushiki Kaisha Yaskawa Denki | Lehrvorrichtung für roboter |
US5988862A (en) * | 1996-04-24 | 1999-11-23 | Cyra Technologies, Inc. | Integrated system for quickly and accurately imaging and modeling three dimensional objects |
JP4085208B2 (ja) * | 1997-07-24 | 2008-05-14 | 株式会社安川電機 | ロボットの制御方法 |
GB9803364D0 (en) * | 1998-02-18 | 1998-04-15 | Armstrong Healthcare Ltd | Improvements in or relating to a method of an apparatus for registering a robot |
US6282459B1 (en) * | 1998-09-01 | 2001-08-28 | International Business Machines Corporation | Structure and method for detection of physical interference during transport of an article |
US6356807B1 (en) * | 1999-08-13 | 2002-03-12 | Fanuc Robotics North America, Inc. | Method of determining contact positions, calibration parameters, and reference frames for robot assemblies |
US6430472B1 (en) * | 1999-12-20 | 2002-08-06 | Servo-Robot Inc. | Robot feature tracking devices and methods |
US6374158B1 (en) * | 2000-02-15 | 2002-04-16 | General Electric Company | Robotic laser pointer |
-
1999
- 1999-10-29 SE SE9903905A patent/SE515374C2/sv not_active IP Right Cessation
-
2000
- 2000-10-24 DE DE60011458T patent/DE60011458T2/de not_active Expired - Lifetime
- 2000-10-24 AU AU11668/01A patent/AU1166801A/en not_active Abandoned
- 2000-10-24 EP EP00973120A patent/EP1227914B1/de not_active Expired - Lifetime
- 2000-10-24 AT AT00973120T patent/ATE268674T1/de not_active IP Right Cessation
- 2000-10-24 US US10/111,281 patent/US6584378B1/en not_active Expired - Lifetime
- 2000-10-24 WO PCT/IB2000/001529 patent/WO2001030545A1/en active IP Right Grant
Also Published As
Publication number | Publication date |
---|---|
SE515374C2 (sv) | 2001-07-23 |
EP1227914A1 (de) | 2002-08-07 |
DE60011458D1 (de) | 2004-07-15 |
SE9903905L (sv) | 2001-04-30 |
AU1166801A (en) | 2001-05-08 |
WO2001030545A1 (en) | 2001-05-03 |
SE9903905D0 (sv) | 1999-10-29 |
US6584378B1 (en) | 2003-06-24 |
EP1227914B1 (de) | 2004-06-09 |
ATE268674T1 (de) | 2004-06-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE60011458T2 (de) | Vorrichtung und verfahren zur bestimmung von koordinaten und orientierung | |
DE60008175T2 (de) | Verfahren zur automatischen Auswahl von Schweissaneinanderreihen für manuelle Schweisszange und manuelle Schweisszange zur Durchführung des Verfahrens | |
DE102014105456B4 (de) | Verfahren zur Vermessung der Außenkontur von dreidimensionalen Messobjekten und zugehöriges Messsystem | |
EP1171752A1 (de) | Indirekte positionsbestimmung mit hilfe eines trackers | |
DE102016220127B4 (de) | Verfahren zum Betrieb eines Koordinatenmessgeräts | |
DE19814630A1 (de) | Verfahren und Vorrichtung zum handgesteuerten Führen eines Werkzeuges in einem vorgegebenen Bewegungsbereich | |
DE4426523A1 (de) | Vorrichtung und Verfahren zur Zentrierungskalibration von Werkzeugen | |
DE60008512T2 (de) | System und verfahren zum nachprüfen der position eines werkzeuges einer werkzeugmaschine | |
DE69933947T2 (de) | Verfahren zur zellausrichtung und identifizierung und kalibrierung eines roboterwerkzeugs | |
EP0763406A1 (de) | Verfahren zum Bestimmen der Lage eines Körpers im Raum | |
DE102011007609A1 (de) | Maschine mit relativ zueinander drehbaren Gliedern | |
WO2019091513A1 (de) | Kalibrierung eines stationären kamerasystems zur positionserfassung eines mobilen roboters | |
DE102020206593A1 (de) | Verfahren und Vorrichtung zur Kalibrierung mindestens eines Sensors | |
DE102019102798A1 (de) | Kombinieren zweier einzelner Robotermanipulatoren zu einem Robotersystem durch Kalibrieren | |
EP1291614A1 (de) | Koordinatenmessung mit Geradheits- und Winkelkalibrierung sowie anschliessender Messwertkorrektur | |
DE4015644C2 (de) | Verfahren zum Bestimmen relevanter Punkte eines Werkzeugs am Handflansch eines gesteuerten mehrachsigen Manipulators | |
EP1471401B1 (de) | Verfahren zur Einmessung des Koordinatensystems einer Kamera eines Roboters gegenüber dem Koordinatensystem des Roboters oder umgekehrt | |
DE10256122B4 (de) | Verfahren und Vorrichtung zur Ermittlung wenigstens einer Zustandsgröße einer Rad-Schiene-Paarung | |
DE102019131401B3 (de) | Kalibrierung einer Impedanzregelung eines Robotermanipulators | |
DE102007056773B4 (de) | Verfahren zum automatischen Bestimmen eines virtuellen Arbeitspunktes | |
DE102013105719A1 (de) | Erfassungsvorrichtung von Drehwinkeln einer Stechkanüle | |
DE2938662A1 (de) | Vorrichtung zum pruefen des kaefigs eines antriebsgelenkes | |
EP1405036A1 (de) | Verfahren zum betreiben eines koordinatenmessgeräts mit einem dreh-schwenk-gelenk | |
DE102015110178B4 (de) | Messvorrichtung | |
DE4126337C2 (de) |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
8364 | No opposition during term of opposition |