DE102010007027A1

DE102010007027A1 - Verfahren und Vorrichtung zur Überwachung eines Manipulatorraumes

Info

Publication number: DE102010007027A1
Application number: DE102010007027A
Authority: DE
Inventors: Johannes Dr. 86163 Kurth
Original assignee: KUKA Laboratories GmbH
Current assignee: KUKA Deutschland GmbH
Priority date: 2010-02-05
Filing date: 2010-02-05
Publication date: 2011-08-11

Abstract

Nach einem erfindungsgemäßen Verfahren zur Überwachung eines Manipulatorraumes (WS) eines mobilen Manipulators, insbesondere eines mobilen Roboters (1, 2), durch Überwachen des Raumes auf nicht vorgesehene Objekte mittels einer Umgebungserfassungseinrichtung (3a–3d) wird der überwachte Raum relativ zu dem Manipulator in Abhängigkeit von einer erfassten Basisposition (TBU) des Manipulators in seiner Umgebung wenigstens teilautomatisiert vorgegeben; und/oder die Umgebungserfassungseinrichtung (3a–3d) auch zur Erfassung einer Basisposition (TBU) des Manipulators in seiner Umgebung verwendet.

Description

Die vorliegende Erfindung betrifft ein Verfahren und eine Vorrichtung zur Überwachung auf Objekte innerhalb eines Manipulatorraumes eines mobilen Manipulators.
Um Beschädigungen von bei der Bahnplanung nicht vorgesehenen Objekten und insbesondere Verletzungen von Menschen durch Manipulatoren wie insbesondere Industrieroboter zu verhindern, ist es bislang üblich, den Arbeitsraum des Manipulators physisch abzusperren, beispielsweise durch ortsfeste Schutzzäune, Lichtschranken oder dergleichen, die den Zutritt zu einer Automatisierungszelle verhindern.
Eine solche Lösung ist jedoch aufwändig und unflexibel und damit für mobile Manipulatoren ungünstig, die gerade in unterschiedlichen Positionen in der Umgebung mit entsprechend wechselnden Arbeitsräumen operieren sollen.
Aus der DE 10 2007 007 576 B4 ist es daher bekannt, dreidimensionale Bilder eines Arbeitsraumes in einem ungestörten Soll-Zustand und einem aktuellen, zu überwachenden Ist-Zustand zu vergleichen. Weichen beide Bilder voneinander ab, kann auf ein unzulässiges Objekt geschlossen werden, welches eine Differenz zwischen beiden Bildern bewirkt.
Der Arbeitsraum wird dabei ortsfest, i. e. relativ zu der Umgebung definiert, in der der mobile Roboter sich bewegt, um Umgebungsrandbedingungen zu genügen, beispielsweise Überschneidungen mit Umgebungskonturen zu vermeiden, zulässige Schutzräume mit realen Zugängen, Bodenmarkierungen oder ähnlichem abzugleichen oder kooperierende Roboter zu berücksichtigen. Dementsprechend ist in der DE 10 2007 007 576 B4 eine ortsfeste Umgebungserfassungseinrichtung vorgesehen.
Die DE 10 2004 041 821 schlägt alternativ vor, einen Arbeitsraum eines portablen Roboters mittels Laserscanner, Ultraschall- und Mikrowellensensoren auf nicht vorgesehene Objekte zu überwachen. Die an dem portablen Roboter befestigten Scanner und Sensoren tasten einen Arbeitsraum ab, der sich somit mit dem portablen Roboter mitbewegt und manuell für einen neuen Arbeitsort angepasst wird.
Fährt ein mobiler Manipulator mit einer solchen manipulatorfesten Umgebungserfassungseinrichtung jedoch mit seiner beweglichen Basis erneut eine Position in der Umgebung an, für die vorab, beispielsweise beim Teachen, ein überwachter Raum vorgegeben wurde, führt eine, beispielsweise toleranz- oder navigationsfehlerbedingte, Abweichung zwischen der aktuellen Ist-Basisposition und der Ausgangs-Basisposition, für die der überwachte Raum vorgegeben wurde, dazu, dass der aktuell überwachte Raum, der aufgrund der an dem Manipulator befestigten Umgebungserfassungseinrichtung relativ zu dem Manipulator definiert ist, relativ zur Umgebung nicht mehr dem Raum entspricht, der auf Basis der Ausgangs-Basisposition vorgegeben wurde, sondern von diesem entsprechend des Basis-Positionsfehlers abweicht.
Dies ist in den nachfolgend noch näher erläuterten 1, 2 skizziert, in denen 1 einen mobilen Roboter in seiner Ausgangs-Basisposition zeigt, für die der schraffiert angedeutete überwachte Arbeitsraum WS' so vorgegeben wird, dass er innerhalb einer Umgebungskontur 4 liegt. Fährt der Roboter, wie in 2 dargestellt, die Basisposition erneut an, wobei seine Ist-Basisposition aufgrund von Navigationsfehlern, Regeltoleranzen und dergleichen gegenüber der in 2 strichliert angedeuteten Ausgangs-Basisposition verdreht und versetzt ist, würde der relativ zum Roboter vorgegebene und entsprechend mit verdrehte und versetzte überwachte Arbeitsraum WS'', wie in 2 strich-doppelpunktiert angedeutet, die Umgebungskontur 4 schneiden und entsprechend zu einem unerwünschten Ansprechen der Überwachung führen.
Aufgabe der vorliegenden Erfindung ist es, die Überwachung eines Manipulatorraumes für einen mobilen Manipulator zu verbessern.
Diese Aufgabe wird durch ein Verfahren mit den Merkmalen des Anspruchs 1 bzw. 7 gelöst. Anspruch 8 stellt eine Vorrichtung, Anspruch 10 ein Computerprogrammprodukt, insbesondere ein Speichermedium oder einen Datenträger, zur Durchführung eines erfindungsgemäßen Verfahrens unter Schutz. Die Unteransprüche betreffen vorteilhafte Weiterbildungen.
Nach einem ersten Aspekt der vorliegenden Erfindung wird der überwachte Raum relativ zu einem mobilen Manipulator wenigstens teilautomatisiert in Abhängigkeit von einer erfassten Basisposition des Manipulators in seiner Umgebung vorgegeben. Diese kann gemäß einem zweiten Aspekt der vorliegenden Erfindung durch dieselbe Umgebungserfassungseinrichtung erfasst werden, die auch zum Überwachen des Raumes auf nicht vorgesehene Objekte verwendet wird. Beide Aspekte können vorteilhafterweise miteinander kombiniert sein.
Durch die Verwendung derselben Umgebungserfassungseinrichtung zur Raumüberwachung und Basispositionserfassung, die insbesondere auch zur Navigation der Manipulatorbasis verwendet werden kann, gemäß dem zweiten Aspekt kann nicht nur der apparative Aufwand reduziert, sondern vorteilhafterweise auch ein Transformationsfehler zwischen einer erfassten Basisposition und einem in Abhängigkeit von dieser vorgegebenem überwachten Raum reduziert oder vermieden werden.
Durch die wenigstens teilautomatisierte Vorgabe des überwachten Raumes relativ zu dem Manipulator in Abhängigkeit von seiner erfassten Basisposition gemäß dem ersten Aspekt können insbesondere die einleitend erläuterten Basis-Positionierungsfehler des mobilen Manipulators kompensiert werden. Unter einer wenigstens teilautomatisierten Vorgabe wird dabei eine automatische Vorgabe verstanden, die jedoch vorzugsweise auch manuelle Eingaben berücksichtigen kann.
Ein mobiler Manipulator weist allgemein eine bewegliche, insbesondere selbstbewegende, Basis bzw. Plattform auf, die, vorzugsweise ungebunden, zwei- oder dreidimensional in einer Umgebung positionierbar ist. Ihre ein-, zwei- oder dreidimensionale Lage, beschrieben beispielsweise durch kartesische Koordinaten in einem Weltkoordinatensystem, und/oder ihre ein-, zwei- oder dreidimensionale Orientierung, beschrieben zum Beispiel durch EULER- oder KARDAN-Winkel, wird vorliegend entsprechend als Basisposition in der Umgebung des Manipulators bezeichnet. Eine Basis kann beispielsweise rad-, raupen-, magnetisch oder durch Luftkissen getrieben sein. Gemäß einer bevorzugten Ausführung handelt es sich um einen autonomen Manipulator, dessen Basis sich, beispielsweise zielgesteuert, selbst einen Weg in, gegebenenfalls auch unbekannter, Umgebung sucht.
An der Basis ist eine Kinematik des Manipulators befestigt und relativ zu dieser beweglich. Sie kann beispielsweise einen, vorzugsweise wenigstens sechsachsigen, Teilmanipulator aufweisen, um ohne Umpositionierung der Basis ein Werkzeugreferenzsystem („Tool Center point”, TCP) beliebig in der Umgebung zu positionieren und so ein Arbeitsprogramm auszuführen. Vorzugsweise erfolgt die Überwachung des Raumes für eine ortsfeste, i. e. relativ zur Umgebung ruhende Basis.
Der überwachte Raum kann ein Arbeitsraum des Manipulators und hierzu insbesondere durch die Bewegungsmöglichkeiten der Kinematik definiert sein, die mechanisch maximal möglich oder durch ein Arbeitsprogramm vorgegeben sind. In dem überwachten Raum können zulässige Objekte vorgesehen sein, insbesondere Teile des Manipulators selber, aber auch Zu- und Abführeinrichtungen, Werkzeugschränke, zu bearbeitende Umgebungselemente und dergleichen. Erfasst die Umgebungserfassungseinrichtung andere als die vorgesehenen Objekte, wird eine entsprechende Reaktion ausgelöst, beispielsweise der Manipulator sicher stillgesetzt.
Alternativ oder zusätzlich kann der überwachte Raum einen Warnraum umfassen. Wird in diesem ein nicht vorgesehenes Objekte erfasst, kann beispielsweise eine Warnung ausgegeben und/oder die Geschwindigkeit des Manipulators reduziert werden. Während ein überwachter Arbeitsraum vorzugsweise sicherheitsgerichtet bzw. in sicherer Technik überwacht wird, kann ein Warnraum vorteilhafterweise auch nicht sicherheitsgerichtet überwacht werden.
Gleichermaßen kann der überwachte Raum auch einen Schutzraum umfassen, der für Bedienpersonen zulässig ist, wobei dann insbesondere Teile des Manipulators als nicht vorgesehene Objekte zu einer entsprechenden Reaktion wie einem Stillsetzen, einer Warnung oder einer Geschwindigkeitsreduktion führen.
Insbesondere, wenn die Umgebungserfassungseinrichtung, die vorzugsweise einen oder mehrere, vorzugsweise berührungslose, Abstandssensoren aufweist, beispielsweise Laserscanner, Ultraschall- oder Mikrowellensensoren, und/oder bildgebende und/oder -verarbeitende Einrichtungen, zum Beispiel CCD-Kameras, manipulatorfest angeordnet ist, wird der überwachte Raum direkt oder indirekt relativ zu dem Manipulator vorgegeben. Dabei wird vorliegend auch eine Vorgabe relativ zur Umgebungserfassungseinrichtung, beispielsweise einem Bezugssystem eines Sensors, verallgemeinernd als Vorgabe relativ zu dem Manipulator im Sinne der vorliegenden Erfindung bezeichnet. Insofern ist ein überwachter Raum im Sinne der vorliegenden Erfindung insbesondere stets dann relativ zu dem Manipulator vorgegeben, wenn eine Veränderung der Basisposition des Manipulators relativ zu seiner Umgebung eine entsprechende Veränderung des überwachten Raumes relativ zu dieser Umgebung bewirkt.
Auf der anderen Seite soll der überwachte Raum häufig Umgebungsrandbedingungen genügen. So soll beispielsweise eine Grenze des überwachten Raumes innerhalb eines freien Raumes der Umgebung verlaufen, ohne dass Umgebungskonturen in den überwachten Raum hineinragen und dort als nicht vorgesehene Objekte erfasst werden und zu einem unerwünschten Ansprechen der Überwachung führen.
Daher wird nach dem ersten Aspekt der vorliegenden Erfindung der überwachte Raum relativ zu einem mobilen Manipulator in Abhängigkeit von einer Basisposition des Manipulators in seiner erfassten Umgebung vorgegeben. Auf diese Weise kann der vorteilhafterweise relativ zum Manipulator vorgegebene Raum, der beispielsweise durch dessen Kinematik bestimmt ist, insbesondere an Fehlpositionierungen des Manipulators relativ zu seiner Umgebung angepasst werden.
Hierzu wird in einer bevorzugten Ausführung der überwachte Raum vorab für eine Ausgangs-Basisposition des mobilen Manipulators vorgegeben, die beispielsweise eine Basisposition sein kann, in der der überwachte Raum durch einen Anwender manuell oder wenigstens teilautomatisiert vorgegeben wird. Gleichermaßen kann es sich auch um eine in einem vorhergehenden Bewegungszyklus eingenommene Basisposition handeln, an die der überwachte Raum angepasst wurde.
Dann wird, vorzugsweise im Betrieb, eine Ist-Basisposition des mobilen Manipulators erfasst. Eine Basisposition kann allgemein beispielsweise in einer bekannten Umgebung erfasst werden, indem etwa Abstände zu bekannten Umgebungskonturen oder Referenzmarken ermittelt und damit eine Positionsbestimmung durchgeführt wird, oder durch Bilderkennung und -vergleich. Gleichermaßen kann eine Basisposition des mobilen Manipulators auch in einer unbekannten Umgebung unter gleichzeitiger Erfassung dieser Umgebung erfasst werden („Simultaneous Localization and Mapping” SLAM).
Wenn die erfasste Ist- von der Ausgangs-Basisposition abweicht, vorzugsweise, wenn eine Differenz zwischen Ausgangs- und Ist-Basisposition einen vorgegebenen Grenzwert übersteigt, wird der relativ zum mobilen Manipulator vorgegebene Raum in Abhängigkeit von der erfassten Ist-Basisposition, insbesondere in Abhängigkeit von einer Differenz zwischen Ausgangs- und Ist-Basisposition, verändert. Eine Differenz zwischen Basispositionen kann beispielsweise ein Lageversatz und/oder eine Umorientierung umfassen. Dadurch kann eine Fehlpositionierung des Manipulators gegenüber seiner Ausgangs-Basisposition, für die der überwachte Raum unter Berücksichtigung von Umgebungsrandbedingungen vorgegeben wurde, kompensiert werden.
In einer bevorzugten Ausführung kann der Grenzwert für die Differenz zwischen Ausgangs- und Ist-Basisposition von dem vorgegebenen überwachten Manipulatorraum und/oder der Basisposition abhängen und beispielsweise bei Arbeitsräumen, die mit größeren Abständen zur Umgebung vorgegeben sind oder in Basispositionen, bei denen der Manipulator weiter von Umgebungskonturen entfernt ist, größer sein, da in diesem Fall auch bei geringfügiger Fehlpositionierung keine Kompensation erforderlich ist.
Der überwachte Raum kann relativ zu dem Manipulator derart verändert werden, dass er relativ zur Umgebung wenigstens im Wesentlichen dem für die Ausgangs-Basisposition vorgegeben überwachten Raum in Lage, Orientierung und/oder Größe entspricht. Insbesondere kann der für die Ausgangs-Basisposition vorgegebene Raum gemäß einer Relation auf einen kompensierten Raum für die Ist-Basisposition abgebildet werden, die sich aus der Transformation zwischen Ausgangs- und Ist-Basisposition ergibt. Er kann aber auch in anderer geeigneter Weise verändert, beispielsweise proportional zur Differenz zwischen ist- und Ausgangs-Basisposition verkleinert werden.
In einer bevorzugten Ausführung wird das Verfahren online während des Betriebs des Manipulators durchgeführt. Insbesondere kann nach Erreichen der Basisposition der dieser zugeordnete überwachte Raum vorgegeben werden. Vorzugsweise wird ein Arbeitsprogramm des Manipulators erst dann freigegeben bzw. gestartet, wenn dieser Raum vorgegeben wurde und sicher überwacht wird.
Auf diese Weise können für verschiedene Basispositionen des Manipulators in seiner Umgebung jeweils überwachte Räume vorgegeben werden. Eine Vorgabeeinrichtung, die in der Umgebungserfassungseinrichtung und/oder einer Manipulatorsteuerung implementiert oder separat ausgebildet sein kann, kann zu jeder erfassten Ist-Position einen abgespeicherten Raum, insbesondere dessen geometrische Grenzen und/oder als zulässig vorgesehene Objekte, abrufen und als überwachten Raum vorgeben.
Während bei den mobilen Manipulatoren, deren Basis sich auf vorgegebenen, insbesondere geteachten Wegen bewegt, einfach der zu einer erreichten Wegposition abgespeicherte überwachte Raum abgerufen werden kann, ist die Vorgabe des überwachten Raumes auf Basis der in, gegebenenfalls unbekannter, Umgebung erfassten Basisposition bei autonomen Manipulatoren besonders vorteilhaft. Dabei kann der Raum zum Beispiel für verschiedene Ausgangs-Basispositionen vorab durch einen Anwender oder automatisch, zum Beispiel durch eine Umgebungserfassung, vorgegeben und abgespeichert werden, wobei die Vorgabeeinrichtung des autonomen Manipulators dann im Betrieb die der erfassten Ist-Position nächstliegende(n) Ausgangs-Basisposition(en) auswählt und hieraus, zum Beispiel durch Mittelung oder eine Verschiebung proportional zur Differenz Ist- und Ausgangs-Basisposition, den überwachten Raum vorgibt.
Gleichermaßen kann eine Vorgabe des überwachten Raumes relativ zu dem Manipulator in Abhängigkeit von seiner Basisposition auch dadurch erfolgen, dass eine geometrische Grenze des überwachten Raumes wenigstens teilautomatisiert auf Basis einer erfassten Umgebung vorgegeben wird, wie dies in der parallelen deutschen Anmeldung derselben Anmelderin vom selben Anmeldetag wie die vorliegende Anmeldung mit demselben Titel ausführlich erläutert ist, auf deren Inhalt insofern ausdrücklich vollinhaltlich Bezug genommen wird. Denn indem die geometrische Grenze des überwachten Raumes unmittelbar auf Basis der in der aktuellen Ist-Basisposition erfassten Umgebung vorgegeben wird, kann ebenfalls eine Fehlpositionierung der Basis in der Umgebung kompensiert und der überwachte Raum an Umgebungsrandbedingungen angepasst werden.
Nach einem dritten Aspekt der vorliegenden Erfindung wird im Wesentlichen vorgeschlagen, nicht den überwachten Raum an eine von einer Ausgangs-Basisposition abweichende Ist-Basisposition des Manipulators anzupassen, sondern umgekehrt die Ist-Basisposition des Manipulators zu verändern, i. e. den Manipulator mechanisch zu verfahren, wenn ein nicht vorgesehenes Objekt, insbesondere eine nicht vorgesehene Umgebungskontur, in dem überwachten Raum festgestellt wird.
Dieses Verfahren erfolgt vorzugsweise, bevor ein Arbeitsprogramm des Manipulators freigegeben bzw. gestartet wird. Vorzugsweise wird die Basisposition solange verändert, bis kein nicht vorgesehenes Objekt in dem überwachten Raum festgestellt wird. Erst dann wird ein Arbeitsprogramm freigegeben bzw. gestartet. Die Veränderung kann dabei gerichtet, beispielsweise von dem nicht vorgesehenen Objekt weg oder in einer bestimmten Umgebungsrichtung, und/oder gemäß einem vorgegebenen Bewegungsmuster erfolgen.
Der dritte Aspekt kann insbesondere mit dem zweiten, aber auch mit dem ersten Aspekt kombiniert sein, indem beispielsweise wahlweise oder iterativ abwechselnd die Basisposition und der überwachte Raum angepasst werden.
Weitere Vorteile und Merkmale ergeben sich aus den Unteransprüchen und den Ausführungsbeispielen. Hierzu zeigt, teilweise schematisiert:
1: in der Draufsicht von oben einen mobilen Roboter mit einer Vorrichtung nach einer Ausführung der vorliegenden Erfindung in einer Ausgangs-Basisposition; und
2: in 1 entsprechender Darstellung den Roboter in einer Ist-Basisposition.
1 zeigt einen mobilen Roboter in Form eines sechsachsigen Knickarmroboters 1, dessen Karussell 1.2 um eine vertikale Achse drehbar an einem Grundgestell 1.1 befestigt ist. Am Karussell 1.2 ist eine Schwinge 1.3, an dieser ein Arm 1.4 um parallele horizontale Achsen drehbar angelenkt. Eine Zentralhand mit drei sich in einem Punkt schneidenden Drehachsen ist am Arm befestigt und trägt ein Werkzeug 1.5.
Das Grundgestell 1.1 ist auf einer mobilen Basis bzw. Plattform 2 festgelegt, die mittels zweier Raupen 2.1 ungebunden in der Umgebung selbstbewegend positioniert werden kann. Auf ihr sind vier Laserscanner 3a bis 3d angeordnet, die eine Umgebungserfassungseinrichtung bilden. Strichpunktiert sind in 1, 2 von den Scannern 3a bis 3d maximal überwachbare Sektoren angedeutet. Die Scanner 3a bis 3d können beispielsweise in einer horizontalen Ebene, die in einer bevorzugten Ausführung etwa 20 cm über dem Boden liegt, zweidimensionale Sektoren überwachen oder in einer nicht dargestellten Abwandlung auch dreidimensionale Sektoren, zum Beispiel Kugelsektoren oder dergleichen, überwachen In der in 1 gezeigten Ausgangs-Basisposition wird vorab als überwachter Manipulatorraum ein Arbeitsraum WS' = a ∩ b ∩ c ∩ d vorgegeben, beispielsweise durch Benutzereingabe oder wie in der parallelen deutschen Anmeldung derselben Anmelderin vom selben Anmeldetag wie die vorliegende Anmeldung mit demselben Titel ausführlich erläutert, auf deren Inhalt insofern ausdrücklich vollinhaltlich Bezug genommen wird.
Hierzu wird der Erfassungsbereich der vier Scanner 3a bis 3d auf die in 1 schraffierten Teilsektoren begrenzt, so dass außerhalb liegende Objekte nicht erfasst oder bei der Überwachung ignoriert werden. Die Teile des Roboters selber sind als zulässig vorgesehen, so dass ihre Erfassung durch die Scanner nicht zu einem Ansprechen der Überwachung führt.
Wie in 1 erkennbar, ist der Arbeitsraum WS' so vorgegeben, dass er knapp innerhalb der durch die Umgebungskontur 4 umgrenzten Nische liegt, in der der Roboter in seiner Ausgangs-Basisposition positioniert ist. Auf diese Weise wird einerseits verhindert, dass die Umgebungskontur 4 ungewollt von den Laserscannern als unzulässiges, nicht vorgesehenes Objekt erfasst wird. Auf der anderen Seite kann aufgrund des geringen Abstands zwischen Arbeitsraumgrenze und Umgebungskontur 4 insbesondere verhindert werden, dass eine Bedienperson von der Nischenöffnung aus in den Arbeitsbereich des Roboters eintritt und dort mit diesem kollidiert oder am Rand der Umgebungskontur 4 unbemerkt „gefangen” wird, wenn der Roboter in die Nische einfährt.
In gleicher Weise kann für weitere Ausgangs-Basispositionen (nicht dargestellt) jeweils ein entsprechender Arbeits- oder auch Schutzraum vorgegeben und abgespeichert werden.
In 2 hat der Roboter erneut seine geteachte Basis-Position eingenommen, nachdem er sich zwischenzeitlich aus der Nische entfernt hatte. Dabei ist seine aktuelle Ist-Basisposition (ausgezogen in 2) gegenüber der geteachten Ausgangs-Basisposition (strichliert in 2) aufgrund geringfügiger Navigationsfehler verdreht und versetzt (in 2 übertrieben dargestellt).
Durch die Laserscanner 3a bis 3d wird diese Ist-Basisposition des Roboters erfasst, indem beispielsweise erfasste Merkmale, insbesondere Kanten der Umgebungskontur 4, mit entsprechenden, in der geteachten Ausgangs-Basisposition abgespeicherten Merkmalen abgeglichen werden. Gleichermaßen kann beispielsweise auch ein SLAM-Verfahren verwendet werden, um gleichermaßen die Umgebung und die Position des Roboters in dieser zu erfassen.
Zunächst wird dann aus mehreren, für verschiedene Ausgangs-Basispositionen abgespeicherten überwachten Räumen der dieser erfassten Ist-Basisposition zugeordnete Arbeitsraum WS' ausgewählt.
Folgt der mobile Roboter dabei vorgegebenen Wegen in der Umgebung, kann dazu zum Beispiel der der hierzu geteachten Ausgangs-Basisposition zugeordnete, vorab abgespeicherte Arbeitsraum aus einem Speicher abgerufen werden. Sucht der Roboter hingegen autonom seinen Weg in der Umgebung, kann alternativ aus mehreren, für verschiedene Ausgangs-Basispositionen vorab vorgegebenen Arbeitsräumen beispielsweise derjenige ausgewählt werden, dessen Ausgangs-Basisposition der erfassten Ist-Basisposition am nächsten kommt. In diesem Fall kann der Versatz bzw. die Verdrehung gegenüber der Ausgangs-Basisposition entsprechend größer sein.
Da der Arbeitsraum durch die manipulatorfesten Scanner 3a bis 3d überwacht wird, ist dieser wenigstens indirekt relativ zur Basis 2 vorgegeben. Denn dies ist im Sinne der vorliegenden Erfindung auch dann der Fall, wenn der Arbeitsraum beispielsweise durch die einzelnen Teilsektoren a bis d definiert und insofern direkt relativ zu einem Bezugssystem der Scanner 3a bis 3d und somit nur indirekt relativ zur Basis 2 vorgegeben wird, an der die Scanner 3a bis 3d angeordnet sind.
Dementsprechend wäre auch der von den Scannern 3a bis 3d überwachte Raum WS'' zusammen mit der Basis 2 verdreht und versetzt (strich-doppelpunktiert in 2). Dies würde zum einen dazu führen, dass links oben und rechts unten in 2 Teile der Umgebungskontur 4 in den Arbeitsraum WS'' hineinragen und als nicht vorgesehene Objekte zu einem Ansprechend der Überwachung und so beispielsweise einem ungewollten sicheren Stillsetzen des Roboters führen.
Zum anderen würde sich rechts unten in 2 ein ungewollt großer Abstand zwischen der Grenze des Arbeitsraums WS'' und der Umgebungskontur 4 ergeben, in dem eine Bedienperson beim Einfahren des Roboters in die Nische unerkannt „gefangen” werden könnte, ohne frühzeitig von der Überwachung erkannt zu werden.
Daher wird die erfasste Ist-Basisposition mit der Ausgangs-Basisposition (vgl. 1 bzw. strichliert in 2) verglichen. Lage und Orientierung der für die Ausgangs-Basisposition vorgegebenen überwachten Raumes werden dann entsprechend der Differenz zwischen Ausgangs- und erfasster Ist-Basisposition automatisch derart verändert, dass der Raum WS relativ zur Umgebung wieder dem für die Ausgangs-Basisposition vorgegeben überwachten Raum WS' entspricht, indem die Laserscanner 3a bis 3d entsprechend andere Teilsektoren überwachen.
In 1, 2 sind zur schematischen Erläuterung diverse Bezugssysteme angedeutet: ein umgebungsfestes Weltkoordinatensystem U, ein manipulatorbasisfestes Koordinatensystem B (Ist-Basisposition, 2) bzw. B' (Ausgangs-Basisposition, 1) sowie ein arbeitsraumfestes Koordinatensystem A bzw. A'.
Der relativ zum Roboter 1 vorgegebene Arbeitsraum WS kann im Ausführungsbeispiel durch einen Quader im arbeitsraumfesten Koordinatensystem A beschrieben werden, welches durch die Transformation TAB aus dem manipulatorbasisfesten Koordinatensystem B hervorgeht. Seine Position, i. e. Lage und Orientierung, relativ zur Umgebung kann hingegen durch die Transformation T_AU beschrieben werden, die den Übergang vom Welt- in das arbeitsraumfeste Koordinatensystem vermittelt. Diese ergibt sich mit der durch die Transformation T_BU beschriebenen Basisposition zu: T_AU = T_AB·T_BU
Weicht nun, wie in 2, die Ist-Basisposition von der Ausgangs-Basisposition ab (T_BU ≠ T_B'U), kann das arbeitsraumfeste Koordinatensystem A und mit dem in ihm definierten Quader auch der Arbeitsraum WS durch eine entsprechende Änderung der Transformation T_AB, i. e. einer Änderung des überwachten Raumes relativ zum Roboter, wieder zur Deckung mit der Ausgangs-Konfiguration gebracht werden: T_AU = T_AB·T_BU = T_A'U = T_A'B'·T_B'U ⇒ T_AB(T_BU, T_A'B', T_B'U), i. e. der Arbeitsraum WS bzw. das arbeitsraumfeste Koordinatensystems A relativ zum Roboter bzw. dem manipulatorbasisfesten Koordinatensystem B (T_AB) in Abhängigkeit von der durch die Scanner 3a bis 3d erfassten Ist-Basisposition des Manipulators in seiner Umgebung (T_BU), dem in der Ausgangs-Basisposition relativ zum Roboter vorgegebenen Arbeitsraum (T_A'B') und der Ausgangs-Basisposition in der Umgebung (T_B'U) vorgegeben werden. Dabei dient die vorstehende Formulierung mit Transformationen lediglich der Erläuterung, während die Änderung des überwachten Raumes relativ zum Roboter auch in anderer Weise implementiert sein kann. So kann beispielsweise der Arbeitsraum entsprechend einer Differenz zwischen Ist- und Ausgangs-Basisposition verkleinert, verformt, verschoben und/oder verdreht werden. Gleichermaßen kann der überwachte Raum direkt im manipulatorbasisfesten Koordinatensystem B vorgegeben werden, so dass an die Stelle der Transformation eine entsprechende, beispielsweise parametrisierte Beschreibung des Arbeitsraumes WS im manipulatorbasisfesten Koordinatensystem B tritt.
Gemäß dem dritten Aspekt kann, ausgehend von der Ist-Basisposition in 2, die Basis 2 auch so lange mechanisch verfahren werden, bis der überwachte Raum nicht mehr von der Umgebungskontur 4 geschnitten wird. Hierzu kann die Basis 2 beispielsweise aufgrund der in der zunächst eingenommenen Ist-Basisposition (ausgezogen in 2) in 2 links oben und rechts unten im Arbeitsraum WS'' erfassten nicht vorgegebenen Objekte (Umgebungskontur 4) um ihre Hochachse gedreht und/oder verfahren werden, bis der relativ zur Basis 2 unverändert vorgegebene überwachte Arbeitsraum WS'' nicht mehr mit der Umgebungskontur 4 kollidiert.
Ein solches Vorgehen ist insbesondere für autonome Manipulatoren vorteilhaft, die somit sozusagen einen freien Arbeitsraum suchen können. Es kann auch mit dem zuvor beschriebenen ersten Aspekt kombiniert werden, indem beispielsweise iterativ zunächst die Basisposition in einem vorgegebenen Bereich verändert und anschließend der überwachte Raum angepasst wird.
Bezugszeichenliste

1.1: Grundgestell
1.2: Karussell
1.3: Schwinge
1.4: Arm
1.5: Werkzeug
2: Basis
2.1: Raupe
3a
3d: Laserscanner (Umgebungserfassungseinrichtung)
4: Umgebung(skontur)
a–d: von Laserscanner 3a–3d erfasster Teilsektor des Arbeitsraums
WS: vorgegebener Arbeitsraum (Manipulatorraum) in Ist-Basisposition
WS': vorgegebener Arbeitsraum in Ausgangs-Basisposition
WS'': unveränderter Arbeitsraum bei Abweichung Ist-, Ausgangs-Basisposition

ZITATE ENTHALTEN IN DER BESCHREIBUNG
Diese Liste der vom Anmelder aufgeführten Dokumente wurde automatisiert erzeugt und ist ausschließlich zur besseren Information des Lesers aufgenommen. Die Liste ist nicht Bestandteil der deutschen Patent- bzw. Gebrauchsmusteranmeldung. Das DPMA übernimmt keinerlei Haftung für etwaige Fehler oder Auslassungen.
Zitierte Patentliteratur

DE 102007007576 B4 [0004, 0005]
DE 102004041821 [0006]

Claims

Verfahren zur Überwachung eines Manipulatorraumes (WS) eines mobilen Manipulators, insbesondere eines mobilen Roboters (1, 2), durch Überwachen des Raumes auf nicht vorgesehene Objekte mittels einer Umgebungserfassungseinrichtung (3a–3d), dadurch gekennzeichnet, dass der überwachte Raum relativ zu dem Manipulator in Abhängigkeit von einer erfassten Basisposition (T_BU) des Manipulators in seiner Umgebung wenigstens teilautomatisiert vorgegeben wird; und/oder die Umgebungserfassungseinrichtung (3a–3d) auch zur Erfassung einer Basisposition (T_BU) des Manipulators in seiner Umgebung verwendet wird.
Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass der überwachte Raum (WS') vorab für eine Ausgangs-Basisposition (T_B'U) des mobilen Manipulators vorgegeben wird, eine Ist-Basisposition (T_BU) des mobilen Manipulators erfasst wird, und der überwachte Raum in Abhängigkeit von der erfassten Ist-Basisposition verändert wird (T_AB(T_BU, T_A'B', T_B'U)), wenn die Ist- von der Ausgangs-Basisposition abweicht.
Verfahren nach Anspruch 2, dadurch gekennzeichnet, dass der überwachte Raum (WS), insbesondere in Abhängigkeit von einer Differenz zwischen Ausgangs- und Ist-Basisposition, relativ zu dem Manipulator derart verändert wird, dass er relativ zur Umgebung wenigstens im Wesentlichen dem für die Ausgangs-Basisposition vorgegeben überwachten Raum (WS') entspricht (T_AU = T_A'U).
Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass eine Basisposition des mobilen Manipulators in seiner bekannten Umgebung erfasst wird; oder dass eine Basisposition des mobilen Manipulators in seiner Umgebung mittels gleichzeitiger Erfassung der Umgebung (SLAM) erfasst wird.
Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass der überwachte Raum während des Betriebs des Manipulators vorgegeben wird.
Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass überwachte Räume für verschiedene Basispositionen des Manipulators in seiner Umgebung vorgegeben werden.
Verfahren zur Überwachung eines Manipulatorraumes (WS) eines mobilen Manipulators, insbesondere nach einem der vorhergehenden Ansprüche, durch Überwachen des Raumes auf nicht vorgesehene Objekte mittels einer Umgebungserfassungseinrichtung (3a–3d), dadurch gekennzeichnet, dass eine Basisposition (T_BU) des Manipulators in seiner Umgebung wenigstens teilautomatisiert verändert wird, wenn in einer Ist-Basisposition ein nicht vorgesehenes Objekt im überwachten Raum erfasst wird.
Vorrichtung zur Überwachung eines Manipulatorraumes (WS) eines mobilen Manipulators, insbesondere eines mobilen Roboters (1, 2), mit: einer Umgebungserfassungseinrichtung (3a–3d) zum Überwachen des Raumes auf nicht vorgesehene Objekte; und einer Vorgabeeinrichtung zum Vorgegeben des überwachten Raumes relativ zu dem Manipulator in Abhängigkeit von einer Basisposition des Manipulators in seiner Umgebung; dadurch gekennzeichnet, dass die Umgebungserfassungseinrichtung und/oder die Vorgabeeinrichtung zur Durchführung eines Verfahrens nach einem der vorhergehenden Ansprüche eingerichtet ist.
Vorrichtung nach Anspruch 8, dadurch gekennzeichnet, dass die Umgebungserfassungseinrichtung manipulatorfest angeordnet ist.
Computerprogrammprodukt mit Programmcode, der auf einem maschinenlesbaren Träger gespeichert ist und ein Verfahren nach einem der vorhergehenden Ansprüche 1 bis 7 ausführt, wenn er in einer Vorrichtung nach Anspruch 8 oder 9 ausgeführt wird.