DE102016001643B4 - Mensch-Roboter-Kooperationssystem, in dem bewirkt wird, dass ein Roboter einen Rückzugsvorgang durchführt - Google Patents

Mensch-Roboter-Kooperationssystem, in dem bewirkt wird, dass ein Roboter einen Rückzugsvorgang durchführt Download PDF

Info

Publication number
DE102016001643B4
DE102016001643B4 DE102016001643.4A DE102016001643A DE102016001643B4 DE 102016001643 B4 DE102016001643 B4 DE 102016001643B4 DE 102016001643 A DE102016001643 A DE 102016001643A DE 102016001643 B4 DE102016001643 B4 DE 102016001643B4
Authority
DE
Germany
Prior art keywords
robot
external force
human
cooperation system
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.)
Active
Application number
DE102016001643.4A
Other languages
English (en)
Other versions
DE102016001643A1 (de
Inventor
Yasuhiro Naitou
Soichi Arita
Hiromitsu Takahashi
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 DE102016001643A1 publication Critical patent/DE102016001643A1/de
Application granted granted Critical
Publication of DE102016001643B4 publication Critical patent/DE102016001643B4/de
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
    • 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
    • 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01LMEASURING FORCE, STRESS, TORQUE, WORK, MECHANICAL POWER, MECHANICAL EFFICIENCY, OR FLUID PRESSURE
    • G01L5/00Apparatus for, or methods of, measuring force, work, mechanical power, or torque, specially adapted for specific purposes
    • G01L5/0061Force sensors associated with industrial machines or actuators
    • G01L5/0076Force sensors associated with manufacturing 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/40Robotics, robotics mapping to robotics vision
    • G05B2219/40201Detect contact, collision with human
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Chemical & Material Sciences (AREA)
  • Analytical Chemistry (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

Mensch-Roboter-Kooperationssystem (1), in dem ein Roboter (10) und ein Mensch (11) einen Kooperationsvorgang durchführen, während sie einen Arbeitsplatz miteinander teilen, wobei das Mensch-Roboter-Kooperationssystem umfasst:eine Externe-Kraft-Erfassungseinheit (S, 21), die eine externe Kraft erfasst, die auf den Roboter einwirkt;eine Rückzugsvorgangsbefehlseinheit (22), die einen Rückzugsvorgang befiehlt, um zu bewirken, dass der Roboter derart in einer Richtung bewegt wird, dass die externe Kraft verringert wird, wenn die externe Kraft, die von der Externe-Kraft-Erfassungseinheit erfasst wurde, größer als ein erster Grenzwert ist, wenn der Mensch gegen den Roboter drückt, der in einem gestoppten Zustand ist; undeine Positionserfassungseinheit (23), die eine aktuelle Position des Roboters erfasst;dadurch gekennzeichnet, dass das Mensch-Roboter-Kooperationssystem ferner eine Rückzugsvorgangsstoppeinheit (24) umfasst, die den Rückzugsvorgang stoppt, wenn die aktuelle Position des Roboters, die von der Positionserfassungseinheit erfasst wurde, von einem Rückzugsbereich abweicht, in dem der Rückzugsvorgang möglich ist.

Description

  • Hintergrund der Erfindung
  • Gebiet der Erfindung
  • Die vorliegende Erfindung betrifft ein Mensch-Roboter-Kooperationssystem, in dem bewirkt wird, dass ein Roboter einen Rückzugsvorgang in Abhängigkeit von einer externen Kraft, die auf den Roboter einwirkt, durchführt.
  • Beschreibung des Standes der Technik
  • In den letzten Jahren wurde ein Mensch-Roboter-Kooperationssystem entwickelt, in dem ein Mensch und ein Roboter gemischt in einer Fertigungsstätte eingesetzt werden und ein Produktionsvorgang zwischen dem Menschen und dem Roboter aufgeteilt wird. In einigen Fällen wird ein Sicherheitszaun zwischen einem Menschen und einem Roboter vorgesehen, um die Sicherheit des Menschen zu gewährleisten. Das Vorsehen eines Sicherheitszauns könnte jedoch zu einer Verzögerung des Vorgangs führen; daher wurde vor kurzem ein Mensch-Roboter-Kooperationssystem vorgeschlagen, in dem kein Sicherheitszaun verwendet wird.
  • In einem derartigen Mensch-Roboter-Kooperationssystem wird der Roboter abgebremst oder gestoppt, wenn der Roboter sich dem Menschen nähert oder mit diesem in Kontakt kommt, um die Sicherheit des Menschen zu sicherzustellen. Da der Mensch und der Roboter jedoch den Betriebsbereich teilen, kann ein Fall eintreten, in dem der abgebremste oder gestoppte Roboter ein Hindernis darstellt, wenn der Mensch einen Vorgang ausführt.
  • Es wird folglich gewünscht, dass ein derartiger Roboter sich aus dem Betriebsbereich zurückzieht. Der Roboter ist daher mit einem Sensor versehen, der eine externe Kraft erfasst, die auf den Roboter ausgeübt wird, wenn der Mensch gegen den Roboter drückt. Auf diese Weise wird bewirkt, dass der Roboter einen Rückzugsvorgang durchführt, einfach indem der Mensch gegen den Roboter mit einer externen Kraft drückt, die größer gleich einem vorherbestimmten Wert ist. In diesem Fall besteht kein Erfordernis, eine Lehrkonsole zu verwenden.
  • In der japanischen Patentveröffentlichung JP 4 445 038 B2 wird in einem System, in dem ein Mensch und ein Roboter ein Werkstück in Kooperation miteinander befördern, ein Sensor vorgesehen, der eine externe Kraft erfasst, die zwischen dem Werkstück und einer Hand des Roboters einwirkt. In der japanischen Offenlegungsschrift JP H10-291 182 A wird eine Konfiguration offenbart, in der ein Drehmomentsensor zwischen einem Motor und einem Arm, der von dem Motor angetrieben wird, vorgesehen wird.
  • Die Druckschrift DE 10 2008 027 008 A1 offenbart ein Verfahren zum Steuern eines Roboters umfassend die Schritte Ermitteln einer Soll-Bewegungsrichtung auf Basis einer auf dem Roboter ausgeübten Kraft und Bewegen des Roboters in der ermittelten Soll-Bewegungsrichtung um eine vorbestimmte Strecke.
  • Kurzdarstellung der Erfindung
  • Es kann jedoch ein Fall eintreten, in dem der Sensor, selbst wenn keine externe Kraft auf den Roboter einwirkt, fälschlicherweise eine externe Kraft erfassen kann, und daher bewirkt wird, dass der Roboter einen Rückzugsvorgang durchführt. Ein derartiger Fall ist ein Fall, in dem ein Werkstück unerwartet fallen gelassen wird, während es von dem Roboter gegriffen wird, ein Fall, in dem ein eingestellter Wert des Gewichts des Werkstücks inkorrekt ist, oder dergleichen. Auf diese Weise besteht eine Möglichkeit, das Eintreten einer Gefahrensituation aufgrund eines Zusammenstoßes des Roboters mit einer peripheren Vorrichtung, dem Menschen oder dergleichen zu verhindern.
  • Die japanische Patentveröffentlichung JP 4 445 038 B2 beschränkt sich auf eine Konfiguration, in der die Hand des Roboters ein Ende des Werkstücks greift und der Mensch das andere Ende des Werkstücks greift. Des Weiteren sieht die japanische Patentveröffentlichung JP 4 445 038 B2 vor, den Sensor zwischen dem Roboter und der Hand vorzusehen, und kann daher nicht auf einen Fall angewendet werden, in dem ein Sensor an einem Gelenk des Roboters vorgesehen wird, wie in der japanischen Offenlegungsschrift JP H10-291 182 A . Es ist somit schwierig, die Konfiguration der japanischen Patentveröffentlichung JP 4 445 038 B2 auf ein Mensch-Roboter-Kooperationssystem anzuwenden, in dem ein Roboter und ein Mensch einen Kooperationsvorgang durchführen, während sie einen Arbeitsplatz miteinander teilen.
  • Die vorliegende Erfindung wurde in Anbetracht derartiger Umstände ersonnen und hat als eine Aufgabe, ein Mensch-Roboter-Kooperationssystem bereitzustellen, in dem, selbst wenn ein Roboter einen Rückzugsvorgang auf der Basis einer falschen Erfassung durch einen Sensor startet, es möglich ist, den Rückzugsvorgang des Roboters zu stoppen.
  • Um die vorstehende Aufgabe zu lösen, wird gemäß einem ersten Gesichtspunkt der vorliegenden Erfindung ein Mensch-Roboter-Kooperationssystem bereitgestellt, in dem ein Roboter und ein Mensch einen Kooperationsvorgang durchführen, während sie einen Arbeitsplatz miteinander teilen, wobei das System Folgendes beinhaltet: eine Externe-Kraft-Erfassungseinheit, die eine externe Kraft erfasst, die auf den Roboter einwirkt; eine Rückzugsvorgangsbefehlseinheit, die einen Rückzugsvorgang befiehlt, um zu bewirken, dass der Roboter derart in einer Richtung bewegt wird, dass die externe Kraft verringert wird, wenn die externe Kraft, die von der Externe-Kraft-Erfassungseinheit erfasst wurde, größer als ein erster Grenzwert ist, wenn der Mensch gegen den Roboter drückt, der in einem gestoppten Zustand ist; eine Positionserfassungseinheit, die eine aktuelle Position des Roboters erfasst; und eine Rückzugsvorgangsstoppeinheit, die den Rückzugsvorgang stoppt, wenn die aktuelle Position des Roboters, die von der Positionserfassungseinheit erfasst wurde, von einem Rückzugsbereich abweicht, in dem der Rückzugsvorgang möglich ist.
  • Gemäß einem zweiten Gesichtspunkt der vorliegenden Erfindung beinhaltet das System gemäß dem ersten Gesichtspunkt der vorliegenden Erfindung weiterhin eine Rückzugsbereichseinstellungseinheit, die einen vorherbestimmten Bereich, der die aktuelle Position des Roboters beinhaltet, als den Rückzugsbereich einrichtet, wenn die externe Kraft kleiner gleich einem zweiten Grenzwert ist, der kleiner als der erste Grenzwert ist.
  • Gemäß einem dritten Gesichtspunkt der vorliegenden Erfindung ist die Externe-Kraft-Erfassungseinheit in dem System gemäß dem ersten oder dem zweiten Gesichtspunkt der vorliegenden Erfindung ein Kraftsensor, der an einem fernen Ende des Roboters montiert ist.
  • Auf der Basis einer ausführlichen Beschreibung beispielhafter Ausführungsformen der vorliegenden Erfindung, die in den begleitenden Zeichnungen dargestellt sind, werden diese und andere Aufgaben, Merkmale und Vorteile offensichtlicher werden.
  • Figurenliste
    • 1 ist eine Ansicht, die eine grundlegende Konfiguration des Mensch-Roboter-Kooperationssystems gemäß der vorliegenden Erfindung darstellt.
    • 2 ist eine erste Seitenansicht eines Roboters.
    • 3 ist eine zweite Seitenansicht des Roboters.
    • 4A ist eine Ansicht, die eine Beziehung zwischen Zeit und externer Kraft darstellt.
    • 4B ist eine andere Ansicht, die eine Beziehung zwischen Zeit und externer Kraft darstellt.
    • 5 ist ein Ablaufdiagramm, das den Betrieb des Mensch-Roboter-Kooperationssystems gemäß der vorliegenden Erfindung darstellt.
    • 6A ist eine Ansicht zum Erläutern eines Rückzugsbereichs.
    • 6B ist eine andere Ansicht zum Erläutern eines Rückzugsbereichs.
  • Ausführliche Beschreibung
  • Ausführungsformen der vorliegenden Erfindung werden unter Bezugnahme auf die begleitenden Zeichnungen hierin im Folgenden beschrieben. In den Zeichnungen sind ähnliche Elemente durch identische Bezugsziffern oder -symbole bezeichnet. Um ein Verständnis zu erleichtern, wurde der Maßstab der Zeichnungen willkürlich geändert.
  • 1 ist eine Ansicht, die eine grundlegende Konfiguration des Mensch-Roboter-Kooperationssystems gemäß der vorliegenden Erfindung darstellt. Wie in 1 dargestellt, beinhaltet das Mensch-Roboter-Kooperationssystem 1 hauptsächlich einen Roboter 10, eine Steuervorrichtung 20, die den Roboter 10 steuert, und einen Menschen 11. Da der Roboter 10 neben dem Menschen 11 angeordnet ist, können der Roboter 10 und der Mensch 11 in dem Mensch-Roboter-Kooperationssystem 1 einen Kooperationsvorgang durchführen, während sie einen Arbeitsplatz miteinander teilen.
  • Der Roboter 10 ist beispielsweise ein 6-achsiger Knickarmroboter, der an seinem fernen Ende mit einer Hand H versehen ist, die ein Werkstück W greifen kann. Des Weiteren ist ein Kraftsensor S in den Roboter 10 zwischen der Hand H und einem fernen Ende eines Roboterarms eingebaut. Folglich erfasst der Kraftsensor S eine externe Kraft als einen Externe-Kraft-Erfassungswert Fd, die von der Stelle, an der der Kraftsensor S an dem fernen Ende der Hand H montiert ist, und dem Werkstück W einwirkt.
  • Die in 1 dargestellte Steuervorrichtung 20 ist ein Digitalrechner und beinhaltet eine Externe-Kraft-Schätzungseinheit 21, die eine Kraft als einen Externe-Kraft-Schätzwert schätzt, die aus einer externen Umgebung, wie einer peripheren Vorrichtung oder dergleichen, auf den Roboter 10 einwirkt, unter Verwendung des Externe-Kraft-Erfassungswerts Fd, der von dem Kraftsensor erfasst wurde. Die Externe-Kraft-Schätzungseinheit 21 berechnet einen Externe-Kraft-Schätzwert Fe durch Subtrahieren des Gewichts von jeweils der Hand H und dem Werkstück W, wenn keine externe Kraft darauf einwirkt, von dem Externe-Kraft-Erfassungswert Fd, der von dem Kraftsensor S erfasst wurde. Wenn der Externe-Kraft-Schätzwert Fe genauer berechnet wird, kann er konfiguriert werden, um weiter eine Kraft, von der bewirkt wird, dass sie auf den Kraftsensor S einwirkt, aufgrund einer Trägheitskraft, die aus der Bewegung von jeweils dem Roboter 10 und dem Werkstück W resultiert, von dem Externe-Kraft-Erfassungswert Fd zu subtrahieren. Zwischenzeitlich kann der Externe-Kraft-Schätzwert Fe durch ein beliebiges anderes Verfahren geschätzt werden. Der Kraftsensor S und die Externe-Kraft-Schätzungseinheit 21 führen die Funktion einer Externe-Kraft-Erfassungseinheit durch, die eine externe Kraft erfasst, die auf den Roboter 10 einwirkt.
  • Des Weiteren beinhaltet die Steuervorrichtung 20 eine Rückzugsvorgangsbefehlseinheit 22, die einen Rückzugsvorgang befiehlt, um zu bewirken, dass der Roboter 10 derart in einer Richtung bewegt wird, dass der Externe-Kraft-Schätzwert verringert wird, wenn der Externe-Kraft-Schätzwert Fd, der von der Externe-Kraft-Schätzungseinheit 21 geschätzt wurde, größer als ein Grenzwert ist. Wenn der Mensch 11 absichtlich gegen den Roboter 10 mit einer Kraft drückt, die größer als der Grenzwert ist, befiehlt die Rückzugsvorgangsbefehlseinheit 22 somit einen Rückzugsvorgang, so dass der Roboter 10 den Rückzugsvorgang startet. Man nehme zwischenzeitlich an, dass der Grenzwert durch einen Versuch oder dergleichen erhalten und in einer Speichereinheit (nicht dargestellt) der Steuervorrichtung 20 gespeichert wird.
  • Des Weiteren beinhaltet die Steuervorrichtung 20 eine Positionserfassungseinheit 23, die eine aktuelle Position des Roboters 10 erfasst. Die Positionserfassungseinheit 23 ist mit einem Geber (nicht dargestellt) verbunden, der an einem Motor (nicht dargestellt) montiert ist, der jede Welle des Roboters 10 antreibt.
  • Die Positionserfassungseinheit 23 kann somit eine Position eines fernen Armendes, insbesondere des Roboters 10 erfassen.
  • Des Weiteren beinhaltet die Steuervorrichtung 20 eine Rückzugsvorgangsstoppeinheit 24, die den Rückzugsvorgang, der von der Rückzugsvorgangsbefehlseinheit 22 befohlen wurde, stoppt, wenn die aktuelle Position des Roboters 10, die von der Positionserfassungseinheit 23 erfasst wurde, von dem Rückzugsbereich abweicht. Des Weiteren beinhaltet die Steuervorrichtung 20 eine Rückzugsbereichseinstellungseinheit 25, die einen vorherbestimmten Bereich, der die aktuelle Position des Roboters 10 beinhaltet, als den Rückzugsbereich einrichtet, wenn der Externe-Kraft-Schätzwert kleiner gleich dem Grenzwert ist.
  • Die 2 und 3 sind Seitenansichten des Roboters. In 2 greift die Hand H des Roboters 10 ein Werkstück W mit einem Gewicht von beispielsweise 30 kg. Da keine externe Kraft vorliegt, die auf den Roboter 10 einwirkt, ist der Externe-Kraft-Schätzwert Fe, der von der Externe-Kraft-Schätzungseinheit 21 berechnet wird, in diesem Fall 0 kg.
  • Es wird nun ein Fall in Betracht gezogen, in dem das Werkstück W unerwartet aus der Hand H des Roboters 10 fallen gelassen wird, wie in 3 dargestellt. Auf diese Weise wird der Externe-Kraft-Erfassungswert Fd um 30 kg verringert, wobei es sich um das Gewicht des Werkstücks W handelt. Infolgedessen wird der Externe-Kraft-Schätzwert Fe, der von der Externe-Kraft-Schätzungseinheit 21 berechnet wird, etwa 30 kg.
  • Wenn der Grenzwert für die Rückzugsvorgangsbefehlseinheit 22 somit auf etwa 30 kg eingestellt wird, befiehlt die Rückzugsvorgangsbefehlseinheit 22 einen Rückzugsvorgang. In diesem Fall tritt eine Situation ein, in der der Roboter 10 den Rückzugsvorgang startet, selbst wenn ein Zurückziehen in der Tat nicht erforderlich ist. Auf diese Weise kann der Roboter 10 mit einer peripheren Vorrichtung oder dem Menschen 11 zusammenstoßen und der Roboter 10 und/oder die periphere Vorrichtung können folglich beschädigt werden und/oder der Mensch 11 kann gefährdet werden.
  • Die 4A und 4B sind Ansichten, die jeweils eine Beziehung zwischen Zeit und externer Kraft darstellen. In diesen Ansichten stellt die horizontale Achse die Zeit dar und die vertikale Achse stellt den Externe-Kraft-Erfassungswert Fd dar, der von dem Kraftsensor S geschätzt wurde. Wenn das Werkstück W in 4A unerwartet aus der Hand H des Roboters 10 zu einer Zeit t1 fallen gelassen wird, wird die externe Kraft schnell von im Wesentlichen null auf eine externe Kraft FA2 erhöht. Danach ändert sich die externe Kraft zwischen der externen Kraft FA2 und einer kleineren externen Kraft FA1.
  • Wenn der Mensch 11 in 4B absichtlich gegen den Roboter 10 mit einer Hand oder dergleichen zu einer Zeit t2 drückt, wird auf ähnliche Weise die externe Kraft von im Wesentlichen null auf eine externe Kraft FB2 erhöht. Dann ändert sich die externe Kraft zwischen der externen Kraft FB2 und einer kleineren externen Kraft FB1.
  • 5 ist ein Ablaufdiagramm, das den Betrieb des Mensch-Roboter-Kooperationssystems gemäß der vorliegenden Erfindung darstellt. Unter Bezugnahme auf 5 wird hierin im Folgenden eine Beschreibung des Betriebs des Mensch-Roboter-Kooperationssystems 1 vorgenommen. Man nehme zwischenzeitlich an, dass das in 5 dargestellte Verfahren für jeden vorherbestimmten Steuerzyklus wiederholt durchgeführt wird.
  • Zunächst erfasst der Kraftsensor S in Schritt S11 von 5 den Externe-Kraft-Erfassungswert Fd. Anschließend schätzt die Externe-Kraft-Schätzungseinheit 21 in Schritt S12 den Externe-Kraft-Schätzwert Fe. Des Weiteren wird der Externe-Kraft-Schätzwert Fe in Schritt S13 mit einem Rückzugsbereichsgrenzwert A2 verglichen. Der Rückzugsbereichsgrenzwert A2 ist ein vorherbestimmter Wert, der durch einen Versuch oder dergleichen erhalten wird und der beispielsweise 2 kg ist.
  • Wenn in Schritt S13 bestimmt wird, dass der Externe-Kraft-Schätzwert Fe nicht größer als der Rückzugsbereichsgrenzwert A2 ist, fährt das Verfahren mit Schritt S14 fort. Die Rückzugsbereichseinstellungseinheit 25 richtet in Schritt S14 einen Rückzugsbereich Z ein.
  • Die 6A und 6B sind Ansichten zum Erläutern des Rückzugsbereichs. Zunächst wird eine aktuelle Position CP, die von der Positionserfassungseinheit 23 erfasst wurde, der Rückzugsbereichseinstellungseinheit 25 bereitgestellt. Dann, wie in 6A dargestellt, wird eine Sphäre mit ihrer Mitte an der aktuellen Position CP und mit einem vorherbestimmten Radius als der Rückzugsbereich Z eingestellt. Der vorherbestimmte Radius kann beispielsweise 30 cm sein. Der Rückzugsbereich Z kann durch eine beliebige andere Methode eingerichtet werden. Wenn der Rückzugsbereich Z eingerichtet wird, kehrt das Verfahren zu Schritt S11 zurück.
  • Wenn in Schritt S13 bestimmt wird, dass der Externe-Kraft-Schätzwert Fe größer als der Rückzugsbereichsgrenzwert A2 ist, fährt das Verfahren mit Schritt S15 fort. In Schritt S15 wird weiterhin bestimmt, ob der Externe-Kraft-Schätzwert Fe größer als der Grenzwert A1 ist. Der Grenzwert A1 ist ein vorherbestimmter Wert, der größer als der Rückzugsbereichsgrenzwert A2 ist und durch einen Versuch oder dergleichen erhalten wird, und der Grenzwert A1 ist ein vorherbestimmter Wert, der kleiner als die in 4A dargestellte externe Kraft FA1 und die in 4B dargestellte externe Kraft FB1 und größer als null ist und von dem angenommen wird, dass er beispielsweise etwa 30 kg ist.
  • Wenn bestimmt wird, dass der Externe-Kraft-Schätzwert Fe größer als der Grenzwert A1 ist, fährt das Verfahren mit Schritt S16 fort. In Schritt S16 wird bestimmt, dass der Mensch 11 absichtlich gegen den Roboter 10 gedrückt hat, und die Rückzugsvorgangsbefehlseinheit 22 gibt einen Rückzugsbefehl aus. Dies führt dazu, dass der Roboter 10 einen Rückzugsvorgang in einer derartigen Richtung durchführt, um den Externe-Kraft-Schätzwert zu verringern. Wenn zwischenzeitlich bestimmt wird, dass der Externe-Kraft-Schätzwert Fe nicht größer als der Grenzwert A1 ist, kehrt das Verfahren zu Schritt S11 zurück.
  • Während der Roboter 10 den Rückzugsvorgang durchführt, erfasst die Positionserfassungseinheit 23 in Schritt S17 eine aktuelle Position CP eines fernen Endes des Roboters 10. Dann wird in Schritt S18 bestimmt, ob die aktuelle Position CP außerhalb des Rückzugsbereichs Z existiert. Wie in 6B dargestellt, wenn die aktuelle Position CP von dem Rückzugsbereich Z abweicht und außerhalb des Rückzugsbereichs Z existiert, stoppt die Rückzugsvorgangsstoppeinheit 24 in Schritt S19 den Rückzugsvorgang. Wenn zwischenzeitlich die aktuelle Position CP innerhalb des Rückzugsbereichs Z existiert, kehrt das Verfahren zu Schritt S17 zurück.
  • Wenn der Mensch 11 absichtlich gegen den Roboter 10 mit einer Kraft drückt, die größer als der Grenzwert A1 ist, wird das ferne Ende des Roboters 10 um einen vorherbestimmten Radius, z. B. 30 cm, bewegt und der Roboter 10 wird dann gestoppt. Wenn der Mensch 11 in diesem Fall ebenfalls erneut gegen den Roboter 10 drückt, folgt daraus, dass der Roboter 10 erneut einen Rückzugsvorgang startet.
  • Wenn das Werkstück W unerwartet aus der Hand H des Roboters 10 fallen gelassen wird, wird des Weiteren der Externe-Kraft-Schätzwert Fe etwa 30 kg, so dass der Roboter 10 einen Rückzugsvorgang startet. In diesem Fall bleibt der Externe-Kraft-Schätzwert Fe im Wesentlichen unverändert, nachdem das Werkstück W fallen gelassen wurde. Wenn der Roboter 10 von dem Rückzugsbereich Z abweicht, folgt daraus, dass der Roboter 10 stoppt. Wenn der Roboter 10 stoppt, folgt somit daraus, dass kein neuer Rückzugsbereich Z erstellt wird. Selbst wenn aufgrund dessen, dass das Werkstück W unerwartet von dem Roboter 10 fallen gelassen wird, ein Rückzugsvorgang gestartet wird, kann der Roboter 10 folglich in der vorliegenden Erfindung gestoppt werden.
  • Da der Rückzugsbereich Z im Voraus eingerichtet wird, kann daher in der vorliegenden Erfindung der Bereich, in dem der Roboter 10 einen Rückzugsvorgang durchführen kann, begrenzt werden. Selbst wenn eine falsche Erfassung vorgenommen wird, wie wenn das Werkstück W unerwartet von dem Roboter 10 fallen gelassen wird, wird der Roboter 10 somit gestoppt, wenn der Roboter 10 von dem Rückzugsbereich Z abweicht. Zwischenzeitlich kann ein vorherbestimmter Bereich als der Rückzugsbereich Z voreingestellt werden. Auf diese Weise ist es in der vorliegenden Erfindung möglich, ein Eintreten einer Gefahrensituation aufgrund eines Zusammenstoßes des Roboters mit einer peripheren Vorrichtung, dem Menschen 11 oder dergleichen zu verhindern. Eine ähnliche Steuerung kann durchgeführt werden, selbst wenn der Roboter 10 einen Rückzugsvorgang durchführt, weil der eingestellte Wert des Gewichts des Erzeugnisses inkorrekt ist.
  • Zwischenzeitlich schätzt die Externe-Kraft-Schätzungseinheit 21 in der unter Bezugnahme auf 5 beschriebenen Ausführungsform den Externe-Kraft-Schätzwert Fe unter Verwendung des Externe-Kraft-Erfassungswerts Fd. Die Externe-Kraft-Schätzungseinheit 21 kann jedoch den Externe-Kraft-Schätzwert Fe unter Verwendung eines Werts des elektrischen Stroms, der durch einen Motor fließt, um jede Welle des Roboters 10 anzutreiben, schätzen. Es ist auch möglich, eine Bestimmung, die ähnlich der oben beschriebenen ist, auf der Basis des Externe-Kraft-Erfassungswerts Fd des Kraftsensors S vorzunehmen. In diesem Fall ist es bevorzugt, dass der erste Grenzwert A1 und der zweite Grenzwert A2 getrennt eingestellt werden.
  • Des Weiteren kann der Kraftsensor S auf einem Basisteil des Roboters 10 angeordnet sein. In diesem Fall ist es möglich zu verhindern, dass der Roboter 10 einen Rückzugsvorgang auf der Basis einer falschen Erfassung durchführt, die aufgrund dessen, dass ein anderes Objekt auf einem Arm des Roboters 10 platziert wird, vorgenommen wurde.
  • Vorteilhafter Effekt der Erfindung
  • Selbst wenn das Werkstück unerwartet aus der Hand des Roboters fallen gelassen wird, kann in dem ersten Gesichtspunkt der Erfindung der Roboter gestoppt werden, wenn die aktuelle Position des Roboters von dem Rückzugsbereich abweicht. Somit ist es möglich zu verhindern, dass eine Gefahrensituation aufgrund eines Zusammenstoßes des Roboters mit einer peripheren Vorrichtung, einem Menschen oder dergleichen eintritt.
  • In dem zweiten Gesichtspunkt der Erfindung ist es durch Einrichten des Rückzugsbereichs möglich, den Bereich, in dem der Roboter einen Rückzugsvorgang durchführen kann, zu begrenzen.
  • Obwohl die vorliegende Erfindung in Bezug auf beispielhafte Ausführungsformen davon beschrieben wurde, werden Fachmänner zu schätzen wissen, dass die oben beschriebenen Änderungen und eine Vielfalt anderer Änderungen, Weglassungen und Hinzufügungen vorgenommen werden können, ohne vom Schutzumfang der vorliegenden Erfindung abzuweichen.

Claims (3)

  1. Mensch-Roboter-Kooperationssystem (1), in dem ein Roboter (10) und ein Mensch (11) einen Kooperationsvorgang durchführen, während sie einen Arbeitsplatz miteinander teilen, wobei das Mensch-Roboter-Kooperationssystem umfasst: eine Externe-Kraft-Erfassungseinheit (S, 21), die eine externe Kraft erfasst, die auf den Roboter einwirkt; eine Rückzugsvorgangsbefehlseinheit (22), die einen Rückzugsvorgang befiehlt, um zu bewirken, dass der Roboter derart in einer Richtung bewegt wird, dass die externe Kraft verringert wird, wenn die externe Kraft, die von der Externe-Kraft-Erfassungseinheit erfasst wurde, größer als ein erster Grenzwert ist, wenn der Mensch gegen den Roboter drückt, der in einem gestoppten Zustand ist; und eine Positionserfassungseinheit (23), die eine aktuelle Position des Roboters erfasst; dadurch gekennzeichnet, dass das Mensch-Roboter-Kooperationssystem ferner eine Rückzugsvorgangsstoppeinheit (24) umfasst, die den Rückzugsvorgang stoppt, wenn die aktuelle Position des Roboters, die von der Positionserfassungseinheit erfasst wurde, von einem Rückzugsbereich abweicht, in dem der Rückzugsvorgang möglich ist.
  2. Mensch-Roboter-Kooperationssystem nach Anspruch 1, dadurch gekennzeichnet, dass sie weiterhin eine Rückzugsbereichseinstellungseinheit (25) umfasst, die einen vorherbestimmten Bereich, der die aktuelle Position des Roboters beinhaltet, als den Rückzugsbereich einrichtet, wenn die externe Kraft kleiner gleich einem zweiten Grenzwert ist, der kleiner als der erste Grenzwert ist.
  3. Mensch-Roboter-Kooperationssystem nach Anspruch 1 oder 2, dadurch gekennzeichnet, dass die Externe-Kraft-Erfassungseinheit ein Kraftsensor ist, der an einem fernen Ende des Roboters montiert ist.
DE102016001643.4A 2015-02-20 2016-02-12 Mensch-Roboter-Kooperationssystem, in dem bewirkt wird, dass ein Roboter einen Rückzugsvorgang durchführt Active DE102016001643B4 (de)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2015032168A JP6055002B2 (ja) 2015-02-20 2015-02-20 ロボットを退避動作させる人間協調ロボットシステム
JP2015-032168 2015-02-20

Publications (2)

Publication Number Publication Date
DE102016001643A1 DE102016001643A1 (de) 2016-08-25
DE102016001643B4 true DE102016001643B4 (de) 2019-01-10

Family

ID=56577675

Family Applications (1)

Application Number Title Priority Date Filing Date
DE102016001643.4A Active DE102016001643B4 (de) 2015-02-20 2016-02-12 Mensch-Roboter-Kooperationssystem, in dem bewirkt wird, dass ein Roboter einen Rückzugsvorgang durchführt

Country Status (4)

Country Link
US (1) US9737989B2 (de)
JP (1) JP6055002B2 (de)
CN (1) CN105911861B (de)
DE (1) DE102016001643B4 (de)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102019001373A1 (de) * 2019-02-27 2020-08-27 Florian Fried Verfahren zum berührungslosen Führen eines Robotersystems in einer Mensch-Roboter-Kollaboration (MRK)

Families Citing this family (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5926346B2 (ja) * 2014-09-25 2016-05-25 ファナック株式会社 人間協調ロボットシステム
JP6034895B2 (ja) * 2015-02-20 2016-11-30 ファナック株式会社 外力に応じてロボットを退避動作させる人間協調ロボットシステム
JP6034900B2 (ja) * 2015-03-06 2016-11-30 ファナック株式会社 動作プログラムの再開を判断するロボット制御装置
JP6426547B2 (ja) * 2015-07-21 2018-11-21 ファナック株式会社 人間協調型ロボットシステムのロボットシミュレーション装置
US9868213B2 (en) * 2015-08-11 2018-01-16 Empire Technology Development Llc Incidental robot-human contact detection
JP6733239B2 (ja) * 2016-03-18 2020-07-29 セイコーエプソン株式会社 制御装置及びロボットシステム
US11045955B2 (en) * 2016-05-26 2021-06-29 Mitsubishi Electric Corporation Robot control device
US10286556B2 (en) * 2016-10-16 2019-05-14 The Boeing Company Method and apparatus for compliant robotic end-effector
JP6316909B1 (ja) * 2016-11-10 2018-04-25 ファナック株式会社 協働動作領域を有するロボットシステム
JP6420298B2 (ja) * 2016-12-02 2018-11-07 ファナック株式会社 ロボットを制御するロボット制御装置、およびロボットに加わる外乱値を推定する方法
JP6392910B2 (ja) * 2017-01-13 2018-09-19 ファナック株式会社 ロボットの安全確保動作機能を備えた人間協働ロボットシステム
JP6851837B2 (ja) * 2017-01-20 2021-03-31 キヤノン株式会社 制御装置、ロボットシステム、制御方法、プログラム、記録媒体及び物品の製造方法
DE102017102621B3 (de) * 2017-02-09 2018-05-09 Franka Emika Gmbh Roboter
KR102001101B1 (ko) * 2017-08-25 2019-07-18 주식회사 토룩 로봇 제어 시스템
JP6690626B2 (ja) 2017-10-31 2020-04-28 株式会社安川電機 ロボットシステムおよびロボットの退避方法
DE102018112370B4 (de) * 2018-05-23 2021-09-16 Franka Emika Gmbh Richtungsabhängige Kollisionsdetektion für einen Robotermanipulator
US11305434B2 (en) 2018-10-26 2022-04-19 Fanuc Corporation Robot system
JP6881525B2 (ja) 2019-08-23 2021-06-02 株式会社安川電機 ロボットシステム、コントローラ及び制御方法
EP3827934A1 (de) * 2019-11-27 2021-06-02 Siemens Aktiengesellschaft Verfahren zum steuern eines roboters, roboter und computerprogrammprodukt

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10291182A (ja) 1997-04-17 1998-11-04 Yaskawa Electric Corp アーム駆動装置
DE102008027008A1 (de) 2008-06-06 2009-12-10 Kuka Roboter Gmbh Verfahren und Vorrichtung zum Steuern eines Manipulators
JP4445038B2 (ja) 2008-02-06 2010-04-07 パナソニック株式会社 ロボット、ロボットの制御装置及び制御方法、並びに、ロボットの制御装置の制御プログラム

Family Cites Families (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06245561A (ja) * 1993-02-10 1994-09-02 Fanuc Ltd サーボモータの異常負荷検出制御方法
JPH06292379A (ja) * 1993-04-02 1994-10-18 Fanuc Ltd 異常負荷時のトルクリミット変更方法
JPH1110580A (ja) * 1997-06-26 1999-01-19 Nachi Fujikoshi Corp 産業用ロボットの駆動軸制御方法及びその装置
JPH11245191A (ja) * 1998-02-27 1999-09-14 Nachi Fujikoshi Corp 産業用ロボットの駆動軸制御方法及びその装置
JP3327205B2 (ja) * 1998-03-30 2002-09-24 松下電器産業株式会社 ロボットの制御方法および装置
JP2000284817A (ja) * 1999-03-31 2000-10-13 Toyoda Mach Works Ltd 共通経路上の2つの可動体を同時制御する数値制御装置
CN102387900B (zh) * 2009-03-27 2015-06-03 Abb股份公司 真正安全的小型机器人和用于控制此机器人的方法
JP4750200B2 (ja) * 2009-05-21 2011-08-17 ファナック株式会社 ロボット動作範囲設定装置
JP5375522B2 (ja) * 2009-10-27 2013-12-25 トヨタ自動車株式会社 ロボットアーム制御装置、その制御方法及びプログラム
DE102012212754B4 (de) * 2012-06-29 2022-03-03 Robert Bosch Gmbh Verfahren zum Betreiben eines Sensorsystems sowie Sensorsystem
JP5912953B2 (ja) * 2012-07-17 2016-04-27 株式会社ダイヘン 制御装置、及び制御方法
JP2014188645A (ja) * 2013-03-28 2014-10-06 Seiko Epson Corp ロボット群システム
CN103213143A (zh) * 2013-04-22 2013-07-24 重庆绿色智能技术研究院 一种具有温度感知功能的多元触觉交互感知系统
DE102013218823A1 (de) * 2013-09-19 2015-04-02 Kuka Laboratories Gmbh Verfahren zum manuell geführten Verstellen der Pose eines Manipulatorarms eines Industrieroboters und zugehöriger Industrieroboter
JP5893665B2 (ja) * 2014-04-14 2016-03-23 ファナック株式会社 作用された力に応じて移動されるロボットを制御するロボット制御装置
CN103921266A (zh) * 2014-04-15 2014-07-16 哈尔滨工程大学 一种基于Kinect的体感控制冰雪机器人方法
JP6193816B2 (ja) * 2014-06-20 2017-09-06 ファナック株式会社 アームの退避機能を有する多関節ロボット
CN104224498B (zh) * 2014-09-24 2016-04-20 哈尔滨工业大学 一种外骨骼机器人系统及基于运动学末端检测的控制方法
US20160214261A1 (en) * 2015-01-22 2016-07-28 GM Global Technology Operations LLC Collaborative robot system and method
US9849595B2 (en) * 2015-02-06 2017-12-26 Abb Schweiz Ag Contact force limiting with haptic feedback for a tele-operated robot

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10291182A (ja) 1997-04-17 1998-11-04 Yaskawa Electric Corp アーム駆動装置
JP4445038B2 (ja) 2008-02-06 2010-04-07 パナソニック株式会社 ロボット、ロボットの制御装置及び制御方法、並びに、ロボットの制御装置の制御プログラム
DE102008027008A1 (de) 2008-06-06 2009-12-10 Kuka Roboter Gmbh Verfahren und Vorrichtung zum Steuern eines Manipulators

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102019001373A1 (de) * 2019-02-27 2020-08-27 Florian Fried Verfahren zum berührungslosen Führen eines Robotersystems in einer Mensch-Roboter-Kollaboration (MRK)
DE102019001373B4 (de) * 2019-02-27 2020-11-19 Florian Fried Verfahren zum berührungslosen Führen eines Robotersystems in einer Mensch-Roboter-Kollaboration (MRK)

Also Published As

Publication number Publication date
CN105911861B (zh) 2018-01-19
CN105911861A (zh) 2016-08-31
DE102016001643A1 (de) 2016-08-25
US9737989B2 (en) 2017-08-22
JP2016153155A (ja) 2016-08-25
JP6055002B2 (ja) 2016-12-27
US20160243700A1 (en) 2016-08-25

Similar Documents

Publication Publication Date Title
DE102016001643B4 (de) Mensch-Roboter-Kooperationssystem, in dem bewirkt wird, dass ein Roboter einen Rückzugsvorgang durchführt
DE102016001644B4 (de) Mensch-Roboter-Kooperationssystem, in dem bewirkt wird, dass ein Roboter einen Rückzugsvorgang in Abhängigkeit von einer externen Kraft durchführt
DE102016008908B4 (de) Industrierobotersystem und Steuerverfahren dafür
DE102015005212B4 (de) Sicherheitsüberwachungsvorrichtung für einen ein Werkstück greifenden und tragenden Roboter
DE102015007524B4 (de) Mehrgelenkroboter mit einer Funktion zum Repositionieren des Arms
DE102018121388B4 (de) Robotersystem
DE102017008248B4 (de) Mit Menschen kollaborativer Roboter
DE102017003000B4 (de) Mit Menschen kooperierendes Robotersystem
DE102015008577B4 (de) Robotersteuervorrichtung zum Verhindern von Fehlbeurteilungen durch Kollisionsbeurteilungsteil
DE102016003250B4 (de) Robotersteuervorrichtung mit einer Funktion zum Erfassen eines Kontakts mit einem Objekt oder einer Person
DE102014019033B4 (de) Industrieroboter, der mit einem Menschen zusammenarbeitet und ein Schutzelement umfasst
DE102018100217B4 (de) System für Mensch-Roboter-Kollaboration mit Funktion für Sicherheitsgewährleistungsbetrieb für einen Roboter
DE102017008916A1 (de) Produktionssystem zum Ausführen von kooperativer Arbeit durch eine Bedienperson und einen Roboter
DE102015016341B4 (de) Robotersteuervorrichtung zum Anhalten eines Roboters durch Detektieren einer Kontaktkraft mit einer Person
EP3200961B1 (de) Verfahren und vorrichtung zur steuerung/regelung eines roboter-manipulators
DE102015005908A1 (de) System zum Transportieren eines Werkstücks mit einer Funktion zur Überwachung einer externen Kraft
DE102015012232A1 (de) Mit Menschen kollaborierendes Robotersystem
DE102018203552A1 (de) Robotersystem und robotersteuerungsverfahren
EP3782773A1 (de) Werkzeug für einen kollaborierenden roboter, roboter mit daran befestigtem werkzeug sowie kollisionsschutzverfahren
DE102016111173A1 (de) Verfahren zum Betreiben einer Greif- bzw. Spannvorrichtung
WO2018145990A1 (de) Vorrichtung zur absicherung eines maschinell gesteuerten handhabungsgeräts und verfahren
DE102014116257A1 (de) Motorsteuerung für einen Schutz des Werkzeugs und des zu bearbeitenden Objekts bei einem Schnellstopp
EP3415286A1 (de) Überwachung eines roboters
EP2644962A1 (de) Umformeinrichtung und Verfahren zum Betreiben der Letzteren
DE102015205494A1 (de) Manipulatorsystem zum Handhaben eines Werkstücks

Legal Events

Date Code Title Description
R082 Change of representative

Representative=s name: WUESTHOFF & WUESTHOFF, PATENTANWAELTE PARTG MB, DE

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