DE69013573T2 - Verteilersteuergerät. - Google Patents
Verteilersteuergerät.Info
- Publication number
- DE69013573T2 DE69013573T2 DE69013573T DE69013573T DE69013573T2 DE 69013573 T2 DE69013573 T2 DE 69013573T2 DE 69013573 T DE69013573 T DE 69013573T DE 69013573 T DE69013573 T DE 69013573T DE 69013573 T2 DE69013573 T2 DE 69013573T2
- Authority
- DE
- Germany
- Prior art keywords
- drive
- control
- program
- controller
- gripper
- 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.)
- Expired - Fee Related
Links
- 230000033001 locomotion Effects 0.000 claims description 53
- 238000004891 communication Methods 0.000 claims description 15
- 230000005540 biological transmission Effects 0.000 claims description 8
- 230000007613 environmental effect Effects 0.000 claims description 7
- 238000000034 method Methods 0.000 claims description 7
- 230000007257 malfunction Effects 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 3
- 238000001514 detection method Methods 0.000 claims description 2
- 239000004065 semiconductor Substances 0.000 claims 1
- 230000000007 visual effect Effects 0.000 description 29
- 238000012545 processing Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 230000006870 function Effects 0.000 description 3
- 230000001419 dependent effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/414—Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller
- G05B19/4141—Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller characterised by a controller or microprocessor per axis
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/33—Director till display
- G05B2219/33228—Detection of line failure, breakage of transmission, failure of receiver
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/33—Director till display
- G05B2219/33332—Each processor can execute all programs
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/33—Director till display
- G05B2219/33339—Controller with lowest operation rate is selected as master
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/34—Director, elements to supervisory
- G05B2219/34449—Fault tolerant control, task from one microprocessor can be done by other
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37261—Encoder and potentiometer to detect fault measurement
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37622—Detect collision, blocking, stall by change, lag in position
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40232—Lock mechanical arm if servo, cpu error, other arms remain free
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Computer Hardware Design (AREA)
- Human Computer Interaction (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Artificial Intelligence (AREA)
- Microelectronics & Electronic Packaging (AREA)
- Evolutionary Computation (AREA)
- Manufacturing & Machinery (AREA)
- General Physics & Mathematics (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
- Circuit For Audible Band Transducer (AREA)
- Train Traffic Observation, Control, And Security (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
Description
- Die vorliegende Erfindung betrifft ein Verteilersteuergerät zur Steuerung der Bewegung eines Gelenkmanipulators, wobei verteilte Steuerungen an den jeweiligen Verbindungsgelenken des Gelenkmanipulators bereitgestellt werden.
- Ein Verteilersteuergerät für einen Gelenkmanipulator ist bekannt. Die verteilten Steuerungen umfassen eine Hauptsteuerungs-CPU (CPU für Central Processing Unit - Zentraleinheit), eine Motorsteuerungs-CPU, eine Kommunikations-CPU und eine I/O-Port-Cpu (I/O für Input/Output - Eingabe/Ausgabe). Die Motorsteuerungs-CPU, die Kommunikations-CPU und die I/O- Port-CPU sind der Hauptsteuerungscpu untergeordnet. Die Hauptsteuerungs-CPU steuert den Gesamtbetrieb des Gelenkmanipulators. Die Motorsteuerungs-CPU steuert Servomotoren an den jeweiligen Verbindungsgelenken des Gelenkmanipulators. Im Verteilersteuergerät werden somit Notorsteuerung, Kommunikationsabwicklung etc. in verteilter Weise durch entsprechende CPUs abgewickelt.
- Ein Programm, das auf Basis des Betriebs des Gelenkmanipulators erstellt wurde, ist in diesem Verteilersteuergerät eingespeichert. Wenn die Struktur des Gelenkmanipulators modifiziert wird, muß das Programm umgeschrieben und neu gestartet werden.
- Darüber hinaus kann dieses Verteilersteuergerät im Falle einer Kehlfunktion einer der CPUs den Gelenkmanipulator nicht mehr betreiben.
- Das dem Stand der Technik zugehörige Dokument EP-A-103 714 beschreibt ein Verfahren für den Betrieb eines computergesteuerten industriellen Fertigungszentrums, bei dem eine Vielzahl von Bewegungsachsen unabhängig voneinander gesteuert werden. Das Verfahren arbeitet mit speicherprogrammier baren Steuerungen zur Erzeugung der Verfahrbefehlssignale für die Servoantriebe der Anlage. Die koordinierte Bewegung mehrerer Achsen wird durch programmtechnische Zusammenfassung der Achsen in Bewegungsgruppen erreicht. Jeder Bewegungsgruppe ist ein Masterprozessor zugeordnet, der den Betrieb aller Achsenprozessoren der betreffenden Gruppe koordiniert. Der Achsenprozessor kann jeder beliebigen anderen Bewegungsgruppe zugeordnet werden, wenn eine programmierbare Bewegung ausgeführt wird.
- Weiter beschreibt das dem Stand der Technik zugehörige Dokument EP-A-291 966 ein Steuerungsverfahren für ein Robotersystem und ein Gerät zur Realisierung dieses Verfahrens. Dieses Robotersystem verfügt über eine Gruppe von Programmmodulen innerhalb einer zentralen Steuerungseinheit zur Abarbeitung der erforderlichen Programme und eine Vielzahl von peripheren Steuermodulen zur Steuerüng der zugehörigen Teile des Robotersystems. Ein Kommunikationsmodul zur Abwicklung der Kommunikation zwischen den Modulen ist bereitgestellt, außerdem ein Warteschlangenpuffer zur sequentiellen Speicherung der vorliegenden Statusinformationen, eines Namens des Quellmoduls und des Neldungstextes. Das Kommunikationsmodul überwacht die Übertragung vom jeweiligen Nodul, legt die Meldung im Warteschlangenpuffer ab, legt eine Liste mit Übermittlungsanforderungen an, übernimmt den Namen des Zielmoduls für die Meldung in sequentieller Weise auf Grundlage eines Empfangsprotokolls des Quellmoduls und legt den Namen des Quellmoduls und die Meldung im Warteschlangenpuffer für das Zielmodul ab. Anschließend durchsucht das Kommunikationsmodul sequentiell den Warteschlangenpuffer nach der zu übermittelnden Meldung und fragt den Status der Zielmodule ab. Ist der Status eines Zielmoduls in den Zustand Freigabe gesetzt, wird die Meldung auf Grundlage eines Sendeprotokolls des Zielmoduls übertragen. Anderenfalls wird die Meldung im Warteschlangenpuffer belassen und im nächsten Übertragungszyklus übermittelt.
- Es ist eine Aufgabe der vorliegenden Erfindung, ein Verteilersteuergerät mit der Fähigkeit zur effizienten Steuerung eines zu steuernden Geräts bereitzustellen. Eine andere Aufgabe der Erfindung ist die Bereitstellung eines Verteilersteuergeräts mit der Fähigkeit zur effizienten Steuerung eines zu steuernden Geräts, wobei auch dann keine Anderung des Steuerungsprogramms erforderlich wird, wenn das Gerät eine Veränderung erfährt. Eine weitere Aufgabe der Erfindung ist die Bereitstellung eines Verteilersteuergeräts mit der Fähigkeit zur Fortführung der Steuerung eines Geräts auch im Fall des Auftretens eines Fehlers.
- Zur tösung dieser Aufgabe stellt die vorliegende Erfindung ein Verteilersteuergerät nach Anspruch 1 bereit.
- Die Erfindung wird anhand der folgenden detaillierten Beschreibung in Verbindung mit den beigefügten Figuren verständlich; es zeigen:
- Fig. 1 ein Verteilersteuergerät gemäß einer Ausführungsform der vorliegenden Erfindung;
- Fig. 2 einen schematischen Aufbau eines Verbindungsgelenks;
- Fig. 3 einen schematischen Aufbau einer visuellen Steuerung;
- Fig. 4 eine schematische ROM-Belegung der visuellen Steuerung;
- Fig. 5 ein Flußdiagramm zur Erläuterung eines Hauptprogramms;
- Fig. 6 einen schematischen Aufbau einer Ein/Ausgabesteuerung;
- Fig. 7 eine schematische ROM-Belegung der Ein/Ausgabesteuerung;
- Fig. 8 einen schematischen Aufbau einer Motorsteuerung;
- Fig. 9 eine schematische ROM-Belegung einer Motorsteuerung;
- Fig. 10 einen schematischen Aufbau einer Greiferantriebs-Steuerung;
- Fig. 11 eine schematische ROM-Belegung der Greiferantriebssteuerung;
- Fig. 12 ein Flußdiagramm zur Erläuterung eines Programms zur visuellen Steuerung;
- Fig. 13 ein Flußdiagramm zur Erläuterung eines Programms zur Ein/Ausgabesteuerung;
- Fig. 14 ein Flußdiagramm zur Erläuterung eines Berechnungsablauf-Umschaltprogramms;
- Fig. 15 ein Diagramm eines Berechnungszeitabschnitts für die Bewegungsrate;
- Fig. 16 ein Flußdiagramm zur Erläuterung eines Ortskurven-Berechnungsprogramms;
- Fig. 17 Stützpunkte einer Bewegungsbahn;
- Fig. 18 ein Flußdiagramm zur Erläuterung eines Interpolations-Berechnungsprogramms;
- Fig. 19 ein Flußdiagramm zur Erläuterung eines Motorsteuerungsprogramms;
- Fig. 20 ein Flußdiagramm zur Erläuterung eines Fehleralarmprogramms;
- Fig. 21 ein Flußdiagramm zur Erläuterung eines Kehlerbehebungsprogramms bei einer Motorstörung;
- Fig. 22 ein Flußdiagramm zur Erläuterung eines Fehlerbehebungsprogramms bei Ausfall einer Steuerung; und
- Fig. 23 ein Flußdiagramm zur Erläuterung eines Programms zur Datenübertragung bei Leitungsunterbrechungen.
- Im folgenden werden Aus führungs formen der vorliegenden Erfindung anhand der beigefügten Zeichnungen beschrieben.
- Unter Bezugnahme auf die Fig. 1 ist ein Gelenkmanipulator 1 auf einem Sockel 2 montiert. Der Manipulator 1 umfaßt einen ersten Arm 3, einen zweiten Arm 4, einen dritten Arm 5, einen vierten Arm 6 und einen Greifer 7. Ein Ende des ersten Arms 3 ist am Sockel 2 angebracht, und das andere Ende des ersten Arms 3 ist über ein erstes Verbindungsgelenk 8 mit dem zweiten Arm 4 verbunden. Der zweite Arm 4 ist über ein zweites Verbindungsgelenk 9 mit dem dritten Arm 5 verbunden. Der dritte Arm 5 ist über ein drittes Verbindungsgelenk 10 mit dem vierten Arm 6 verbunden. Der vierte Arm 6 ist über ein viertes Verbindungsgelenk 11 mit dem Greifer verbunden.
- Die Fig. 2 zeigt den schematischen Aufbau des ersten bis vierten Verbindungsgelenks 8, 9, 10 und 11. Da das erste bis vierte Verbindungsgelenk 8 bis 11 jeweils gleich aufgebaut ist, wird stellvertretend der Aufbau des ersten Verbindungsgelenks 8 beschrieben. Das erste Verbindungsgelenk 8 ist mit einem Servomotor 12 ausgestattet. Eine elektromagnetische Verriegelung 14 sowie Bremsen 15 und 16 sind auf einer umlaufenden Welle 13 des Servomotors 12 angeordnet. Ein Kodierer 17 ist mit der umlaufenden Welle des Servomotors 12 gekuppelt. Ein Potentiometer 17a ist am Kodierer 17 angebracht. Der zweite Arm 4 wird daher entsprechend der Rotation des Servomotors 12 bewegt. Wenn der am zweiten Verbindungsgelenk 9 mit dem gleichen Aufbau wie das erste Verbindungsgelenk 8 angebrachte Servomotor umläuft, wird der dritte Arm 5 bewegt. Wenn der am dritten Verbindungsgelenk angebrachte Servomotor umläuft, wird der vierte Arm 6 bewegt, wenn der am vierten Verbindungsgelenk 11 angebrachte Servomotor umläuft, wird der Greifer 7 bewegt. Mit dem Umlaufen von im Greifer 7 bereitgestellten Servomotoren werden die Greiferfinger 18 geöffnet und geschlossen.
- Ein visueller Sensor 19, bei dem es sich um einen Umgebungszustandssensor handelt, ist über dem Gelenkmanipulator 1 angebracht. Der visuelle Sensor 19 ist eine industrielle Fernsehkamera. Die Bilderfassung durch den visuellen Sensor 19 wird durch eine visuelle Steuerung 20 oder eine Steuerung zur Erkennung des Umgebungszustandes gesteuert. Die visuelle Steuerung 20 ändert die Bilderfassungsrichtung des visuellen Sensors 19 und hält den Nanipulator 1 oder einen Handhabungsgegenstand 21 des Manipulators 1 innerhalb des Sichtfeldes des visuellen Sensors 19. Die visuelle Steuerung 20 gibt auf Basis der Bildverarbeitung ermittelte Bilddatensignale des Gelenkmanipulators 1 oder des Handhabungsgegenstandes 21 aus.
- Weiterhin wird ein Anzeigebildschirm 24 für das Empfangen bzw. Senden von Daten vom/zum Gelenkmanipulator 1 bereitgestellt. Eine Ein/Ausgabesteuerung 25 steuert die Ein/Ausgabe von Daten zwischen dem Manipulator 1 und dem Anzeigebildschirm 24.
- Das erste bis vierte Verbindungsgelenk 8, 9, 10 und 11 des Gelenkmanipulators 1 verfügt über jeweils eine erste bis vierte Motorsteuerung 26 bis 29. Der Greifer 7 verfügt über eine Greiferantriebssteuerung 30. Die erste bis vierte Motorsteuerung 26 bis 29 steuert den Servomotor des betreffenden Verbindungsgelenks. Die Greiferantriebssteuerung 30 steuert die Servomotoren im Greifer 7.
- Die Steuerungen 20 und 25 bis 30 sind untereinander durch eine hochschnelle Kommunikationsstrecke 31 verbunden.
- Nachstehend wird der Aufbau der Steuerungen 20 und 25 bis 30 beschrieben.
- Die Fig. 3 zeigt den schematischen Aufbau der visuellen Steuerung 20. Ein ROM 33, ein RAM 34, ein I/O-Port 35 und ein Bildspeicher 38 sind über einen Bus 32 mit einer CPU 31 verbunden. Eine Motorsteuerungsschaltung 36 ist mit dem I/O- Port 35 verbunden. Die Motorsteuerungsschaltung 36 steuert einen Motor 37 zur Anderung der Bilderfassungsrichtung des visuellen Sensors 19. Der A/D-Wandler 39 erhält ein Bildsignal S vom visuellen Sensor 19. Das ROM 33 speichert Programme entsprechend Fig. 4. Wie in der Fig. 5 dargestellt, ruft ein Hauptprogramm ein Ortskurven-Berechnungsprogramm und ein Interpolations-Berechnungsprogramm auf und aktiviert darüber hinaus in bestimmten Intervallen ein Berechnungsablauf-Umschaltprogramm.
- Das Ortskurven-Berechnungsprogramm wird zur Berechnung einer Ortskurve des Greifers 7 des Gelenkmanipulators von der momentanen Position zu einer Zielposition auf Basis Von in festgelegten Intervallen angeordneten Stützpunkten durchlaufen.
- Das Interpolations-Berechnungsprogramm wird zur Berechnung einer Variation des Winkels eines jeden Verbindungsgelenks des Gelenkmanipulators 1 zwischen zwei benachbarten Stützpunkten der vom Ortskurven-Berechnungsprogramm erhaltenen Ortskurve durchlaufen.
- Das Berechnungsablauf-Umschaltprogramm wird durchlaufen, um in jedem Steuerungszyklus festzustellen, welche der Steuerungen unter den Motorsteuerungen 26 bis 29, der Greiferantriebssteuerung 30, der visuellen Steuerung 20 und der Ein/Ausgabesteuerung 25 die geringste Bewegungsrate aufweist. Die ermittelte Steuerung mit der geringsten Bewegungsrate erhält die Freigabe, die Ortskurvenberechnung und die Interpolationsberechnung durchzuführen und die Steuerung mit der geringsten Bewegungsrate im nächsten Bewegungszyklus zu ermitteln. Wenn das visuelle Steuerungsprogramm ausgeführt wird, liefert die visuelle Steuerung 20 ein funktionsabhängiges EIN/AUS-Signal F an den visuellen Sensor 19 und ändert die Bilderfassungsrichtung des visuellen Sensors 19.
- Darüber hinaus wird bei der Abarbeitung des visuellen Steuerungsprogramms ein im Bildspeicher 38 gehaltenes Bildsignal über die hochschnelle Kommunikationsstrecke 31 und die Ein/Ausgabesteuerung 25 an den Monitor für den Anzeigebildschirm 24 übermittelt.
- Die Fig. 6 zeigt den schematischen Aufbau der Ein/Ausgabesteuerung 25. Ein ROM 42, ein RAM 43, ein Bildspeicher 44 und ein I/O-Port 45 sind über einen Bus 41 mit einer CPU 49 verbunden. Die Daten werden über das I/O-Port 45 an den Anzeigebildschirm 24 ein- bzw. von diesem ausgegeben. Das ROM 42 enthält die in der Fig. 7 gezeigten Programme. Das Hauptprogramm, das Ortskurven-Berechnungsprogramm, das Interpolationsprogramm und das Berechnungsablauf-Umschaltprogramm sind weiter oben beschrieben worden. Wie in der Fig. 13 gezeigt, überträgt ein Ein/Ausgabe-Programm die im Bildspeicher 44 gehaltenen Bilddaten an einen Monitor des Bildschirms 24, es überträgt weiter die Winkeldaten an den Bildschirm 24 und es übernimmt eine Befehlseingabe von der Tastatur des Bildschirms 24 und übermittelt den Befehl an die Steuerungen 20 und 25 bis 30.
- Die Fig. 8 zeigt den schematischen Aufbau der Motorsteuerungen 26 bis 29. Ein ROM 48, ein PAM 49 und ein I/O-Port 50 sind über einen Bus 47 mit einer CPU 46 verbunden. Eine Motorsteuerungsschaltung 51, ein Grenzschalter 52 und eine elektromagnetische Antriebssperrschaltung 53 sind mit dem I/O-Port 50 verbunden. Der Grenzschalter 52 begrenzt den Bewegungsbereich eines jeden Arms. Die elektromagnetische Antriebssperrschaltung 53 steuert die elektromagnetische Verriegelung 14 an, wenn sie ein Verriegelungskommando von der CPU 46 erhält, oder wenn eine Fehlfunktion der CPU 46 auftritt. Das ROM 48 enthält die in der Fig. 9 gezeigten Programme. Das Hauptprogramm, das Ortskurven-Berechnungsprogramm, das Interpolations-Berechnungsprogramm und das Berechnungsablauf-Umschaltprogramm sind weiter oben beschrieben worden.
- Auf Basis eines ersten Motorsteuerungsprogrammes werden Antriebssteuerungssignale für Bewegungsgrad, Geschwindigkeit und Drehrichtung des Antriebs generiert, die an den Servomotor 12 des ersten Verbindungsgelenks 8 übermittelt werden, wenn der Gelenkmanipulator 1 den Handhabungsgegenstand 21 bewegt.
- Auf Basis eines zweiten Mötorsteuerungsprogrammes werden Antriebssteuerungssignale für Bewegungsgrad, Geschwindigkeit und Drehrichtung des Antriebs generiert, die an den Servomotor des zweiten Verbindungsgelenks 9 übermittelt werden, wenn der Gelenkmanipulator 1 den Handhabungsgegenstand 21 bewegt.
- Auf Basis eines dritten Motorsteuerungsprogrammes werden Antriebssteuerungssignale für Bewegungsgrad, Geschwindigkeit und Drehrichtung des Antriebs generiert, die an den Servomotor des dritten Verbindungsgelenks 10 übermittelt werden, wenn der Gelenkmanipulator 1 den Handhabungsgegenstand 21 bewegt.
- Auf Basis eines vierten Motorsteuerungsprogrammes werden Antriebssteuerungssignale für Bewegungsgrad, Geschwindigkeit und Drehrichtung des Antriebs generiert, die an den Servomotor des vierten Verbindungsgelenks 11 übermittelt werden, wenn der Gelenkmanipulator 1 den Handhabungsgegenstand 21 bewegt.
- Ein Fehleranzeigeprogramm wird durchlaufen, um im Falle einer Störung des Servomotors ein Verriegelungskommando an die elektromagnetische Verriegelung 14 abzusetzen und die Störung an die Motorsteuerungen für die anderen Servomotoren zu übermitteln.
- Mittels eines Antriebsstörungsbehebungsprogramms werden Signale für Bewegungsgrad, Drehzahl und Drehrichtung, die die Funktion des gestörten Servomotors kompensieren, an die normal arbeitenden Servomotoren übermittelt.
- Mittels eines Steuerungsfehlerbehebungsprogramms werden beim Auftreten einer Störung in einer anderen Motorsteuerung eine Winkelstellung des gestörten Servomotors ermittelt und Signale für Bewegungsgrad, Drehzahl und Drehrichtung, die die Funktion des gestörten Servomotors kompensieren, an die normal arbeitenden Servomotoren übermittelt.
- Mittels eines Programms zur Datenübertragung bei Leitungsunterbrechungen werden bei einer Unterbrechung der hochschnellen Kommunikationsstrecke 31 Daten über eine der Motorsteuerungen übertragen.
- Ein Programm zur Anderung des Bewegungsgrades wird durchlaufen, um den Bewegungsgrad für die von den Motorsteuerungen gesteuerten Servomotoren entsprechend dem jeweiligen Motortyp zu ändern.
- Wie weiter oben beschrieben, haben die erste bis vierte Motorsteuerung 26 bis 29 den gleichen schematischen Aufbau.
- Die Fig. 10 zeigt den schematischen Aufbau der Greiferantriebssteuerung 30. Ein ROM 56, ein RAM 57 und ein I/O-Port 58 sind über einen Bus 55 mit einer CPU 54 verbunden. Eine Motorsteuerungsschaltung 59 und ein Grenzschalter 60 sind mit dem I/O-Port 58 verbunden. Der Grenzschalter 60 begrenzt den Bewegungsbereich des Greifers 7 und der Finger 18. Das ROM 56 enthält die in der Fig. 11 gezeigten Programme. Das Hauptprogramm, das Ortskurven-Berechnungsprogramm, das Interpolationsprogramm und das Berechnungsablauf-Umschaltprogramm sind weiter oben beschrieben worden.
- Ein Greifersteuerungsprogramm steuert die Servomotoren 61 und 62 im Greifer 7. Der Servomotor 61 wird so angesteuert, daß die Abweichung der Richtung des Greifers 7 gegenüber der Position des Handhabungsgegenstandes 21 zu Null wird. Der Servomotor 62 wird für ein Schließen und Öffnen der Finger 18 unter Konstanthaltung der Kraft der Finger 18 beim Erfassen des Handhabungsgegenstandes 21 angesteuert.
- Der Betrieb des Geräts mit dem oben beschriebenen Aufbau wird nachstehend beschrieben.
- Zur Aktivierung des Hauptprogramms wird zunächst die Greiferantriebssteuerung 30 eingesetzt. Die anderen Steuerungen rufen das Hauptprogramm nicht auf.
- Die CPU 31 in der visuellen Steuerung 20 liest das visuelle Steuerungsprogramm aus dem ROM 32 aus und arbeitet das Programm ab. Im Schritt el der Fig. 12 startet die CPU 31 den Betrieb des visuellen Sensors 19. Der visuelle Sensor 19 erfaßt ein Bild des Handhabungsgegenstandes 21 und gibt ein entsprechendes Bildsignal aus. Das Bildsignal wird von der A/D-Wandlerschaltung 39 in der visuellen Steuerung 20 in ein digitales Signal gewandelt, wobei das digitale Signal im Bildspeicher 38 gespeichert wird. Im Schritt e2 bestimmt die CPU 31 Koordinaten eines Objekts (Handhabungsgegenstand 21 oder Greifer 7 des Manipulators 1) auf Basis des digitalen Bildsignals. Im nachfolgenden Schritt e3 richtet die CPU 28 das Sichtfeld des visuellen Sensors 19 auf die ermittelten Koordinaten.
- Die Greiferantriebssteuerung 30 wickelt das Hauptprogramm und das Ortskurven-Berechnungsprogramm in Parallelbearbeitung ab. Wenn die CPU 54 der Greiferantriebssteuerung 30 das Hauptprogramm bearbeitet, bestimmt die CPU 54 nach einer festgelegten Zeit (Schritt a1 in Fig. 5), welche der Steuerungen 20, 25, 26, 27, 28, 29 oder 30 die niedrigste Bewegungsrate aufweist (Schritt a2).
- Die Bewegungsrate wird vom Berechnungsablauf-Umschaltprogramm ermittelt. Die CPU 54 setzt die Bewegungsrate W auf Null (Schritt b1 in Fig. 14) und fragt anschließend die Zeit ab (Schritt b2). Es wird bestimmt, ob ein Zeitabschnitt Δt vergangen ist oder nicht (Schritt b3). Wie in der Fig. 15 gezeigt, beginnt die CPU 54 mit einer Abfrage der Zeit zum Zeitpunkt t1 und prüft nach Ablauf eines Zeitabschnitts Δt, ob ein anderes Programm als das Bewegungsraten-Prüfprogramm ausgeführt wurde. Wenn ein anderes Programm als das Bewegungsraten-Prüfprogramm ausgeführt wurde, wird die Bewegungsrate W um "1" erhöht. Im nächsten Schritt b5 prüft die CPU 54, ob die Abfrage der Ausführung eines anderen Programms als des Bewegungsraten-Prüfprogramms n mal erfolgte, d.h. ob ein Zeitabschnitt Atn verstrichen ist. Liefert Schritt b5 "JA", so hat die CPU 54 die Bewegungsrate W bestimmt. Die Fig. 15 zeigt einen Zeitabschnitt Wa, in dem das Bewegungsraten-Prüfprogramm ausgeführt wird, und einen Zeitabschnitt Wb, in dem ein anderes Programm als das Bewegungsraten-Prüfprogramm ausgeführt wird. Die CPU 54 bestimmt die Bewegungsraten aller Steuerungen 20 und 25 bis 30.
- Die CPU 54 kehrt zum Hauptprogramm zurück und bestimmt unter den Steuerungen 20 und 25 bis 30 diejenige Steuerung mit der niedrigsten Bewegungsrate (Schritt a3). Wenn es sich bei der so bestimmten Steuerung um die Greiferantriebssteuerung 30 handelt, fährt die CPU 54 mit der Bearbeitung des Hauptprogramms, des Ortskurven-Berechnungsprogramm5 und des Interpolations-Berechnungsprogramms fort.
- Die CPU 54 arbeitet das Hauptprogramm und das Ortkurven- Berechnungsprogramm in paralleler Weise ab.
- In Schritt k1 der Fig. 16 übernimmt die CPU 54 Zielpositionsdaten von der Ein/Ausgabe-Erfassungssteuerung 25. In Schritt k2 bestimmt die CPU 54 die momentane Position des Greifers 7. Die momentane Position des Greifers 7 wird aus den Winkeln der Verbindungsgelenke 8 bis 11 berechnet. In Schritt k3 bestimmt die CPU 54 eine Bewegungsbahn für den Greifer 7 auf Basis der Zielposition und der momentanen Position des Greifers 7. Wie in der Fig. 17 gezeigt, wird die Bewegungbahn durch Stützpunkte P1, P2 ... beschrieben, die in vorgegebenen Zeitintervallen angeordnet sind. Zusätzlich führt die CPU 54 das Interpolations-Berechnungsprogramm aus. In Schritt h1 der Fig. 18 übernimmt die CPU 54 Daten der Stützpunkte P1, P2 ... der Bewegungsbahn. In Schritt h2 führt die CPU 54 Interpolationsberechnungen durch, um Daten für die Winkel der Verbindungsgelenke (Drehwinkel der Servomotoren) zwischen den Stützpunkten P1 und P2, den Stützpunkten P2 und P3, den Stützpunkten P3 und P4 ... zu erhalten. Die CPU 54 übermittelt die Daten für die Winkel der Verbindungsgelenke nacheinander an die erste bis vierte Motorsteuerung 26 bis 29.
- Die erste bis vierte Motorsteuerung 26 bis 29 führt jeweils die folgenden Operationen aus. Die CPU 46 in der ersten Motorsteuerung 26 liest das erste Motorsteuerungsprogramm aus dem ROM 48 und führt das Programm aus. In Schritt y1 der Fig. 19 übernimmt die CPU 46 nacheinander Daten für die Winkel der Verbindungsgelenke. In Schritt y2 bestimmt die CPU 46 eine Abweichung zwischen den Daten der Zielposition und den Winkelstellungsdaten des Servomotors, die vom Kodierer 17 geliefert werden. In Schritt y3 generiert die CPU 46 Antriebssteuerungssignale für Bewegungsgrad, Geschwindigkeit und Drehrichtung für den Servomotor 12, durch die die Abweichung auf Null gebracht wird. Die Antriebssteuerungssignale werden an die Motorsteuerungsschaltung 51 übertragen. Damit wird der Servomotor 12 auf Basis der durch die Antriebssteuerungssignale vorgegebenen Werte für Bewegungsgrad, Geschwindigkeit und Drehrichtung angesteuert. Wie weiter oben beschrieben, erfaßt der Kodierer 17 die Drehbewegung und die Drehrichtung des Servomotors 12 und liefert die für Drehbewegung und Drehrichtung repräsentativen Daten an die erste Motorsteuerung 26 zurück. Der Ausgang des Kodierers 17 wird durch das Potentiometer 17a in ein Signal gewandelt, das in einfacher Weise von der CPU weiterverarbeitet werden kann. Nochmals: Die CPU 46 generiert Antriebssteuerungssignale derart, daß die Abweichung zwischen den rückgemeldeten Daten des Drehwinkels und der Drehrichtung einerseits und den vorgegebenen Daten für Drehwinkel und Drehrichtung andererseits auf Null gebracht werden kann.
- In gleicher Weise steuert die zweite bis vierte Motorsteuerung 27 bis 29 jeweils die Antriebsbewegungen der Servomotoren in den Verbindungsgelenken 9 bis 11. Auf diese Weise wird der Greifer 7 in Richtung des Handhabungsgegenstands 21 geführt.
- Nachstehend wird die Betriebsweise nach Auftreten einer Störung beschrieben.
- Es sei angenommen, daß eine Störung im Servomotor 12 des ersten Verbindungsgelenks 8 aufgetreten ist. Die CPU 46 der ersten Motorsteuerung 26 liest das Fehleranzeigeprogramm in jedem festgelegten Zyklus aus dem ROM 48 und führt das Programm aus. In Schritt j1 der Fig. 20 übernimmt die CPU 46 rückgemeldete Daten vom Kodierer. Wenn sich die rückgemeldeten Daten für Bewegungsgrad und Drehrichtung verändert haben, entscheidet die CPU 46, daß der Servomotor 12 normal arbeitet (Schritt j2). Sind die rückgemeldeten Daten unverändert, stellt die CPU 46 eine Störung des Servomotors 12 fest. In diesem Fall informiert die CPU 46 die Steuerungen 20 und 25 bis 30 über die Störung des Servomotors 12 (Schritt j5). In Schritt j6 steuert die CPU 46 die elektromagnetische Verriegelung 14 an, um die Bewegung des ersten Arms 3 zu verriegeln. Gleichzeitig stellt die CPU 46 den Veriegelungswinkel des zweiten Arms 4 gegenüber dem verriegelten ersten Arm 3 fest. Der Verriegelungswinkel wird aus den Daten für Bewegungsgrad und Drehrichtung bestimmt, die vom Kodierer 17 zurückgeliefert werden.
- Wie weiter oben beschrieben, führt die CPU 54 der Greiferantriebssteuerung 30 das Hauptprogramm, das Ortskurven- Berechnungsprogramm, das Interpolations-Berechnungsprogramm und das Berechnungsablauf-Umschaltprogramm aus. Die CPU 54 führt in jedem festgelegten Zyklus das Antriebsstörungsbehebungsprogramm aus. In Schritt r1 der Fig. 21 wird die CPU 54 über die Störung des Servomotors 12 informiert, wobei die CPU 54 eine Bewegungsbahn bestimmt, entlang der der Greifer 7 durch Bewegung des zweiten bis vierten Verbindungsgelenks 9 bis 11 in die Zielposition verfahren wird (Schritt r2) Wie in der Fig. 17 gezeigt, wird die Bewegungsbahn durch in festgelegten Intervallen angeordnete Stützpunkte beschrieben. Die Bewegungsbahn variiert in Abhängigkeit vom Verriegelungswinkel des zweiten Armes 4. In Schritt r3 übermittelt die CPU 54 nacheinander die Daten eines jeden Stützpunktes an die zweite bis vierte Steuerung 27 bis 29. Damit erhalten die zweite bis vierte Motorsteuerung 27 bis 29 nacheinander die Daten der Stützpunkte. Auf Basis der Daten der Stützpunkte berechnet die zweite bis vierte Motorsteuerung 27 bis 29 jeweils die Daten für Bewegungsgrad, Geschwindigkeit und Drehrichtung, durch die der Greifer 7 in die Zielposition verfahren wird. Im Ergebnis wird der Greifer 7 durch Bewegen des zweiten bis vierten Verbindungsgelenks in Richtung des Handhabungsgegenstandes 21 verfahren.
- Es sei angenommen, daß eine Störung der zweiten Motorsteuerung 27 aufgetreten ist.
- Die CPU einer jeden der Motorsteuerungen 26 bis 29 führt in jedem festgelegten Zyklus das Steuerungsfehlerbehebungsprogramm aus. In Schritt n1 der Fig. 22 greifen die CPUs gegenseitig aufeinander zu. Wenn die CPU der Motorsteuerung 27, 28 oder 29 keine Reaktion von der zugegriffenen Steuerung erhält, stellt die betreffende CPU einen Fehler der zugegriffenen CPU oder eine Unterbrechung der hochschnellen Kommunikationsstrecke 31 fest.
- Wenn in der CPU ein Fehler aufgetreten ist, erkennt die elektromagnetische Antriebssperrschaltung 53 den Fehler der CPU von der Hardwareseite her und steuert die elektromagnetische Verriegelung 14 an, wodurch das Verbindungsgelenk 9 verriegelt wird.
- Der Ausfall der CPU kann auch daran erkannt werden, daß diese keine Reaktion auf die Zugriffe seitens der anderen CPUs ausgibt. Wenn der Fehler der zweiten Motorsteuerung 27 erkannt ist, stellen die CPUs der ersten, dritten und vierten Motorsteuerung fest, ob Daten des Verriegelungswinkels vom Potentiometer 17a des zweiten Verbindungsgelenks gelesen werden können. Wenn die Daten des Verriegelungswinkels ausgelesen werden können, werden diese Daten vom Kodierer des zweiten Verbindungsgelenks ausgelesen (Schritt n5). Wenn die zweite Motorsteuerung 27 eine so schwere Fehlfunktion aufweist, daß die Daten des Verriegelungswinkels nicht vom Kodierer des zweiten Verbindungsgelenks ausgelesen werden können, wird ein Befehl an die visuelle Steuerung 20 abgesetzt, um den Verriegelungswinkel des zweiten Verbindungsgelenks festzustellen (Schritt n6). Die visuelle Steuerung 20 bestimmt den Verriegelungswinkel des zweiten Verbindungsge lenks auf Basis des Bildsignals und der Winkelstellungsdaten der ersten, dritten und vierten Motorsteuerung 26, 28 und 29, wobei die visuelle Steuerung 20 den festgestellten Verriegelungswinkel an jede der Motorsteuerungen übermittelt. In Schritt n7 erhält jede Motorsteuerung die Daten des Verriegelungswinkels des zweiten Verbindungsgelenks. Sobald der Verriegelungswinkel übernommen ist, wird der Verriegelungswinkel festgehalten, und die Greiferantriebssteuerung 30 setzt das Hauptprogramm, das Ortskurven-Berechnungsprogramm, das Interpolations-Berechnungsprogramm und das Berechnungsablauf-Umschaltprogramm zurück.
- Im folgenden wird eine Beschreibung des Falls gegeben, daß die hochschnelle Kommunikationsstrecke 31 zwischen der ersten und zweiten Motorsteuerung 26 und 27 unterbrochen ist.
- Wie weiter oben beschrieben, greifen die Motorsteuerungen 26 bis 29 zu jedem festgelegten Zyklus gegenseitig aufeinander zu. Auf Basis dieses Zugriffs stellt jede der Motorsteuerungen 26 bis 29 die Unterbrechung der hochschnellen Kommunikationsstrecke 31 fest. Wenn die erste Motorsteuerung 26 die Unterbrechung der Kommunikationsstrecke 31 zwischen der ersten und zweiten Motorsteuerung 26 und 27 feststellt, übermittelt die erste Notorsteuerung 26 Daten an die dritte Motorsteuerung 28 (Schritt m3 der Fig. 23). Als Ziel der übermittelten Daten ist die zweite Motorsteuerung 27 vorgegeben. Wenn die dritte Motorsteuerung 28 die Daten erhält, werden die Daten entsprechend dem vorgegebenen Ziel der Daten an die zweite Motorsteuerung 27 übermittelt.
- Die Erfindung ist auch für einen Manipu1ator in einem Kern-10 kraftwerk oder für Anlagen im Weltraum oder in einem Reinraum einsetzbar.
Claims (12)
1. Verteilersteuergerät, welches folgendes umfaßt:
eine Vielzahl von Antriebssteuerungen (26 bis 29), die
an den Verbindungsgelenken eines Gelenkmanipulators
angeordnet sind, um Antriebe zu steuern, welche zum
Antrieb der Verbindungsgelenke dienen; und
eine Arbeitssteuerung (30), die an einem äußeren
Endstück des Gelenkmanipulators angeordnet ist, um einen
Antrieb für einen Arbeitsgreifer zu steuern;
dadurch gekennzeichnet, daß jede der
Antriebssteuerungen (26 bis 29) und die Arbeitssteuerung (30) folgendes
umfaßt:
eine Ortskurven-Berechnungseinrichtung zur Berechnung
einer Bewegungsbahn des Arbeitsgreifers von der
momentanen Position zu einer Zielposition mit Hilfe von in
festgelegten Abständen angeordneten Stützpunkten;
eine Interpolations-Berechnungeinrichtung zur
Berechnung einer Variation des Winkels eines entsprechenden
Verbindungsgelenks zwischen jedem aufeinanderfolgenden
Paar der Stützpunkte; und
eine Berechnungsprozeß-Umsteuereinrichtung zur
Ermittlung, welche der Antriebssteuerungen (26 bis 29)
einschließlich der Arbeitssteuerung (30) in jedem
festgelegten
Zeitabschnitt die geringste Bewegungsrate
während der Ausführung einer Steuerungsoperation
aufweist, wobei die für einen Zeitabschnitt ermittelte
Steuerung die Freigabe erhält, in einem nachfolgenden
Zeitabschnitt unter den Antriebssteuerungen (26 bis 29)
und der Arbeitssteuerung (30) eine Steuerung mit der
geringsten Bewegungsrate zu ermitteln; gleichzeitig
werden die Ortskurven-Berechnungseinrichtung und die
Interpolations-Berechnungseinrichtung aktiviert.
2. Gerät nach Anspruch 1, dadurch gekennzeichnet, daß:
jede der Antriebssteuerungen Einrichtungen zur
Erkennung von Fehlersituationen und zum Festsetzen von
Gliedern, Einrichtungen für Fehlergegenmaßnahmen,
Einrichtungen zur Datenübertragung während
Leitungsunterbrechungen und Einrichtungen zur Anderung des
Teilnahmegrades von Antrieben umfaßt;
im Fall des Auftretens einer Fehlfunktion in einer der
Antriebssteuerungen (26 bis 29) oder den Antrieben die
Einrichtung zur Erkennung-von Fehlersituationen und zum
Festsetzen von Gliedern, die der fehlerhaften
Antriebssteuerung oder dem fehlerhaften Antrieb zugeordnet ist,
eine andere Antriebssteuerung über das Auftreten der
Fehlfunktion informiert und das betreffende
Verbindungsgelenk, das durch die fehlerhafte Steuerung oder
den fehlerhaften Antrieb bedient wird, festsetzt;
nach Erhalt der Information von der anderen
Antriebssteuerung über das Auftreten der Eehlfunktion die
Einrichtung für Fehlergegenmaßnahmen der anderen
Antriebssteuerung Daten für den Teilnahmegrad, die den
Ausfall der fehlerhaften Steuerung oder des
fehlerhaften
Antriebs kompensieren, an den durch die andere
Antriebssteuerung gesteuerten Antrieb liefert;
im Fall der Unterbrechung einer
Kommunikationsverbindung zwischen den Antriebssteuerungen die Einrichtung
zur Datenübertragung während Leitungsunterbrechungen
Daten über eine der Antriebssteuerungen übermittelt;
und
die Einrichtung zur Anderung des Teilnahmegrades von
Antrieben den Steuereingriff für einen zugeordneten
Antrieb entsprechend dem jeweiligen Antriebstyp
modifiziert.
3. Gerät nach Anspruch 1, dadurch gekennzeichnet, daß die
Antriebe Servomotoren (12) sind.
4. Gerät nach Anspruch 1, dadurch gekennzeichnet, daß die
Antriebe Schrittmotoren sind.
5. Gerät nach Anspruch 1, dadurch gekennzeichnet, daß die
Antriebe Stellelemente sind.
6. Gerät nach Anspruch 1, dadurch gekennzeichnet, daß der
Greiferantrieb ein Servomotor ist.
7. Gerät nach Anspruch 1, dadurch gekennzeichnet, daß der
Greiferantrieb ein Schrittmotor ist.
8. Gerät nach Anspruch 1, dadurch gekennzeichnet, daß der
Greiferantrieb ein Stellelement ist.
9. Gerät nach Anspruch 1, dadurch gekennzeichnet, daß die
Berechnungsprozeß-Umsteuereinrichtung auf Basis des
Verhältnisses der Berechnungszeit für die Bewegungsrate
im betreffenden Zeitabschnitt zu der Zeit, in der
mindestens die Ortskurven-Berechnungseinrichtung und die
Interpolations-Berechnungseinrichtung aktiviert sind,
eine Steuerung mit der niedrigsten Eewegungsrate
bestimmt.
10. Gerät nach einem der Ansprüche 1 bis 9, gekennzeichnet
durch
einen Umgebungszustandssensor (19) zur Erfassung des
Umgebungszustandes des Gelenkmanipulators;
eine Umgebungszustands-Erkennungssteuerung (20) zur
Steuerung des Umgebungszustandssensors und zur
Übertragung von Daten; und
eine Eingangs/Ausgangssteuerung (25) zur Steuerung der
Eingangs- und Ausgangsinformationen von und nach außen.
11. Gerät nach Anspruch 10, dadurch gekennzeichnet, daß als
Umgebungszustandssensor eine industrielle Fernsehkamera
eingesetzt wird.
12. Gerät nach Anspruch 10, dadurch gekennzeichnet, daß als
Umgebungszustandssensor eine
Halbleiter-Bilderfassungseinrichtung eingesetzt wird.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP13885689A JPH033785A (ja) | 1989-05-31 | 1989-05-31 | ロボットコントローラ |
JP13089890A JPH0424803A (ja) | 1990-05-21 | 1990-05-21 | 並列分散制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
DE69013573D1 DE69013573D1 (de) | 1994-12-01 |
DE69013573T2 true DE69013573T2 (de) | 1995-03-16 |
Family
ID=26465892
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE69013573T Expired - Fee Related DE69013573T2 (de) | 1989-05-31 | 1990-05-30 | Verteilersteuergerät. |
Country Status (3)
Country | Link |
---|---|
US (1) | US5055755A (de) |
EP (1) | EP0400624B1 (de) |
DE (1) | DE69013573T2 (de) |
Families Citing this family (36)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5282418A (en) * | 1991-03-13 | 1994-02-01 | Tokyo Kikai Seisakusho, Ltd. | Roller changer |
DE4202922A1 (de) * | 1992-02-01 | 1993-08-05 | Zeiss Carl Fa | Motorisches stativ |
JP2769947B2 (ja) * | 1992-05-15 | 1998-06-25 | 株式会社椿本チエイン | マニピュレータの位置・姿勢制御方法 |
JP2599571B2 (ja) * | 1994-05-11 | 1997-04-09 | ダイトロンテクノロジー株式会社 | 基板搬送ロボット |
US5963712A (en) * | 1996-07-08 | 1999-10-05 | Sony Corporation | Selectively configurable robot apparatus |
US5757419A (en) * | 1996-12-02 | 1998-05-26 | Qureshi; Iqbal | Inspection method and apparatus for tanks and the like |
DE19718284C2 (de) | 1997-05-01 | 2001-09-27 | Kuka Roboter Gmbh | Verfahren und Vorrichtung zum Überwachen einer Anlage mit mehreren Funktionseinheiten |
US6751526B2 (en) * | 1997-08-22 | 2004-06-15 | Sony Corporation | Method for describing robot structure and part of robot |
JP2000042971A (ja) * | 1998-07-29 | 2000-02-15 | Janome Sewing Mach Co Ltd | 水平多関節ロボット |
US6718533B1 (en) * | 1999-02-26 | 2004-04-06 | Real-Time Innovations, Inc. | Method for building a real-time control system with mode and logical rate |
US6341246B1 (en) * | 1999-03-26 | 2002-01-22 | Kuka Development Laboratories, Inc. | Object oriented motion system |
US7882253B2 (en) | 2001-04-05 | 2011-02-01 | Real-Time Innovations, Inc. | Real-time publish-subscribe system |
JP3643867B2 (ja) * | 2001-07-23 | 2005-04-27 | 独立行政法人情報通信研究機構 | マニピュレータの制御方法 |
TW200523703A (en) * | 2003-12-01 | 2005-07-16 | Unisearch Ltd | A method for controlling a system formed from interdependent units |
JP4735795B2 (ja) * | 2003-12-26 | 2011-07-27 | 独立行政法人 宇宙航空研究開発機構 | 冗長マニピュレータの制御方法 |
JP2006013448A (ja) | 2004-05-21 | 2006-01-12 | Matsushita Electric Ind Co Ltd | ラインバランス制御方法、ラインバランス制御装置、および部品実装機 |
JP4722558B2 (ja) * | 2004-06-01 | 2011-07-13 | 株式会社小松製作所 | ダイクッション装置 |
US7533128B1 (en) | 2005-10-18 | 2009-05-12 | Real-Time Innovations, Inc. | Data distribution service and database management systems bridge |
US8054752B2 (en) * | 2005-12-22 | 2011-11-08 | Intuitive Surgical Operations, Inc. | Synchronous data communication |
EP1837131A1 (de) * | 2006-03-20 | 2007-09-26 | Abb Research Ltd. | Manipulator, zum Beispiel für einen Industrieroboter, und Antriebsvorrichtung für einen Manipulator |
EP1844909A1 (de) * | 2006-04-11 | 2007-10-17 | Abb Ab | Mehrfacheingabe- Steuerung eines Industrierobotersystems |
US7783853B1 (en) | 2006-04-24 | 2010-08-24 | Real-Time Innovations, Inc. | Memory usage techniques in middleware of a real-time data distribution system |
US8671135B1 (en) | 2006-04-24 | 2014-03-11 | Real-Time Innovations, Inc. | Flexible mechanism for implementing the middleware of a data distribution system over multiple transport networks |
US7827559B1 (en) | 2006-04-24 | 2010-11-02 | Real-Time Innovations, Inc. | Framework for executing multiple threads and sharing resources in a multithreaded computer programming environment |
CN101089763B (zh) * | 2006-06-15 | 2011-01-05 | 上海广茂达伙伴机器人有限公司 | 基于现场总线的微型伺服电机控制***以及方法 |
CN101219284A (zh) * | 2007-01-08 | 2008-07-16 | 鸿富锦精密工业(深圳)有限公司 | 仿生类装置 |
US7675257B2 (en) | 2007-03-09 | 2010-03-09 | Regal Beloit Corporation | Methods and systems for recording operating information of an electronically commutated motor |
KR101305819B1 (ko) * | 2012-01-04 | 2013-09-06 | 현대자동차주식회사 | 착용식 로봇의 사용자 조작 의도 토크 추출방법 |
CN102896631A (zh) * | 2012-10-09 | 2013-01-30 | 温州大学 | 实时/在线方位调整装置和方法 |
JP6700669B2 (ja) * | 2015-04-07 | 2020-05-27 | キヤノン株式会社 | 制御方法、ロボット装置、プログラム、記録媒体、及び物品の製造方法 |
CN106041935A (zh) * | 2016-07-27 | 2016-10-26 | 重庆峰创科技有限公司 | 一种工业机器人高可靠容错控制装置 |
GB201713277D0 (en) * | 2017-08-18 | 2017-10-04 | Rolls Royce Plc | Hyper-redundant manipulators |
CN108247620A (zh) * | 2018-01-22 | 2018-07-06 | 东莞市精联精密技术有限公司 | 一种微米级工业测量质检机械手臂及其检测方法 |
CN109909646B (zh) * | 2019-02-02 | 2021-01-01 | 宁波吉利汽车研究开发有限公司 | 机器人焊枪工作点的修正方法、装置及电子设备 |
US11433534B2 (en) * | 2019-03-07 | 2022-09-06 | Abb Schweiz Ag | Robotic arm including edge computer and cabling arrangement facilitating flexible function advanced distal arm end tooling |
EP4219092A1 (de) * | 2022-01-28 | 2023-08-02 | Kassow Robots ApS | Optimierte sicherheitsarchitektur in einem roboter |
Family Cites Families (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2377251A1 (fr) * | 1977-01-12 | 1978-08-11 | Line Sa | Procede de commande d'interpolateurs dans les commandes numeriques |
US4221997A (en) * | 1978-12-18 | 1980-09-09 | Western Electric Company, Incorporated | Articulated robot arm and method of moving same |
US4467436A (en) * | 1981-10-26 | 1984-08-21 | United States Robots, Inc. | Robot arm controller with common bus memory |
JPS5927307A (ja) * | 1982-08-04 | 1984-02-13 | Hitachi Ltd | 経路制御方法及び装置 |
US4514814A (en) * | 1982-09-07 | 1985-04-30 | General Electric Company | Multi-processor axis control |
JPS59114609A (ja) * | 1982-12-22 | 1984-07-02 | Hitachi Ltd | ロボットの制御装置 |
JPS59218513A (ja) * | 1983-05-26 | 1984-12-08 | Fanuc Ltd | 工業用ロボツトの円弧制御法 |
US4547858A (en) * | 1983-06-13 | 1985-10-15 | Allied Corporation | Dynamic control for manipulator |
US4617502A (en) * | 1983-06-30 | 1986-10-14 | Hitachi, Ltd. | Method and apparatus for controlling a robot hand along a predetermined path |
JPS6085885A (ja) * | 1983-10-17 | 1985-05-15 | 株式会社日立製作所 | 多関節機構の制御装置 |
JPS60193016A (ja) * | 1984-03-14 | 1985-10-01 | Toyota Motor Corp | ロボツト装置 |
DE3501968A1 (de) * | 1985-01-22 | 1986-07-24 | Siemens AG, 1000 Berlin und 8000 München | Steuerungseinrichtung fuer eine mehrachsige werkzeugmaschine |
US4663726A (en) * | 1985-04-15 | 1987-05-05 | General Electric Co. | Robot control utilizing cubic spline interpolation |
JPS62232006A (ja) * | 1986-04-02 | 1987-10-12 | Yokogawa Electric Corp | ロボツト・システム |
JP2713899B2 (ja) * | 1987-03-30 | 1998-02-16 | 株式会社日立製作所 | ロボツト装置 |
JPS63289607A (ja) * | 1987-05-21 | 1988-11-28 | Toshiba Corp | 知能ロボットのモジュ−ル間通信制御方式 |
JPH0820894B2 (ja) * | 1987-07-01 | 1996-03-04 | 株式会社日立製作所 | 産業用ロボツトの動作制御方法 |
JP2719345B2 (ja) * | 1988-03-30 | 1998-02-25 | 豊田工機株式会社 | 力センサを用いた加工制御装置 |
US4878002A (en) * | 1988-10-27 | 1989-10-31 | Advanced Engineering Systems, Operations & Products, Inc. | Multi-axis DSP-based parallel processing servo controller for machine tools and robots |
-
1990
- 1990-05-29 US US07/529,571 patent/US5055755A/en not_active Expired - Fee Related
- 1990-05-30 EP EP90110293A patent/EP0400624B1/de not_active Expired - Lifetime
- 1990-05-30 DE DE69013573T patent/DE69013573T2/de not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
EP0400624B1 (de) | 1994-10-26 |
DE69013573D1 (de) | 1994-12-01 |
US5055755A (en) | 1991-10-08 |
EP0400624A3 (de) | 1991-05-15 |
EP0400624A2 (de) | 1990-12-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE69013573T2 (de) | Verteilersteuergerät. | |
DE102006047026B4 (de) | Verfahren und System zum redundanten Ansteuern einer Slaveeinrichtung | |
EP1035953B1 (de) | Überwachungs- und steuergerät sowie verfahren zur überwachung einer technischen anlage mit erhöhten sicherheitsanforderungen, insbesondere eines handhabungsgerätes | |
DE3873411T2 (de) | Verfahren und geraet zum steuern eines robotersystems. | |
DE19634055B4 (de) | Industrieroboter und Steuerungseinheit dafür | |
EP1415208B1 (de) | Verfahren und prozessleitsystem zum betrieb einer technischen anlage | |
DE68919801T2 (de) | Verfahren zur kollisionsermittlung von beweglichen, mittels servomotoren angetriebenen gegenständen. | |
EP1297394B1 (de) | Redundantes steuerungssystem sowie steuerrechner und peripherieeinheit für ein derartiges steuerungssystem | |
DE3786860T2 (de) | Regelvorrichtung für einen roboter. | |
DE69325975T2 (de) | System zum Sicherheitsbetrieb von Manipulatoren | |
EP1040028B1 (de) | Verfahren zur fehlererkennung von mikroprozessoren in steuergeräten eines kfz | |
DE3587396T2 (de) | Handhabungsgerät mit beweglicher Struktur. | |
DE102011117094B4 (de) | Robuster betrieb von sehnengetriebenen roboterfingern unter verwendung von kraft- und positionsbasierten steuergesetzen | |
DE4411426B4 (de) | Multitask-Steuersystem | |
EP0628647A1 (de) | Steuervorrichtung für eine Spinnereimaschine | |
EP1860564A1 (de) | Verfahren und Vorrichtung zum Austausch von Daten auf Basis des OPC-Kommunikationsprotokolls zwischen redundanten Prozessautomatisierungskomponenten | |
DE102012003242A1 (de) | Verfahren zum ausfallsicheren Betreiben eines Prozesssteuersystems mit redundanten Steuereinrichtungen | |
EP0791874B1 (de) | Verfahren und Vorrichtung zum Steuern von binären Sensoren und/oder Aktuatoren | |
DE69122185T2 (de) | Verfahren und Vorrichtung zum Steuern eines Gelenkroboters mit Redundanz | |
DE102020126209A1 (de) | Roboter | |
EP0903654B1 (de) | Steuerungssystem für eine Palettieranlage | |
DE3831048A1 (de) | Betriebsprogramm fuer eine datenverarbeitungsanlage | |
EP3955077A1 (de) | Steuerungseinrichtung einer betriebsanlage | |
DE102008008449B4 (de) | Elektrische Presse | |
DE102005013289B4 (de) | Verfahren zum Kompensieren langsam veränderlicher Merkmale einer Werkzeugmaschine |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
8364 | No opposition during term of opposition | ||
8320 | Willingness to grant licences declared (paragraph 23) | ||
8339 | Ceased/non-payment of the annual fee |