INDUSTRIAL ROBOT HAVING A DEVICE FOR TEACHING A MOTOR-DRIVEN ARM WITH VARIABLE SERVO-CONTROL

Abstract: Disclosed is an industrial robot of the type wherein the robot arm is directly driven by a motor. A position encoder generates a signal representative of the actual position of the arm and a manually controlled position entry switch is operable during a teaching mode. A memory controller is responsive to operation of the position entry device when the arm is manually moved to a desired position to store the actual position signal into a memory as a target position signal and read the stored signal during a playback mode. A servo-control system responds to the actual position sig­ nal from the encoder and the target position signal from the memory by controlling the motor so that the actual position of the arm approaches the desired position during the play­ back mode. The output of the servo-control system is de­ creased during the teaching mode to render the arm manu­ ally movable to the desired position and is increased when the switch is released during the playback mode. Alter­ natively, the servo-control system is disabled during the teaching mode to enable the robot arm to be moved manu­ ally to the desired position and enabled during the playback mode.

Description: The invention relates to an industrial robot according to the features indicated in the preamble of claim 1. The invention starts out from a prior art as it is known from GB-A-1 418 710. This document discloses an industrial robot which comprises at least one movable robot arm for executing a working-movement, the path of which is stored in a memory in the form of a magnetic tape. In a playback mode, the arm is moved by means of a servo-controlled actuator means which is responsive to the path data stored in the memory. In order to record the data necessary for the actuator means, the operator can enter a teaching mode by actuating a start bottom, whereupon the servo-controlled actuator means is disabled or deenergized, thus permitting the operator to move the robot arm along an intended path which conforms to the robotic action to be performed later. During this movement, a position registration means is generating signals which are representative of the actual position of the arm and are converted to path data to be stored in the memory. A very experienced operator is needed to teach this known robot the movement necessary to conduct the work to be automatically repeated later on. This is because the operator is urged to execute the movement as perfectly as possible without any interruption so as to have an excellently reproduced working movement; because of this fact even a skilled operator has to repeat the learning process several times until reaching the accuracy needed. As a consequence, a disadvantage of this known robot lies in the fact that only few operators are able to teach a robot in an adequate period of time. Therefore it is the object of the present invention to improve an industrial robot according to the preamble of claim 1 in such a way that even an unexperienced operator can attain short teaching periods when instructing the robot a new movement path. According to the present invention this object is achieved by the advantageous measures indicated in claim 1. Hence, according to the present invention, the servo-controlled actuator means can be disabled by a manually operated switch which is located in a position accessible by the operator during the teaching mode to permit the robot arm to be manually moved along the intended path. When the arm reaches a desired position, the next actuation of this switch has the effect that the servo-controlled actuator means is enabled in such a way that the robot arm is stopped and firmly held in this position. As a further measure, the position registration means characterizes the arm position at the moment of disabling the servo-controlled actuator means with a first signifying code and the position at the moment of enabling and stopping the same with a second signifying code. By the advantageous measures indicated above, the operator can perform the teaching operation by guiding the robot arm only very short distances at a time, one of the guiding hands of the operator simultaneously actuating the easily accessible switch. The control means of the robot can then add all these short distances, each of which is only part of the total working path, in order to "integrate" the desired working path by means of the above mentioned signifying codes recorded at each stop position. As a consequence, even an unexperienced operator is able to teach the robot to work along the needed path, which is additionally followed with high precision. FR-A-2 217 741 and US-A-4 442 387 disclose industrial robots of the type which use hydraulic servo motors to move the robot arm. In order to make the movement of the robot arm during a teaching operation easier for an operator, these two documents propose to provide a separate low power driving source for the teaching period, so that the operator need not act against the hydraulic resistance at that time. From GB-A-2 086 612 and from EP-A-35 282 it is known to provide sensor means to develop position signals during the teaching and playback modes. In the robot known from EP-A-35 282 a so called edit means is additionally provided by which it is possible to make small corrections during the playback mode. The invention is advantageously developed by the measures mentioned in the subclaims. The present invention will be described in detail with reference to certain advantageous embodiments illustrated in the accompanying figures, in which: Fig. 1 is a perspective view of an industrial robot according to the present invention; Fig. 2 is a block diagram of a control unit of the industrial robot; Fig. 3 is a perspective view of the teaching device of Fig. 1; Figs. 4-10 are more detailed block diagrams of the control unit of Fig. 2; Fig. 11 is an illustration of various teaching modes in relation to operation of various teaching commands; and Fig. 12 a perspective view of a modified teaching device of the invention. Referring to Figs. 1 to 3, an industrial robot according to a first preferred embodiment of the invention comprises an upper motor 2a mounted on an arm portion of a stand A and a lower motor 2b on the base of the stand. Motor 2a has a rotary cylinder 2c connected to it for rotation therewith and motor 2b has a rotary cylinder 2d connected thereto for rotation therewith in coaxial relationship with the upper cylinder. An arm 1a extends horizontally from the upper cylinder 2c and is articulated with an arm 1b by means of a roller bearing 1e, the arm 1b being jointed to an arm 1c with a roller bearing 1f. Arm 1c is in turn articulated by a bearing 1g with an arm 1d which extends from the lower cylinder 2d. It is seen that arms 1a, 1b, 1c and 1d form a pantograph. At the free end of arm 1b is mounted a robot hand 1h which is vertically movable by means of a linear motor 1i. A position encoder 3 is connected to the motor 2a to detect the angular position of arm 1b. On the arm 1b is mounted a teaching device 16 which is connected by a cable 17 to a control unit 6 for entry of instruction data thereinto. Teaching device 16 includes plural controls including servo-unlock switch 9, position registration key 10, output signal registration key 11, external mode select command entry device 12, external mode registration command key 13, and timer control knob 14. Teaching device 16 further includes a servo-output control switch 15 through which a voltage is supplied to control unit 6. Control unit 6 processes the input command data and stores its results into a memory 5 and controls motors 2a, 2b in accordance with the stored data. As will be described later, the voltage supplied to motors 2a, 2b is controlled at high or low voltage level depending on the operation of the servo-control switch 15. External devices 18 and 19 are connected to the control unit 6 to receive command signals therefrom. Device 18 is of an interactive type which supplies a signal to the control unit indicating its operating mode, whereas device 19 provides no mode signal. A playback controller 30 is coupled to the control unit 6 to cause it to operate the robot in a playback mode in which the arm 1 is moved along instructed paths in accordance with a stored program in a manner well known in the art. As shown in Fig. 3, the teaching device 16 is of a generally L-shaped construction with a hand-grip portion 23 on which the servo-unlock switch 9 is located for ease of manipulation. All the command controls except servo-unlock switch 9 are arranged on top of the device 16 within the reach of on operator's finger while holding the grip-portion 23. This permits the robot arms to be moved by a single hand while holding the teaching device with the other hand, giving a freedom to teaching operation. Teaching device 16 is detachably mounted by a pair of couplers 20 to the arm 1. Cable 17 is detachably connected by a connector 21 on the arm 1 to the control unit 6. Connector 21 serves the function of on-off switch 15. Indicator lamps 22 are provided for indicating the operating conditions of mode select knobs 12a and 12b. Teaching device 16 is dismantled from the robot during playback in accordance with registered information to reduce the load on the robot arms and prevents unauthorized personnel from entering false information into the teachig device. Figs. 4 to 10 are illustrations of the internal structure of the control unit 6. In Fig. 4, control unit 6 includes a servo control circuit 6a which receives inputs from memory 5 and position encoder 3 and controls the motors 2a and 2b in accordance with the difference between the actual position of arm 1b and a target position represented by the data read out of memory 5 through a closed servo-control loop. The servo-control loop is disabled in response to an output from the servo-unlock switch 9 to deactivate the motors 2a and 2b. This allows the operator to manipulate the robot arms with a minimum of effort. A position signal registration circuit 6b is enabled in response to a position entry command generated by the position signal registration key 10 to discriminate the output of the servo-unlock switch 9 and characterizes the position signal from encoder 3 depending on whether the servo-unlock switch 9 is operated or not in a manner as will be described in detail later. The characterized position signal is stored into memory 5. During the time the servo-control system is unlocked, various control data can be advantageously stored into memory 5 as follows. In Fig. 5, an output signal registration circuit 6d is responsive to the output signal registration key 11 to store control data necessary for the operation of external device 18. During a playback mode, the command data is retrieved from memory 5 into an external device controller 6e which in turn supplies a control signal on lead 18a to external device 18 for the execution of a specified function. External device 18 returns a response on lead 18b to the external device controller 6e, whereupon it proceeds to retrieve the control signal for the execution of the next function. In Fig. 6, the control unit 6 includes an external mode registration circuit 6f connected to the external mode registration key 13 and an external device controller 6g connected to the outputs of external mode select knobs 12a and 12b. When one of the external mode select knobs 12a and 12b is operated, external device controller 6g causes the external device 19 to change operating positions according to the selected external mode. External mode registration circuit 6f responds to the operation of external mode registration key 13 by transferring the same mode control data as supplied to the external device 19 to memory 5. In playback, the mode control data is retrieved from memory 5 into the external device controller 6g which controls the device 19 in accordance with the retrieved data. In Fig. 7, a timer registration circuit 6g measures the length of tame during which the timer control knob 14 is depressed and stores the measured time length signal into memory 5. This teaching operation is effected so that on playback there is a time delay between specified operations. In Fig. 8, a coincidence detector 6i is responsive to the position signal registration key 10 and to the output signal registration key 11 to determine whether these command controls are operated individually or simultaneously. If these commands are simultaneously operated, the coincidence detector 6i directs a position signal registration circuit 6j to characterize the output of position encoder 3 in a manner as described in connection with Fig. 4 and stores the characterized position signal into memory 5. Immediately after the registration of the characterized position signal, detector 6i directs an output signal registration circuit 6k to store an external device control data into a storage location of memory 5 which is adjacent to the location into which the characterized position signal has been registered. If the position signal registration key 10 is operated exclusively, detector 6i directs the position signal registration circuit 6j exclusively to store characterized position signal into memory 5, and if the output signal registration key 11 is operated exclusively, detector 6i exclusively directs the output signal registration circuit 6k to store the external device control data into memory 5. The embodiment of Fig. 8 is modified as shown in Fig. 9 in which a coincidence detector 6ℓ is responsive to the position signal registration key 10 and the mode signal registration key 13 to determine if these keys are operated individually or simultaneously. As in the embodiment of Fig. 8, simultaneous entry of commands from keys 10 and 13 causes the detector 6ℓ to sequentially direct the position signal registration circuit 6j to store its output into memory 5 and enables an external mode registration circuit 6m for registration of an external mode into memory 5. During the registration of the external mode, an external device controller 6n detects the indication given by one of the mode select knobs 12a and 12b which is operated and directs the external mode registration circuit 6m to store the information given by the selector 12 into memory 5. As in the previous embodiment, individual operation of keys 10 and 13 causes the detector 6ℓ to respectively direct the associated registration circuits. In Fig. 10, the control unit 6 includes a servo-voltage controller 6o which is connected to voltage source via on-off switch 15, or connector 21, to detect whether the teaching device 16 is connected to the control unit 6 by connector 21. If the connector 21 is connected, the voltage at the input of controller 6o is high and controller 6o directs the servo-control system 6a to operate the motors 2a, 2b at a low voltage. This allows the robot arms to be moved smoothly by the operator's hand. The robot can thus be taught with precision without the possibility of hazard to the operator. If the connector 21 is removed from the robot, the input of controller 6o is low and the latter directs the servo-control system 6a to switch the operating voltage of motors 2a, 2b to normal, high voltage level for playback operations. Detailed description of the operation of the teaching device will be given as follows with reference to Fig. 11 which illustrates the relations between combinations of commands and their associated operating modes. Teaching mode A is initiated by operation of servo-unlock switch 9 (see Fig. 4). Motors 2a, 2b are unlocked from the servo-control system and robot arms 1a-1d are manually moved until the robot hand 1h comes precisely to a desired point. With the robot arms being moved to the desired position, restoration of servo-unlock switch 9 will cause the teaching mode to switch to mode B during which the servo-control system 6a is again rendered active, so that motors 2a, 2b are energized with high voltage to keep the robot hand in the desired point. When the position signal entry key 10 is operated with the operation of servo-unlock switch 9, a teaching mode C is initiated in which the position signal registration circuit 6b reads the output of position encoder 3 and for purposes of storage into memory 5 it characterizes the position signal with a signifying code which indicates that the point given by the position signal is a point located on a path traced by the robot hand. If the servo-unlock switch 9 is turned off while the position registration key 10 is operated, a teaching mode D is effected. During the mode D, the position signal registration circuit 6b interprets the output of encoder 3 that the position it indicates is a point at which the robot hand is to be stopped and characterizes it with an appropriate signifying code for storage into memory 5. As a result of the characterization, the amount of positional information stored in memory 5 can be reduced advantageously for efficient use of memory 5. The reduction of such information also results in the reduction of time for processing the positional information during playback. A further advantage of the characterization is that it allows the positional information to be readily classified advantageously for editing purposes. Operation of output signal registration key 11 initiates a teaching mode E in which the output signal registration circuit 6d. Fig. 5, responds to the output of output signal registration key 11 by generating data for controlling external device 18 and storing it into memory 5. Such output signal registration key and their associated registration circuits may be provided as many as desired for operating a plurality of external devices. With the servo-control system 6a being unlocked, such registration key 11 can selectively be operated for instant registration of external device control data while manipulating the robot arms for registration of positional data using position registration key 10. Switching operation of external mode selector 12 initiates a teaching mode F in which the external device controller 6g, Fig. 6, selects one of operating positions of the external device 19 in accordance with the switched position of selector 12 and supplies it with a selected operating signal to cause it to change operating states. By doing so, it is possible for the operator to test to see if the operating position of the selected external device 19 is optimum for the robot arms. If the operating position of the external device 19 is not optimum for the robot arms, the selector 12 is switched to the next operating position to seek an optimum operating position. The operating signal is also applied to external mode registration circuit 6f for storing the selected position signal into memory 5 in response to operation of registration command key 13 when the optimum position is finally determined (mode G). In playback, the stored external mode signal is read from memory 5 into external device 19 through controller 6g. The external mode teaching operation can therefore be performed simultaneously with ease while the robot arms are manipulated in a manner described above. Operation of the timer control knob 14 initiates a teaching mode H in which the timer registration circuit 6h, Fig. 7, measures the length of time the timer control knob 14 is manually pressed down and registers a time-length code into memory 5. Teaching mode H is advantageously performed between successive command operations during teaching modes E, F and G, so that, in playback, external device 18 or 19 is taught to perform operations with delays between successive movements. Simultaneous operation of position signal registration key 10 and output signal registration key 11 initiates a teaching mode I in which the coincidence detector 6i, Fig. 8, sequentially controls the position signal registration circuit 6j and output signal registration circuit 6k to store the respective outputs into memory 5. In playback, the robot arms are moved to the position specified by the position signal registration 10, whereupon the output signal registration circuit 6k reads the stored output signal from memory 5 into external device 18 to cause it to perform the specified operation. Robot arms may or may not continue to move after reaching the specified position. In a preferred embodiment, an extra command switch may be provided on the teaching device 16 to simultaneously operate command keys 10 and 11. Teaching mode I can also be performed simultaneously with the manipulation of robot arms. Simultaneous operation of keys 10 and 13 initiates a teaching mode J in which the coincidence detector 6ℓ, Fig. 9, sequentailly directs the position signal registration circuit 6j and external mode registration circuit 6m to sequentially store the respective outputs into memory 5. Teaching mode J can also be performed simultaneously with the manipulation of the robot arms. In playback, the robot arms are moved in accordance with the stored position data to a specified position, whereupon the external device 19 is set in motion to perform the stored function. When the connector 21 is disconnected from the socket of arm 1b, a teaching mode K is initiated in which the servo-voltage controller 6o directs the servo-control system 6a to supply a high voltage to motors 2a, 2b. When the connector 21 is inserted to the socket for teaching the robot, the controller 6o directs the servo-control system 6a to supply a low voltage to the motors. This ensures easy movement of the robot arms and safety against possible erratic movements of the robot arms beyond calculated bounds which might occur during teaching modes. To enhance the safety measure, plural power cut-off switches may be provided in parallel with each other, so that the motors are operated with high voltage only when these switches are open at the same time. Fig. 12 is an illustration of a modified form of the teaching device 16 in which parts corresponding to those in Fig. 3 are marked with the same numerals as used in Fig. 3. In this modification, a horizontal extension plate 24 extends from a side wall of robot arm 1b. Teaching device 16 has a hand-grip portion 23 coupled by its joint 27 to plate 24 permit it to rotate about the vertical axis of the grip portions 23. A connector mount 28 is attached to a side wall of the extension plate 24 to temporarily hold the connector 21 when it is disconnected from the socket 21a. Rotary joint 27 advantageously allows the controls of teaching device 16 to orient toward the operator at all times while the orientation of the arm 1b is changed to teach the robot.

Claims: An industrial robot comprising at least one movable robot arm (1a-1d), a position encoder (3) for generating a position signal representative of the actual position of said arm, a memory (5), a position registration means (6b,10) effective during a teaching mode for storing data into said memory in accordance with said position signal, servo-controlled actuator means (2a,2b,6a) responsive to said data stored in said memory for operating said robot arm during a play back mode, and input means (9) for disabling said actuator means during said teaching mode so as to permit said robot arm to be manually moved along an intended path, characterized in that said disabling input means (9) is a switch located in a position accessible by an operator during said teaching mode, which, in its desactivated position disables the actuator means (2a,2b,6a) to permit said robot arm to perform the manual movement along said intended path in a first teaching mode (A), until said arm reaches a desired position where the switch (9) is reactivated so that said actuator means (2a,2b,6a) is enabled and stop and firmly hold the arm therein, and that if the position registration means (6b,10) are activated at the same instant at which said switch (9) is reactivated, said registration means characterizes said position signal from the encoder (3) with a first signifying code which indicates that the point given by the position signal is a point located on a path traced by the robot hand, whereas if the position registration means is activated when said switch (9) is desactivated, it characterizes said position signal with a second code which indicates that the point given by the encoder (3) is a point at which the robot hand is to be stopped during play back mode. An industrial robot according to claim 1, characterized in that said switch (3) is mounted adjacent said arm (1a-1d) . An industrial robot according to claim 2, characterized in that said switch (3) is mounted on a teaching device (16) which is detachably mounted on said arm (1a-1d) . An industrial robot according to any one of the preceding claims, characterized by means (6a, 15, 60) for reducing a power supply voltage applied to said servo-controlled actuator means to a level which is lower than a normal operating voltage supplied thereto during said playback mode. An industrial robot according to any one of the preceding claims, characterized by means (6m, 6n) for storing an external device control signal together with said characterized position signal into said memory (5) during said teaching mode and for operating said arm (1a-1d) and an external device (18, 19) during said playback mode in accordance with said stored characterized position signal and said stored external device control signal, respectively.

Inventors: HIRAHATA, AKIHO, INOUE, TOSHITUGU, MAKIZAWA, YOSHIAKI, MARUO, TOMOHIRO, NAKADA, AKIYOSHI
Applicants: MATSUSHITA ELECTRIC INDUSTRIAL CO., LTD.
Application year: 1986
Main classification: B25J18
IPC codes: B25J9, G05B19, B25J13