DE102016004837C5 - Steuerung eines aktorisch angetriebenen Robotermanipulators - Google Patents

Abstract

Die Erfindung betrifft ein Verfahren und eine Vorrichtung zur Steuerung eines aktorisch angetriebenen Robotermanipulators, bei dem ein distales Ende des Robotermanipulators eine vorgegebene Soll-BewegungBsoll=Bsoll(s→pfad1,s→˙pfad1,s→¨pfad1)entlang eines vorgegebenen ersten Pfads pfad1 ausführt und entlang des ersten Pfads pfad1 einen Soll-KraftwinderK→=[F→, L→]auf eine Umgebung ausübt. Das Verfahren umfasst folgende Schritte: Bereitstellen (101) von die Soll-Bewegung Bsollund den Soll-KraftwinderK→definierenden ParameternP(Bsoll,K→)von einer Speichereinheit, während der Ausführung der Bewegung Bsollund/oder während der Ausübung des Soll-KraftwindersK→Ermitteln(102) eines in den Robotermanipulator eingebrachten externen KraftwindersK→ext=[F→ext, L→ext]Korrigieren (103) der vorgegebenen Soll-BewegungBsoll(s→pfad1,s→˙pfad1,s→¨pfad1)abhängig von dem KraftwinderK→extzu einer korrigierten Soll-Bewegung:Bsoll*=Bsoll*(s→pfadx*(K→ext),s→˙pfadx(K→ext),s→¨pfadx(K→ext))und/oder Korrigieren (103) des vorgegebenen Soll-KraftwindersK→abhängig von dem KraftwinderK→extzu einem korrigierten Soll-KraftwinderK→*=K→*(K→,K→ext)=[F→*,L→*],und Speichern (105) von die Soll-Bewegung Bsoll* und den korrigierten Soll-KraftwinderK→*definierenden ParameternP(Bsoll*,K→*)auf der Speichereinheit.

Description

• Die Erfindung betrifft Verfahren zur Steuerung eines aktorisch angetriebenen Robotermanipulators, bei dem ein distales Ende des Robotermanipulators eine vorgegebene Soll-Bewegung entlang eines vorgegebenen ersten Pfads ausführt und entlang des ersten Pfads einen Soll-Kraftwinder auf eine Umgebung ausübt. Weiterhin betrifft die Erfindung eine Vorrichtung zur Steuerung eines ebensolchen Robotermanipulators.
• Die Steuerung von aktorisch angetriebenen Robotermanipulatoren basiert typischerweise auf vorgegebenen Roboterprogrammen. Diese Roboterprogramme definieren die Bewegungen und Aktionen des Robotermanipulators und überwachen deren Durchführung. Zur Erstellung von Roboterprogrammen gibt es grundsätzlich die Verfahren der Online-Programmierung und der Offline-Programmierung. Änderungen der Programmierung ändern bei Ausführung des Programms konsequenterweise die Steuerung des betreffenden Robotermanipulators.
• Die Aufgabe der Erfindung ist es, ein Verfahren und eine Vorrichtung zur Steuerung eines aktorisch angetriebenen Robotermanipulators anzugeben, das/die eine einfache und intuitive Onlineprogrammierung während der Ausführung eines aktuellen Steuerprogramms ermöglicht.
• Die Erfindung ergibt sich aus den Merkmalen der unabhängigen Ansprüche. Vorteilhafte Weiterbildungen und Ausgestaltungen sind Gegenstand der abhängigen Ansprüche. Weitere Merkmale, Anwendungsmöglichkeiten und Vorteile der Erfindung ergeben sich aus der nachfolgenden Beschreibung, sowie der Erläuterung von Ausführungsbeispielen der Erfindung, die in den Figuren dargestellt sind.
• Ein erster Aspekt der Erfindung betrifft ein Verfahren zur Steuerung eines aktorisch angetriebenen Robotermanipulators, bei dem ein distales Ende des Robotermanipulators eine vorgegebene Soll-Bewegung ${\text{B}}_{\text{soll}}={\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  entlang eines vorgegebenen ersten Pfads pfad1 ausführt und entlang dieses ersten Pfads pfad1 einen Soll-Kraftwinder $\overrightarrow{K}$

  

  mit der Kraft $\overrightarrow{F}$

  

  und dem Drehmoment $\overrightarrow{L}$

  

  auf eine Umgebung ausübt, wobei gilt: $\overrightarrow{K}=\left[\overrightarrow{F},\overrightarrow{L}\right].$

  
• Der Soll-Kraftwinder $\overrightarrow{K}$

  

  ist bevorzugt abhängig von dem ersten Pfad pfad1 oder abhängig von dem ersten Pfad pfad1 und der Zeit t oder nur abhängig von der Zeit ist: $\overrightarrow{K}=\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)=\left[\overrightarrow{F}\left({\overrightarrow{s}}_{pfad1}\right),\overrightarrow{L}\left({\overrightarrow{s}}_{pfad1}\right)\right]$

  

  $$

  

  oder $\overrightarrow{K}=\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1},t\right)=\left[\overrightarrow{F}\left({\overrightarrow{s}}_{pfad1},t\right),\overrightarrow{L}\left({\overrightarrow{s}}_{pfad1},t\right)\right]$

  

  oder $\overrightarrow{K}=\overrightarrow{K}\left(t\right)=\left[\overrightarrow{F}\left(t\right),\overrightarrow{L}\left(t\right)\right].$

  
• Dabei gibt ${\overrightarrow{s}}_{pfad1}$

  

  den ersten Pfad pfad1 definierende Positionen (bspw. in allgemeinen 3D-Koordinaten x, y, z) des distalen Endes des Robotermanipulators, gegebenenfalls mit zugehörigen Posen des Robotermanipulators (d.h. beispielsweise zugeordnete Translationen und Rotationen von Gliedern des Robotermanipulators), ${\overrightarrow{s}}_{pfad1}$

  

  vorgegebene Geschwindigkeiten des distalen Endes des Robotermanipulators entlang des ersten Pfades ${\overrightarrow{s}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}$

  

  vorgegebene Beschleunigungen des distalen Endes des Robotermanipulators entlang des ersten Pfades ${\overrightarrow{s}}_{pfad1},\overrightarrow{F}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  eine vom distalen Ende des Robotermanipulators an der Position ${\overrightarrow{s}}_{pfad1}$

  

  auf die Umgebung ausgeübte Kraft, $\overrightarrow{F}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  eine vom distalen Ende des Robotermanipulators an der Position ${\overrightarrow{s}}_{pfad1}$

  

  auf die Umgebung ausgeübte zeitabhängige Kraft, und $\overrightarrow{L}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  ein vom distalen Ende des Robotermanipulators an der Position ${\overrightarrow{s}}_{pfad1}$

  

  auf die Umgebung ausgeübtes Drehmoment und $\overrightarrow{L}\left({\overrightarrow{s}}_{pfad1},t\right)$

  

  vom distalen Ende des Robotermanipulators an der Position ${\overrightarrow{s}}_{pfad1}$

  

  auf die Umgebung ausgeübtes zeitabhängiges Drehmoment an.
• Der erste Pfad pfad1 ist vorteilhaft in Gelenkkoordinaten oder in Taskkoordinaten definiert.
• Die Parameter der Soll-Bewegung ${\text{B}}_{\text{soll}}={\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  und des Soll-Kraftwinders $\overrightarrow{K}$

  

  definieren vorteilhaft eine Bewegung des distalen Endes des Robotermanipulators entlang eines ersten Pfads (Raumkurve/Trajektorie), vorteilhaft im dreidimensionalen Raum mit den allgemeinen Raumkoordinaten x,y,z, bei der sich das Ende des Robotermanipulators entlang des Pfads ${\overrightarrow{s}}_{pfad1}$

  

  mit einer Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  und einer Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}$

  

  bewegt.
• Vorliegend bezeichnet ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  eine lokale Geschwindigkeit des Endes des Robotermanipulators an einem jeweiligen Punkt des Pfads ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  der allgemeinen Raumkoordinaten, die zur Vereinfachung weggelassen sind. Gleichermaßen bezeichnet ${\ddot{\overrightarrow{s}}}_{pfad1}$

  

  eine lokale Beschleunigung des Endes des Robotermanipulators am jeweiligen Punkt der s ${\dot{\overrightarrow{s}}}_{pfad1}.$

  
• Die Parameter der Soll-Bewegung ${\text{B}}_{\text{soll}}={\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  und des Soll-Kraftwinders $\overrightarrow{K}$

  

  sind vorteilhaft in einem aktuell gültigen Steuerprogramm für den Robotermanipulator hinterlegt oder werden beispielsweise online berechnet.
• Das vorgeschlagene Verfahren umfasst folgende Schritte. In einem ersten Schritt erfolgt ein Bereitstellen von die Soll-Bewegung B_soll und den Soll-Kraftwinder $\overrightarrow{K}$

  

  definierenden Parametern $\text{P}\left({\text{B}}_{\text{soll}},\overrightarrow{K}\right)$

  

  von einer Speichereinheit. Die Parameter $\text{P}\left({\text{B}}_{\text{soll}},\overrightarrow{K}\right)$

  

  können beispielsweise im Rahmen einer Onlineprogrammierung oder eine offline Programmierung auf der Speichereinheit gespeichert worden sein.
• Die Bewegung B_soll des Robotermanipulators wird gestartet, und während der Ausführung der Soll-Bewegung B_soll und/oder während der Ausübung des Soll-Kraftwinders $\overrightarrow{K}$

  

  erfolgt ein Ermitteln eines in den Robotermanipulator eingebrachten externen Kraftwinders ${\overrightarrow{K}}_{ext}=\left[{\overrightarrow{F}}_{ext},{\overrightarrow{L}}_{ext}\right].$

  

  $$

  
• Vorteilhaft gilt dabei: ${\overrightarrow{K}}_{ext}={\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)=\left[{\overrightarrow{F}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right),{\overrightarrow{L}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right]$

  

  oder $${\overrightarrow{K}}_{ext}={\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1},t\right)=\left[{\overrightarrow{F}}_{ext}\left({\overrightarrow{s}}_{pfad1},t\right),{\overrightarrow{L}}_{ext}\left({\overrightarrow{s}}_{pfad1},t\right)\right]\text{ oder }{\overrightarrow{K}}_{ext}={\overrightarrow{K}}_{ext}\left(t\right)=\left[{\overrightarrow{F}}_{ext}\left(t\right),{\overrightarrow{L}}_{ext}\left(t\right)\right]$$

  
• Der Begriff „Ermitteln“ umfasst vorliegend beispielsweise das Schätzen oder das Messen von Größen.
• Vorteilhaft wird das vorgeschlagene Verfahren in einem Steuermodus einer Steuerung des Robotermanipulators ausgeführt, bei dem extern in den Robotermanipulator eingebrachte Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  ausschließlich zur Korrektur der Soll-Bewegung B_soll und/oder des gewünschten Soll-Kraftwinders $\overrightarrow{K}$

  

  genutzt werden.
• In einem weiteren Schritt erfolgt ein Korrigieren der vorgegebenen Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  zu einer korrigierten Soll-Bewegung: $${\text{B}}_{\text{soll}}*={\text{B}}_{\text{soll}}*\left({\overrightarrow{s}}_{pfadx}*\left({\overrightarrow{K}}_{ext}\right),{\dot{\overrightarrow{s}}}_{pfadx}\left({\overrightarrow{K}}_{ext}\right),{\ddot{\overrightarrow{s}}}_{pfadx}\left({\overrightarrow{K}}_{ext}\right)\right)$$

  

  und/oder ein Korrigieren des vorgegebenen Soll-Kraftwinders $\overrightarrow{K}$

  

  abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  zu einem korrigierten Soll-Kraftwinder $\overrightarrow{K}*=\overrightarrow{K}*\left(\overrightarrow{K},{\overrightarrow{K}}_{ext}\right)=\left[\overrightarrow{F}*,\overrightarrow{L}*\right]$

  
• Vorteilhaft gilt dabei: $\overrightarrow{K}*=\overrightarrow{K}*\left({\overrightarrow{s}}_{pfadx}*,{\overrightarrow{K}}_{ext},\overrightarrow{K}\right)=\left[\overrightarrow{F}*\left({\overrightarrow{s}}_{pfadx}*\right),\overrightarrow{L}*\left({\overrightarrow{s}}_{pfadx}*\right)\right]$

  

  oder $$\begin{array}{l}\overrightarrow{K}*=\overrightarrow{K}*\left({\overrightarrow{s}}_{pfadx}*,{\overrightarrow{K}}_{ext},\overrightarrow{K},t\right)=\left[\overrightarrow{F}*\left({\overrightarrow{s}}_{pfadx},t\right),\overrightarrow{L}*\left({\overrightarrow{s}}_{pfadx}*,t\right)\right]\text{ oder }\overrightarrow{K}*=\overrightarrow{K}*\left({\overrightarrow{K}}_{ext},\overrightarrow{K},t\right)=\\ \left[\overrightarrow{F}*\left(t\right),\overrightarrow{L}*\left(t\right)\right].\end{array}$$

  
• Vorliegend bezeichnet ${\overrightarrow{s}}_{pfadx}*\left({\overrightarrow{K}}_{ext}\right)$

  

  Positionen des distalen Endes des Robotermanipulators auf dem abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  korrigierten Pfad ${\overrightarrow{s}}_{pfad1},$

  

  gegebenenfalls mit zugehörigen Posen des Robotermanipulators (d.h. beispielsweise zugeordnete Translationen und Rotationen von Gliedern des Robotermanipulators), ${\overrightarrow{s}}_{pfadx}*\left({\overrightarrow{K}}_{ext}\right)$

  

  eine abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  korrigierte Geschwindigkeit des distalen Endes des Robotermanipulators auf dem Pfad ${\overrightarrow{s}}_{pfadx},$

  

  ${\ddot{\overrightarrow{s}}}_{pfadx}*\left({\overrightarrow{K}}_{ext}\right)$

  

  eine abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  korrigierte Beschleunigung des distalen Endes des Robotermanipulators auf dem Pfad ${\overrightarrow{s}}_{pfadx},\overrightarrow{K}*\left({\overrightarrow{s}}_{pfadx},{\overrightarrow{K}}_{ext}\right)$

  

  einen abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  korrigierten Kraftwinder auf dem Pfad ${\overrightarrow{s}}_{pfadx}$

  

  mit der Kraft $\overrightarrow{F}*$

  

  und dem Drehmoment $\overrightarrow{L}*$

  

  wobei gilt: ${\overrightarrow{s}}_{pfadx}={\overrightarrow{s}}_{pfad1}$

  

  oder ${\overrightarrow{s}}_{pfad2},$

  

  mit ${\overrightarrow{s}}_{pfad1}\ne {\overrightarrow{s}}_{pfad2},$

  

  $$

  

  und wobei ${\overrightarrow{s}}_{pfad2}$

  

  einen zweiten Pfad pfad2 definierende Positionen des distalen Endes des Robotermanipulators angibt.
• Durch den auf den Roboterarm während der Ausführung der Soll Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  und/oder während der Ausführung des Soll-Kraftwinders $\overrightarrow{K}$

  

  wirkenden externen Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  erfolgt somit eine Korrektur bzw. eine Änderung der Soll-Bewegung B_soll und/oder des dabei auszuübenden Soll-Kraftwinders $\overrightarrow{K}$

  

  Diese Änderung kann eine Korrektur/Änderung des ersten Pfads ${\overrightarrow{s}}_{pfad1},$

  

  der Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  und/oder der Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}$

  

  des distalen Endes des Robotermanipulators entlang des ersten Pfads ${\overrightarrow{s}}_{pfad1}$

  

  oder eine Kombination daraus bewirken. Weiterhin kann diese Änderung eine Korrektur der entlang des ersten Pfads ${\overrightarrow{s}}_{pfad1}$

  

  auf eine Umgebung ausgeübten Kraft $\overrightarrow{F}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  bzw. $\overrightarrow{F}\left({\overrightarrow{s}}_{pfad1},t\right)$

  

  und/oder eine Änderung des auf eine Umgebung ausgeübten Drehmoments $\overrightarrow{L}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  bzw. $\overrightarrow{L}\left({\overrightarrow{s}}_{pfad1},t\right)$

  

  bewirken.
• Nach der Korrektur der Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  zu B_soll* und/oder der Korrektur des Soll-Kraftwinders $\overrightarrow{K}$

  

  zu $\overrightarrow{K}*$

  

  erfolgt ein Ausführen der korrigierten Soll-Bewegung B_soll* und/oder ein Ausüben des korrigierten Soll-Kraftwinders $\overrightarrow{K}*.$

  
• Vorteilhaft erfolgt die Ausführung der korrigierten Soll-Bewegung B_soll* bzw. des korrigierten Kraftwinders $\overrightarrow{K}*$

  

  instantan nach der Korrektur, beginnend von der aktuellen Position des distalen Endes des Robotermanipulator in diesem Zeitpunkt für die von dort aus verbleibende korrigierte Soll-Bewegung B_soll*. Alternativ kann die Ausführung der korrigierten Soll-Bewegung B_soll* bzw. des korrigierten Kraftwinders $\overrightarrow{K}*$

  

  von Beginn der Soll-Bewegung B_soll* oder von einem beliebigen Punkt auf des ersten Pfads ${\overrightarrow{s}}_{pfad1}$

  

  aus erfolgen, sodass der Robotermanipulator nach dem Erfassen des externen Kraftwinders ${\overrightarrow{K}}_{ext}$

  

  derart angesteuert wird, dass das distale Ende des Robotermanipulators auf eine Anfangsposition der korrigierten Soll Bewegung B_soll* gesteuert wird.
• In einem weiteren Schritt erfolgt ein Speichern von die Soll-Bewegung B_soll* und den Soll-Kraftwinder: $\overrightarrow{K}*$

  

  definierenden Parametern $\text{P}\left({\text{B}}_{\text{soll}}*,\overrightarrow{K}*\right)$

  

  auf der Speichereinheit. Damit wird sichergestellt, dass die Steuerung des Robotermanipulators für weitere Ausführungen der Bewegung B auf die entsprechend upgedateten Parameter $\text{P}\left({\text{B}}_{\text{soll}}*,\overrightarrow{K}*\right)$

  

  zugreift und entsprechend künftig die Soll-Bewegung B_soll* und den Soll-Kraftwinder: $\overrightarrow{K}*$

  

  ausführt.
• Vorteilhaft werden beim Speichern die Parameter $\text{P}\left({\text{B}}_{\text{soll}}*,\overrightarrow{K}*\right)$

  

  durch die Parameter $\text{P}\left({\text{B}}_{\text{soll}}*,\overrightarrow{K}*\right)$

  

  auf der Speichereinheit ersetzt.
• Das vorgeschlagene Verfahren ermöglicht eine einfache und intuitive Anpassung/Korrektur eines Steuerprogramms zur Steuerung eines Robotermanipulators, während der Robotermanipulator eine vorgegebene Soll-Bewegung ausführt bzw. dabei einen Kraftwinder auf eine Roboterumgebung ausübt. Eine erfolgte Anpassung/Korrektur der Steuerprogramms bzw. der die Änderung/Korrektur angegebenen Parameter wird in einer Speichereinheit gespeichert, sodass weitere Ausführungen der Soll-Bewegung/des Soll-Kraftwinders auf Basis der gespeicherten korrigierten Parameter erfolgen.
• Eine besonders vorteilhafte Weiterbildung des Verfahrens zeichnet sich dadurch aus, dass das Korrigieren der vorgegebenen Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  und/oder das Korrigieren des vorgegebenen Soll-Kraftwinders $\overrightarrow{K}$

  

  abhängig von einem aus der folgenden Liste gewählten Änderungsmodus aus der folgenden Liste erfolgt:
• - erster Änderungsmodus zur Änderung des Pfads ${\overrightarrow{s}}_{pfad1},$
  
• - zweiter Änderungsmodus zur Änderung der Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1},$
  
• - dritter Änderungsmodus zur Änderung der Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1},$
  
• - vierter Änderungsmodus zur Änderung des Kraftwinders $\overrightarrow{K}.$
  
• Der Änderungsmodus wird vorteilhaft vor Ausführung des Verfahrens gewählt und definiert, welcher Parameter der vorgegebenen Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  bzw. des vorgegebenen Soll-Kraftwinders $\overrightarrow{K}$

  

  ausschließlich korrigiert werden sollen.
• Vorteilhaft erfolgt im ersten Änderungsmodus ausschließlich eine Korrektur des gesamten ersten Pfads pfad1 mit den Punkten ${\overrightarrow{s}}_{pfad1}$

  

  zu dem zweiten Pfad pfad2 mit den Punkten ${\overrightarrow{s}}_{pfad2},$

  

  wobei der zweite Pfad pfad2 der Bewegung B_soll* und damit die Punkte ${\overrightarrow{s}}_{pfad2}\left({\overrightarrow{K}}_{ext}\right)$

  

  durch eine Translation $\overrightarrow{t}$

  

  des gesamten ersten Pfads pfad1 um einen konstanten Translationsvektor $\overrightarrow{t}$

  

  erzeugt wird: ${\overrightarrow{s}}_{pfad2}\left({\overrightarrow{K}}_{ext}\right)={\overrightarrow{s}}_{pfad1}+\overrightarrow{t}.$

  

  Dabei wird der Betrag des Translationsvektors $\left|\overrightarrow{t}\right|$

  

  basierend auf dem Betrag $\left|{\overrightarrow{F}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right|$

  

  der Kraft ${\overrightarrow{F}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  bestimmt, wobei die Richtung des Translationsvektors $\overrightarrow{t}$

  

  mit der Richtung der Kraft ${\overrightarrow{F}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  vorteilhaft identisch ist. Die Richtung des Translationsvektors $\overrightarrow{t}$

  

  kann auch diskretisiert bzw. gerastert sein, sodass sich geringfügige Unterschiede zwischen der Richtung der Kraft ${\overrightarrow{F}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  und der Richtung des Translationsvektor $\overrightarrow{t}$

  

  ergeben können. So führt vorteilhaft bspw. eine senkrecht auf dem ersten Pfad pfad1 stehende Kraft ${\overrightarrow{F}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  zu einer Parallelverschiebung des gesamten ersten Pfads pfad1 und damit zu einem zweiten Pfad pfad2, wobei die Distanz zwischen dem ersten Pfad pfad1 und dem zweiten Pfad pfad2 proportional zum Betrag der Kraft ${\overrightarrow{F}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  ist. Vorteilhaft wird die extern aufgebrachte Kraft ${\overrightarrow{F}}_{ext}$

  

  sowie das extern aufgebrachte Drehmoment ${\overrightarrow{L}}_{ext}$

  

  diskretisiert bzw. gerastert ermittelt. So können sowohl für den Betrag der Kraft bzw. des Drehmoments, als auch für die Richtung der Kraft bzw. nur vorgegebene diskretisierte Werte ermittelt werden.
• In einer weiteren vorteilhaften Alternative des ersten Änderungsmodus wird ausschließlich eine Korrektur des gesamten ersten Pfads pfad1 mit den Punkten ${\overrightarrow{s}}_{pfad1}$

  

  zu dem zweiten Pfad pfad2 mit den Punkten ${\overrightarrow{s}}_{pfad2}$

  

  durchgeführt, wobei der zweite Pfad pfad2 der Bewegung B_soll* und damit die Punkte ${\overrightarrow{s}}_{pfad2}\left({\overrightarrow{K}}_{ext}\right)$

  

  durch eine vorgegebene Rotation R um eine oder mehrere Rotationsachsen und entsprechend vorgegebene Rotationswinkel oder durch eine vorgegebene Rotation und eine vorgegebene Translation um einen konstanten Translationsvektor $\overrightarrow{t}$

  

  des gesamten ersten Pfads pfad1 hervorgehen. Dabei wird die Translation vorteilhaft wie vorstehend erläutert ermittelt: ${\overrightarrow{s}}_{pfad2}\left({\overrightarrow{K}}_{ext}\right)={\overrightarrow{s}}_{pfad1}+\overrightarrow{t}.$

  

  Die Rotation R wird vorteilhaft auf Basis des extern aufgebrachten Drehmoments ${\overrightarrow{L}}_{ext}$

  

  ermittelt.
• Vorteilhaft erfolgt im zweiten Änderungsmodus ausschließlich eine Korrektur der Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  zu einer Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)$

  

  wobei sich die Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)$

  

  abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  und der Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  des distalen Endes des Robotermanipulators vor dem Einwirken des externen Kraftwinders ${\overrightarrow{K}}_{ext}$

  

  bestimmt: ${\dot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)={\dot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext},{\dot{\overrightarrow{s}}}_{pfad1}\right).$

  
• Vorteilhaft ergibt sich eine Änderung der Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  des distalen Endes des Robotermanipulators entlang des ersten Pfads pfad1 abhängig von der extern in Pfadrichtung pfad1 einwirkenden Kraft ${\overrightarrow{F}}_{ext}.$

  

  Wirkt eine Kraftkomponente der einwirkenden Kraft ${\overrightarrow{F}}_{ext}$

  

  in Pfadrichtung entgegengesetzt zur aktuellen Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1},$

  

  so wird die Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  entsprechend einer vorgegebenen Beziehung verringert: ${\dot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)<{\dot{\overrightarrow{s}}}_{pfad1}.$

  
• Wirkt eine Kraftkomponente der einwirkenden Kraft ${\overrightarrow{F}}_{ext}$

  

  in Richtung der aktuellen Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1},$

  

  so wird die Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  entsprechend einer vorgegebenen Beziehung erhöht: ${\dot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)>{\dot{\overrightarrow{s}}}_{pfad1}.$

  
• Vorteilhaft gibt die korrigierte Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)$

  

  eine lokale Geschwindigkeit vor, wobei nach einer vorgegebenen Bewegungsstrecke des distalen Endes des Robotermanipulators entlang des Pfads Pfad1 oder einem vorgegebenen Zeitintervall wieder die ursprünglichen unkorrigierten lokalen Geschwindigkeiten ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  angenommen werden. In einer anderen vorteilhaften Weiterbildung gibt die korrigierte Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right)$

  

  eine Differenzgeschwindigkeit mit Δv vor, die alle lokalen Geschwindigkeiten entlang des ersten Pfads Pfad1 um die Differenzgeschwindigkeit Δv ändert.
• In einer weiteren Variante wird ein Schwellwert für den Betrag der extern einwirkenden Kraft ${\overrightarrow{F}}_{ext}$

  

  vorgegeben. Immer wenn der Betrag $\left|{\overrightarrow{F}}_{ext}\right|$

  

  der Kraft ${\overrightarrow{F}}_{ext}$

  

  den Schwellwert übersteigt, wird die Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  inkrementell verändert. Vorteilhaft wird die Geschwindigkeit dabei inkrementell erhöht, wenn eine Komponente der Kraft ${\overrightarrow{F}}_{ext}$

  

  in Pfadrichtung liegt. Vorteilhaft wird die Geschwindigkeit dabei inkrementell verringert, wenn eine Komponente der Kraft ${\overrightarrow{F}}_{ext}$

  

  entgegen der Fahrtrichtung liegt.
• Wird der Schwellwert beispielsweise dreimal hintereinander überschritten, wobei eine Komponente der Kraft ${\overrightarrow{F}}_{ext}$

  

  in Pfadrichtung zeigt, so wird die Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  drei mal um das jeweilige Inkrement erhöht.
• Vorteilhaft erfolgt im dritten Änderungsmodus ausschließlich eine Korrektur der Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}$

  

  zu der Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right),$

  

  wobei sich die Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)$

  

  abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  und/oder der Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

  

  und/oder der Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}$

  

  des distalen Endes des Robotermanipulators im Zeitpunkt vor Einwirken des externen Kraftwinders ${\overrightarrow{K}}_{ext}$

  

  bestimmt: $${\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right)={\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right),{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right).$$

  
• Vorteilhaft ergibt sich eine Änderung der Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}$

  

  des distalen Endes des Robotermanipulators entlang des ersten Pfads pfad1 abhängig von der extern in Pfadrichtung pfad1 einwirkenden Kraft ${\overrightarrow{F}}_{ext}.$

  

  Wirkt die Kraftkomponente der einwirkenden Kraft ${\overrightarrow{F}}_{ext}$

  

  in Pfadrichtung entgegengesetzt zur aktuellen Beschleunigung, so wird die Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}$

  

  entsprechend einer vorgegebenen Beziehung verringert: ${\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)<{\ddot{\overrightarrow{s}}}_{pfad1},$

  

  Wirkt die Kraftkomponente der einwirkenden Kraft ${\overrightarrow{F}}_{ext}$

  

  in Richtung der aktuellen Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1},$

  

  so wird die Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}$

  

  entsprechend einer vorgegebenen Beziehung erhöht: ${\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right)>{\ddot{\overrightarrow{s}}}_{pfad1}.$

  
• Vorteilhaft gibt die korrigierte Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)$

  

  eine lokale Beschleunigung vor, wobei nach einer vorgegebenen Bewegungsstrecke des distalen Endes des Robotermanipulators entlang des Pfads pfad1 oder einem vorgegebenen Zeitintervall wieder die ursprünglichen unkorrigierten lokalen Beschleunigungen ${\ddot{\overrightarrow{s}}}_{pfad1}$

  

  angenommen werden. In einer anderen vorteilhaften Version gibt die korrigierte Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)$

  

  eine Differenzbeschleunigung mit $\Delta \text{a}\times {\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)-{\ddot{\overrightarrow{s}}}_{pfad1}$

  

  vor, die alle lokalen Beschleunigungen entlang des ersten Pfads pfad1 um die Differenzbeschleunigung Δa ändert.
• In einer weiteren Variante wird ein Schwellwert für den Betrag der extern einwirkenden Kraft ${\overrightarrow{F}}_{ext}$

  

  vorgegeben. Immer wenn der Betrag $\left|{\overrightarrow{F}}_{ext}\right|$

  

  der Kraft ${\overrightarrow{F}}_{ext}$

  

  den Schwellwert übersteigt, wird die Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}$

  

  inkrementell verändert. Vorteilhaft wird die Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}$

  

  dabei inkrementell erhöht, wenn eine Komponente der Kraft ${\overrightarrow{F}}_{ext}$

  

  in Pfadrichtung liegt. Vorteilhaft wird die Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}$

  

  dabei inkrementell verringert, wenn eine Komponente der Kraft ${\overrightarrow{F}}_{ext}$

  

  entgegen der Pfadrichtung liegt.
• Vorteilhaft wird im zweiten und im dritten Modus die Methode der Zeitskalierung angewandt. In beiden Moden bleibt der ursprüngliche Bewegungspfad erhalten. Es ändern sich im zweiten Modus das Profil der Geschwindigkeit entlang des Bewegungspfades und im dritten Modus das Profil der Beschleunigung entlang des Bewegungspfades. Es ist somit erforderlich, in beiden Moden sicherzustellen, dass trotz der Änderung der Profile der ursprüngliche Bewegungspfad (also die entsprechenden Positionen) erhalten bleibt. Die Zeitskalierung, also das Skalieren einer Zeitbasis basierend auf der Kraft ${\overrightarrow{F}}_{ext}$

  

  ${\overrightarrow{L}}_{ext}.$

  

  Damit sind keine geometrischen Berechnungen erforderlich, es muss lediglich sichergestellt werden, dass die Zeitbasis kontinuierlich bleibt.
• Vorteilhaft erfolgt im vierten Änderunasmodus ausschließlich eine Korrektur des Kraftwinders $\overrightarrow{K}$

  

  zu dem Kraftwinder $\overrightarrow{K}*,$

  

  wobei sich der Kraftwinder $\overrightarrow{K}*$

  

  abhängig von dem Soll-Kraftwinder $\overrightarrow{K}$

  

  des Robotermanipulators im Zeitpunkt vor Einwirken des externen Kraftwinders ${\overrightarrow{K}}_{ext}$

  

  und dem externen Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  bestimmt.
• Vorteilhaft wird die korrigierte Soll-Bewegung B_soll* und/oder das Ausüben des korrigierten Soll-Kraftwinders $\overrightarrow{K}*$

  

  von Beginn der Soll-Bewegung B_soll* an für die dann noch verbleibende Soll-Bewegung ${\text{B}}_{\text{soll}}*$

  

  fortgesetzt.
• Die Aufgabe der Erfindung ist weiterhin gelöst durch ein Computersystem, mit einer Datenverarbeitungsvorrichtung, wobei die Datenverarbeitungsvorrichtung derart ausgestaltet ist, dass ein Verfahren, wie vorstehend angegeben, auf der Datenverarbeitungsvorrichtung ausgeführt wird.
• Zudem wird die Aufgabe der Erfindung gelöst durch ein digitales Speichermedium mit elektronisch aus lesbaren Steuersignalen, wobei die Steuersignale so mit einem programmierbaren Computersystem zusammenwirken können, dass ein Verfahren, wie vorstehend angegeben, ausgeführt wird.
• Ferner wird die Aufgabe der Erfindung gelöst durch ein Computer-Programm-Produkt mit auf einem maschinenlesbaren Träger gespeicherten Programmcode zur Durchführung des Verfahrens, wie vorstehend angegeben, wenn der Programmcode auf einer Datenverarbeitungsvorrichtung ausgeführt wird.
• Weiterhin betrifft die Erfindung ein Computer-Programm mit Programmcodes zur Durchführung des Verfahrens, wie vorstehend angegeben, wenn das Programm auf einer Datenverarbeitungsvorrichtung abläuft. Dazu kann die Datenverarbeitungsvorrichtung als ein beliebiges aus dem Stand der Technik bekanntes Computersystem ausgestaltet sein.
• Ein weiterer Aspekt der Erfindung betrifft eine Vorrichtung zur Steuerung eines aktorisch angetriebenen Robotermanipulators, und zur Ausführung des vorstehend erläuterten Verfahrens , bei dem ein distales Ende des Robotermanipulators eine vorgegebene Soll-Bewegung ${\text{B}}_{\text{soll}}={\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  entlang eines vorgegebenen ersten Pfads pfad1 ausführt und entlang des ersten Pfads pfad1 einen Soll-Kraftwinder $\overrightarrow{K}=\left[\overrightarrow{F},\overrightarrow{L}\right]$

  

  auf eine Umgebung ausübt, mit

den ersten Pfad pfad1 definierende Positionen des distalen Endes des Robotermanipulators,

vorgegebene Geschwindigkeiten des distalen Endes des Robotermanipulators entlang des ersten Pfades,

vorgegebene Beschleunigungen des distalen Endes des Robotermanipulators entlang des ersten Pfades,

• Die vorgeschlagene Vorrichtung umfasst eine Schnittstelle zum Bereitstellen von die Soll-Bewegung B_soll und den Soll-Kraftwinder $\overrightarrow{K}$

  

  definierenden Parametern $\text{P}\left({\text{B}}_{\text{soll}},\overrightarrow{K}\right)$

  

  von einer Speichereinheit, eine Ermittlungseinheit, mit der während der Ausführung der Bewegung B_soll und/oder während der Ausübung des Soll-Kraftwinders $\overrightarrow{K}$

  

  ein in den Robotermanipulator eingebrachter externer Kraftwinders ${\overrightarrow{K}}_{ext}=\left[{\overrightarrow{F}}_{ext},{\overrightarrow{L}}_{ext}\right]$

  

  $$

  

  ermittelt/geschätzt wird, eine Korrektureinheit zum Korrigieren der vorgegebenen Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  zu einer korrigierten Soll-Bewegung: ${\text{B}}_{\text{soll}}*={\text{B}}_{\text{soll}}*\left({\overrightarrow{s}}_{pfadx}*\left({\overrightarrow{K}}_{ext}\right),{\dot{\overrightarrow{s}}}_{pfadx}\left({\overrightarrow{K}}_{ext}\right),{\ddot{\overrightarrow{s}}}_{pfadx}\left({\overrightarrow{K}}_{ext}\right)\right)$

  

  und/oder zum Korrigieren des vorgegebenen Soll-Kraftwinders $\overrightarrow{K}$

  

  abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

  

  zu einem korrigierten Soll-Kraftwinder: $\overrightarrow{K}*=\overrightarrow{K}*\left(\overrightarrow{K},{\overrightarrow{K}}_{ext}\right)=\left[\overrightarrow{F}*,\overrightarrow{L}*\right],$

  

  mit

  ${\overrightarrow{s}}_{pfadx}\text{ * }\left({\overrightarrow{K}}_{ext}\right)$ :	Positionen des distalen Endes des Robotermanipulators auf dem abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$ korrigierten Pfad ${\overrightarrow{s}}_{pfad1},$
  ${\dot{\overrightarrow{s}}}_{pfadx}\text{ * }\left({\overrightarrow{K}}_{ext}\right)$ :	abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$ korrigierte Geschwindigkeit des distalen Endes des Robotermanipulators auf dem Pfad ${\overrightarrow{s}}_{pfadx},$
  ${\ddot{\overrightarrow{s}}}_{pfadx}\text{ * }\left({\overrightarrow{K}}_{ext}\right)$ :	abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$ korrigierte Beschleunigung des distalen Endes des Robotermanipulators auf dem Pfad ${\overrightarrow{s}}_{pfadx},$
  $\overrightarrow{K}*\left(\overrightarrow{K},{\overrightarrow{K}}_{ext}\right)$ :	abhängig von den Kraftwindern $\overrightarrow{K}\text{ und }{\overrightarrow{K}}_{ext}$ korrigierter Kraftwinder,
  ${\overrightarrow{s}}_{pfadx}$ :	${\overrightarrow{s}}_{pfad1}\text{ oder }{\overrightarrow{s}}_{pfad2},\text{ mit }{\overrightarrow{s}}_{pfad1}\ne {\overrightarrow{s}}_{pfad2},\text{ wobei }{\overrightarrow{s}}_{pfad2}$ einen zweiten Pfad pfad2 definierende Positionen des distalen Endes des Robotermanipulators angibt.

• Weiterhin umfasst die Vorrichtung eine Steuereinheit, die derart ausgeführt und eingerichtet ist, dass nach der Korrektur der Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  und/oder der Korrektur des Kraftwinders $\overrightarrow{K}$

  

  die korrigierte Soll-Bewegung B_soll* ausgeführt wird und/oder der korrigierte Soll-Kraftwinders $\overrightarrow{K}*$

  

  auf die Umgebung ausgeübt wird, und die die Soll-Bewegung B_soll* und den Soll-Kraftwinder: $\overrightarrow{K}*$

  

  definierenden Parametern $\text{P}\left({\text{B}}_{\text{soll}}*,\overrightarrow{K}*\right)$

  

  über die Schnittstelle auf der Speichereinheit gespeichert werden.
• Vorteile und vorteilhafte Weiterbildungen der vorgeschlagenen Vorrichtung ergeben sich durch analoge und sinngemäße Übertragung der im Zusammenhang mit dem vorgeschlagenen Verfahren gemachten Ausführungen.
• Schließlich betrifft die Erfindung einen Roboter mit einer Vorrichtung, wie vorstehend beschrieben.
• Weitere Vorteile, Merkmale und Einzelheiten ergeben sich aus der nachfolgenden Beschreibung, in der - gegebenenfalls unter Bezug auf die Zeichnung - zumindest ein Ausführungsbeispiel im Einzelnen beschrieben ist. Gleiche, ähnliche und/oder funktionsgleiche Teile sind mit gleichen Bezugszeichen versehen.
• Es zeigen:
• 1 einen schematisierten dargestellten Ablauf eines vorgeschlagenen Verfahrens, sowie
• 2 eine schematisierte Darstellung des Aufbaus einer vorgeschlagenen Vorrichtung.
• 1 zeigt einen schematisierten dargestellten Ablauf eines vorgeschlagenen Verfahrens zur Steuerung eines aktorisch angetriebenen Robotermanipulators, bei dem ein distales Ende des Robotermanipulators eine vorgegebene Soll-Bewegung ${\text{B}}_{\text{soll}}={\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  $$

  

  entlang eines vorgegebenen ersten Pfads pfad1 ausführt und entlang des ersten Pfads pfad1 einen Soll-Kraftwinder $\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)=\left[\overrightarrow{F}\left({\overrightarrow{s}}_{pfad1}\right),\overrightarrow{L}\left({\overrightarrow{s}}_{pfad1}\right)\right]$

  

  auf eine Umgebung ausübt. Das Verfahren umfasst folgende Schritte. In einem ersten Schritt 101 erfolgt ein Bereitstellen von die Soll-Bewegung B_soll und den Soll-Kraftwinder $\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  definierenden Parametern $\text{P}\left({\text{B}}_{\text{soll}},\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)\right)$

  

  von einer Speichereinheit. In einem zweiten Schritt 102 erfolgt während der Ausführung der Bewegung B_soll und/oder während der Ausübung des Soll-Kraftwinders $\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  ein Erfassen eines in den Robotermanipulator eingebrachten externen Kraftwinders ${\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)=\left[\overrightarrow{F}\left({\overrightarrow{s}}_{pfad1}\right),\overrightarrow{L}\left({\overrightarrow{s}}_{pfad1}\right)\right].$

  

  $$

  

  in einem dritten Schritt 103 erfolgt ein Korrigieren der vorgegebenen Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  zu einer korrigierten Soll-Bewegung: $${\text{B}}_{\text{soll}}*={\text{B}}_{\text{soll}}*\left({\overrightarrow{s}}_{pfadx}*\left({\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right),{\dot{\overrightarrow{s}}}_{pfadx}\left({\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right),{\ddot{\overrightarrow{s}}}_{pfadx}\left({\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right)\right)$$

  

  und/oder Korrigieren des vorgegebenen Soll-Kraftwinders $\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  zu einem korrigierten Soll-Kraftwinder:
• $\overrightarrow{K}*\left({\overrightarrow{s}}_{pfadx},{\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right)=\left[\overrightarrow{F}*\left({\overrightarrow{s}}_{pfadx}\right),\overrightarrow{L}*\left({\overrightarrow{s}}_{pfadx}\right)\right],$
  
  wobei ${\overrightarrow{s}}_{pfad2}$
  
  einen zweiten Pfad pfad2 definierende Positionen des distalen Endes des Robotermanipulators angibt. In einem vierten Schritt 104 erfolgt nach der Korrektur der Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$
  
  und/oder des Kraftwinders $\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)$
  
  ein Ausführen der korrigierten Soll-Bewegung B_soll* und/oder Ausüben des korrigierten Soll-Kraftwinders $\overrightarrow{K}*\left({\overrightarrow{s}}_{pfadx}\right).$
  
  In einem fünften Schritt 105 erfolgt ein Speichern von die Soll-Bewegung B_soll* und den Soll-Kraftwinder: $\overrightarrow{K}*\left({\overrightarrow{s}}_{pfadx}\right)$
  
  definierenden Parametern $\text{P}\left({\text{B}}_{\text{soll}}*,\overrightarrow{K}*\left({\overrightarrow{s}}_{pfadx}\right)\right)$
  
  auf der Speichereinheit. Die Definitionen der einzelnen verwendeten Ausdrücke Ausdrücke ergeben sich aus der vorstehenden Beschreibung.
• 2 zeigt eine schematisierte Darstellung des Aufbaus einer vorgeschlagenen Vorrichtung zur Steuerung eines aktorisch angetriebenen Robotermanipulators, bei dem ein distales Ende des Robotermanipulators eine vorgegebene Soll-Bewegung ${\text{B}}_{\text{soll}}={\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  $$

  

  entlang eines vorgegebenen ersten Pfads pfad1 ausführt und entlang des ersten Pfads pfad1 einen Soll-Kraftwinder $\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)=\left[\overrightarrow{F}\left({\overrightarrow{s}}_{pfad1}\right),\overrightarrow{L}\left({\overrightarrow{s}}_{pfad1}\right)\right]$

  

  auf eine Umgebung ausübt. Die vorgeschlagene Vorrichtung umfasst eine Schnittstelle 201 zum Bereitstellen von die Soll-Bewegung B_soll und den Soll-Kraftwinder $\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  definierenden Parametern $\text{P}\left({\text{B}}_{\text{soll}},\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)\right)$

  

  von einer Speichereinheit 202, eine Erfassungseinheit 203, mit der während der Ausführung der Bewegung B_soll und/oder während der Ausübung des Soll-Kraftwinders $\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  ein in den Robotermanipulator eingebrachter externer Kraftwinders $\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)=\left[\overrightarrow{F}\left({\overrightarrow{s}}_{pfad1}\right),\overrightarrow{L}\left({\overrightarrow{s}}_{pfad1}\right)\right]$

  

  erfassbar ist, eine Korrektureinheit 204 zum Korrigieren der vorgegebenen Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  zu einer korrigierten Soll-Bewegung: ${\text{B}}_{\text{soll}}*={\text{B}}_{\text{soll}}*\left({\overrightarrow{s}}_{pfadx}*\left({\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right),{\dot{\overrightarrow{s}}}_{pfadx}\left({\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right),{\ddot{\overrightarrow{s}}}_{pfadx}\left({\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right)\right)$

  

  und/oder zum Korrigieren des vorgegebenen Soll-Kraftwinders $\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  zu einem korrigierten Soll-Kraftwinder: $\overrightarrow{K}*\left({\overrightarrow{s}}_{pfadx},{\overrightarrow{K}}_{ext}\left({\overrightarrow{s}}_{pfad1}\right)\right)=\left[\overrightarrow{F}\left({\overrightarrow{s}}_{pfadx}\right),\overrightarrow{L}\left({\overrightarrow{s}}_{pfadx}\right)\right],$

  

  und eine Steuereinheit 205, die derart ausgeführt und eingerichtet ist, dass nach der Korrektur der Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

  

  und/oder der Korrektur des Kraftwinders $\overrightarrow{K}\left({\overrightarrow{s}}_{pfad1}\right)$

  

  die korrigierte Soll-Bewegung B_soll* ausgeführt wird und/oder der korrigierte Soll-Kraftwinders $\overrightarrow{K}*\left({\overrightarrow{s}}_{pfadx}\right)$

  

  auf die Umgebung ausgeübt wird , und die die Soll-Bewegung B_soll* und den Soll-Kraftwinder: $\overrightarrow{K}*\left({\overrightarrow{s}}_{pfadx}\right)$

  

  definierenden Parametern $\text{P}\left({\text{B}}_{\text{soll}}*,\overrightarrow{K}*\left({\overrightarrow{s}}_{pfadx}\right)\right)$

  

  über die Schnittstelle auf der Speichereinheit gespeichert werden. Die Definitionen der einzelnen verwendeten Ausdrücke Ausdrücke ergeben sich aus der vorstehenden Beschreibung.
• Obwohl die Erfindung im Detail durch bevorzugte Ausführungsbeispiele näher illustriert und erläutert wurde, so ist die Erfindung nicht durch die offenbarten Beispiele eingeschränkt und andere Variationen können vom Fachmann hieraus abgeleitet werden, ohne den Schutzumfang der Erfindung zu verlassen. Es ist daher klar, dass eine Vielzahl von Variationsmöglichkeiten existiert. Es ist ebenfalls klar, dass beispielhaft genannte Ausführungsformen wirklich nur Beispiele darstellen, die nicht in irgendeiner Weise als Begrenzung etwa des Schutzbereichs, der Anwendungsmöglichkeiten oder der Konfiguration der Erfindung aufzufassen sind. Vielmehr versetzen die vorhergehende Beschreibung und die Figurenbeschreibung den Fachmann in die Lage, die beispielhaften Ausführungsformen konkret umzusetzen, wobei der Fachmann in Kenntnis des offenbarten Erfindungsgedankens vielfältige Änderungen beispielsweise hinsichtlich der Funktion oder der Anordnung einzelner, in einer beispielhaften Ausführungsform genannter Elemente vornehmen kann, ohne den Schutzbereich zu verlassen, der durch die Ansprüche und deren rechtliche Entsprechungen, wie etwa weitergehenden Erläuterung in der Beschreibung, definiert wird.
• Bezugszeichenliste

101 -105

Verfahrensschritte

201

Schnittstelle

202

Speichereinheit

203

Ermittlungseinheit

204

Korrektureinheit

205

Steuereinheit

Claims (9)

1. Verfahren zur Steuerung eines aktorisch angetriebenen Robotermanipulators, bei dem ein distales Ende des Robotermanipulators eine vorgegebene Soll-Bewegung ${\text{B}}_{\text{soll}}={\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

   

   entlang eines vorgegebenen ersten Pfads pfad1 ausführt und entlang des ersten Pfads pfad1 einen Soll-Kraftwinder $\overrightarrow{K}=\left[\overrightarrow{F},\overrightarrow{L}\right]$

   

   auf eine Umgebung ausübt, mit

   

   den ersten Pfad pfad1 definierende Positionen des distalen Endes des Robotermanipulators,

   

   vorgegebene Geschwindigkeiten des distalen Endes des Robotermanipulators entlang des ersten Pfades,

   

   vorgegebene Beschleunigungen des distalen Endes des Robotermanipulators entlang des ersten Pfades,

   

   vom distalen Ende des Robotermanipulators auf die Umgebung ausgeübte Kraft,

   

   vom distalen Ende des Robotermanipulators auf die Umgebung ausgeübtes Drehmoment, mit folgenden Schritten: - Bereitstellen (101) von die Soll-Bewegung B_soll und den Soll-Kraftwinder $\overrightarrow{K}$

   

   definierenden Parametern $\text{P}\left({\text{B}}_{\text{soll}},\overrightarrow{K}\right)$

   

   von einer Speichereinheit, - während der Ausführung der Bewegung B_soll und/oder während der Ausübung des Soll-Kraftwinders $\overrightarrow{K}$

   

   Ermitteln(102) eines in den Robotermanipulator eingebrachten externen Kraftwinders ${\overrightarrow{K}}_{ext}=\left[{\overrightarrow{F}}_{ext},{\overrightarrow{L}}_{ext}\right],$

   

   - Korrigieren (103) der vorgegebenen Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

   

   abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

   

   zu einer korrigierten Soll-Bewegung: $${\text{B}}_{\text{soll}}*={\text{B}}_{\text{soll}}*\left({\overrightarrow{s}}_{pfadx}*\left({\overrightarrow{K}}_{ext}\right),{\dot{\overrightarrow{s}}}_{pfadx}\left({\overrightarrow{K}}_{ext}\right),{\ddot{\overrightarrow{s}}}_{pfadx}\left({\overrightarrow{K}}_{ext}\right)\right)$$

   

   und/oder Korrigieren (103) des vorgegebenen Soll-Kraftwinders $\overrightarrow{K}$

   

   abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

   

   zu einem korrigierten Soll-Kraftwinder $\overrightarrow{K}*=\overrightarrow{K}*\left(\overrightarrow{K},{\overrightarrow{K}}_{ext}\right)=\left[\overrightarrow{F}*,\overrightarrow{L}*\right],$

   

   $$$$

   

   mit ${\overrightarrow{s}}_{pfadx}\text{ * }\left({\overrightarrow{K}}_{ext}\right)$

   

   : Positionen des distalen Endes des Robotermanipulators auf dem abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

   

   korrigierten Pfad ${\overrightarrow{s}}_{pfad1},$

   

   ${\dot{\overrightarrow{s}}}_{pfadx}\text{ * }\left({\overrightarrow{K}}_{ext}\right)$

   

   : abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

   

   korrigierte Geschwindigkeit des distalen Endes des Robotermanipulators auf dem Pfad ${\overrightarrow{s}}_{pfadx},$

   

   ${\ddot{\overrightarrow{s}}}_{pfadx}\text{ * }\left({\overrightarrow{K}}_{ext}\right)$

   

   : abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

   

   korrigierte Beschleunigung des distalen Endes des Robotermanipulators auf dem Pfad ${\overrightarrow{s}}_{pfadx},$

   

   $\overrightarrow{K}*\left(\overrightarrow{K},{\overrightarrow{K}}_{ext}\right)$

   

   : abhängig von den Kraftwindern $\overrightarrow{K}\text{ und }{\overrightarrow{K}}_{ext}$

   

   korrigierter Kraftwinder, ${\overrightarrow{s}}_{pfadx}$

   

   : ${\overrightarrow{s}}_{pfad1}\text{ oder }{\overrightarrow{s}}_{pfad2},\text{ mit }{\overrightarrow{s}}_{pfad1}\ne {\overrightarrow{s}}_{pfad2},\text{ wobei }{\overrightarrow{s}}_{pfad2}$

   

   einen zweiten Pfad pfad2 definierende Positionen des distalen Endes des Robotermanipulators angibt, - nach der Korrektur der Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

   

   und/oder des Soll-Kraftwinders $\overrightarrow{K}$

   

   Ausführen (104) der korrigierten Soll-Bewegung B_soll* und/oder Ausüben des korrigierten Soll-Kraftwinders $\overrightarrow{K}*,$

   

   wobei die Ausführung der korrigierten Soll-Bewegung B_soll* bzw. des korrigierten Kraftwinders $\overrightarrow{K}*$

   

   nicht instantan nach der Korrektur, sondern von Beginn der Soll-Bewegung B_soll aus erfolgt, sodass der Robotermanipulator nach dem Erfassen des externen Kraftwinders ${\overrightarrow{K}}_{ext}$

   

   derart angesteuert wird, dass das distale Ende des Robotermanipulators auf eine Anfangsposition der korrigierten Soll Bewegung B_soll* gesteuert wird, und - Speichern (105) von die Soll-Bewegung B_soll* und den korrigierten Soll-Kraftwinder $\overrightarrow{K}*$

   

   definierenden Parametern $\text{P}\left({\text{B}}_{\text{soll}}*,\overrightarrow{K}*\right)$

   

   auf der Speichereinheit.
2. Verfahren nach Anspruch 1, bei dem das Korrigieren (103) der vorgegebenen Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

   

   und/oder das Korrigieren (103) des vorgegebenen Soll-Kraftwinders $\overrightarrow{K}$

   

   abhängig von einem aus der folgenden Liste gewählten Änderungsmodus aus der folgenden Liste erfolgt: - erster Änderungsmodus zur Änderung des Pfads ${\overrightarrow{s}}_{pfad1},$

   

   - zweiter Änderungsmodus zur Änderung der Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1},$

   

   - dritter Änderungsmodus zur Änderung der Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1},$

   

   - vierter Änderungsmodus zur Änderung des Kraftwinders $\overrightarrow{K}.$

   
3. Verfahren nach Anspruch 2, bei dem im ersten Änderungsmodus ausschließlich eine Korrektur des gesamten ersten Pfads pfad1 mit den Punkten ${\overrightarrow{s}}_{pfad1}$

   

   zu dem zweiten Pfad pfad2 mit den Punkten ${\overrightarrow{s}}_{pfad2}$

   

   erfolgt, wobei der zweite Pfad pfad2 der Bewegung B_soll* und damit die Punkte ${\overrightarrow{s}}_{pfad2}\left({\overrightarrow{K}}_{ext}\right)$

   

   durch eine Translation $\overrightarrow{t}$

   

   des gesamten ersten Pfads pfad1 um einen konstanten Translationsvektor $\overrightarrow{t}$

   

   erzeugt wird: ${\overrightarrow{s}}_{pfad2}\left({\overrightarrow{F}}_{ext}\right)={\overrightarrow{s}}_{pfad1}+\overrightarrow{t}$

   

   wobei der Betrag des Translationsvektors $\left|\overrightarrow{t}\right|$

   

   basierend auf dem Betrag der Kraft $\left|{\overrightarrow{F}}_{ext}\right|$

   

   bestimmt wird, und wobei die Richtung des Translationsvektors $\overrightarrow{t}$

   

   mit der Richtung der Kraft ${\overrightarrow{F}}_{ext}$

   

   identisch ist.
4. Verfahren nach Anspruch 2, bei dem im zweiten Änderungsmodus ausschließlich eine Korrektur der Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

   

   zu einer Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)$

   

   erfolgt, wobei sich die Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)$

   

   abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

   

   und der Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

   

   des distalen Endes des Robotermanipulators vor dem Einwirken des externen Kraftwinders ${\overrightarrow{K}}_{ext}$

   

   bestimmt: ${\dot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)={\dot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext},{\dot{\overrightarrow{s}}}_{pfad1}\right).$

   

   $$

   
5. Verfahren nach Anspruch 2, bei dem im dritten Änderungsmodus ausschließlich eine Korrektur der Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}$

   

   zu der Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)$

   

   erfolgt, wobei sich die Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)$

   

   abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext},$

   

   und der Geschwindigkeit ${\dot{\overrightarrow{s}}}_{pfad1}$

   

   sowie der Beschleunigung ${\ddot{\overrightarrow{s}}}_{pfad1}$

   

   des distalen Endes des Robotermanipulators im Zeitpunkt vor Einwirkens des externen Kraftwinders ${\overrightarrow{K}}_{ext}$

   

   bestimmt: ${\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext}\right)={\ddot{\overrightarrow{s}}}_{pfad1}*\left({\overrightarrow{K}}_{ext},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)).$

   
6. Verfahren nach Anspruch 2, bei dem im vierten Änderungsmodus ausschließlich eine Korrektur des Kraftwinders $\overrightarrow{K}$

   

   zu dem Kraftwinder $\overrightarrow{K}*$

   

   erfolgt, wobei sich der Kraftwinder $\overrightarrow{K}*$

   

   abhängig von dem Soll-Kraftwinder $\overrightarrow{K}$

   

   des Robotermanipulators im Zeitpunkt vor Einwirken des externen Kraftwinders ${\overrightarrow{K}}_{ext}$

   

   und dem externen Kraftwinder ${\overrightarrow{K}}_{ext}$

   

   bestimmt.
7. Verfahren nach einem der Ansprüche 1 bis 6, bei dem das Ausführen der korrigierten Soll-Bewegung B_soll* und/oder das Ausüben des korrigierten Soll-Kraftwinders $\overrightarrow{K}*$

   

   von der aktuellen Position des distalen Endes des Robotermanipulators an fortgesetzt wird.
8. Vorrichtung zur Steuerung eines aktorisch angetriebenen Robotermanipulators, und zur Ausführung eines Verfahrens gemäß den vorstehenden Ansprüchen, bei dem ein distales Ende des Robotermanipulators eine vorgegebene Soll-Bewegung ${\text{B}}_{\text{soll}}={\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

   

   entlang eines vorgegebenen ersten Pfads pfad1 ausführt und entlang des ersten Pfads pfad1 einen Soll-Kraftwinder $\overrightarrow{K}=\left[\overrightarrow{F},\overrightarrow{L}\right]$

   

   auf eine Umgebung ausübt, mit

   

   den ersten Pfad pfad1 definierende Positionen des distalen Endes des Robotermanipulators,

   

   vorgegebene Geschwindigkeiten des distalen Endes des Robotermanipulators entlang des ersten Pfades,

   

   vorgegebene Beschleunigungen des distalen Endes des Robotermanipulators entlang des ersten Pfades,

   

   vom distalen Ende des Robotermanipulators auf die Umgebung ausgeübte Kraft,

   

   vom distalen Ende des Robotermanipulators auf die Umgebung umfassend: - eine Schnittstelle (201) zum Bereitstellen von die Soll-Bewegung B_soll und den Soll-Kraftwinder $\overrightarrow{K}$

   

   definierenden Parametern $\text{P}\left({\text{B}}_{\text{soll}},\overrightarrow{K}\right)$

   

   von einer Speichereinheit (202), - eine Ermittlungseinheit (203), mit der während der Ausführung der Bewegung B_soll und/oder während der Ausübung des Soll-Kraftwinders $\overrightarrow{K}$

   

   ein in den Robotermanipulator eingebrachter externer Kraftwinders ${\overrightarrow{K}}_{ext}=\left[{\overrightarrow{F}}_{ext},{\overrightarrow{L}}_{ext}\right]$

   

   ermittelbar ist, - eine Korrektureinheit (204) zum Korrigieren der vorgegebenen Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

   

   abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

   

   zu einer korrigierten Soll-Bewegung: $${\text{B}}_{\text{soll}}*={\text{B}}_{\text{soll}}*\left({\overrightarrow{s}}_{pfadx}*\left({\overrightarrow{K}}_{ext}\right),{\dot{\overrightarrow{s}}}_{pfadx}\left({\overrightarrow{K}}_{ext}\right),{\ddot{\overrightarrow{s}}}_{pfadx}\left({\overrightarrow{K}}_{ext}\right)\right)$$

   

   und/oder zum Korrigieren des vorgegebenen Soll-Kraftwinders $\overrightarrow{K}$

   

   abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

   

   zu einem korrigierten Soll-Kraftwinder $\overrightarrow{K}*=\overrightarrow{K}*\left(\overrightarrow{K},{\overrightarrow{K}}_{ext}\right)=\left[\overrightarrow{F}*,\overrightarrow{L}*\right].$

   

   $$$$

   

   mit ${\overrightarrow{s}}_{pfadx}\text{ * }\left({\overrightarrow{K}}_{ext}\right)$

   

   : Positionen des distalen Endes des Robotermanipulators auf dem abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

   

   korrigierten Pfad ${\overrightarrow{s}}_{pfad1}.$

   

   ${\dot{\overrightarrow{s}}}_{pfadx}\text{ * }\left({\overrightarrow{K}}_{ext}\right)$

   

   : abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

   

   korrigierte Geschwindigkeit des distalen Endes des Robotermanipulators auf dem Pfad ${\overrightarrow{s}}_{pfadx},$

   

   ${\ddot{\overrightarrow{s}}}_{pfadx}\text{ * }\left({\overrightarrow{K}}_{ext}\right)$

   

   : abhängig von dem Kraftwinder ${\overrightarrow{K}}_{ext}$

   

   korrigierte $\overrightarrow{K}*\left(\overrightarrow{K},{\overrightarrow{K}}_{ext}\right)$

   

   : Beschleunigung des distalen Endes des Robotermanipulators auf dem Pfad ${\overrightarrow{s}}_{pfadx},$

   

   abhängig von den Kraftwindern $\overrightarrow{K}\text{ und }{\overrightarrow{K}}_{ext}$

   

   korrigierter Kraftwinder, ${\overrightarrow{s}}_{pfadx}$

   

   : ${\overrightarrow{s}}_{pfad1}\text{ oder }{\overrightarrow{s}}_{pfad2},\text{ mit }{\overrightarrow{s}}_{pfad1}\ne {\overrightarrow{s}}_{pfad2},\text{ wobei }{\overrightarrow{s}}_{pfad2}$

   

   einen zweiten Pfad pfad2 definierende Positionen des distalen Endes des Robotermanipulators angibt, - einer Steuereinheit (205), die derart ausgeführt und eingerichtet ist, dass nach der Korrektur der Soll-Bewegung ${\text{B}}_{\text{soll}}\left({\overrightarrow{s}}_{pfad1},{\dot{\overrightarrow{s}}}_{pfad1},{\ddot{\overrightarrow{s}}}_{pfad1}\right)$

   

   und/oder der Korrektur des Kraftwinders $\overrightarrow{K}$

   

   die korrigierte Soll-Bewegung B_soll* ausgeführt wird und/oder der korrigierte Soll-Kraftwinders $\overrightarrow{K}*$

   

   auf die Umgebung ausgeübt wird, wobei die Ausführung der korrigierten Soll-Bewegung B_soll* bzw. des korrigierten Kraftwinders $\overrightarrow{K}*$

   

   nicht instantan nach der Korrektur, sondern von Beginn der Soll-Bewegung B_soll aus erfolgt, sodass der Robotermanipulator nach dem Erfassen des externen Kraftwinders ${\overrightarrow{K}}_{ext}$

   

   derart angesteuert wird, dass das distale Ende des Robotermanipulators auf eine Anfangsposition der korrigierten Soll Bewegung B_soll* gesteuert wird, und die die Soll-Bewegung B_soll* und den Soll-Kraftwinder: $\overrightarrow{K}*$

   

   definierenden Parametern $\text{P}\left({\text{B}}_{\text{soll}}*,\overrightarrow{K}*\right)$

   

   über die Schnittstelle (201) auf der Speichereinheit (202) gespeichert werden.
9. Roboter mit einer Vorrichtung nach Anspruch 8.

Images