DE2660912C2 - Programmsteuerung für einen Manipulator - Google Patents

Programmsteuerung für einen Manipulator

Info

Publication number
DE2660912C2
DE2660912C2 DE2660912A DE2660912A DE2660912C2 DE 2660912 C2 DE2660912 C2 DE 2660912C2 DE 2660912 A DE2660912 A DE 2660912A DE 2660912 A DE2660912 A DE 2660912A DE 2660912 C2 DE2660912 C2 DE 2660912C2
Authority
DE
Germany
Prior art keywords
arm
register
signal
coordinate
program control
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
Application number
DE2660912A
Other languages
English (en)
Inventor
Maurice J. Newton Conn. Dunne
Joseph F. Newton Conn. Engelberger
Horace L. Ridgefield Conn. Gardner
Torsten H. Brookfield Conn. Lindbom
William Weston Conn. Perzley
Wilbur N. Newton Conn. Roberts
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.)
UNIMATION Inc BETHEL CONN US
Original Assignee
UNIMATION Inc BETHEL CONN US
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 UNIMATION Inc BETHEL CONN US filed Critical UNIMATION Inc BETHEL CONN US
Application granted granted Critical
Publication of DE2660912C2 publication Critical patent/DE2660912C2/de
Expired legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/42Recording and playback systems, i.e. in which the programme is recorded from a cycle of operations, e.g. the cycle of operations being manually controlled, after which this record is played back on the same machine
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23PMETAL-WORKING NOT OTHERWISE PROVIDED FOR; COMBINED OPERATIONS; UNIVERSAL MACHINE TOOLS
    • B23P21/00Machines for assembling a multiplicity of different parts to compose units, with or without preceding or subsequent working of such parts, e.g. with programme control
    • B23P21/002Machines for assembling a multiplicity of different parts to compose units, with or without preceding or subsequent working of such parts, e.g. with programme control the units stationary whilst being composed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J17/00Joints
    • B25J17/02Wrist joints
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/0084Programme-controlled manipulators comprising a plurality of manipulators
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16HGEARING
    • F16H9/00Gearings for conveying rotary motion with variable gear ratio, or for reversing rotary motion, by endless flexible members
    • F16H9/02Gearings for conveying rotary motion with variable gear ratio, or for reversing rotary motion, by endless flexible members without members having orbital motion
    • F16H9/04Gearings for conveying rotary motion with variable gear ratio, or for reversing rotary motion, by endless flexible members without members having orbital motion using belts, V-belts, or ropes
    • F16H9/10Gearings for conveying rotary motion with variable gear ratio, or for reversing rotary motion, by endless flexible members without members having orbital motion using belts, V-belts, or ropes engaging a pulley provided with radially-actuatable elements carrying the belt
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/19Numerical 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 characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • G05B19/21Numerical 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 characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device
    • G05B19/25Numerical 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 characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for continuous-path control
    • G05B19/251Numerical 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 characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for continuous-path control the positional error is used to control continuously the servomotor according to its magnitude
    • G05B19/253Numerical 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 characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for continuous-path control the positional error is used to control continuously the servomotor according to its magnitude with speed feedback only
    • 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/34Director, elements to supervisory
    • G05B2219/34236Multiplex for servos, actuators
    • 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/34Director, elements to supervisory
    • G05B2219/34239Multiplex for whole system
    • 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/35Nc in input of data, input till input file format
    • G05B2219/35238Gray-code
    • 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/35Nc in input of data, input till input file format
    • G05B2219/35543Cartesian to polar and vice versa
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/39Robotics, robotics to robotics hand
    • G05B2219/39002Move tip of arm on straight line
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/39Robotics, robotics to robotics hand
    • G05B2219/39468Changeable hand, tool, code carrier, detector
    • 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/40307Two, dual arm robot, arm used synchronously, or each separately, asynchronously
    • 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/42Servomotor, servo controller kind till VSS
    • G05B2219/42207Generate points between start and end position, linear interpolation
    • 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/43Speed, acceleration, deceleration control ADC
    • G05B2219/43183Speed control, input is the reference, but no feedback
    • 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/45Nc applications
    • G05B2219/45051Transfer line
    • 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/45Nc applications
    • G05B2219/45083Manipulators, robot
    • 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/49Nc machine tool, till multiple
    • G05B2219/49395Repeating same operations for other coordinates

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Physics & Mathematics (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)
  • Automatic Assembly (AREA)
  • Control Of Position Or Direction (AREA)

Description

65
Die Erfindung betrifft eine Programmsteuerung für einen Manipulator gemäß Oberbegriff des Patentanspruchs 1.
Eine derartige Programmsteuerung ist aus der DE-OS 20 12 858 bekannt. Sie erlaubt es, für die Programmierung in einer sog. Instruktionsphase vor dem eigentlichen Arbeitsbetrieb den Manipulatorarm b^w. die daran befindliche »Hand« unter manueller Steuerung maschinell in einzelne gewünschte Positionen zu führen, die dann bei Betätigung eines entsprechenden Druckknopfes in Form entsprechender digitaler Positionssignale in dem Programmspeicher aufgezeichnet werden. Indessen kann es vorkommen, daß der Arm die betreffende gewünschte Position wieder verläßt, noch ehe die Aufzeichnung erfolgt ist. Dies kann etwa geschehen, indem die mit der Programmierung beschäftigte oder eine andere Person an den Arm anstößt oder einfach durch Leckströmungen in den i. a. hydraulischen Antriebsmitteln und deren Steuerventilen. Es ist besonders unerwünscht, wo es, z. B. wenn zwei derartige Manipulatoren zu einem Montagevorgang zusammenwirken, auf hohe Präzision in der jeweiligen Positionierung ankommt. Soll der eine Manipulator irgendwelche Verrichtungen an einem Teil vornehmen, das von dem anderen gehalten wird, so muß die Position dieses Teiles während der Instruktion des erstgenannten Manipulators absolut festliegen.
Dementsprechend besteht die Aufgabe der Erfindung darin, einen Weg anzugeben, um in der Instruktionsphase eine einmal eingegebene und im Arbeitsbetrieb wieder anzufahrende Position, solange dies erwünscht ist, präzise festhalten zu können.
Diese Aufgabe ist für eine Programmsteuerung der eingangs genannten Art durch die kennzeichnenden Merkmale des Anspruchs 1 gelöst.
Die in dem betreffenden Register gespeicherten Positionsdaten gestatten es, durch Vergleich mit den jeweiligen aktuellen Positionsdaten aus den Codierern für die einzelnen Koordinaten Abweichungssignale zu erzeugen, um damit eine auftretende Positionsabweichung auszuregeln.
Die Unteransprüche geben vorteilhafte Ausgestaltungsmöglichkeiten an, wie sie genauer noch aus der nachfolgenden Beschreibung eines Ausführungsbeispiels anhand der Figuren hervorgehen. Hierbei zeigt
Fig. 1 ein vereinfachtes Blockschaltbild der hier wesentlichen Schaltmittel der Programmsteuerung für eine Bewegungskoordinate des Manipulators,
Fig. 2 ein vereinfachtes Blockschaltbild der Programmsteuerung nach Fig. 1 für alle auftretenden Bewegungskoordinaten, und
Fig. 3 ein Diagramm, welches die in der Anordnung nach Fig. 2 zur Anwendung kommenden Multiplex-Zeitintervalle zeigt.
Fig. 1 zeigt die Schaltungsanordnung für eine einzelne von beispielsweise sechs Bewegungskoordinaten des Manipulators, nämlich für eine Armschwenkbewegung um eine vertikale »Hüftachse«. Hiernach besitzt der betreffende Codierer 610 eine Gruppe von Ausgangsleitungen 620, auf denen das digitale Positionssignal in Form einer Zahl im Gray-Code erscheint. Diese Leitungen sind mit einem Gray-Code/Binärcode-Umsetzer 622 verbunden, worin das Positionssignal in ein Binärcodesignal verwandelt wird, das über eine Leitung 624 in einen Digitalvergleicher 626 gegeben wird.
Während des Arbeitsbetriebs der Anlage ist der Programmspeicher 628 derselben über ein Vielleiterkanal 630 und einen Abschnitt 632a eines Betriebswahlschalters 632 mit einem anderen Eingang 634 des Vergleichers 626 verbunden. In dem Vergleicher 626 werden das digitale Positionssignal aus dem Codierer und das digitale Steuersignal
aus dem Speicher miteinander verglichen, um daraus ein digitales Abweichungssignal entsprechend der Abweichung zu erhalten, welche eine mit dem Codierer 610 gekuppelte drehbare Plattform der Säule, an der sich der Arm befindet, gerade von ihrer durch das betreffende Steuersignal 5 vorgegebenen Position aufweist. Das Abweichungssignal aus dem Vergleicher 626 gelangt über ein Vielleiterkabel 636 zu einem Digital-Analog-Umsetzer 640, worin es in ein Analogsignal von entsprechender Form umgewandelt wird, um den Manipulatorann ohne Oberhub in die vorgegebene Position zu schwenken. Das Analogsignal aus dem Umsetzer 640 wird in einen Prüf- und Haltestromkreis 642 gegeben, um während derjenigen Zeit, die der betreffenden Koordinate zugeteilt ist, seine Größe zu ermitteln und daraus eine proportionale Spannung zu gewinnen, die kontinuierlich einem Servo-Leistuagsverstärker 644 für die Betätigung des Servoventils 646 für die Armschwenkbewegung zugeführt wird, welches seinerseits den betreffenden Hydraulikmotor 224 steuert. Ein Geschwindigkeits-Rückkopplungssignal aus einem Tachogenerator kann über den Eingang 643 an den Servoverstärker 644 gelangen, um eine rasche Bewegung ohne Instabilitäten zu ernüoglichen.
Der Vergleicher 626 liefert des weiteren ein Plus-Minus-Signal (Richtungssignal), das über die Leitung 648 einem Richtungsschaltkreis 650 zugeführt wird, worin die erforderliche Richtung festgelegt wird, in der sich der Manipulatorarm zu bewegen hat, um die in dem Vergleicher 626 festgestellte Abweichung zu reduzieren. Das Ausgangssignal dieses Schaltkreises wird zusätzlich dem Servoverstärker 644 zugeführt, damit dieser über das Servoventil 646 den Hydraulikmotor 224 in der korrekten Richtung betätigt.
Alie diese Schaltungskomponenten sind im wesentlichen in der DE-OS 20 12 858 beschrieben. Jedoch wird nun das digitale Ausgangssignal des Codierers 610 nach Passieren des Umsetzers 622 kontinuierlich in einem Register 652 für die betreffende Koordinate aufgezeichnet, das während eines jeden der Armschwenkkoordinate zugeteilten Multiplexintervalls auf das Laufende gebracht wird. Ein ähnliches Register ist auch für jede weitere Koordinate vorgesehen, und die Ausgangssignale aller dieser Register werden über UND-Gatter mit offenem Kollektor geleitet, von denen hier nur eines, 654, dargestellt ist. Von dort können sie über den Abschnitt 632a des Betriebswahlschalters anstelle des Ausgangssignals aus dem Speicher 628 an den zweiten Eingang des Vergleichers 626 gelangen.
Während des Instruktionsbetriebes wird das aus dem Codierer 610 erhaltene Positionssignal als Steuersignal dafür verwendet, den Manipulatorarm in der zunächst angefahrenen Position zn halten, während die Instruktionsperson den Arm eines kooperierenden zweiten Manipulators in eine gewünschte Position bringt. Genauer gesagt findet während des Instruktionsbetriebes eine gewöhnlich in einem Handgriff untergebrachte Instruktionssteuereinrichtung 656, wie sie in der DE-OS 20 12 858 im einzelnen beschrieben ist, dazu Verwendung, einen jeden Arm bzw. seine Hand nacheinander in die gewünschten Programmpositionen zu bringen.
Die Instruktionssteuereinrichtung 656 enthält zwei Richtungsknöpfe 658 und 660 für die Armschwenkbewegung, die von der Instruktionsperson wahlweise gedruckt werden können, um den Manipulatorarm um die Hüftachse in einer bestimmten Richtung zu verschwenken. Wenn z. B. der Knopf 658 gedrückt wird, der beispielsweise ein Plus-Signal liefern soil, so gelangt dieses Signal über die Leitung 662 zu dem Richtungsschaltkreis 650, wodurch der Servoverstärker 644 in der t streifenden Richtung angesteuert wird.
Zur gleichen Zeit liefert ein Abschnitt 6326 des Betriebswahlschalters ein +SV-Spannungssignal über den Knopf 658 zum einen Eingang des UND-Gatters 664, während der andere Eingang desselben während des der Armschwenkkoordinate zugeordneten Multiplex-Zeitintervalles einen Aufsteuerimpuls empfängt.
Das Ausgangssignal des UND-Gatters 664 dient als Taktsignal für das Register 652, wodurch dieses Register in die Lage versetzt wird, das Ausgangssignal des Codierers 610 während eines sog. G3-Multiplexintervalls für die betreffende Koordinate zu speichern, jedoch nur dann, wenn einer der beiden Richtungsknöpfe 658 und 660 gedruckt wird. Der der Armschwenkkoordinate zugeordnete Multipleximpuls wird ebenso an das UND-Gatter 654 gegeben, wodurch die Ausgangssignale aller sechs Koordinaten über das Vielleiterkabel 666 und den Schalterabschnitt 632a gemeinsam als Steuersignale an den Eingang des Vergleichers 626 gelangen.
Während der Schwenkbewegungen des Manipulatorarmes im Instruktionsbetrieb, d. h. wj'rxend z. B. der Richtungsknopf 658 gedrückt wird, gelangt eine Spannung an den Servoverstärker 644, wodurch der Hydraulikmotor 224 in der Plus-Richtung betätigt wird. Sobald jedoch der Knopf 658 freigegeben wird, wird das Register 652 stillgesetzt und hält den zuletzt aufgenommenen Wert aus dem Codierer 610 fest. Dieser so in dem Register 652 gespeicherte Wert dient dann als Steuersignal für den Vergleicher 626. Wenn nun die Instruktionsperson den Manipulatorarm in einer anderen Koordinate bewegt oder die Instruktionssteuereinrichtung 656 ablegt, um unterdessen den zweiten Manipulatorann zu instruieren, so liegt noch immer das gleiche Ausgangssignal aus dem Register 652 an dem Vergleicher 626 an. Hinzukommt, daß die weiteren Komponenten dieses Servokreises weiterhin in Funktion bleiben, so daß bei irgend einer Abweichung des erstgenannten Manipulatorarmes aus einer zuletzt eingestellten Stellung diese Bewegung eine Veränderung des Ausgangssignals aus dem Codierer 610 hervorruft, rtas in dem Vergleicher 626 kontinuierlich mit dem Signal aus dem Register 652 verglichen wird. Hierdurch werden die nachfolgenden Steuerungskomponenten in der zuvor beschriebenen Weise wirksam, um den Manipulatorarm in die dem Signal aus dem Register 652 entsprechende Stel'ung zurückzuführen.
Anhand der Fig. 2 und 3 sei nun die Schaltungsanordnung für diese Funktionsweise in der Instruktionsphase für alle sechs Koordinaten des betreffenden Manipulatorarmes weiter erläutert. Wie aus Fig. 2 ersichtlich, ist ein Taktgenerator 670 über einen programmierbaren Binärzähler 672, dessen Funktionsweise nachfolgend noch beschrieben wird, mit einer Gruppe von 3-Bit-Zählern 674 verbunden, deren Ausgangssignale an einen Oktal-Decodierer 676 gelangen. Der Decodierer 676 liefert Multipleximpulse an die Ausgangsleitungsn Gl bis GS, deren jeder eine nominale Dauer von <?ftva 250 us besitzt, wie aus Fig. 3 hervorgeht. Die Ausgangsimpulse der letzten sechs Multiplexintervalle sind den sechs Koordinaten des Manipulatorarmes zugeordnet, während die ersten zwei MultiplexintervaiJe G7 und Gl für zusätzliche Steuerfunktionen Verwendung finden, wie z.B. einen Fremdsteuerbefehl (OX) oder einen Abwartebefehl (WX) für den programmierbaren Zähler, wiederum in binärcodierter Form. Das Ausgangssignal des 3-Bit-Zählers 674 wird an ein Adressenregister 678 gegeben, das mit dem Programmspeicher 628 in Verbindung steht, so daß ein jeder in dem Speicher 628 eingespeicherte Programmschritt über dieses Adressenregister zugänglich ist. Das Register 678 wird durch einen Adressenzähler 680 gesteuert, der während des Arbeitsbetriebs dazu dient, in
der üblichen Weise einen Programmschritt nach dem anderen aus dem Speicher 628 abzurufen.
Um für alle sechs Koordinaten einen gemeinsamen Gray-Code/Binärcode-Umsetzer 622 verwenden zu können, liegen die Ausgangsleitungen der Codierer 602 und 608 bis 618 an einer Reihe von UND-Gattern 682 und 684 mit offenem Kollektor an. Die anderen Eingange dieser UND-Gatter erhalten Multipleximpulse von dem Oktal-Decodierer 676 entsprechend der Zuordnung der Multiplexintervalle zu den einzelnen Koordinaten. So erhalten die UND-Gatter 682 und 684 in Verbindung mit dem Codierer 610 Multipleximpulse im Intervall C3, die UND-Gatter in Verbindung mit dem Codierer 608 Multipleximpulse im Intervall G4 und die UND-Gatter in Verbindung mit dem Codierer 614 Multipleximpulse im Intervall GS.
Die Richtungsknöpfe 686 und 688 finden dazu Verwendung, ein Register 690 auf den letzten Stand zu bringen, und die Richtungsknöpfe 692 und 694 dienen dazu, das
Verbindung mit Fig. 1 beschrieben wurde. Die Ausgangssignale aller drei Register 652, 690 und 696 werden über UND-Gatter mit offenem Kollektor, wie die UND-Gatter 654, an den Schalterabschnitt 632« des Betriebswahlschalters gegeben, von wo sie während der Instruktionsphase, wie zuvor beschrieben, an den Vergleicher 626 gelangen. Der Vergleicher 626 und der Digital-Analog-Umsetzer 640, der zugleich in der DE-OS 20 12 858 beschriebene Funktionserzeugungsschaltkreise enthalten kann, sind für alle sechs Koordinaten gemeinsam vorgesehen, wodurch sich der Schaltungsaufwand außerordentlich reduziert. Das Ausgangssignal des Digital-Analog-Umsetzers mitsamt seinen Funktionserzeugungsschaltkreisen wird an die einzelnen Prüf- und Halteschaltkreise der verschiedenen Koordinaten, wie z. B. den Schaltkreis 642 für die Armschwenkbewegung, gegeben. Der Prüf- und Halteschaltkreis 696 für die Unterarmbeugebewegung sowie der Prüf- und Halteschaltkreis 698 für die Unterarmdrehbewegung sind gleichfalls in Fig. 2 dargestellt. Zu ihnen gehören die Servoverstärker 700 und 702. Es versteht sich, daß der Vergleicher 626 auch ein geeignetes Richtungssignal liefert, das den Richtungsschaltkreisen für die einzelnen Koordinaten zugeführt wird, wie zuvor für den Richtungsschaltkreis 650 in Verbindung mit Fig. 1 beschrieben, jedoch sind diese Schaltkreise der Einfachheit halber in Fig. 2 weggelassen. So sind für alle sechs Bewegungskoordinaten aktive Servosysteme vorgesehen, um den Manipulatorarm bzw. die Hand während der Instruktionsphase in jede gewünschte Position bringen und dort halten zu können. Eine Verstellung des Armes bzw. der Hand findet bei dieser Betriebsweise nur dann statt, wenn einer der Richtungsknöpfe der Instruk^ionssteuereinrichtung gedrückt wird. Während der dann erfolgenden Bewegung werden die Bewegungskomponenten in den einzelnen Koordinaten durch die Register 652, 690 und 696 etc. laufend aufgezeichnet, so daß bei Freigabe des betreffenden Richtungsknopfes eine genaue Aufzeichnung der dann eneichten letzten Position vorliegt. Diese Aufzeichnung dient in der beschriebenen Weise dazu, nach Art eines Regelvorganges diese zuletzt eingenommene Position aufrechtzuerhalten. In diesem Zusammenhang ist noch anzumerken, daß nach Anfahren einer jeden gewünschten Position mittels der Richtungsknöpfe ein sog. Aufzeichnungsknopf 704 gedrückt wird, womit die digitalen Positionssignale der Codierer sämtlicher sechs Koordinaten während der entsprechenden Multiplexintervalle G3 bis GH an den Speieher 628 gegeben werden. Dazu können noch zusätzliche Steuersignale in Verbindung mit dem jeweiligen Programmschritt, die durch entsprechende Schalter eingegeben werden, während der betreffenden Multiplexintervalle (71 und G'2 eingespeichert werden.
Hierzu 2 Blatt Zeichnungen

Claims (5)

Patentansprüche:
1. Programmsteuerung für einen Manipulator, der einen entlang einer gewünschten Bahn beweglichen Arm sowie Codierer (z. B. 608, 610, 614) zum Erzeugen digitaler Signale entsprechend der jeweiligen tatsächlichen Position des Armes entlang der Bahn sowie eine Instruktionssteuereinrichtung (656) zum Bewegen des Armes entlang der Bahn in einer Instruktionsphase I» des Manipulatorbetriebes aufweist, gekennzeichnet durch ein Register (652), Mittel (6326, 664) zum Einspeichern des jeweils aktuellen digitalen Signals in das Register während der Arm in der Instruktionsphase mittels der Instruktionssteuereinrichtung (656) entlang der Bahn bewegt wird derart, daß in dem Register bei Stillstand des Armes jeweils die von dem Arm zuletzt eingenommene Position gespeichert ist, und Mittel einschließlich eines Vergleichers (626), die in der Insiniktkmsphase Aufgrund des jeweils aktuellen digitalen Signals und des in dem Register gespeicherten Signals den Arm in derjenigen Position zu halten suchen, die dem in dem Register gespeicherten Signal entspricht.
2. Programmsteuerung nach Anspruch 1, dadurch gekennzeichnet, daß die Instruktionssteuereinrichtung (656) zwei Richtungsknöpfe (658, 660) und auf die Betätigung eines jeden dieser Richtungsknöpfe ansprechende Schaltmittel (664) aufweist, um den Ann zu bewegen und zugleich das digitale Signal aus den Codierern (608, 610, 614) in das Register (652) einzugeben derart, daß rfas in dem Register gespeicherte Signal jeweils das bei Freigabe des betreffenden Richtungsknopfes (658, 660) gerade aktu-ile ist.
3. Programmsteuerung nach Anspruch 1 oder 2, wobei der Manipulatorann in mi..ireren Koordinaten beweglich ist, Codierer (608, 610, 616) zur Erzeugung digitaler Signale entsprechend den tatsächlichen Positionen des Armes in einer jeden Koordinate und Register (652, 690, 696) für eine jede Koordinate vorgesehen sind, dadurch gekennzeichnet, daß der Vergleicher (626) allen Koordinaten gemeinsam ist und jeweils das aktuelle digitale Signal einer jeden Koordinate mit dem in dem Register einer jeden Koordinate gespeicherten Signal vergleicht.
4. Programmsteuerung nach Anspruch 3, gekennzeichnet durch Schaltmittel (676) zum Erzeugen aufeinanderfolgender Multiplex-Impulse während aufeinanderfolgender Multiplex-Zeitintervalle, von diesen MuI-tiplex-lmpulsen gesteuerte Schaltmittel (682, 684 etc.) zum aufeinanderfolgenden Anlegen der digitalen sv Signale der einzelnen Koordinaten an einen Eingang des gemeinsamen Vergleichers (626) und von den MuI-tiplex-Impulsen gesteuerte Schaltmittel (642, 696 etc.) zum aufeinanderfolgenden Anlegen der Ausgangssignale der einzelnen Register (652, 690, 696) an den anderen Eingang des gemeinsamen Vergleichers.
5. Programmsteuerung nach Anspruch 4, gekennzeichnet durch von den Multiplex-Impulsen gesteuerte Schaltmittel (644, 700 etc.) zum aufeinanderfolgenden Steuern der Bewegungen des Armes in einer jeden Koordinate in der Weise, daß der Arm in der dem jeweils in dem Register gespeicherten Signal entsprechenden Position festgehalten wird.
DE2660912A 1975-10-28 1976-10-28 Programmsteuerung für einen Manipulator Expired DE2660912C2 (de)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
US05/625,932 US4163183A (en) 1975-10-28 1975-10-28 Programmable automatic assembly system

Publications (1)

Publication Number Publication Date
DE2660912C2 true DE2660912C2 (de) 1986-07-17

Family

ID=24508237

Family Applications (2)

Application Number Title Priority Date Filing Date
DE2649123A Expired DE2649123C2 (de) 1975-10-28 1976-10-28 Programmierbarer Manipulator
DE2660912A Expired DE2660912C2 (de) 1975-10-28 1976-10-28 Programmsteuerung für einen Manipulator

Family Applications Before (1)

Application Number Title Priority Date Filing Date
DE2649123A Expired DE2649123C2 (de) 1975-10-28 1976-10-28 Programmierbarer Manipulator

Country Status (8)

Country Link
US (1) US4163183A (de)
JP (1) JPS5284669A (de)
CA (1) CA1084966A (de)
DE (2) DE2649123C2 (de)
FR (4) FR2357339A1 (de)
GB (4) GB1561260A (de)
IT (1) IT1075776B (de)
SE (6) SE446071B (de)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3931964A1 (de) * 1989-09-25 1991-04-04 Rexroth Mannesmann Gmbh Robotersteuerung fuer den bewegungsablauf mindestens eines von einem stellglied angesteuerten arbeitsgeraetes

Families Citing this family (55)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4086522A (en) * 1976-09-08 1978-04-25 Unimation, Inc. Computer assisted teaching arrangement for conveyor line operation
US4263538A (en) * 1977-05-30 1981-04-21 Societa Di Elettronica Per L'automazione Sepa S.P.A. Control system for an automatic machine
DE2861285D1 (en) * 1977-10-20 1982-01-14 Ici Plc An industrial manipulator for placing articles in close proximity to adjacent articles and a method of close packing articles therewith
US4420812A (en) * 1979-09-14 1983-12-13 Tokico, Ltd. Teaching- playback robot
US4385358A (en) * 1979-10-19 1983-05-24 Tokico Ltd. Robot
US4445184A (en) * 1980-07-19 1984-04-24 Shin Meiwa Industry Co., Ltd. Articulated robot
DE3033202C2 (de) * 1980-09-03 1984-04-19 Siemens AG, 1000 Berlin und 8000 München Verfahren zur Werkzeugbahn-Interpolation
CH645564A5 (de) * 1980-09-05 1984-10-15 Heinz Hossdorf Verfahren und vorrichtung fuer das formen der oberflaeche eines werkstuecks.
CH639584A5 (fr) * 1980-10-10 1983-11-30 Microbo Sa Automate susceptible d'apprentissage.
JPS5769314A (en) * 1980-10-13 1982-04-28 Fanuc Ltd Numerical control system
US4379335A (en) * 1980-10-28 1983-04-05 Auto-Place, Inc. Electronic controller and portable programmer system for a pneumatically-powered point-to-point robot
US4468695A (en) * 1980-11-20 1984-08-28 Tokico Ltd. Robot
JPS57113114A (en) * 1980-12-30 1982-07-14 Fanuc Ltd Robot control system
JPS584377A (ja) * 1981-03-18 1983-01-11 株式会社安川電機 関節形産業用ロボツトの制御装置
IT1144709B (it) * 1981-05-15 1986-10-29 Dea Spa Sistema di misura dimensionale servito da una pluralita di bracci operativi e controllato da un sistema a calcolatore
US4581893A (en) * 1982-04-19 1986-04-15 Unimation, Inc. Manipulator apparatus with energy efficient control
FR2530173B1 (fr) * 1982-07-14 1987-08-14 Kuka Schweissanlagen & Roboter Procede et montage pour freiner une partie de machine et pour l'arreter
US4558420A (en) * 1982-10-25 1985-12-10 Gerber Scientific Inc. Computer generated mold for contoured garment piece formation
JPS59106007A (ja) * 1982-12-10 1984-06-19 Toyota Central Res & Dev Lab Inc 多関節型ロボツトの軌跡制御装置
JPS59172013A (ja) * 1983-03-22 1984-09-28 Mitsubishi Electric Corp 数値制御装置の刃物台同期方式
DE3337782A1 (de) * 1983-10-18 1984-11-29 Daimler-Benz Ag, 7000 Stuttgart Verfahren zum programmieren und wiederholten ausfuehren einer bewegung eines roboters
US4557663A (en) * 1984-01-09 1985-12-10 Westinghouse Electric Corp. Modular, low cost, pogrammable assembly system
GB2155212A (en) * 1984-02-29 1985-09-18 Dowty Group Services Apparatus for assembling component parts
US4688983A (en) * 1984-05-21 1987-08-25 Unimation Inc. Low cost robot
US4973215A (en) * 1986-02-18 1990-11-27 Robotics Research Corporation Industrial robot with servo
US4878801A (en) * 1986-05-19 1989-11-07 Invention Design Engineering Associates, Inc. Machine for handling circuit package storage tubes
US4748552A (en) * 1986-05-28 1988-05-31 Goro Kikuchi Sequence control system
US4822238A (en) * 1986-06-19 1989-04-18 Westinghouse Electric Corp. Robotic arm
DE3803040A1 (de) * 1988-02-02 1989-08-10 Eke Robotersysteme Gmbh Schwenkantrieb fuer den arm eines industrieroboters
US5126948A (en) * 1989-11-08 1992-06-30 Ltv Aerospace And Defense Company Digital position encoder and data optimizer
DE4290927T1 (de) * 1991-04-01 1994-01-13 Fanuc Robotics North America Verfahren und System zur flexiblen Montage von Baugruppen
JPH0553634A (ja) * 1991-08-29 1993-03-05 Matsushita Electric Ind Co Ltd 複腕干渉回避システム
FR2687523B1 (fr) * 1992-02-18 1995-01-20 Telediffusion Fse Regie de diffusion de programmes audiovisuels.
US5475797A (en) * 1993-10-22 1995-12-12 Xerox Corporation Menu driven system for controlling automated assembly of palletized elements
SE512338C2 (sv) * 1998-06-25 2000-02-28 Neos Robotics Ab System och metod för reglering av en robot
US6612143B1 (en) 2001-04-13 2003-09-02 Orametrix, Inc. Robot and method for bending orthodontic archwires and other medical devices
DE10148519A1 (de) * 2001-10-01 2003-04-24 Siemens Ag Programmierverfahren zur Erstellung eines Steuerungsprogramms einer industriellen Maschine
DE10258633A1 (de) * 2002-12-16 2004-07-08 Kuka Roboter Gmbh Verfahren und Vorrichtung zum Positionieren von zusammenzufügenden Bauteilen
US20080172857A1 (en) * 2007-01-05 2008-07-24 Tennessee Rand Automation Systems and Methods for Manipulating a Frame in a Manufacturing Process
JP5507587B2 (ja) * 2012-01-11 2014-05-28 ファナック株式会社 補助指令の実行機能を有する数値制御装置
US9517895B2 (en) * 2013-10-30 2016-12-13 GM Global Technology Operations LLC Vehicle frame turnover system and method
US9804593B1 (en) * 2014-12-12 2017-10-31 X Development Llc Methods and systems for teaching positions to components of devices
JP6424236B2 (ja) * 2014-12-22 2018-11-14 株式会社Fuji 対基板作業管理装置
JP7288670B2 (ja) * 2017-03-10 2023-06-08 ユニヴァーシティ オブ ワシントン 医療用インプラントの安定性を測定および評価するための方法およびシステム
US11625023B2 (en) * 2017-09-29 2023-04-11 Donald Scott Rogers Device and method for automated assembly of interlocking segments
JP7118628B2 (ja) * 2017-12-01 2022-08-16 キヤノン株式会社 ロボット装置、およびロボット装置の制御方法
WO2019139815A1 (en) 2018-01-12 2019-07-18 Duke University Apparatus, method and article to facilitate motion planning of an autonomous vehicle in an environment having dynamic objects
TWI822729B (zh) 2018-02-06 2023-11-21 美商即時機器人股份有限公司 用於儲存一離散環境於一或多個處理器之一機器人之運動規劃及其改良操作之方法及設備
DE102018105041A1 (de) * 2018-03-06 2019-09-12 Dürr Systems Ag Schwenkeinheit für einen Handhabungsroboter und zugehöriges Verfahren
WO2019183141A1 (en) 2018-03-21 2019-09-26 Realtime Robotics, Inc. Motion planning of a robot for various environments and tasks and improved operation of same
CN108188736B (zh) * 2018-03-23 2023-08-15 浙江亿宝科技有限公司 一种换向器自动装配机
JP7417356B2 (ja) * 2019-01-25 2024-01-18 株式会社ソニー・インタラクティブエンタテインメント ロボット制御システム
US11958183B2 (en) 2019-09-19 2024-04-16 The Research Foundation For The State University Of New York Negotiation-based human-robot collaboration via augmented reality
CN112093471B (zh) * 2020-07-29 2022-03-04 强信机械科技(莱州)有限公司 一种切拼下摆机的机械手
CN113771045B (zh) * 2021-10-15 2022-04-01 广东工业大学 视觉引导的直角机器人手机中框高适应定位抓取方法

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE2012858A1 (de) * 1969-03-18 1970-09-24 Unimation Inc., Bethel, Conn. (V.St.A.) Programmgesteuerter Manipulator

Family Cites Families (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US2822094A (en) * 1953-09-29 1958-02-04 Greer Hydraulics Inc Bridge manipulator
BE582789A (de) * 1958-09-19
FR1371685A (fr) * 1963-10-15 1964-09-04 Lemer & Cie Manipulateur à distance commandé par vérins
US3701888A (en) * 1970-08-05 1972-10-31 Bendix Corp Time shared position feedback system for numerical control
US3624371A (en) * 1970-08-06 1971-11-30 Cincinnati Milacron Inc Apparatus for generating and recording a program and producing a finished part therefrom
JPS4921672Y1 (de) * 1970-08-21 1974-06-10
FR2183584B1 (de) * 1972-05-10 1974-09-27 Commissariat Energie Atomique
DE2226407C3 (de) * 1972-05-31 1978-10-12 Industrie-Werke Karlsruhe Augsburg Ag, 7500 Karlsruhe Gerät zur maschinellen, durch veränderbare Programme steuerbaren Handreichung
US3909600A (en) * 1972-06-26 1975-09-30 Cincinnati Milacron Inc Method and apparatus for controlling an automation along a predetermined path
JPS5425300B2 (de) * 1973-01-25 1979-08-27
JPS5214900B2 (de) * 1973-02-28 1977-04-25
JPS5024686A (de) * 1973-07-09 1975-03-15
US3920972A (en) * 1974-07-16 1975-11-18 Cincinnati Milacron Inc Method and apparatus for programming a computer operated robot arm
US4011437A (en) * 1975-09-12 1977-03-08 Cincinnati Milacron, Inc. Method and apparatus for compensating for unprogrammed changes in relative position between a machine and workpiece

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE2012858A1 (de) * 1969-03-18 1970-09-24 Unimation Inc., Bethel, Conn. (V.St.A.) Programmgesteuerter Manipulator

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3931964A1 (de) * 1989-09-25 1991-04-04 Rexroth Mannesmann Gmbh Robotersteuerung fuer den bewegungsablauf mindestens eines von einem stellglied angesteuerten arbeitsgeraetes

Also Published As

Publication number Publication date
SE8305519L (sv) 1983-10-07
SE8305517L (sv) 1983-10-07
FR2361207A1 (fr) 1978-03-10
FR2361207B1 (fr) 1985-08-23
DE2649123C2 (de) 1986-07-24
SE8305518L (sv) 1983-10-07
FR2357339B1 (de) 1984-10-19
SE8305520D0 (de) 1983-10-07
FR2357339A1 (fr) 1978-02-03
SE8305519D0 (sv) 1983-10-07
GB1561259A (en) 1980-02-13
IT1075776B (it) 1985-04-22
CA1084966A (en) 1980-09-02
JPS5284669A (en) 1977-07-14
GB1561258A (en) 1980-02-13
SE8305521L (sv) 1983-10-07
FR2361206B1 (de) 1984-07-20
DE2649123A1 (de) 1977-05-12
FR2361206A1 (fr) 1978-03-10
SE446071B (sv) 1986-08-11
GB1561260A (en) 1980-02-13
GB1561256A (en) 1980-02-13
US4163183A (en) 1979-07-31
SE7611920L (sv) 1977-04-29
SE8305520L (sv) 1983-10-07
SE8305521D0 (sv) 1983-10-07
FR2361205A1 (fr) 1978-03-10
SE8305517D0 (sv) 1983-10-07
SE8305518D0 (sv) 1983-10-07

Similar Documents

Publication Publication Date Title
DE2660912C2 (de) Programmsteuerung für einen Manipulator
DE2234759C3 (de) Programmsteuerung für einen in einer Fließbandfertigung anwendbaren ortsfesten Manipulator
DE3039094C2 (de) Manipulator
DE3317263C2 (de)
DE2712169C2 (de) Verfahren zur Ausführung einer komplexen Bewegung durch einen Industrieroboter
DE3034244A1 (de) Lernfaehiger roboter
DE3208435C2 (de) Steuerungsvorrichtung zum Führen eines Lichtbogenschweißautomaten
DE2904777C2 (de) Positioniereinrichtung für ein Gerät mit mehreren Motoren
DE2740507A1 (de) Verfahren zur programmierung eines programmsteuerbaren manipulators und dementsprechender manipulator
DE2709335A1 (de) Programmierbarer manipulator
EP0069046A1 (de) Elektronisches Regelgerät
DE2402829B2 (de) Numerisch arbeitende Programmsteuerung für einen Manipulator
DE3139431A1 (de) Programmierbarer automat
DE3806966A1 (de) Steuersystem
DE2012858C3 (de) Mit einer numerisch arbeitenden Programmsteuerung ausgerüsteter Manipulator
DE3322221A1 (de) Industrieroboter
DE1763565C3 (de) Numerisch arbeitende elektrische Programmsteuerungseinrichtung
EP0000735B1 (de) Einrichtung zur Steuerung eines motorisch verstellbaren zahnärztlichen Behandlungsstuhles
DE3635265A1 (de) Industrieroboter
DE3133246C2 (de) Elektrische Steuerungsvorrichtung für die anschlaglose Wegbegrenzung an Werkzeugmaschinen, insbesondere an Honmaschinen
DE1563727A1 (de) Steuersystem
DE3001778C2 (de) Verfahren und Einrichtung zur Wegregelung eines Positionsantriebes
DE3625914C2 (de)
DE3530678A1 (de) Verfahren und vorrichtung zur speicherprogrammierten steuerung bewegbarer vorrichtungen
DE3022173C2 (de)

Legal Events

Date Code Title Description
Q172 Divided out of (supplement):

Ref country code: DE

Ref document number: 2649123

8110 Request for examination paragraph 44
AC Divided out of

Ref country code: DE

Ref document number: 2649123

Format of ref document f/p: P

D2 Grant after examination
8364 No opposition during term of opposition
8339 Ceased/non-payment of the annual fee