[0001] Die gegenständliche Erfindung betrifft ein Verfahren zum Steuern einer Hebeeinrichtung,
welche eine Last entlang einer ersten Bewegungsrichtung und entlang einer zweiten
Bewegungsrichtung innerhalb eines vorgegebenen Arbeitsbereichs der Hebeeinrichtung
gemäß einer vorgegebenen Trajektorie von einem Anfangspunkt zu einem Endpunkt bewegt.
[0002] Die Planung geeigneter Trajektorien stellt in den verschiedensten technischen Anwendungen
einen oftmals wesentlichen Bestandteil von Betriebs- und Problemlösungskonzepten dar.
Unter einer Trajektorie ist hierbei der zeitliche Verlauf der Bewegung eines Körpers
entlang einer Bahnkurve, eines Pfades oder eines Weges zu verstehen, was im Fall eines
starren Körpers beispielsweise durch den Positionsverlauf seines Schwerpunktes beschrieben
werden kann. Die in der Regelungstechnik übliche Verwendung des Begriffs "Trajektorie"
als zeitlicher (Soll-)Verlauf von Zustands- bzw. Ausgangsgrößen eines zu regelnden
(technischen) Systems weicht von dieser Definition zwar ab, stellt aber keinen Widerspruch
zu ihr dar. Verlangt ein technisches Problem zum einen die Planung einer Bewegung
eines physikalischen Körpers, zum anderen aber ebenso die Umsetzung der geplanten
Bewegung, beispielsweise durch eine geeignete Regelung oder (An-)Steuerung von zu
diesem Zweck vorgesehenen Antriebselementen, fallen die genannten Bedeutungen des
Begriffs "Trajektorie" zusammen, was in vielen Anwendungen und so auch im Rahmen der
nachfolgenden Ausführungen der Fall ist.
[0003] Eine den obigen Ausführungen entsprechende Trajektorienplanung stellt eine grundlegende
Teilaufgabe in der Automatisierung von Fahrzeugen dar, wie von Personen- oder auch
Lastkraftwagen. Mit Hilfe von karten- bzw. sensorbasierten Daten werden dabei in vielen
Fällen Trajektorien, die in erster Linie die Bewegung eines Fahrzeugs auf einer Straße
beschreiben, zunächst geplant und in weiterer Folge als Sollgrößen durch die Regelung
/ Steuerung des Fahrzeuges umgesetzt. Bei der Umsetzung dieser Vorgehensweise sind
neben Komfortaspekten vielfach auch die Realisierbarkeit und Kollisionsfreiheit einer
Trajektorie wichtige Kriterien.
[0004] Ein anderer Bereich, in dem das Thema Trajektorienplanung große Bedeutung besitzt,
ist das Gebiet der Transportlogistik. Unter anderem um die Wirtschaftlichkeit von
Logistik-Prozessen zu erhöhen, ist in dieser Sparte ein rascher Güterumschlag gefordert.
Daraus ergeben sich insbesondere Forderungen nach raschen Be- und Entladungsvorgängen
von Frachtschiffen, sowie nach dementsprechend schnellen Bewegungsvorgängen von zur
Be- und Entladung eingesetzten Hebeeinrichtungen. Auch solche Hebeeinrichtungen werden
vermehrt automatisiert betrieben, wobei sich Forderungen nach schnellen Bewegungsvorgängen
unmittelbar auf die im (automatisierten) Betrieb umzusetzenden Trajektorien niederschlagen.
[0005] Hebeeinrichtungen gibt es in den verschiedensten Ausführungsformen, die dementsprechend
in den unterschiedlichsten Anwendungsgebieten zum Einsatz kommen. So gibt es Turmkrane,
die vorwiegend für den Hoch- und Tiefbau verwendet werden, oder auch Mobilkrane, z.B.
für die Montage von Windkraftanlagen. Weiters werden Brückenkrane z.B. als Hallenkrane
in Fabrikhallen eingesetzt, oder Portalkrane z.B. für die Manipulation von Transportcontainern
an Umschlagsorten für den intermodalen Güterumschlag. Zu transportierende Güter werden
dabei vorwiegend in standardisierten Containern, sogenannten ISO-Containern, gelagert,
welche gleichermaßen für die Transport-Modi Straße, Schiene, Wasser geeignet sind.
Von einer Hebeeinrichtung zu transportierende Objekte, wie ein Verbund von Containern
mit darin enthaltenen Gütern, werden nachfolgend insbesondere schlicht als "Last"
bzw. "Lasten" bezeichnet.
[0006] Der Aufbau und die Funktionsweise insbesondere von Portalkranen ist hinlänglich bekannt
und z.B. in der
US 2007/0289931 A1 anhand eines "Ship-to-Shore-Krans" (STS-Kran) beschrieben. Ein Portalkran weist eine
tragende Struktur bzw. ein Portal auf, auf dem ein Ausleger angeordnet ist. Dabei
ist das Portal mit Rädern z.B. auf einem Gleis beweglich angeordnet und kann in einer
Richtung bewegt werden. Der Ausleger ist fest mit dem Portal verbunden und weist üblicherweise
eine entlang des Auslegers bewegliche Laufkatze auf. Zur Aufnahme einer Last, wie
beispielsweise eines ISO-Containers, ist die Laufkatze in der Regel mittels vier Seilen
mit einem Lastaufnahmeelement, einem sogenannten Spreader, verbunden. Zur Aufnahme
und zur Manipulation eines Containers kann der Spreader mittels Seilwinden gehoben
oder gesenkt werden. Der Spreader kann auch an unterschiedlich große Container angepasst
werden.
[0007] Typischerweise werden Krane von einem Kranführer bedient, der die Bewegung eines
Krans üblicherweise von einer Kabine aus steuert. Eine derartige Kabine kann an einem
Portal oder an einer beweglichen Laufkatze angeordnet sein. Für eine genaue und kollisionsfreie
Manipulation von Lasten sind hierbei hohe Anforderungen an den Kranführer gestellt,
weshalb in der Regel eine zumindest einjährige Ausbildungs- bzw. Einschulungszeit
nötig ist. Insbesondere das rasche Bewegen von Lasten mit geringen Pendelbewegungen
stellt dabei eine höchst komplexe Tätigkeit dar, weshalb zur erfolgreichen Ausübung
der Tätigkeit eines Kranführers zusätzlich eine meist mehrjährige Praxis-Erfahrung
erforderlich ist. Erschwert wird die Tätigkeit eines Kranführers vielfach durch eine
hohe körperliche Belastung, unter anderem aufgrund der geforderten hohen Konzentration
in Verbindung mit langem Sitzen mit nach unten geneigtem Blick. Unter anderem aus
diesen Gründen ist es ein erklärtes Ziel der Automatisierungstechnik, die komplexen
Manipulationsvorgänge einer Hebeeinrichtung zumindest teilweise zu automatisieren
und damit für den Kranführer zu vereinfachen. Untrennbar mit dem automatisierten Betrieb
von Hebeeinrichtungen verbunden ist dabei die Planung von geeigneten Trajektorien,
die von den Hebeeinrichtungen im automatisierten Betrieb umzusetzen sind.
[0008] Eine bislang wenig betrachtete, aber zusehends an Bedeutung gewinnende Fragestellung
betrifft in diesem Zusammenhang die Umplanung von bereits bestehenden Trajektorien.
Ein für die Praxis relevantes Beispiel, in dem das Erfordernis der Trajektorienumplanung
vermehrt auftritt, sind die bereits erwähnten STS ("Ship-to-Shore") Krane. Wie erwähnt
ist es der primäre Zweck von STS-Kranen, Container von Frachtschiffen zum Weitertransport
auf Lastkraftwagen (LKW) oder auf sogenanannte "Automated Guided Vehicles" zu verladen.
Dabei tritt häufig der Fall ein, dass ein LKW noch nicht in einem von der Hebeeinrichtung
bzw. vom Kran erreichbaren Bereich eingetroffen ist, die Bewegung der Last aus Effizienzgründen
aber bereits begonnen werden muss. Die tatsächliche Position eines LKWs zur Lastaufnahme
kann aus offensichtlichen Gründen erst nach dessen Eintreffen erfasst und in weiterer
Folge berücksichtigt werden. Um die Bewegung eines Containers bzw. einer Last dennoch
auch vor Eintreffen des LKWs beginnen zu können, ist es in derartigen Fällen erforderlich,
zunächst eine geeignete Zielposition für die Planung einer ersten Trajektorie anzunehmen
und die angenommene Zielposition später im Rahmen einer Umplanung an die wahre Zielposition
anzupassen.
[0009] Selbes gilt für Hindernisse, die während der Bewegung der Last von der Last vermieden
werden müssen. Ein Hindernis kann hierbei ein anderes Schiff, ein Stapel aus Containern,
beispielsweise auf einem Schiff oder an Land, oder ein sonstiges Hindernis sein. Diesbezüglich
kann es aus Effizienzgründen vorteilhaft sein, die Bewegung eines Containers bzw.
einer Last bereits zu beginnen, noch bevor beispielsweise die Abmessungen eines Hindernisses
bekannt sind. Auch kann ein Hindernis erst während der Bewegung einer Last auftreten.
In solchen Fällen ist es erforderlich, ebenso zunächst Annahmen zu treffen, insbesondere
hinsichtlich Anzahl und Form von zu berücksichtigenden Hindernissen. Auf Basis dieser
Annahmen kann eine erste Trajektorie geplant werden, welche im Rahmen einer späteren
Umplanung an die tatsächlichen Hindernisse anzupassen ist. Es ist also eine Umplanung
einer Trajektorie in Abhängigkeit von geänderten Hindernissen erforderlich.
[0010] Obgleich das Thema Trajektorienplanung für Hebeeinrichtungen im Stand der Technik
behandelt wird, finden Fragestellungen hinsichtlich einer Trajektorienumplanung, insbesondere
aufgrund sich ändernder Hindernisse, bislang kaum Erwähnung in der einschlägigen Literatur.
[0011] So beschreibt die
EP 3461783 B1 die Ermittlung einer Trajektorie für die Bewegung einer Last durch eine Hebeeinrichtung.
Dazu wird einerseits eine geometrische Bahn, andererseits eine dynamische Bahn berechnet,
die in einem weiteren Schritt zur Erzeugung einer Trajektorie kombiniert werden. Ein
Nachteil dieser Herangehensweise ist der mit ihr verknüpfte große Rechenaufwand. Eine
(echtzeitfähige) Umplanung während des Betriebs einer Hebeeinrichtung ist damit nur
eingeschränkt möglich.
[0012] Die
CN 111170153 A beschreibt demgegenüber ein Verfahren zur Umplanung einer gegebenen Trajektorie auf
Basis von messtechnisch erfassten Hindernissen. Die erforderlichen messtechnischen
Voraussetzungen stellen hierbei eine signifikante Erschwernis für die Implementierung
dieser Methode dar. Darüber hinaus beschreibt die
CN 111170153 A nicht, wie während des Betriebs geänderte Hindernisse berücksichtigt werden können,
und trifft überdies keine Aussagen zur Echtzeitfähigkeit des beschriebenen Verfahrens.
[0013] Daneben zeigt der bekannte Stand der Technik eine Vielzahl weiterer Nachteile, wie
die üblicherweise gegebene Notwendigkeit, dass sich durch eine Umplanung keine Richtungsänderungen
entlang der vorgegebenen Bewegungsrichtungen ergeben dürfen. Ein weiterer wesentlicher
Punkt ist die Echtzeitfähigkeit von Konzepten zur Trajektorienumplanung. Da die beschriebenen
Umplanungen üblicherweise während des Betriebs einer Hebeeinrichtung vorgenommen werden
müssen, darf der mit einer Umplanung verknüpfte Rechenaufwand den Betrieb einer Hebeeinrichtung
nicht beeinträchtigen. Auch dieser Aspekt wird im Stand der Technik nicht berücksichtigt.
[0014] Es ist demnach eine Aufgabe der gegenständlichen Erfindung, ein verbessertes Verfahren
zur Trajektorienumplanung für eine Hebeeinrichtung anzugeben, welches eine effiziente
Umplanung einer Trajektorie, entlang derer eine Last bewegt wird, unter Berücksichtigung
eines veränderlichen Hindernisses ermöglicht.
[0015] Diese Aufgabe wird durch die gegenständliche Erfindung gelöst. Dabei wird von einer
Hebeeinrichtung ausgegangen, welche eine Last entlang einer ersten Bewegungsrichtung
und entlang einer zweiten Bewegungsrichtung innerhalb eines vorgegebenen Arbeitsbereichs
der Hebeeinrichtung gemäß einer vorgegebenen Trajektorie von einem Anfangspunkt zu
einem Endpunkt bewegt.
[0016] Erfindungsgemäß wird für diese Hebeeinrichtung zu einem Kommandozeitpunkt während
der Bewegung der Last ein für die Bewegung der Last neues Hindernis, welches zwischen
der zum Kommandozeitpunkt von der Last angenommenen Position und dem Endpunkt angeordnet
ist, vorgegeben und/oder ein bestehendes Hindernis, welches zwischen der zum Kommandozeitpunkt
von der Last angenommenen Position und dem Endpunkt angeordnet ist, zu einem neuen
Hindernis für die Bewegung der Last verändert, wobei unter Berücksichtigung von vorgegebenen
kinematischen Beschränkungen der Hebeeinrichtung für die erste Bewegungsrichtung und
für die zweite Bewegungsrichtung jeweils zumindest eine Einzelbewegung geplant wird,
welche die weitere Bewegung der Last entlang der jeweiligen Bewegungsrichtung ab dem
Kommandozeitpunkt festlegt, wobei je Bewegungsrichtung zumindest eine Einzelbewegung
in einer Projektion des Endpunktes auf die jeweilige Bewegungsrichtung endet, und
wobei die geplanten Einzelbewegungen entsprechend einer vorgegebenen Bewegungsabfolge
ausgeführt werden, um die Last ohne Kollision mit dem Hindernis entlang der ersten
Bewegungsrichtung und entlang der zweiten Bewegungsrichtung gemäß einer sich aus der
Bewegungsabfolge der geplanten Einzelbewegungen ergebenden Umplanungstrajektorie weiterzubewegen.
Durch die Planung von Einzelbewegungen wird hierbei die numerische Komplexität im
Vergleich zu aus dem Stand der Technik bekannten Verfahren signifikant reduziert,
wodurch eine effiziente und flexible Umplanung auch während des Betriebs einer Hebeeinrichtung
möglich wird.
[0017] In einer vorteilhaften Weise werden die für die erste Bewegungsrichtung und die für
die zweite Bewegungsrichtung geplanten Einzelbewegungen als voneinander unabhängige
Einzelbewegungen geplant, wodurch keine gegenseitigen Abhängigkeiten berücksichtigt
werden müssen und die eigentliche Umplanungsaufgabe noch weiter vereinfacht werden
kann.
[0018] In einer weiteren vorteilhaften Ausführungsform der gegenständlichen Erfindung werden
die durch die geplanten Einzelbewegungen vorgegebenen Positionsverläufe der Last als
zeitlich zumindest vierfach stetig differenzierbare Positionsverläufe vorgegeben.
Dadurch können in einer bemerkenswerten Weise Schwingungen der bewegten Last prinzipbedingt
vermieden werden.
[0019] In einer weiteren vorteilhaften Ausführungsform der gegenständlichen Erfindung werden
die durch die Einzelbewegungen vorgegebenen Positionsverläufe zur Erzeugung der zeitlich
zumindest vierfach stetigen Differenzierbarkeit mittels eines Filters mit einer vorgebbaren
Zeitkonstante gefiltert. Dadurch kann in einer besonders vorteilhaften Weise dafür
Sorge getragen werden kann, dass vorgegebene kinematische Beschränkungen der Hebeeinrichtung
eingehalten werden. Die Zeitkonstante des Filters kann hierbei in einer vorteilhaften
Weise von der Geometrie der Hebeeinrichtung abhängig gemacht werden, um eine präzise
Abstimmung auf die gegebene Hebeeinrichtung zu ermöglichen.
[0020] In einer weiteren vorteilhaften Ausführungsform der gegenständlichen Erfindung wird
für die zweite Bewegungsrichtung eine zweite Einzelbewegung geplant, um die Last um
das neu vorgegebene und/oder das geänderte Hindernis zu bewegen. Hierbei ist zu beachten,
dass es zum Umfahren eines Hindernisses üblicherweise erforderlich ist, die zum Umfahren
geplante Einzelbewegung mit entlang der anderen Bewegungsrichtungen geplanten, anderen
Einzelbewegungen zu kombinieren, also Horizontal- und Vertikalbewegungen geeignet
miteinander zu kombinieren. Hierbei kann es erforderlich sein, die neue Einzelbewegung
auf gegebenenfalls bereits bestehende, andere Einzelbewegungen abzustimmen bzw. anzupassen.
Auf die beschriebene Weise kann die Last um das Hindernis bewegt werden und es können
Kollisionen der Last mit dem vorgegebenen Hindernis vermieden werden.
[0021] In einer weiteren vorteilhaften Ausführungsform der gegenständlichen Erfindung wird
durch die genannte Bewegungsabfolge ein abwechselnder Beginn und gegebenenfalls eine
überlappende Ausführung der geplanten Einzelbewegungen entlang der ersten Bewegungsrichtung
und von Einzelbewegungen entlang der zweiten Bewegungsrichtung vorgesehen, wodurch
einerseits Hindernissen ausgewichen werden kann, andererseits in einem teils signifikanten
Maß Zeit eingespart werden kann.
[0022] Weiters erlaubt das erfindungsgemäße Verfahren vor der Ausführung zumindest einer
geplanten Einzelbewegung die Überprüfung, ob die zu erwartende Umplanungstrajektorie
zu einer Kollision der Last mit einem im Arbeitsbereich vorgegebenen Hindernis führt.
Diese Überprüfung kann dabei in einer vorteilhaften Weise durchgeführt werden, indem
die Kollisionszeitpunkte verglichen werden, an denen die jeweiligen Einzelbewegungen
Projektionen auf die entsprechende Bewegungsrichtung eines vom vorgegebenen Hindernis
abgeleiteten Stützpunktes erreichen, wobei zur Ermittlung dieser Kollisionszeitpunkte,
an denen die jeweiligen Einzelbewegungen Projektionen auf die entsprechende Bewegungsrichtung
eines vom vorgegebenen Hindernis abgeleiteten Stützpunktes erreichen, ein numerisches
Verfahren zur Nullstellensuche herangezogen werden kann. Auf diese Weise können Hindernisse
im Arbeitsbereich der Hebeeinrichtung bei der erfindungsgemäßen Umplanung eingebunden
werden, und rechtzeitig auf mögliche Kollisionen reagiert werden. Hierbei ist zu anzumerken,
dass durch die erfindungsgemäße Vorgehensweise die beschriebene Überprüfung in einer
besonders effizienten Weise durchgeführt werden kann.
[0023] Wird durch die beschriebene Vorwegrechnung eine mögliche Kollision erkannt, kann
zumindest eine Einzelbewegung nicht durchgeführt werden und stattdessen entlang jener
Bewegungsrichtung, für welche die zumindest eine nicht durchgeführte Einzelbewegung
geplant worden ist, für zumindest die Dauer einer vorgegebenen Minimalbremszeit ein
vorgegebener Bremsvorgang durchgeführt werden. So können einerseits auf eine vorteilhafte
Weise Kollisionen vermieden werden, andererseits wird auf die beschriebene Weise eine
neue Ausgangssituation geschaffen, von der weg eine erneute Umplanung von Einzelbewegungen
möglich gemacht wird.
[0024] Entsprechend den vorangegangenen Ausführungen kann in einer vorteilhaften Weise anstelle
der zumindest einen nicht durchgeführten Einzelbewegung für die entsprechende Bewegungsrichtung
eine neue Einzelbewegung geplant werden, wobei eine durch die zumindest eine neue
Einzelbewegung zu erwartende Umplanungstrajektorie ermittelt wird und überprüft wird,
ob die zu erwartende Umplanungstrajektorie zu einer Kollision der Last mit einem im
Arbeitsbereich vorgegebenen Hindernis führt, und wobei die neue Einzelbewegung ausgeführt
wird, wenn keine Kollision erkannt wird, oder der vorgegebene Bremsvorgang für zumindest
eine weitere Minimalbremszeit fortgesetzt wird und erneut eine Neuplanung einer Einzelbewegung
sowie eine Überprüfung der Umplanungstrajektorie, welche durch die neu geplante Einzelbewegung
zu erwarten ist, durchgeführt wird, falls eine erneute Kollision mit einem Hindernis
erkannt wird. Auf diese Weise kann das erfindungsgemäße Verfahren ohne Kollision weitergeführt
werden, auch wenn eine erste Umplanung zu einer Kollision geführt hätte und es kann
sichergestellt werden, dass es während der gesamten Bewegung der Last zu keiner Kollision
der transportieren Last mit Hindernissen kommt.
[0025] Weiters kann zur Unterstützung der gegenständlichen Erfindung die Position der Last
messtechnisch erfasst werden und die Messung der Position der Last bei der Durchführung
der Einzelbewegungen herangezogen werden. Insbesondere bei der regelungstechnischen
Umsetzung von geplanten Einzelbewegungen ist die Verwendung von Messdaten üblicherweise
besonders vorteilhaft.
[0026] Weiters ist darauf hinzuweisen, dass das erfindungsgemäße Verfahren keineswegs auf
Bewegungen in der Ebene beschränkt ist, und dass anhand der gegenständlichen Erfindung
auch Bewegungen im (dreidimensionalen) Raum geplant werden können. Im Fall von mehr
als zwei Dimensionen wirken sich die Eigenschaften der gegenständlichen Erfindungen
sogar noch vorteilhafter aus. Die Unabhängigkeit der geplanten Einzelbewegungen ist
dabei besonders hervorzuheben, insbesondere da drei voneinander abhängige Koordinaten
die bei einer Umplanung zu bewältigende Komplexität - im Vergleich zum bereits herausfordernden
2D-Fall - noch weiter erhöhen würden.
[0027] Die gegenständliche Erfindung wird nachfolgend unter Bezugnahme auf die Figuren 1
bis 6 näher erläutert, die beispielhaft, schematisch und nicht einschränkend vorteilhafte
Ausgestaltungen der Erfindung zeigen. Dabei zeigt
Fig. 1 eine schematische Darstellung eines Containerkrans mit einer Trajektorie innerhalb
eines Arbeitsbereichs des Containerkrans,
Fig. 2a einen möglichen Ablauf des erfindungsgemäßen Verfahrens bei Vorgabe eines
geänderten Hindernisses,
Fig. 2b eine Einzelbewegung in X-Richtung,
Fig. 2c eine Einzelbewegung in Y-Richtung,
Fig. 2d eine weitere Einzelbewegung in Y-Richtung,
Fig. 3a eine zeitoptimale Einzelbewegung für eine Bewegungsrichtung,
Fig. 3b ein Blockschaltbild zur Filterung der zu einer Einzelbewegung gehörenden Positions-,
Geschwindigkeits- und Beschleunigungsverläufe,
Fig. 4 eine Trajektorie und eine Umplanungstrajektorie innerhalb eines Arbeitsbereichs
mit einer Verbotszone,
Fig. 5a Einzelbewegungen in X-Richtung bei Durchführung eines erfindungsgemäßen Bremsvorganges,
Fig. 5b Einzelbewegungen in Y-Richtung bei Durchführung eines erfindungsgemäßen Bremsvorganges,
Fig. 5c resultierende Trajektorien bei Durchführung eines erfindungsgemäßen Bremsvorganges,
Fig. 6 eine Umplanungstrajektorie zur Kollisionsvermeidung bei zwei Hindernissen.
[0028] Fig.1 zeigt eine Hebeeinrichtung 1 in Form eines schematischen Containerkrans 2,
wie er zum Be- und Entladen von Schiffen in einem Hafen verwendet wird. Üblicherweise
weist ein Containerkran 2 eine tragende Struktur 3 auf, die entweder fest oder beweglich
am Boden angeordnet ist. Im Fall einer beweglichen Anordnung kann die tragende Struktur
3 beispielsweise in Z-Richtung fahrbar auf Schienen angeordnet sein. Durch diesen
Freiheitsgrad in Z-Richtung ist der Containerkran 2 örtlich flexibel einsetzbar. Zur
Bewegung der tragenden Struktur 3 in Z-Richtung kann beispielsweise eine geeignete
Verschiebeeinrichtung an der Hebeeinrichtung angeordnet sein, z.B. angetriebene Räder,
ein Seilzug, ein Zahntrieb oder dergleichen. Die tragende Struktur 3 weist einen Ausleger
4 auf, der in einer bestimmten Höhe y
T fest mit der tragenden Struktur 3 verbunden ist.
[0029] Auf diesem Ausleger 4 ist üblicherweise ein Laufelement 5 angeordnet, das in Längsrichtung
des Auslegers 4, im dargestellten Beispiel also in X-Richtung, beweglich ist. Dementsprechend
kann ein Laufelement 5 mittels Rollen in Führungen gelagert sein. Für das Laufelement
5 ist ein nicht dargestellter Laufelementantrieb vorgesehen, um das Laufelement 5
in X-Richtung zu bewegen. Der Laufelementantrieb kann am Laufelement 5 selbst vorgesehen
sein, kann aber auch am Ausleger 4 oder an der tragenden Struktur 3 angeordnet sein.
Das Laufelement 5 ist üblicherweise mithilfe von Halteelementen 6 mit einem Lastaufnahmeelement
7 zur Aufnahme einer Last 8 verbunden. Im Falle eines Containerkrans 2 ist die Last
8 üblicherweise ein Container 9, in den meisten Fällen ein ISO-Container mit einer
Länge von 20, 40 oder 45 Fuß, einer Breite von 8 Fuß und einer Höhe von 8 Fuß, 6 Zoll.
[0030] Die Halteelemente 6 sind üblicherweise als Seile ausgeführt, wobei in den meisten
Fällen vier Halteelemente 6 am Laufelement 5 angeordnet sind, es können aber auch
mehr oder weniger Halteelemente 6 vorgesehen sein, im einfachsten Fall auch nur ein
einzelnes Halteelement 6. Zur Aufnahme einer Last 8, wie z.B. eines Containers 9,
ist der Abstand zwischen dem Laufelement 5 und dem Lastaufnahmeelement 7 anhand eines
Hubantriebs (nicht dargestellt) verstellbar, in Fig. 1 demnach in Y-Richtung. Wenn
die Halteelemente 6 als Seile ausgeführt sind, wird die Hubhöhe üblicherweise mittels
einer oder mittels mehrerer Seilwinden verstellt. Der Bereich, in dem eine Hebeeinrichtung
1 eine Last 8 bewegen kann, wird im gegenständlichen Zusammenhang als Arbeitsbereich
15 bezeichnet. Je nach Größe und konstruktiver Ausführung der Hebeeinrichtung 1 kann
der Arbeitsbereich 15 variieren.
[0031] In der in Fig. 1 gezeigten Situation ist es das Ziel, die Last 8 vom Anfangspunkt
A zum Endpunkt E zu bewegen. Beim Beladen eines Schiffes kann der Anfangspunkt A z.B.
eine Position eines Containers 9 an Land sein, wie auf einem LKW-Anhänger, einem Bahn-Waggon
oder einem Lagerplatz, und die Endposition E kann z.B. eine vorgegebene Position des
Containers 9 auf einem Schiff sein. In einer vorteilhaften Weise kann der Arbeitsbereich
15 hierbei in einer Ebene oder auch im gesamten Bewegungsraum festgelegt werden und
es kann geprüft werden, ob ein vorgegebener Anfangspunkt A sowie ein vorgegebener
Endpunkt E innerhalb des Arbeitsbereichs 15 liegen und ob demnach eine durchgehende
Bewegung der Last 8 vom Anfangspunkt A zum Endpunkt E möglich ist.
[0032] Um eine Last 8 entlang einer Trajektorie T vom Anfangspunkt A zum Endpunkt E zu bewegen,
weist die Hebeeinrichtung 1 eine Kransteuerung 16 mit einer Recheneinheit 12 auf,
z.B. in Form einer elektronischen Steuereinheit in Form von geeigneter Hardware und/oder
Software, mittels derer die Bewegung der Last 8 entlang der jeweiligen Bewegungsrichtung
X, Y, Z gesteuert werden kann. Wird ein Anfangspunkt A und/oder Endpunkt E beispielsweise
manuell durch einen Benutzer definiert, kann der Anfangspunkt A und/oder Endpunkt
E der Recheneinheit 12 z.B. über eine geeignete Schnittstelle übermittelt werden.
Ein Anfangspunkt A und/oder ein Endpunkt E kann auch in der Recheneinheit 12 ermittelt
werden. Mögliche Realisierungen einer Recheneinheit 12 sind unter anderem durch mikroprozessorbasierte
Hardware, Mikrocontroller und integrierte Schaltungen (ASIC, FPGA) gegeben. Die Kransteuerung
16 kommuniziert zur Bewegungssteuerung und/oder -regelung der Last 8 mit den zu diesem
Zweck vorgesehenen Antrieben, wie einem Laufelementantrieb oder einer Seilwinde, und
ist üblicherweise so ausgeführt, dass sie die aktuelle Position des Laufelements 5,
die Position des Lastaufnahmeelements 7 und gegebenenfalls auch die Position der tragenden
Struktur 3 messtechnisch erfassen kann.
[0033] In diesem Sinn können in der in Fig. 1 gezeigten Situation die Koordinaten des Zentralpunktes
Pz, der an der dem Ausleger 4 zugewandten Oberseite des Lastaufnahmeelements 7 angeordnet
ist, in der X-Y-Ebene E
XY anhand der Koordinaten x
L und y
L des Lastaufnahmeelements 7 erfasst werden, es können aber auch die Koordinaten x
T und y
T des Laufelements 5 in X- sowie in Y-Richtung erfasst werden. Der Zentralpunkt Pz
kann hierbei zur Beschreibung der Position der Last 8 herangezogen werden, und demnach
auch als Lastposition aufgefasst werden. Die Position y
T des Laufelements in Y-Richtung ist weiters oftmals durch die konstruktive Höhe der
tragenden Struktur 3 bzw. des Auslegers 4 festgelegt und demzufolge konstant. Die
Koordinaten sind auf ein gegebenes Koordinatensystem bezogen. Bei einer Bewegung der
Last 8 in Z-Richtung, also bei einer Bewegung der tragenden Struktur 3 der Hebeeinrichtung
1 in Z-Richtung, würden ebenso die Position z
L des Lastaufnahmeelements 7 und die Position z
T des Laufelements 5 in Z-Richtung erfasst werden.
[0034] Fig.1 zeigt weiters ein zwischen Anfangspunkt A und Endpunkt E angeordnetes Hindernis
11. Ein Hindernis 11 kann hierbei ein anderes Schiff, ein Stapel aus Containern 9
oder ein sonstiges Hindernis 11 sein. Das Hindernis 11 führt dazu, dass keine direkte
Verbindung zwischen dem Anfangspunkt A und dem Endpunkt E, also keine Trajektorie
T in Form einer Geraden möglich ist. Um Kollisionen zu vermeiden oder ausreichend
Sicherheitsabstand zu gewährleisten, muss die Last 8 während ihrer Bewegung die vorgegebenen
Hindernisse 11 vermeiden. In einer vorteilhaften Weise können Hindernisse 11 durch
sogenannte Verbotszonen V
i berücksichtigt werden (der Index i≥1 bezieht sich dabei auf die Anzahl der Verbotszonen
V
i), wobei die Verbotszonen V
i die Hindernisse 11 umschließen. Eine Verbotszone V
i kann demnach auch merklich größer sein als ein von ihr umfasstes Hindernis 11. Eine
Verbotszone kann beispielsweise manuell durch einen Benutzer z.B. über eine geeignete
Schnittstelle in der Recheneinheit 12 definiert werden oder automatisch von der Recheneinheit
12 ermittelt werden. Dazu kann beispielsweise ein geeignetes Laser-Scan Verfahren
verwendet werden, das z.B. einen Arbeitsbereich 15 der Hebeeinrichtung 1 abtastet
und dabei Hindernisse 11 erkennt, vermisst und die ermittelten Daten an die Recheneinheit
12 weitergibt. Solche Verfahren sind im Stand der Technik bekannt.
[0035] Von einer Trajektorie T, entlang derer die Last 8 bewegt wird, ist üblicherweise
eine rasche Überführung der Last 8 vom Anfangspunkt A in den Endpunkt E gefordert.
Wie eingangs ausgeführt, kann es während einer solchen Überführung aus mehreren Gründen
erforderlich werden, eine vorgegebene Trajektorie T während der Bewegung der Last
8 an sich geänderte Umstände im Bereich der Hebeeinrichtung 1 zu adaptieren, die Trajektorie
T also umzuplanen. Dieses Problem wird durch das erfindungsgemäße Verfahren gelöst.
Wie das erfindungsgemäße Verfahren zur Umplanung einer Trajektorie T unter Berücksichtigung
eines geänderten oder neu vorgegebenen Hindernisses 11n herangezogen werden kann,
ist in den Figuren 2a-2d konkret gezeigt.
[0036] Über der Zeitachse t sind hierbei drei Situationen aufgetragen, die bei Anwendung
des erfindungsgemäßen Verfahrens während der Bewegung einer Last 8 durch eine Hebeeinrichtung
1 entlang einer ersten und entlang einer zweiten Bewegungsrichtung auftreten können,
hier entlang der Bewegungsrichtungen X und Y. In der in Fig. 2a gezeigten Situation
beginnt die Bewegung der Last 8 zum Zeitpunkt t
A im Anfangspunkt A. Die Position der Last 8 wird dabei dem zuvor erwähnten Zentralpunkt
Pz gleichgesetzt und demnach ebenso mit Pz bezeichnet. Zum Zeitpunkt t
A beginnt die Bewegung der Last 8 entlang der in Fig. 2a strichliert dargestellten,
vorgegebenen Trajektorie T, wobei die Position Pz der Last 8 und der Anfangspunkt
A zunächst übereinander liegen. Für die Planung der Trajektorie T wurde das Hindernis
11a angenommen, von dem die Verbotszone V
1a abgeleitet wurde.
[0037] Zum Zeitpunkt t
K, nachfolgend auch als Kommandozeitpunkt t
K bezeichnet, wird nun anstelle des bisherigen Hindernisses 11a ein neues Hindernis
11n vorgegeben. Der Kommandozeitpunkt t
K kann hierbei von einem Bediener wie einem Kranführer vorgegeben und damit weitestgehend
frei gewählt werden. Der Kommandozeitpunkt t
K kann aber auch intern in der Recheneinheit 12 generiert werden. Auch sind mehrere,
aufeinanderfolgende Kommandozeitpunkte t
K für ein wiederholtes Ändern eines Hindernisses 11 denkbar. Zum Kommandozeitpunkt
t
K befindet sich die Last 8 an der Position P
z(t
K). Erfindungsgemäß wird nach der Vorgabe des neuen Hindernisses 11n unmittelbar mit
der Umplanung der Bewegung der Last 8 begonnen. Das erfolgt entsprechend den vorausgegangenen
Ausführungen anhand von Projektionen der zum Kommandozeitpunkt t
K von der Last 8 angenommenen Position P
z(t
K) und des Endpunktes E auf die Bewegungsrichtungen X, Y, sowie anhand von Projektionen
von Stützpunkten S
1n,S
2n, die vom neuen Hindernis 11n abgeleitet werden, auf die Bewegungsrichtungen X, Y.
Bevorzugt sind die Stützpunkte S
1n, S
2n wie dargestellt Eckpunkte der Verbotszone V
1n. Für die Verbotszone V
1a können natürlich ebenso Stützpunkte S
1a, S
2a angegeben werden. Wie nachfolgend gezeigt wird, können Stützpunkte wie S
1n, S
2n insbesondere bei der Planung von Bewegungen entlang der Y-Achse als Zwischenziele
eingesetzt werden, um Kollisionen mit einer Verbotszone V
1n und damit mit dem Hindernis 11
n zu vermeiden.
[0038] Die Projektionen der zum Kommandozeitpunkt t
K von der Last 8 angenommenen Position P
z(t
K), des Endpunktes E und der Stützpunkte S
1n, S
2n auf die X-Achse werden hierbei als Pz', E', S
1n' und S
2n' bezeichnet, die Projektionen auf die Y-Achse werden demgegenüber als Pz", E", S
1n" und S
2n" bezeichnet. Erfindungsgemäß werden die Projektionen Pz', E', S
1n', S
2n' und die Projektionen Pz", E", S
1n", S
2n" getrennt voneinander betrachtet. Für jede dieser Gruppen von Projektionen werden
jeweils Einzelbewegungen TE geplant, um die jeweiligen Projektionen Pz', E', S
1n', S
2n'bzw. Pz", E", S
1n", S
2n" entlang der entsprechenden Bewegungsrichtung X, Y miteinander zu verbinden. Eine
Einzelbewegung TE legt dabei vorzugsweise einen Positions-, Geschwindigkeits- und
Beschleunigungsverlauf entlang der jeweiligen Bewegungsrichtung fest. Durch eine Einzelbewegung
TEx für die Bewegungsrichtung X werden beispielsweise die Projektionen Pz', E', S
1n', S
2n' entlang der Bewegungsrichtung X verbunden. Für jede der Bewegungsrichtungen X, Y
ergibt sich so zunächst jeweils zumindest eine Einzelbewegung TE. Auf Bewegungsrichtungen
wie X, Y bezogene Einzelbewegungen werden hierbei als TEx, TE
Y bezeichnet.
[0039] Um Hindernisse 11a, 11n zu umfahren, die zwischen der zum Kommandozeitpunkt t
K von der Last 8 angenommenen Position P
Z(t
K) und dem Endpunkt E angeordnet sind, können insbesondere für die zweite Bewegungsrichtung
Y mehrere Einzelbewegung TE
Y geplant werden. So können für die Last 8 entlang der Bewegungsrichtung Y einerseits
Einzelbewegungen TE
Y in Form von Hebebewegungen ("Hoist Up") vorgesehen werden, und andererseits Einzelbewegungen
TE
Y in Form von Senkbewegungen ("Hoist Down") vorgesehen werden. Zur Vermeidung von Hindernissen
11a, 11n, werden hierbei üblicherweise zunächst Hebebewegungen ("Hoist Up") durchgeführt,
und Senkbewegung ("Hoist Down") erst nach einer geeigneten Horizontalbewegung entlang
der X-Achse ("Move Trolley"), um die Last 8 um ein Hindernis 11n herum zu bewegen
bzw. die Last 8 über ein Hindernis 11n zu heben. Dazu ist anzumerken, dass zum Bewegen
einer Last 8 um ein Hindernis 11n Einzelbewegungen TE entlang der Bewegungsrichtungen
X, Y kombiniert werden müssen.
[0040] In der in Fig. 2 gezeigten Situation ist aus den genannten Gründen für die Last 8
die Einzelbewegung TE
Y2 als Hebevorgang vorgesehen, welche die Last 8 entlang der Bewegungsrichtung Y zuerst
soweit anhebt, dass eine Kollision mit dem Hindernis 11n ausgeschlossen werden kann.
Eine zur Überführung der Last 8 in den Endpunkt E bereits geplante Einzelbewegung
TEx entlang der Bewegungsrichtung X wird in einem solchen Szenario erst begonnen,
wenn eine Kollision wie beschrieben ausgeschlossen werden kann. Wie erwähnt ist es
zum Umfahren eines Hindernisses 11 üblicherweise erforderlich, Einzelbewegungen TE
entlang der Bewegungsrichtungen X, Y geeignet zu kombinieren. Zur Planung von Einzelbewegungen
TE
Y, TE
Y2 können wie erwähnt Stützpunkte S
1n, S
2n eingesetzt werden. So kann in der in Fig. 2 gezeigten Situation zunächst eine Einzelbewegungen
TE
Y2 geplant werden, welche die Projektion P
Z"(t
K) mit der Projektion S
1n" verbindet, und es kann eine weitere Einzelbewegung TE
Y geplant werden, welche die Projektion S
2n" mit der Projektion E" verbindet. Da die Projektionen der Stützpunkte S
1n, S
2n auf die Y-Achse gleich sind, also S
1n" = S
2n" gilt, kann im konkreten Fall anhand der zwei Einzelbewegungen TE
Y2, TE
Y in Y-Richtung in Kombination mit einer zwischen diesen Einzelbewegungen TE
Y2, TE
Y in Y-Richtung ausgeführten Einzelbewegung TEx in X-Richtung das Hindernis 11n umfahren
werden.
[0041] In diesem Zusammenhang ist anzumerken, dass entlang der X-Achse üblicherweise eine
einzelne Einzelbewegung TEx von der Projektion P
Z'(t
K) zur Projektion E' ausreichend ist, um eine kollisionsfreie Bewegung der Last 8 in
den Endpunkt E zu gewährleisten. Ebenso ist an dieser Stelle ist anzumerken, dass
die gegenständliche Erfindung auch den Fall abdeckt, dass sich ein zuvor für die Planung
einer Trajektorie T angenommenes Hindernis 11a im Nachhinein als nicht vorhanden herausstellt,
das Hindernis 11a also verschwindet. In einem solchen Fall ist auch entlang der Y-Achse
bereits eine einzelne Einzelbewegung TE
Y zur Überführung der Last 8 von ihrer Position P
Z(t
K) in den Endpunkt E ausreichend.
[0042] Nach der Planung der Einzelbewegungen TE werden die geplanten Einzelbewegungen TE
entsprechend einer vorgegebenen Reihenfolge, nachfolgend als "Bewegungsabfolge" bezeichnet,
ausgeführt, um die Last 8 entlang der ersten Bewegungsrichtung X und entlang der zweiten
Bewegungsrichtung Y weiterzubewegen. Aus den geplanten Einzelbewegungen TE ergibt
sich so eine Umplanungstrajektorie TU. Die Umplanungstrajektorie TU ist in Fig. 2
durch die durchgezogene Linie dargestellt.
[0043] Einzelbewegungen TE, wie sie im Rahmen des erfindungsgemäßen Verfahrens auftreten
können, sind in den Figuren 2b, 2c und 2d gezeigt. Entsprechend der in Fig. 2b gezeigten
Einzelbewegung TEx, in deren Rahmen der Positionsverlauf s
x die Projektion P
Z'(t
k) mit den Projektionen S
1n', S
2n' und mit der Projektion E' verbindet, kann die Planung einer Einzelbewegung TE hinsichtlich
ihres zeitlichen Positionsverlaufs s
x beispielsweise durch die Vorgabe eines sigmoiden-ähnlichen Verlaufs erfolgen, was
jedoch lediglich beispielhaft zu verstehen ist. Auch andere Positionsverläufe können
an dieser Stelle herangezogen werden.
[0044] Fig. 2c zeigt eine entsprechende Einzelbewegung TE
Y2 entlang der Y-Richtung, mittels derer die Projektionen P
z"(t
k) und S
1n" auf die Y-Richtung miteinander verbunden werden. Die Einzelbewegung TE
Y2 stellt dementsprechend eine zuvor beschriebene Hebebewegung dar, und endet zum Zeitpunkt
t
S1 in der Projektion S
1n". In Fig. 2d ist letztlich die Einzelbewegung TE
Y dargestellt, die zum Zeitpunkt t
S2 beginnt und die die Last 8 ausgehend von der Projektion S
2n" in den Endpunkt E" senkt. Diesbezüglich ist anzumerken, dass insbesondere bei Hebebewegungen
in Y-Richtung üblicherweise nicht verlangt, dass die Geschwindigkeit der Last 8 in
Y-Richtung am Ende der Hebebewegung gleich Null sein soll. Damit wird eine Last 8
über die Projektionen S
1n" bzw. S
2n" hinausgehoben, was in den Sicherheitsabstand zu Hindernissen 11 erhöht und damit
vorteilhaft ist. Eine sich ergebende Umplanungstrajektorie TU geht dadurch üblicherweise
nicht direkt durch die Stützpunkte S
1n oder S
2n, sondern umläuft diese.
[0045] Durch die Auftrennung der neu zu planenden Gesamtbewegung in eine Mehrzahl von stattdessen
zu planenden Einzelbewegungen TE wird die zu lösende (Um-)Planungsaufgabe im Vergleich
zu aus dem Stand der Technik bekannten Verfahren signifikant vereinfacht. So wird
das komplexe Problem der Planung einer zumindest zweidimensionalen Bewegung auf die
Planung mehrerer nur noch eindimensionaler Bewegungen reduziert. Gerade dieser Umstand
erweist sich in der praktischen Umsetzung als vorteilhaft, da die Planung eindimensionaler
Bewegungen ein in der Regelungs- und Automatisierungstechnik bekanntes und bereits
auf verschiedene Weisen gelöstes Problem darstellt. Bei der konkreten Planung der
Einzelbewegungen TE kann so auf eine Vielzahl von bekannten Ansätzen zurückgegriffen
werden. Soll beispielsweise eine Überführung der Last 8 in den Endpunkt E anhand zeitoptimaler
Einzelbewegungen TE sichergestellt werden, kann unter Verwendung der mittels der gegebenen
Antriebe der Hebeeinrichtung 1 realisierbaren, maximalen Beschleunigungen entlang
der Bewegungsrichtungen X, Y zum Beispiel der aus der regelungstechnischen Literatur
hinlänglich bekannte Bang-Bang-Controller-Ansatz herangezogen werden.
[0046] In Fig. 3a wird die Planung einer zeitoptimalen Einzelbewegung TE zur Verbindung
der Projektionen P
Z' und E' näher erläutert. Dabei sind neben dem Positionsverlauf s
x auch der zugehörige Geschwindigkeitsverlauf v
x und der zugehörige Beschleunigungsverlauf a
x entlang der X-Achse dargestellt. Die wesentlichste dynamische Limitierung, die bei
der Planung einer zeitoptimalen Einzelbewegung TE zu berücksichtigen ist, sind dabei
kinematische Begrenzungen der Antriebe der Hebeeinrichtung 1, wie eine maximale realisierbare
Beschleunigung der Antriebe oder eine maximale durch die Antriebe realisierbare Kraft.
Aus diesen kinematischen Begrenzungen ergeben sich Begrenzungen für die entlang der
jeweiligen Bewegungsrichtungen X, Y realisierbaren Beschleunigungen der Last 8. Die
maximal mögliche positive Beschleunigung der Last 8 wird dabei als a
+max bezeichnet, die maximal mögliche negative Beschleunigung der Last 8 als a
-max. Eine schnellstmögliche Einzelbewegung TE entlang der X-Achse wird in diesem Sinn
unter Ausnützung der maximal möglichen positiven Beschleunigungen a
+max sowie der maximal möglichen negativen Beschleunigungen a
-max entlang der X-Achse erreicht.
[0047] Im in Fig. 3a gezeigten Beispiel können der dargestellte Positions-, Geschwindigkeits-
und Beschleunigungsverlauf mathematisch als

dargestellt werden. Darin steht
σ(
x) für die aus der Mathematik wohlbekannte Sigma-Funktion, die bei Argumenten größer
gleich Null (x ≥ 0) den Wert Eins annimmt, und ansonsten gleich Null ist. v
x0 steht hierbei für die Anfangsgeschwindigkeit zu Beginn der Einzelbewegung. Demnach
kann die Planung von Einzelbewegungen TE, anhand derer ein Positionsverlauf s
x, ein Geschwindigkeitsverlauf v
x und ein Beschleunigungsverlauf a
x festgelegt werden, erfolgen, indem wie oben dargestellte Funktionen festgelegt werden,
beispielsweise durch die Vorgabe von Zeitpunkten T
a1 und T
a2. In einer vorteilhaften Weise können dazu auch Randbedingungen vorgegeben werden,
wie zum Beispiel s
x(t
E) = E', v
x(t
E) = v
tE. Insbesondere die Geschwindigkeit v
tE kann hierbei gleich Null, aber auch verschieden von Null gewählt werden.
[0048] Entsprechend den obigen Ausführungen müssen zur Planung einer zeitoptimalen Einzelbewegung
TE Beschleunigungsphasen mit maximal positiver Beschleunigung a
+max, mit maximal negativer Beschleunigung a
-max, sowie mit verschwindender Beschleunigung, also einer Beschleunigung a
x=0, vorgegeben werden. In der in Fig. 3a dargestellten Vorgehensweise erfolgt das
durch die Vorgabe von Zeitpunkten T
a1 und T
a2, welche die genannten Beschleunigungsphasen zeitlich begrenzen. Die mit dem Beschleunigungsverlauf
a
x zusammenhängenden Geschwindigkeitsverläufe v
x und Positionsverläufe s
x stellen sich entsprechend den vorgegebenen Beschleunigungsverläufen ein. Die Breiten
der durch die Zeitpunkte T
a1 und T
a2 begrenzten Beschleunigungsphasen mit von Null verschiedenen Beschleunigungen werden
hierbei üblicherweise so vorgegeben, dass die sich ergebenden Geschwindigkeiten vorgegebene
Schranken v
+max, v
-max nicht überschreiten. Dabei ist anzumerken, dass für die Beschleunigung der Last 8
entlang der Bewegungsrichtungen X, Y auch geringere (konstante) Werte als die aufgrund
der kinematischen Begrenzungen der Antriebe möglichen Maximalbeschleunigungen vorgegeben
werden können.
[0049] Kinematische und/oder geometrische Grenzwerte können beispielsweise in der Recheneinheit
12 hinterlegt sein oder der Recheneinheit 12 vorgegeben werden. Weitere kinematische
Grenzwerte sind dabei vorzugsweise eine Maximalgeschwindigkeit v
Tmax und/oder eine Maximalbeschleunigung a
Tmax des Laufelements 5, oder eine Maximalgeschwindigkeit v
Hmax und eine Maximalbeschleunigung a
Hmax des Hubantriebs in Y-Richtung. Eine geometrische Begrenzung kann z.B. durch einen
maximalen Auslenkwinkel Θ
XYmax des Lastaufnahmeelements 7 in der Ebene E
XY gegeben sein. Bei einer dritten Bewegungsrichtung der Hebeeinrichtung in Z-Richtung
können zusätzlich eine Maximalgeschwindigkeit v
Smax und eine Maximalbeschleunigung a
Smax der tragenden Struktur 3 als kinematische Grenzwerte und ein maximaler Auslenkwinkel
Θ
ZYmax des Lastaufnahmeelements 7 in der Ebene E
ZY als geometrischer Grenzwert vorgegeben werden. Neben der Planung zeitoptimaler Einzelbewegungen
TE können aber auch andere Ansätze zur Planung von Einzelbewegungen TE herangezogen
werden.
[0050] In vielen Fällen erweist es sich in diesem Zusammenhang als vorteilhaft, die Einzelbewegungen
TE
x, TE
y (und ggf. TE
z) entlang der Achsen X, Y (und ggf. Z) voneinander unabhängig zu planen. Das bedeutet,
dass kein Zusammenhang zwischen den geplanten Einzelbewegungen TE
x, TE
y (ggf. TE
z) auf den jeweiligen Achsen besteht, der beispielsweise mathematisch ausgedrückt werden
könnte und der bei einer Änderung der Position P
z der Last 8 entlang einer ersten Bewegungsrichtung, beispielsweise der X-Achse, eine
Änderung der Position Pz der Last 8 auch entlang einer zweiten Bewegungsrichtung,
beispielsweise der Y-Achse, bedingen würde.
[0051] Die geplanten Einzelbewegungen TE werden in weiterer Folge entweder gleichzeitig
oder zeitlich zueinander versetzt ausgeführt. Ein zeitliches Versetzen von geplanten
Einzelbewegungen TE kann insbesondere im oben beschriebenen Fall von verbotenen Bereichen
V
i bzw. Hindernissen 11 erforderlich sein. So kann es für das Umfahren eines Hindernisses
11 erforderlich sein, eine Senkbewegung in Y-Richtung erst verzögert zu beginnen.
Eine in Y-Richtung geplante Einzelbewegung TE
Y würde demnach erst zeitlich versetzt begonnen werden, nachdem die in X-Richtung geplante
Einzelbewegung bereits begonnen worden ist. Die Vorgabe, welche Einzelbewegung TE
zuerst und welche Einzelbewegung TE gegebenenfalls erst später auszuführen ist, wird
im Rahmen der gegenständlichen Erfindung durch eine sogenannte Bewegungsabfolge zum
Ausdruck gebracht, die beispielsweise der Kransteuerung 16 bzw. der in der Kransteuerung
16 vorgesehenen Recheneinheit 12 über eine geeignete Schnittstelle vorgegeben werden
kann. Eine Bewegungsabfolge kann so in der Recheneinheit 12 hinterlegt werden. Eine
Bewegungsabfolge legt demnach die Reihenfolge fest, in der die geplanten Einzelbewegungen
TE auszuführen sind. Eine Bewegungsabfolge kann beispielsweise lauten: "Zuerst Horizontalbewegung
in X-Richtung, erst danach Vertikalbewegung in Y-Richtung." Eine Bewegungsabfolge
kann auch in Form einer Tabelle vorliegen, in welcher den geplanten Einzelbewegungen
TE Startzeitpunkte zugewiesen werden, zu denen diese begonnen werden. Eine Bewegungsabfolge
kann auch Zeitintervalle umfassen, welche Wartezeiten festlegen, die zwischen den
Startzeitpunkten von aufeinanderfolgenden Einzelbewegungen TE zumindest vorgesehen
werden müssen.
[0052] Ein zentrales Problem bei der Manipulation von Lasten 8 durch Hebeeinrichtungen 1,
welches durch eine geeignete Trajektorienplanung vielfach entweder gelöst, meist aber
zumindest stark verringert werden kann, ist das Problem von Lastschwingungen. Vor
allem schnelle Bewegungsvorgänge von Hebeeinrichtungen können oftmals unerwünschte
Schwingungen und/oder Pendelbewegungen von transportierten Lasten 8 oder von Lastaufnahmeelementen
anregen. Schwingungen von Lasten 8 können wiederum Umschlags- und Manipulationsvorgänge
verzögern, da Lasten, wie z.B. Container, in derartigen Fällen oft gar nicht oder
zumindest nicht ausreichend präzise platziert werden können und erst gewartet werden
muss, bis eine gegebene Schwingung wieder abgeklungen ist. In Fig.1 ist die Möglichkeit
der Ausbildung von Schwingungen und/oder Pendelbewegungen anhand eines Doppelpfeils
in der X-Y-Ebene E
XY dargestellt.
[0053] Im gegenständlichen Zusammenhang zeigt sich, dass sogenannte flache Trajektorien,
also Trajektorien, die in Abhängigkeit vom konkreten Aufbau der Hebeeinrichtung hinreichend
oft stetig differenzierbar sind, ein effektives Mittel gegen (Last-)Schwingungen und/oder
Pendelbewegungen darstellen. Dieser Herangehensweise liegt der Umstand zugrunde, dass
es sich bei einer wie in Fig. 1 gezeigten Hebeeinrichtungen 1 um ein im regelungstechnischen
Sinn "flaches System" handelt. Flache Systeme sind bekanntermaßen Systeme, die über
einen sogenannten flachen Ausgang verfügen.
[0054] Flache Ausgänge und deren Ableitungen erlauben im Fall eines flachen Systems, wie
beispielsweise der gegenständlichen Hebeeinrichtung 1, die Darstellung (auch "Parametrierung")
der inneren Zustands- bzw. Systemgrößen des flachen Systems. Die inneren Zustands-
bzw. Systemgrößen eines flachen Systems können demnach als Funktionen der flachen
Ausgänge und deren Ableitungen dargestellt werden, worüber der Fachmann auf dem Gebiet
der Regelungstechnik natürlich Bescheid weiß. Für die Unterdrückung von Schwingungen
einer von einer Hebeeinrichtung 1 transportierten Last 8 ist an dieser Stelle der
Umstand von Bedeutung, dass (in einer idealen Betrachtung) eine mithilfe eines flachen
Ausgangs konstruierte Steuerung keine Schwingungen bzw. Pendelbewegungen der Last
anregen kann.
[0055] Im Fall der gegenständlich betrachteten Hebeeinrichtung 1 stellen die Positionsverläufe
der Last 8 entlang der Bewegungsrichtungen X, Y flache Ausgänge des Systems "Hebeeinrichtung"
1 dar. Hierbei zeigt sich, dass es zur Unterdrückung von Schwingungen und/oder Pendelbewegungen
ausreichend ist, die durch die geplanten Einzelbewegungen TE festgelegten Positionsverläufe
s
x(t), s
y(t) als vierfach stetig zeitlich differenzierbare Positionsverläufe s
x(t), s
y(t) vorzugeben. Auf diese Weise können Schwingungen und/oder Pendelbewegungen unterdrückt
werden, ohne auf Messungen der Lastposition Pz angewiesen zu sein. An dieser Stelle
sei erwähnt, dass durch die Verwendung von noch öfter stetig differenzierbaren Trajektorien
noch ruhigere und für die Antriebe noch schonendere Bewegungsverläufe sichergestellt
werden können.
[0056] Um sicherzustellen, dass die durch die vorgegebenen Einzelbewegungen TE festgelegten
Positionsverläufe s
x(t), s
y(t) tatsächlich vierfach stetig differenzierbar sind, können die Positionsverläufe
s
x(t), s
y(t) vor deren Ausführung gefiltert werden. Die beschriebene vierfache Differenzierbarkeit
kann jedoch auch auf eine andere Art als durch eine Filterung erreicht werden, beispielsweise
durch polynomielle Ansätze für die vorgegebenen Positions-, Geschwindigkeits- und/oder
Beschleunigungsverläufe. Die Filterung von Einzelbewegungen TE, die als skalare Verläufe
vorliegen, ist hierbei wesentlich einfacher als die Filterung von mehrdimensionalen
Verläufen. Auch deshalb stellt die Verwendung von Einzelbewegungen TE einen signifikanten
Vorteil bei der Steuerung von Hebeeinrichtungen 1 dar.
[0058] Die Größen
xT, vT, aT stehen hierbei für die Bewegungen des Laufelements 5,
xL und
yL demgegenüber für die Koordinaten der Last 8, deren entsprechende Ableitungen mit
ẋL, ẍL, 
usw. notiert sind. Entsprechend den obigen Ausführungen stellen die angegebenen Gleichungen
eine flache Parametrierung der Zustandsgrößen
xT, vT, aT als Funktion der flachen Ausgänge
ẍL, y
L dar. Der angegebene Zusammenhang verdeutlicht, dass sich Vorgaben hinsichtlich der
Verläufe der Koordination x
L und y
L in unmittelbarer Weise auf die Bewegung des Laufelements 5 auswirken.
[0059] Um die beschriebene Filterung zur Erzeugung flacher Trajektorien umzusetzen, kann
beispielsweise auf ein geeignetes Filter F zurückgegriffen werden, wie ein Moving-Average
Filter (MA-Filter, "Gleitender-Mittelwert-Filter"). Eine schematische Darstellung
einer solchen Filterung ist in Fig. 3b dargestellt. Fig. 3b zeigt dabei ein allgemeines
Filter F, das Positionsverläufe s, Geschwindigkeitsverläufe v und Beschleunigungsverläufe
a aufnimmt, und gefilterte Positionsverläufe s̃, Geschwindigkeitsverläufe ṽ und Beschleunigungsverläufe
ã ausgibt. Das Filter F kann ausgestaltet sein, auch zeitliche Ableitungen der genannten
Größen auszugeben, insbesondere von eingehenden Beschleunigungsverläufen. Das Filter
F kann dabei als Eingrößensystem ausgeführt sein, und je nur eine der genannten Größen
Position s, Geschwindigkeit v und Beschleunigung a aufnehmen und gefiltert wieder
ausgeben. Das Filter F kann aber auch als Mehrgrößensystem ausgeführt sein und gleichzeitig
mehrere Größen verarbeiten. In bekannter Weise kann das Filter F in der Steuereinheit
12 implementiert sein.
[0060] Die Filterzeit τ
filt eines als MA-Filter umgesetzten Filters F kann hierbei in einer besonders vorteilhaften
Weise in Abhängigkeit der Geometrie der Hebeeinrichtung und der Pendelgleichungen
gewählt werden. Durch die Wahl größerer Zeitkonstanten können die zuvor geplanten
Einzelbewegungen noch stärker gefiltert werden und beispielsweise für das Laufelement
noch konservativere Verläufe vorgegeben werden. Durch eine mehrmalige Filterung können
in einer äußerst vorteilhaften Weise Einzelbewegungen TE erzeugt werden, durch welche
für die Antriebe der Hebeeinrichtung 1 vorgegebene kinematische Begrenzungen berücksichtigt
werden, wie Geschwindigkeits-, Beschleunigungs-, Ruckbeschränkungen.
[0061] Wie die Definition von Verbotszonen V
i konkret erfolgen kann, ist weiters in Fig. 4 näher gezeigt. So kann z.B. eine Umhüllende
eines Hindernisses 11 in Form eines Rechtecks verwendet werden, welches das Hindernis
11 vollständig einschließt. Dabei entspricht die Höhe H
R1 des Rechtecks zumindest der maximalen Erstreckung des Hindernisses 11 in Y-Richtung
und die Breite W
R1 des Rechtecks zumindest der maximalen Erstreckung des Hindernisses 11 in X-Richtung.
Dies ist nur beispielhaft zu verstehen, natürlich sind auch andere geometrische Festlegungen
der Verbotszone V
1 denkbar. Allgemein kann beispielsweise eine einzige verbotenen Zone V
1 mehrere Hindernisse 11 umschließen. Es kann aber auch eine feinere Definition mehrerer
Verbotszonen V
i angewandt werden, z.B. anhand der konkreten Umrisse der Hindernisse 11.
[0062] Entscheidende Bedeutung kommt bei einer wie in den Figuren 1 und 4 gezeigten Situation
der Reihenfolge, in der die geplanten Einzelbewegungen TE ausgeführt werden, zu. Wie
anhand von Fig. 4 unmittelbar erkannt werden kann, darf ausgehend vom Kommandozeitpunkt
t
k eine Senkbewegung in Y-Richtung durch die Einzelbewegung TE
Y erst dann ausgeführt werden, wenn eine Kollision mit dem Hindernis 11 ausgeschlossen
werden kann. Erfindungsgemäß wird zur Festlegung der Reihenfolge, in der die geplanten
Einzelbewegungen TE ausgeführt werden, eine sogenannte Bewegungsabfolge vorgegeben,
die festlegt, in welcher Reihenfolge die vorgegebenen Einzelbewegungen TE auszuführen
sind und zu welchen Zeitpunkten diese Einzelbewegungen TE gestartet werden.
[0063] Eine erste dahingehende Möglichkeit besteht darin, die geplanten Einzelbewegungen
TE zeitlich voneinander beabstandet durchzuführen, also nach der Durchführung einer
Einzelbewegungen TE zu warten und erst nach einer vorgegebenen Wartezeit mit der entsprechend
der Bewegungsabfolge nächsten Einzelbewegung TE fortzufahren.
[0064] Konkret kann eine Bewegungsabfolge beispielsweise festlegen, dass in der in Fig.
4 gezeigten Situation zuerst in Y-Richtung eine Hebebewegung als Einzelbewegung TE
Y2 durchgeführt wird (englisch "Hoist Up"), danach die vertikale Einzelbewegung TE
x in X-Richtung durchgeführt wird ("Move Trolley"), und erst im Anschluss die Einzelbewegung
TE
Y1 in Y-Richtung als Senkbewegung ("Hoist Down"). Die Wartezeit zwischen diesen Einzelbewegungen
TEx, TE
Y, TE
Y2 kann dabei vorgegeben sein oder situationsabhängig bestimmt werden. So kann beispielsweise
gewartet werden, bis die Einzelbewegung TE
Y2 beendet ist, und erst nach deren Beendigung mit der nächsten Einzelbewegung TEx,
entweder entlang der gleichen Bewegungsrichtung X, Y oder entlang einer anderen Bewegungsrichtung
X, Y, begonnen werden. Auf diese Weise wird jedoch aufgrund der zwischen den verschiedenen
Einzelbewegungen TEx, TE
Y, TE
Y2 vorzusehenden Wartezeiten Zeit verloren. In einer vorteilhaften Weise können die
geplanten Einzelbewegungen TE aus diesem Grund auch zeitlich überlappend ausgeführt
werden. Zeitlich überlappend bedeutet hierbei, dass beispielsweise mit einer Einzelbewegung
in Y-Richtung bereits begonnen wird, noch bevor eine Einzelbewegung in X-Richtung
vollständig abgeschlossen ist. Auch eine derartige Überlappung von Einzelbewegungen
TE kann im Rahmen der gegenständlichen Erfindung in einer Bewegungsabfolge festgehalten
werden.
[0065] Im Zuge der Festlegung der Bewegungsabfolge, in der die geplanten Einzelbewegungen
auszuführen sind, ist es vielfach von besonderem Vorteil, wenn zusätzlich geprüft
wird, ob es im Zuge der resultierenden Umplanungstrajektorie TU gegebenenfalls zu
einer Kollision der Last 8 mit einer Verbotszone V
i kommen kann.
[0066] Wie diesbezüglich vorgegangen werden kann, ist in Fig. 5a-5c gezeigt. Fig. 5a und
Fig. 5b zeigen dazu einerseits Beschleunigungs-, Geschwindigkeits- und Positionsprofile
(a
x, v
x, s
x und a
y v
y, s
y) für die Bewegungsrichtungen X und Y, wie sie zur erfindungsgemäßen Umplanung der
Bewegung einer Last 8 eingesetzt werden können. In der dargestellten Situation befindet
sich die Last 8 zum Kommandozeitpunkt t
K links eines neu vorgegebenen Hindernisses 11n, wie in Fig.5c ersichtlich ist. Demnach
können die in Y-Richtung geplanten Einzelbewegungen TE
Y1, TE
Y2 ohne Einschränkung übernommen werden. Rein durch eine Bewegung in Y-Richtung kann
ausgehend von der Position P
z(t
k) keine Kollision herbeigeführt werden.
[0067] In X-Richtung zeigt sich allerdings, dass die Einzelbewegung TE
xa zu einer Kollision mit dem Hindernis 11 führen würde. Die zu Beginn geplante Einzelbewegung
TE
xa ist in Fig.5a durch die strichpunktierten Verläufe s
xa, v
xa und a
xa dargestellt. In Kombination mit der für die Y-Richtung geplanten Hebebewegung TE
Y2 würde sich die in Fig. 5c strichpunktiert gezeigte, erste Umplanungstrajektorie TU
1 ergeben, die allerdings eine Kollision mit der neuen Verbotszone V
1n zur Folge hätte. Aus diesem Grund wird die für die X-Richtung zunächst geplante Einzelbewegung
TEx nicht durchgeführt und stattdessen für eine vorgegebene Dauer T
St ein Bremsvorgang ausgeführt. Der Bremsvorgang entspricht der in Fig. 5a zu Beginn
vorgesehenen Phase mit negativer Beschleunigung. Darauf aufbauend wird eine neue Einzelbewegung
TE
xn in X-Richtung geplant und diese wird anstelle der zuvor geplanten, alten Einzelbewegung
TE
xa nach Ende des Bremsvorganges durchgeführt.
[0068] Auf eine besonders elegante Art und Weise kann eine Überprüfung, ob eine Kollision
mit einem Hindernis zu erwarten ist, auf folgende Weise durchgeführt werden: Vor der
Ausführung zumindest einer geplanten Einzelbewegung TE werden sogenannte Kollisionszeitpunkte
t
iX, t
iY ermittelt und miteinander verglichen. Unter den Kollisionszeitpunkten t
iX, t
iY sind dabei die jeweiligen Zeitpunkte zu verstehen, zu denen die Last 8 mittels der
jeweiligen geplanten Einzelbewegungen TEx, TE
Y eine Projektion Si' bzw. S
i" eines, von einer um ein Hindernis 11 gelegten Verbotszone V
i abgeleiteten, Stützpunktes S
i (englisch "Keypoints") auf die jeweilige Bewegungsrichtung X, Y erreichen würden.
[0069] Wie erwähnt sind Stützpunkte S
i bevorzugt Eckpunkte von Verbotszonen V
i. Um zu überprüfen, ob eine zu erwartende Umplanungstrajektorie TU zu einer Kollision
der Last 8 mit einem im Arbeitsbereich 15 vorgegebenen Hindernis 11 führen würde,
kann in der in Fig. 5c dargestellten Situation geprüft werden, ob der entsprechende
Kollisionszeitpunkt t
1X für die Einzelbewegung TE
xa entlang der X-Achse vor dem entsprechenden Kollisionszeitpunkt t
1Y für die Einzelbewegung TE
Y2 entlang der Y-Achse liegt, also t
iX<t
iY gilt (konkret auf Fig. 5c übertragen würde die Ungleichung t
iX<t
iY lauten). In diesem Fall kann in der in Fig. 5c gezeigten Situation auf eine Kollision
geschlossen werden. Die entsprechenden Kollisionszeitpunkte t
ix, t
iy sind hierbei in den Figuren 5a und 5b dargestellt.
[0070] Bei der beschriebenen Vorgehensweise ist insbesondere auf die Y-Koordinate der Lastposition
Pz, also die Projektion Pz" der Lastposition Pz auf die Y-Achse zu achten. Dabei ist
zu berücksichtigen, ob die Y-Koordinate Pz" der Lastposition Pz zu Beginn einer Einzelbewegung
TE
Y in Y-Richtung größer oder kleiner als die Projektion S
i" des in Y-Richtung nächsten Stützpunktes S
i auf die Y-Achse ist. In vielen praktisch relevanten Fällen ist die Lastposition Pz
zu Beginn einer neu geplanten Einzelbewegung TE durch die Lastposition Pz zum Kommandozeitpunkt
t
k, also P
Z(t
k), gegeben. Ist die Projektion S
i" des in Y-Richtung nächsten Stützpunktes S
i auf die Y-Achse kleiner als die Projektion Pz" der Lastposition P
Z auf die Y-Achse, ist die Bedingung für eine Kollision genau dann erfüllt, wenn umgekehrt
t
iY<t
iX gilt.
[0071] Einzelbewegungen TE
x, TE
Y liegen vielfach nicht in analytischer Form vor. In einer vorteilhaften Weise können
in solchen Fällen auch numerische Verfahren zur Nullstellensuche zur Bestimmung der
Kollisionszeitpunkte t
iX, t
iY herangezogen werden, wie das wohlbekannte Bisektionsverfahren oder das Newton-Verfahren.
[0072] In der praktischen Umsetzung ist es hierbei oftmals von Vorteil, sowohl analytische
als auch numerische Methoden zu kombinieren, um die gesuchten Kollisionszeitpunkte
t
iX, t
iY zu ermitteln. Ein derartiger Fall wird nachfolgend beschrieben. Dabei werden die
Beschleunigungsverläufe a
x und a
y zunächst wie beschrieben stückweise konstant vorgegeben. Zu diesen stückweise konstanten
Beschleunigungsverläufen a
x und a
y können die zugehörigen Positionsverläufe s
x und s
y leicht analytisch berechnet werden. Für die sich daraus ergebenden analytischen Beschreibungen
der Positionsverläufe s
x(t) und s
y(t) können die Kollisionszeitpunkte t
iX, ti
Y mit geringem Aufwand berechnet werden, indem z.B. die Nullstellen t
x0, t
y0 der Funktionen f
x(t) = s
x(t)-Si', f
y(t) = s
y(t)-Si' bestimmt werden. Für diese Nullstellen t
x0, t
y0 gilt definitionsgemäß f
x(t
x0) = f
y(t
y0) =0. Natürlich können in den Formeln f
x(t) und f
y(t) auch die Höhe und Breite der Last 8 berücksichtigt werden, welche üblicherweise
durch die Höhe H
7 des Lastaufnahmeelements 7 zuzüglich der Höhe Hg eines Containers 9 in Y-Richtung,
sowie der halben Breite B
7 des Lastaufnahmeelements 7 (entspricht üblicherweise der halben Breite Bg des Containers
9) gegeben sind. Je nachdem ob sich die Last 8 von links, rechts, oben oder unten
dem nächsten Stützpunkt S
i nähert, kann beispielsweise die Funktion f
x(t) um die halbe Breite Bg vergrößert oder verkleinert werden.
[0073] Werden die Einzelbewegungen TEx, TE
Y gefiltert, beispielsweise mittels eines eingangs beschriebenen MA-Filters, werden
insbesondere die Positionsverläufe s
x(t) und s
y(t) zu gefilterten Positionsverläufen
s̃x(
t) und s
y(t) gefiltert. Für solche gefilterten Positionsverläufe
s̃x(
t) und s
y(t) kann nun die Eigenschaft eines MA-Filters ausgenützt werden, dass die aus der
oben gezeigten Funktion f
x(t) ermittelten Nullstellen t
x0, t
y0 durch eine Filterung um maximal die Filterzeit
τfilt des zur Filterung eingesetzten MA-Filters verschoben werden können. Für den Fall
einer zweifachen Filterung kann dementsprechend ein Zeitintervall der Länge 2 · τ
filt um die zuvor ermittelten Nullstellen t
x0, t
y0 gelegt werden, mit den Nullstellen t
x0, t
y0 zu Beginn des Intervalls an der linken Intervallgrenze. In einem solchen Zeitintervall
kann nun mittels eines Bisektionsverfahrens nach Nullstellen der Funktionen f
x(t)
= 
und

gesucht werden. Diese Nullstellen entsprechen dann den gesuchten Kollisionszeitpunkten
t
iX, t
iY für die gefilterten Positionsverläufe
s̃x(
t) und
s̃y(
t).
[0074] Neben dem beschriebenen Vergleich zweier Kollisionszeitpunkte t
iX, t
iY, kann noch ein weiterer Ansatz zur Kollisionsüberprüfung genannt werden. So kann
zunächst nur der Kollisionszeitpunkt t
iy berechnet werden, der angibt, wann entlang der Y- Achse durch eine geplante Einzelbewegung
TE
Y in Y-Richtung eine Projektion eines vorgegebenen Stützpunktes S
i" auf die Y-Achse erreicht wird. Anhand dieses Kollisionszeitpunktes t
iy kann weiters die Position s
X(t
iy) ermittelt werden, welche die zum Kollisionszeitpunkt t
iy durch die geplante Einzelbewegung TE
x in X-Richtung vorgegebene Position auf der X- Achse beschreibt.
[0075] Die Überprüfung, ob durch geplante Einzelbewegungen TE eine Kollision mit einem Hindernis
11 zu erwarten ist, kann dann erfolgen, indem die Position s
x(t
iy) mit der Projektion Si' des Stützpunktes Si auf die X-Achse verglichen wird. Im in
Fig. 5a-5c konkret gezeigten Fall kann zum Beispiel auf eine Kollision geschlossen
werden, wenn eine der Bedingungen s
x(t
1y) > S
1' bzw. s
x(t
2y) < S
2' erfüllt ist. So kann gegenüber der zuvor beschriebenen Vorgangsweise Rechenzeit
eingespart werden, da lediglich ein Kollisionszeitpunkt t
iy bestimmt werden muss. Diese Herangehensweise ist in Fig. 5a anhand der Punkte s
xa(t
1y) und s
xn(t
1y) angedeutet. Während s
xa(t
1y) oberhalb der Projektion S
1' liegt (was zu einer Kollision führen würde), liegt s
xn(t
1y) unterhalb der Projektion S
1', mit dem gewünschten Effekt der Kollisionsvermeidung.
[0076] Andererseits ist es zur Überprüfung einer Kollision aber ebenso möglich, zunächst
den Kollisionszeitpunkt t
ix zu ermitteln, anhand dieses Kollisionszeitpunktes t
ix, die korrespondierende Position auf der Y-Achse s
y(t
ix) zu bestimmen, und die korrespondierende Position auf der Y-Achse s
y(t
x) mit einer Projektion Si" eines Stützpunktes Si auf die Y-Achse zu vergleichen. Im
in Fig. 5a-5c gezeigten Fall wäre in diesem Sinn eine für eine Kollision zu erfüllende
Bedingung s
y(t
1x) < S
1" (nicht dargestellt).
[0077] Ergibt eine der oben genannten Vorwegrechnungen vor der Ausführung zumindest einer
Einzelbewegung TE, dass eine Kollision zu erwarten ist, wird die für die Kollision
ursächliche Einzelbewegung TE nicht durchgeführt und stattdessen entlang jener Bewegungsrichtung
X, Y, für welche die zumindest eine nicht durchgeführte Einzelbewegung geplant ist,
in Fig. 5c die Einzelbewegung TEx in Bewegungsrichtung X, ein vorgegebener Bremsvorgang
durchgeführt. Der Bremsvorgang wird dabei zumindest für die Dauer einer vorgegebenen
Minimalbremszeit T
St durchgeführt. Ein Bremsvorgang gibt dabei Beschleunigungen für die Bewegung der Last
8 derart vor, dass die Geschwindigkeit der Last 8 entlang jener Richtung, entlang
der gebremst werden muss reduziert wird. So werden bei positiven Geschwindigkeiten
negative Beschleunigungen vorgegeben werden und umgekehrt. In einer vorteilhaften
Weise kann auch bei einem Bremsvorgang auf die maximal zulässigen Beschleunigungen
zurückgegriffen werden.
[0078] Nach der Minimalbremszeit T
St wird in einer vorteilhaften Weise in einem Neuplanungsschritt zumindest eine nicht
durchgeführte Einzelbewegung TE zu einer neuen Einzelbewegung TE umgeplant. In einem
weiteren Überprüfungsschritt mit der zumindest einen neuen Einzelbewegung TE kann
erneut überprüft werden, ob die auf Basis der neuen Einzelbewegung TE zu erwartende
Umplanungstrajektorie TU zu einer Kollision führt. Wird keine Kollision erkannt, kann
die neu geplante Einzelbewegung TE ausgeführt werden.
[0079] Wird im vorhergehenden Überprüfungsschritt allerdings erneut eine Kollision der Last
8 mit einem Hindernis 11 prädiziert, kann vorteilhafterweise erneut ein vorgegebener
Bremsvorgang für zumindest eine weitere Minimalbremszeit T
St durchgeführt werden. Danach können erneut ein Neuplanungsschritt und ein Überprüfungsschritt,
der diesem Neuplanungsschritt folgt, durchgeführt werden.
[0080] Durch ein wiederholtes Ausführen des oben beschriebenen Bremsvorganges kann die Last
8 auch zur Gänze in den Stillstand gebracht werden. Die weitere Planung von Einzelbewegungen
TE findet dann ausgehend vom Stillstand der Last 8 statt. Die Möglichkeit, mittels
des erfindungsgemäßen Verfahrens ausgehend vom Stillstand der Last 8 entsprechende
Einzelbewegungen TE und damit eine aus diesen Einzelbewegungen TE resultierende Trajektorie
T zu planen, eröffnet unmittelbar die Option, anhand des erfindungsgemäßen Verfahrens
auch grundsätzlich neue Trajektorien T für die Bewegung einer Last 8 zu planen. Befindet
sich die Last 8 zu Beginn eines Bewegungsvorganges im Stillstand und ist noch keine
Trajektorie T für deren Bewegung vom Anfangspunkt A in den Endpunkt E bekannt, kann
der Stillstand im Anfangspunkt A als Ende eines mehrfach ausgeführten Bremsvorganges
angenommen / vorgegeben werden und durch Anwendung des erfindungsgemäßen Verfahrens
auch eine erste Trajektorie T zur Überführung der Last 8 vom Stillstand im Anfangspunkt
A in den Endpunkt E geplant werden.
[0081] Ähnlich der zuvor beschriebenen Ermittlung der Kollisionszeitpunkte t
iX, t
iy kann auch für einen Bremsvorgang ein Zeitintervall angegeben werden, in dem die Last
8 vollständig in den Stillstand überführt werden kann. Konkret können für dieses Zeitintervall
die Grenzen t
k (Kommandozeitpunkt) und t
k +T
TE angegeben werden, wobei T
TE die Dauer einer geplanten Einzelbewegung TE beschreibt. Innerhalb dieses Zeitintervalls
kommt es bei wiederholter Ausführung eines Bremsvorganges zum Stillstand der Last
8, wobei der konkrete Zeitpunkt wie vorhin beispielsweise durch ein Bisektionsverfahren
ermittelt werden kann.
[0082] Auch wenn die gegenständliche Erfindung bislang anhand einer Trajektorie T in der
X-Y-Ebene E
XY beschrieben wurde, ist auch eine Erweiterung auf eine dreidimensionale Trajektorie
T im Raum möglich. Das prinzipielle Verfahren zur Umplanung auch von dreidimensionalen
Trajektorien T auf Basis von bevorzugt unabhängigen Einzelbewegungen bleibt hierbei
unverändert. Wird die Last 8 durch die Hebeeinrichtung 1 zusätzlich entlang einer
dritten Bewegungsrichtung Z bewegt, wird zur Umplanung der Trajektorie T entsprechend
dem erfindungsgemäßen Verfahren auch für die dritte Bewegungsrichtung Z zumindest
eine Einzelbewegung TE
Z geplant, welche gemäß einer vorgegebenen Bewegungsabfolge zusätzlich zu den für die
erste Bewegungsrichtung X und für die zweite Bewegungsrichtung Y geplanten Einzelbewegungen
TEx, TE
Y ausgeführt wird.
[0083] Zur Anwendung der gegenständlichen Erfindung bei der Planung von dreidimensionalen
Trajektorien ist es vielfach vorteilhaft, anstelle eines zweidimensionalen Arbeitsbereichs
15 einen 3D-Arbeitsraum zur Beschränkung der Bewegung der Last 8 vorzugeben. Im Gegensatz
zu einer rein zweidimensionalen Betrachtung kann es im 3D-Fall allerdings auch erforderlich
sein, die Ausdehnung eines Hindernisses 11 sowie die Ausdehnung einer Last 8 in Z-Richtung
zu berücksichtigen. Das kann beispielsweise in Montagehallen erforderlich sein, wo
an den Wänden angeordnete Hindernisse 11 in den Raum der Montagehalle ragen. In derartigen
Fällen können Situationen eintreten, in denen einem Hindernis 11 auch durch geeignete
Senkbewegungen ausgewichen werden kann, was durch das erfindungsgemäße Verfahren jedoch
ebenso umsetzbar ist.
[0084] Ein derartiger Fall ist in Fig. 6 dargestellt, wo wie in den vorhergehenden Beispielen
zum Kommandozeitpunkt tk ausgehend von der Position P
z(t
k) neue Einzelbewegungen TE
X1, TE
X2, TE
Y1, TE
Y2, TE
Y3 geplant werden. Dabei ist der wichtige Fall gezeigt, dass auch in X-Richtung mehrere
Einzelbewegungen TE
X1, TE
X2 geplant werden, was im Rahmen der gegenständlichen Erfindung ebenso möglich ist.
In Fig. 6 wird dem Hindernis 11a beispielsweise durch eine Hebebewegung TE
Y3 ausgewichen und dem Hindernis 11b demgegenüber durch eine Senkbewegung TE
Y2. Die abschließende Überführung in den Endpunkt E erfolgt mittels einer finalen Hebebewegung
TE
Y1.
[0085] In vielen praktischen Anwendungen kann es in diesem Zusammenhang vorteilhaft sein,
optische Messsysteme zur Erfassung der Lastposition P
Z oder auch von Hindernissen 11 einzusetzen, wie dies beispielsweise in der
EP 3 653 562 A1 beschrieben ist. Als optische Messsysteme sind hierbei insbesondere geeignete Kamerasysteme,
aber auch Laserscanner zu nennen. Zum Zweck der Überwachung von bezüglich ihrer Position
im Arbeitsbereich 15 veränderlichen Hindernissen 11 kann eine Kamera direkt auf der
Laufkatze einer Hebeeinrichtung 1 montiert/installiert sein. Konkret kann eine optische
Erfassung von Hindernissen hierbei vielfach Information darüber liefern, wie hoch
und an welchen räumlichen Positionen zu umfahrende Hindernisse 11 angeordnet sind.
Wird eine Positionsänderung eines Hindernisses 11 erkannt, kann daraus eine neue Verbotszone
V abgeleitet werden und wie beschrieben die Umplanung einer Trajektorie für die Bewegung
einer Last vorgenommen werden. Neben Kamera- und/oder Laserscansystemen sind auch
andere Ansätze zur Erfassung von Hindernissen denkbar. Vielfach bieten auch in Software
implementierte Automatisierungs- oder Logistiksysteme Informationen über zu berücksichtigende
Hindernisse 11.
1. Verfahren zum Steuern einer Hebeeinrichtung (1), welche eine Last (8) entlang einer
ersten Bewegungsrichtung (X) und entlang einer zweiten Bewegungsrichtung (Y) innerhalb
eines vorgegebenen Arbeitsbereichs (15) der Hebeeinrichtung (1) gemäß einer vorgegebenen
Trajektorie (T) von einem Anfangspunkt (A) zu einem Endpunkt (E) bewegt, dadurch gekennzeichnet, dass zu einem Kommandozeitpunkt (tk) während der Bewegung der Last (8) ein für die Bewegung der Last (8) neues Hindernis
(11n), welches zwischen der zum Kommandozeitpunkt (tk) von der Last (8) angenommenen Position (Pz) und dem Endpunkt (E) angeordnet ist,
vorgegeben wird und/oder ein bestehendes Hindernis (11), welches zwischen der zum
Kommandozeitpunkt (tk) von der Last (8) angenommenen Position (Pz) und dem Endpunkt (E) angeordnet ist,
zu einem neuen Hindernis (11n) für die Bewegung der Last (8) verändert wird, dass
unter Berücksichtigung von vorgegebenen kinematischen Beschränkungen der Hebeeinrichtung
(1) für die erste Bewegungsrichtung (X) und für die zweite Bewegungsrichtung (Y) jeweils
zumindest eine Einzelbewegung (TEx, TEY) geplant wird, welche die weitere Bewegung der Last (8) entlang der jeweiligen Bewegungsrichtung
(X, Y) ab dem Kommandozeitpunkt (tk) festlegt, wobei je Bewegungsrichtung (X,Y) zumindest eine Einzelbewegung (TEx, TEY) in einer Projektion (E', E") des Endpunktes (E) auf die jeweilige Bewegungsrichtung
(X, Y) endet, und dass die geplanten Einzelbewegungen (TEx, TEY) entsprechend einer vorgegebenen Bewegungsabfolge ausgeführt werden, um die Last
(8) ohne Kollision mit dem neuen Hindernis (11n) entlang der ersten Bewegungsrichtung
(X) und entlang der zweiten Bewegungsrichtung (Y) gemäß einer sich aus der Bewegungsabfolge
der geplanten Einzelbewegungen (TEx, TEY) ergebenden Umplanungstrajektorie (TU) weiterzubewegen.
2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass die für die erste Bewegungsrichtung (X) und die für die zweite Bewegungsrichtung
(Y) geplanten Einzelbewegungen (TEx, TEY) als voneinander unabhängige Einzelbewegungen (TEx, TEY) geplant werden.
3. Verfahren nach einem der Ansprüche 1 bis 2, dadurch gekennzeichnet, dass die geplanten Einzelbewegungen (TEx, TEY) jeweils einen zeitlich zumindest vierfach stetig differenzierbaren Positionsverlauf
(sx(t), sy(t)) umfassen, wobei die Positionsverläufe (sx(t), sy(t)) zur Erzeugung der zeitlich zumindest vierfach stetigen Differenzierbarkeit mittels
eines Filters (F) mit einer vorgebbaren Zeitkonstante gefiltert werden, wobei die
Zeitkonstante des Filters (F) in Abhängigkeit der Geometrie der Hebeeinrichtung (1)
gewählt wird, um bei einer kombinierten Ausführung der Einzelbewegungen (TEx, TEY) die vorgegebenen kinematischen Beschränkungen der Hebeeinrichtung (1) einzuhalten.
4. Verfahren nach einem der Ansprüche 1 bis 3, dadurch gekennzeichnet, dass für die zweite Bewegungsrichtung (Y) eine weitere Einzelbewegung (TEY2) geplant wird, welche die Last (8) in Kombination mit der entlang der ersten Bewegungsrichtung
(X) geplanten Einzelbewegung (TEx) um das neu vorgegebene und/oder das geänderte Hindernis
(11n) bewegt, und dass die zweite Einzelbewegung (TEY2) entsprechend der vorgegebenen Bewegungsabfolge vor der für die zweite Bewegungsrichtung
(Y) bereits geplanten Einzelbewegung (TEY) ausgeführt wird.
5. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die Bewegungsabfolge so vorgegeben wird, dass Einzelbewegungen (TEx) entlang der
ersten Bewegungsrichtung (X) und Einzelbewegungen (TEY) entlang der zweiten Bewegungsrichtung (Y) abwechselnd begonnen werden.
6. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die Bewegungsabfolge so vorgegeben wird, dass eine Einzelbewegung (TEx) entlang der
ersten Bewegungsrichtung (X) und eine Einzelbewegung (TEY) entlang der zweiten Bewegungsrichtung (Y) zeitlich überlappend durchgeführt werden.
7. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass vor der Ausführung zumindest einer geplanten Einzelbewegung (TEx, TEY) überprüft wird, ob die zu erwartende Umplanungstrajektorie (TU) zu einer Kollision
der Last (8) mit einem im Arbeitsbereich (15) vorgegebenen Hindernis (11a, 11n) führt.
8. Verfahren nach Anspruch 7, dadurch gekennzeichnet, dass zur Überprüfung, ob die zu erwartende Umplanungstrajektorie (TU) zu einer Kollision
der Last (8) mit einem im Arbeitsbereich (15) vorgegebenen Hindernis (11a, 11n) führt,
Projektionen (Si', Si") eines vom vorgegebenen Hindernis (11a, 11n) abgeleiteten Stützpunktes (Si) auf die Bewegungsrichtungen (X, Y) ermittelt werden, dass ein Kollisionszeitpunkt (tix) ermittelt wird, zu dem die Last (8) mit der für die erste Bewegungsrichtung (X)
geplanten Einzelbewegungen (TEx) die Projektion (Si') auf die erste Bewegungsrichtung (X) erreicht und ein Kollisionszeitpunkt (tiy) ermittelt wird, zu dem die Last (8) mit der für die zweite Bewegungsrichtung (Y)
geplanten Einzelbewegung (TEy) die Projektion (Si") auf die zweite Bewegungsrichtung (Y) erreicht, und dass die ermittelten Kollisionszeitpunkte (tix, tiy) miteinander verglichen werden.
9. Verfahren nach Anspruch 7, dadurch gekennzeichnet, dass zur Überprüfung, ob die zu erwartende Umplanungstrajektorie (TU) zu einer Kollision
der Last (8) mit einem im Arbeitsbereich (15) vorgegebenen Hindernis (11a, 11n) führt,
eine Projektion (Si', Si") eines vom vorgegebenen Hindernis (11a, 11n) abgeleiteten Stützpunktes (Si) auf
eine der Bewegungsrichtungen (X, Y) ermittelt wird, dass ein Kollisionszeitpunkt (tix, tiy) ermittelt wird, zu dem die Last (8) mit der für diese Bewegungsrichtung (X, Y) geplanten
Einzelbewegung (TEx, TEy) die ermittelte Projektion (Si', Si") erreicht, dass eine Position (sx(tix), sy(tiy)) der Last (8) auf der anderen Bewegungsrichtung (X,Y) ermittelt wird, welche von
der Last (8) zum ermittelten Kollisionszeitpunkt (tiy, tiy) angenommen wird, und dass die ermittelte Position (sx(tix), sy(tiy)) mit einer Projektion (Si', Si") des Stützpunktes (Si) auf jene Bewegungsrichtung (X, Y), für die die Position (sx(tix), sy(tiy)) der Last (8) ermittelt wurde, verglichen wird.
10. Verfahren nach Anspruch 8 oder 9, dadurch gekennzeichnet, dass die Kollisionszeitpunkte (tix, tiy) mit einem Verfahren zur Nullstellensuche ermittelt werden.
11. Verfahren nach einem der Ansprüche 8 bis 10, dadurch gekennzeichnet, dass im Fall einer ermittelten Kollision mit einem Hindernis (11a, 11n) die zumindest
eine Einzelbewegung (TEx, TEY) nicht durchgeführt wird und dass stattdessen entlang jener Bewegungsrichtung (X, Y), für welche die zumindest eine
nicht durchgeführte Einzelbewegung (TEX, TEY) geplant worden ist, für zumindest die Dauer einer vorgegebenen Minimalbremszeit
(Tst) ein vorgegebener Bremsvorgang durchgeführt wird.
12. Verfahren nach Anspruch 11, dadurch gekennzeichnet, dass anstelle der zumindest einen nicht durchgeführten Einzelbewegung (TEX, TEY) für die entsprechende Bewegungsrichtung (X,Y) eine neue Einzelbewegung (TEX,n, TEY,n) geplant wird, dass überprüft wird, ob die sich aus der neu geplanten Einzelbewegungen
(TEX,n, TEY,n) ergebende Umplanungstrajektorie (TU) zu einer Kollision der Last (8) mit einem im
Arbeitsbereich (15) vorgegebenen Hindernis (11a, 11n) führt, und dass die neue Einzelbewegung (TEX,n, TEY,n) durchgeführt wird, wenn keine Kollision erkannt wird, oder dass der vorgegebene
Bremsvorgang für zumindest eine weitere Minimalbremszeit (Tst) fortgesetzt wird und
erneut eine Neuplanung einer Einzelbewegung (TEX,n, TEY,n) sowie eine Überprüfung der Umplanungstrajektorie (TU), welche sich durch die neu
geplante Einzelbewegung (TEX,n, TEY,n) ergibt, durchgeführt werden, falls eine erneute Kollision mit einem Hindernis (11a,
11n) erkannt wird.
13. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die Position (Pz) der Last (8) messtechnisch erfasst wird und zur Planung und/oder
Durchführung der Einzelbewegungen (TEX, TEY) verwendet wird.
14. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die Last (8) durch die Hebeeinrichtung (1) zusätzlich entlang einer dritten Bewegungsrichtung
(Z) bewegt wird, wobei die Last (8) innerhalb eines vorgegebenen 3D-Arbeitsraumes
gemäß einer dreidimensionalen Trajektorie (T) bewegt wird, und dass zur Umplanung der Trajektorie (T) auch für die dritte Bewegungsrichtung (Z) zumindest
eine Einzelbewegung (TEz) geplant wird und gemäß einer vorgegebenen Bewegungsabfolge
zusätzlich zu den für die erste Bewegungsrichtung (X) und für die zweite Bewegungsrichtung
(Y) geplanten Einzelbewegungen (TEX, TEY) ausgeführt wird.
15. Hebeeinrichtung (1) zum Bewegen einer Last (8) von einem Anfangspunkt (A) zu einem
Endpunkt (E) gemäß einer vorgegebenen Trajektorie (T) innerhalb eines vorgegebenen
Arbeitsbereichs (15) der Hebeeinrichtung (1), wobei in der Hebeeinrichtung (1) ein
Lastaufnahmeelement (7) zur Aufnahme der Last (8) vorgesehen ist, das mit zumindest
einem Halteelement (6) mit einem Laufelement (5) verbunden ist, wobei das Laufelement
(5) mittels eines Laufelementantriebs entlang einer ersten Bewegungsrichtung (X) bewegbar
ist und das Lastaufnahmeelement (7) mittels eines Hubantriebs entlang einer zweiten
Bewegungsrichtung (Y) bewegbar ist, dadurch gekennzeichnet, dass in der Hebeeinrichtung (1) eine Recheneinheit (12) vorgesehen ist, welche ausgestaltet
ist, zu einem Kommandozeitpunkt (tk) während der Bewegung der Last (8) ein für die Bewegung der Last (8) neu vorgegebenes
Hindernis (11n), welches zwischen der zum Kommandozeitpunkt (tk) von der Last (8) angenommenen Position (Pz) und dem Endpunkt (E) angeordnet ist,
und/oder ein bestehendes Hindernis (11), welches zwischen der zum Kommandozeitpunkt
(tk) von der Last (8) angenommenen Position (Pz) und dem Endpunkt (E) angeordnet ist
und zu einem neuen Hindernis (11n) für die Bewegung der Last (8) verändert wird, einzulesen,
dass die Recheneinheit (12) weiters ausgestaltet ist, unter Berücksichtigung von vorgegebenen
kinematischen Beschränkungen der Hebeeinrichtung (1) für die erste Bewegungsrichtung
(X) sowie für die zweite Bewegungsrichtung (Y) jeweils eine Einzelbewegung (TEX, TEY) zu planen, welche die weitere Bewegung der Last (8) entlang der jeweiligen Bewegungsrichtung
(X, Y) ab dem Kommandozeitpunkt (tk) definieren, wobei die Einzelbewegungen (TEX, TEY) jeweils in einer Projektion (E', E") des Endpunktes (E) auf die jeweilige Bewegungsrichtung
(X, Y) enden, und dass die Recheneinheit (12) ausgestaltet ist, den Laufelementantrieb und den Hubantrieb
der Hebeeinrichtung (1) zu steuern, um die geplanten Einzelbewegungen (TE) entsprechend
einer vorgegebenen Bewegungsabfolge auszuführen und damit die Last (8) ohne Kollision
mit einem Hindernis (11, 11n) entlang der ersten Bewegungsrichtung (X) sowie entlang
der zweiten Bewegungsrichtung (Y) gemäß einer sich aus der Bewegungsabfolge der geplanten
Einzelbewegungen (TE) ergebenden Umplanungstrajektorie (TU) weiterzubewegen.