-
HINTERGRUND DER ERFINDUNG
-
GEBIET DER ERFINDUNG
-
Die vorliegende Erfindung betrifft ein Verfahren zur Planung und / oder Steuerung der Bewegung eines bewegten Elementes, insbesondere einer Maschinenkomponente, wie beispielsweise einer Mess - oder Werkzeugmaschine sowie eine Steuerung zur Steuerung der Bewegung eines Elements einer Maschine.
-
STAND DER TECHNIK
-
In vielen Bereichen der Technik gibt es Maschinen, bei denen Komponenten der Maschine in einer bestimmten Art und Weise bewegt werden müssen. Als Beispiele hierfür können Koordinatenmessmaschinen oder Werkzeugmaschinen genannt werden, bei denen ein Mess - oder Tastkopf oder ein Werkzeug in einer definierten Weise bewegt werden müssen. Obwohl es aus Effizienzgründen vorteilhaft ist, wenn das bewegte Element möglichst schnell von einer Position zu einer anderen Position bewegt werden kann, sind häufig Grenzen für eine dynamische Bewegung zu beachten, wie beispielsweise eine Begrenzung der maximal zulässigen Beschleunigung oder Verzögerung oder der maximal erlaubten Geschwindigkeit. Darüber hinaus ist es auch vorteilhaft, wenn die Bewegung von Maschinenelementen hinsichtlich des Rucks, der die Ableitung der Beschleunigung nach der Zeit darstellt, ebenfalls begrenzt ist, d.h. dass die Beschleunigung sich nicht beliebig schnell ändern darf.
-
Allerdings ist es deutlich schwieriger eine ruckbegrenzte Bewegung von Elementen von Maschinen zu realisieren als beispielsweise eine beschleunigungsbegrenzte oder geschwindigkeitsbegrenzte Bewegung. Dies gilt umso mehr, wenn zusätzliche Rahmenbedingungen, wie die Grenzen für eine zulässige Geschwindigkeit und Beschleunigung, eingehalten werden sollen. Außerdem soll eine entsprechende Bewegung des Elements das Element exakt an die gewünschte Zielposition bringen, ohne diese unnötig zu überfahren. Gleichzeitig soll das bewegte Element natürlich möglichst schnell, also zeitoptimiert an die Zielposition gefahren werden.
-
In dem Dokument
WO 2009/055120A2 ist bereits ein System und ein Verfahren zur ruckbegrenzten Trajektorie - Planung für eine Bewegungsplanung offenbart, wobei die Erzeugung des Bewegungsprofils in Echtzeit erfolgen kann. Hierzu wird die Bewegung in eine erste und eine zweite Phase unterteilt, wobei die erste Phase die Bewegung in Richtung eines Segments mit konstanter Geschwindigkeit leitet und wobei in der zweiten Phase die Berechnung eines Ruckwerts vorgenommen wird, der erforderlich ist, um erfolgreich die Zielbedingungen während der stattfindenden Bewegung zu erreichen.
-
OFFENBARUNG DER ERFINDUNG AUFGABE DER ERFINDUNG
-
Es ist Aufgabe der vorliegenden Erfindung ein Verfahren zur Planung und / oder Steuerung der Bewegung eines bewegten Elements, insbesondere einer Maschinenkomponente, vorzugsweise einer Mess - oder Werkzeugmaschine bereitzustellen, bei welchem in Echtzeit ein geplanter Bewegungsverlauf erstellt werden kann, wobei die Startbedingungen, wie Startposition, Startgeschwindigkeit und Startbeschleunigung sowie die Randbedingungen, wie betragsmäßig maximal zulässiger Ruck, betragsmäßig maximal zulässige Beschleunigung und betragsmäßig maximal zulässige Geschwindigkeit sowie die Endbedingungen, wie Zielposition und Zielgeschwindigkeit vorgegeben werden können und mittels des Verfahrens ein geplanter Bewegungsverlauf bzw. eine Trajektorie - Planung erstellt werden kann. Das Verfahren soll zudem mit möglichst geringem Aufwand automatisiert durchgeführt werden und für die Echtzeit - Steuerung der Bewegung eines bewegten Elements eingesetzt werden.
-
TECHNISCHE LÖSUNG
-
Diese Aufgabe wird gelöst mit einem Verfahren mit den Merkmalen des Anspruchs 1 sowie einer Steuerung mit den Merkmalen des Anspruchs 18. Vorteilhafte Ausgestaltungen sind Gegenstand der abhängigen Ansprüche.
-
Gemäß der Erfindung wird die Planung und / oder Steuerung der Bewegung eines bewegten Elements (Trajektorieplanung) ausgehend von Startwerten hinsichtlich der Position, der Geschwindigkeit und der Beschleunigung des zu bewegenden Elements zur Erreichung mindestens eines Zielwerts aus der Gruppe, die die Zielgeschwindigkeit, die Zielbeschleunigung und die Zielposition umfasst, dadurch bestimmt, dass die Bewegung in mehrere Intervalle unterteilt wird, in welchen jeweils ein konstanter Ruck innerhalb eines zulässigen Bereichs für den Ruck eingestellt wird. Die Unterteilung der Bewegung in mehrere Intervalle mit jeweils konstantem Ruck wird mittels mindestens einem, vorzugsweise mehreren Modulen mit einer vorgegebenen Intervalleinteilung und / oder eines vorgegebenen Verfahrens zur Ermittlung einer Intervalleinteilung erreicht, wobei mehrere Module miteinander kombiniert werden können. Innerhalb der einzelnen Module kann die zu bestimmende Länge der Intervalle sowie die sich aus den Intervallen mit konstantem Ruck zu bestimmenden Werte für die Beschleunigung, die Geschwindigkeit und den zurückgelegten Weg des bewegten Elements analytisch berechnet werden, sodass durch Kombination der Berechnungen für die Bewegungsplanung in den einzelnen Modulen eine analytische Gesamtberechnung für die Bewegungsplanung ermöglicht wird. Da keine numerischen Berechnungen notwendig sind, ist der Rechenaufwand begrenzt und das Verfahren kann in Echtzeit durchgeführt werden und in einfacher Weise beispielsweise auf einem Mikrocontroller implementiert werden.
-
Die Intervalle mit konstantem Ruck sind unabhängig von einem Takt einer entsprechenden Maschinensteuerung und ein Intervall mit konstantem Ruck kann kürzer oder länger als die Dauer eines Taktes einer Maschinensteuerung sein.
-
Die Beschleunigung kann sowohl positiv sein, also eine Beschleunigung im eigentlichen Sinn darstellen, als auch negativ und somit einer Verzögerung entsprechen. In gleicher Weise kann der Ruck positiv oder negativ sein und auch die Geschwindigkeit oder die Position können positiv oder negativ sein, sodass sowohl eine Vorwärts - als auch eine Rückwärtsbewegung möglich ist. Das Verfahren eignet sich zum Ausregeln, d.h. zum Anfahren einer Position, bei der die Zielgeschwindigkeit 0 sein soll, oder zum Anfahren einer nicht exakt bekannten Position, wie dies beispielsweise für das Antasten und Scannen an Messmaschinen, wie Koordinatenmessmaschinen erforderlich ist. Außerdem kann auch die Zielgeschwindigkeit ungleich 0 sein.
-
Die Module, die einfachere Teilprobleme des Gesamtproblems darstellen und somit die analytische Berechnung ermöglichen, können verschiedene Arten von Modulen umfassen, wie beispielsweise ein Geschwindigkeitsmodul, welches das Erreichen einer Zielgeschwindigkeit unabhängig von einer Position und einer Beschleunigung des bewegten Elements beim Erreichen der Zielgeschwindigkeit ermöglicht.
-
Darüber hinaus können die Module ein Geschwindigkeit - Beschleunigung - Modul umfassen, welches das Erreichen einer Zielgeschwindigkeit und einer Zielbeschleunigung unabhängig von einer Position des bewegten Elements beim Erreichen der Zielgeschwindigkeit und Zielbeschleunigung ermöglicht, wobei ein erlaubter Geschwindigkeits - und Beschleunigungsbereich berücksichtigt werden kann.
-
Ferner können die Module ein Begrenzung - Modul zur Einhaltung eines erlaubten Beschleunigungs - und / oder Geschwindigkeitsbereichs umfassen.
-
Ein weiteres Modul kann ein Weg - Modul sein, welches ermöglicht, dass das bewegte Element einen Weg einer bestimmten Länge zurücklegt, wobei Start - und Endgeschwindigkeit gleich sind und die Start - und Endbeschleunigung betragsmäßig gleich sind, aber entgegengesetzte Vorzeichen aufweisen.
-
Ferner kann ein Weg - Geschwindigkeit - Modul vorgesehen sein, mit welchem die Zielposition und die Zielgeschwindigkeit gleichzeitig erreicht werden können, wobei das bewegte Element an der Zielposition eine Beschleunigung gleich 0 aufweist.
-
Das Beschleunigung - Modul kann eine maximale Beschleunigung unter Beachtung der Grenzwerte für Beschleunigung und Geschwindigkeit und unter Berücksichtigung der Zielparameter ermöglichen.
-
Ein End - Modul kann zur Beendigung eines Bewegungsverlaufs vorgesehen werden, um den Bewegungsverlauf zu kürzen, wenn die Zielposition innerhalb eines Intervalls erreicht wird und die Zielgeschwindigkeit ungleich 0 ist.
-
Allgemein können mithilfe des Verfahrens und der verwendeten Module Intervalle mit variabler Dauer bestimmt werden, innerhalb derer der Ruck jeweils konstant ist, wobei die zugehörige Geschwindigkeit, Beschleunigung und der Weg des bewegten Elements innerhalb der Intervalle unter Berücksichtigung der Startwerte analytisch berechnet werden kann. Hierbei können von dem Verfahren Grenzwerte für die zulässige Beschleunigung und die zulässige Geschwindigkeit berücksichtigt werden, die nicht über - oder unterschritten werden dürfen.
-
Die Ruckwerte können aus einem zulässigen Ruckwertebereich gewählt werden, wobei insbesondere drei Ruckwerte verwendet werden können, nämlich ein maximal positiver Ruckwert jmax, ein minimal negativer Ruckwert jmin und ein Ruckwert gleich 0.
-
Auf Basis des Verfahrens zur Trajektorie - Planung kann eine Steuerung für ein bewegtes Element bereitgestellt werden, welche einen Speicher und einen Prozessor und insbesondere einen Mikrocontroller umfasst, die so ausgebildet sind, dass das entsprechende Verfahren implementiert und durchgeführt werden kann. Die Steuerung kann getaktet sein und bei jedem Takt der Steuerung kann das entsprechende Verfahren zur Trajektorie - Planung durchgeführt werden.
-
Figurenliste
-
Die beigefügten Zeichnungen zeigen in rein schematischer Weise in
- 1 ein Beispiel einer Bewegungsplanung mit verschiedenen Teildiagrammen für den zeitlichen Verlauf von Weg, Geschwindigkeit, Beschleunigung und Ruck des bewegten Elements,
- 2 ein Beispiel einer Bewegungsplanung mit verschiedenen Teildiagrammen für den zeitlichen Verlauf von Weg, Geschwindigkeit, Beschleunigung und Ruck eines bewegten Elements für das Modul einer Bewegungsplanung, bei welcher das bewegte Element eine bestimmte Geschwindigkeit erreichen soll, wobei die Position bzw. der zurückgelegte Weg und die Beschleunigung zum Zeitpunkt des Erreichens der Geschwindigkeit unberücksichtigt bleiben (Geschwindigkeit - Modul),
- 3 ein Beispiel einer Bewegungsplanung mit verschiedenen Teildiagrammen für den zeitlichen Verlauf von Weg, Geschwindigkeit, Beschleunigung und Ruck eines bewegten Elements für den ersten Schritt eines Moduls einer Bewegungsplanung, bei welcher das bewegte Element gleichzeitig eine bestimmte Geschwindigkeit und eine Beschleunigung erreichen soll (Geschwindigkeit - Beschleunigung - Modul),
- 4 eine Darstellung der Bewegungsplanung des zweiten Schritts für das Modul gemäß 3,
- 5 eine Darstellung der Bewegungsplanung des dritten Schritts für das Modul gemäß 3,
- 6 ein Beispiel einer Bewegungsplanung mit verschiedenen Teildiagrammen für den zeitlichen Verlauf von Weg, Geschwindigkeit, Beschleunigung und Ruck eines bewegten Elements für den ersten Schritt eines Moduls einer Bewegungsplanung, welche dazu dient bei Startwerten von Geschwindigkeit und Beschleunigung, die die erlaubten Grenzen überschreiten, die Geschwindigkeit und die Beschleunigung des bewegten Elements möglichst bald in den Bereich innerhalb der erlaubten Grenzen zurückzuführen (Begrenzung - Modul),
- 7 eine Darstellung der Bewegungsplanung des zweiten Schritts für das Modul gemäß 6,
- 8 bis 14 ein Beispiel einer Bewegungsplanung mit verschiedenen Teildiagrammen für den zeitlichen Verlauf von Weg, Geschwindigkeit, Beschleunigung und Ruck eines bewegten Elements jeweils für die verschiedenen Schritte eines Moduls einer Bewegungsplanung für eine Bewegung eines bewegten Elements, bei welcher ein bestimmter zurückgelegter Weg in einen Bewegungsverlauf eingefügt wird, wobei Start - und Endgeschwindigkeit des bewegten Elements gleich sind und Start - und Endbeschleunigung genau umgekehrt sind (Weg - Modul),
- 15 bis 18 ein Beispiel einer Bewegungsplanung mit verschiedenen Teildiagrammen für den zeitlichen Verlauf von Weg, Geschwindigkeit, Beschleunigung und Ruck eines bewegten Elements jeweils für die verschiedenen Schritte eines Moduls einer Bewegungsplanung für eine Bewegung eines bewegten Elements, bei welcher zu einem Zeitpunkt die Zielposition und Zielgeschwindigkeit sowie eine Beschleunigung des bewegten Elements gleich 0 erreicht werden sollen (Weg - Geschwindigkeit - Modul),
- 19 bis 21 ein Beispiel einer Bewegungsplanung mit verschiedenen Teildiagrammen für den zeitlichen Verlauf von Weg, Geschwindigkeit, Beschleunigung und Ruck eines bewegten Elements jeweils für die verschiedenen Schritte eines Moduls einer Bewegungsplanung für eine Bewegung eines bewegten Elements, bei welcher eine maximale Beschleunigung des Elements erreicht werden soll, ohne die Grenzen der Beschleunigung und der Geschwindigkeit zu verletzen (Beschleunigung - Modul),
- 22 ein Beispiel einer Bewegungsplanung mit verschiedenen Teildiagrammen für den zeitlichen Verlauf von Weg, Geschwindigkeit, Beschleunigung und Ruck eines bewegten Elements für das Modul einer Bewegungsplanung, bei welcher die gewünschte Position des bewegten Elements mit einer gewünschten Endgeschwindigkeit und einer Endbeschleunigung von 0 erreicht werden können,
- 23 eine Darstellung der Bewegungsplanung aus 23 mit der Darstellung des Taktes einer Steuerung für das bewegte Element und in
- 24 ein Beispiel einer Bewegungsplanung mit verschiedenen Teildiagrammen für den zeitlichen Verlauf von Weg, Geschwindigkeit, Beschleunigung und Ruck eines bewegten Elements, bei welcher die Bewegungsplanung bei jedem Takt der Steuerung für die Bewegung des bewegten Elements neu ermittelt wird.
-
AUSFÜHRUNGSBEISPIELE
-
Weitere Vorteile, Kennzeichen und Merkmale der vorliegenden Erfindung werden bei der nachfolgenden detaillierten Beschreibung der Ausführungsbeispiele ersichtlich. Allerdings ist die Erfindung nicht auf diese Ausführungsbeispiele beschränkt.
-
Die 1 zeigt in vier Teildiagrammen die Bewegungsplanung für ein bewegtes Element, wie beispielsweise den Tastkopf einer Koordinatenmessmaschine oder das Werkzeug einer Werkzeugmaschine. Die einzelnen Teildiagramme zeigen den Verlauf des zurückgelegten Weges bzw. der Position s des bewegten Elements über der Zeit sowie den Verlauf der Geschwindigkeit v während des Bewegungsablaufs und der Beschleunigung a während des Zeitablaufs der Bewegung. Im untersten Teildiagramm ist der Ruck j über den Verlauf der Bewegung dargestellt, wobei zu erkennen ist, dass der Ruck j in verschiedenen Intervallen konstant ist und drei verschiedene Werte annimmt, nämlich einmal einen maximalen Ruckwert jmax sowie einen minimalen Ruckwert jmin und einen Ruckwert 0, wobei der maximale Ruckwert jmax und der minimale Ruckwert jmin betragsmäßig gleich sind, allerdings einmal die Veränderung der Beschleunigung und das andere Mal die Veränderung der Verzögerung betreffen.
-
Wie den Diagrammen der 1 zu entnehmen ist, erstreckt sich die gezeigte Planung des Bewegungsablaufs über sechs Zeiteinheiten beginnend vom Zeitpunkt T1 bis zum Zeitpunkt T7, wobei die Planung des Bewegungsablaufs in fünf Intervalle 1 bis 5 unterteilt ist, die jeweils über das jeweilige Zeitintervall einen konstanten Ruck j aufweisen
-
Der gesamte Bewegungsverlauf wird, wenn der Bewegungsverlauf entsprechend der Bewegungsplanung gesteuert wird, so verlaufen, dass im ersten Intervall 1 der maximale Ruck jmax eingestellt wird, der zu einem Anstieg der Beschleunigung a bis zu einem Wert von höchstens amax führt. Gleichzeitig nimmt die Geschwindigkeit v zu und das Element liegt eine erste Strecke s1 zurück.
-
Im zweiten Intervall wird der minimale Ruck jmin eingestellt und die Beschleunigung a wird entsprechend auf 0 zurückgefahren, wobei sich die Geschwindigkeit der maximal zulässigen Geschwindigkeit vmax annähert. Während des zweiten Intervalls 2 bewegt sich das Element weiter bis zu einer Position s2.
-
Danach schließt sich ein Intervall 3 mit dem Ruckwert 0 an wobei das bewegte Element mit der Maximalgeschwindigkeit vmax bewegt wird.
-
Im vierten Intervall 4 wird der Ruckwert auf den minimalen Ruckwert jmin eingestellt, sodass die Beschleunigung a auf die maximale Verzögerung bzw. die minimale Beschleunigung amin eingestellt wird. Entsprechend nimmt die Geschwindigkeit v ab, wobei jedoch weiterhin das bewegte Element in der gleichen Richtung Weg s zurücklegt.
-
Im fünften und letzten Intervall 5 wird der Ruckwert j wieder auf den maximalen Ruck jmax eingestellt, sodass die Beschleunigung a auf einen Wert 0 zurückgeführt wird und auch die Geschwindigkeit v einen Endwert 0 annimmt, während das bewegte Element in die Zielposition s5 bewegt wird.
-
Ein derartiger Plan für den Bewegungsablauf eines bewegten Elements kann durch eine Vielzahl von verschiedenen Modulen erzeugt werden, die jeweils die Lösung für eine Teilaufgabe zur Durchführung einer gewünschten Bewegung des zu bewegenden Elements bereitstellen und es ermöglichen, dass die entsprechenden Werte für die Zeitdauer der Intervalle sowie der zu wählenden Geschwindigkeit und Beschleunigung durch analytische Rechenverfahren gelöst werden können, sodass eine Echtzeitsteuerung gemäß dem Verlauf des Plans für die Bewegung möglich ist.
-
Geschwindigkeit - Modul
-
Hierzu kann beispielsweise ein Modul Verwendung finden, mit welchen eine bestimmte Geschwindigkeit erreicht werden kann (Geschwindigkeit - Modul), wobei in der Planung der Bewegung die Position des bewegten Elements unberücksichtigt bleibt und auch die Beschleunigung zum Zeitpunkt des Erreichens der Geschwindigkeit ebenfalls nicht festgelegt wird. Die Beschleunigung darf lediglich ein betragsmäßiges Maximum nicht überschreiten.
-
Das Geschwindigkeit - Modul arbeitet so, dass zunächst bestimmt wird, ob beschleunigt oder gebremst werden muss. Hierzu wird die Geschwindigkeit zu Beginn des Moduls vStart mit der einzustellenden Geschwindigkeit vEnd verglichen.
-
Danach wird, wie in 2 gezeigt ist, der entsprechende Ruck mit jmax für eine Beschleunigung und jmin für einen Bremsvorgang im ersten Intervall eingestellt. Dieses erste Intervall dauert so lange, bis die gewünschte Geschwindigkeit v oder die minimale Beschleunigung amin bzw. die maximale Verzögerung bei einem Bremsvorgang erreicht wird. Nach Erreichen der minimalen Beschleunigung amin schließt sich ein zweites Intervall mit einem Ruck j gleich 0 an, bis die entsprechende Geschwindigkeit vZiel erreicht ist.
-
Geschwindigkeit - Beschleunigung - Modul
-
Ein weiteres Beispiel für ein Modul für eine Bewegungsplanung ist in den 3 bis 5 mit entsprechenden Teildiagrammen für den zeitlichen Verlauf von Weg s, Geschwindigkeit v, Beschleunigung a und Ruck j gezeigt. Das hier gezeigte Geschwindigkeit - Beschleunigung - Modul ermöglicht die gleichzeitige Einstellung einer bestimmten Geschwindigkeit und einer bestimmten Beschleunigung unabhängig von der Position des bewegten Elements.
-
Hierzu weist das Modul drei Teilschritte auf, die in den 3 bis 5 dargestellt sind. Im ersten Schritt wird ein Intervall berechnet, mit welchem mit konstantem Ruck j die Zielbeschleunigung aZiel erreicht wird. Im gezeigten Ausführungsbeispiel ist die Zielbeschleunigung aZiel gleich 0, sodass ausgehend von einer positiven Startbeschleunigung atart ein minimaler Ruck jmin eingestellt wird, bis die Zielbeschleunigung aZiel erreicht ist (siehe 3).
-
Anschließend wird ein sogenanntes Beschleunigungsdreieck angeschlossen, welches zwei Intervalle 6 und 7 aufweist, die eine gleich lange Zeitdauer besitzen und genau umgekehrte Ruckwerte j aufweisen, die also betragsmäßig gleich sind, aber entgegengesetzte Vorzeichen besitzen. Im gezeigten Fall ist im Intervall 6 ein minimaler Ruck jmin eingestellt, während im darauffolgenden Intervall 7 ein maximale Ruck Jmax eingestellt wird. Durch die gleiche Länge der Intervalle 6, 7 und der genau entgegengesetzt wirkenden Ruckwerte jmin und jmax wird nach dem Durchlaufen dieses Bewegungsverlaufs der Intervalle 6, 7 das bewegte Element die gleiche Beschleunigung aufweisen, die bereits im ersten Intervall dieses Moduls eingestellt worden ist. Die beiden Intervalle werden 6, 7 werden dann so lange ausgeführt, bis die Endgeschwindigkeit vZiel erreicht ist.
-
Sollte es, wie in 4 zu sehen ist, durch die Einfügung der Intervalle 6 und 7 bei der Bewegungsplanung zu einer Überschreitung des Wertebereichs für die Beschleunigung a kommen, so wird in einem dritten Teilschritt, der in 5 gezeigt ist, bei der Bewegungsplanung ein Intervall mit einer konstanten Beschleunigung a und somit einem Ruck j gleich 0 zwischen die beiden Intervalle 6 und 7 eingefügt, um ohne Verletzung der Bereichsgrenzen für die Beschleunigung a die gewünschte Geschwindigkeit v zu erreichen.
-
Begrenzung - Modul
-
Bei diesem Modul, das mit den entsprechenden Teildiagrammen für den zeitlichen Verlauf von Weg s, Geschwindigkeit v, Beschleunigung a und Ruck j in den 6 und 7 dargestellt ist, geht es darum, dass die jeweils gültigen Bereiche von Geschwindigkeit v und Beschleunigung a eingehalten werden sollen, indem die Bewegung des bewegten Elements gemäß der Bewegungsplanung so eingestellt wird, dass die entsprechenden Grenzen möglichst schnell wieder eingehalten werden. Das kann zum Beispiel dann sinnvoll sein, wenn sich die erlaubten Maximalwerte beispielsweise durch Benutzervorgabe ändern.
-
Zunächst muss hierzu festgestellt werden, welche Bereichsgrenzen verletzt sind. Hierzu wird zunächst überprüft, ob die Geschwindigkeitsgrenzen eingehalten werden und falls die Geschwindigkeit v den Gültigkeitsbereich verlassen hat, wird die Zielgeschwindigkeit vZiel gleich der maximalen oder minimalen Geschwindigkeit vmin oder vmax, je nachdem welche Grenze verletzt worden ist. Falls jedoch die Geschwindigkeit innerhalb des gültigen Bereichs liegt, so ist die Zielgeschwindkeit vZiel gleich der Startgeschwindigkeit vStart zu Beginn des Moduls.
-
Ist der Geschwindigkeitsbereich überschritten und muss die Geschwindigkeit v deshalb in den zulässigen Bereich zurückgeführt werden, so wird die hierfür angestrebte Beschleunigung aZiel durch die Grenzwerte amin oder amax bestimmt, die zur Rückführung der Geschwindigkeit in den zulässigen Bereich führen.
-
Gemäß 6 wird somit zunächst ein Intervall mit dem maximalen oder minimalen Ruck jmin oder jmax gewählt, das dazu führt, dass die Beschleunigung a und / oder die Geschwindigkeit v in den zulässigen Bereich zurückgeführt werden. Wie in 6 zu sehen ist, weist das bewegte Element eine zu hohe Beschleunigung und eine zu hohe Geschwindigkeit auf, sodass zunächst mit einem Intervall mit einem Ruck j gleich jmin gebremst wird, um die Geschwindigkeit zu reduzieren und auch die Beschleunigung zu einer Verzögerung umzuwandeln. Sobald der Beschleunigungswert die entsprechende Grenze, hier am Beispiel der 6 die untere Grenze amin, erreicht hat, wird ein zweites Intervall angeschlossen, welches mit einem Ruck j gleich 0 eingestellt wird, bis die Geschwindigkeit v in den zulässigen Bereich zurückgekehrt ist (siehe 7).
-
Weg - Modul
-
Die 8 bis 14 zeigen ein weiteres Beispiel für ein Modul, und zwar ein Weg - Modul, welches ermöglicht, in den geplanten Bewegungsverlauf einen Weg einer bestimmten Länge einzufügen, wobei Start - und Endgeschwindigkeit vStart und vEnd gleich sind und Start - und Endbeschleunigung aStart und aEnd umgekehrt sind, also betragsmäßig gleich sind, aber unterschiedliche Vorzeichen aufweisen. Ein entsprechender Verlauf von verschiedenen Intervallen für die Bewegungsplanung ist in 8 gezeigt und ist hinsichtlich der Zeitachse bezogen auf die Mitte der Zeitachse achsensymmetrisch bezüglich des Verlaufs des Rucks j und der Geschwindigkeit v sowie punktsymmetrisch bezüglich des Verlaufs der Beschleunigung a. Entsprechend ist in den 9 bis 14 lediglich die linke Symmetriehälfte des geplanten Bewegungsverlaufs gezeigt.
-
Um den entsprechenden Ruckverlauf zu ermitteln, muss zunächst geklärt werden, wie die Startbeschleunigung aStart ist. Ist die Startbeschleunigung kleiner 0, wird also zum Start des Moduls gerade gebremst, so muss zunächst der Bremsvorgang beendet werden und es wird ein Ruck j eingestellt, der die Beschleunigung auf einen Wert gleich 0 bringt (siehe 9). Hierzu kann ein Intervall Δt1 Verwendung finden, bei dem der Ruck j maximal ist, also jmax.
-
Sofern die Startbeschleunigung entweder von Haus aus oder nach Durchlaufen des ersten Intervalls Δt1 größer oder gleich 0 ist, kann wiederum ein sogenanntes Beschleunigungsdreieck eingefügt werden, wie die 10 zeigt, um den zurück zu legenden Weg möglichst mit hoher Geschwindigkeit zu durchlaufen.
-
Hierzu wird zuerst ein Intervall mit einem maximalen Ruck jmax und ein daran anschließendes zweites Intervall eingefügt, welches die gleiche Zeitdauer aufweist und einen entgegengesetzten Ruck j besitzt, der also betragsmäßig gleich dem Ruck j im ersten Intervall ist, aber ein entgegengesetztes Vorzeichen aufweist. Dadurch wird die Startbeschleunigung aStart nicht verändert, aber entsprechender Weg s eingefügt.
-
Allerdings kann es, wie die Teildiagramme bezüglich des Geschwindigkeit - Zeit - Verlaufs und des Beschleunigung - Zeit - Verlaufs zeigen, dazu führen, dass die zulässigen Bereiche für die Beschleunigung a und / oder die Geschwindigkeit v verlassen werden (siehe 10). Entsprechend muss, wie in 11 gezeigt ist, entweder die Beschleunigung a auf den Maximalwert amax reduziert werden (siehe 11) und / oder die Beschleunigung muss so limitiert werden, dass die maximal zulässige Geschwindigkeit vmax nicht überschritten wird. Die dadurch verkürzte Strecke s, die das bewegte Element zurücklegt, kann durch ein Intervall mit konstanter Beschleunigung a und einem Ruck j gleich 0 wieder ergänzt werden, wie in 12 gezeigt ist. Darüber hinaus kann ein immer noch fehlender Weg s durch ein Intervall mit konstanter Geschwindigkeit v hinzugefügt werden, wie dies in 13 zu sehen ist.
-
Da die 9 bis 13 lediglich die linke Symmetriehälfte des Bewegungsverlaufs darstellen, muss zur Vervollständigung des geplanten Bewegungsverlaufs, wie er in der 8 dargestellt ist, ein entsprechend symmetrischer Verlauf angefügt werden.
-
Die 14 zeigt zusätzlich ein Intervall, Δt5, welches, im Gegensatz zu Δt1 aus 9, nach dem Beschleunigungsdreieck mit dem Zwischenintervall der konstanten Beschleunigung eingefügt wird, um die Beschleunigung a auf den Wert 0 zurückzuführen, wenn die Startbeschleunigung aStart größer 0 war. Dies ist erforderlich, da in der Mitte des Bewegungsverlaufs die Beschleunigung gleich 0 sein muss.
-
Weg - Geschwindigkeit - Modul
-
Mit diesem Modul kann ein Bewegungsverlauf erzielt werden, bei welchem zu einem bestimmten Zeitpunkt gleichzeitig die Zielposition sZiel und die Zielgeschwindigkeit vZiel erreicht wird, wobei zu diesem Zeitpunkt die Beschleunigung aZiel gleich 0 ist.
-
Hierzu wird zunächst ein Ruckverlauf mit drei Intervallen vorgesehen, bei welchem im mittleren Intervall ein Ruck j gleich 0 eingestellt wird und der Ruck j im ersten und dritten Intervall so gewählt wird, dass die Zielvorgaben erreicht werden. Damit ließe sich das Ziel bereits erreichen, aber der Verlauf kann noch optimiert werden, da das mittlere Intervall zwar eine konstante Beschleunigung aufweist, aber die Beschleunigung nicht zwangsläufig die minimale oder maximale Beschleunigung ist.
-
Liegt die Beschleunigung im mittleren Intervall, wie in 15 gezeigt ist, nicht zwischen der Startbeschleunigung aStart und der Endbeschleunigung aEnde und ist die Beschleunigung aMitte im mittleren Intervall kleiner als die betragsmäßig größte zulässige Beschleunigung, so kann, wie in 16 gezeigt ist, anstelle des mittleren Intervalls mit einem Ruck j gleich 0 wiederum ein sogenanntes Beschleunigungsdreieck mit zwei Intervallen gleicher Länge und entgegengesetztem Ruck j eingefügt werden, sodass die Geschwindigkeit v möglichst schnell an die Zielgeschwindigkeit vZiel gleich 0 angenähert wird. Ein entsprechend weniger zurückgelegte Weg s kann durch Ersetzung des ersten Intervalls durch drei Intervalle mit einem mittleren Intervall mit Ruck j gleich 0 ersetzt werden.
-
Sofern die Startbeschleunigung aStart und die Beschleunigung aMitte im mittleren Intervall der drei ursprünglich gewählten Intervalle so gewählt sind, dass die Beschleunigung im mittleren Intervall aMitte zwischen der Startbeschleunigung aStart und der Zielbeschleunigung aZiel gleich 0 liegt, so ist keine weitere Optimierung des Ruckverlaufs notwendig (siehe 18).
-
Sollte mit dem Modul keine brauchbare Lösung auffindbar sein, da beispielsweise die erlaubten Bereiche für die Beschleunigung überschritten werden, so kann alternativ zunächst mit dem Geschwindigkeit - Beschleunigung - Modul und anschließend mit dem Weg - Modul die entsprechende Aufgabenstellung erfüllt werden.
-
Beschleunigung - Modul
-
Ein weiteres Modul für die Bewegungsplanung kann dafür vorgesehen sein, eine möglichst maximale Beschleunigung zu Beginn der geplanten Bewegung zu erzielen, ohne die vorgegebenen zulässigen Bereiche zu verletzen und sicherzustellen, dass das Gesamtproblem lösbar ist, d.h. die Zielwerte noch erreicht werden können.
-
Bei diesem Modul wird in einem ersten Schritt wieder ein sogenanntes Beschleunigungsdreieck geplant, welches aus zwei Intervallen gleicher Länge mit entgegengesetzten Ruck, d.h. jmax und jmin, besteht. Die Länge der Intervalle wird so gewählt, dass die zurückzulegende Strecke sZiel zurückgelegt wird.
-
Im zweiten Schritt werden dann an das erste Intervall zwei Intervalle hinzugefügt und das ursprünglich zweite Intervall wird verworfen. Die zwei Intervalle, die als zweites und drittes Intervall hinzugefügt werden, entsprechen dem Geschwindigkeit - Beschleunigung - Modul (siehe 20), um die Zielgeschwindigkeit vZiel und die Zielbeschleunigung aZiel zu erreichen.
-
Sofern nunmehr zulässige Bereiche für Geschwindigkeit v und Beschleunigung a überschritten werden, wie in 20 gezeigt ist, wird das erste Intervall entsprechend verkürzt und angepasst (siehe 21). Dieses erste Intervall stellt die Lösung für das Beschleunigungsmodul dar und ermöglicht somit eine maximale Beschleunigung unter Berücksichtigung der Erreichung der Zielwerte.
-
End - Modul
-
Sofern die Bewegungsplanung erlaubt, dass das bewegte Element an der Zielposition eine Geschwindigkeit v ungleich 0 aufweist, kann der entsprechend geplante Bewegungsverlauf verkürzt werden, wenn das bewegte Element das erste Mal die Zielposition sZiel überfährt. Entsprechend kann das End - Modul bestimmen, in welchem Intervall die Zielposition sZiel das erste Mal erreicht wird und die Bewegungsplanung in diesem Intervall entsprechend beenden.
-
Die Aufgabe, eine gewünschte Position sZiel mit einer Zielgeschwindigkeit vZiel gleich 0 und eine Zielbeschleunigung aZiel gleich 0 zu erreichen, kann durch die Kombination von verschiedenen der oben erläuterten Module erreicht werden. Hierzu können die folgenden Module in der entsprechenden Reihenfolge eingesetzt werden, nämlich das Begrenzung - Modul, das Geschwindigkeit - Beschleunigung - Modul, das Beschleunigung - Modul und das Geschwindigkeit - Weg - Modul. Ein entsprechender Ruckverlauf mit den dazugehörigen Verläufen für die Beschleunigung a, die Geschwindigkeit v und die Strecke s ist in 22 gezeigt.
-
Die 23 zeigt den entsprechenden Bewegungsplan mit den Teildiagrammen für den Ruck j, die Beschleunigung a und die Geschwindigkeit v sowie den Weg s zusammen mit der Taktung der Steuerung, wobei die Takte 8 als vertikale Striche in die entsprechenden Teildiagramme eingezeichnet sind. Wie der 23 zu entnehmen ist, sind die Intervalle mit konstantem Ruck j unabhängig von den Takten 8. Allerdings kann zu den Zeitpunkten der jeweiligen Takte 8 jeweils eine neue Bewegungsplanung vorgenommen werden, sodass die Bewegungsplanung an die Bewegung entsprechend angepasst wird. Ein Beispiel für einen Bewegungsverlauf mit Teildiagrammen für den Ruck j, die Beschleunigung a, die Geschwindigkeit v und den Weg s über die Zeit ist in 24 gezeigt.
-
Obwohl die vorliegende Erfindung anhand der Ausführungsbeispiele detailliert beschrieben worden ist, ist für den Fachmann selbstverständlich, dass die Erfindung nicht auf diese Ausführungsbeispiele beschränkt ist, sondern dass vielmehr Abwandlungen in der Weise möglich sind, dass einzelne Merkmale weggelassen oder andersartige Kombinationen von Merkmalen verwirklicht werden können, ohne dass der Schutzbereich der beigefügten Ansprüche verlassen wird. Insbesondere schließt die vorliegende Offenbarung sämtliche Kombinationen der in den verschiedenen Ausführungsbeispielen gezeigten Einzelmerkmale mit ein, sodass einzelne Merkmale, die nur in Zusammenhang mit einem Ausführungsbeispiel beschrieben sind, auch bei anderen Ausführungsbeispielen oder nicht explizit dargestellten Kombinationen von Einzelmerkmalen eingesetzt werden können.
-
In der vorangegangenen Beschreibung sind für den Ruck j, die Beschleunigung a und die Geschwindigkeit v teilweise Nullwerte angegeben, ohne dass eine entsprechende Dimension genannt ist, da sich diese für den Wert 0 erübrigt. Ansonsten ist für den Fachmann selbstverständlich, dass der Ruck j, die Beschleunigung a und die Geschwindigkeit v entsprechende Dimensionen nach den SI - Einheiten aufweisen.
-
Bezugszeichenliste
-
- 1 bis 7
- Intervalle
- 8
- Takte
-
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
-