US6992458B2 - Emergency stop circuit - Google Patents
Emergency stop circuit Download PDFInfo
- Publication number
- US6992458B2 US6992458B2 US10/999,948 US99994804A US6992458B2 US 6992458 B2 US6992458 B2 US 6992458B2 US 99994804 A US99994804 A US 99994804A US 6992458 B2 US6992458 B2 US 6992458B2
- Authority
- US
- United States
- Prior art keywords
- emergency stop
- cpu
- contact
- contacts
- command
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- H—ELECTRICITY
- H01—ELECTRIC ELEMENTS
- H01H—ELECTRIC SWITCHES; RELAYS; SELECTORS; EMERGENCY PROTECTIVE DEVICES
- H01H47/00—Circuit arrangements not adapted to a particular application of the relay and designed to obtain desired operating characteristics or to provide energising current
- H01H47/002—Monitoring or fail-safe circuits
- H01H47/004—Monitoring or fail-safe circuits using plural redundant serial connected relay operated contacts in controlled circuit
Definitions
- the present invention relates to emergency stop circuits, in various machines such as robots or machine tools, for stopping operations thereof in an emergency.
- a safety measure is taken by surrounding the robot operating range with a fence so as not to let a person come into the robot operating area within the fence.
- the fence is provided with a door or the like, and when the door is opened, an emergency stop signal is output so as to stop the operation of the robot.
- a teaching pendant is controlled to operate the robot, so the teaching pendant is provided with an emergency stop command button or the like, whereby the operation of the robot is stopped in an emergency by inputting an emergency stop signal through the button (see, for example, Japanese Patent Application Laid-open No. 10-217180).
- machine tools, injection molders or the like are also so configured that when a door of a processing unit or the like is opened, an emergency stop signal is output so as to stop the operation of the machine. That is, driving of the motor for driving an operable unit of the machine is stopped in an emergency to thereby stop the operation of the machine.
- FIG. 7 shows an example of an emergency stop circuit used for a robot system or the like.
- the emergency stop circuit of the robot system is configured to detect emergency stop factors through independent two systems of emergency stop lines, composed of components with contacts such as relays, respectively.
- the machine is so configured that through a safety relay circuit 13 connected with the emergency stop circuit, power supply contacts Ca and Cb are controlled so as to interrupt power supply to the servo motor 12 for driving the machine to thereby cause the machine to be in the emergency stop state.
- FIG. 7 shows two emergency stop factors 14 and 15 .
- the emergency stop factor 14 interrupts power supply to the relays R 1 a and R 1 b for the two systems of emergency stop lines A and B when the emergency stop button is manipulated.
- the emergency stop factor 15 opens a contact thereof by a relay, not shown, so as to stop power supply to the relays R 2 a and R 2 b .
- These relays or the like are provided as many as emergency stop factors.
- two emergency stop factors 14 and 15 are shown as examples.
- normally-open contacts of the relays for respective emergency stop factors are connected in series.
- a normally-open contact r 1 a of the relay R 1 a on the line A, a normally-open contact r 2 a of the relay R 2 a , a normally-open contact r 3 a of a relay R 3 a operable by a command from the CPU 10 , a normally-open contact k 1 a of a safety relay K 1 in the safety relay circuit 13 , and a safety relay K 2 are connected in series, and a voltage is applied to either end of the series circuit.
- a normally-open contact k 2 a of the safety relay K 2 is connected in parallel with the normally-open contact k 1 a of the safety relay K 1 .
- a normally-open contact r 1 b of the relay R 1 b a normally-open contact r 2 b of the relay R 2 b , a normally-open contact r 3 b of a relay R 3 b operable by a command from the CPU 10 , a normally-open contact k 1 b of a safety relay K 1 on the safety relay circuit 13 , and a safety relay K 3 are connected in series, and a voltage is applied to either end of the series circuit.
- a normally-open contact k 3 a of the safety relay K 3 is connected in parallel with the normally-open contact k 1 b of the safety relay K 1 .
- a normally-close contact k 1 c of the safety relay K 1 , a normally-open contact k 2 c of the safety relay K 2 , and a normally-open contact k 3 c of the safety relay K 3 are connected in series, and a voltage is applied to the series circuit.
- a normally-close contact k 1 d of the safety relay K 1 , a normally-open contact k 2 d of the safety relay K 2 , and a normally-open contact k 3 d of the safety relay K 3 are connected in series, and a voltage is applied to the series circuit.
- the servo amplifier 11 is connected with a three-phase power source via contacts Ca 1 and Cb 1 ; Ca 2 and Cb 2 ; and Ca 3 and Cb 3 , which are connected in series for respective phases.
- the contacts ca 1 , ca 2 and ca 3 are normally-open contacts, for respective phases, of the contactor Ca
- the contacts cb 1 , cb 2 and cb 3 are normally-open contacts, for respective phases, of the contactor Cb.
- the normally-close contacts ca 4 and cb 4 of the contactors Ca and Cb, the normally-close contacts k 2 b and k 3 b of the safety relays K 2 and K 3 , and the safety relay K 1 are connected in series, and a voltage is applied to either end of the series circuit.
- DI indicates a digital input element
- DO indicates a digital output element
- the digital input elements DI constitutes a detecting means for detecting the states of respective contacts of the relays R 1 a to R 3 a and R 1 b to R 3 b operable by the emergency stop factors 14 and 15 and commands from the CPU 10 .
- the safety relay K 1 operates to close the normally-open contacts k 1 a and k 1 b thereof, and to open the normally-close contacts k 1 c and k 1 d . If no emergency stop command is inputted from an emergency stop factor, the contacts r 1 a to r 3 a on the line A and the contacts r 1 b to r 3 b on the line B are closed so that the safety relays K 2 and K 3 are excited, and the safety relays K 2 and K 3 are self held via the contacts k 2 a and k 3 a .
- the normally-close contacts k 2 b and k 3 b are opened, so that the safety relay K 1 is non-excited. Thereby, the contact k 1 c to k 3 c are closed, and the contactor Ca is excited. Similarly, the contact k 1 d to k 3 d are closed, and the contactor Cb is excited. Consequently, the contacts of the contactors Ca and Cb are closed, so that the power is supplied to the servo amplifier 11 from the power source, whereby the servo motor 12 becomes operable.
- the safety relay K 2 and/or the safety relay K 3 is non-excited, whereby the contactors k 2 c , k 2 d , k 3 c and k 3 d are opened and the contactors Ca and Cb are non-excited, whereby the contacts ca 1 to ca 3 and cb 1 to cb 3 are opened to thereby interrupt power supply to the servo motor 12 . Consequently, operation of the servomotor 12 is stopped, and the machine is stopped in an emergency.
- the conventional emergency stop circuit uses a safety relay circuit composed of safety relays in which operations of the contacts are assured, whereby specially-designed, expensive components must be used. Further, the circuit is complicated and a number of general components must be used as well. This causes an adverse effect on the cost and reliability.
- An emergency stop circuit comprises: two emergency stop lines, each of which is connected with a contactor; and a power supply circuit for supplying power to a motor for driving a machine from a power source via series circuits composed of contacts of respective contactors.
- a contact which is opened when an emergency stop command signal is inputted from an emergency stop factor, and a contact which is opened by a command from a CPU provided to each emergency stop line are connected in series to thereby connect the contactor with the power source.
- the states of these contacts are detected by a detecting means.
- each CPU outputs a command to open a contact on the self emergency stop line when information about the states of the contacts on the self emergency stop line, detected by the detecting means, and information about the states of the contacts on the other emergency stop line, transmitted from the other CPU, do not coincide with each other.
- each CPU determines whether the states of the contacts on the self emergency stop line, detected by the detecting means, are normal to conduct the contactor, and if they are not normal, the CPU transmits an abnormality signal to the other CPU, and the CPU which receives the abnormality signal outputs a command to open a contact on the self emergency stop line.
- a CPU may also outputs a command to a contact on the self emergency stop line to open the contact.
- the first and second modes of the emergency stop circuit according to the present invention can take the following aspects.
- the CPUs transmit and receive a watchdog signal between them so as to check, with each other, whether an operation of the other CPU is normal, and when either CPU detects an abnormal operation of the other CPU through the check, the CPU outputs a command to open a contact on the self emergency stop line to thereby open the self emergency stop line.
- Each contactor is provided with a detecting contact operable with the contacts of the contactor so as to detect contact states thereof, and a contact state detecting means for detecting a contact state of the detecting contact, and detected information from the contact state detecting means is included in the states of the contacts of the emergency stop line.
- An additional CPU is provided besides the respective CPUs corresponding to the respective emergency stop lines, and contacts, which are opened by a command from the additional CPU, are provided on respective emergency stop lines.
- the respective CPUs corresponding to the respective emergency stop lines and the additional CPU transmit and receive watchdog signals between them so as to check whether operations of the CPUs are normal.
- the additional CPU detects an abnormal operation in either of the CPUs corresponding to the respective emergency stop lines, the additional CPU outputs at least a command to open a contact provided on the emergency stop line of the CPU in which the abnormal operation is detected.
- An additional CPU is provided besides the respective CPUs corresponding to the respective emergency stop lines.
- the respective CPUs corresponding to the respective emergency stop lines and the additional CPU transmit and receive watchdog signals between them so as to check whether operations of the CPUs are normal.
- the additional CPU detects an abnormal operation in either of the CPUs corresponding to the respective emergency stop lines, the additional CPU outputs at least an emergency stop command to a CPU in which the abnormal operation is not detected, and the CPU receiving the emergency stop command outputs a command to open a contact provided on the emergency stop line.
- the emergency stop circuit of the present invention does not require a safety relay circuit composed of expensive safety relays with contact operation assurance. Further, an emergency stop is performed by outputting emergency stop commands doubly by the hardware and the software, whereby the emergency stop can be performed more securely. Moreover, a CPU, on the emergency stop line in which an abnormality is detected, transmits an abnormality signal to the other CPU on the other emergency stop line so as to open the emergency stop line on the other CPU side, whereby the emergency stop can be performed more securely.
- FIG. 1 is a circuit diagram showing a first embodiment of an emergency stop circuit according to the present invention
- FIG. 2 is a flowchart showing emergency stop processing performed by a first CPU in the emergency stop circuit shown in FIG. 1 ;
- FIG. 3 shows a variation of the emergency stop processing shown in FIG. 2 ;
- FIG. 4 is a flowchart showing emergency stop processing, using a watchdog signal, performed by the first CPU in the emergency stop circuit shown in FIG. 1 ;
- FIG. 5 is a flowchart showing emergency stop processing, using a watchdog signal, performed by a second CPU in the emergency stop circuit shown in FIG. 1 ;
- FIG. 6 is a circuit diagram showing a second embodiment of an emergency stop circuit according to the present invention.
- FIG. 7 is a circuit diagram for a conventional emergency stop.
- FIG. 1 is a circuit diagram of a first embodiment of an emergency stop circuit according to the present invention, the circuit being applied to a driving motor in a robot, a machine tool or various industrial machinery.
- the present embodiment is characterized in that the safety relay circuit 13 is Omitted while another CPU is added so as to have two CPUs (a first CPU 10 a and a second CPU 10 b ).
- emergency stop factors are detected by independent two systems of circuits, as same as the emergency stop circuit of FIG. 7 .
- the circuit has relays, and contacts to stop power supply to the relays, for the two systems of the emergency stop lines A and B, respectively.
- the emergency stop factors and the number thereof are different depending on machines to apply.
- two emergency stop factors 14 and 15 are indicated.
- power supply to relays R 1 a , R 1 b , R 2 a and R 2 b is interrupted by a push button for one emergency stop factor 14 , or by relay contacts for the other emergency stop factor 15 , whereby an emergency stop command is transmitted.
- a contact r 1 a of the relay R 1 a for the emergency stop factor 14 a contact r 2 a of the relay R 2 a for the emergency stop factor 15 , a contact r 3 a of a relay R 3 a operable by a command from the first CPU 10 a , and a contactor Ca are connected in series, and a voltage is applied to either end of the series circuit.
- a contact r 1 b of the relay R 1 b for the emergency stop factor 14 a contact r 2 b of the relay R 2 b for the emergency stop factor 15 , a contact r 3 b of a relay R 3 b operable by a command from the second CPU 10 b , and a contactor Cb are connected in series, and a voltage is applied to either end of the series circuit.
- the line A includes digital input elements DI 1 a to DI 3 a constituting a detection means with which the first CPU 10 a detects the states of the contacts r 1 a to r 3 a .
- the line B includes digital input elements DI 1 b to DI 3 b constituting a detection means with which the second CPU 10 b detects the states of the contacts rib to r 3 b.
- Reference numerals DOa and DOb indicate digital output elements.
- the first CPU 10 a and the second CPU 10 b drive the relays R 3 a and R 3 b via the digital output elements Doa and Dob, respectively.
- a servo amplifier 11 for driving a servo motor 12 connects with a three-phase power source via contacts ca 1 , cb 1 ; ca 2 , cb 2 ; and ca 3 , cb 3 , connected in series for each phase.
- the contacts ca 1 , ca 2 and ca 3 are normally-open contacts for respective phases of the contactor Ca
- the contacts cb 1 , cb 2 and cb 3 are normally-open contacts for respective phases of the contactor Cb.
- One end of a normally-close contact ca 4 of the contactor Ca connects with a direct-current power source, and the other end thereof connects with a digital input element DIca, whereby the first CPU 10 a monitors the states of the contacts of the contactor Ca.
- a normally-close contact cb 4 of the contactor Cb connects with the direct-current power source, and the other end thereof connects with a digital input element DIcb, whereby the second CPU 10 b monitors the states of the contacts of the contactor Cb.
- the relays R 1 a , R 1 b , R 2 a and R 2 b for the emergency stop factors 14 and 15 are excited, and the normally-open contacts r 1 a , r 1 b , r 2 a and r 2 b thereof are closed. Further, since no emergency stop command is output from the first CPU 10 a or the second CPU 10 b , the relays R 3 a and R 3 b are excited, and the contacts r 3 a and r 3 b thereof are closed.
- the contactors Ca and Cb are excited so as to close the normally-open contacts ca 1 to ca 3 and cb 1 to cb 3 thereof, whereby the power is supplied to the servo amplifier 11 so that the servo motor 12 is in the operable state.
- the first CPU 10 a receives signals of “1, 1, 1, 0” from the digital input elements DI 1 a , DI 2 a , DI 3 a , and DIca.
- the second CPU 10 b receives signals of “1, 1, 1, 0” from the digital input elements DI 1 b , DI 2 b , DI 3 b , and DIcb.
- any emergency stop factor is operated, for example, if the emergency stop factor 15 is operated, the relays R 2 a and R 2 b thereof are operated and the respective contacts r 2 a and r 2 b thereof are opened, so that the power supply to the contactors Ca and Cb stops. Thereby, the contactors Ca and Cb stop their operations and open the normally-open contacts ca 1 to ca 3 and cb 1 to cb 3 so as to stop the power supply to the servo amplifier 11 .
- the contactors Ca and Cb stop their operations and open the normally-open contacts ca 1 to ca 3 and cb 1 to cb 3 so as to stop the power supply to the servo amplifier 11 .
- the contactors Ca and Cb stop their operations and open the normally-open contacts ca 1 to ca 3 and cb 1 to cb 3 so as to stop the power supply to the servo amplifier 11 .
- the contactors Ca and Cb stop their operations and open the normally-open contacts ca 1 to ca 3 and cb 1
- the relay R 2 b operates to cause the contactor Cb to be non-excited, so that the normally-open contacts cb 1 , cb 2 and cb 3 are opened. Thereby, the power supply to the servomotor is stopped securely.
- the contactor Cb is operationally failed, for example, the contactor Ca operates to interrupt the power supply to the servomotor 12 .
- the power supply to the servomotor 12 is stopped so as to perform an emergency stop securely by the dual-system hardware.
- two CPUs that is, the first CPU 10 a and the second CPU 10 b , execute an emergency stop by software, which provides a more secured emergency stop.
- the present embodiment uses two methods. One is a method in which emergency stop processing is performed when the operational states of respective contacts on respective emergency stop lines A and B, inputted from the digital input elements, do not coincide with each other. The other one is a method in which a watchdog signal is exchanged so as to check whether each CPU works normally, and if either CPU does not work normally, emergency stop processing is also performed by the other CPU.
- FIG. 2 is a flowchart showing processing in which the first CPU 10 a in FIG. 1 monitors the operational states of the contacts so as to detect unconformity in the operational states of the respective contacts on the emergency stop lines A and B to thereby perform emergency stop processing.
- the first CPU 10 a performs this processing in prescribed cycles.
- the first CPU 10 a reads signals from the digital input elements DI 1 a , DI 2 a , DI 3 a and DIca, constituting the detecting means for detecting the contact states, of the line A (Step a 1 ), and transmits information indicating the contact states to the second CPU- 10 b (Step a 2 ). Further, the first CPU 10 a receives information indicating the contact states of the line B, detected by the digital input elements DI 1 b , DI 2 b , DI 3 b and DIcb and transmitted from the second CPU 10 b (Step a 3 ), and determines whether the contact states of the line A and the contact states of the line B coincide with each other (Step a 4 ). If they coincide, the first-CPU 10 a ends the processing here.
- the first CPU 10 a outputs an emergency stop signal.
- the first CPU 10 a outputs an emergency stop signal of the line A of itself so as to cause the relay R 3 a to be non-excited via the digital output element DOa to thereby open the contact r 3 a thereof (Step a 5 ).
- the contact r 3 a is opened, the power supply to the contactor Ca is stopped, causing the contactor Ca to be non-excited.
- the normally-open contact ca 1 to ca 3 are opened and the power supply to the servo amplifier 11 is interrupted, so that the operation of the servomotor 12 is stopped.
- the second CPU 10 b also performs processing similar to that shown in FIG. 2 .
- the second CPU 10 b reads signals from the digital input elements DI 1 b , DI 2 b , DI 3 b and DIcb, and transmits them to the first CPU 10 a .
- the second CPU 10 b causes the relay R 3 b to be non-excited so as to open the contact r 3 b thereof to thereby stop the operation of the servo motor 12 .
- FIG. 3 is a flowchart showing a processing method, other than the one shown in FIG. 2 , for performing an emergency stop on the basis of operational states of respective contacts of the emergency stop lines A and B, inputted from the digital input elements.
- the operational states of respective contacts inputted from the digital input elements are determined to be normal or not, and if not, an emergency stop signal is transmitted to the other CPU so as to cause emergency stop processing to be performed by the other CPU as well.
- the first CPU 10 a reads signals from the digital input elements DI 1 a , DI 2 a , DI 3 a and DIca constituting the detecting means for detecting the contact states (Step a′ 1 ), and determines whether or not the output pattern of the digital input elements DI 1 a , DI 2 a , DI 3 a and DIca shows “1, 1, 1, 0” which indicates the normal state (Step a′ 2 ). If the output pattern shows the normal state, the first CPU 10 a transmits a normal state signal to the second CPU 10 b (Step a′ 3 ).
- the first CPU 10 a reads signals transmitted from the second CPU 10 b (Step a′ 4 ), and determines whether the signals read show the normal state (Step a′ 5 ), and if they show the normal state, ends the processing of this cycle. If, on the other hand, the first CPU 10 a determines that the output pattern of the normal state cannot be read in Step a′ 2 , the first CPU 10 a transmits an abnormality signal to the second CPU 10 b (Step a′ 7 ), and outputs an emergency stop signal so as to cause the relay R 3 a to be non-excited via the digital output element DOa to thereby open the contact r 3 a thereof (Step a′ 6 ).
- the first CPU 10 a receives an abnormality signal transmitted from the second CPU 10 b (Step a′ 5 ), the first CPU 10 a also outputs an emergency stop signal so as to cause the relay R 3 a to be non-excited to thereby open the contact r 3 a thereof.
- the contact r 3 a being opened, the power supply to the contactor Ca is stopped, so that the contact Ca is to be non-excited, and the normally-open contacts ca 1 to ca 3 thereof are opened to thereby interrupt the power supply to the servo amplifier 11 and stop the operation of the servo motor 12 .
- the first CPU 10 a outputs an emergency stop signal when a signal pattern of the contact states detected from the line A of itself is abnormal and also when a signal pattern of the contact states in the other line B, transmitted from the second CPU 10 b , is abnormal, so as to cause the contactor Ca to be non-excited to thereby stop the power supply to the servo amplifier 11 .
- the second CPU 10 b also performs processing similar to that shown in FIG. 3 .
- the second CPU 10 b performs processing similar to that of the CPU 10 a except that, in the processing of Steps a′ 1 and a′ 2 , the second CPU 10 b reads signals from the digital input elements DI 1 b , DI 2 b , DI 3 b and DIcb, and determines whether the output pattern of the digital input elements DI 1 b , DI 2 b , DI 3 b and the DIcb is “1, 1, 1, 0” which shows the normal state, and that, in Step a 6 , the second CPU 10 b outputs an emergency stop command to the digital output DOb to thereby cause the relay R 3 b to be non-excited.
- an emergency stop can be performed further securely. Note that even in this case, an emergency stop command may be output only when an abnormality signal is transmitted from the other CPU (Steps a′ 4 , a′ 5 and a′ 6 ).
- the servo motor cannot be stopped if the emergency stop means consists solely of hardware such as relays.
- the relay contact r 1 a is opened when an emergency stop signal due to the emergency stop factor 14 is inputted and the power supply to the relays R 1 a and R 1 b is released, the contacts ca 1 to ca 3 are not opened due to the failure of the contactor Ca, and further the relay contact r 1 b is not opened, whereby the contactor Cb is in the excited state, so that the contacts cb 1 to cb 3 are remained to be closed.
- the relay r 1 a when the relay r 1 a is opened, a pattern detected by the detecting means of the digital input elements DI 1 a , DI 2 a , DI 3 a and DIca of the first CPU 10 a becomes “0, 0, 0, 0”, which is different from the pattern “1, 1, 1, 0” showing the normal state.
- the first CPU 10 a detects the abnormality and transmits an abnormality signal to the second CPU 10 b .
- the second CPU 10 b Upon receipt of the abnormality signal, the second CPU 10 b causes the relay R 3 b to be non-excited to thereby open the contact r 3 b thereof. Consequently, the contactor Cb working normally is caused to be non-excited so as to open the contacts cb 1 to cb 3 thereof to thereby stop the power supply to the servo motor 12 and perform an emergency stop.
- a pattern detected by the detecting means of the digital input elements DI 1 b , DI 2 b DI 3 b and DIcb on the side of the second CPU 10 b is “1, 1, 1, 0” showing the normal state, so the contact states do not coincide with each other.
- an emergency stop signal is outputted from each of the first CPU 10 a and the second CPU 10 b so as to cause the relays R 3 a and R 3 b to be non-excited to thereby open the contacts r 3 a and r 3 b and stop conducting to the contactors Ca and Cb. This enables to cause the contactor Cb working normally to be non-excited.
- FIGS. 4 and 5 show an example, among others, of emergency stop processing based on a watchdog signal.
- FIG. 4 shows processing performed by one CPU (the first CPU 10 a ) to cause an emergency stop by a watchdog signal
- FIG. 5 shows processing performed by the other CPU (the second CPU 10 b ). These two CPUs perform the processing in synchronization.
- the first CPU 10 a performs processing shown in FIG. 4 every prescribed cycles, and determines whether the first CPU 10 a itself operates normally (Step b 1 ). If it operates normally, the first CPU 10 a outputs a watchdog signal WDS to the second CPU 10 b , and resets a timer T and starts it (Steps b 2 , b 3 ). If the watchdog signal WDS is sent back from the second CPU 10 b before the timer T completes timing (Steps b 4 , b 5 ), the first CPU 10 a ends the processing as no abnormality is found.
- the first CPU 10 a determines that the operation of itself is abnormal in Step b 1 , or if the timer T completes timing before the first CPU 10 a receives the watchdog signal WDS, the first CPU 10 a outputs an emergency stop command to the digital output DOa (Step b 6 ) so as to cause the relay R 3 a to be non-excited to thereby open the contact r 3 a thereof, and to cause the contactor Ca to be non-excited to thereby open the contactors ca 1 to ca 3 thereof, and to interrupt the power supply to the servo motor 12 and perform an emergency stop.
- the second CPU 10 b performs the processing shown in FIG. 5 in synchronization with the performing cycles of the processing in FIG. 4 performed by the first CPU 10 a .
- the second CPU 10 b determines whether the second CPU 10 b itself operates normally (Step c 1 ), and if it operates normally, the second CPU 10 b resets a timer T and starts it (Step c 2 , c 3 ). If the second CPU 10 b receives a watchdog signal WDS from the first CPU 10 a before the timer T completes timing (Step c 4 ), it sends the watchdog signal WDS back to the first CPU 10 a (Step c 5 ), and ends the processing of this processing cycle.
- the second CPU 10 b determines that the operation of itself is abnormal in Step c 1 , or the timer T completes the timing before the second CPU 10 b receives the watchdog signal WDS, the second CPU 10 b outputs an emergency stop command to the digital output DOb (Step c 6 ) so as to cause the relay R 3 b to be non-excited to thereby open the contact r 3 b thereof, and to cause the contactor Cb to be non-excited to thereby open the contacts cb 1 -cb 3 thereof, and to interrupt power supply to the servo motor and perform an emergency stop.
- the contactor of the line on the side of the CPU is caused to be non-excited to thereby interrupt power supply to the servo amplifier 11 , while a watchdog signal WDS is not sent to the other CPU.
- the other CPU detects the fact that it does not receive the watchdog signal, and causes the contactor of itself to be non-excited to thereby interrupt power supply to the servo amplifier 11 . In this way, an emergency stop is performed securely.
- the relay R 3 a or R 3 b of the line on the side of the CPU is caused to be non-excited and the contactor is also caused to be non-excited to thereby interrupt power supply to the servo amplifier 11 .
- this CPU does not operate normally, it may be acceptable to perform only operation to cause the relay R 3 a or R 3 b of the line on the side of the other CPU to be non-excited and to cause the contactor to be non-excited.
- the aforementioned first embodiment is provided with two systems for performing an emergency stop, whereby even when the hardware such as a relay in one system is abnormal, an emergency stop can be performed by the hardware such as a relay in the other system. Further, since the first embodiment uses commands from the CPUs, if an abnormality is detected in one system, an emergency stop command is outputted from the CPU of the system, while an emergency stop command is also outputted from the CPU of the other system, whereby an emergency stop can be performed further securely.
- FIG. 6 is an emergency stop circuit diagram according to a second embodiment of the present invention.
- the second embodiment is characterized in that a third CPU 10 c is added to the first embodiment shown in FIG. 1 .
- normally-open contacts r 4 a and r 4 b of relays R 4 a and R 4 b driven by the third CPU 10 c via digital output elements DO 2 a and DO 2 b are added to the lines A and B of the respective systems, and are connected in series with respective contacts of the relays for the emergency stop factors.
- the only difference from the first embodiment is that watchdog signals are transmitted and received between the first CPU 10 a and the third CPU 10 c , and between the second CPU 10 b and the third CPU 10 c to thereby detect abnormal operations in the first CPU 10 a and the second CPU 10 b .
- the relay R 4 a or R 4 b is caused to be non-excited so as to open the normally-open contact r 4 a or r 4 b to thereby perform an emergency stop.
- the third CPU 10 c sends watchdog signals WDS to the first CPU 10 a and to the second CPU 10 b , and if the first or the second CPUs 10 a or 10 b does not sent the watchdog signal WDS back to itself (the third CPU 10 c ), the third CPU 10 c causes the relay R 4 a or R 4 b to be non-excited so as to open the normally-open contacts r 4 a or r 4 b to thereby perform an emergency stop.
- the third CPU 10 c performs processing similar to that of Steps b 2 to b 6 in FIG. 4 every prescribed cycles.
- the third CPU 10 b sends watchdog signals WDS to the first CPU 10 a and to the second CPU 10 b , and if the watchdog signals WDS are sent back to the third CPU 10 c from the first CPU 10 a and from the second CPU 10 b , respectively, before the timer T completes timing, the third CPU 10 b ends the processing of the present cycle.
- the third CPU 10 c outputs an emergency stop command to the digital output elements DO 2 a and DO 2 b so as to cause the relays R 4 a and R 4 b to be non-excited to thereby open the normally-open contacts r 4 a and r 4 b and to perform an emergency stop.
- first CPU 10 a and the second CPU 10 b On the sides of the first CPU 10 a and the second CPU 10 b , they perform processing similar to the processing shown in FIG. 5 except Steps c 2 and c 3 . If the first CPU 10 a and the second CPU 10 b operate normally and they receive watchdog signals from the third CPU 10 c within the prescribed time period, they send the watchdog signals WDS back to the third CPU 10 c . On the other hand, if the first CPU 10 a and the second CPU 10 b do not operate normally, so that they do not send the watchdog signals WDS back to the third CPU 10 c within the prescribed time period, the third CPU 10 c outputs an emergency stop command to the relays R 4 a and R 4 b to thereby perform an emergency stop.
- the digital output elements DO 2 a and DO 2 b and the relays R 4 a and R 4 b are provided, it may be acceptable that these digital output elements and the relays are not to be provided, and the third CPU 10 c transmits an emergency stop command to the first CPU 10 a and to the second CPU 10 b as shown by the dashed lines in FIG. 6 , and the first and second CPUs 10 a and 10 b , when received the emergency stop command, cause the contacts r 3 a and r 3 b of the relays R 3 a and R 3 b in their systems to be opened. Further, although, in FIG.
- a watchdog signal WDS is also transmitted and received between the first CPU 10 a and the second CPU 10 b , abnormal operations in the first CPU 10 a and the second CPU 10 b can be detected due to the transmission and reception of the watchdog signals WDS performed between the first CPU 10 a and the third CPU 10 c and between the second CPU 10 b and the third CPU 10 c . Therefore, a detection of abnormality through the transmission and reception of the watchdog signal WDS between the first CPU 10 a and the second CPU 10 b may not be performed. However, if this detection of abnormality is performed, the emergency stop operation becomes more accurate.
Abstract
Description
Claims (11)
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP404801/2003 | 2003-12-03 | ||
JP2003404801A JP3944156B2 (en) | 2003-12-03 | 2003-12-03 | Emergency stop circuit |
Publications (2)
Publication Number | Publication Date |
---|---|
US20050122078A1 US20050122078A1 (en) | 2005-06-09 |
US6992458B2 true US6992458B2 (en) | 2006-01-31 |
Family
ID=34463981
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US10/999,948 Active US6992458B2 (en) | 2003-12-03 | 2004-12-01 | Emergency stop circuit |
Country Status (4)
Country | Link |
---|---|
US (1) | US6992458B2 (en) |
EP (1) | EP1538651A3 (en) |
JP (1) | JP3944156B2 (en) |
CN (1) | CN100366402C (en) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050010332A1 (en) * | 2003-07-08 | 2005-01-13 | Omron Corporation | Safety controller and system using same |
US20060006824A1 (en) * | 2004-01-28 | 2006-01-12 | Stridsberg Innovation Ab | Actuator and movement linkage system |
US20080091280A1 (en) * | 2006-09-15 | 2008-04-17 | Production Resource Group, L.L.C. | Stage Command Autostop |
US20080150467A1 (en) * | 2006-12-21 | 2008-06-26 | Fanuc Ltd | Robot system able to secure worker safety |
US20090187277A1 (en) * | 2006-05-16 | 2009-07-23 | Abb Ab | control system for an industrial robot |
WO2011005835A1 (en) * | 2009-07-08 | 2011-01-13 | Brown Thomas J | Anti-theft, emergency system |
Families Citing this family (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4930969B2 (en) * | 2005-11-18 | 2012-05-16 | 株式会社不二越 | Robot controller |
JP4233571B2 (en) | 2006-01-04 | 2009-03-04 | ファナック株式会社 | Robot controller |
US7342376B2 (en) * | 2006-02-24 | 2008-03-11 | Emhart Glass Sa | Glass machinery motor control |
JP5271499B2 (en) * | 2007-03-01 | 2013-08-21 | 株式会社安川電機 | Robot system |
EP2228895B1 (en) * | 2009-03-09 | 2012-12-26 | SMA Solar Technology AG | Inverter with utility grid interface |
JP5435621B2 (en) * | 2009-03-31 | 2014-03-05 | 独立行政法人産業技術総合研究所 | SAFETY CONTROL DEVICE, ROBOT, SYSTEM, PROGRAM, AND RECORDING MEDIUM |
JP5407882B2 (en) * | 2010-01-14 | 2014-02-05 | オムロン株式会社 | Control system |
EP2671690B1 (en) * | 2012-06-06 | 2019-02-20 | Keba Ag | Evaluation unit for a safety switch device and safety switch device |
JP5404863B2 (en) | 2012-07-23 | 2014-02-05 | ファナック株式会社 | Injection molding machine with motor power cutoff function |
CN104238452A (en) * | 2013-06-21 | 2014-12-24 | 鸿富锦精密工业(武汉)有限公司 | Machine tool control circuit |
US10185291B2 (en) * | 2013-06-28 | 2019-01-22 | Fisher Controls International Llc | System and method for shutting down a field device |
JP6474339B2 (en) * | 2015-09-01 | 2019-02-27 | ファナック株式会社 | A machine that stops the movement of members on the drive shaft due to brake abnormality |
JP6641922B2 (en) * | 2015-11-24 | 2020-02-05 | 株式会社デンソーウェーブ | Robot controller |
DE102016005026B3 (en) * | 2016-04-24 | 2017-05-18 | Sami Haddadin | System and method for controlling a robot |
US10348207B2 (en) * | 2016-11-15 | 2019-07-09 | Lg Chem, Ltd. | Control system for transitioning a DC-DC voltage converter from a boost operational mode to a safe operational mode |
CN106683945B (en) * | 2017-01-04 | 2019-05-24 | 东软医疗系统股份有限公司 | Emergency stop control system and its control method |
US10782665B2 (en) * | 2017-06-30 | 2020-09-22 | Cattron North America, Inc. | Wireless emergency stop systems, and corresponding methods of operating a wireless emergency stop system for a machine safety interface |
CN109016427A (en) * | 2018-09-03 | 2018-12-18 | 珠海格力电器股份有限公司 | A kind of circuit and method of injection molding mechanical arm safeguard protection |
CN109079793A (en) * | 2018-09-12 | 2018-12-25 | 珠海格力电器股份有限公司 | Industrial robot safety guard and its working method, industrial robot and its working method |
CN109616378B (en) * | 2018-12-06 | 2020-05-05 | 珠海格力电器股份有限公司 | Emergency stop control device, robot and emergency stop control method of robot |
CN110142642B (en) * | 2019-06-13 | 2024-02-27 | 安徽卓朴智能装备股份有限公司 | Electrical control system for numerical control milling machine safety protection |
FR3103914A1 (en) | 2019-11-28 | 2021-06-04 | Schneider Electric Industries Sas | Secure control device, contactor comprising such a device and method of secure processing of a control signal |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4817750A (en) * | 1986-05-09 | 1989-04-04 | 501 Daifuku Co., Ltd. | Running control system for conveyor cart |
US5587640A (en) * | 1994-09-28 | 1996-12-24 | Tetra Laval Holdings & Finance S.A. | Delayed safety braking apparatus for a servomotor control system |
JPH10217180A (en) | 1997-02-07 | 1998-08-18 | Matsushita Electric Ind Co Ltd | Safety device for robot |
US6051894A (en) * | 1996-08-28 | 2000-04-18 | Matsushita Electric Industrial Co., Ltd. | Safety device of industrial robot |
US6108179A (en) * | 1997-10-03 | 2000-08-22 | Mitsubishi Denki Kabushiki Kaisha | Emergency shut-down apparatus for motor |
US20010027352A1 (en) * | 2000-04-03 | 2001-10-04 | Kunitoshi Morita | Control apparatus for robot |
US6484076B2 (en) * | 2000-07-14 | 2002-11-19 | Samsung Electronics Co., Ltd. | Automated-guided vehicle and method for controlling emergency stop thereof |
US20040078116A1 (en) * | 2002-10-08 | 2004-04-22 | Fanuc Ltd. | Robot controller |
US20040215354A1 (en) * | 2001-06-22 | 2004-10-28 | Toshiyuki Nakamura | Safety network system, safety slave, and safety controller |
US20050010332A1 (en) * | 2003-07-08 | 2005-01-13 | Omron Corporation | Safety controller and system using same |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH064353A (en) * | 1992-06-17 | 1994-01-14 | Sumitomo Electric Ind Ltd | Mutual monitor circuit for plural microcomputers |
JPH08206988A (en) * | 1995-02-06 | 1996-08-13 | Yaskawa Electric Corp | Emergency stop device of robot |
DE19756616A1 (en) * | 1997-12-19 | 1999-07-01 | Bosch Gmbh Robert | Monitoring device for garage door operators |
JP2001014015A (en) * | 1999-06-28 | 2001-01-19 | Amada Eng Center Co Ltd | Method and device for safety control over machine tool |
DE10038953A1 (en) * | 2000-08-09 | 2002-02-28 | Siemens Ag | Method for operating a safety switching device and safety switching device |
-
2003
- 2003-12-03 JP JP2003404801A patent/JP3944156B2/en not_active Expired - Fee Related
-
2004
- 2004-11-30 EP EP04257442A patent/EP1538651A3/en not_active Withdrawn
- 2004-12-01 US US10/999,948 patent/US6992458B2/en active Active
- 2004-12-03 CN CNB2004100966634A patent/CN100366402C/en not_active Expired - Fee Related
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4817750A (en) * | 1986-05-09 | 1989-04-04 | 501 Daifuku Co., Ltd. | Running control system for conveyor cart |
US5587640A (en) * | 1994-09-28 | 1996-12-24 | Tetra Laval Holdings & Finance S.A. | Delayed safety braking apparatus for a servomotor control system |
US6051894A (en) * | 1996-08-28 | 2000-04-18 | Matsushita Electric Industrial Co., Ltd. | Safety device of industrial robot |
JPH10217180A (en) | 1997-02-07 | 1998-08-18 | Matsushita Electric Ind Co Ltd | Safety device for robot |
US5903123A (en) * | 1997-02-07 | 1999-05-11 | Matsushita Electric Industrial Co., Ltd. | Emergency stop circuit for a robot |
US6108179A (en) * | 1997-10-03 | 2000-08-22 | Mitsubishi Denki Kabushiki Kaisha | Emergency shut-down apparatus for motor |
US20010027352A1 (en) * | 2000-04-03 | 2001-10-04 | Kunitoshi Morita | Control apparatus for robot |
US6570355B2 (en) * | 2000-04-03 | 2003-05-27 | Matsushita Electric Industrial Co., Ltd. | Control apparatus for robot |
US6484076B2 (en) * | 2000-07-14 | 2002-11-19 | Samsung Electronics Co., Ltd. | Automated-guided vehicle and method for controlling emergency stop thereof |
US20040215354A1 (en) * | 2001-06-22 | 2004-10-28 | Toshiyuki Nakamura | Safety network system, safety slave, and safety controller |
US20040078116A1 (en) * | 2002-10-08 | 2004-04-22 | Fanuc Ltd. | Robot controller |
US20050010332A1 (en) * | 2003-07-08 | 2005-01-13 | Omron Corporation | Safety controller and system using same |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050010332A1 (en) * | 2003-07-08 | 2005-01-13 | Omron Corporation | Safety controller and system using same |
US7610119B2 (en) * | 2003-07-08 | 2009-10-27 | Omron Corporation | Safety controller and system using same |
US20060006824A1 (en) * | 2004-01-28 | 2006-01-12 | Stridsberg Innovation Ab | Actuator and movement linkage system |
US7098619B2 (en) * | 2004-01-28 | 2006-08-29 | Stridsberg Innovation Ab | Actuator and movement linkage system |
US20090187277A1 (en) * | 2006-05-16 | 2009-07-23 | Abb Ab | control system for an industrial robot |
US8099193B2 (en) * | 2006-05-16 | 2012-01-17 | Abb Ab | Control system for an industrial robot |
US20080091280A1 (en) * | 2006-09-15 | 2008-04-17 | Production Resource Group, L.L.C. | Stage Command Autostop |
US8170693B2 (en) * | 2006-09-15 | 2012-05-01 | Production Resource Group, Llc | Stage command autostop |
US20080150467A1 (en) * | 2006-12-21 | 2008-06-26 | Fanuc Ltd | Robot system able to secure worker safety |
WO2011005835A1 (en) * | 2009-07-08 | 2011-01-13 | Brown Thomas J | Anti-theft, emergency system |
US20110006921A1 (en) * | 2009-07-08 | 2011-01-13 | Brown Thomas J | Anti-theft, emergency system |
US8497768B2 (en) * | 2009-07-08 | 2013-07-30 | Thomas J. Brown | Anti-theft, emergency system |
Also Published As
Publication number | Publication date |
---|---|
JP2005165755A (en) | 2005-06-23 |
CN100366402C (en) | 2008-02-06 |
EP1538651A3 (en) | 2007-11-28 |
JP3944156B2 (en) | 2007-07-11 |
EP1538651A2 (en) | 2005-06-08 |
CN1623744A (en) | 2005-06-08 |
US20050122078A1 (en) | 2005-06-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6992458B2 (en) | Emergency stop circuit | |
US7208899B2 (en) | Emergency-stop device | |
JP5319400B2 (en) | Relay error detection device | |
US6108179A (en) | Emergency shut-down apparatus for motor | |
US10006455B2 (en) | Drive control apparatus | |
US10298166B2 (en) | Motor control system, motor controller, and method for setting safety function | |
EP1403010B1 (en) | Robot system comprising an operator detection unit | |
JP2005522637A (en) | Device for fail-safe disconnection of electrical loads | |
US6826433B1 (en) | Failsafe data output system and automation system having the same | |
US6570355B2 (en) | Control apparatus for robot | |
WO2018155424A1 (en) | Motor control device | |
JPH02501960A (en) | Monitoring method and circuit device for operating elements controlled by computer | |
JP4395829B2 (en) | Automatic machine operation permission device | |
US20240036546A1 (en) | Wiring error detection device for motor | |
JP3857264B2 (en) | Electric motor drive system | |
JP4238706B2 (en) | Safety controller | |
JP6625964B2 (en) | Lift control device and lift control method | |
CN117222501A (en) | Enable switching device and load drive control device provided with same | |
KR0155722B1 (en) | Robot system of electric cut-off control | |
CN115244475A (en) | Control device and control method | |
JPH01276830A (en) | Erroneous switching relieving system for signal switching device | |
JPH06270812A (en) | Controller for monorail turnout | |
JPH10133722A (en) | Output circuit of control unit | |
JPS617902A (en) | Load driving control device | |
JPH10254521A (en) | Motor speed monitor device for nc system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AS | Assignment |
Owner name: FANUC LTD, JAPAN Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNORS:HASHIMOTO, YOSHIKI;CHINO, NOBUO;TANABE, YOSHIKIYO;AND OTHERS;REEL/FRAME:016043/0785 Effective date: 20041025 |
|
AS | Assignment |
Owner name: FANUC LTD, JAPAN Free format text: RE-RECORD TO CORRECT THE DOCUMENT DATE OF SECOND ASSIGNOR, PREVIOUSLY RECORDED ON REEL 016043 FRAME 0785.;ASSIGNORS:HASHIMOTO, YOSHIKI;CHINO, NOBUO;TANABE, YOSHIKIYO;AND OTHERS;REEL/FRAME:016624/0696;SIGNING DATES FROM 20041022 TO 20041025 |
|
STCF | Information on status: patent grant |
Free format text: PATENTED CASE |
|
CC | Certificate of correction | ||
FEPP | Fee payment procedure |
Free format text: PAYOR NUMBER ASSIGNED (ORIGINAL EVENT CODE: ASPN); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY |
|
FEPP | Fee payment procedure |
Free format text: PAYER NUMBER DE-ASSIGNED (ORIGINAL EVENT CODE: RMPN); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY Free format text: PAYOR NUMBER ASSIGNED (ORIGINAL EVENT CODE: ASPN); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY |
|
FEPP | Fee payment procedure |
Free format text: PAYOR NUMBER ASSIGNED (ORIGINAL EVENT CODE: ASPN); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY Free format text: PAYER NUMBER DE-ASSIGNED (ORIGINAL EVENT CODE: RMPN); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY |
|
FPAY | Fee payment |
Year of fee payment: 4 |
|
FPAY | Fee payment |
Year of fee payment: 8 |
|
FPAY | Fee payment |
Year of fee payment: 12 |