DE102019128082A1 - Drehmomentbegrenztes Bremsen eines Robotermanipulators - Google Patents

Drehmomentbegrenztes Bremsen eines Robotermanipulators Download PDF

Info

Publication number
DE102019128082A1
DE102019128082A1 DE102019128082.6A DE102019128082A DE102019128082A1 DE 102019128082 A1 DE102019128082 A1 DE 102019128082A1 DE 102019128082 A DE102019128082 A DE 102019128082A DE 102019128082 A1 DE102019128082 A1 DE 102019128082A1
Authority
DE
Germany
Prior art keywords
joints
robot manipulator
angle vector
joint angle
control unit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
DE102019128082.6A
Other languages
English (en)
Other versions
DE102019128082B4 (de
Inventor
Andreas Spenninger
Dmitrij Forssilow
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Franka Emika GmbH
Original Assignee
Franka Emika GmbH
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Priority to DE102019128082.6A priority Critical patent/DE102019128082B4/de
Application filed by Franka Emika GmbH filed Critical Franka Emika GmbH
Priority to KR1020227016116A priority patent/KR20220083767A/ko
Priority to PCT/EP2020/078981 priority patent/WO2021074262A1/de
Priority to CN202080072787.6A priority patent/CN114585481A/zh
Priority to EP20803095.7A priority patent/EP4045237A1/de
Priority to US17/769,419 priority patent/US20240123610A1/en
Priority to JP2022523078A priority patent/JP2022553260A/ja
Publication of DE102019128082A1 publication Critical patent/DE102019128082A1/de
Application granted granted Critical
Publication of DE102019128082B4 publication Critical patent/DE102019128082B4/de
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/1605Simulation of manipulator lay-out, design, modelling of manipulator
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1633Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/085Force or torque sensors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/0004Braking devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/106Programme-controlled manipulators characterised by positioning means for manipulator elements with articulated links
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/1607Calculation of inertia, jacobian matrixes and inverses
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/163Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1653Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1674Programme controls characterised by safety, monitoring, diagnostic

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Human Computer Interaction (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Manipulator (AREA)

Abstract

Die Erfindung betrifft einen Robotermanipulator (1), wobei eine Steuereinheit (7) eine an zumindest einem seiner Gelenke (5) angeordnete Bremseinrichtung (7) zum Erzeugen eines solchen Restmoments ansteuert, dass ein maximales Moment an dem Gelenk (5) nicht überschritten wird, und das Restmoment auf Basis einer sensorischen Ermittlung und/oder einer Schätzung des aktuell an dem Gelenk (5) auftretenden Moments ermittelt, wobei die Schätzung auf einem mit einem ersten vorgegebenen Faktor multiplizierten Maß für einen an dem zumindest einen der Gelenke (5) wirkenden Schwerkrafteinfluss, oder auf einem den Schwerkrafteinfluss aufweisenden dynamischen Modell des Robotermanipulators (1) basiert, wobei die Steuereinheit (3) den Schwerkrafteinfluss auf Basis eines Gelenkwinkelvektors mit Gelenkwinkeln zwischen dem zumindest einen der Gelenke (5) und einem distalen Ende des Robotermanipulators (1) ermittelt.

Description

  • Die Erfindung betrifft einen Robotermanipulator mit einer Vielzahl von durch Gelenke miteinander verbundenen Gliedern, mit einer Steuereinheit, und insbesondere mit einer Bremseinheit, sowie ein Verfahren zum Ansteuern einer Bremseinheit eines Robotermanipulators mit einer Vielzahl von durch Gelenken miteinander verbundenen Gliedern durch eine ebensolche Steuereinheit.
  • Aufgabe der Erfindung ist es, die Bewegung eines Robotermanipulators so zu verzögern, dass ein maximales Bremsmoment an einem Gelenk des Robotermanipulators nicht überschritten wird.
  • Die Erfindung ergibt sich aus den Merkmalen der unabhängigen Ansprüche. Vorteilhafte Weiterbildungen und Ausgestaltungen sind Gegenstand der abhängigen Ansprüche.
  • Ein erster Aspekt der Erfindung betrifft einen Robotermanipulator mit einer Vielzahl von durch Gelenke miteinander verbundenen Gliedern und mit einer Steuereinheit, wobei zumindest eines der Gelenke eine Bremseinrichtung aufweist und die Steuereinheit dazu ausgeführt ist, die Bremseinrichtung zum Erzeugen eines solchen Restmoments anzusteuern, dass ein vorgegebenes maximal zulässiges Moment an dem zumindest einen der Gelenke nicht überschritten wird, und das Restmoment auf Basis einer sensorischen Ermittlung und/oder einer Schätzung eines aktuell an dem zumindest einen der Gelenke auftretenden Moments zu ermitteln, wobei die Schätzung auf
    • - einem mit einem ersten vorgegebenen Faktor multiplizierten Maß für einen an dem zumindest einen der Gelenke wirkenden Schwerkrafteinfluss, oder auf
    • - einem den Schwerkrafteinfluss
    aufweisenden dynamischen Modell des Robotermanipulators basiert,
    wobei die Steuereinheit dazu ausgeführt ist, den Schwerkrafteinfluss auf Basis einer bekannten Masseverteilung des Robotermanipulators und auf Basis eines Gelenkwinkelvektors mit Gelenkwinkeln zwischen dem zumindest einen der Gelenke und einem distalen Ende des Robotermanipulators zu ermitteln.
  • Die Komponenten des Robotermanipulators, insbesondere die Glieder und die Komponenten an den Gelenken, unterliegen durch ihre Masse dem Einfluss des Schwerefelds der Erde. Insbesondere diejenigen Komponenten, die vor und damit in Richtung des distalen Endes ab dem zumindest einen Gelenk angeordnet sind, wirken damit mit einer Kraft und/oder einem Moment auf das zumindest eine Gelenk. Nimmt dieses zumindest eine Gelenk nicht diese Kraft und/oder dieses Moment auf, so würden diese Komponenten in Richtung der Erde herunterfallen. Zusätzlich zu diesem statischen Schwerkrafteinfluss kann bei einer Bewegung des Robotermanipulators eine weitere Komponente zu der auf das zumindest eine Gelenk wirkenden Kraft und/oder dem wirkenden Moment hinzukommen, verursacht durch die Trägheit der Masse aller Komponenten ab dem zumindest einen Gelenk, welche für eine Coriolis-Beschleunigung bzw. Zentrifugal-Beschleunigung verantwortlich ist.
  • Es wird das aktuell wirkende Moment an dem zumindest einen Gelenk ermittelt. Dies erfolgt entweder durch sensorische Ermittlung, das heißt, dass insbesondere ein Drehmomentsensor das aktuell wirkende Moment erfasst, insbesondere durch Erfassen einer Dehnung an einem elastischen Material, dessen E-Modul bekannt ist. Alternativ (oder in Kombination) dazu erfolgt die Ermittlung des aktuell wirkenden Moments an dem zumindest einen Gelenk durch Schätzung. Die Schätzung erfolgt bevorzugt durch Multiplikation eines Maßes für einen an dem zumindest einen der Gelenke wirkenden Schwerkrafteinfluss mit einem ersten vorgegebenen Faktor: τ J = g ( q ) f 1
    Figure DE102019128082A1_0001
  • Wobei hierin beschreiben:
  • τj:
    Die Schätzung des aktuell auf das zumindest eine Gelenk wirkenden Moments;
    q:
    Den aktuellen Gelenkwinkelvektor zumindest mit Gelenkwinkeln zwischen dem
    g(q):
    zumindest einen der Gelenke und dem distalen Ende des Robotermanipulators; Den Schwerkrafteinfluss in Abhängigkeit des aktuellen Gelenkwinkelvektors;
    f1:
    Den ersten vorgegebenen Faktor, bevorzugt gewählt als f1 = 140%;
  • Die Schätzung erfolgt alternativ bevorzugt mittels eines den Schwerkrafteinfluss aufweisenden dynamischen Modells des Robotermanipulators. Dies wird in den weiteren sich anschließenden Ausführungsformen näher erläutert.
  • Die Steuereinheit ist bevorzugt am Roboter selbst angeordnet, alternativ bevorzugt mit diesem lediglich datentechnisch verbunden. Das Moment, das von der Bremseinrichtung zu erzeugen ist, ist im Allgemeinen als relative Stellgröße zu sehen, sodass das Restmoment einerseits als absoluter Wert ein Bremsmoment einer mechanischen Bremse sein kann, oder andererseits kann der Wert des Restmoments auf eine von der Steuereinheit erzeugte Stellgröße für einen elektrischen Motor des zumindest einen Gelenks addiert werden, sodass das Restmoment nur einen Teilbetrag der absoluten Stellgröße des Motors des zumindest einen Gelenks ausmacht. Im letzteren Fall entspricht die Bremseinheit einem Motor des zumindest einen Gelenks, das heißt sie stimmt mit einem Antrieb des zumindest einen Gelenks überein, da ein Antrieb sowohl zum Erzeugen eines positiven, beschleunigenden, Moments als auch zu einem negativen, verzögernden, Moment verwendet werden kann. Weiterhin bevorzugt kann das Restmoment durch eine Saturierung realisiert sein, um die Stellgröße für den Motor des zumindest einen Gelenks zu begrenzen. Die Differenz zwischen dem maximal zulässigen Moment und dem aktuellen Moment an dem zumindest einem Gelenk stellt insbesondere eine obere Schranke für das Restmoment dar. Bevorzugt ist die Steuereinheit dazu ausgeführt, das Restmoment in Höhe dieser Differenz zu bestimmen. Vorteilhaft wird dadurch das höchstmögliche Restmoment, ohne das vorgegebene maximal zulässige Moment an dem zumindest einen Gelenk zu übersteigen, verwendet.
  • Es ist eine vorteilhafte Wirkung der Erfindung, dass die Sicherheit beim Betrieb eines Robotermanipulators insbesondere dadurch erhöht wird, dass ein erzeugtes Bremsmoment an zumindest einem Glied des Robotermanipulators mit einer vorgegebenen Grenze so abgeglichen wird, dass das erzeugte Bremsmoment die vorgegebene Grenze nicht übersteigt.
  • Gemäß einer vorteilhaften Ausführungsform ist die Steuereinheit dazu ausgeführt, den Gelenkwinkelvektor aus einer jeweiligen Aktuatorposition eines jeweiligen an einem jeweiligen Gelenk angeordneten Aktuators zwischen dem zumindest einen der Gelenke und einem distalen Ende des Robotermanipulators zu ermitteln.
  • Gemäß dieser Ausführungsform wird die Schätzung für das aktuell anliegende Moment durch Multiplikation eines Maßes für einen an dem zumindest einen der Gelenke wirkenden Schwerkrafteinfluss mit dem ersten vorgegebenen Faktor durch: τ J = g ( θ ) f 1
    Figure DE102019128082A1_0002
    oder im Falle eines Getriebes mit dem Übersetzungsverhältnis n durch: τ J = g ( n θ ) f 1
    Figure DE102019128082A1_0003
    ermittelt, worin angeben:
  • θ:
    Einen Vektor von Aktuatorpositionen, insbesondere von Motoren an denjenigen Gelenken, deren Gelenkwinkel q im obigen Fall ermittelt werden; und
    g(θ):
    Den Schwerkrafteinfluss in Abhängigkeit des aktuellen Vektors der Aktuatorpositionen;
  • Gemäß einer weiteren vorteilhaften Ausführungsform ist die Steuereinheit dazu ausgeführt, den Schwerkrafteinfluss auf Basis einer Masseverteilung des Robotermanipulators zu ermitteln. Bevorzugt umfasst die Masseverteilung des Robotermanipulators auch eine Relativposition eines Schwerpunkts einer Last am Robotermanipulator relativ zum Robotermanipulator.
  • Gemäß einer weiteren vorteilhaften Ausführungsform weist das dynamische Modell des Robotermanipulators eine mit einer zweiten zeitlichen Ableitung des Gelenkwinkelvektors multiplizierte und von dem Gelenkwinkelvektor abhängige Massematrix und eine von dem Gelenkwinkelvektor und von der ersten zeitlichen Ableitung des Gelenkwinkelvektors abhängige Coriolismatrix und einen vom Gelenkwinkelvektor abhängigen Term für den Schwerkrafteinfluss auf. Bevorzugt wird die Schätzung insoweit ermittelt durch: τ J = M ( q ) q ¨ + C ( q , q ˙ ) + g ( q )
    Figure DE102019128082A1_0004
  • Hierin beschreiben:
  • τj:
    Die Schätzung des aktuell auf das zumindest eine Gelenk wirkenden Moments;
    q:
    Den aktuellen Gelenkwinkelvektor zumindest mit Gelenkwinkeln zwischen dem zumindest einen der Gelenke und dem distalen Ende des Robotermanipulators;
    M(q):
    Eine aktuelle Massenmatrix von Komponenten des Robotermanipulators in Abhängigkeit des aktuellen Gelenkwinkelvektors;
    C(q,q̇):
    Eine aktuelle Coriolismatrix von Komponenten des Robotermanipulators in Abhängigkeit des aktuellen Gelenkwinkelvektors und seiner ersten zeitlichen Ableitung;
    g(q):
    Den Schwerkrafteinfluss in Abhängigkeit des aktuellen Gelenkwinkelvektors;
  • Gemäß einer weiteren vorteilhaften Ausführungsform weist das dynamische Modell des Robotermanipulators ein konstantes Maß für die mit der zweiten zeitlichen Ableitung des Gelenkwinkelvektors multiplizierte und von dem Gelenkwinkelvektor abhängige Massenmatrix und eine von dem Gelenkwinkelvektor und von der ersten zeitlichen Ableitung des Gelenkwinkelvektors abhängige Coriolismatrix und einen vom Gelenkwinkelvektor abhängigen Term für den Schwerkrafteinfluss auf. Bevorzugt wird die Schätzung in Adaption der vorhergehenden Ausführungsform ermittelt durch: τ J = B + C ( q , q ˙ ) + g ( q )
    Figure DE102019128082A1_0005
  • Hierin beschreibt:
  • B:
    eine vorgegebene obere Schranke für den Term M(q)q̈, wie oben beschrieben. Die weiteren Größen dieser Gleichung werden wie in der vorhergehenden Ausführungsform beschrieben verwendet.
  • Gemäß einer weiteren vorteilhaften Ausführungsform weist das dynamische Modell des Robotermanipulators eine von dem Gelenkwinkelvektor und von der ersten zeitlichen Ableitung des Gelenkwinkelvektors abhängige Coriolismatrix und einen vom Gelenkwinkelvektor abhängigen Term für den Schwerkrafteinfluss auf, wobei die Summe aus der Coriolismatrix und dem Term für den Schwerkrafteinfluss mit einem zweiten vorgegebenen Faktor multipliziert ist. Bevorzugt wird die Schätzung in Adaption der vor der vorhergehenden genannten Ausführungsform ermittelt durch: τ J = f 2 ( C ( q , q ˙ ) + g ( q ) )
    Figure DE102019128082A1_0006
  • Hierin beschreibt:
  • f2:
    den zweiten vorgegebenen Faktor; die weiteren Größen dieser Gleichung werden wie in der vor der vorhergehenden Ausführungsform beschrieben verwendet.
  • Gemäß einer weiteren vorteilhaften Ausführungsform ist der erste vorgegebene Faktor und/oder der zweite vorgegebene Faktor derart, dass das begrenzte Bremsmoment einen vorgegebenen Auslegungsfall nicht übersteigt. Bevorzugt wird für den ersten Faktor und/oder den zweiten Faktor jeweils ein heuristischer Faktor verwendet, der bei der Auslegung zur Dimensionierung von Komponenten des Robotermanipulators insbesondere an dem zumindest einen Gelenk verwendet wurde. Vorteilhaft wird so dasjenige maximal zulässige Moment, welches aus der Auslegungsphase des Robotermanipulators stammt, nicht überschritten.
  • Gemäß einer weiteren vorteilhaften Ausführungsform weist der Robotermanipulator an dem zumindest einen der Gelenke einen Drehmomentsensor auf, wobei der Drehmomentsensor zum Ausführen der sensorischen Ermittlung ausgeführt ist. Der Drehmomentsensor ist insbesondere zum direkten Erfassen einer Dehnung oder einer Verschiebung ausgeführt, die von einer Kraft oder einem Moment herrührt, welche auf ein elastisches Material mit bekanntem Spannungs- Dehnungsverhältnis wirkt. Bevorzugt wird ein speichenförmiger Drehmomentsensor verwendet.
  • Gemäß einer weiteren vorteilhaften Ausführungsform ist die Steuereinheit dazu ausgeführt, die Bremseinrichtung zum Erzeugen des Restmoments mittels eines Saturierungselements mit variablen Schranken anzusteuern, wobei die variablen Schranken von dem vorgegeben maximal zulässigen Moment an dem zumindest einen der Gelenke und von der sensorischen Ermittlung und/oder der Schätzung des aktuell an dem zumindest einen der Gelenke auftretenden Moments abhängig ist.
  • Gemäß einer weiteren vorteilhaften Ausführungsform weist ein jeweiliges der Gelenke eine jeweilige Steuereinheit auf, wobei die jeweilige Steuereinheit am jeweiligen der Gelenke angeordnet ist und zum Ansteuern nur der jeweiligen am jeweiligen Gelenk angeordneten Bremseinrichtung ausgeführt ist. Gemäß dieser Ausführungsform ist die Steuereinheit an einem jeweiligen Gelenk mit einer jeweiligen Bremse angeordnet. Vorteilhaft muss nicht der sogenannte „Master“ des Robotermanipulators die erfindungsgemäße Aufgabe übernehmen, sondern das jeweilige Rechenmodul an einem jeweiligen Gelenk ist für die jeweilige Bremseinrichtung des jeweiligen Gelenks zuständig.
  • Gemäß einer weiteren vorteilhaften Ausführungsform ist die Steuereinheit eine zentrale Steuereinheit des Robotermanipulators, die für alle Gelenke mit einer Bremseinrichtung zum Ausführen der erfindungsgemäßen Aufgabe verwendet wird.
  • Gemäß einer weiteren vorteilhaften Ausführungsform ist die Bremseinrichtung ein elektrischer Motor zum Bewegen oder Abbremsen von an dem zumindest einen der Gelenke angeordneten Gliedern relativ zueinander. Diese Ausführungsform entspricht dem Fall, dass ein Antrieb des Robotermanipulators sowohl zum positiven Beschleunigen als auch zum negativen Verzögern von zumindest zwei durch ein Gelenk miteinander verbundenen Glieder dient. Vorteilhaft ist gemäß dieser Ausführungsform keine weitere separate, insbesondere mechanische, Bremsvorrichtung notwendig.
  • Ein weiterer Aspekt der Erfindung betrifft ein Verfahren zum Ansteuern einer Bremseinheit eines Robotermanipulators mit einer Vielzahl von durch Gelenken miteinander verbundenen Gliedern durch eine Steuereinheit, wobei zumindest eines der Gelenke eine solche Bremseinrichtung aufweist, wobei die Bremseinrichtung zum Erzeugen eines derartigen Restmoments durch die Steuereinheit angesteuert wird, dass ein vorgegebenes maximal zulässiges Moment an dem zumindest einen der Gelenke nicht überschritten wird, wobei das Restmoment auf Basis einer sensorischen Ermittlung und/oder einer Schätzung des aktuell an dem zumindest einen der Gelenke auftretenden Moments von der Steuereinheit ermittelt wird, wobei die Schätzung auf
    • - einem mit einem ersten vorgegebenen Faktor multiplizierten Maß für einen an dem zumindest einen der Gelenke wirkenden Schwerkrafteinfluss, oder auf
    • - einem den Schwerkrafteinfluss aufweisenden dynamischen Modell des Robotermanipulators basiert, wobei der Schwerkrafteinfluss von der Steuereinheit auf Basis eines Gelenkwinkelvektors mit Gelenkwinkeln zwischen dem zumindest einen der Gelenke und einem distalen Ende des Robotermanipulators ermittelt wird.
  • Vorteile und bevorzugte Weiterbildungen des vorgeschlagenen Verfahrens ergeben sich durch eine analoge und sinngemäße Übertragung der im Zusammenhang mit dem vorgeschlagenen Robotermanipulator vorstehend gemachten Ausführungen.
  • 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 Robotermanipulator gemäß einem Ausführungsbeispiel der Erfindung, und
    • 2 einen Robotermanipulator gemäß einem weiteren Ausführungsbeispiel der Erfindung.
  • Die Darstellungen in den Figuren sind schematisch und nicht maßstäblich.
  • 1 zeigt einen Robotermanipulator 1 mit einer Vielzahl von durch Gelenken miteinander verbundenen Gliedern. Der Robotermanipulator 1 weist eine zentrale Steuereinheit 3 auf, wobei an jedem der Gelenke 5 eine jeweilige Bremseinrichtung 7 angeordnet ist. Die jeweilige Bremseinrichtung 7 ist hierbei ein jeweiliger elektrischer Motor (Antrieb) zum Bewegen oder Abbremsen von an dem jeweiligen der Gelenke 5 angeordneten Glieder relativ zueinander. Der Einfachheit halber sind in der 1 nur zwei beispielhafte Gelenke 5 gezeigt. Die Steuereinheit 3 dient zum Erzeugen eines solchen jeweiligen Restmoments für die jeweilige Bremseinrichtung 7, dass ein jeweiliges vorgegebenes maximal zulässiges Moment an dem jeweiligen Gelenk 5 nicht überschritten wird. Für jedes der Gelenke 5 wird hierbei ein bestimmtes maximal zulässiges Moment vorgegeben. Das Restmoment wird hierbei auf Basis des maximal zulässigen Moments an dem jeweiligen Gelenk und auf Basis einer Schätzung des aktuell an dem zumindest einen der Gelenke 5 auftretenden Moments ermittelt, wobei die Schätzung auf einem den Schwerkrafteinfluss aufweisenden dynamischen Modell des Robotermanipulators 1 basiert. Die Steuereinheit 3 ermittelt dabei den Schwerkrafteinfluss auf Basis eines Gelenkwinkelvektors mit Gelenkwinkeln zwischen dem zumindest einen der Gelenke 5 und einem distalen Ende 9 des Robotermanipulators 1. Das dynamische Modell des Robotermanipulators 1 weist eine mit einer zweiten zeitlichen Ableitung des Gelenkwinkelvektors multiplizierte und von dem Gelenkwinkelvektor abhängige Massematrix und eine von dem Gelenkwinkelvektor und von der ersten zeitlichen Ableitung des Gelenkwinkelvektors abhängige Coriolismatrix und einen vom Gelenkwinkelvektor abhängigen Term für den Schwerkrafteinfluss auf und lautet: τ J = M ( q ) q ¨ + C ( q , q ¨ ) + g ( q )
    Figure DE102019128082A1_0007
  • Hierin beschreiben:
  • τj:
    Die Schätzung des aktuell auf das zumindest eine Gelenk wirkenden Moments;;
    q:
    Den aktuellen Gelenkwinkelvektor mit Gelenkwinkeln zwischen dem zumindest einen der Gelenke und dem distalen Ende 9 des Robotermanipulators;
    M(q):
    Eine aktuelle Massenmatrix von Komponenten des Robotermanipulators in Abhängigkeit des aktuellen Gelenkwinkelvektors;
    C(q,q̇):
    Eine aktuelle Coriolismatrix von Komponenten des Robotermanipulators in Abhängigkeit des aktuellen Gelenkwinkelvektors und seiner ersten zeitlichen Ableitung;
    g(q):
    Den Schwerkrafteinfluss in Abhängigkeit des aktuellen Gelenkwinkelvektors;
  • 2 zeigt einen Robotermanipulator 1, wiederum mit einer Vielzahl von durch Gelenken 5 miteinander verbundenen Gliedern. Der Robotermanipulator 1 weist an jedem der Gelenke 5 eine Bremseinheit 7 mit einer jeweiligen Steuereinheit 3 auf. Die jeweilige Bremseinrichtung 7 ist hierbei ein jeweiliger elektrischer Motor (Antrieb) zum Bewegen oder Abbremsen von an dem jeweiligen der Gelenke 5 angeordneten Glieder relativ zueinander. Der Einfachheit halber sind in der 1 nur zwei beispielhafte Gelenke 5 gezeigt. Die jeweilige Steuereinheit 3 dient zum Erzeugen eines solchen jeweiligen Restmoments für die jeweilige Bremseinrichtung 7, dass ein jeweiliges vorgegebenes maximal zulässiges Moment an dem jeweiligen Gelenk 5 nicht überschritten wird. Für jedes der Gelenke 5 wird hierbei ein bestimmtes maximal zulässiges Moment vorgegeben. Das jeweilige Restmoment wird auf Basis des maximal zulässigen Moments an dem jeweiligen Gelenk und auf Basis einer sensorischen Ermittlung des am jeweiligen der Gelenke 5 aktuell anliegenden Moments ermittelt. Zu diesem Zweck weist jedes der Gelenke 5 einen jeweiligen Drehmomentsensor 11 auf.
  • 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 weitergehende Erläuterungen in der Beschreibung, definiert wird.
  • Bezugszeichenliste
  • 1
    Robotermanipulator
    3
    Steuereinheit
    5
    das zumindest eine der Gelenke
    7
    Bremseinrichtung
    9
    distales Ende des Robotermanipulators
    11
    Drehmomentsensor

Claims (10)

  1. Robotermanipulator (1) mit einer Vielzahl von durch Gelenke miteinander verbundenen Gliedern und mit einer Steuereinheit (3), wobei zumindest eines der Gelenke (5) eine Bremseinrichtung (7) aufweist und die Steuereinheit (3) dazu ausgeführt ist, die Bremseinrichtung (7) zum Erzeugen eines solchen Restmoments anzusteuern, dass ein vorgegebenes maximal zulässiges Moment an dem zumindest einen der Gelenke (5) nicht überschritten wird, und das Restmoment auf Basis einer sensorischen Ermittlung und/oder einer Schätzung eines aktuell an dem zumindest einen der Gelenke (5) auftretenden Moments zu ermitteln, wobei die Schätzung auf - einem mit einem ersten vorgegebenen Faktor multiplizierten Maß für einen an dem zumindest einen der Gelenke (5) wirkenden Schwerkrafteinfluss, oder auf - einem den Schwerkrafteinfluss aufweisenden dynamischen Modell des Robotermanipulators (1) basiert, wobei die Steuereinheit (3) dazu ausgeführt ist, den Schwerkrafteinfluss auf Basis einer bekannten Masseverteilung des Robotermanipulators (1) und eines Gelenkwinkelvektors mit Gelenkwinkeln zwischen dem zumindest einen der Gelenke (5) und einem distalen Ende des Robotermanipulators (1) zu ermitteln.
  2. Robotermanipulator (1) nach Anspruch 1, wobei die Steuereinheit (3) dazu ausgeführt ist, den Gelenkwinkelvektor aus einer jeweiligen Aktuatorposition eines jeweiligen an einem jeweiligen Gelenk (5) angeordneten Aktuators zwischen dem zumindest einen der Gelenke (5) und einem distalen Ende (9) des Robotermanipulators (1) zu ermitteln.
  3. Robotermanipulator (1) nach einem der Ansprüche 1 bis 2, wobei das dynamische Modell des Robotermanipulators (1) eine mit einer zweiten zeitlichen Ableitung des Gelenkwinkelvektors multiplizierte und von dem Gelenkwinkelvektor abhängige Massematrix und eine von dem Gelenkwinkelvektor und von der ersten zeitlichen Ableitung des Gelenkwinkelvektors abhängige Coriolismatrix und einen vom Gelenkwinkelvektor abhängigen Term für den Schwerkrafteinfluss aufweist.
  4. Robotermanipulator (1) nach einem der Ansprüche 1 bis 2, wobei das dynamische Modell des Robotermanipulators (1) ein konstantes Maß für die mit der zweiten zeitlichen Ableitung des Gelenkwinkelvektors multiplizierte und von dem Gelenkwinkelvektor abhängige Massematrix aufweist und eine von dem Gelenkwinkelvektor und von der ersten zeitlichen Ableitung des Gelenkwinkelvektors abhängige Coriolismatrix und einen vom Gelenkwinkelvektor abhängigen Term für den Schwerkrafteinfluss aufweist.
  5. Robotermanipulator (1) nach einem der Ansprüche 1 bis 2, wobei das dynamische Modell des Robotermanipulators (1) eine von dem Gelenkwinkelvektor und von der ersten zeitlichen Ableitung des Gelenkwinkelvektors abhängige Coriolismatrix und einen vom Gelenkwinkelvektor abhängigen Term für den Schwerkrafteinfluss aufweist, wobei die Summe aus der Coriolismatrix und dem Term für den Schwerkrafteinfluss mit einem zweiten vorgegebenen Faktor multipliziert ist.
  6. Robotermanipulator (1) nach einem der vorhergehenden Ansprüche, wobei der Robotermanipulator (1) an dem zumindest einen der Gelenke (5) einen Drehmomentsensor (11) aufweist, wobei der Drehmomentsensor (11) zum Ausführen der sensorischen Ermittlung ausgeführt ist.
  7. Robotermanipulator (1) nach einem der vorhergehenden Ansprüche, wobei die Steuereinheit (3) dazu ausgeführt ist, die Bremseinrichtung (7) zum Erzeugen des Restmoments mittels eines Saturierungselements mit variablen Schranken anzusteuern, wobei die variablen Schranken von dem vorgegeben maximal zulässigen Moment an dem zumindest einen der Gelenke (5) und von der sensorischen Ermittlung und/oder der Schätzung des aktuell an dem zumindest einen der Gelenke (5) auftretenden Moments abhängig sind.
  8. Robotermanipulator (1) nach einem der vorhergehenden Ansprüche, wobei ein jeweiliges der Gelenke (5) eine jeweilige Steuereinheit (3) aufweist, und die jeweilige Steuereinheit (3) am jeweiligen der Gelenke (5) angeordnet ist und zum Ansteuern nur der jeweiligen am jeweiligen Gelenk (5) angeordneten Bremseinrichtung (7) ausgeführt ist.
  9. Robotermanipulator (1) nach einem der vorhergehenden Ansprüche, wobei die Bremseinrichtung (7) ein elektrischer Motor zum Bewegen oder Abbremsen von an dem zumindest einen der Gelenke (5) angeordneten Gliedern relativ zueinander ist.
  10. Verfahren zum Ansteuern einer Bremseinheit (7) eines Robotermanipulators (1) mit einer Vielzahl von durch Gelenken miteinander verbundenen Gliedern durch eine Steuereinheit (3), wobei zumindest eines der Gelenke (5) die Bremseinrichtung (7) aufweist, wobei die Bremseinrichtung (7) zum Erzeugen eines solchen Restmoments durch die Steuereinheit (3) angesteuert wird, dass ein vorgegebenes maximal zulässiges Moment an dem zumindest einen der Gelenke (5) nicht überschritten wird, wobei das Restmoment auf Basis einer sensorischen Ermittlung und/oder einer Schätzung des aktuell an dem zumindest einen der Gelenke (5) auftretenden Moments von der Steuereinheit (7) ermittelt wird, wobei die Schätzung auf - einem mit einem ersten vorgegebenen Faktor multiplizierten Maß für einen an dem zumindest einen der Gelenke (5) wirkenden Schwerkrafteinfluss, oder auf - einem den Schwerkrafteinfluss aufweisenden dynamischen Modell des Robotermanipulators (1) basiert, wobei der Schwerkrafteinfluss von der Steuereinheit (3) auf Basis eines Gelenkwinkelvektors mit Gelenkwinkeln zwischen dem zumindest einen der Gelenke (5) und einem distalen Ende des Robotermanipulators (1) ermittelt wird.
DE102019128082.6A 2019-10-17 2019-10-17 Drehmomentbegrenztes Bremsen eines Robotermanipulators Active DE102019128082B4 (de)

Priority Applications (7)

Application Number Priority Date Filing Date Title
DE102019128082.6A DE102019128082B4 (de) 2019-10-17 2019-10-17 Drehmomentbegrenztes Bremsen eines Robotermanipulators
PCT/EP2020/078981 WO2021074262A1 (de) 2019-10-17 2020-10-15 Drehmomentbegrenztes bremsen eines robotermanipulators
CN202080072787.6A CN114585481A (zh) 2019-10-17 2020-10-15 机器人机械手的扭矩限制制动
EP20803095.7A EP4045237A1 (de) 2019-10-17 2020-10-15 Drehmomentbegrenztes bremsen eines robotermanipulators
KR1020227016116A KR20220083767A (ko) 2019-10-17 2020-10-15 로봇 매니퓰레이터의 토크 제한식 제동
US17/769,419 US20240123610A1 (en) 2019-10-17 2020-10-15 Torque-limited braking of a robot manipulator
JP2022523078A JP2022553260A (ja) 2019-10-17 2020-10-15 ロボットマニピュレータのトルク制限ブレーキ

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
DE102019128082.6A DE102019128082B4 (de) 2019-10-17 2019-10-17 Drehmomentbegrenztes Bremsen eines Robotermanipulators

Publications (2)

Publication Number Publication Date
DE102019128082A1 true DE102019128082A1 (de) 2021-04-22
DE102019128082B4 DE102019128082B4 (de) 2022-03-10

Family

ID=73138796

Family Applications (1)

Application Number Title Priority Date Filing Date
DE102019128082.6A Active DE102019128082B4 (de) 2019-10-17 2019-10-17 Drehmomentbegrenztes Bremsen eines Robotermanipulators

Country Status (7)

Country Link
US (1) US20240123610A1 (de)
EP (1) EP4045237A1 (de)
JP (1) JP2022553260A (de)
KR (1) KR20220083767A (de)
CN (1) CN114585481A (de)
DE (1) DE102019128082B4 (de)
WO (1) WO2021074262A1 (de)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102013227147A1 (de) * 2013-12-23 2015-06-25 Daimler Ag Verfahren zum automatisierten Drehfügen und/oder Drehlösenvon Bauteilen, sowie zugehöriger Industrieroboter und automatisierterMontagearbeitsplatz
DE102014001923A1 (de) * 2014-02-12 2015-08-13 Kuka Roboter Gmbh Verfahren und Vorrichtung zum Festlegen einer Manipulatorachse
DE102015106227B3 (de) * 2015-04-22 2016-05-19 Deutsches Zentrum für Luft- und Raumfahrt e.V. Steuern und/oder Regeln von Motoren eines Roboters
EP3109014B1 (de) * 2015-06-26 2017-09-20 Haption Motorisierter gelenkarm mit capstan mit kabel, der eine bremse umfasst
DE102017106791A1 (de) * 2017-03-29 2018-10-04 Kuka Deutschland Gmbh Überwachungsverfahren und Überwachungssystem
DE112016001831B4 (de) * 2015-05-21 2019-09-19 Kastanienbaum GmbH Verfahren und Vorrichtung zur Steuerung/Regelung eines aktorisch angetriebenen Robotergelenks

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4358979B2 (ja) * 2000-07-14 2009-11-04 株式会社ダイヘン ロボットシステムの制御方法及び制御装置
US7390309B2 (en) * 2002-09-23 2008-06-24 Honda Motor Co., Ltd. Human assist system using gravity compensation control system and method using multiple feasibility parameters
JP2005094744A (ja) * 2003-08-08 2005-04-07 Toshiba Corp 制御システム
US7741802B2 (en) * 2005-12-20 2010-06-22 Intuitive Surgical Operations, Inc. Medical robotic system with programmably controlled constraints on error dynamics
FR2978844B1 (fr) * 2011-08-04 2014-03-21 Aldebaran Robotics Robot a articulations de rigidite variable et methode de calcul de ladite rigidite optimisee
CN103747927A (zh) * 2011-08-19 2014-04-23 株式会社安川电机 机器人系统、机器人和机器人控制装置
US9092698B2 (en) * 2012-06-21 2015-07-28 Rethink Robotics, Inc. Vision-guided robots and methods of training them
GB2518576B (en) * 2012-08-02 2015-09-02 Toshiba Machine Co Ltd Robotic apparatus and control method therefor
SE537534C2 (sv) * 2013-08-27 2015-06-02 Cognibotics Ab Metod och system för bestämning av åtminstone en egenskap hos en manipulator
JP2016028842A (ja) * 2014-07-17 2016-03-03 株式会社ロボテック アクチュエータシステム
EP3001164B1 (de) * 2014-09-25 2019-03-27 ABB Schweiz AG Auswertung des statischen Bremsmoments in einem Roboter
DE102015113467A1 (de) * 2015-08-14 2017-02-16 Sami Haddadin Roboterarm und Roboterhandgelenk
EP3498433A1 (de) * 2017-12-14 2019-06-19 Universal Robots A/S Dynamische sicherheitstrajektorien in einem robotersystem
US11453122B2 (en) * 2018-03-28 2022-09-27 Bae Systems Plc Collaborative robot system
CN112352206A (zh) * 2018-06-15 2021-02-09 优傲机器人公司 机器人臂的双模自由驱动

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102013227147A1 (de) * 2013-12-23 2015-06-25 Daimler Ag Verfahren zum automatisierten Drehfügen und/oder Drehlösenvon Bauteilen, sowie zugehöriger Industrieroboter und automatisierterMontagearbeitsplatz
DE102014001923A1 (de) * 2014-02-12 2015-08-13 Kuka Roboter Gmbh Verfahren und Vorrichtung zum Festlegen einer Manipulatorachse
DE102015106227B3 (de) * 2015-04-22 2016-05-19 Deutsches Zentrum für Luft- und Raumfahrt e.V. Steuern und/oder Regeln von Motoren eines Roboters
DE112016001831B4 (de) * 2015-05-21 2019-09-19 Kastanienbaum GmbH Verfahren und Vorrichtung zur Steuerung/Regelung eines aktorisch angetriebenen Robotergelenks
EP3109014B1 (de) * 2015-06-26 2017-09-20 Haption Motorisierter gelenkarm mit capstan mit kabel, der eine bremse umfasst
DE102017106791A1 (de) * 2017-03-29 2018-10-04 Kuka Deutschland Gmbh Überwachungsverfahren und Überwachungssystem

Also Published As

Publication number Publication date
KR20220083767A (ko) 2022-06-20
EP4045237A1 (de) 2022-08-24
DE102019128082B4 (de) 2022-03-10
CN114585481A (zh) 2022-06-03
US20240123610A1 (en) 2024-04-18
WO2021074262A1 (de) 2021-04-22
JP2022553260A (ja) 2022-12-22

Similar Documents

Publication Publication Date Title
EP3914423A1 (de) Verfahren zum ermitteln einer gewichtskraft und eines schwerpunktes einer robotermanipulatorlast
DE19742920A1 (de) Verfahren zum Aufbringen definierter Betätigungskräfte
DE202019102430U1 (de) Ermittlung eines externen Kraftwinders durch Drehmomentsensoren eines Robotermanipulators
EP3132243B1 (de) Verfahren zur nachbildung des fahrzeugverhaltens und fahrzeugprüfstand
DE102006015636B4 (de) Verfahren zum Kompensieren von Schiefzieheffekten an einem Kraftfahrzeug über die Fahrzeuglenkung sowie hierzu geeignete Vorrichtung
DE102011003506A1 (de) Industrieroboter
DE102019102470A1 (de) Einlernvorgang für ein Robotersystem bestehend aus zwei Robotermanipulatoren
DE102013014122A1 (de) Lenkanschlag
DE102017116733A1 (de) Kontrolleinrichtung für mindestens einen Radnabenmotor sowie Fahrzeug mit der Kontrolleinrichtung
EP4106958A1 (de) Steuerung eines robotermanipulators bei kontakt mit einer person
DE102016217105A1 (de) Verfahren zum Ansteuern eines Insassenschutzsystems eines Fahrzeugs und Steuergerät
WO2021004920A1 (de) Taktile rückmeldung eines endeffektors eines robotermanipulators über verschiedene orientierungsbereiche
WO2020200804A1 (de) Kalibrieren von drehmomentsensoren eines robotermanipulators
DE202019104109U1 (de) Kraftfeld um eingelernte Positionen eines Robotermanipulators
DE102019128591A1 (de) Gestensteuerung für einen Robotermanipulator
DE102019128082A1 (de) Drehmomentbegrenztes Bremsen eines Robotermanipulators
EP3946831B1 (de) Vorgeben von sicheren geschwindigkeiten für einen robotermanipulator
DE102015113720A1 (de) Regel- oder Steuersystem, landwirtschaftliche Maschine mit einem solchen System und Verfahren zum Betreiben einer landwirtschaftlichen Maschine
EP3359410A1 (de) Antriebsvorrichtung für ein allradgetriebenes kraftfahrzeug
DE102021113139B3 (de) Verfahren zur Verwendung einer Robotereinrichtung; System; Computerprogramm; Speichermedium
DE60006872T2 (de) Methode und Vorrichtung zur Verschiebung einer beweglichen Masse auf einer elastisch gelagerten Unterlage
DE3723488A1 (de) Fahrzeug mit einem system zur dynamischen stabilisierung seiner bewegungen
DE102019127260B4 (de) Reibungskompensation für einen Greifer eines Robotermanipulators
DE202019105217U1 (de) Virtueller Endanschlag eines Gelenks eines Robotermanipulators
WO2021099454A1 (de) Kraftmessung und krafterzeugung in redundanten robotermanipulatoren

Legal Events

Date Code Title Description
R012 Request for examination validly filed
R016 Response to examination communication
R018 Grant decision by examination section/examining division
R020 Patent grant now final