Robotergeführte Messanordnung

Die vorliegende Erfindung betrifft eine robotergeführte Messanordnung sowie ein Verfahren zur dynamischen 6D-Vermessung eines Roboters, ein Verfahren zur Kalibrierung einer solchen Messanordnung sowie ein Messgerät für eine solche Messanordnung.

Aus verschiedenen Gründen werden Roboter vorab oder im Betrieb sechsdimensional vermessen: so kann hiermit beispielsweise eine Positioniergenauigkeit überprüft, eine Temperaturdrift, eine Elastizität und/oder ein Verschleiß kompensiert oder eine

Roboter-, insbesondere Gelenkantriebssteuerung kalibriert werden. Zur kompakteren Darstellung wird vorliegend auch eine Regelung verallgemeinernd als Steuerung bezeichnet. Wird nur ein Teilabschnitt eines Regelkreises betrachtet, so steuert in einer Ausführung ein, vorzugsweise vorgelagertes, Sendermodul ein, vorzugsweise nachfolgendes Empfängermodul. Ergibt sich aus einer Anordnung von Sender- Empfängerstrecken ein Kreis zur optimierten Minimierung einer Sollwertabweichung, ist insbesondere dies eine Regelung im Sinne der vorliegenden Erfindung.

Unter einem sechsdimensionalen („6D") Vermessen wird vorliegend insbesondere die Bestimmung einer dreidimensionalen Lage, insbesondere eines Ortsvektors a,

vorzugsweise in einem kartesischen, Zylinder- oder Kugelkoordinatensystem, und einer dreidimensionalen Orientierung, insbesondere der Kardan- oder Eulerwinkel (ψ, θ, φ), eines roboterfesten Referenzkoordinatensystems, beispielsweise des TCPs, relativ zu einem roboterbasis- bzw. -umgebungsfesten Koordinatensystem verstanden. Eine solche 6D-Vermessung kann insbesondere eine sogenannte erweiterte

Transformationsmatrix, eine Denavit-Hartenberg-Matrix oder dergleichen liefern, etwa in der Form

T e9i ^4x4 ΓΛ(ψ, Θ, (p)e<R ^3x3 ae9i ^3x1 l

L OeSl ^{1 *3} 1 J,

Natürlich kann die Lage und Orientierung eines roboterfesten

Referenzkoordinatensystems gleichermaßen durch Quaternionen oder dergleichen beschrieben werden, insofern ist die oben genannte Matrix nur ein Beispiel für eine Transformation zwischen einem roboter- und einem umgebungsfesten

Koordinatensystem.

Zur Vermessung von Robotern werden in betriebsinterner Praxis sogenannte

Lasertracker benutzt. Diese erfassen laserinterferometrisch eine dreidimensionale Position eines passiven Markers. Indem nacheinander drei nicht kollineare Marker erfasst werden, kann auch die Orientierung eines durch diese Marker definierten Referenzkoordinatensystems bestimmt werden.

Nachteilig verfälscht jedoch eine Relativbewegung zwischen Markeranordnung und Lasertracker während der sequentiellen Erfassung der verschiedenen Marker das Messergebnis. Dies wird insbesondere bei schnellen bzw. dynamischen

Roboterbewegungen relevant: bewegt sich beispielsweise ein Roboter, der einen markerbestückten Referenzkörper trägt, während der Lasertracker nacheinander dessen Marker erfasst, ergeben sich falsche Relativpositionen der Marker zueinander, was eine dynamische 6D-Vermessung erschwert, teilweise unmöglich macht. Unter einer dynamischen Messung wird vorliegend insbesondere eine Vermessung während einer Bewegung des Roboters verstanden.

Aufgabe der vorliegenden Erfindung ist es, ein Vermessen eines Roboters zu verbessern. Diese Aufgabe wird durch eine robotergeführte Messanordnung mit den Merkmalen des Anspruchs 1 gelöst. Ansprüche 8, 10 bzw. 12 stellen eine Verfahren zur dynamischen 6D-Vermessung eines Roboters mittels einer solchen Anordnung, ein Verfahren zur Kalibrierung einer solchen Messanordnung bzw. ein Messgerät für eine solche Messanordnung unter Schutz. Die Unteransprüche betreffen vorteilhafte Weiterbildungen.

Gemäß einem Aspekt der vorliegenden Erfindung weist eine robotergeführte

Messanordnung ein Messgerät auf, das drei oder mehr Erfassungsmittel und ein gemeinsames Steuermittel zum Steuern dieser Erfassungsmittel aufweist. Des

Weiteren weist die Messanordnung einen Referenzkörper mit drei oder mehr nicht kollinearen, durch die Erfassungsmitteln erfassbaren passiven Marker, und einen Roboter auf, der das Messgerät oder den Referenzkörper führt. Insbesondere kann einer von dem Referenzkörper und dem Messgerät dauerhaft oder zerstörungsfrei lösbar an dem Roboter befestigt bzw. befestigbar sein, wobei der andere von dem Referenzkörper und dem Messgerät in einer Roboterumgebung, insbesondere an einer Roboterbasis, in einer Roboterzelle oder dergleichen angeordnet bzw. gelagert sein kann. Der Roboter weist in einer Ausführung sechs oder mehr Freiheitsgrade, insbesondere Drehfreiheitsgrade bzw. -gelenke, auf. In einer anderen Ausführung weist der Roboter höchstens, insbesondere genau, drei oder vier Freiheitsgrade auf.

Die Erfassungsmittel sind zur, insbesondere optischen, Erfassung der Position bzw. Lage von passiven Markern eingerichtet. Unter einem passiven Marker wird vorliegend insbesondere ein energieloser Marker bzw. eine energielose Markierung verstanden, der bzw. die eine, insbesondere optische, Strahlung, die von einem Erfassungsmittel ausgestrahlt wird, vorzugsweise gerichtet, an das Erfassungsmittel zurückstrahlt bzw. reflektiert. Die Erfassungsmittel können entsprechend

insbesondere ein optisches Sende- und/oder Empfangsmittel, insbesondere einen Lasertracker, aufweisen.

Die Erfassungsmittel sind in einem ein- oder mehrteiligen gemeinsamen Gehäuse des Messgeräts drehbar. Hierunter wird insbesondere verstanden, dass die

Erfassungsmittel um eine oder mehrere, vorzugsweise wenigstens zwei Achsen, in dem Gehäuse drehbar gelagert und um diese Achse(n) auch, insbesondere

(elektro)motorisch, aktuier- bzw. verstellbar, sind. In einer Ausführung sind wenigstens zwei Erfassungsmittel 2D-kardanisch in dem Gehäuse drehbar. Hierunter wird insbesondere verstanden, dass ein Rahmen bzw. Gehäuse eines Erfassungsmittels um eine erste Achse relativ zu dem gemeinsamen Gehäuse des Messgeräts drehbar ist, und ein optisches Sende- und/oder Empfangsmittel dieses Erfassungsmittels seinerseits, insbesondere unabhängig, um eine zweite Achse relativ zu diesem Rahmen bzw. Gehäuse des Erfassungsmittels drehbar ist.

Wenigstens ein drittes Erfassungsmittel kann ebenfalls 2D-kardanisch in dem gemeinsamen Gehäuse des Messgeräts drehbar sein, wobei dieses gemeinsame Gehäuse dann seinerseits fest bzw. unbeweglich, insbesondere auf einem Stativ, in der Umgebung bzw. an dem Roboter gelagert bzw. angeordnet sein kann. Gleichermaßen kann das gemeinsame Gehäuse des Messgeräts um eine oder mehrere Gehäusedrehachsen gegen eine Gehäuselagerung drehbar sein, die ihrerseits fest bzw. unbeweglich in der Umgebung bzw. an dem Roboter gelagert bzw. angeordnet sein kann. Insbesondere dann kann ein drittes Erfassungsmittel 1 D- kardanisch in dem gemeinsamen Gehäuse des Messgeräts drehbar sein, d.h. um nur eine Achse in dem Gehäuse drehbar gelagert und um diese Achse auch,

insbesondere (elektro)motorisch aktuier- bzw. verstellbar.

Ein Messgerät mit wenigstens zwei 2D-kardanischen und wenigstens einem 1 D- kardanischen Erfassungsmittel kann insbesondere den Vorteil aufweisen, dass die 2D-kardanischen Erfassungsmittel zusammen mit einer Drehung des gemeinsamen Gehäuses des Messgerätes zur Positionierung des 1 D-kardanischen

Erfassungsmittels mitbewegt und so vorpositioniert bzw. -orientiert werden. Zudem wird eine Kaskadierung von Messfehlern zwischen den 2D-kardanischen

Erfassungsmitteln und dem 1 D-kardanischen Erfassungsmittel reduziert bzw.

vermieden.

Ein Messgerät mit wenigstens drei 2D-kardanischen Erfassungsmitteln kann demgegenüber insbesondere den Vorteil aufweisen, dass die drei Erfassungsmittel unabhängig voneinander und insbesondere aufgrund ihrer Trägheit schneller als das gemeinsame Gehäuse positioniert bzw. auf den Referenzkörper und dessen Marker ausgerichtet werden können.

Durch wenigstens einen, vorzugsweise unlimitierten, Drehfreiheitsgrad des

gemeinsamen Gehäuses des Messgerätes kann, insbesondere auch bei wenigstens drei 2D-kardanischen Erfassungsmitteln, der Vorteil erreicht werden, dass ein

Erfassungsraum des Messgeräts nicht durch den, meist konstruktiv begrenzten, Dreh- bzw. Erfassungsraum der Erfassungsmittel limitiert ist. Um diesen Erfassungsraum zu erweitern, kann das gemeinsame Gehäuses des Messgerätes auch träger bzw.

langsamer verstellen als die Erfassungsmittel selber relativ zu diesem Gehäuse. Kann beispielsweise ein Erfassungsmittel (schneller) um etwa 90° relativ zu dem

gemeinsamen Gehäuse des Messgerätes verschwenken, kann durch (langsamere) Drehung des Gehäuses, vorzugsweise unlimitiert bzw. um wenigstens 360°, trotzdem der gesamte Raum erfasst werden. Wenigstens zwei, insbesondere drei Erfassungsmittel eines stationären bzw. in einer Roboterumgebung fest oder drehbar gelagerten Messgeräts können in dem

gemeinsamen Gehäuse, insbesondere horizontal, neben- oder, insbesondere vertikal, übereinander angeordnet sein. Insbesondere kann eine Drehachse eines

Erfassungsmittels, vorzugsweise eine erste Drehachse eines 2D-kardanischen

Erfassungsmittels parallel neben einer Drehachse eines weiteren Erfassungsmittels, vorzugsweise einer ersten Drehachse eines weiteren 2D-kardanischen

Erfassungsmittels, und/oder parallel neben einer Drehachse eines anderen weiteren Erfassungsmittels, vorzugsweise einer Drehachse eines 1 D-kardanischen

Erfassungsmittels oder einer ersten Drehachse eines anderen weiteren 2D- kardanischen Erfassungsmittels, angeordnet sein, wobei die zweiten Drehachsen 2D- kardanischer Erfassungsmittel vorzugsweise in einer Winkelstellung der ersten Drehachsen miteinander fluchten können. Gleichermaßen kann eine Drehachse eines Erfassungsmittels, vorzugsweise eine erste Drehachse eines 2D-kardanischen Erfassungsmittels mit einer Drehachse eines weiteren Erfassungsmittels,

vorzugsweise einer ersten Drehachse eines weiteren 2D-kardanischen

Erfassungsmittels fluchten, und/oder mit einer Drehachse eines anderen weiteren Erfassungsmittels, vorzugsweise einer Drehachse eines 1 D-kardanischen

Erfassungsmittels oder einer ersten Drehachse eines anderen weiteren 2D- kardanischen Erfassungsmittels, fluchten.

Zusätzlich oder alternativ kann eine Drehachse eines Erfassungsmittels,

vorzugsweise eine zweite Drehachse eines 2D-kardanischen Erfassungsmittels oder eine Drehachse eines 1 D-kardanischen Erfassungsmittels, senkrecht zu einer

Gehäusedrehachse des gemeinsamen Gehäuses des Messgeräts orientiert sein, um die das gemeinsame Gehäuse gegen eine Gehäuselagerung drehbar ist.

Durch drei solche 2D-kardanischen Erfassungsmittel bzw. zwei solche 2D- kardanische Erfassungsmittel und ein 1 D-kardanisches Erfassungsmittel in einem gemeinsamen Gehäuse, das um wenigstens eine Gehäusedrehachse gegen eine Gehäuselagerung drehbar ist, können vorteilhaft gleichzeitig bzw. simultan drei passive Marker des Referenzkörpers erfasst und so der Roboter dynamisch bzw. während der Bewegung sechsdimensional vermessen werden. Unter einem

simultanen bzw. gleichzeitigen Erfassen wird vorliegend insbesondere verstanden, dass zu wenigstens im Wesentlichen einem Messzeitpunkt je wenigstens drei Erfassungsmittel des Messgeräts je einen passiven Marker des Referenzkörpers erfassen. Der gemeinsame Messzeitpunkt kann insbesondere dadurch gewährleistet werden, dass in einer Ausführung das gemeinsame Steuermittel eine einzige

Verarbeitungs-, insbesondere Rechnereinheit, insbesondere einen Controller, zum, vorzugsweise (voll)synchronen, Steuern der Erfassungsmittel und in einer

Weiterbildung gegebenenfalls des bzw. der Drehfreiheitsgrade des gemeinsamen Gehäuses des Messgeräts aufweist. Hierdurch können insbesondere

Ungenauigkeiten aufgrund unterschiedlicher Signallaufzeiten reduziert werden. In einer Ausführung sind Mess- bzw. Samplezeitpunkte, an denen Meßwerte der Erfassungsmittel, insbesondere der Lasertracker, vorliegen, wenigstens im

Wesentlichen, gleich.

Insbesondere hierdurch wird es vorteilhaft möglich, Roboter dynamisch

sechsdimensional mit einer Taktrate von über 500 Hz, vorzugsweise von 1 kHz oder mehr zu vermessen, d.h. zu Messzeitpunkten, die höchstens um 2 ms, insbesondere um höchstens 1 ms auseinanderliegen.

Die drei Erfassungsmittel erfassen in einer Ausführung jeweils eine Position bzw. Lage eines passiven Markers in ihrem Referenzkoordinatensystem. Diese Positionen können bei Kenntnis der Transformationen zwischen den

Referenzkoordinatensystemen der Erfassungsmittel ineinander überführt werden. Auf diese Weise können die Positionen der drei passiven Marker, die diese zum selben Messzeitpunkt aufweisen, in einem gemeinsamen Referenzkoordinatensystem, beispielsweise eines kardanischen, insbesondere 1 D- oder 2D-kardanischen, Erfassungsmittels, dargestellt und so die Transformation bzw. Lage und Orientierung zwischen diesem Erfassungsmittel und dem Referenzkörper bzw. dessen,

vorzugsweise vorab relativ zueinander vermessenen, passiven Markern ermittelt werden.

Insbesondere, um die Transformationen zwischen den Referenzkoordinatensystemen der Erfassungsmittel zu bestimmen, kann nach einem Aspekt der vorliegenden Erfindung die Messanordnung kalibriert werden. Hierzu erfassen in einer Ausführung wenigstens drei Erfassungsmittel des Messgeräts je wenigstens drei passive Marker des Referenzkörpers, wobei es prinzipiell auch genügen kann, durch ein

Erfassungsmittel die dreidimensionale Lage eines passiven Markers, eine zweidimensionale Lage eines weiteren passiven Markers sowie eine eindimensionale Lage, insbesondere eine Entfernung, eines anderen weiteren passiven Markers zu erfassen. Werden hingegen jeweils die dreidimensionalen Lagen der drei passiven Marker erfasst, beispielsweise Entfernung zu einem optischen Sende- und/oder Empfangsmittel sowie dessen (Dreh)freiheitsgrade relativ zu dem gemeinsamen Gehäuse oder einem anderen Erfassungsmittel, kann diese Redundanz zum

Fehlerausgleich, insbesondere durch Mittelung der Messwerte, genutzt werden.

Sind die Lagen dreier Marker und damit auch die Orientierung eines durch diese definierten Referenzkoordinatensystems in den Referenzkoordinatensystemen der diese erfassenden Erfassungsmittel bekannt, kann hieraus die Transformation zwischen diesen Erfassungsmitteln bestimmt bzw. ermittelt werden.

Diese Kalibrierung kann in einer Weiterbildung anschließend überprüft und

gegebenenfalls korrigiert werden, indem zwei oder mehr Erfassungsmittel des

Messgeräts jeweils denselben passiven Marker erfassen und seine Position in einem Referenzkoordinatensystem eines Erfassungsmittels in das

Referenzkoordinatensystem des anderen Erfassungsmittels überführt wird.

Der Referenzkörper ist in einer Ausführung derart mit Markern bestückt, dass aus jeder Raumrichtung wenigstens drei Marker sichtbar sind. Dies kann beispielsweise durch Bestückung aller Flächen eines, vorzugsweise regelmäßigen, Polyeders, insbesondere eines Quaders, mit je einem, vorzugsweise mit wenigstens drei Markern, oder durch Bestückung von zwei einander schneidenden Großkreisen eines

kugelförmigen Referenzkörpers mit je wenigstens drei Markern erreicht werden. Die passiven Marker können insbesondere durch eine lokale Beschichtung des

Referenzkörpers oder die Befestigung von, vorzugsweise erhabenen, insbesondere halbkugelförmigen, Markerkörperchen, an dem Referenzkörper ausgebildet werden.

Weitere Vorteile und Merkmale ergeben sich aus den Unteransprüchen und den Ausführungsbeispielen. Hierzu zeigt, teilweise schematisiert:

Fig. 1 : eine robotergeführte Messanordnung nach einer Ausführung der

vorliegenden Erfindung; Fig. 2: ein Messgerät nach einer weiteren Ausführung der vorliegenden

Erfindung in Fig. 1 entsprechender Darstellung;

Fig. 3: ein Kalibrier(prüf)verfahren nach einer Ausführung der vorliegenden Erfindung; und Fig. 4: ein Verfahren zur dynamischen 6D-Messung eines Roboters nach einer

Ausführung der vorliegenden Erfindung.

Fig. 1 zeigt eine robotergeführte Messanordnung nach einer Ausführung der vorliegenden Erfindung mit einem Messgerät 1 , das in einer Roboterumgebung, beispielsweise in einer stationären Roboterzelle oder auf einer beweglichen Plattform, gelagert ist, und mit einem Referenzkörper 2, der von einem Roboter 3 geführt wird. Der Referenzkörper 2 kann dauerhaft oder lösbar, insbesondere nur zur Vermessung, mit dem Roboter 3 verbunden sein. Diese Anordnung ist nur exemplarisch,

insbesondere kann umgekehrt das Messgerät 1 dauerhaft oder lösbar mit dem

Roboter 3 verbunden und der Referenzkörper 2 in einer Roboterumgebung gelagert sein.

Das Messgerät 1 weist ein Gehäuse 1.1 auf. Dies ist in Fig. 1 , 2 rein exemplarisch kastenförmig dargestellt, kann in einer bevorzugten Ausführung jedoch, wenigstens im Wesentlichen, zylindrisch und/oder rotationssymmetrisch zu einer der nachfolgend erläuterten Drehachse ausgebildet sein. In dem Gehäuse 1.1 sind drei Messeinheiten angeordnet. Diese weisen jeweils ein optisches Erfassungsmittel in Form eines Lasertrackers A, B, C auf. Die drei

Lasertracker sind bis auf nachfolgend erläuterte Unterschiede gleich aufgebaut, so dass nachfolgend stellvertretend nur der Lasertracker C erläutert und bezüglich der beiden anderen hierauf Bezug genommen wird. Der Lasertracker C weist eine optische Sende- und/oder Empfangseinrichtung C1 auf. Diese ist um eine in Fig. 1 , 2 fett ausgezogene zweite Achse drehbar in einem

Rahmen C2 angeordnet, was in Fig. 1 durch die Koordinate γ ₂ bzw. a ₂ , ß ₂ für die Lasertracker A, B angedeutet ist. Der Rahmen C2 ist seinerseits um eine in Fig. 1 , 2 fett ausgezogene erste Achse drehbar in dem Gehäuse 1.1 angeordnet, was in Fig. 1 durch die Koordinate y- _\ bzw. αι, ß- _\ für die Lasertracker A, B angedeutet ist. Der Rahmen C2 ist wiederum rein exemplarisch kastenförmig dargestellt, kann in einer bevorzugten Ausführung jedoch auch andere Konturen aufweisen, insbesondere wenigstens im Wesentlichen einen kreuzförmigen Querschnitt, dessen Balken mit den beiden Drehachsen fluchten können. Die Lasertracker A, B und C sind somit jeweils 2D-kardanisch in dem Gehäuse 1.1 gelagert.

Die drei ersten Achsen fluchten miteinander. Zusätzlich oder alternativ zu der drehbaren Anordnung eines Rahmens, insbesondere des Rahmens des Lasertrackers A, im Gehäuse 1.1 , kann das Gehäuse 1.1 um eine, insbesondere mit den ersten Achsen der anderen Lasertracker B, C fluchtende, in Fig. 1 , 2 fett ausgezogene Achse drehbar in der Roboterumgebung gelagert sein, was in Fig. 1 durch die Koordinate αΊ angedeutet ist. In Fig. 1 sind beide Ausführungen gemeinsam dargestellt, wie erläutert, kann der Freiheitsgrad oder Ί auch entfallen. Zur kompakteren Darstellung werden nachfolgend beide Freiheitsgrade notiert, bei Wegfall kann der entsprechende Wert als konstant betrachtet werden, z.B. ι = 0 oder αΊ = 0.

Am Gehäuse 1.1 ist ein gemeinsames Steuermittel in Form eines Controllers 1 .2 des

Messgerätes 1 angeordnet, der die Bewegung αι, α ₂ γ ₂ der drei Lasertracker A, B,

C und gegebenenfalls αΊ des Gehäuses steuert und die Erfassung durch die optischen Sende- und/oder Empfangseinrichtungen gemeinsam steuert und

verarbeitet, insbesondere auswertet.

Fig. 2 zeigt ein Messgerät nach einer weiteren Ausführung der vorliegenden Erfindung in Fig. 1 entsprechender Darstellung. Nachfolgend wird nur auf die Unterschiede eingegangen und im Übrigen Bezug auf die Beschreibung der Ausführung nach Fig. 1 genommen. Während in Fig. 1 das Messgerät 1 , bezogen auf die ersten Achsen seiner

Lasertracker und/oder die Drehachse des Gehäuses, vertikal in der

Roboterumgebung angeordnet ist, ist das Messgerät 1 der Fig. 2 horizontal

angeordnet. Insbesondere sind hier die im Bezug auf die Umgebung ebenfalls vertikalen ersten Drehachsen der Lasertracker A, B und C parallel nebeneinander angeordnet, die zweiten, horizontalen Drehachsen können miteinander fluchten. Wiederum ist auch ein Drehfreiheitsgrad des Gehäuses 1 .1 gegen die Roboterumgebung um eine, vorzugsweise vertikale, Achse eingezeichnet, der zusätzlich oder alternativ zu einem Drehfreiheitsgrad um die erste Achse eines, insbesondere des mittleren Lasertrackers A vorgesehen sein kann. Die Drehachse αΊ kann in einer Abwandlung auch horizontal angeordnet sein.

Die Lasertracker A, B, C definieren jeweils, insbesondere durch eine optische Achse ihrer optischen Sende- und/oder Empfangseinrichtung, ein lokales Koordinatensystem (A), (B) bzw. (C), welche in Fig. 1 links neben dem Messgerät 1 dargestellt sind, und auf die in der nachfolgenden Beschreibung zur kompakteren Darstellung Bezug genommen wird. Die Orientierung der Lasertracker A, B und C bzw. der

Koordinatensysteme (A), (B) und (C) gegenüber dem Gehäuse 1 .1 wird durch deren Freiheitsgrade α-ι ,..., γ ₂ beschrieben. Entsprechend wird eine Transformation T zwischen zwei lokalen Koordinatensystemen durch deren Freiheitsgrade bestimmt:

TAB = Τ _ΑΒ (αι , α ₂ , ßi , ß _2, Offset),

7 _AC = , α ₂ , γ-ι , γ ₂ , Offset), wobei die Transformation Γυν die Transformation vom System V e {(A), (B), (C)} in das System U e {(A), (B), (C)} beschreibt, insbesondere einen Versatz und/oder eine Verdrehung. Die Transformation T kann beispielsweise durch eine sogenannte erweiterte Transformationsmatrix, eine Denavit-Hartenberg-Matrix oder dergleichen beschrieben sein. Offset kann insbesondere einen Versatz von Ursprüngen der Koordinatensysteme gegeneinander beschreiben.

Der robotergeführte Referenzkörper 2 weist eine Menge von Referenzmarkern auf, von denen in Fig. 1 neun Marker Ρ^ . , . , ΡΘ sichtbar sind. Der Referenzkörper 2 ist rein exemplarisch kastenförmig dargestellt, kann in einer bevorzugten Ausführung jedoch auch andere Konturen aufweisen, insbesondere eine rotationssymmetrische, vorzugsweise kugelförmige, Gestalt.

Um eine Vermessung des Roboters durchzuführen, sind vorab die Positionen der Marker relativ zueinander zu vermessen, sie können beispielsweise, wie in Fig. 1 rein exemplarisch angedeutet, als Punkte P^ , ... , PQ in einem referenzkörperfesten Koordinatensystem (R) bekannt sein. Die Marker sind auf dem Referenzkörper 2 so angeordnet, dass stets wenigstens drei von ihnen gleichzeitig aus jeder Raumrichtung sichtbar sind. Insbesondere können die Marker gemäß einer homogenen

Gitterstruktur verteilt sein, so dass je drei benachbarte Marker stets dieselbe relative Lage zueinander aufweisen.

Eine Erfassung eines Markes durch einen Lasertracker ist in Fig. 1 durch einen entsprechenden Vektorpfeil angedeutet. Exemplarisch ist die vom Lasertracker A in dessen lokalem Koordinatensystem (A) erfasste Position _A P _I des Markers P-i , die vom Lasertracker B in dessen lokalem Koordinatensystem (B) erfasste Position _B p ₂ des Markers P ₂ und die vom Lasertracker C in dessen lokalem Koordinatensystem (C) erfasste Position _C P3 des Markers P ₃ eingezeichnet.

Nachfolgend wird zunächst anhand der Fig. 3 ein Kalibrier(prüf)verfahren beschrieben, wie es mittels der Messanordnung, insbesondere durch den Controller 1.2

durchgeführt wird: Hierzu wird ein stationärer Referenzkörper mit wenigstens drei nicht kollinearen

Markern verwendet, beispielsweise der Referenzkörper 2 mit den Markern P-i bis P ₃ . Diese müssen jedoch zur Kalibrierung nicht notwendigerweise vermessen sein.

In einem ersten Schritt S10 werden von den drei Lasertrackern A, B, C nacheinander, d.h. zu verschiedenen Messzeitpunkten tw, die gleichen drei Marker erfasst, wobei die drei Lasertracker jeweils zur gleichen Zeit unterschiedliche Marker erfassen können:

APl(tKl), A 2(tK2), A 3(tK3)>

B l (tK2), B 2(t«3), B 3(t l ),

cPl (tK3), CP2(t l )> cP3(tK2)-

Eine Transformation zwischen einem lokalen Koordinatensystem (A), (B) bzw. (C) bzw. einem Lasertracker und einem Referenzkoordinatensystem (R) bzw. -körper wird durch drei erfasste Marker eindeutig bestimmt, wobei eine Überbestimmung, beispielsweise durch Mittelung, vorteilhaft zur Reduzierung von Messfehlern genutzt werden kann: TRA ⁼ T ^" RA(A I , A 2, AP ₃ ),

TRC ⁼ T ^" RC(C I , CP2, CP3)>

Somit können in einem Schritt S20 aus den in Schritt S10 erfassten Markern P-ι bis P ₃ die Transformationen zwischen den lokalen Koordinatensystemen (A), (B) und (C) bestimmt und das Messgerät 1 kalibriert werden:

T ^" AC ⁼ T ^" AR T C wobei TAR aus T ^" RA bestimmt werden kann. Entsprechend ist darauf hinzuweisen, dass diese Transformationen nur exemplarisch zu verstehen sind - selbstverständlich kann beispielsweise auch umgekehrt jeweils die Transformation Γ _Β Α etc. verwendet werden.

In einem Schritt S30 kann diese Kalibrierung dadurch überprüft werden, dass ein oder mehrere Marker eines Referenzkörpers durch verschiedene Lasertracker erfasst und die Erfassungen miteinander verglichen werden:

Λ - TAC CP - API, i=1 , 2, ... wobei Δ den Kalibrierungsfehler beschreibt. Auf Basis dieser Überprüfung kann die Kalibrierung in Schritt S30 auch korrigiert werden.

Nachfolgend wird anhand der Fig. 4 ein Verfahren zur dynamischen 6D-Messung eines Roboters beschrieben, wie es mittels der Messanordnung, insbesondere durch den Controller 1.2 durchgeführt wird:

Hierzu werden in einem Schritt S1 10 die Lasertracker A, B und C auf den

robotergeführten Referenzkörper 2 ausgerichtet, so dass jeder Lasertracker einen eigenen Marker erfassen kann. Hierzu können sich insbesondere zwei Lasertracker, beispielsweise die Lasertracker B und C, an dem dritten Lasertracker orientieren, sobald dieser seinen Marker gefunden hat. Dies erleichtert die Suche nach Markern. Weist das Messgerät 1 einen Freiheitsgrad αΊ gegenüber der Roboterumgebung auf, kann es in diesem Freiheitsgrad auf den Referenzkörper 2 ausgerichtet werden und so ebenfalls die (Fein)Suche insbesondere der Lasertracker B und C erleichtern.

Dann wird in einem Schritt S120 gleichzeitig, d.h. im Wesentlichen zum selben oder zu nur geringfügig voneinander abweichenden Messzeitpunkten t _M , von jedem

Lasertracker A, B und C je einer der Marker P† bis P ₃ erfasst:

APl(tlVl), BP2(t|Vl), cP3(t|Vl)-

Hieraus kann in Schritt S130 die Transformation TRA bestimmt werden:

T RA^M) ⁼ ΤΡΑ(Α Ι (ΪΜ), TAB B 2(tivi), 7Ac cP3(tivi))- Diese beschreibt die Lage und Orientierung eines, insbesondere durch die Marker P- _\ bis P3 definierten, Referenzkoordinatensystems bzw. des Referenzkörpers 2 und des Koordinatensystems (A) des Erfassungsmittels A bzw. des Messgeräts 1 relativ zueinander und somit auch die Lage und Orientierung des Roboters 3 in seiner Umgebung. Wie vorstehend ausgeführt, kann der Roboter natürlich gleichermaßen in einer anderen mathematischen Implementierung vermessen werden, beispielsweise mit Bezug auf ein Koordinatensystem (B), (C) eines anderen Erfassungsmittels B bzw. C, in einer anderen Darstellung, beispielsweise mittels Quaternionen, und/oder als Transformation vom Referenz- in ein Erfassungsmittel-Koordinatensystem TAR.

Wenn, wie vorstehend ausgeführt, der Drehfreiheitsgrad αι entfällt, d.h. das

Erfassungsmittel A 1 D-kardanisch in dem gemeinsamen Gehäuse 1 .1 drehbar ist, wird dieses gemeinsame Gehäuse um seinen Drehfreiheitsgrad αΊ gedreht, um zusammen mit dem Drehfreiheitsgrad a ₂ das Erfassungsmittel A auf die Marker auszurichten. Hierdurch werden vorteilhaft die Erfassungsmittel B, C mit

vorpositioniert, die Transformationen

AC = T _A c(a ₂ , γ-ι , γ ₂ ), können präziser bestimmt werden. Auch bei einem 2D-kardanischen Erfassungsmittel A kann der Drehfreiheitsgrad Ί des gemeinsamen Gehäuses 1 .1 vorteilhaft den Erfassungsraum des Messgeräts 1 vergrößern, wobei dieser Drehfreiheitsgrad αΊ nicht so schnell aktuiert werden muss wie die Drehfreiheitsgrade der Erfassungsmittel A, B, C selber.

Bezuqszeichenliste

1 Messgerät

1 .1 gemeinsames Gehäuse

1 .2 gemeinsamer Controller (Steuermittel)

2 robotergeführter Referenzkörper

3 Roboter

A, B, C Erfassungsmittel

(A), (B), (C) Koordinatensystem des Erfassungsmittels A, B, C

C1 optisches Sende- und/oder Empfangsmittel C2 Rahmen

Pi P ₉ Marker