DE102014104175B4 - Mehrgelenkrobotor mit Gasverfahren und Schätzverfahren für den Gasfederinnendruck - Google Patents

Mehrgelenkrobotor mit Gasverfahren und Schätzverfahren für den Gasfederinnendruck Download PDF

Info

Publication number
DE102014104175B4
DE102014104175B4 DE102014104175.5A DE102014104175A DE102014104175B4 DE 102014104175 B4 DE102014104175 B4 DE 102014104175B4 DE 102014104175 A DE102014104175 A DE 102014104175A DE 102014104175 B4 DE102014104175 B4 DE 102014104175B4
Authority
DE
Germany
Prior art keywords
cylinder
piston rod
gas spring
internal pressure
gas
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
DE102014104175.5A
Other languages
English (en)
Other versions
DE102014104175A1 (de
Inventor
Yu c/o FANUC CORPORATION Hayashi
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 DE102014104175A1 publication Critical patent/DE102014104175A1/de
Application granted granted Critical
Publication of DE102014104175B4 publication Critical patent/DE102014104175B4/de
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1674Programme controls characterised by safety, monitoring, diagnostic
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/0008Balancing devices
    • B25J19/0012Balancing devices using fluidic devices
    • 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/36Nc in input of data, input key till input tape
    • G05B2219/36406Use a spring or gas pressure to keep tool on desired path

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Fluid-Damping Devices (AREA)

Abstract

Mehrgelenkroboter (2), umfassend: eine mechanische Robotereinheit (4), die mindestens einen Arm (12) aufweist; eine Gasfeder (16), die an dem Arm (12) angebracht ist; und einen Controller (6), der die mechanische Robotereinheit (4) steuert, wobei die Gasfeder (16) einen Zylinder (18), komprimierbares Inertgas, das in dem Zylinder (18) eingeschlossen ist, und eine Kolbenstange (20) umfasst, die dafür ausgelegt ist, im Zylinder (18) zu gleiten, und die Gasfeder (16) als Gasausgleicher ausgelegt ist, der die Last auf einem Servomotor (22) verringert, der den Arm (12) antreibt, und der Controller (6) die Funktion hat, die Gesamtbewegungsentfernung (D) der Kolbenstange (20) durch das Integrieren der Größe der Vorwärts- und Rückwärtsbewegung der Kolbenstange (20) gegen den Zylinder (18) zu berechnen, und das Ausmaß des Abfalls des Innendrucks (P) des komprimierbaren Inertgases abhängig von der Gesamtbewegungsentfernung (D) zu berechnen.

Description

  • HINTERGRUND DER ERFINDUNG
  • 1. Gebiet der Erfindung
  • Die Erfindung betrifft einen Mehrgelenkroboter mit einer Gasfeder. Sie betrifft insbesondere eine Vorgehensweise zum Schätzen der Höhe des Innendruckverlustes der Gasfeder.
  • 2. BESCHREIBUNG DES STANDS DER TECHNIK
  • In einer Gasfeder befindet sich eine Kolbenanordnung, in der ein komprimierbares Inertgas (im Weiteren einfach als ”Gas” bezeichnet) eingeschlossen ist, und die eine Reaktionskraft erzeugen kann, indem das Gas durch die Bewegung einer Kolbenstange gegen einen Zylinder zusammengedrückt wird. Eine solche Gasfeder ist in der Regel verglichen mit einer Schraubenfeder, die die gleichen Daten hat wie die Gasfeder, klein und leicht. Damit kann die Gasfeder die Größe und das Gewicht eines gesamten Systems verringern.
  • In einem Mehrgelenkroboter mit einer Schwerkraftachse kann als Vorrichtung, die eine Kraft (oder ein Drehmoment) eines Servomotors unterstützt, der die Achse betätigt, eine Vorrichtung (im Weiteren als Ausgleicher bezeichnet) verwendet werden, die eine Kraft in einer Richtung entgegengesetzt zur Lastrichtung aufgrund der Schwerkraft erzeugen kann. Wird eine Gasfeder in dem Ausgleicher verwendet (ein derartiger Ausgleicher wird als Gasausgleicher bezeichnet), so kann die Gasfeder, da die Abgabe der Gasfeder trotz ihres Gewichts und ihrer Größe relativ hoch ist, ein relativ großes Hilfsdrehmoment mit einem kompakten Mechanismus erzeugen. Daher kann man mit Hilfe der Gasfeder einen kompakten und leichten Roboter aufbauen, der eine relativ schwere Last befördern kann.
  • In JP H10-138189 A ist ein Ausgleicher zum Verringern eines Lastmoments einer vertikalen Drehachse 2 offenbart, die einen rotierenden Arm 3 auf einem Sockel 1 antreibt. Der Ausgleicher umfasst einen Zylinder 4, eine Stange 5 und einen Kolben 6. Eine Luftkompressionskammer 10 ist über ein Verbindungsteil 11 mit dem Zylinder 4 verbunden, und ein Gas, etwa Luft (komprimierbares Fluid) und viskose Flüssigkeit wie Öl sind in dem Zylinder 4 und der Kammer 10 eingeschlossen.
  • Bei Gasfedern ist bekannt, dass in dem Zylinder eingeschlossenes Gas durch die Bewegung der Kolbenstange gegen den Zylinder aus dem Zylinder austreten kann, wodurch der Innendruck des Zylinders nach und nach abnimmt. Dadurch sinkt die vom Ausgleicher erzeugte Kraft. Dies führt zu einem Alarm, der darüber informiert, dass zu wenig Drehmoment ausgegeben wird, und der Roboter wird mit einem Nothalt angehalten.
  • Als Mittel, mit denen man diese Nachteile durch den verringerten Innendruck des Zylinders vermeiden kann, werden einige Vorgehensweisen vorgeschlagen. Beispielsweise ist in JP 2007-298513 A eine Kreisdruck-Anzeigevorrichtung offenbart, die den verringerten Innendruck eines Gasfederkreises anzeigen kann. In JP 2009-270987 A ist eine Druckanzeige für eine Gasfeder offenbart, die dafür ausgelegt ist, den Druck des komprimierbaren Gases anzuzeigen, das in einer Gasfüllkammer der Gasfeder enthalten ist.
  • Zudem ist in JP 2012-519083 A eine Ausgleichervorrichtung offenbart, die eine Gasfeder 4 und ein Kompressionssystem 5 enthält. Das Kompressionssystem 5 umfasst einen Kompressor 6 und ein automatisches Kontrollsystem 7, dass den Druck in der Gasfeder 4 einstellt, wobei das automatische Kontrollsystem 7 ein Drucksteuerventil 9 kontrolliert, um die Gasströmungsrate von oder zu der Gasfeder 4 zu begrenzen, und zwar abhängig von einem Signal von einem Drucksensor 8, der den Druck der Gasfeder 4 feststellt.
  • In JP 2007-298513 A oder JP 2009-270987 A ist beschrieben, dass, wenn ein Druckanzeiger außen an der Gasfeder angebracht wird, die Kosten der Einrichtung abhängig von den Kosten der Druckanzeige steigen. Es ist erforderlich, eine Verbindungsvorrichtung anzubringen, beispielsweise einen Verbinder zwischen der Druckanzeige und der Gasfeder. Die Verbindungsvorrichtung erhöht wiederum die Wahrscheinlichkeit eines Gaslecks. Zudem kann ein Gasaustritt durch das Brechen der Druckanzeige vorkommen.
  • In JP 2012-519083 A ist beschrieben, dass, wenn der Drucksensor und das Druckkontrollventil in der Gasfeder angebracht werden, die Kosten der Einrichtung abhängig von den Kosten des Sensors und des Ventils steigen, und dass die Wahrscheinlichkeit eines Gaslecks steigt, wie auch in JP 2007-298513 A oder JP 2009-270987 A . Da zudem eine Vorrichtung wie etwa ein Gastank 11 erforderlich ist, der mit dem Drucksteuerventil 9 verbunden ist, können die Zusatzeinrichtungen umfangreicher werden.
  • ZUSAMMENFASSUNG DER ERFINDUNG
  • Es ist daher Aufgabe der Erfindung, einen Mehrgelenkroboter bereitzustellen, der eine Funktion zum Schätzen des Ausmaßes des Innendruckabfalls einer Gasfeder aufweist, und zwar mit Hilfe einer einfachen und kostengünstigen Anordnung, sowie ein Verfahren zum Schätzen des Ausmaßes des Innendruckabfalls der Gasfeder.
  • Gemäß einem Aspekt der Erfindung wird ein Mehrgelenkroboter bereitgestellt, umfassend: eine mechanische Robotereinheit, die mindestens einen Arm aufweist; eine Gasfeder, die an dem Arm angebracht ist; und einen Controller, der die mechanische Robotereinheit steuert, wobei die Gasfeder einen Zylinder, komprimierbares Inertgas, das in dem Zylinder eingeschlossen ist, und eine Kolbenstange umfasst, die dafür ausgelegt ist, im Zylinder zu gleiten, und die Gasfeder als Gasausgleicher ausgelegt ist, der die Last auf einem Servomotor verringert, der den Arm antreibt, und der Controller die Funktion hat, die Gesamtbewegungsentfernung der Kolbenstange durch das Integrieren der Größe der Vorwärts- und Rückwärtsbewegung der Kolbenstange gegen den Zylinder zu berechnen, und das Ausmaß des Innendruckabfalls des komprimierbaren Inertgases abhängig von der Gesamtbewegungsentfernung zu berechnen.
  • In einer bevorzugten Ausführungsform berechnet der Controller die Gesamtbewegungsentfernung der Kolbenstange durch das Integrieren einer Differenz der herausragenden Länge der Kolbenstange aus dem Zylinder in sehr kurzen Zeitintervallen, wobei die herausragende Länge geometrisch aus dem Drehwinkel des Arms berechnet wird.
  • In einer bevorzugten Ausführungsform berechnet der Controller das Ausmaß des Innendruckabfalls des komprimierbaren Inertgases mit Hilfe mindestens eines der folgenden Parameter: der Betrag des Innendrucks des Zylinders; Vorwärts- und Rückwärts-Bewegungsgeschwindigkeit der Kolbenstange gegen den Zylinder; und Temperatur der Gasfeder sowie Gesamtbewegungsentfernung der Kolbenstange.
  • In einer bevorzugten Ausführungsform umfasst der Roboter Mittel, die dafür ausgelegt sind, sichtbar oder hörbar zumindest entweder die berechnete Gesamtbewegungsentfernung der Kolbenstange oder das Ausmaß des Innendruckabfalls des komprimierbaren Inertgases auszugeben.
  • Gemäß einem weiteren Aspekt der Erfindung wird ein Verfahren zum Schätzen des Ausmaßes des Innendruckabfalls einer Gasfeder eines Mehrgelenkroboters bereitgestellt, wobei der Mehrgelenkroboter umfasst: eine mechanische Robotereinheit, die mindestens einen Arm aufweist; eine Gasfeder, die an dem Arm angebracht ist; und einen Controller, der die mechanische Robotereinheit steuert, wobei die Gasfeder einen Zylinder, komprimierbares Inertgas, das in dem Zylinder eingeschlossen ist, und eine Kolbenstange umfasst, die dafür ausgelegt ist, im Zylinder zu gleiten, und die Gasfeder als Gasausgleicher ausgelegt ist, der die Last auf einem Servomotor verringert, der den Arm antreibt, und das Verfahren die Schritte umfasst: das Berechnen einer Gesamtbewegungsentfernung der Kolbenstange durch das Integrieren der Größe der Vorwärts- und Rückwärtsbewegung der Kolbenstange gegen den Zylinder, und das Berechnen des Ausmaßes des Innendruckabfalls des komprimierbaren Inertgases abhängig von der Gesamtbewegungsentfernung.
  • KURZE BESCHREIBUNG DER ZEICHNUNGEN
  • Die genanten Aufgaben, Vorteile und Merkmale der Erfindung und weitere Aufgaben, Vorteile und Merkmale gehen aus der folgenden Beschreibung von bevorzugten Ausführungsformen anhand der beiliegenden Zeichnungen deutlicher hervor.
  • Es zeigt:
  • 1 eine Aufbauskizze eines Mehrgelenkroboters einer bevorzugten Ausführungsform der Erfindung;
  • 2 ein Flussdiagramm eines Beispiels der Bewegungsteuerung, die ein Controller des Mehrgelenkroboters in 1 ausführt;
  • 3 eine Ansicht eines ersten Anordnungsbeispiels zum Berechnen der Gesamtbewegungsentfernung einer Kolbenstange gegen einen Zylinder;
  • 4 eine Ansicht eines zweiten Anordnungsbeispiels zum Berechnen der Gesamtbewegungsentfernung einer Kolbenstange gegen einen Zylinder; und
  • 5 ein Flussdiagramm einer Prozedur zum Berechnen der Gesamtbewegungsentfernung der Kolbenstange und des Ausmaßes des Innendruckabfalls einer Gasfeder mit Hilfe der Anordnung in 4.
  • AUSFÜHRLICHE BESCHREIBUNG
  • 1 zeigt eine Aufbauskizze eines Mehrgelenkroboters einer bevorzugten Ausführungsform der Erfindung. Der Mehrgelenkroboter 2 enthält eine mechanische Robotereinheit 4, die mindestens einen Arm 12 aufweist, einen Controller 6, der die mechanische Robotereinheit 4 steuert, und eine Gasfeder, die an dem mindestens einen Arm angebracht ist. In der dargestellten Ausführungsform umfasst die mechanische Robotereinheit 4 einen Sockel 8, einen rotierenden Körper 10, der drehbar an dem Sockel 8 angebracht ist, einen unteren Arm 12, der drehbar am rotierenden Körper 10 angebracht ist, und einen oberen Arm 14, der drehbar am unteren Arm 12 angebracht ist. Der Mehrgelenkroboter 2 weist ferner eine Gasfeder 16 auf, die dem unteren Arm 12 zugeordnet ist. Die Gasfeder 16 enthält einen Zylinder 18, der drehbar am unteren Arm 12 angebracht ist, und eine Kolbenstange 20, die drehbar am rotierenden Körper 10 angebracht ist, wobei die Kolbenstange 20 dafür ausgelegt ist, im Zylinder 18 zu gleiten. Im Zylinder 18 ist komprimierbares Inertgas eingeschlossen. Die Gasfeder 16 dient als Gasausgleicher zum Verringern der Last eines Servomotors 22, der den unteren Arm 12 antreibt, auf den eine Schwerkraftlast ausgeübt wird.
  • Der Controller 6 ist über ein Stromversorgungskabel usw. an die mechanische Robotereinheit 4 angeschlossen, damit die Bewegung einer jeden Achse der mechanischen Robotereinheit 4 gesteuert wird. Der Controller 6 kann eine Bedientafel 26 mit einem Monitor aufweisen, auf dem die Gesamtbewegungsentfernung der Kolbenstange 20 und/oder der geschätzte Innendruck des Zylinders 18 angezeigt wird.
  • Der Gasdruck (oder Innendruck) im Zylinder 18 der Gasfeder 16 nimmt aufgrund der Bewegung des Arms (in diesem Fall des unteren Arms 12) ab, dem die Gasfeder 16 zugeordnet ist. Als Ursache für den Innendruckabfall sind ein Gasaustritt durch den engen Spalt zwischen der Kolbenstange 20 und einem Dichtungsteil (nicht dargestellt), das das komprimierbare Gas innerhalb der Gasfeder einschließt, wegen der Bewegung der Kolbenstange denkbar, und/oder ein Abrieb des Dichtungsteils durch die Bewegung der Kolbenstange 20. Da sich gezeigt hat, dass das Ausmaß des Innendruckabfalls des Gasdrucks durch die obigen Ursachen stark mit der Gesamtbewegungsentfernung korreliert ist, die man durch Integrieren der Größe der Vorwärts- und Rückwärtsbewegung der Kolbenstange 20 gegen den Zylinder 18 erhält, wird in der Erfindung das Ausmaß des Innendruckabfalls in der Gasfeder durch das Berechnen der Gesamtbewegungsentfernung geschätzt.
  • 2 zeigt ein Flussdiagramm eines Beispiels der Bewegungsteuerung, die ein Controller 6 für den Mehrgelenkroboter 2 in Mikrozeitintervallen vornimmt (oder in den Steuerzeitperioden). Der Controller 6 erzeugt einen Befehl zum Steuern der Bewegung einer jeden Achse des Mehrgelenkroboters 2 in vorbestimmten Steuerzeitperioden und überträgt den Befehl gemäß einem gegebenen Roboterprogramm an den Roboter 2 usw. In der Ausführungsform in 2 führt der Controller 6 Prozeduren A bis D in Mikrozeitintervallen aus. Die Prozedur C entspricht einer Prozedur zum Berechnen des Ausmaßes des Innendruckabfalls der Gasfeder. Damit kann die Prozedur zum Berechnen des Ausmaßes des Innendruckabfalls leicht in die Prozeduren eingegliedert werden, die der Controller 6 ausführt.
  • 3 zeigt eine Ansicht eines ersten Anordnungsbeispiels zum Berechnen der Gesamtbewegungsentfernung der Kolbenstange 20 gegen den Zylinder 18. Die Gesamtbewegungsentfernung ist die Grundlage zum Berechnen des Ausmaßes des Innendruckabfalls der Gasfeder 16. An der Kolbenstange 20 der Gasfeder 16 wird ein Bereichssensor (oder Entfernungssensor) 28 angebracht, beispielsweise ein Laserentfernungsmesser. Der Bereichssensor wird im Wesentlichen integriert mit der Kolbenstange 20 betrieben. Der Bereichssensor 28 ist dafür ausgelegt, die Entfernung zwischen dem Bereichssensor 28 und einem festen Abschnitt bzw. einer festen Oberfläche 30 zu erfassen, die ein Teil des Zylinders 18 sind. Die Größe der Entfernungsveränderung, die der Bereichssensor 28 erfasst, entspricht der Vorwärts- und Rückwärtsbewegungsentfernung der Kolbenstange 20 gegen den Zylinder 18. Integriert man die Größe der Entfernungsveränderung, die der Bereichssensor 28 erfasst, so kann man die Gesamtbewegungsentfernung der Kolbenstange 20 gegen den Zylinder 18 berechnen.
  • Häufig führt der untere Arm 12 irreguläre Schwenkbewegungen aus. Damit ist die Vorwärts- und Rückwärtsbewegung der Kolbenstange 20 der Gasfeder, die am unteren Arm 12 angeordnet ist, ebenfalls kompliziert. In diesem Fall ist es zum Berechnen der Größe der Veränderung der herausstehenden Entfernung der Kolbenstange 20 mit dem Bereichssensor nötig, den Bereichssensor am Zylinder 18 oder der Kolbenstange 20 anzubringen, wodurch das Anbringen des Sensors schwierig werden kann. Im Weiteren wird ein Beispiel zum Berechnen der herausstehenden Länge der Kolbenstange ohne einen Bereichssensor erklärt.
  • 4 zeigt eine Ansicht eines zweiten Anordnungsbeispiels zum Berechnen der Gesamtbewegungsentfernung der Kolbenstange 20 gegen den Zylinder 18. Das zweite Anordnungsbeispiel ist insbesondere für den Mehrgelenkroboter 2 in 1 verfügbar. In diesem Beispiel wird die Bewegungsentfernung des Kolbens 20 gegen den Zylinder 18 berechnet, wenn der untere Arm 12 eine Drehbewegung aus einer ersten Position (in 4 dargestellt durch eine unterbrochenen Linie mit jeweils zwei Punkten), in der der untere Arm 12 im Wesentlichen in der vertikalen Richtung verläuft, in eine Position gebracht wird (in 4 dargestellt durch eine durchgezogene Linie), wobei der untere Arm 12 um den Winkel θ in der Gegenuhrzeigerrichtung gegen den rotierenden Körper 10 gedreht wird.
  • Die Entfernung vom Verbindungspunkt 32 zwischen dem unteren Arm 12 und der Gasfeder 16 (Zylinder 18), siehe 4, zum Drehpunkt 34 des unteren Arms 12 wird als Entfernung ”a” bezeichnet. Die Entfernung vom Verbindungspunkt 36 zwischen dem rotierenden Körper 10 und der Gasfeder 16 (Kolbenstange 20) zum Drehpunkt 34 des unteren Arms 12 wird als Entfernung ”b” bezeichnet. Die Gesamtlänge des Zylinders 18 wird als Entfernung ”c” bezeichnet. Damit kann die hervorstehende Länge ”d” der Kolbenstange 20 aus dem Zylinder 18 mit Hilfe der folgenden Gleichung (1) geometrisch berechnet werden. d = (a2 + b2 – 2·a·b·cos(180 – θ))1/2 – c (1)
  • In Gleichung (1) sind die Entfernungen a, b und c konstant. Erfasst man den Drehwinkel θ des unteren Arms 12 in Mikrozeitperioden, so kann man die hervorstehende Länge d der Kolbenstange 20 geometrisch leicht berechnen. Da man im Beispiel in 4 den Drehwinkel θ mit einem Geber (nicht dargestellt) erfassen kann, der für die Regelung des unteren Arms 12 verwendet wird, ist es nicht erforderlich, einen Bereichssensor usw. wie im Beispiel in 3 zu verwenden.
  • 5 zeigt ein Flussdiagramm einer Einzelheit der Prozedur C im Flussdiagramm in 2, wobei die Gesamtbewegungsentfernung der Kolbenstange und das Ausmaß des Innendruckabfalls der Gasfeder mit Hilfe der Anordnung in 4 berechnet werden. Zuerst wird im Schritt S1 der Drehwinkel θ des unteren Arms 12 gegen den rotierenden Körper 10 gelesen. Als Drehwinkel θ kann ein Ausgabewert eines Gebers usw. verwendet werden, der den Drehwinkel des unteren Arms 12 erfassen kann.
  • Nun wird im Schritt S2 eine hervorstehende Länge d1 der Kolbenstange 20 aus dem Zylinder 18 berechnet, und zwar aus dem geometrischen Zusammenhang zwischen dem rotierenden Körper 10, dem unteren Arm 12 und der Gasfeder 16 (konkret dem Positionszusammenhang zwischen dem Drehpunkt 34, dem Verbindungspunkt 32 und dem Verbindungspunkt 36).
  • Im Schritt S3 wird die Differenz (Betrag) zwischen d1 und der hervorstehenden Länge d0 der Kolbenstange, die durch die gleiche Berechnung in der vorhergehenden bzw. letzten Regelperiode erhalten wurde, als Differenz Δd ermittelt (= |d1 – d0|). Anders ausgedrückt entspricht die Differenz Δd der Bewegungsentfernung der Kolbenstange 20 in jeder Regelperiode während des Roboterbetriebs.
  • Im Schritt S4 wird die Gesamtbewegungsentfernung D der Kolbenstange 20 gegen den Zylinder 18 aktualisiert. Konkret wird die im Schritt S3 berechnete Differenz Δd zu einer Gesamtbewegungsentfernung D addiert, die in der vorhergehenden bzw. letzten Regelperiode erhalten wurde. Das Ergebnis liefert die neue Gesamtbewegungsentfernung.
  • Im Schritt S5 wird ausgehend von der aktualisierten Gesamtbewegungsentfernung D das Ausmaß des Innendruckabfalls der Gasfeder berechnet. Im Beispiel in 5 wird, da sich herausgestellt hat, dass das Ausmaß des Abfalls des Innendrucks P ungefähr proportional zur Gesamtbewegungsentfernung D ist, das Ausmaß des Abfalls des Innendrucks P durch das Multiplizieren der Gesamtbewegungsentfernung D mit einem Innendruck-Konversionsfaktor K1 berechnet. Das Berechnungsergebnis wird als geschätztes Ausmaß des Innendruckabfalls angesehen. Zusätzlich kann die Gesamtbewegungsentfernung D und das Ausmaß des Abfalls des Innendrucks P durch Software berechnet werden, die im Controller 6 enthalten ist.
  • Im Schritt S6 wird das berechnete Ausmaß des Abfalls des Innendrucks P in Echtzeit auf dem Monitor der Bedientafel 26 des Controllers 6 angezeigt. Hierdurch kann eine Bedienperson in einfacher Weise über das Ausmaß des Innendruckabfalls der Gasfeder informiert werden und rasch notwendige Maßnahmen einleiten, die dem Ausmaß des Abfalls entsprechen. Anstelle oder zusätzlich zum Ausmaß des Innendruckabfalls kann die im Schritt S4 berechnete Gesamtbewegungsentfernung D angezeigt werden. Zudem kann ein Alarm ausgegeben werden, wenn das Ausmaß des Innendruckabfalls oder die Gesamtbewegungsentfernung einen vorbestimmten Grenzwert überschreitet. Damit kann der Controller 6 zumindest entweder die Gesamtbewegungsentfernung D oder das Ausmaß des Abfalls des Innendrucks P in Echtzeit ausgeben. Dadurch wird die Bedienperson unverzüglich in sichtbarer oder hörbarer Weise auf die ausgegebene Information aufmerksam gemacht.
  • Schließlich wird im Schritt S7 die im Schritt S2 berechnete Differenz d1 für die Verarbeitung in der folgenden Regelperiode auf d0 aktualisiert. Die Verarbeitung im Schritt S7 kann zu jeder beliebigen Zeit nach dem Schritt S3 ausgeführt werden.
  • Dem Flussdiagramm in 5 kann man entnehmen, dass durch Integrieren der Differenz der aus dem Zylinder hervorstehenden Länge der Kolbenstange, die über den Drehwinkel des Arms in Mikrozeitintervallen berechnet wird, die Gesamtbewegungsentfernung der Kolbenstange berechnet werden kann, und man kann das Ausmaß des Innendruckabfalls der Gasfeder schätzen, indem man die berechnete Gesamtbewegungsentfernung der Kolbenstange als Parameter verwendet.
  • Im Beispiel in 5 wird das Ausmaß des Innendruckabfalls der Gasfeder als proportional zur Gesamtbewegungsentfernung der Kolbenstange angesehen (P = K1 × D). In Wirklichkeit hängt das Ausmaß des Innendruckabfalls der Gasfeder auch vom Betrag des Innendrucks im Zylinder ab, der Vorwärts- und Rückwärts-Bewegungsgeschwindigkeit der Kolbenstange gegen den Zylinder und der Temperatur (oder der Umgebungstemperatur) der Gasfeder usw. Daher kann man in der Verarbeitung im Schritt S5 das Ausmaß des Innendruckabfalls der Gasfeder berechnen, indem man eine Gleichung verwendet, die zumindest den Betrag des Innendrucks im Zylinder, die Vorwärts- und Rückwärts-Bewegungsgeschwindigkeit der Kolbenstange gegen den Zylinder oder die Temperatur der Gasfeder als Parameter enthält, sowie die Gesamtbewegungsentfernung der Kolbenstange. Beispielsweise kann man die Daten des Ausmaßes des Innendruckabfalls der Gasfeder vorab und experimentell erhalten, indem man den Betrag des Innendrucks im Zylinder ändert sowie die Vorwärts- und Rückwärts-Bewegungsgeschwindigkeit der Kolbenstange gegen den Zylinder oder die Temperatur der Gasfeder, und eine Korrelationsgleichung kann erzeugt werden, indem man einen Parameter anhand dieser Daten in Betracht zieht. Bezieht man andere Parameter als die Gesamtbewegungsentfernung ein, so kann das Ausmaß des Innendruckabfalls genauer geschätzt werden, weil es an die tatsächlichen Gebrauchsbedingungen der Gasfeder angepasst ist.
  • Oben wurde die bevorzugte Ausführungsform der Erfindung erklärt. Die Erfindung ist jedoch nicht auf diese Ausführungsform eingeschränkt. Obwohl beispielsweise die anhand von 1 erklärte Gasfeder den Servomotor 22 des unteren Arms 12 unterstützt, der sich in der Vorwärts- und Rückwärts-Richtung Hin und Her bewegt (der horizontalen Richtung), kann eine Gasfeder eines Roboters, die dafür ausgelegt ist, eine Antriebsachse zu unterstützen, auf die die Schwerkraft einwirkt, die oben beschriebene Funktion und den gleichen Effekt haben. Anders gesagt kann die Erfindung auf den unteren Arm 12 angewendet werden, wenn der untere Arm in der Vertikalen oder einer geneigten Richtung schwenkt, und sie kann auch auf einen Arm angewendet werden, der nicht der untere Arm ist. Da der geometrische Zusammenhang zwischen der Gasfeder und dem Roboterarm verschiedene Formen annehmen kann, ist die Gleichung zum Berechnen der hervorstehenden Länge der Kolbenstange nicht auf die vorstehende Gleichung (1) eingeschränkt.
  • Da gemäß der Erfindung das Ausmaß des Innendruckabfalls der Gasfeder aus der Gesamtbewegungsentfernung der Kolbenstange gegen den Zylinder geschätzt werden kann, ist eine Druckmessvorrichtung oder ein Sensor zum Messen des Innendrucks nicht nötig. Dadurch kann ein System, das den Roboter enthält, kompakt und kostengünstig ausfallen.
  • Durch das geometrische Berechnen der Gesamtbewegungsentfernung der Kolbenstange aus dem Drehwinkel des Arms in Mikrozeitintervallen ist ein Bereichssensor usw. nicht nötig, wodurch die Systemkosten weiter gesenkt werden können.
  • Wird das Ausmaß des Innendruckabfalls der Gasfeder berechnet, so kann der Umfang des Innendruckabfalls genauer geschätzt werden, indem man zumindest entweder den Betrag des Innendrucks im Zylinder, die Vorwärts- und Rückwärts-Bewegungsgeschwindigkeit der Kolbenstange gegen den Zylinder oder die Temperatur der Gasfeder als Parameter einbezieht, und zudem die Gesamtbewegungsentfernung der Kolbenstange.
  • Gibt man zumindest entweder die Gesamtbewegungsentfernung der Kolbenstange oder das Ausmaß des Innendruckabfalls des Gases sichtbar oder hörbar aus, so kann die Bedienperson rasch in sichtbarer oder hörbarer Weise auf die ausgegebene Information aufmerksam gemacht werden.

Claims (5)

  1. Mehrgelenkroboter (2), umfassend: eine mechanische Robotereinheit (4), die mindestens einen Arm (12) aufweist; eine Gasfeder (16), die an dem Arm (12) angebracht ist; und einen Controller (6), der die mechanische Robotereinheit (4) steuert, wobei die Gasfeder (16) einen Zylinder (18), komprimierbares Inertgas, das in dem Zylinder (18) eingeschlossen ist, und eine Kolbenstange (20) umfasst, die dafür ausgelegt ist, im Zylinder (18) zu gleiten, und die Gasfeder (16) als Gasausgleicher ausgelegt ist, der die Last auf einem Servomotor (22) verringert, der den Arm (12) antreibt, und der Controller (6) die Funktion hat, die Gesamtbewegungsentfernung (D) der Kolbenstange (20) durch das Integrieren der Größe der Vorwärts- und Rückwärtsbewegung der Kolbenstange (20) gegen den Zylinder (18) zu berechnen, und das Ausmaß des Abfalls des Innendrucks (P) des komprimierbaren Inertgases abhängig von der Gesamtbewegungsentfernung (D) zu berechnen.
  2. Mehrgelenkroboter (2) nach Anspruch 1, dadurch gekennzeichnet, dass der Controller (6) die Gesamtbewegungsentfernung (D) der Kolbenstange (20) durch das Integrieren einer Differenz der herausragenden Länge (d) der Kolbenstange (20) aus dem Zylinder (18) in sehr kurzen Zeitintervallen berechnet, wobei die herausragende Länge (d) geomerisch aus dem Drehwinkel (0) des Arms (12) berechnet wird.
  3. Mehrgelenkroboter (2) nach Anspruch 1 oder 2, dadurch gekennzeichnet, dass der Controller (6) das Ausmaß des Innendruckabfalls (P) des komprimierbaren Inertgases mit Hilfe mindestens eines der folgenden Parameter berechnet: Betrag des Innendrucks des Zylinders (18); Vorwärts- und Rückwärts-Bewegungsgeschwindigkeit der Kolbenstange (20) gegen den Zylinder (18); und Temperatur der Gasfeder (16) sowie die Gesamtbewegungsentfernung (D) der Kolbenstange (20).
  4. Mehrgelenkroboter (2) nach irgendeinem der Ansprüche 1 bis 3, dadurch gekennzeichnet, dass der Roboter Mittel (26) umfasst, die dafür ausgelegt sind, sichtbar oder hörbar zumindest entweder die berechnete Gesamtbewegungsentfernung (D) der Kolbenstange (20) oder das Ausmaß des Innendruckabfalls (P) des komprimierbaren Inertgases auszugeben.
  5. Verfahren zum Schätzen des Ausmaßes des Innendruckabfalls (P) einer Gasfeder (16) eines Mehrgelenkroboters (2), wobei der Mehrgelenkroboter (2) umfasst: eine mechanische Robotereinheit (4), die mindestens einen Arm (12) aufweist; eine Gasfeder (16), die an dem Arm (12) angebracht ist; und einen Controller (6), der die mechanische Robotereinheit (4) steuert, wobei die Gasfeder (16) einen Zylinder (18), komprimierbares Inertgas, das in dem Zylinder (18) eingeschlossen ist, und eine Kolbenstange (20) umfasst, die dafür ausgelegt ist, im Zylinder (18) zu gleiten, und die Gasfeder (16) als Gasausgleicher ausgelegt ist, der die Last auf einem Servomotor (22) verringert, der den Arm (12) antreibt, und das Verfahren die Schritte umfasst: das Berechnen einer Gesamtbewegungsentfernung (D) der Kolbenstange (20) durch das Integrieren der Größe der Vorwärts- und Rückwärtsbewegung der Kolbenstange (20) gegen den Zylinder (18); und das Berechnen des Ausmaßes des Abfalls des Innendrucks (P) des komprinierbaren lnertgases abhängig von der Gesamtbewegungsentfernung (D).
DE102014104175.5A 2013-03-29 2014-03-26 Mehrgelenkrobotor mit Gasverfahren und Schätzverfahren für den Gasfederinnendruck Active DE102014104175B4 (de)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2013-071433 2013-03-29
JP2013071433A JP5612150B2 (ja) 2013-03-29 2013-03-29 ガススプリングを備えた多関節ロボット、及びガススプリングの内圧を推定する方法

Publications (2)

Publication Number Publication Date
DE102014104175A1 DE102014104175A1 (de) 2014-10-16
DE102014104175B4 true DE102014104175B4 (de) 2015-07-30

Family

ID=51592352

Family Applications (1)

Application Number Title Priority Date Filing Date
DE102014104175.5A Active DE102014104175B4 (de) 2013-03-29 2014-03-26 Mehrgelenkrobotor mit Gasverfahren und Schätzverfahren für den Gasfederinnendruck

Country Status (4)

Country Link
US (1) US9102064B2 (de)
JP (1) JP5612150B2 (de)
CN (1) CN104070538B (de)
DE (1) DE102014104175B4 (de)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102018220132B4 (de) 2017-11-28 2024-08-14 Fanuc Corporation Roboter und Kollisionserkennungsverfahren dafür

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105108777A (zh) * 2015-10-14 2015-12-02 南京埃斯顿机器人工程有限公司 工业机器人第二关节平衡机构
KR101734241B1 (ko) * 2015-12-10 2017-05-11 현대자동차 주식회사 트렁크 리드 힌지 지능형 로더유닛
JP6745119B2 (ja) * 2016-03-09 2020-08-26 川崎重工業株式会社 関節型ロボットおよびそのガススプリングのガス減少状態推定方法
JP7084202B2 (ja) * 2018-05-10 2022-06-14 川崎重工業株式会社 関節型ロボット及びそのガススプリングのガス減少状態の推定方法
JP7473317B2 (ja) * 2019-10-11 2024-04-23 ファナック株式会社 ガススプリングのメンテナンス管理装置、ロボットシステムおよびガススプリングのメンテナンス管理方法
JP7401297B2 (ja) * 2019-12-26 2023-12-19 ファナック株式会社 バランサの異常検出システム及びバランサの異常検出方法
CN114739562A (zh) * 2021-01-07 2022-07-12 配天机器人技术有限公司 一种工业机器人用氮气弹簧压力监测系统及工业机器人

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3150511A1 (de) * 1981-12-21 1983-06-30 Produtec-Entwicklungs- und Planungsgesellschaft für Produktionssysteme und Automatisierungstechnik mbH, 7000 Stuttgart Antriebselement fuer ein handhabungsgeraet
DE3317425A1 (de) * 1983-05-13 1984-08-09 Daimler-Benz Ag, 7000 Stuttgart Halterung fuer ein bearbeitungswerkzeug an einem roboterkopf
JPH10138189A (ja) * 1996-10-31 1998-05-26 Fanuc Ltd ロボット用バランサ
JP2007298513A (ja) * 2006-05-05 2007-11-15 Soc Des Usines Quiri & Co 回路圧力表示装置
EP1932631A1 (de) * 2006-12-13 2008-06-18 Fotona d.d. Manuell geführter Gelenkarm
JP2009270987A (ja) * 2008-05-09 2009-11-19 Pascal Engineering Corp ガススプリング用圧力インジケータ
JP2012519083A (ja) * 2009-02-26 2012-08-23 ストルムショルメン アーベー 気体ばねを備える、2つの相互に可動な部品を釣合わせる釣合い装置及び方法

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS61109679A (ja) * 1984-11-01 1986-05-28 株式会社東芝 産業用ロボツト
JPS63180491A (ja) * 1987-01-19 1988-07-25 フアナツク株式会社 垂直多関節型ロボツトのバランサ機構
JPH0631680A (ja) * 1992-07-20 1994-02-08 Tokico Ltd 工業用ロボット
SE516448C2 (sv) * 1995-01-27 2002-01-15 Abb Ab Anordning för utbalansering av en arm hos en industrirobot samt användning av anordningen
CN2312364Y (zh) * 1996-11-22 1999-03-31 北京医疗设备四厂 平衡气弹簧装置
JPH10180665A (ja) * 1996-12-27 1998-07-07 Aichi Corp 作業用アーム
JPH1148185A (ja) * 1997-08-06 1999-02-23 Fanuc Ltd 密閉型エアバランサ
JP4523977B2 (ja) * 2008-03-19 2010-08-11 関東自動車工業株式会社 ロボット内蔵減速機の故障診断方法及び装置
CN201193667Y (zh) * 2008-05-12 2009-02-11 杨世铭 气弹簧

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3150511A1 (de) * 1981-12-21 1983-06-30 Produtec-Entwicklungs- und Planungsgesellschaft für Produktionssysteme und Automatisierungstechnik mbH, 7000 Stuttgart Antriebselement fuer ein handhabungsgeraet
DE3317425A1 (de) * 1983-05-13 1984-08-09 Daimler-Benz Ag, 7000 Stuttgart Halterung fuer ein bearbeitungswerkzeug an einem roboterkopf
JPH10138189A (ja) * 1996-10-31 1998-05-26 Fanuc Ltd ロボット用バランサ
JP2007298513A (ja) * 2006-05-05 2007-11-15 Soc Des Usines Quiri & Co 回路圧力表示装置
EP1932631A1 (de) * 2006-12-13 2008-06-18 Fotona d.d. Manuell geführter Gelenkarm
JP2009270987A (ja) * 2008-05-09 2009-11-19 Pascal Engineering Corp ガススプリング用圧力インジケータ
JP2012519083A (ja) * 2009-02-26 2012-08-23 ストルムショルメン アーベー 気体ばねを備える、2つの相互に可動な部品を釣合わせる釣合い装置及び方法

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102018220132B4 (de) 2017-11-28 2024-08-14 Fanuc Corporation Roboter und Kollisionserkennungsverfahren dafür

Also Published As

Publication number Publication date
JP2014193516A (ja) 2014-10-09
CN104070538A (zh) 2014-10-01
US9102064B2 (en) 2015-08-11
CN104070538B (zh) 2015-07-01
US20140297032A1 (en) 2014-10-02
JP5612150B2 (ja) 2014-10-22
DE102014104175A1 (de) 2014-10-16

Similar Documents

Publication Publication Date Title
DE102014104175B4 (de) Mehrgelenkrobotor mit Gasverfahren und Schätzverfahren für den Gasfederinnendruck
DE102014104173B4 (de) Mehrgelenkrobotor mit Gasfeder und Berechnungsverfahren für den Gasfederinnendruck
DE102016012065B4 (de) Robotersystem mit Funktion zum Berechnen von Position und Ausrichtung eines Sensors
DE102015200355B3 (de) Medizinische roboterartige Vorrichtung mit Kollisionsdetektion und Verfahren zur Kollisionsdetektion einer medizinischen roboterartigen Vorrichtung
EP2984350B1 (de) Elektrohydraulischer steuerkreis
DE102014019035B4 (de) Verfahren zur Beurteilung einer äußeren Kraft und Vorrichtung zur Beurteilung einer äußeren Kraft eines mit Menschen kollaborierenden Industrieroboters
DE102017005043A1 (de) Vorrichtung und Verfahren zum Erkennen einer Abnormalität eines Gelenks eines Parallelarmroboters
DE19837595B4 (de) Verfahren und Vorrichtung zum Gewichtsausgleich eines Roboterarms
EP3039289B1 (de) Verfahren zur bestimmung von hydraulischen parametern in einer verdrängerpumpe
DE102016002338B4 (de) Roboter-Steuerungsvorrichtung, die den erneuten Start eines Betriebsprogramms beurteilt
DE102015108010B3 (de) Steuern und Regeln von Aktoren eines Roboters unter Berücksichtigung von Umgebungskontakten
EP1607714B1 (de) Verfahren und Messanordnung zur Spielmessung an einem Achsgelenk
EP3078460B1 (de) Verfahren zum steuern von zumindest einem manipulator unter verwendung zumindest einer kraftkompensationsvorrichtung
EP3204194B1 (de) Verfahren zur optimierung des betriebs einer handhabungseinheit, insbesondere einer linear- oder schwenkeinheit, und anordnung hierfür
DE102017004737A1 (de) Verstellbare lastaufnehmende Vorrichtung für Flurförderzeuge, insbesondere Gabelstapler
EP0245624B1 (de) Knickschutzvorrichtung für Gelenkfahrzeuge
DE69819796T2 (de) Ventilantrieb mit Überwachung der Funktionsfähigkeit
DE102019120157B3 (de) Verifikation eines Massemodells eines Robotermanipulators
WO2018060060A1 (de) Verfahren zum betreiben von sich autonom bewegenden plattformen und hindernisschutzsensor
EP3335007B1 (de) Navigationsvorrichtung mit drehtisch für eine umschlagsmessung und verfahren zum betreiben der navigationsvorrichtung
DE102013006220B4 (de) Pneumatischer Antrieb und Verfahren zur Erfassung der Leistung eines pneumatischen Antriebs
DE102020125571A1 (de) Gasfederwartungsmanagementvorrichtung, robotersystem und gasfederwartungsmanagementverfahren
EP3366431B1 (de) Fördervorrichtung zum befördern von objekten und/oder personen
DE102020124867A1 (de) Verbesserte Hydraulikvorrichtung
EP3876890A1 (de) Tragarmsystem für ein medizinisches gerät, verfahren zum betreiben eines tragarmsystem sowie verfahren zum gestalten eines tragarmsystems

Legal Events

Date Code Title Description
R082 Change of representative

Representative=s name: HASELTINE LAKE LLP, DE

R012 Request for examination validly filed
R012 Request for examination validly filed

Effective date: 20141015

R018 Grant decision by examination section/examining division
R020 Patent grant now final
R082 Change of representative

Representative=s name: HL KEMPNER PATENTANWAELTE, SOLICITORS (ENGLAND, DE

Representative=s name: HL KEMPNER PATENTANWALT, RECHTSANWALT, SOLICIT, DE