DE102019202456A1 - Verfahren und System zum Durchführen einer vorgegebenen Aufgabe durch einen Roboter - Google Patents

Verfahren und System zum Durchführen einer vorgegebenen Aufgabe durch einen Roboter Download PDF

Info

Publication number
DE102019202456A1
DE102019202456A1 DE102019202456.4A DE102019202456A DE102019202456A1 DE 102019202456 A1 DE102019202456 A1 DE 102019202456A1 DE 102019202456 A DE102019202456 A DE 102019202456A DE 102019202456 A1 DE102019202456 A1 DE 102019202456A1
Authority
DE
Germany
Prior art keywords
robot
task
admittance
movement
determined
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.)
Pending
Application number
DE102019202456.4A
Other languages
English (en)
Inventor
Ewald Lutscher
Mario Daniele Fiore
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.)
KUKA Deutschland GmbH
Original Assignee
KUKA Deutschland 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
Application filed by KUKA Deutschland GmbH filed Critical KUKA Deutschland GmbH
Priority to DE102019202456.4A priority Critical patent/DE102019202456A1/de
Priority to PCT/EP2020/051708 priority patent/WO2020169302A1/de
Priority to KR1020217029895A priority patent/KR20210127746A/ko
Priority to CN202080015794.2A priority patent/CN113474130A/zh
Priority to EP20702254.2A priority patent/EP3927498A1/de
Priority to US17/431,593 priority patent/US20220111520A1/en
Publication of DE102019202456A1 publication Critical patent/DE102019202456A1/de
Pending legal-status Critical Current

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/30Surgical robots
    • A61B34/32Surgical robots operating autonomously
    • 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
    • B25J9/00Programme-controlled manipulators
    • B25J9/06Programme-controlled manipulators characterised by multi-articulated arms
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • 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
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1643Programme controls characterised by the control loop redundant 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/1679Programme controls characterised by the tasks executed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00Gripping heads and other end effectors
    • B25J15/0019End effectors other than grippers
    • 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/1651Programme controls characterised by the control loop acceleration, rate control
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/39Robotics, robotics to robotics hand
    • G05B2219/39086Reduce impact effect by impact configuration of redundant manipulator
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/40Robotics, robotics mapping to robotics vision
    • G05B2219/40202Human robot coexistence
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/40Robotics, robotics mapping to robotics vision
    • G05B2219/40367Redundant manipulator

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Surgery (AREA)
  • Biomedical Technology (AREA)
  • Molecular Biology (AREA)
  • Automation & Control Theory (AREA)
  • Mathematical Physics (AREA)
  • Physics & Mathematics (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Medical Informatics (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Human Computer Interaction (AREA)
  • Manipulator (AREA)

Abstract

Nach einem erfindungsgemäßen Verfahren zum Durchführen einer vorgegebenen Aufgabe durch einen Roboter (10), der bezüglich dieser Aufgabe redundant ist, wird beim Durchführen der Aufgabe eine von einer extern auf den Roboter ausgeübten Kraft und einer vorgegebenen virtuellen Masse, Steifigkeit und/oder Dämpfung abhängige Admittanz-Bewegung im Nullraum durchgeführt.

Description

  • Die vorliegende Erfindung betrifft ein Verfahren zum Durchführen einer vorgegebenen Aufgabe durch einen Roboter, der bezüglich dieser Aufgabe redundant ist, ein System zum Betreiben des Roboters, das zur Durchführung des Verfahrens eingerichtet ist und ein Computerprogrammprodukt zur Durchführung des Verfahrens
  • Roboter können Aufgaben durchführen, bezüglich deren sie redundant sind. Umfasst eine Aufgabe beispielsweise eine vorgegebene dreidimensionale Position und dreidimensionale Orientierung eines Roboterendflanschs bzw. eines damit verbundenen robotergeführten Werkzeugs, so ist ein Roboter mit sieben oder mehr aufeinanderfolgenden Gelenken bezüglich dieser Aufgabe redundant.
  • Auf der anderen Seite ist eine Handführung von Robotern bekannt, bei der der Roboter einer manuell auf ihn ausgeübten Kraft folgt bzw. aus(zu)weich(en such)t.
  • Bei bisherigen betriebsinternen Ansätzen einer Handführung von Robotern beim Durchführen einer vorgegebenen Aufgabe, bezüglich der der Roboter redundant ist, ist insbesondere die Präzision der Aufgabendurchführung häufig unbefriedigend.
  • Aufgabe der vorliegenden Erfindung ist es, die Durchführung vorgegebener Aufgaben durch Roboter, die bezüglich dieser Aufgaben redundant sind, zu verbessern, vorzugsweise die Präzision der Aufgabendurchführung bei bzw. trotz Handführung des Roboters zu erhöhen.
  • Diese Aufgabe wird durch ein Verfahren mit den Merkmalen des Anspruchs 1 gelöst. Ansprüche 8, 9 stellen ein System bzw. Computerprogrammprodukt zur Durchführung eines hier beschriebenen Verfahrens unter Schutz. Die Unteransprüche betreffen vorteilhafte Weiterbildungen.
  • Nach einer Ausführung der vorliegenden Erfindung ist ein Roboter bezüglich einer vorgegebenen Aufgabe redundant. In einer Ausführung weist der Roboter mehr Freiheitsgrade, insbesondere Gelenke bzw. Achsen, auf als die Aufgabe bzw. für die Durchführung der Aufgabe erforderlich bzw. durch diese bestimmt.
  • Bezeichne xd ∈ ℝtask bzw. ẋd ∈ ℝtask eine vorgegebene Aufgabe, beispielsweise eine Pose bzw. Position und/oder Orientierung einer roboterfesten Referenz bzw. deren zeitliche Änderung, und q ∈ ℝDoF Gelenkkoordinaten, beispielsweise Winkellagen, des Roboters, so gilt bei dem ((aufgaben)redundanten) Roboter entsprechend in einer Ausführung task< DoF.
  • In einer Weiterbildung weist der Roboter wenigstens sechs, insbesondere wenigstens sieben, in einer Ausführung aufeinanderfolgende, Gelenke bzw. Achsen, insbesondere Drehgelenke bzw. -achsen, auf (Dof≥ 6 bzw. Dof ≥ 7), so dass er insbesondere beliebige vorgegebene dreidimensionale Positionen und Orientierungen anfahren kann (Dof≥ 6) bzw. bezüglich beliebiger vorgegebener sechsdimensionaler Posen roboterfester Referenzen stets redundant (Dof≥ 7) und somit sehr flexibel einsetzbar ist.
  • Nach einer Ausführung der vorliegenden Erfindung wird beim Durchführen der vorgegebenen, in einer Ausführung programmierten bzw. vorab abgespeicherten oder durch einen Eingabebefehl kommandierten, Aufgabe durch den Roboter eine Bewegung i(n eine)m Nullraum (des Roboters bezüglich der Aufgabe) durchgeführt, insbesondere kommandiert, die vorliegend als Admittanz-Bewegung bezeichnet wird und von einer extern, insbesondere manuell, auf den Roboter ausgeübten Kraft und einer vorgegebenen, in einer Ausführung eingestellten bzw. parametrierten, virtuellen Masse, virtuellen Steifigkeit und/oder virtuellen Dämpfung abhängt, in einer Ausführung auf Basis der extern auf den Roboter ausgeübten Kraft und vorgegebenen virtuellen Masse, Steifigkeit bzw. Dämpfung ermittelt wird bzw. ist. In einer Ausführung werden Gelenke bzw. Antriebe des Roboters, in einer Ausführung Elektromotoren, derart aktuiert bzw. kommandiert, dass der Roboter die Aufgabe und Admittanz-Bewegung durchführt bzw. zur Durchführung der Aufgabe und der Admittanz-Bewegung aktuiert bzw. kommandiert.
  • Hierdurch kann in einer Ausführung der Roboter beim Durchführen der vorgegebenen Aufgabe (durch externes Aufprägen der Kraft) handgeführt und dadurch seine Redundanz, insbesondere zur Kollisionsvermeidung oder dergleichen, ausgenutzt, und dabei vorteilhaft die Präzision der Aufgabendurchführung erhöht werden.
  • Zur kompakteren Darstellung wird vorliegend auch ein antiparalleles Kräftepaar bzw. Drehmoment verallgemeinernd als Kraft im Sinne der vorliegenden Erfindung bezeichnet.
  • Die Jacobimatrix (der Aufgabe) ist in einer Ausführung in fachüblicher Weise definiert durch J = x d q
    Figure DE102019202456A1_0001
    bzw. J = x ˙ d q ˙
    Figure DE102019202456A1_0002
    mit den Zeitableitungen d x d d t = x ˙ d ,   d q d t = q ˙ ,   d 2 q d t 2 = q ¨   .
    Figure DE102019202456A1_0003
  • Eine generalisierte bzw. Pseudoinverse J#der Jacobimatrix bildet umgekehrt ẋd auf q̇d ab q ˙ d = J # x ˙ d
    Figure DE102019202456A1_0004
    und kann in einer Ausführung gemäß J # = W 1 J T ( J W 1 J T ) 1
    Figure DE102019202456A1_0005
    mit der Inversen ()-1 einer Gewichtungsmatrix W, beispielsweise der Einheits- oder Massenmatrix, und der Transponierten ()T definiert sein bzw. ermittelt werden.
  • Der Nullraum (der Aufgabe) ist in einer Ausführung in fachüblicher Weise definiert durch den Nullraumoperator bzw. -projektor N = ( 1 J # J )
    Figure DE102019202456A1_0006
  • In einer Ausführung wird eine Admittanz-Sollbewegung, in einer Weiterbildung im Gelenkkoordinatenraum des Roboters und/oder mithilfe einer Admittanz-Regelung, auf Basis der extern auf den Roboter ausgeübten, insbesondere also in den Gelenkkoordinatenraum transformierten, Kraft Text und/oder der vorgegebenen virtuellen Masse M, Steifigkeit K und/oder Dämpfung D ermittelt, in einer Ausführung gemäß q ˙ a = M 1 ( T e x t D q ˙ a K q ˙ a )
    Figure DE102019202456A1_0007
    bzw., insbesondere durch Integration oder in einem Regelkreis, gemäß q ˙ a = q ˙ a ( q ¨ a ) ;  insbesondere  q ˙ a = t q ¨ a d t
    Figure DE102019202456A1_0008
    und diese ermittelte Admittanz-Sollbewegung in den Nullraum projiziert, in einer Ausführung durch Linksmultiplikation des Nullraumoperators N gemäß Gl. (4).
  • Dabei kann in einer Ausführung K und/oder D gleich oder ungleich Null sein bzw. die entsprechenden Terme entfallen und/oder M die Einheitsmatrix oder von dieser und Null verschieden sein.
  • Eine solche Admittanz-Sollbewegung vermittelt eine Bewegung, die ein virtuelles Masse-, Feder- und/oder Dämpfer-System, insbesondere ein virtuelles Masse-Dämpfer-System (q̈a = M-1 · (Text - D· q̇a)) bzw. eine virtuelle Masse (q̈a = M-1 · Text), infolge der externen Kraft Text ausführen würde. Hierdurch kann in einer Ausführung ein vorteilhaftes Verhalten des Roboters bei der Handführung realisiert werden.
  • Die extern auf den Roboter ausgeübte Kraft wird in einer Ausführung im Gelenkkoordinatenraum und/oder auf Basis von Kräften in Gelenken des Roboters und/oder einem, insbesondere mathematischen bzw. numerischen, Modell des Roboters ermittelt, in einer Ausführung indem Kräfte in Gelenken des Roboters ermittelt, insbesondere mithilfe von Sensoren, insbesondere Kraft-Sensoren, gemessen oder, insbesondere mithilfe von Sekundärencodern, erfassten Strömen in Gelenkantrieben oder dergleichen, abgeschätzt werden, und in einer Ausführung von diesen Kräften diejenigen, in einer Ausführung modellbasiert und/oder auf Basis von Stellungen und/oder Bewegungen des Roboters ermittelten, internen Kräfte abgezogen werden, die aus der Dynamik, insbesondere dem Gewicht und der Bewegungen des Roboters, resultieren, in einer Ausführung gemäß T e x t = T i ( M m q ¨ i + h ( q , q ˙ i ) )
    Figure DE102019202456A1_0009
    mit den ermittelten Kräften Ti in den Gelenken, den aktuellen Gelenkkoordinaten qi bzw. deren Zeitableitungen, sowie der Massenmatrix Mm und dem Vektor h der verallgemeinerten Kräfte, insbesondere gyroskopischen, Gravitations- und/oder Reibungskräfte, des Roboters bzw. seines Modells. Wie bereits erwähnt, werden auch Drehmomente vorliegend verallgemeinernd als Kräfte bezeichnet. Allgemein wird die extern auf den Roboter ausgeübte Kraft in einer Ausführung auf Basis von mittels Sensoren ermittelten Kräften in Gelenken des Roboters ermittelt.
  • Hierdurch kann in einer Ausführung die extern auf den Roboter ausgeübte Kraft besonders vorteilhaft, insbesondere präzise(r), ermittelt und dadurch die Handführung verbessert werden.
  • In einer Ausführung ist bzw. wird die Aufgabe im (kartesischen) Arbeitsraum des Roboters vorgegeben.
  • Zusätzlich oder alternativ umfasst in einer Ausführung die Aufgabe eine oder mehrere Posen einer roboterfesten Referenz und/oder eine oder mehrere Änderungen einer Pose einer roboterfesten Referenz, in einer Ausführung eine vorgegebene Bewegung und/oder ein vorgegebenes Halten einer Pose der roboterfesten Referenz.
  • In einer Ausführung weist eine Pose eine ein-, zwei- oder dreidimensionale Position und/oder eine ein-, zwei- oder dreidimensionale Orientierung auf, kann insbesondere (durch) eine solche (definiert) sein bzw. eine solche bestimmen.
  • Hierdurch können Aufgaben vorteilhaft vorgegeben bzw. durchgeführt werden.
  • In einer Ausführung ist die roboterfeste Referenz auf einem robotergeführten Werkzeug, in einer Weiterbildung zwischen einer Werkzeugspitze und einem Roboterendflansch, an dem das Werkzeug mit dem Roboter verbunden ist, angeordnet.
  • So kann in einer Ausführung ein Roboter handgeführt bewegt und dabei ein Fixpunkt, insbesondere Trokarpunkt, eines robotergeführten, insbesondere medizinischen, Werkzeugs mit hoher Präzision beibehalten werden.
  • In einer Ausführung ist die roboterfeste Referenz der „Tool Center Point“ (TCP) des Roboters.
  • Hierdurch kann dieser in einer Ausführung mit hoher Präzision positioniert werden.
  • Zusätzlich oder alternativ wird in einer Ausführung eine Aufgaben-Sollbewegung, insbesondere im Gelenkkoordinatenraum des Roboters, auf Basis der vorgegebenen Aufgabe, insbesondere ihrer Jacobimatrix, insbesondere deren generalisierten bzw. Pseudoinversen, ermittelt, in einer Ausführung gemäß q ˙ t a s k = J # x ˙ d
    Figure DE102019202456A1_0010
  • In einer Ausführung wird der Roboter mithilfe einer Geschwindigkeits- und/oder Positionsregelung auf Basis der Aufgaben-Sollbewegung und/oder der in den Nullraum projizierten Admittanz-Sollbewegung gesteuert, insbesondere auf Basis einer Soll-Geschwindigkeit gemäß q ˙ d = J # X ˙ d q ˙ t a s k + N q ˙ a
    Figure DE102019202456A1_0011
    wobei diese Soll-Geschwindigkeit in einer Ausführung zu einer Soll-Stellung integriert werden kann. In einer Ausführung werden somit Gelenke bzw. Antriebe des Roboters auf Basis der Aufgaben-Sollbewegung und/oder der in den Nullraum projizierten Admittanz-Sollbewegung aktuiert bzw. kommandiert.
  • Die vorliegende Erfindung kann mit besonderem Vorteil in der Medizinrobotik eingesetzt werden. Entsprechend führt der Roboter in einer Ausführung ein medizinisches, in einer Ausführung mikroinvasives oder nicht chirurgisch( verwendetes Werkzeug. Gleichermaßen kann die vorliegende Erfindung mit besonderem Vorteil in der Telemanipulation eingesetzt bzw. der Roboter als Telemanipulator verwendet werden.
  • Nach einer Ausführung der vorliegenden Erfindung ist ein System zum Betreiben des Roboters, insbesondere hard- und/oder software-, insbesondere programmtechnisch, zur Durchführung eines hier beschriebenen Verfahrens eingerichtet und/oder weist Mittel zum Durchführen der Aufgabe und Durchführen einer von einer extern auf den Roboter ausgeübten Kraft und einer vorgegebenen virtuellen Masse, Steifigkeit und/oder Dämpfung abhängigen Admittanz-Bewegung im Nullraum beim Durchführen der Aufgabe auf.
  • In einer Ausführung weist das System bzw. sein(e) Mittel auf:
    • - Mittel zum Ermitteln der extern auf den Roboter ausgeübten Kraft auf Basis von Kräften in Gelenken des Roboters und/oder einem Modell des Roboters; und/oder
    • - Mittel zum Ermitteln einer Aufgaben-Sollbewegung, insbesondere im Gelenkkoordinatenraum des Roboters, auf Basis der vorgegebenen Aufgabe, insbesondere ihrer Jacobimatrix; und/oder
    • - Mittel zum Ermitteln einer Admittanz-Sollbewegung, insbesondere im Gelenkkoordinatenraum des Roboters und/oder mithilfe einer Admittanz Regelung, auf Basis der extern auf den Roboter ausgeübten Kraft und/oder vorgegebenen virtuellen Masse, Steifigkeit und/oder Dämpfung und zum Projizieren dieser ermittelte Admittanz-Sollbewegung in den Nullraum; und/oder
    • - eine Geschwindigkeits- und/oder Positionsregelung auf Basis der Aufgaben-Sollbewegung und/oder der in den Nullraum projizierten Admittanz-Sollbewegung.
  • Ein Mittel im Sinne der vorliegenden Erfindung kann hard- und/oder softwaretechnisch ausgebildet sein, insbesondere eine, vorzugsweise mit einem Speicher- und/oder Bussystem daten- bzw. signalverbundene, insbesondere digitale, Verarbeitungs-, insbesondere Mikroprozessoreinheit (CPU), Graphikkarte (GPU) oder dergleichen, und/oder ein oder mehrere Programme oder Programmmodule aufweisen. Die Verarbeitungseinheit kann dazu ausgebildet sein, Befehle, die als ein in einem Speichersystem abgelegtes Programm implementiert sind, abzuarbeiten, Eingangssignale von einem Datenbus zu erfassen und/oder Ausgangssignale an einen Datenbus abzugeben. Ein Speichersystem kann ein oder mehrere, insbesondere verschiedene, Speichermedien, insbesondere optische, magnetische, Festkörper- und/oder andere nicht-flüchtige Medien aufweisen. Das Programm kann derart beschaffen sein, dass es die hier beschriebenen Verfahren verkörpert bzw. auszuführen imstande ist, sodass die Verarbeitungseinheit die Schritte solcher Verfahren ausführen kann und damit insbesondere den Roboter betreiben bzw. steuern kann. Zur kompakteren Darstellung wird vorliegend auch ein Regeln verallgemeinernd als Steuern bezeichnet. Ein Computerprogrammprodukt kann in einer Ausführung ein, insbesondere nicht-flüchtiges, Speichermedium zum Speichern eines Programms bzw. mit einem darauf gespeicherten Programm aufweisen, insbesondere sein, wobei ein Ausführen dieses Programms ein System bzw. eine Steuerung, insbesondere einen Computer, dazu veranlasst, ein hier beschriebenes Verfahren bzw. einen oder mehrere seiner Schritte auszuführen.
  • In einer Ausführung werden ein oder mehrere, insbesondere alle, Schritte des Verfahrens vollständig oder teilweise automatisiert durchgeführt, insbesondere durch das System bzw. sein(e) Mittel.
  • In einer Ausführung weist das System den Roboter und/oder dessen Steuerung auf.
  • Zeitableitungen können in einer Ausführung durch entsprechende Differenzen implementiert sein, also beispielsweise die Aufgabe ẋd durch ein differentielles Kommando Δxd, die Soll-Geschwindigkeit q̇d durch ein differentielles Kommando Δqd etc..
  • Weitere Vorteile und Merkmale ergeben sich aus den Unteransprüchen und den Ausführungsbeispielen. Hierzu zeigt, teilweise schematisiert:
    • 1: ein System zum Betreiben eines Roboters bzw. Durchführen einer vorgegebenen Aufgabe durch den Roboter nach einer Ausführung der vorliegenden Erfindung; und
    • 2: ein Verfahren zum Durchführen der Aufgabe durch den Roboter nach einer Ausführung der vorliegenden Erfindung.
  • 1 zeigt ein System mit einer Steuerung 2 zum Betreiben bzw. Steuern eines siebenachsigen Roboters 10 bzw. Durchführen einer vorgegebenen Aufgabe durch den Roboter 10 nach einer Ausführung der vorliegenden Erfindung, 2 ein Verfahren zum Durchführen der Aufgabe durch den Roboter nach einer Ausführung der vorliegenden Erfindung.
  • Der Roboter 10 führt ein Werkzeug 12, das am Roboterendflansch 11 befestigt ist und eine distale Werkzeugspitze 13 aufweist.
  • Eine vorgegebene Aufgabe besteht beispielsweise darin, die dreidimensionale kartesische Position des werkzeugfesten Punktes X konstant zu halten. Eine andere vorgegebene Aufgabe kann beispielsweise eine vorgegebene TCP-Pose oder TCP-Bahn sein.
  • In einem ersten Schritt S10 ermittelt die Steuerung 2 Kräfte, insbesondere Drehmomente Ti um die (Dreh)Achsen, in den Gelenken des Roboters, beispielsweise mittels Kraft-, insbesondere Drehmoment-Sensoren in den Gelenken (nicht dargestellt).
  • In einem zweiten Schritt S20 ermittelt die Steuerung 2 hieraus eine extern auf den Roboter ausgeübte Kraft Text, beispielsweise gemäß Gl. (6) oder auf andere Weise.
  • In einem dritten Schritt S30 ermittelt die Steuerung 2 auf Basis dieser extern auf den Roboter ausgeübten Kraft Text und einer vorgegebenen virtuellen Masse Mund Dämpfung D mithilfe einer Admittanz-Regelung eine Admittanz-Sollbewegung q̇a bzw. q̈a, beispielsweise gemäß Gl. (5), (5') mit K = 0 oder auf andere Weise.
  • In einem vierten Schritt S40 projiziert die Steuerung 2 diese Admittanz-Sollbewegung in den Nullraum der Aufgabe, addiert eine Aufgaben-Sollbewegung, die sie auf Basis der generalisierten bzw. Pseudoinversen der Jacobimatrix der vorgegebenen Aufgabe, beispielsweise gemäß Gl. (7) oder auf andere Weise, ermittelt, und führt die resultierende bzw. gemäß Gl. (8) ermittelte Soll-Bewegung q̇d, gegebenenfalls nach Integration zu einer Soll-Stellung qd im Gelenkkoordinatenraum, einer Geschwindigkeits- bzw. Positionsregelung zu, die entsprechende Gelenkwinkel kommandiert bzw. Antriebe des Roboters 10 (nicht dargestellt) entsprechend (an)steuert.
  • Dadurch führt der Roboter 10 beim Durchführen der Aufgabe im Nullraum eine von der extern auf ihn ausgeübten Kraft und der vorgegebenen virtuellen Masse und Dämpfung abhängige Admittanz-Bewegung q̇a durch.
  • Obwohl in der vorhergehenden Beschreibung exemplarische Ausführungen erläutert wurden, sei darauf hingewiesen, dass eine Vielzahl von Abwandlungen möglich ist. Außerdem sei darauf hingewiesen, dass es sich bei den exemplarischen Ausführungen lediglich um Beispiele handelt, die den Schutzbereich, die Anwendungen und den Aufbau in keiner Weise einschränken sollen. Vielmehr wird dem Fachmann durch die vorausgehende Beschreibung ein Leitfaden für die Umsetzung von mindestens einer exemplarischen Ausführung gegeben, wobei diverse Änderungen, insbesondere in Hinblick auf die Funktion und Anordnung der beschriebenen Bestandteile, vorgenommen werden können, ohne den Schutzbereich zu verlassen, wie er sich aus den Ansprüchen und diesen äquivalenten Merkmalskombinationen ergibt.
  • Bezugszeichenliste
  • 10
    Roboter
    11
    Roboterendflansch
    12
    robotergeführtes Werkzeug
    13
    Werkzeugspitze
    2
    Steuerung
    q1,... q7 = q
    Gelenkkoordinaten/-winkel
    X
    roboterfeste Referenz

Claims (9)

  1. Verfahren zum Durchführen einer vorgegebenen Aufgabe durch einen Roboter (10), der bezüglich dieser Aufgabe redundant ist, wobei beim Durchführen der Aufgabe eine von einer extern auf den Roboter ausgeübten Kraft und einer vorgegebenen virtuellen Masse, Steifigkeit und/oder Dämpfung abhängige Admittanz-Bewegung im Nullraum durchgeführt wird.
  2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass die extern auf den Roboter ausgeübte Kraft auf Basis von Kräften in Gelenken des Roboters und/oder einem Modell des Roboters ermittelt wird.
  3. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die Aufgabe im Arbeitsraum des Roboters vorgegeben ist und/oder wenigstens eine Pose und/oder Posenänderung einer roboterfesten Referenz (X) umfasst.
  4. Verfahren nach dem vorhergehenden Anspruch, dadurch gekennzeichnet, dass die roboterfeste Referenz (X) auf einem robotergeführten Werkzeug (12), insbesondere zwischen einer Werkzeugspitze (13) und einem Roboterendflansch (11), angeordnet oder der TCP des Roboters ist und/oder eine Aufgaben-Sollbewegung, insbesondere im Gelenkkoordinatenraum des Roboters, auf Basis der vorgegebenen Aufgabe, insbesondere ihrer Jacobimatrix, ermittelt wird.
  5. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass eine Admittanz-Sollbewegung, insbesondere im Gelenkkoordinatenraum des Roboters und/oder mithilfe einer Admittanz-Regelung, auf Basis der extern auf den Roboter ausgeübten Kraft und/oder vorgegebenen virtuellen Masse, Steifigkeit und/oder Dämpfung ermittelt und diese ermittelte Admittanz-Sollbewegung in den Nullraum projiziert wird.
  6. Verfahren nach wenigstens einem der beiden vorhergehenden Ansprüche, gekennzeichnet durch eine Geschwindigkeits- und/oder Positionsregelung auf Basis der Aufgaben-Sollbewegung und/oder der in den Nullraum projizierten Admittanz-Sollbewegung.
  7. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass der Roboter ein medizinisches Werkzeug (12) führt.
  8. System (2) zum Betreiben eines Roboters (10), das zur Durchführung eines Verfahrens nach einem der vorhergehenden Ansprüche eingerichtet ist und/oder Mittel zum Durchführen einer von einer extern auf den Roboter ausgeübten Kraft und einer vorgegebenen virtuellen Masse, Steifigkeit und/oder Dämpfung abhängigen Admittanz-Bewegung im Nullraum beim Durchführen der Aufgabe aufweist.
  9. Computerprogrammprodukt mit einem Programmcode, der auf einem von einem Computer lesbaren Medium gespeichert ist, zur Durchführung eines Verfahrens nach einem der vorhergehenden Ansprüche.
DE102019202456.4A 2019-02-22 2019-02-22 Verfahren und System zum Durchführen einer vorgegebenen Aufgabe durch einen Roboter Pending DE102019202456A1 (de)

Priority Applications (6)

Application Number Priority Date Filing Date Title
DE102019202456.4A DE102019202456A1 (de) 2019-02-22 2019-02-22 Verfahren und System zum Durchführen einer vorgegebenen Aufgabe durch einen Roboter
PCT/EP2020/051708 WO2020169302A1 (de) 2019-02-22 2020-01-24 Verfahren und system zum durchführen einer vorgegebenen aufgabe durch einen roboter
KR1020217029895A KR20210127746A (ko) 2019-02-22 2020-01-24 미리 정해져 있는 과제를 로봇을 통해 수행하기 위한 방법 및 시스템
CN202080015794.2A CN113474130A (zh) 2019-02-22 2020-01-24 利用机器人执行预先设定的任务的方法和系统
EP20702254.2A EP3927498A1 (de) 2019-02-22 2020-01-24 Verfahren und system zum durchführen einer vorgegebenen aufgabe durch einen roboter
US17/431,593 US20220111520A1 (en) 2019-02-22 2020-01-24 Method and system for performing a predetermined task using a robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
DE102019202456.4A DE102019202456A1 (de) 2019-02-22 2019-02-22 Verfahren und System zum Durchführen einer vorgegebenen Aufgabe durch einen Roboter

Publications (1)

Publication Number Publication Date
DE102019202456A1 true DE102019202456A1 (de) 2020-08-27

Family

ID=69326512

Family Applications (1)

Application Number Title Priority Date Filing Date
DE102019202456.4A Pending DE102019202456A1 (de) 2019-02-22 2019-02-22 Verfahren und System zum Durchführen einer vorgegebenen Aufgabe durch einen Roboter

Country Status (6)

Country Link
US (1) US20220111520A1 (de)
EP (1) EP3927498A1 (de)
KR (1) KR20210127746A (de)
CN (1) CN113474130A (de)
DE (1) DE102019202456A1 (de)
WO (1) WO2020169302A1 (de)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113954074A (zh) * 2021-11-09 2022-01-21 西北工业大学 一种面向刚度的机器人加工位姿优化方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102009007181A1 (de) * 2009-02-03 2010-08-05 Kuka Roboter Gmbh Verfahren zum Abfahren einer vorgegebenen Bahn durch einen Manipulator, sowie Steuervorrichtung zur Durchführung eines solchen Verfahrens
DE102013010290A1 (de) * 2013-06-19 2014-12-24 Kuka Laboratories Gmbh Überwachen eines kinematisch redundanten Roboters
DE102011083347B4 (de) * 2011-09-23 2015-08-20 Deutsches Zentrum für Luft- und Raumfahrt e.V. Verfahren zur Steuerung eines redundanten Robotersystems
DE102014222809B3 (de) * 2014-11-07 2016-01-14 Kuka Roboter Gmbh Event-basierte Redundanzwinkelkonfiguartion für Gelenkarmroboter
DE102015210218A1 (de) * 2015-06-02 2016-12-08 Kuka Roboter Gmbh Verfahren zum Betreiben eines Roboters, zugehöriger Roboter mit einer Vibrationsvorrichtung und Roboterarbeitsplatz
DE102017004711A1 (de) * 2017-05-16 2018-11-22 Kuka Deutschland Gmbh Robotersteuerung

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102005054575B3 (de) * 2005-11-16 2007-04-26 Deutsches Zentrum für Luft- und Raumfahrt e.V. Verfahren zur Regelung eines Roboterarms sowie Roboter zur Durchführung des Verfahrens
JP2013054629A (ja) * 2011-09-06 2013-03-21 Honda Motor Co Ltd 制御装置及び方法
CN104781050B (zh) * 2012-09-17 2017-05-24 睿信科机器人有限公司 约束冗余机械手的方法和具有冗余机械手的机器人
DE102014226936B3 (de) * 2014-11-14 2016-03-17 Deutsches Zentrum für Luft- und Raumfahrt e.V. Ganzkörperimpedanz für mobile Roboter
DE102015009151A1 (de) * 2015-07-14 2017-01-19 Kuka Roboter Gmbh Ermitteln eines Eingabebefehls für einen Roboter, der durch manuelles Ausüben einer Kraft auf den Roboter eingegeben wird

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102009007181A1 (de) * 2009-02-03 2010-08-05 Kuka Roboter Gmbh Verfahren zum Abfahren einer vorgegebenen Bahn durch einen Manipulator, sowie Steuervorrichtung zur Durchführung eines solchen Verfahrens
DE102011083347B4 (de) * 2011-09-23 2015-08-20 Deutsches Zentrum für Luft- und Raumfahrt e.V. Verfahren zur Steuerung eines redundanten Robotersystems
DE102013010290A1 (de) * 2013-06-19 2014-12-24 Kuka Laboratories Gmbh Überwachen eines kinematisch redundanten Roboters
DE102014222809B3 (de) * 2014-11-07 2016-01-14 Kuka Roboter Gmbh Event-basierte Redundanzwinkelkonfiguartion für Gelenkarmroboter
DE102015210218A1 (de) * 2015-06-02 2016-12-08 Kuka Roboter Gmbh Verfahren zum Betreiben eines Roboters, zugehöriger Roboter mit einer Vibrationsvorrichtung und Roboterarbeitsplatz
DE102017004711A1 (de) * 2017-05-16 2018-11-22 Kuka Deutschland Gmbh Robotersteuerung

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113954074A (zh) * 2021-11-09 2022-01-21 西北工业大学 一种面向刚度的机器人加工位姿优化方法
CN113954074B (zh) * 2021-11-09 2022-12-27 西北工业大学 一种面向刚度的机器人加工位姿优化方法

Also Published As

Publication number Publication date
EP3927498A1 (de) 2021-12-29
WO2020169302A1 (de) 2020-08-27
KR20210127746A (ko) 2021-10-22
US20220111520A1 (en) 2022-04-14
CN113474130A (zh) 2021-10-01

Similar Documents

Publication Publication Date Title
EP3323026B1 (de) Ermitteln eines eingabebefehls für einen roboter, der durch manuelles ausüben einer kraft auf den roboter eingegeben wird
EP3109012B1 (de) Umschalten einer steuerung eines roboters in einen handführ-betriebsmodus
EP2815855B1 (de) Überwachen eines kinematisch redundanten Roboters
WO2017129352A1 (de) Verfahren und system zur bahnplanung eines redundanten roboters
DE102017004711B4 (de) Robotersteuerung
DE102017001131B4 (de) Verfahren und System zum Betreiben eines Roboters
DE102018210864B3 (de) Verfahren und System zum Regeln eines Roboters
DE102018214257B3 (de) Roboterregelung
DE102018200864B3 (de) Verfahren und System zum Steuern eines Roboters
DE102017007359B4 (de) Verfahren und System zum Überprüfen und/oder Modifizieren eines Arbeitsprozesses eines Roboters
DE102019202456A1 (de) Verfahren und System zum Durchführen einer vorgegebenen Aufgabe durch einen Roboter
EP4084937B1 (de) Bewegen einer roboterfesten referenz
DE102019219930B3 (de) Verfahren und System zum Steuern eines Roboters
DE102020209866B3 (de) Verfahren und System zum Betreiben eines Roboters
DE102018207919B3 (de) Robotersteuerung
DE102018207921B3 (de) Steuern eines Roboters
DE102017010244A1 (de) Verfahren und Steuermittel zum Steuern einer Roboteranordnung
DE102020215904B3 (de) Verfahren und System zum Betreiben eines Roboters
EP3810377B1 (de) Verfahren und system zum überführen eines endeffektors eines roboters zwischen einer endeffektorpose und einer weiteren endeffektorpose
DE102022200943B3 (de) Steuern eines Teleroboters
DE102021204494A1 (de) Verfahren und System zum Steuern eines Teleroboters
DE102021111569A1 (de) Verfahren und System zum Steuern eines Teleroboters
WO2019219795A1 (de) Steuern eines roboters
DE102018208088A1 (de) Verfahren und Steuerung zum Steuern eines Roboters
DE102021201024B3 (de) Verfahren und System zum Betreiben eines Roboters

Legal Events

Date Code Title Description
R012 Request for examination validly filed