DE102019122415A1 - Roboter und Robotersystem - Google Patents

Roboter und Robotersystem Download PDF

Info

Publication number
DE102019122415A1
DE102019122415A1 DE102019122415.2A DE102019122415A DE102019122415A1 DE 102019122415 A1 DE102019122415 A1 DE 102019122415A1 DE 102019122415 A DE102019122415 A DE 102019122415A DE 102019122415 A1 DE102019122415 A1 DE 102019122415A1
Authority
DE
Germany
Prior art keywords
joints
robot
torque
wrist
basic
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
DE102019122415.2A
Other languages
English (en)
Inventor
Kazutaka Nakayama
Kenichiro Oguri
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.)
Fanuc Corp
Original Assignee
Fanuc Corp
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 Fanuc Corp filed Critical Fanuc Corp
Publication of DE102019122415A1 publication Critical patent/DE102019122415A1/de
Pending legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J17/00Joints
    • B25J17/02Wrist joints
    • B25J17/0283Three-dimensional joints
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1612Programme controls characterised by the hand, wrist, grip control
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/42Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
    • G05B19/427Teaching successive positions by tracking the position of a joystick or handle to control the positioning servo of the tool head, master-slave control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • 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/0081Programme-controlled manipulators with master teach-in means
    • 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/1641Programme controls characterised by the control loop compensation for backlash, friction, compliance, elasticity in the joints
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1694Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01LMEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L3/00Measuring torque, work, mechanical power, or mechanical efficiency, in general
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01RMEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
    • G01R31/00Arrangements for testing electric properties; Arrangements for locating electric faults; Arrangements for electrical testing characterised by what is being tested not provided for elsewhere
    • G01R31/34Testing dynamo-electric machines
    • 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/37Measurements
    • G05B2219/37319Derive acceleration, force, torque from current
    • 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/40599Force, torque sensor integrated in joint

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Health & Medical Sciences (AREA)
  • General Health & Medical Sciences (AREA)
  • Orthopedic Medicine & Surgery (AREA)
  • Human Computer Interaction (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

Eine Kostenreduktion wird erzielt, während die Sicherheit eines Bedieners gewährleistet ist. Ein Roboter 100 umfasst: eine Handgelenkeinheit 60, umfassend eine Vielzahl von Handgelenkgelenken 5, 6 und 7; und eine Vielzahl von Grundgelenken 1, 2, 3 und 4, die eingerichtet sind, die Position der Handgelenkeinheit 60 in einem dreidimensionalen Raum zu bestimmen. Nur die Grundgelenke 1, 2, 3 und 4 sind mit Drehmomentsensoren S1, S2 und S3 versehen, die eingerichtet sind, ein Drehmoment der Grundgelenke 1, 2, 3 und 4 um Achsenlinien J1, J2 und J3 zu detektieren.

Description

  • GEBIET DER ERFINDUNG
  • Die vorliegende Erfindung betrifft einen Roboter und ein Robotersystem.
  • ALLGEMEINER STAND DER TECHNIK
  • Ein herkömmlich bekannter Roboter umfasst einen Servomotor mit hoher Antriebsleistung zum Antreiben jeweils einer ersten Welle bis dritten Welle und einen Servomotor mit niedriger Antriebsleistung zum Antreiben jeweils einer vierten Welle bis sechsten Welle (siehe beispielsweise Patentliteratur 1). Ein bekanntes menschlich kooperatives Robotersystem führt direktes Lehren aus, bei dem die Bewegung eines Arms zulässig ist, wenn ein Bediener den Arm direkt berührt und bewegt (siehe beispielsweise Patentliteratur 2).
  • ENTGEGENHALTUNGSLISTE
  • PATENTLITERATUR
    • Patentliteratur 1 Japanische nicht geprüfte Patentanmeldung, Veröffentlichung Nummer Hei 11-77571
    • Patentliteratur 2 Japanische nicht geprüfte Patentanmeldung, Veröffentlichung Nummer 2018-111174
  • KURZDARSTELLUNG DER ERFINDUNG
  • TECHNISCHE AUFGABE
  • Der in Patentliteratur 2 offenbarte Kooperationsroboter, der eine Kooperationsaufgabe zusammen mit dem Bediener ausführt, umfasst an jeder Welle einen hochsensiblen Drehmomentsensor zum Detektieren des Kontakts mit dem Bediener, um die Sicherheit des Bedieners zu gewährleisten. Wenn der Drehmomentsensor an jeder Welle vorgesehen ist, wird der Roboter teuer, da der hochsensible Drehmomentsensor teuer ist.
  • Die vorliegende Erfindung soll einen Roboter und ein Robotersystem bereitstellen, die in der Lage sind, eine Kostenreduzierung zu erzielen, während die Sicherheit eines Bedieners gewährleistet ist.
  • LÖSUNG DER AUFGABE
  • Um die zuvor beschriebene Aufgabe zu erfüllen, sieht die vorliegende Erfindung die nachfolgend beschriebene Lösung vor.
    Ein Aspekt der vorliegenden Erfindung sieht einen Roboter vor, umfassend: eine Handgelenkeinheit, umfassend eine Vielzahl von Handgelenkgelenken; und eine Vielzahl von Grundgelenken, die eingerichtet sind, die Position der Handgelenkeinheit in einem dreidimensionalen Raum zu bestimmen. Nur die Grundgelenke sind mit Drehmomentsensoren versehen, die eingerichtet sind, ein Drehmoment der Grundgelenke um Achsenlinien zu detektieren.
  • Gemäß dem vorliegenden Aspekt wird die Position der Handgelenkeinheit in dem dreidimensionalen Raum bestimmt, indem die Vielzahl von Grundgelenken betrieben wird, und die Lage eines Werkzeugs, das an einer Spitze der Handgelenkeinheit befestigt ist, wird bestimmt, indem die Vielzahl von Handgelenkgelenken betrieben wird, die in der Handgelenkeinheit umfasst sind. Wenn ein Bediener in Kontakt mit einer optionalen Position des Roboters kommt, wird das Drehmoment jedes Grundgelenks um die Achsenlinie von einem beliebigen der Drehmomentsensoren detektiert, die jeweils an der Vielzahl von Grundgelenken vorgesehen sind. Entsprechend kann, wenn kein Drehmoment der Handgelenkgelenke um die Achsenlinien detektiert wird, der Kontakt zwischen dem Bediener und dem Roboter hoch empfindlich detektiert werden. Zusätzlich kann eine Kostenreduktion erzielt werden, indem keine Drehmomentsensoren an den Handgelenkgelenken vorgesehen werden.
  • Der zuvor beschriebene Aspekt kann ferner umfassen: einen Motor, der eingerichtet ist, jedes Handgelenkgelenk anzutreiben; eine aktuelle Detektionseinheit, die eingerichtet ist, Strom zu detektieren, der jedem Motor zugeführt wird; und eine Drehmomentschätzeinheit, die eingerichtet ist, das Drehmoment jedes Handgelenkgelenks um die Achsenlinie basierend auf dem detektierten Strom zu schätzen.
  • Mit dieser Ausgestaltung wird, wenn kein Drehmomentsensor an jedem Handgelenkgelenk angeordnet ist, das Drehmoment des Handgelenkgelenks um die Achsenlinie von der Drehmomentschätzeinheit basierend auf dem Strom an den Motor geschätzt, der eingerichtet ist, das Handgelenkgelenk anzutreiben. Entsprechend kann eine Kostenreduktion erzielt werden, indem keine Drehmomentsensoren, die teuer sind, an den Handgelenkgelenken installiert werden, und die Sicherheit des Bedieners kann gewährleistet werden, indem der Kontakt des Bedieners mit einem Werkzeug, das an der Handgelenkeinheit befestigt ist, detektiert wird.
  • Der zuvor beschriebene Aspekt kann ferner eine Steuereinheit umfassen, die eingerichtet ist, jedes Grundgelenk in einer Richtung zu betreiben, die identisch mit der Richtung des detektierten Drehmoments ist, wenn ein Drehmoment, das um die Achsenlinie jedes Grundgelenks von einer externen Kraft erzeugt wird, von jedem Drehmomentsensor detektiert wird.
  • Mit dieser Ausgestaltung wird, wenn die externe Kraft auf die Handgelenkeinheit oder das Werkzeug aufgebracht wird, jedes Grundgelenk von der Steuereinheit in einer Richtung angetrieben, die identisch mit der Richtung der externen Kraft ist, und somit kann das Handgelenk einfach in einer gewünschten Richtung in dem dreidimensionalen Raum bewegt werden. Gleichzeitig wird die Handgelenkeinheit nicht gesteuert, in der Richtung der externen Kraft zu arbeiten, und somit kann die Lage des Werkzeugs nach Aufnahme der externen Kraft aufrechterhalten werden.
  • Der zuvor beschriebene Aspekt kann die drei Grundgelenke umfassen, und jedes Grundgelenk kann mit dem Drehmomentsensor versehen sein.
    Mit dieser Ausgestaltung kann die dreidimensionale Position der Handgelenkeinheit optional durch Betätigung der drei Grundgelenke bestimmt werden. Außerdem kann das dreidimensionale Drehmoment von dem Drehmomentsensor detektiert werden, der an jedem Grundgelenk vorgesehen ist.
  • Der zuvor beschriebene Aspekt kann die vier Grundgelenke umfassen, und jedes Grundgelenk kann mit dem Drehmomentsensor versehen sein.
    Mit dieser Ausgestaltung kann eines der vier Grundgelenke als eine redundante Achse fungieren, und eine Grundwelle, umfassend die Vielzahl von Grundgelenken, kann in eine Vielzahl von Zuständen geändert werden, während die Handgelenkeinheit an einer optionalen Position in dem dreidimensionalen Raum fixiert ist. Wenn der Bediener in Kontakt mit einer optionalen Position des Roboters kommt, wird das Drehmoment jedes Grundgelenks um die Achsenlinie von einem beliebigen der Drehmomentsensoren detektiert, die jeweils an den vier Grundgelenken vorgesehen sind. Entsprechend kann, wenn kein Drehmoment der Handgelenkgelenke um die Achsenlinien detektiert wird, der Kontakt zwischen dem Bediener und dem Roboter hoch empfindlich detektiert werden. Zusätzlich kann eine Kostenreduktion erzielt werden, indem keine Drehmomentsensoren an den Handgelenkgelenken vorgesehen werden.
  • Der zuvor beschriebene Aspekt kann die vier Grundgelenke umfassen, und drei der Grundgelenke, ausgenommen eines der Grundgelenke als eine redundante Achse, können jeweils mit dem Drehmomentsensor vorgesehen sein.
    Mit dieser Ausgestaltung kann eines der vier Grundgelenke als eine redundante Achse fungieren, und eine Grundwelle, umfassend die Vielzahl von Grundgelenken, kann in eine Vielzahl von Zuständen geändert werden, während die Handgelenkeinheit an einer optionalen Position in dem dreidimensionalen Raum fixiert ist. Wenn der Bediener in Kontakt mit einer optionalen Position des Roboters kommt, wird das Drehmoment jedes Grundgelenks um die Achsenlinie von einem beliebigen der Drehmomentsensoren detektiert, die jeweils an den drei Grundgelenken, ausgenommen der redundanten Achse, vorgesehen sind. Entsprechend kann, wenn kein Drehmoment der Handgelenkgelenke um die Achsenlinien detektiert wird, der Kontakt zwischen dem Bediener und dem Roboter hoch empfindlich detektiert werden. Zusätzlich kann eine Kostenreduktion erzielt werden, indem keine Drehmomentsensoren an den Handgelenkgelenken und ein Grundgelenk als die redundante Achse vorgesehen werden.
  • Gemäß dem zuvor beschriebenen Aspekt können die Drehmomentsensoren, die an den Grundgelenken vorgesehen sind, identisch miteinander sein.
    Mit dieser Ausgestaltung kann eine Kostenreduktion durch die Reduktion der Anzahl von Bauteilarten erzielt werden.
  • Gemäß dem zuvor beschriebenen Aspekt kann die Handgelenkeinheit eine Quetschschutzstruktur aufweisen.
    Diese Ausgestaltung kann verhindern, dass der Bediener von der Handgelenkseinheit gequetscht wird, an der kein Drehmomentsensor angeordnet ist, wodurch die Sicherheit des Bedieners verbessert wird.
  • Ein anderer Aspekt der vorliegenden Erfindung sieht ein Robotersystem, umfassend den zuvor beschriebenen Roboter, und eine Steuerung vor, die eingerichtet ist, den Roboter zu steuern. Umrissforminformationen des Roboters werden in der Steuerung gespeichert. Die Steuerung beschränkt einen Bewegungsbereich mindestens eines der Grundgelenke und der Handgelenkgelenke, um zu verhindern, dass der Umriss des Roboters die Achsenlinie mindestens eines der Grundgelenke überlappt.
  • Ein anderer Aspekt der vorliegenden Erfindung sieht ein Robotersystem, umfassend den zuvor beschriebenen Roboter, und eine Steuerung vor, die eingerichtet ist, den Roboter zu steuern. Ein Mechanismus beschränkt einen Bewegungsbereich mindestens eines der Grundgelenke und der Handgelenkgelenke, um zu verhindern, dass der Umriss des Roboters die Achsenlinie mindestens eines der Grundgelenke überlappt.
  • Gemäß dem zuvor beschriebenen Aspekt kann ein Werkzeug an einer Spitze jedes Handgelenkgelenks befestigt sein, die Steuereinheit kann Umrissforminformationen des Werkzeugs speichern und die Steuereinheit kann einen Bewegungsbereich mindestens eines der Grundgelenke und der Handgelenkgelenke beschränken, um zu verhindern, dass der Umriss des Werkzeugs die Achsenlinie mindestens eines der Grundgelenke überlappt.
  • Die vorliegende Erfindung bietet eine Wirkung des Erzielens einer Kostenreduktion, während sie die Sicherheit eines Bedieners gewährleistet.
  • Figurenliste
    • 1 ist eine schematische Draufsicht eines Roboters gemäß einer Ausführungsform der vorliegenden Erfindung.
    • 2 ist eine schematische Seitenansicht eines Teils, bei dem eine Basis und ein Rotationszylinder miteinander in dem Roboter von 1 verbunden sind.
    • 3 ist ein Blockdiagramm der Drehmomentsteuerung eines Motors von einer Steuerung des Roboters von 1.
    • 4 ist eine schematische Draufsicht des Roboters von 1 gemäß einer Abwandlung.
    • 5 ist eine schematische Gesamtansicht eines Robotersystems, umfassend den Roboter von 1.
  • BESCHREIBUNG VON AUSFÜHRUNGSFORMEN
  • Nachfolgend wird ein Roboter 100 gemäß einer Ausführungsform der vorliegenden Erfindung mit Bezug auf die begleitenden Zeichnungen beschrieben.
    Der Roboter 100 gemäß der vorliegenden Ausführungsform ist ein vertikaler Gelenkroboter, umfassend sechs Gelenke, die um jeweilige Achsenlinien gedreht werden.
  • Wie in 1 veranschaulicht, umfasst der Roboter 100 eine Basis (Grundgelenk) 1, die an einer Installationsoberfläche fixiert ist, einen Rotationszylinder (Grundgelenk) 2, der an der Basis 1 drehbar um eine Welle (Achsenlinie) J1 gestützt ist, die sich in der vertikalen Richtung erstreckt, einen ersten Arm (Grundgelenk) 3, der an dem Rotationszylinder 2 drehbar um eine horizontale Welle (Achsenlinie) J2 orthogonal zu der Welle J1 gestützt ist, einen zweiten Arm (Grundgelenk) 4, der an dem ersten Arm 3 drehbar um eine Welle (Achsenlinie) J3 parallel zu der Welle J2 gestützt ist, ein erstes Handgelenkelement (Handgelenkgelenk) 5, das an dem zweiten Arm 4 drehbar um eine Welle (Achsenlinie) J4 verdreht in Bezug auf die Welle J3 gestützt ist, ein zweites Handgelenkelement (Handgelenkgelenk) 6, das an dem ersten Handgelenkelement 5 drehbar um eine Welle (Achsenlinie) J5 orthogonal zu der Welle J4 gestützt ist, und ein drittes Handgelenkelement (Handgelenkgelenk) 7, das an dem zweiten Handgelenkelement 6 drehbar um eine Welle (Achsenlinie) J6 orthogonal zu der Welle J5 gestützt ist. Nachfolgend wird die Basis 1 bis zum zweiten Arm 4 auch als eine Grundwelle 50 bezeichnet, und das erste Handgelenkelement 5 bis dritte Handgelenkelement 7 wird auch als eine Handgelenkeinheit 60 bezeichnet.
  • Der Roboter 100 umfasst auch einen ersten Drehmomentsensor (Drehmomentsensor) S1, der zwischen der Basis 1 und dem Rotationszylinder 2 angeordnet und eingerichtet ist, ein Drehmoment um die Welle J1 zu detektieren, einen zweiten Drehmomentsensor (Drehmomentsensor) S2, der zwischen dem Rotationszylinder 2 und dem ersten Arm 3 angeordnet und eingerichtet ist, ein Drehmoment um die Welle J2 zu detektieren, und einen dritten Drehmomentsensor (Drehmomentsensor) S3, der zwischen dem ersten Arm 3 und dem zweiten Arm 4 angeordnet und eingerichtet ist, ein Drehmoment um die Welle J3 zu detektieren. Die Drehmomentsensoren S1, S2 und S3 sind identisch miteinander. Der Roboter 100 umfasst keinen Drehmomentsensor, der eingerichtet ist, ein Drehmoment der Gelenkeinheit 60 um die Wellen J4, J5 und J6 zu detektieren.
  • Der Roboter 100 umfasst auch Motoren MT1 bis MT6, die eingerichtet sind, die jeweiligen Komponenten um die Wellen J1 bis J6 anzutreiben, und eine Steuerung 10, die eingerichtet ist, die Motoren MT1 bis MT6 zu steuern. In 1 bezeichnen die Bezugszeichen EN1 bis EN6 Codierer, die eingerichtet sind, die Rotationswinkel der Motoren MT1 bis MT6 um die Wellen J1 bis J6 zu detektieren. Der Motor MT1, der den Rotationszylinder 2 um die Welle J1 in Bezug auf die Basis 1 antreibt, und der Codierer EN1 sind in 2, aber nicht in 1, veranschaulicht.
  • Die Steuerung 10 umfasst eine CPU, ein ROM und ein RAM (nicht veranschaulicht). Die Steuerung 10 führt die Funktion eines Computerprogramms aus, das in dem ROM gespeichert ist, wenn die CPU das Computerprogramm in das RAM lädt.
  • Wie in 3 veranschaulicht, treibt die Steuerung 10 die Motoren MT1 bis MT6 an, indem sie Antriebsstrom an die Motoren MT1 bis MT6 ausgibt, die in dem Roboter 100 umfasst sind. In 3 sind zur Vereinfachung der Veranschaulichung die Motoren MT1 bis MT6 kollektiv an einer Position angeordnet, die von dem Roboter 100 getrennt ist.
  • Die Steuerung 10 umfasst eine Stromdetektionseinheit 11, die eingerichtet ist, den Antriebsstrom an die Motoren MT1 bis MT6 zu detektieren, eine Drehmomentschätzeinheit 13, die eingerichtet ist, das Schätzdrehmoment Tr um die Wellen J4 bis J6 basierend auf dem detektierten Antriebsstrom zu schätzen, und eine Steuereinheit 12, die eingerichtet ist, Positionsrückmeldung basierend auf den Rotationswinkeln, die von den Codierern EN1 bis EN6 detektiert werden, und Stromrückmeldung basierend auf dem Antriebsstrom auszuführen, der von der Stromdetektionseinheit 11 detektiert wird, und die Motoren MT1 bis MT6 basierend auf dem Schätzdrehmoment Tr, das von der Drehmomentschätzeinheit 13 geschätzt wird, und dem Detektionsdrehmoment T, das von jedem Drehmomentsensor detektiert wird, zu steuern.
  • Die Drehmomentschätzeinheit 13 schätzt das Drehmoment Tr um die Wellen J4 bis J6 basierend auf dem Antriebsstrom an die Motoren MT4 bis MT6 der Handgelenkeinheit 60, die von der Stromdetektionseinheit 11 detektiert wird.
  • In einem Lehrmodus, wenn das Detektionsdrehmoment T von den Drehmomentsensoren S1 bis S3 detektiert wird, gibt die Steuereinheit 12 ein Drehmoment an die Motoren MT1 bis MT3 zum Drehen der Grundwelle 50 um die Wellen J1 bis J3 in einer Richtung, die gleich ist, wie die Richtung des Drehmoments, das um die Wellen J1 bis J3 wirkt. Mit anderen Worten steuert die Steuereinheit 12 die Motoren MT1 bis MT3, um ein Drehmoment zu erzeugen, das die Drehung unterstützt, die um die Wellen J1 bis J3 von externer Kraft verursacht werden. Das unterstützende Drehmoment kann gemäß der Größe des Detektionsdrehmoments T geändert werden, das von den Drehmomentsensoren S1 bis S3 erhalten wird, oder kann konstant sein.
  • Wenn externe Kraft an der Handgelenkeinheit 60 oder einem Werkzeug wirkt, das an der Handgelenkeinheit 60 montiert ist, detektiert die Steuereinheit 12 basierend auf dem Schätzdrehmoment Tr, das von der Drehmomentschätzeinheit 13 nach einer Änderung des Antriebstroms an die Motoren Mt4 bis MT6 geschätzt wird, den Kontakt eines Bedieners an dem Werkzeug und steuert die Motoren MT1 bis MT6, um den Roboter 100 zu stoppen oder zurückzufahren.
  • Nachfolgend werden Wirkungen des Roboters 100 gemäß der so eingerichteten vorliegenden Ausführungsform beschrieben.
    Die Position der Handgelenkeinheit 60 in dem dreidimensionalen Raum wird bestimmt, indem die drei Grundgelenke der Grundwelle 50 gedreht werden, und die Lage eines Werkzeugs, das an einer Spitze der Handgelenkeinheit 60 befestigt ist, wird bestimmt, indem die drei Handgelenkgelenke der Handgelenkeinheit 60 betrieben werden.
  • Wenn beispielsweise der Bediener in Kontakt mit einer optionalen Position des Roboters 100 kommt, bestimmt ein beliebiger der Drehmomentsensoren S1 bis S3, dass externe Kraft an den Roboter 100 als Drehmoment um die Wellen J1 bis J3 aufgebracht wird. Wenn der Bediener in Kontakt mit der Handgelenkeinheit 60 oder dem Werkzeug kommt, wird das Schätzdrehmoment Tr von der Drehmomentschätzeinheit 13 geschätzt, und der Kontakt des Bedieners wird detektiert.
  • Entsprechend kann, wenn kein Drehmoment um die Welten J4 bis J6 detektiert wird, der Kontakt zwischen dem Bediener und dem Roboter 100 hoch empfindlich detektiert werden. Außerdem müssen keine Drehmomentsensoren für die Wellen J4 bis J6 vorgesehen sein, und somit können die Kosten des Roboters 100 reduziert werden.
  • Da die Drehmomentschätzeinheit 13 das Drehmoment um die Wellen J4 bis J6 basierend auf dem Strom an die Motoren MT4 bis MT6 schätzt, der von der Stromdetektionseinheit 11 detektiert wird, müssen keine Drehmomentsensoren an den Wellen J4 bis J6 angeordnet sein. Entsprechend können die Kosten des Roboters 100 reduziert werden, indem keine Drehmomentsensoren, die teuer sind, an den Wellen J4 bis J6 installiert werden, und die Sicherheit des Bedieners kann gewährleistet werden, indem der Kontakt des Bedieners mit Werkzeugen, die an den Wellen J4 bis J6 befestigt sind, detektiert wird.
  • Im Lehrmodus treibt, wenn externe Kraft auf die Handgelenkeinheit 60 oder das Werkzeug aufgebracht wird, die Steuereinheit 12 die Wellen J1 bis J3 in einer Richtung an, die identisch mit der Richtung der externen Kraft ist. Entsprechend kann die Position der Gelenkeinheit 60 in dem dreidimensionalen Raum einfach geändert werden, indem externe Kraft auf den Roboter 100 aufgebracht wird. Gleichzeitig steuert die Steuereinheit 12 die Handgelenkeinheit 60 nicht gemäß der externen Kraft, und somit kann die Lage des Werkzeugs nach Aufnahme der externen Kraft aufrechterhalten werden.
  • Der Roboter 100 gemäß der zuvor beschriebenen Ausführungsform umfasst die Grundwelle 50, umfassend die drei Grundgelenke um die Wellen J1 bis J3 und die Gelenkeinheit 60, umfassend die drei Handgelenkgelenke um die Wellen J4 bis J6. Stattdessen kann ein Roboter 101, umfassend ein redundantes Gelenk um eine Welle Ja (redundante Achse) zusätzlich zu den sechs Gelenken um die Wellen J1 bis J6 eingesetzt werden, wie in 4 veranschaulicht. Der Roboter 101 umfasst einen redundanten Arm 8, der eingerichtet ist, in Bezug auf den ersten Arm 3 um die Welle Ja orthogonal zu der Welle J2 zu drehen, und einen Motor MTa, der eingerichtet ist, den redundanten Arm 8 anzutreiben. Der Roboter 101 umfasst einen Drehmomentsensor, der eingerichtet ist, ein Drehmoment um die Welle Ja zu detektieren.
  • Gemäß diesem siebenwelligen Gelenkroboter 101 kann die Grundwelle 50 in eine Vielzahl von Zuständen geändert werden, während das redundante Gelenk die Handgelenkeinheit 60 in einer Position in dem dreidimensionalen Raum fixiert. Das redundante Gelenk kann keinen Drehmomentsensor umfassen.
  • Die Handgelenkeinheit 60 gemäß der zuvor beschriebenen Ausführungsform kann eine Schutzstruktur aufweisen, damit der Bediener nicht gequetscht wird. In der Schutzstruktur wird beispielsweise eine Naht eines Teils reduziert, an dem das zweite Handgelenkelement 6 und das dritte Handgelenkelement 7 miteinander verbunden sind, und die Größe des Spalts zwischen dem zweiten Handgelenkelement und dem dritten Handgelenkelement ist ausreichend groß, wenn die Elemente einander am nächsten kommen. Diese Ausgestaltung kann beispielsweise verhindern, dass ein Arm des Bedieners in der Naht oder dem Spalt gequetscht wird, wodurch die Sicherheit des Bedieners verbessert wird.
  • Ein Robotersystem 300, umfassend den zuvor beschriebenen Roboter 100, und eine Steuerung 200, die nachfolgend beschrieben ist, können eingesetzt werden.
    Insbesondere kann die Steuerung 200 die Umrissform des Roboters 100 speichern und den Betrieb mindestens einer der Wellen J1 bis J6 beschränken, um zu verhindern, dass die Umrissform des Roboters 100 die Achsenlinie mindestens einer der Wellen J1, J2 und J3 überlappt. Entsprechend kann die äußere Kraft, die auf eine beliebige aller Außenoberflächen des Roboters 100 wirkt, zuverlässig von den Drehmomentsensoren S1 bis S3 detektiert werden, die an den Wellen J1 bis J3 vorgesehen sind.
  • Beispielsweise kann die externe Kraft, die auf eine beliebige aller Außenoberflächen des Roboters 100 wirkt, von dem ersten Drehmomentsensor S1 detektiert werden, der an der Welle J1 vorgesehen ist, indem die Betriebsbeschränkung ausgeführt wird, um zu verhindern, dass Umrissformen der Wellen J2 bis J6 die Achsenlinie der Welle J1 überlappen, wie in 5 veranschaulicht.
  • Wenn ein Werkzeug 110 an der Spitze der Gelenkeinheit 60 befestigt ist, kann die Steuerung 200 auch die Umrissform des Werkzeugs 110 speichern und den Betrieb mindestens einer der Wellen J1 bis J6 beschränken, um zu verhindern, dass die Umrissform des Werkzeugs 110 die Achsenlinie mindestens einer der Wellen J1, J2 und J3 überlappt. Entsprechend kann die äußere Kraft, die auf eine beliebige aller Außenoberflächen des Werkzeugs 110 wirkt, zuverlässig von einem beliebigen der Drehmomentsensoren S1 bis S3 detektiert werden, die an den Wellen J1 bis J3 vorgesehen sind. Die zuvor beschriebene Betriebsbeschränkung kann von einer Software oder einem Mechanismus ausgeführt werden.
  • Bezugszeichenliste
  • 1
    Basis (Grundgelenk)
    2
    Rotationszylinder (Grundgelenk)
    3
    erster Arm (Grundgelenk)
    4
    zweiter Arm (Grundgelenk)
    5
    erstes Handgelenkelement (Handgelenkgelenk)
    6
    zweites Handgelenkelement (Handgelenkgelenk)
    7
    drittes Handgelenkelement (Handgelenkgelenk)
    11
    Stromdetektionseinheit
    12
    Steuereinheit
    13
    Drehmomentschätzeinheit
    60
    Handgelenkeinheit
    100, 101
    Roboter
    110
    Werkzeug
    200
    Steuerung
    300
    Robotersystem
    J1, J2, J3, J4, J5, J6
    Achsenlinie
    Ja
    redundante Achse
    MT1 bis MT6
    Motor
    S1
    erster Drehmomentsensor (Drehmomentsensor)
    S2
    zweiter Drehmomentsensor (Drehmomentsensor)
    S3
    dritter Drehmomentsensor (Drehmomentsensor)

Claims (11)

  1. Roboter, umfassend: eine Gelenkeinheit, umfassend eine Vielzahl von Handgelenkgelenken; eine Vielzahl von Grundgelenken, die eingerichtet sind, die Position der Handgelenkeinheit in einem dreidimensionalen Raum zu bestimmen, wobei nur die Grundgelenke mit Drehmomentsensoren versehen sind, die eingerichtet sind, ein Drehmoment der Grundgelenke um Achsenlinien zu detektieren.
  2. Roboter nach Anspruch 1, überdies umfassend: einen Motor, der eingerichtet ist, jedes Handgelenkgelenk anzutreiben; eine Stromdetektionseinheit, die eingerichtet ist, Strom zu detektieren, der jedem Motor zugeführt wird; und eine Drehmomentschätzeinheit, die eingerichtet ist, ein Drehmoment jedes der Handgelenkgelenke um die Achsenlinie basierend auf dem detektierten Strom zu schätzen.
  3. Roboter nach Anspruch 1 oder 2, überdies umfassend eine Steuereinheit, die eingerichtet ist, jedes Grundgelenk in einer Richtung zu betreiben, die identisch mit der Richtung des detektierten Drehmoments ist, wenn ein Drehmoment, das um die Achsenlinie jedes Grundgelenks von einer externen Kraft erzeugt wird, von jedem Drehmomentsensor detektiert wird.
  4. Roboter nach einem beliebigen der Ansprüche 1 bis 3, umfassend die drei Grundgelenke, wobei jedes Grundgelenk mit dem Drehmomentsensor versehen ist.
  5. Roboter nach einem beliebigen der Ansprüche 1 bis 3, umfassend die vier Grundgelenke, wobei jedes Grundgelenk mit dem Drehmomentsensor versehen ist.
  6. Roboter nach einem beliebigen der Ansprüche 1 bis 3, umfassend die vier Grundgelenke, wobei drei der Grundgelenke, ausgenommen eines der Grundgelenke als eine redundante Achse, jeweils mit dem Drehmomentsensor vorgesehen sind.
  7. Roboter nach einem beliebigen der Ansprüche 1 bis 6, wobei die an den Grundgelenken vorgesehenen Drehmomentsensoren identisch miteinander sind.
  8. Roboter nach einem beliebigen der Ansprüche 1 bis 7, wobei die Handgelenkeinheit eine Quetschschutzstruktur aufweist.
  9. Robotersystem, umfassend: den Roboter nach Anspruch 1; und eine Steuerung, die eingerichtet ist, den Roboter zu steuern, wobei Umrissforminformationen des Roboters in der Steuerung gespeichert werden, und die Steuerung einen Bewegungsbereich mindestens eines der Grundgelenke und der Handgelenkgelenke beschränkt, um zu verhindern, dass der Umriss des Roboters die Achsenlinie mindestens eines der Grundgelenke überlappt.
  10. Robotersystem, umfassend: den Roboter nach Anspruch 1; und eine Steuerung, die eingerichtet ist, den Roboter zu steuern, wobei ein Mechanismus einen Bewegungsbereich mindestens eines der Grundgelenke und der Handgelenkgelenke beschränkt, um zu verhindern, dass der Umriss des Roboters die Achsenlinie mindestens eines der Grundgelenke überlappt.
  11. Robotersystem nach Anspruch 9 oder 10, wobei ein Werkzeug an einer Spitze jedes Handgelenkgelenks befestigt ist, Umrissforminformationen des Werkzeugs in der Steuereinheit gespeichert sind, und die Steuereinheit einen Bewegungsbereich mindestens eines der Grundgelenke und der Handgelenkgelenke beschränkt, um zu verhindern, dass der Umriss des Werkzeugs die Achsenlinie mindestens eines der Grundgelenke überlappt.
DE102019122415.2A 2018-08-31 2019-08-21 Roboter und Robotersystem Pending DE102019122415A1 (de)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2018163209A JP6841802B2 (ja) 2018-08-31 2018-08-31 ロボットおよびロボットシステム
JP2018-163209 2018-08-31

Publications (1)

Publication Number Publication Date
DE102019122415A1 true DE102019122415A1 (de) 2020-03-05

Family

ID=69526995

Family Applications (1)

Application Number Title Priority Date Filing Date
DE102019122415.2A Pending DE102019122415A1 (de) 2018-08-31 2019-08-21 Roboter und Robotersystem

Country Status (4)

Country Link
US (1) US11358276B2 (de)
JP (1) JP6841802B2 (de)
CN (1) CN110871455A (de)
DE (1) DE102019122415A1 (de)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7436241B2 (ja) * 2020-02-25 2024-02-21 ファナック株式会社 ロボットシステム

Family Cites Families (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0230487A (ja) * 1988-07-18 1990-01-31 Matsushita Electric Ind Co Ltd 産業用ロボットの制御装置
JPH0933369A (ja) 1995-07-18 1997-02-07 Kobe Steel Ltd 電動モータ系の外力・外トルク検出方法並びにその装置
JPH1142574A (ja) * 1997-07-28 1999-02-16 Matsushita Electric Ind Co Ltd ロボットの制御方法および制御装置
JPH1177571A (ja) 1997-09-04 1999-03-23 Meidensha Corp ロボットの教示方法、ロボットの加工制御方法及びロボット制御装置
JP4273335B2 (ja) * 2004-06-16 2009-06-03 独立行政法人産業技術総合研究所 ロボットアーム
JP5302647B2 (ja) * 2008-12-09 2013-10-02 東海ゴム工業株式会社 連結部の被覆材
US8562049B2 (en) * 2009-09-22 2013-10-22 GM Global Technology Operations LLC Robotic finger assembly
JP5701055B2 (ja) 2010-12-28 2015-04-15 川崎重工業株式会社 7軸多関節ロボットの制御方法、制御プログラム及びロボット制御装置
JP2012206219A (ja) 2011-03-30 2012-10-25 Seiko Epson Corp ロボット制御装置及びロボットシステム
US9452532B2 (en) 2014-01-27 2016-09-27 Panasonic Intellectual Property Management Co., Ltd. Robot, device and method for controlling robot, and computer-readable non-transitory recording medium
EP3135445B1 (de) * 2014-03-28 2021-04-28 Sony Corporation Roboterarmvorrichtung
JP6100727B2 (ja) * 2014-04-09 2017-03-22 ファナック株式会社 リードスルー機能を有する人協調型産業用ロボット
US10759634B2 (en) * 2014-08-08 2020-09-01 GM Global Technology Operations LLC Electromechanical system for interaction with an operator
EP3242775B1 (de) * 2015-01-07 2021-12-22 ABB Schweiz AG Verfahren zur schätzung der externen kräften und drehmomente auf einem roboterarm
JP6771888B2 (ja) * 2015-01-29 2020-10-21 キヤノン株式会社 ロボット装置、制御方法、物品の製造方法、プログラム及び記録媒体
US10201901B2 (en) 2015-01-29 2019-02-12 Canon Kabushiki Kaisha Robot apparatus, method for controlling robot, program, and recording medium
GB201512964D0 (en) * 2015-07-22 2015-09-02 Cambridge Medical Robotics Ltd Communication paths for robot arms
DE102015214170A1 (de) * 2015-07-27 2017-02-02 Kuka Roboter Gmbh Roboter mit einer Kraftmesseinrichtung
DE102015113467A1 (de) 2015-08-14 2017-02-16 Sami Haddadin Roboterarm und Roboterhandgelenk
WO2017130926A1 (ja) 2016-01-30 2017-08-03 ライフロボティクス株式会社 ロボットアーム機構
CN113384348A (zh) * 2016-02-26 2021-09-14 直观外科手术操作公司 使用虚拟边界避免碰撞的系统和方法
JP6506195B2 (ja) 2016-03-09 2019-04-24 ファナック株式会社 回転軸モジュールおよび多関節ロボット
JP2017177255A (ja) 2016-03-29 2017-10-05 ソニー株式会社 制御装置及び制御方法
JP6392910B2 (ja) 2017-01-13 2018-09-19 ファナック株式会社 ロボットの安全確保動作機能を備えた人間協働ロボットシステム
US20190365489A1 (en) * 2017-02-28 2019-12-05 Sony Corporation Medical support arm system and control device
EP3418007A1 (de) * 2017-06-19 2018-12-26 ABB Schweiz AG Verfahren zur bestimmung eines gelenkmoments in einem gelenk eines gelenkigen industrieroboters
US10145747B1 (en) * 2017-10-10 2018-12-04 Auris Health, Inc. Detection of undesirable forces on a surgical robotic arm

Also Published As

Publication number Publication date
CN110871455A (zh) 2020-03-10
US20200070341A1 (en) 2020-03-05
US11358276B2 (en) 2022-06-14
JP2020032517A (ja) 2020-03-05
JP6841802B2 (ja) 2021-03-10

Similar Documents

Publication Publication Date Title
EP2231369B1 (de) Roboter und verfahren zum überwachen der momente an einem solchen roboter
EP2815855B1 (de) Überwachen eines kinematisch redundanten Roboters
DE102014225537B4 (de) Robotervorrichtung, robotersteuerverfahren, programm und aufzeichnungsmedium
DE102010023736B4 (de) Robotersystem mit Problemerkennungsfunktion
DE102018124007B4 (de) Steuervorrichtung zur Beschränkung der Geschwindigkeit einer Aufbaukomponente eines Roboters
CH677745A5 (de)
DE102018117829B4 (de) Steuereinheit für Gelenkroboter
EP3334574B1 (de) Roboterarm und roboterhandgelenk
EP3439834B1 (de) Kartesische steuerung einer mastspitze eines grossmanipulators, insbesondere betonpumpe
DE102020103857B4 (de) Kraftbegrenzung bei Kollision eines Robotermanipulators
EP3037219B1 (de) Sicherer roboter mit bahnfortschrittsvariablen
DE102019103557A1 (de) Schwingungsanalysator und Schwingungsanalyseverfahren
DE102020113098A1 (de) Werkstück-drehvorrichtung und robotersystem
DE102018104082B4 (de) Robotersystem
DE102019122415A1 (de) Roboter und Robotersystem
DE102017108492B4 (de) Steuervorrichtung eines Roboters, die ein Betriebsprogramm, in dem der Zustand einer zusätzlichen Achse enthalten ist, anzeigt
DE102020113686A1 (de) Robotersystem
DE102020201926A1 (de) Robotersteuerungsvorrichtung und robotersystem
DE102017204211B4 (de) Robotersteuerung und Robotersteuerungsverfahren
DE102019215850A1 (de) Roboter und erstes Armglied
DE102012022190B4 (de) Inverse Kinematik
DE102019107838B4 (de) Roboter mit Sicherheitszaun und Robotersystem
EP3589456B1 (de) Parallelkinematik
DE102020110340B4 (de) Roboter
DE102018133472B3 (de) Bewegungsüberwachung eines Robotermanipulators

Legal Events

Date Code Title Description
R012 Request for examination validly filed
R016 Response to examination communication