DE102012209769B4 - Verfahren zum Betreiben eines Roboters und Vorrichtung mit einem Roboter - Google Patents
Verfahren zum Betreiben eines Roboters und Vorrichtung mit einem Roboter Download PDFInfo
- Publication number
- DE102012209769B4 DE102012209769B4 DE102012209769.4A DE102012209769A DE102012209769B4 DE 102012209769 B4 DE102012209769 B4 DE 102012209769B4 DE 102012209769 A DE102012209769 A DE 102012209769A DE 102012209769 B4 DE102012209769 B4 DE 102012209769B4
- Authority
- DE
- Germany
- Prior art keywords
- robot
- end effector
- coordinate system
- robot arm
- center point
- 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.)
- Active
Links
Images
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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40359—Constraint, physical limitations
-
- 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/40—Robotics, robotics mapping to robotics vision
- G05B2219/40415—Semi active robot, cobot, guides surgeon, operator to planned trajectory, constraint
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
Description
- Die Erfindung betrifft ein Verfahren zum Betreiben eines Roboters und eine Vorrichtung mit einem Roboter.
- Roboter im Allgemeinen sind Handhabungsmaschinen, die zur selbsttätigen Handhabung von Objekten mit zweckdienlichen Werkzeugen ausgerüstet und in mehreren Bewegungsachsen insbesondere hinsichtlich Orientierung, Position und Arbeitsablauf programmierbar sind. Roboter weisen üblicherweise einen Roboterarm mit mehreren Gliedern und programmierbare Steuerungen (Steuervorrichtungen) auf, die während des Betriebs die Bewegungsabläufe des Roboterarms steuern bzw. regeln. Die Antriebe sind z.B. elektrische Antriebe.
- Die
EP 1 294 300 B1 offenbart ein chirurgisches Instrument, welches während eines orthopädischen Eingriffs mittels eines Roboters bewegt wird. Am medizinischen Instrument ist ein Instrumentensensor angebracht und an einem Knochen eines mittels des medizinischen Instruments zu behandelnden Patienten ist ein Referenzsensor angebracht. Die beiden Sensoren sind mit einem Detektor verbunden, welcher eingerichtet ist, aufgrund der von den Sensoren stammenden Signale die Ist-Positionen des Instruments und des Knochens zu ermitteln. Mit dem Detektor ist ein Signalprozessor verbunden, welcher der Robotersteuerung eine Soll-Position relativ zum Referenzsensor für das medizinische Instrument übermittelt, damit das medizinische Instrument die gewünschte Soll-Position einnimmt. Die aktuelle Ist-Position wird mit der Soll-Position verglichen, damit gegebenenfalls iterativ das medizinische Instrument die gewünschte Soll-Position einnimmt. - Die
DE 41 15 846 A1 offenbart ein Verfahren zur berührungslosen räumlichen Positionsmessung in Roboterarbeitsräumen. Mit Hilfe eines Roboterarms werden photogrammetrische Parameter ortsfester, elektronischer Bildaufnehmer bestimmt und auf ein gemeinsames Koordinatensystem bezogen. Dadurch können alle Positionen von nicht an das Roboterkoordinatensystem gebundenen Einrichtungen durch photogrammetrische Vermessung zugeordneter Bildaufnehmer in Bewegungspositionen für den Roboter umgerechnet werden. - Die Aufgabe der Erfindung ist es, ein verbessertes Verfahren zum Betreiben eines Roboters und eine entsprechende Vorrichtung mit einem Roboter anzugeben.
- Die Aufgabe der Erfindung wird gelöst durch ein Verfahren zum Betreiben eines Roboters, der einen mehrere, nacheinander folgende Glieder, eine Befestigungsvorrichtung zum Befestigen eines Endeffektors und Antriebe zum Bewegen der Glieder aufweisenden Roboterarm und eine mit den Antrieben verbundene Steuervorrichtung aufweist, aufweisend folgende Verfahrensschritte:
- a) Bewegen des Roboterarms, insbesondere gesteuert durch die Steuervorrichtung, derart, dass der an der Befestigungsvorrichtung befestigte Endeffektor oder ein dem Endeffektor zugeordneter Tool Center Point eine vorgegebene Position oder Lage einnimmt,
- b) Ermitteln einer ersten Ist-Position des Endeffektors oder des Tool Center Points mittels des Roboterarms, und unabhängig davon, Ermitteln einer zweiten Ist-Position des Endeffektors oder des Tool Center Points mittels einer unabhängigen Positionsermittlungsvorrichtung,
- c) basierend auf den beiden ermittelten Ist-Positionen zugeordneten Koordinaten, Berechnen eines Korrekturvektors, welcher einer Differenz zwischen diesen Koordinaten zugeordnet ist und in Richtung der zweiten ermittelten Ist-Position zugeordneten Koordinate gerichtet ist,
- d) Bewegen des Roboterarms, insbesondere gesteuert durch die Steuervorrichtung, derart, dass der an der Befestigungsvorrichtung befestigte Endeffektor oder der Tool Center Point sich um eine dem Korrekturvektor zugeordnete Strecke bewegt, um eine korrigierte Position oder Lage einzunehmen, und
- e) Wiederholen der Schritte b) bis d) bis zu einem parametrisierbaren Endkriterium.
- Ein weiterer Aspekt der Erfindung betrifft eine Vorrichtung, aufweisend
- - einen Roboter, der einen mehrere, nacheinander folgende Glieder, eine Befestigungsvorrichtung zum Befestigen eines Endeffektors und Antriebe zum Bewegen der Glieder aufweisenden Roboterarm und eine mit den Antrieben verbundene Steuervorrichtung aufweist, wobei der Roboter eingerichtet ist, dass dieser gesteuert durch die Steuervorrichtung den Roboterarm derart bewegt, dass der an der Befestigungsvorrichtung befestigte Endeffektor oder ein dem Endeffektor zugeordneter Tool Center Point eine vorgegebene Position oder Lage einnimmt, und eine erste abgeschätzte Ist-Position des Endeffektors oder des Tool Center Points mittels des Roboterarms ermittelbar ist, und
- - eine Positionsermittlungsvorrichtung, welche eingerichtet ist, unabhängig vom Roboter eine zweite abgeschätzte Ist-Position des Endeffektors oder des Tool Center Points zu ermitteln,
- Erfindungsgemäß soll demnach die Position bzw. Pose des mittels des Roboterarms bewegten Endeffektors bzw. des Tool Center Points bestimmt werden. Dies erfolgt einerseits mittels des Roboterarms als solchen, z.B. aufgrund der Stellungen der Achsen des Roboterarms, und mittels der Positionsermittlungsvorrichtung.
- Mittels des Roboterarms wird demnach die erste ermittelte Ist-Position des Endeffektors oder des Tool Center Points und unabhängig davon die zweite ermittelte Ist-Position des Endeffektors oder des Tool Center Points mittels der Positionsermittlungsvorrichtung ermittelt.
- Die Positionsermittlungsvorrichtung ist demnach vorgesehen, die Position bzw. Pose des Endeffektors zu ermitteln. Der Endeffektor ist z.B. ein medizinisches Instrument.
- Aufgrund der zusätzlichen, Roboter unabhängige Positionsverifikation wird eine redundante Positions- bzw. Lageerkennung z.B. eines chirurgischen Instrumentes als Endeffektor erreicht. Durch diese redundante Positionserfassung des Instrumentes kann zudem eine höhere Sicherheit in der Erfassung der Positioniergenauigkeit des Robotersystems erreicht werden.
- Insbesondere soll die Position, gegebenenfalls auch dessen Orientierung, des Tool Center Points, d.h. einem bestimmten Punkt des Endeffektors, im Falle des medizinischen Instruments beispielsweise dessen Instrumentenspitze, ermittelt werden. Als Positionsermittlungsvorrichtung kann z.B. eine dem Fachmann im Prinzip bekannte optische Positionsermittlungsvorrichtung vorgesehen sein, welche z.B. am Endeffektor oder auch am Roboterarm, insbesondere an dessen Befestigungsvorrichtung, angeordnete Marker aufweist, welche mittels einer Kamera, insbesondere mittels einer Stereokamera, überwacht werden. Die Positionsermittlungsvorrichtung kann auch auf induktiver Basis oder auf akustischen (z.B. Ultraschall) -Messverfahren ausgelegt sein.
- Vorzugsweise kann die Positionsermittlungsvorrichtung mehrere, am Roboterarm und/oder am Endeffektor angeordnete RFID Transponder und ein zum Auslesen der RFID Transponder eingerichtetes Lesegerät aufweisen. Eine solch ausgebildete Positionsermittlungsvorrichtung kann gegebenenfalls auch dann die Position des Tool Center Points bzw. des Endeffektors ausreichend genau bestimmen, wenn bei einer optischen Positionsermittlungsvorrichtung die Sicht auf die Marker versperrt wäre.
- Der Positionsermittlungsvorrichtung kann insbesondere eine Masterfunktion und dem Roboter eine Slavefunktion zugeordnet werden. Demgemäß orientiert sich die Bestimmung des Korrekturvektors an der zweiten ermittelten Ist-Position (Master-Position). Aufgrund der Wiederholung der einzelnen Schritte nähern sich die beiden ermittelten Ist-Positionen immer weiter an, wodurch sich die Genauigkeit der Ist-Position bzw. der Ist-Pose des Endeffektors bzw. des Tool Center Points sich erhöht.
- Die Wiederholung bzw. Iteration wird so lange durchgeführt, bis das Endkriterium erreicht ist. Das Endkriterium ist beispielsweise dann erreicht, wenn der Betrag des Korrekturvektors einen vorgegebenen Betrag unterschreitet.
- Wenn z.B. der Betrag des Korrekturvektors ein vorbestimmtes Maß überschreitet, dann kann es vorgesehen sein, dass das Verfahren abgebrochen wird. In diesem Fall wird demnach der Betrieb des Roboters abgebrochen, da z.B. bei einer derart hohen Messdifferenz der beiden abgeschätzten Ist-Positionen das Risiko eines Messfehlers (Kalibrationsunsicherheit / Fehlpositionierung) zu hoch erscheint.
- Es kann vorgesehen sein, dass dem Roboterarm ein ortsfestes Roboterbasiskoordinatensystem und der Positionsermittlungsvorrichtung ein ortsfestes Basiskoordinatensystem zugeordnet ist. Dann wird vorzugsweise die erste ermittelte Ist-Position in Koordinaten des Roboterbasiskoordinatensystems und die zweite ermittelte Ist-Position in Koordinaten des Basiskoordinatensystems berechnet.
- Um den Korrekturvektor zu berechnen, kann ein von dem Roboterbasiskoordinatensystem und dem Psoitionsermittelungsvorrichtung- Basiskoordinatensystem verschiedenes Referenzkoordinatensystem vorgesehen sein. Dann können die ermittelten Ist-Positionen in Koordinaten des Referenzkoordinatensystems umgerechnet werden, um den Korrekturvektor zu berechnen. Somit kann zunächst die erste ermittelte Ist-Position durch einen ersten Ortsvektor und die zweite ermittelte Ist-Position durch einen zweiten Ortsvektor bezüglich des Referenzkoordinatensystems definiert bzw. umgerechnet werden. Aus diesen beiden Ortsvektoren lässt sich dann der Korrekturvektor aus einer Vektordifferenz beider Ortsvektoren berechnen.
- Es ist aber auch möglich, dass das Basiskoordinatensystem oder das Roboterbasiskoordinatensystem als Referenzkoordinatensystem verwendet wird. Im ersten Fall wird dann die erste ermittelte Ist-Position in Koordinaten des Basiskoordinatensystems umgerechnet, um den Korrekturvektor zu berechnen. Im zweiten Fall wird die zweite ermittelte Ist-Position in Koordinaten des Roboterbasiskoordinatensystems umgerechnet werden, um den Korrekturvektor zu berechnen.
- Somit wird insbesondere für das Ermitteln des Korrekturvektors das Referenzkoordinatensystem gewählt, in dessen Koordinaten die ermittelten Ist-Positionen ausgedrückt bzw. umgerechnet werden. Aufgrund dieser Koordinaten wird der Korrekturvektor berechnet, indem die diesen Koordinaten zugeordneten Ortsvektoren bezüglich des Referenzkoordinatensystem ermittelt werden. Anschließend wird die Vektordifferenz beider Ortsvektoren errechnet.
- Zudem wird das Referenzierungsverfahren gegenüber konventionellen Methoden verbessert: Die Master-Positionsermittlungsvorrichtung erfasst die Positionen des Roboterbasiskoordinatensystem und des Referenzkoordinatensystems. Dabei werden die Koordinaten (Referenz, Roboter und Instrument) auf das Referenzkoordinatensystem umgerechnet, sodass kontinuierlich das Roboterbasiskoordinatensystem, die Instrumentenpose und das Referenzkoordinatensystem gleichzeitig erfasst werden. Da hierbei nur die relative Position zwischen Roboter und Referenzkoordinatensystem betrachtet wird, lassen sich mit dem Verfahren Kalibrationsungenauigkeiten von Roboter und Instrument ausgleichen und damit der Registrierungsprozess verbessern.
- Ein Ausführungsbeispiel der Erfindung ist exemplarisch in den beigefügten schematischen Zeichnungen dargestellt. Es zeigen:
-
1 eine Vorrichtung mit einem Roboter und einer Positionsermittlungsvorrichtung, und -
2 ein Blockdiagramm zum Veranschaulichen einer Regelstrategie für den Roboter. - Die
1 zeigt eine Vorrichtung mit einem Roboter und einer Positionsermittlungsvorrichtung. Die Vorrichtung ist insbesondere als eine medizinische Vorrichtung ausgebildet. - Der Roboter, welcher insbesondere als ein medizinischer Roboter ausgebildet ist, umfasst einen Roboterarm M und eine Steuervorrichtung S. Der Roboterarm M stellt im Wesentlichen den beweglichen Teil des Roboters dar und umfasst mehrere, nacheinander folgende Glieder, die mittels Gelenke miteinender verbunden sind. An einem seiner Enden weist der Roboterarm M eine Befestigungsvorrichtung
1 z.B. in Form eines Flansches auf, an dem ein Endeffektor E befestigt werden kann. Im Falle des vorliegenden Ausführungsbeispiels handelt es sich bei dem Endeffektor E um ein medizinisches Instrument2 . - Der Roboterarm M weist ferner mit der Steuervorrichtung S verbundene, nicht näher dargestellte Antriebe auf, mittels derer die Glieder bezüglich den Gelenken zugeordneten Achsen relativ zueinander bewegt werden können.
- Die Antriebe sind z.B. elektrische Antriebe und können von der Steuervorrichtung S angesteuert werden, sodass die Befestigungsvorrichtung
1 oder ein sogenannter Tool Center Point des Roboters automatisch eine vorbestimmte Position, gegebenenfalls auch eine Orientierung und somit eine Lage einnimmt. Somit nimmt auch der Endeffektor E bzw. das medizinische Instrument2 eine vorbestimmte Position bzw. Lage ein. - Im Falle des vorliegenden Ausführungsbeispiels ist dem Roboter ein Roboterbasiskoordinatensystem
3 zugeordnet, welches insbesondere ortsfest bezüglich eines Grundgestells des Roboterarms M ist. Das Roboterbasiskoordinatensystem3 ist insbesondere ein kartesisches Koordinatensystem. Des Weiteren ist ein ortsfestes Referenzkoordinatensystem4 vorgesehen, welches vorzugsweise ebenfalls ein kartesisches Koordinatensystem ist. - Die Positionsermittlungsvorrichtung ist vorgesehen, die Position, gegebenenfalls die Lage des Endeffektiors E gegebenenfalls des medizinischen Instruments
2 im Raum zu ermitteln. Insbesondere soll die Position bzw. Lage des Tool Center Points, d.h. einem bestimmten Punkt des Endeffektors E bzw. des medizinischen Instruments2 , z.B. dessen Spitze, ermittelt werden. Als Positionsermittlungsvorrichtung kann z.B. eine dem Fachmann im Prinzip bekannte optische Positionsermittlungsvorrichtung vorgesehen sein, welche z.B. am Endeffektor E bzw. am medizinischen Instrument2 oder auch am Roboterarm M, insbesondere an dessen Befestigungsvorrichtung1 angeordnete Marker aufweist, welche mittels einer Kamera, insbesondere mittels einer Stereokamera überwacht werden. Die Positionsermittlungsvorrichtung kann auch auf induktiver Basis ausgelegt sein. - Im Falle des vorliegenden Ausführungsbeispiels weist die Positionsermittlungsvorrichtung am Endeffektor E bzw. am medizinischen Instrument
2 angeordnete RFID Transponder5 und ein RFID-Lesegerät6 auf. Die Transponder5 können aktive oder passive Transponder sein. Aktive Transponder5 können eine höhere Signalleistung und damit eine bessere Signalqualität aufweisen. Passive Transponder haben den Vorteil ohne Kabel auszukommen. Dessen ungeachtet kann die Energieversorgung der Transponder5 auch über einen gegebenenfalls im Roboterarm M integrierten Energieversorgungskanal umgesetzt werden. - Dem Lesegerät
6 ist ein ortsfestes Koordiantensystem7 zugeordnet, welches insbesondere ein kartesisches Koordinatensystem ist. Das Lesegerät6 kann beispielsweise mit der Steuervorrichtung S kommunizieren. - Im Falle des vorliegenden Ausführungsbeispiels kann der Roboter bzw. sein Roboterarm M z.B. neben seiner Funktion als aktiver Assistenzarm oder Instrumenten-Positionierungsgerät, auch als elektromechanisches Tracking System (Positionsermittlungssystem) angesehen werden. Betrachtet man ein definiertes Zielvolumen
8 , beispielsweise einen Quader, so kann der Roboter als solcher und die Positionsermittlungsvorrichtung zur unabhängigen Positions- oder Lageerfassung (z.B. des medizinischen Instrumentes2 ) im Zielvolumen8 herangezogen werden. - Insbesondere ist das medizinische Instrument
2 bzw. der Endeffektor E fest und formschlüssig mit der Befestigungsvorrichtung1 des Roboterarms M verbunden. Die Positionsermittlungsvorrichtung und das in Form des Roboterarms M ausgebildete Positionsermittlungssystem werden insbesondere zur Erhöhung der Messgenauigkeit auf das Zielvolumen8 optimiert. Dies bedeutet, dass sich vorzugsweise das Zielvolumen8 im insbesondere idealen Messbereich des RFID-Lesegerät6 befindet und insbesondere für den Roboter ein ausgewählter Arbeitsbereich definiert wird. - Zudem können sich für den Roboter spezielle Kalibrations-Werte, sogenannte PID-Files, für einen bestimmten Arbeitsbereich programmieren lassen. Die Positionierungsgenauigkeit des Positionsermittlungssystems (Roboter) wird durch die Messauflösung der Positionsauflösung des Roboters sowie gegebenenfalls der spezifischen Zustellgenauigkeit des Roboters begrenzt.
- Vorzugsweise verfügen beide Systeme (Roboter und Positionsermittelungsvorrichtung) über eine möglichst gleichwertige Messauflösung.
- Die Position bzw. Lage des medizinischen Instrumentes
2 bzw. des Tool Center Points im Raum, lässt sich zum einen über das „elektromechanische Trackingsystem Roboterarm“ (Positionsermittlungssystem), zum andern über die Positionsermittlungsvorrichtung bestimmen. - Im vorliegenden Ausführungsbeispiel wird die Instrumentenspitze des medizinischen Instruments
2 bzw. der Tool Center Point vom Roboter mit einer räumlichen Toleranz, veranschaulicht in Form eines Kugelradius r1 einer Kugel K1, auf eine vorgegebene Soll-Koordinate im Raum positioniert. Mittels des Roboters, z.B. aufgrund der Stellungen der Achsen des Roboterarms M, wird eine erste ermittelte Ist-Position Prob des Tool Center Points ermittelt und über einen Vektor TRI1 bezüglich des Roboterbasiskoordinatensystems3 dargestellt. - Mittels der Positionsermittlungsvorrichtung wird eine zweite Ist-Position Prfid ermittelt und mit einer Messtoleranz innerhalb einer Kugel K2 mit einem Kugelradius r2 durch einen Vektor TRI2 bezüglich des Koordinatensystems
7 des Lesegerätes6 dargestellt. - Die erste abgeschätzte Ist-Position Prob kann durch einen ersten Ortsvektor TRRIrob und die zweite abgeschätzte Ist-Position Prfid kann durch einen zweiten Ortsvektor TRRIrfid bezüglich des Referenzkoordinatensystems
4 definiert werden. - Ziel ist es, die abgeschätzten Ist-Positionen Prob, Prfid relativ gut, wenn nicht gar bestmöglich in Deckung zu bringen.
- Das Referenzkoordinatensystem
4 bildet im Falle des vorliegenden Ausführungsbeispiels einen festen, definierten Bezugspunkt im Raum und dient beiden Systemen, d.h. der Positionsermittlungsvorrichtung und dem Roboter, ggf. weiteren relevanten Systemen, als Bezugskoordinatensystem. Optional kann das Bezugskoordinatensystem aber auch auf einem Patienten-Lokalisator, einer definierten Patientenstruktur, einem Bildgebungsgerät, dem Lesegerät6 , einem Roboterfuß bzw. einem Gestell des Roboterarms M oder einen beliebigen anderen Punkt im Raum oder am/im Patienten definiert werden. Alle Positionskoordinaten im Zielvolumen8 werden im Falle des vorliegenden Ausführungsbeispiels über eine entsprechende Koordinatentransformation in Bezug zum Referenzkoordinatensystem4 bestimmt. - Im Falle des vorliegenden Ausführungsbeispiels kann über die Positionsermittlungsvorrichtung nicht nur die aktuelle Position des Endeffektors E oder des medizinischen Instruments
2 bzw. des Tool Center Points, sondern optional auch weitere Positionskoordinaten, wie z.B. Strukturen eines mit dem Roboter behandelnden Objekts, beispielsweise eines Patienten, im Zielvolumen8 ermittelt werden. Ein Beispiel einer Struktur sind Knochen. - Im Falle des vorliegenden Ausführungsbeispiels wird der Positionsermittlungsvorrichtung eine Masterfunktion und dem Roboter eine Slavefunktion zugeordnet. Demgemäß orientiert sich die Bestimmung eines Roboter Korrekturvektors rkv an der zweiten ermittelten Ist-Position Prfid, die außerdem durch den zweiten Ortsvektor TRRIrfid bezüglich des Referenzkoordinatensystems
4 definiert wird. Über einen Vergleich der beiden Ortsvektoren TRRIrob zu TRRIrfid kann der Korrekturvektor rkv in Relation zum Referenzkoordinatensystem4 berechnet werden. - Im Falle des vorliegenden Ausführungsbeispiels erfolgt eine Messdatenerfassung zum Bestimmen der Position des Tool Center Points über beide Messsysteme unabhängig. Liegen die unabhängig ermittelten abgeschätzten Ist-Positionen Prfid, Prob nicht weiter als um 2* (|r1| + |r2|) auseinander, so schneiden bzw. berühren sich die beiden virtuellen Kugeln K1, K2 der Messtoleranz-Volumina beider Systeme. Bei größeren Abständen wird im Falle des vorliegenden Ausführungsbeispiels der Betrieb des Roboters abgebrochen, da z.B. bei einer derart hohen Messdifferenz das Risiko eines Messfehlers (Kalibrationsunsicherheit / Fehlpositionierung) zu hoch erscheint.
-
- Anschließend wird der Korrekturvektor rkv zu dem Roboter zugeordneten ersten Ortvektor TRRIrob addiert. Über einen als Blockschaltbild schematisch in der
2 gezeigten iterativen Regelkreis werden die beiden abgeschätzten Ist-Positionen Prob, Prfid immer weiter angeglichen und damit Kalibrationsungenauigkeiten (z.B. Roboterkinematik, Instrument etc.) reduziert, wenn nicht gar minimiert. - Im Falle des vorliegenden Ausführungsbeispiels wird die iterative Positionsregelung folgendermaßen durchgeführt:
- Die Steuervorrichtung S des Roboters steuert die Antriebe des Roboterarms M derart an, sodass dieser den Tool Center Point an eine vorgegebene Sollkoordinate (Sollposition) im Raum bewegt, Schritt A des Flussdiagramms der
2 . Hat der Roboterarm M die Sollposition angefahren, dann erzeugt im Falle des vorliegenden Ausführungsbeispiels die Steuervorrichtung S ein Triggersignal, Schritt B des Flussdiagramms, und übermittelt dem Lesegerät6 der Positionsermittlungsvorrichtung ein entsprechendes Signal. Daraufhin ermittelt das aus dem Roboterarm M gebildete Positionsermittlungssystem im angefahrenen Punkt die erste abgeschätzte Ist-Position Prob des Tool Center Points, Schritt C des Flussdiagramms, und die Positionsermittlungsvorrichtung die zweite abgeschätzte Ist-Position Prfid, Schritt D des Flussdiagramms, indem das Lesegerät6 die am Endeffektor E bzw. am medizinischen Instrument2 , gegebenenfalls am Roboterarm M angebrachten RFID-Transponder5 ausliest. - Beispielsweise über einen nicht näher dargestellten Rechner, z.B. einem externen PC, oder mittels der Steuervorrichtung S findet anschließend ein Plausibilitäts-Check („befinden sich die Messdaten innerhalb einer definierten Toleranz?“) und ein Messdatenvergleich der beiden abgeschätzten Ist-Positionen Prob, Prfid statt, Schritt E des Flussdiagramms.
- In Abhängigkeit des zugrunde liegenden Iterationsalgorithmus und der Differenz aus dem Messdatenvergleich wird bei Bedarf vom Rechner der Korrekturvektor rkv berechnet, Schritt F des Flussdiagramms. Anschließend steuert die Steuervorrichtung S die Antriebe des Roboterarms M derart an, sodass der Roboterarm M den Endeffektor E bzw. das medizinische Instrument 2 derart bewegt, sodass der Tool Center Point um den Korrekturvektor rkv verschoben wird. Dadurch wird eine neue Position angefahren, wieder Schritt A des Flussdiagramms.
- Es folgen weitere Messungen über die Positionsermittlungsvorrichtung und dem Positionsermittlungssystem, d.h. die Schritte B bis F werden mehrmals wiederholt. Die Position des Endeffektors E bzw. des medizinischen Instrumentes
2 bzw. des Tool Center Points wird vom Roboter nach jeder Positionsmessung in Form einer iterativen Positionskorrekturschleife korrigiert. Die Iteration erfolgt solange, bis die abgeschätzten Ist-Positionen Prob, Prfid einen vorgegebenen, insbesondere kleinstmöglichen Abstand zueinander aufweisen (theoretisches Ideal: Prob = Prfid). - Allerdings sind in der Regel Auflösevermögen des Positionsermittlungssystems und der Positionsermittlungsvorrichtung sowie die Zustellgenauigkeit rz des Roboters begrenzt. Mit einem geeigneten Iterationsalgorithmus wird deshalb eine Zeit- / genauigkeitsoptimierte Näherung (Prob ≈ Prfid) für die Zielkoordinate generiert und die Regelschleife bei Erfüllung einer hinreichenden Genauigkeits-Bedingung abgebrochen. Ein Kriterium für einen solchen Iterationsabbruch könnte beispielsweise mit einem parametrisierbarem Korrekturvektor rkv (z.B. |rkv| → 0 ≤ |rkv| ≤ |rz|) umgesetzt werden. Die Zustellgenauigkeit des Roboters kann über ein Software-Modul optimierbar sein. Zusätzlich kann ein Algorithmus ermitteln werden, wonach z.B. das Getriebe-Umschlagsspiel oder Gravitationseffekte vermieden bzw. optimiert werden. So könnte beispielsweise je nach Roboter-Pose eine individuelle Anfahrtstrategie berechnet werden, um die Zustellgenauigkeit (|rz|) spezifisch zu verbessern.
- Nachdem die Zielposition erreicht wurde, erfolgt im Falle des vorliegenden Ausführungsbeispiels fortlaufend eine Überwachung der aktuellen Positionskoordinate, Schritt G des Flussdiagramms. Die Zeit zwischen zwei aufeinander folgenden Messungen (Messabtastfrequenz) bzw. die Frequenz der Korrekturschleifen (Iteration) kann vorzugsweise parametrisierbar sein. Unbeabsichtigte Abweichungen der Roboterposition, die beispielsweise durch den Bearbeitungsprozess, z.B. Knochen-Fräsen, hervorgerufen wurden, können kontinuierlich detektiert und mittels eines geeigneten Regelalgorithmus direkt ausgeglichen werden.
Claims (9)
- Verfahren zum Betreiben eines Roboters, der einen mehrere, nacheinander folgende Glieder, eine Befestigungsvorrichtung (1) zum Befestigen eines Endeffektors (E, 2) und Antriebe zum Bewegen der Glieder aufweisenden Roboterarm (M) und eine mit den Antrieben verbundene Steuervorrichtung (S) aufweist, aufweisend folgende Verfahrensschritte: a) Bewegen des Roboterarms (M), insbesondere gesteuert durch die Steuervorrichtung (S), derart, dass der an der Befestigungsvorrichtung (1) befestigte Endeffektor (E, 2) oder ein dem Endeffektor (E, 2) zugeordneter Tool Center Point eine vorgegebene Position oder Lage einnimmt, b) Ermitteln einer ersten Ist-Position (Prob) des Endeffektors (E, 2) oder des Tool Center Points mittels des Roboterarms (M), und unabhängig davon, Ermitteln einer zweiten Ist-Position (Prifd) des Endeffektors (E, 2) oder des Tool Center Points mittels einer unabhängigen Positionsermittlungsvorrichtung, c) basierend auf den beiden ermittelten Ist-Positionen (Prob, Prif) zugeordneten Koordinaten, Berechnen eines Korrekturvektors (rkv), welcher einer Differenz zwischen diesen Koordinaten zugeordnet ist und in Richtung der der zweiten ermittelten Ist-Position (Prifd) zugeordneten Koordinate gerichtet ist, d) Bewegen des Roboterarms (M), insbesondere gesteuert durch die Steuervorrichtung (S), derart, dass der an der Befestigungsvorrichtung (1) befestigte Endeffektor (E, 2) oder der Tool Center Point sich um eine dem Korrekturvektor (rkv) zugeordnete Strecke bewegt, um eine korrigierte Position oder Lage einzunehmen, und e) Wiederholen der Schritte b) bis d) bis zu einem parametrisierbaren Endkriterium.
- Verfahren nach
Anspruch 1 , bei dem das Endkriterium dann erreicht ist, wenn der Betrag des Korrekturvektors (rkv) einen vorgegebenen Betrag unterschreitet. - Verfahren nach
Anspruch 1 oder2 , bei dem das Verfahren abgebrochen wird, wenn der Betrag des Korrekturvektors (rvk) ein vorbestimmtes Maß überschreitet. - Verfahren nach einem der
Ansprüche 1 bis3 , bei dem die Positionsermittlungsvorrichtung mehrere, am Roboterarm (M) und/oder am Endeffektor (E, 2) angeordnete RFID Transponder (5) und ein zum Auslesen der RFID Transponder (5) eingerichtetes Lesegerät (6) aufweist. - Verfahren nach einem der
Ansprüche 1 bis4 , bei dem dem Roboterarm (M) ein ortsfestes Roboterbasiskoordinatensystem (3) und der Positionsermittlungsvorrichtung ein ortsfestes Basiskoordinatensystem (7) zugeordnet ist, die erste ermittelte Ist-Position (Prob) in Koordinaten des Roboterbasiskoordinatensystems und die zweite ermittelte Ist-Position (Prifd) in Koordinaten des Basiskoordinatensystems (7) berechnet werden. - Verfahren nach
Anspruch 5 , bei dem ein von dem Roboterbasiskoordinatensystem (3) und dem Basiskoordinatensystems (7) verschiedenes Referenzkoordinatensystem (4) vorgesehen ist, die ermittelten Ist-Positionen (Prob, Prifd) in Koordinaten des Referenzkoordinatensystems (4) umgerechnet werden, um den Korrekturvektor (rkv) zu berechnen. - Verfahren nach
Anspruch 5 , bei dem die erste ermittelte Ist-Position (Prob) in Koordinaten des Basiskoordinatensystems (7) umgerechnet werden, um den Korrekturvektor (rkv) zu berechnen, oder bei dem die zweite ermittelte Ist-Position (Prfid) in Koordinaten des Roboterbasiskoordinatensystems (3) umgerechnet werden, um den Korrekturvektor (rkv) zu berechnen - Vorrichtung, aufweisend - einen Roboter, der einen mehrere, nacheinander folgende Glieder, eine Befestigungsvorrichtung (1) zum Befestigen eines Endeffektors (E, 2) und Antriebe zum Bewegen der Glieder aufweisenden Roboterarm (M) und eine mit den Antrieben verbundene Steuervorrichtung (S) aufweist, wobei der Roboter eingerichtet ist, dass dieser gesteuert durch die Steuervorrichtung (S) der Roboterarm (M) derart bewegt, dass der an der Befestigungsvorrichtung (1) befestigte Endeffektor (E, 2) oder ein dem Endeffektor (E, 2) zugeordneter Tool Center Point eine vorgegebene Position oder Lage einnimmt, und eine erste ermittelte Ist-Position (Prob) des Endeffektors (E, 2) oder des Tool Center Points mittels des Roboterarms (M) ermittelbar ist, und - eine Positionsermittlungsvorrichtung, welche eingerichtet ist, unabhängig vom Roboter eine zweite ermittelte Ist-Position (Prifd) des Endeffektors (E, 2) oder des Tool Center Points zu ermitteln, wobei die Vorrichtung eingerichtet ist, das Verfahren nach einem der
Ansprüche 1 bis7 durchzuführen. - Vorrichtung nach
Anspruch 8 , bei der die Positionsermittlungsvorrichtung mehrere, am Roboterarm (M) und/oder am Endeffektor (E, 2) angeordnete RFID Transponder (5) und ein zum Auslesen der RFID Transponder (5) eingerichtetes Lesegerät (6) aufweist.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102012209769.4A DE102012209769C5 (de) | 2012-06-12 | 2012-06-12 | Verfahren zum Betreiben eines Roboters und Vorrichtung mit einem Roboter |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102012209769.4A DE102012209769C5 (de) | 2012-06-12 | 2012-06-12 | Verfahren zum Betreiben eines Roboters und Vorrichtung mit einem Roboter |
Publications (3)
Publication Number | Publication Date |
---|---|
DE102012209769A1 DE102012209769A1 (de) | 2013-12-12 |
DE102012209769B4 true DE102012209769B4 (de) | 2018-09-06 |
DE102012209769C5 DE102012209769C5 (de) | 2021-11-11 |
Family
ID=49625920
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE102012209769.4A Active DE102012209769C5 (de) | 2012-06-12 | 2012-06-12 | Verfahren zum Betreiben eines Roboters und Vorrichtung mit einem Roboter |
Country Status (1)
Country | Link |
---|---|
DE (1) | DE102012209769C5 (de) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102019105466B3 (de) * | 2019-03-04 | 2020-08-06 | Forward Ttc Gmbh | Verfahren zum Betrieb eines Antriebssystems sowie Antriebssystem |
DE102021212542B3 (de) | 2021-11-08 | 2022-12-22 | Volkswagen Aktiengesellschaft | Verfahren zum Betreiben eines mehrachsigen Roboters und Roboter |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112932670B (zh) * | 2020-11-07 | 2022-02-08 | 北京和华瑞博医疗科技有限公司 | 校准方法、机械臂控制方法及外科手术*** |
CN115153855B (zh) * | 2022-07-29 | 2023-05-05 | 中欧智薇(上海)机器人有限公司 | 一种微型机械臂的定位对准方法、装置及电子设备 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE4115846A1 (de) | 1991-05-15 | 1992-11-19 | Ameling Walter | Verfahren zur beruehrungslosen raeumlichen positionsmessung in roboterarbeitsraeumen |
US20040093119A1 (en) | 2000-04-10 | 2004-05-13 | Svante Gunnarsson | Pathcorrection for an industrial robot |
EP1294300B1 (de) | 2000-06-28 | 2004-11-03 | Depuy International Limited | Gerät zur positionierung eines chirurgischen instruments |
DE102005000732A1 (de) | 2005-01-04 | 2006-07-13 | Siemens Ag | Funkbasiertes Ortungssystem mit synthetischer Apertur |
DE102006003555A1 (de) | 2006-01-25 | 2007-07-26 | Edag Engineering + Design Ag | Steuerung für eine Werkzeug-Sensor-Vorrichtung |
EP1854425A1 (de) | 2006-05-11 | 2007-11-14 | BrainLAB AG | Medizintechnische Positionsbestimmung mit redundanten Positionserfassungseinrichtungen und Prioritätsgewichtung für die Positionserfassungseinrichtungen |
DE102007018810A1 (de) | 2007-04-20 | 2008-10-30 | Siemens Ag | Verfahren zur Bewegungsüberwachung bei einer medizintechnischen Anlage sowie zugehörige medizintechnische Anlage |
DE102008054501A1 (de) | 2008-12-10 | 2010-06-17 | Kuka Roboter Gmbh | Industrieroboter und Verfahren zum Betreiben eines Industrieroboters |
-
2012
- 2012-06-12 DE DE102012209769.4A patent/DE102012209769C5/de active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE4115846A1 (de) | 1991-05-15 | 1992-11-19 | Ameling Walter | Verfahren zur beruehrungslosen raeumlichen positionsmessung in roboterarbeitsraeumen |
US20040093119A1 (en) | 2000-04-10 | 2004-05-13 | Svante Gunnarsson | Pathcorrection for an industrial robot |
EP1294300B1 (de) | 2000-06-28 | 2004-11-03 | Depuy International Limited | Gerät zur positionierung eines chirurgischen instruments |
DE102005000732A1 (de) | 2005-01-04 | 2006-07-13 | Siemens Ag | Funkbasiertes Ortungssystem mit synthetischer Apertur |
DE102006003555A1 (de) | 2006-01-25 | 2007-07-26 | Edag Engineering + Design Ag | Steuerung für eine Werkzeug-Sensor-Vorrichtung |
EP1854425A1 (de) | 2006-05-11 | 2007-11-14 | BrainLAB AG | Medizintechnische Positionsbestimmung mit redundanten Positionserfassungseinrichtungen und Prioritätsgewichtung für die Positionserfassungseinrichtungen |
DE102007018810A1 (de) | 2007-04-20 | 2008-10-30 | Siemens Ag | Verfahren zur Bewegungsüberwachung bei einer medizintechnischen Anlage sowie zugehörige medizintechnische Anlage |
DE102008054501A1 (de) | 2008-12-10 | 2010-06-17 | Kuka Roboter Gmbh | Industrieroboter und Verfahren zum Betreiben eines Industrieroboters |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102019105466B3 (de) * | 2019-03-04 | 2020-08-06 | Forward Ttc Gmbh | Verfahren zum Betrieb eines Antriebssystems sowie Antriebssystem |
DE102021212542B3 (de) | 2021-11-08 | 2022-12-22 | Volkswagen Aktiengesellschaft | Verfahren zum Betreiben eines mehrachsigen Roboters und Roboter |
Also Published As
Publication number | Publication date |
---|---|
DE102012209769C5 (de) | 2021-11-11 |
DE102012209769A1 (de) | 2013-12-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3558599B1 (de) | Verfahren zum kalibrieren eines manipulators eines diagnostischen und/oder therapeutischen manipulatorsystems | |
DE112016002797B4 (de) | Kalibriervorrichtung und robotersystem mit einer solchen kalibriervorrichtung | |
EP2211751B1 (de) | Einen roboter aufweisende vorrichtung, medizinischer arbeitsplatz und verfahren zum registrieren eines objekts | |
DE10145587B4 (de) | Verfahren und Vorrichtung zur Prüfung eines Markierungselementes auf Verrückung | |
EP1817547B1 (de) | Verfahren und eine vorrichtung zum navigieren und positionieren eines gegenstands relativ zu einem patienten | |
DE102004042489B4 (de) | Medizinische Untersuchungs- oder Behandlungseinrichtung mit dazugehörigem Verfahren | |
EP2214872B1 (de) | Roboter und verfahren zum projizieren eines bildes auf die oberfläche eines objekts | |
EP1854425A1 (de) | Medizintechnische Positionsbestimmung mit redundanten Positionserfassungseinrichtungen und Prioritätsgewichtung für die Positionserfassungseinrichtungen | |
EP3476358B1 (de) | System zum nachverfolgen einer position eines zielobjekts | |
DE102008041260A1 (de) | Verfahren zum Betreiben eines medizinischen Roboters, medizinischer Roboter und medizinischer Arbeitsplatz | |
DE102007055205A1 (de) | Verfahren zum Ermitteln eines Aufstellortes und zum Aufstellen einer Erfassungsvorrichtung eines Navigationssystems | |
DE102012209769B4 (de) | Verfahren zum Betreiben eines Roboters und Vorrichtung mit einem Roboter | |
WO2015185235A1 (de) | Verfahren und vorrichtung zur strahlerpositionierung | |
DE102012112025B4 (de) | Verfahren und Vorrichtungen zur Positionsbestimmung einer Kinematik | |
DE102010015633B4 (de) | Verfahren zum Einsatz einer Markervorrichtung bei einem bildgebenden Durchleuchtungssystem, Markervorrichtung und bildgebendes Durchleuchtungssystem | |
DE102008009266B4 (de) | Verfahren und Einrichtung zur Kalibrierung einer Instrumentenlokalisierungseinrichtung mit einer Bildgebungsvorrichtung | |
DE102014208540A1 (de) | Vorrichtung und Verfahren zur kontaktlosen Steuerung eines Patiententisches | |
EP2110162B1 (de) | Medizinische Anlage und Verfahren zum Docken einer Positioniervorrichtung an ein Shuttle | |
EP2098168B1 (de) | Kalibrierung eines C-Bogen-Röntgengeräts | |
DE102011050240A1 (de) | Vorrichtung und Verfahren zur Bestimmung der relativen Position und Orientierung von Objekten | |
EP0957803B1 (de) | Vorrichtung zum positionieren und führen eines chirurgischen werkzeuges bei orthopädischen eingriffen | |
WO2009095350A1 (de) | Roboter und verfahren zum parametrieren eines robotermodells | |
EP4062854A1 (de) | Verfahren und vorrichtung zur osteotomieverifizierung, lesbares speichermedium und system für orthopädische chirurgie | |
DE102022125798A1 (de) | Verfahren zur medizintechnischen Kalibrierung | |
CN117122413A (zh) | 用于骨科手术机器人的基于oct成像的定位导航方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
R163 | Identified publications notified | ||
R012 | Request for examination validly filed | ||
R016 | Response to examination communication | ||
R081 | Change of applicant/patentee |
Owner name: KUKA ROBOTER GMBH, DE Free format text: FORMER OWNER: KUKA LABORATORIES GMBH, 86165 AUGSBURG, DE Owner name: KUKA DEUTSCHLAND GMBH, DE Free format text: FORMER OWNER: KUKA LABORATORIES GMBH, 86165 AUGSBURG, DE |
|
R082 | Change of representative |
Representative=s name: EGE LEE & PARTNER PATENTANWAELTE PARTGMBB, DE Representative=s name: FUNK & BOESS GBR, DE |
|
R082 | Change of representative |
Representative=s name: EGE LEE & PARTNER PATENTANWAELTE PARTGMBB, DE Representative=s name: BOESS, DIETER ALEXANDER, DIPL.-ING. (UNIV.), DE |
|
R018 | Grant decision by examination section/examining division | ||
R081 | Change of applicant/patentee |
Owner name: KUKA DEUTSCHLAND GMBH, DE Free format text: FORMER OWNER: KUKA ROBOTER GMBH, 86165 AUGSBURG, DE |
|
R082 | Change of representative |
Representative=s name: BOESS, DIETER ALEXANDER, DIPL.-ING. (UNIV.), DE Representative=s name: EGE LEE & PARTNER PATENTANWAELTE PARTGMBB, DE |
|
R026 | Opposition filed against patent | ||
R082 | Change of representative |
Representative=s name: BOESS, DIETER ALEXANDER, DIPL.-ING. (UNIV.), DE |
|
R034 | Decision of examining division/federal patent court maintaining patent in limited form now final | ||
R206 | Amended patent specification |