WO2004109414A1 - ティーチペンダントの制御方法および装置 - Google Patents

ティーチペンダントの制御方法および装置 Download PDF

Info

Publication number
WO2004109414A1
WO2004109414A1 PCT/JP2004/007347 JP2004007347W WO2004109414A1 WO 2004109414 A1 WO2004109414 A1 WO 2004109414A1 JP 2004007347 W JP2004007347 W JP 2004007347W WO 2004109414 A1 WO2004109414 A1 WO 2004109414A1
Authority
WO
WIPO (PCT)
Prior art keywords
state
relay
teach pendant
contact
operation position
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.)
Ceased
Application number
PCT/JP2004/007347
Other languages
English (en)
French (fr)
Inventor
Keijiro Yuasa
Takeshi Horibe
Michiharu Tanaka
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.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric Corp
Yaskawa Electric Manufacturing Co Ltd
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 Yaskawa Electric Corp, Yaskawa Electric Manufacturing Co Ltd filed Critical Yaskawa Electric Corp
Priority to US10/559,336 priority Critical patent/US7337014B2/en
Priority to DE112004000987.1T priority patent/DE112004000987B4/de
Publication of WO2004109414A1 publication Critical patent/WO2004109414A1/ja
Anticipated expiration legal-status Critical
Ceased 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/00Program-control systems
    • G05B19/02Program-control systems electric
    • G05B19/42Recording and playback systems, i.e. in which the program 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
    • G05B19/427Teaching successive positions by tracking the position of a joystick or handle to control the positioning servo of the tool head, leader-follower control
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/36Nc in input of data, input key till input tape
    • G05B2219/36162Pendant control box

Definitions

  • the present invention relates to a teach pendant control method used for an operation for teaching an operation to an apparatus such as an industrial robot or a machine tool.
  • the teach pendant allows the operation of the apparatus by a teach pendant. Or, it relates to improvement of the control method to be prohibited.
  • Such a teach pendant is usually held by one hand of a teaching operator and operated by input keys or the like with the other hand to perform a teaching operation.
  • the industrial robot or the NC machine tool to be taught (hereinafter collectively referred to as a device) sequentially performs the operation for each step in accordance with the teaching operation. For example, driving operation of a motor, turning operation of an arm, energization of a work head (for example, a welding gun), and the like are performed.
  • the device operates differently from what the teaching operator intends due to a teaching operation error or a defect such as a component of the device.
  • the teaching operation should be prohibited and the equipment should be stopped immediately.
  • the safety system of the device must be configured.
  • an enable switch is employed so as to surely prohibit the teaching operation and immediately stop the device in the case of an unintended operation of the teaching operator as described above.
  • the enable switch is arranged on both sides of the teach pendant to improve the efficiency of the dominant hand and teaching operation of the teaching operator, and has been proposed and adopted so that it can be operated with both hands.
  • Surprise or danger of imminent danger to a human causes the muscles to atrophy, so that, for example, the hand is tightened. For this reason, a three-position momentary type switch is adopted for the enable switch, and the state in which the teach pendant is not gripped is in the first operation position described later.
  • an enable contact signal (described later) of the 3-position switch is output to the apparatus.
  • the enable contact is opened in the first operation position in which the pressing stroke is smaller than the predetermined range and in the third operation position in which the pressing stroke is operated larger than the predetermined range.
  • the circuit In the second operation position that is operated within the range, the circuit is configured to be in a permissible state in which the circuit is closed and operation of the device is permitted.
  • the release is released and the enable contact is not closed in the second operation position until the first operation position is reached, and the prohibition state in which operation of the device is prohibited is maintained.
  • the teaching operator may hold the teach pendant with the left hand and perform the teaching operation with the right hand, or vice versa.
  • the teach pendant in the long-term teaching work, in consideration of the fatigue of fingers and arms, the teach pendant can be arbitrarily changed, so that the left and right fingers can touch each other.
  • Position switches are arranged, and two 3-position switches each allow operation of the device!
  • it is desirable that the configuration is such that when one of the three-position switches is in the third operation position, the operation of the apparatus is prohibited until both three-position switches are in the first operation position.
  • Patent Document 1 Japanese Patent Application Laid-Open No. 2002-355781
  • Patent Document 2 Japanese Patent Application Laid-Open No. 2002-83522
  • a teaching operator performs a teaching operation by holding the teach pendant with one hand and pressing an input key with the other hand.
  • the operation method at the time of this change is (1) opening both the three-position switches and operating the other three-position switch as the first operation position to the second operation position, or (2) both three-position switches.
  • the switch is used as the second operation position, and the other is opened to be used as the first operation position.
  • both of the above two operation methods are in a prohibited state in which the operation of the device is prohibited.
  • the prohibited state where the operation of this device is prohibited depending on the configuration and use of the device, the drive power is cut off and the driving energy is released to ensure reliable safety.
  • the prohibited state it is necessary to turn on the power supply for driving and to store the driving energy until the operation of the device is allowed and the operation of the device is allowed.
  • the prohibition state in which the operation of the device is prohibited is required to release and accumulate the driving energy, resulting in a time loss and a loss of energy.
  • both the three-position switches are set to the allowable state in which the operation of the apparatus is allowed in the state of the second operation position.
  • the state is not prohibited.However, when the teaching operator grips the teach pendant with one hand and grips the teach pendant with both hands due to surprises, such as unintended operation of the device during the teaching operation. There was a problem with safety because the operation was still allowed.
  • the present invention has been made in view of such problems, and a teach pendant used for teaching an operation or simulating an operation for an industrial robot, a machine tool, or the like. It is an object of the present invention to provide a control method of a teach pendant which can be continued without interruption by changing a teach pendant, and in which safety is considered.
  • the teach pendant control method has three operation positions of a first operation position, a second operation position, and a third operation position according to a depression stroke.
  • Two 3-position switches are provided, and the 3-position switch has the first operation position and detection means for detecting the third operation position, and allows operation of the device based on the operation position.
  • the method of controlling the teach pendant to be prohibited is characterized in that the operation of the device is prohibited when the three-position switch is located at the second operation position for more than a predetermined time. .
  • the time measurement is started when both of the three-position switches are located at the first operation position force in the second operation position. If at least one of the three position switches and one of the three force switches are located in the other operation positions while the time period is shorter than the predetermined time period, the measurement of the time period is stopped. And
  • the two 3-position switches provided on the teach pendant are first gripped by the right hand after the left hand and then opened by the left hand. Even in a series of operations described above, the holding operation can be performed smoothly without setting the operation to prohibit the operation of the device, so that the teaching operation can be performed continuously.
  • the control device for the teach pendant according to claim 3 is provided with a Two 3-position switches having three operation positions of a first operation position, a second operation position, and a third operation position according to a lower stroke are provided, and the three-position switch is provided with the first operation position and the third operation position.
  • the control device of the teach pendant which has a detection contact for detecting a position, and has a signal processing circuit for determining whether to allow or prohibit the operation of the device based on the operation position.
  • the signal processing circuit receives the detection contact signal of the three-position switch, and prohibits and establishes the operation of the device when the three-position switch is both located at the second operation position for more than a predetermined time. By setting both of the position switches to the first operation position, the establishment of the prohibition of the operation of the device is released. .
  • the control device for a teach pendant according to claim 4 is characterized in that the signal processing circuit is constituted by a circuit including a relay.
  • the control device for a teach pendant according to claim 5 is characterized in that the signal processing circuit is configured by a circuit including either a logical element or a logical operation element.
  • the signal processing circuit is provided in the teach pendant main body or in the device.
  • the signal processing circuit can be easily configured using a relay, a logic element, and a logic operation element, and a part or all of the circuits are arranged in the teach pendant main body rather than in the device. Therefore, the teach pendant held by the teaching operator can be reduced in size and weight.
  • the teaching operation is continuously performed without inhibiting the operation of the device when the hand holding the teach pendant is prohibited. And the teaching operator can When the teach pendant is grasped with both hands and surprised by unintended operation of the device, the operation of the device is prohibited and the teach pendant is prohibited. This has the effect of providing a highly safe teach pendant.
  • FIG. 1 is a circuit configuration diagram of a first embodiment for implementing the present invention.
  • FIG. 2 is a state transition diagram of a first embodiment implemented by the present invention.
  • FIG. 3 is a circuit configuration diagram of a second embodiment for implementing the present invention.
  • FIG. 4 is a signal processing table according to a second embodiment of the present invention.
  • 61- -4, 61-5, 62-4, 62-5 enable contact
  • FIG. 1 is a circuit configuration diagram of a first embodiment for implementing the present invention.
  • the switches that make up the circuit The electric components of the switch and the relay are divided and arranged in a teach pendant (not shown) or a teach pendant and a device (not shown).
  • Reference numeral 61 denotes a left-handed 3-position switch, which has three operation states: a first operation position, a second operation position, and a third operation position.
  • Enable contacts 61-4 and 61-5 are closed in the second operating position and open otherwise.
  • the operation detecting contacts 6 1-1 and 6-1-2 which are auxiliary contacts, are closed in the first operating position and open in other positions.
  • a third operation position detection contact 61-3 is provided as an auxiliary contact that is open in the third operation position and closed in other cases.
  • the right-hand three-position switch 62 has operation detection contacts 62-1, 62-2, a third operation position detection contact 62-3, and enable contacts 62-4, 62-5.
  • the third operating position detecting contact 61-3 of the left-hand three-position switch 61 and the third operating position detecting contact 62-3 of the right-hand three-position switch 62 are connected in series and connected to the relay 66.
  • the power supply is 24 V DC
  • the other of the relays 66 is connected to OV
  • the other of the third operation position detecting contacts 61-3 of the left-hand three-position switch 61 is connected to 24 V DC. (The description of connection to DC 24V, OV is omitted hereafter.)
  • This circuit line is a third operation position detection line that detects the third operation position by opening the third operation position detection contact of the three-position switch when at least one of the three position switches is in the third operation position.
  • the operation detection contact 61-1 of the left-hand three-position switch 61 and the operation detection contact 62-1 of the right-hand three-position switch 6-2 are connected in series, and the operation detection line 71 opens when at least one of the three-position switches is operated. And is connected to the normally open contact 68a of the relay 68.
  • the operation detection contact 61-2 of the left-hand three-position switch 61 and the operation detection contact 62-2 of the right-hand three-position switch 62 are connected in parallel.
  • the switch operation detection line 73 is connected in series with the normally open contact 63a3 of the relay 63, and is connected in parallel with the other of the normally open contact 68a of the aforementioned relay 68 connected to the operation detection line 71 (line 74). ),
  • the normally open contact 66a of relay 66 and the relay 63 Are connected in series.
  • resistor 64 and capacitor 65 are connected in series and connected to OV.
  • the resistor 67 and the normally closed contact 66b of the relay 66 are connected in series, and are connected in parallel to the capacitor 65.
  • the capacitor 65 is provided to delay turning off the relay 63 for a predetermined time (for example, 1 second) when the normally open contact 66a of the relay 66 is closed and the line 74 is disconnected from the power supply 24V. Te ru.
  • the resistor 64 limits the current when the capacitor 65 is charged, and protects the contact through which the stored current flows.
  • the normally closed contact 66b of the relay 66 closes when at least one of the three-position switches is in the third operating position, and rapidly discharges the electric charge stored in the capacitor 65. Protects normally closed contact 66b during discharge.
  • the normally closed contact 63b of the relay 63 is connected to the relay 68.
  • a resistor 69 and a capacitor 70 connected in series are connected to the relay 68 in parallel. This is provided to delay turning off the relay 68 for a predetermined time.
  • the enable contact 61-4 of the left-hand three-position switch 61 and the enable contact 62-4 of the right-hand three-position switch 62 are connected in parallel, and the normally open contact 63al of the relay 63 and the normally closed contact 68b of the relay 68 are connected. It is connected in series with 1 to form an enable contact output signal.
  • the other enable contacts 61-5 and 62-5 are connected in series with the normally-open contact 63a2 of the relay 63 and the normally-closed contact 68b2 of the relay 68 after being connected in parallel to form an enable contact output signal.
  • the enable contact output signal is divided into two systems.
  • FIG. 2 is a state transition diagram in the present embodiment. It shows the operating position of the 3-position switch and the permitted and prohibited states of operation of the device. The operation of the circuit of FIG. 1 will be described along the state transition of FIG.
  • the operation detection contacts 61-1 and 62-1 are closed, so that the relay 63 is energized and turned on and the capacitor 65 is charged. Is done.
  • the normally open contact 63a3 of the relay 63 is closed, and the operation detection contacts 61-2 and 62-2 of the three-position switch are also closed, so that a self-holding circuit for the relay 63 is formed.
  • the normally closed contact 63b is opened, so that the relay 68 is turned off.
  • the relay 68 is discharged from the capacitor 70 for a predetermined time, the relay 68 is turned off for a predetermined time even after the relay 63 is turned on, thereby failing to form the self-holding circuit of the relay 63. Is prevented.
  • the normally open contact 68a of the relay 68 connected to the operation detection line 71 opens, but as described above, both the switch operation detection line 73 and the relay 63 Since the self-holding is established by the circuit of the normally open contact 63a3, the ON state of the relay 63 is maintained.
  • the teaching operator holds the teach pendant with one hand (for example, the left hand), the three-position switch 61 for the left hand is pressed. As a result, the operation detection contacts 61-1 and 61-2 open. However, since the right-hand three-position switch 62 is not operated, the operation detection contact 62-2 is closed, and the relay 63 Self-retention is established and maintained. Then, the teaching operator holds the teach pendant, and the 3-position switch 61 for the left hand is in the second operation position, so the enable contacts 61-4 and 61-5 are closed and the enable contact output signal is output. The state is changed to the permissible state 1 that allows the operation of the device (state 2).
  • the normally open contacts 63al and 63a2 of the relay 63 and the normally closed contacts 68bl and 68b2 of the gyre 68 in the circuit of the enable contact output signal are open, and the 3-position 3 switches 61 and 62 enable contacts 61-4, 61-5, Even if 62-4 and 62-5 are closed due to welding or the like, the output of the enable contact output signal is cut off and the device enters Prohibition State 4 where operation of the device is prohibited (State 3). At this time, the electric charge stored in the capacitor 65 is discharged through the normally closed contact 66b of the closed relay 66.
  • the left-hand three-position switch 61 is released after setting both the three-position switches 61 and 62 to the second operation position.
  • the normally open contacts 63al and 63a2 of the relay 63 and the normally closed contacts 68bl and 68b2 of the relay 68 in the circuit of the enable contact output signal remain closed, so that the enable contacts 61-4 and 61- are closed.
  • the status of 5, 62-4, 62-5 is output as the enable contact output signal, and it becomes the permissible state 3 which allows the operation of the device (state 4).
  • the operation detecting contact 61-2 is closed, power is supplied to the relay 63 again, and the self-holding circuit for the relay 63 is maintained.
  • the relay 63 When the allowable state 3 is maintained, the relay 63 is turned off after a predetermined time due to the discharge of the capacitor 65, the normally closed contact 63b is closed, and the relay 68 connected thereto is turned on. It becomes.
  • the normally open contacts 63al and 63a2 of the relay 63 and the normally closed contacts 68bl and 68b2 of the gyre 68 are open, so the 3 position 3 switches 61 and 62 enable contacts 61-4, 61-5 , 62—4 and 62—5 are closed, the output of the enable contact output signal is cut off and the device enters the prohibition state 2 where the operation of the device is prohibited (state 6).
  • the right-hand three-position switch 62 is strongly held by the strong grip of the three-position switch 62 for the right hand, and the three-position switch for the right hand is used. Since the third operation position detecting contact 62-3 of the circuit 62 is opened, the power of the relay 66 connected thereto is cut off and turned off. When the normally open contact 66a is opened, the relay 63 is turned off, and the relay 68 connected to the normally closed contact 63b is turned on.
  • the normally open contacts 63al and 63a2 of the relay 63 and the normally closed contacts 68bl and 68b2 of the relay 68 in the circuit of the enable contact output signal are open, and the enable contacts 61-4 and 61-5 of the 3-position switch 61 are closed.
  • the output of the enable contact output signal is cut off and the device enters the prohibition state 8 where the operation of the device is prohibited (state 7).
  • the electric charge stored in the capacitor 65 is discharged through the normally closed contact 66b of the closed relay 66.
  • the enable connection The normally open contacts 63al and 63a2 of the relay 63 and the normally closed contacts 68bl and 68b2 of the relay 68 that are connected to the point output signal circuit are open and cannot output the enable contact output signal.
  • the position of the three position switches 61 and 62 must be the first. It must be released from the operating position.
  • the three-position switches 61 and 62 for the left hand and the right hand are released so as to be the first operation positions.
  • the path returns from the prohibited state 2 (state 6) to the prohibited state 1 (state 1) via the prohibited state 3 or the prohibited state 6.
  • the three-position switch is set to the second operation position with both hands, and then the robot is released even if one hand is released. It is possible to hold hands smoothly without disabling operation. At this time, if at least one of the three-position switches is set to the third operation position due to factors such as encountering a dangerous state, the operation is immediately disabled and the operation can be prohibited, so high safety! Operation is possible.
  • the output circuit of the enable contact output signal is closed, that is, the interruption is released. If the output of the point output signal is cut off, it is assured without being affected by the transition timing of each contact state by switching of each operation position of the 3-position switch and the transition timing of contact state by switching on / off of each relay. In addition, the output of the enable contact output signal can be cut off.
  • FIG. 3 is a circuit configuration diagram of a second embodiment for implementing the present invention. As in the first embodiment, this circuit is divided into a teach pendant (not shown) or a teach pendant and a V ⁇ device (not shown).
  • Reference numerals 61 and 62 denote 3-position switches, which are the same as in the first embodiment, and will not be described. In this embodiment, the operation detection contacts 61-2 and 62-2 are not used.
  • Reference numerals 81 and 84 denote voltage converters, which input 24 VDC through an auxiliary contact of a 3-position switch, convert them to 5 VDC signals, and output them.
  • OV is output when 24 V DC is input
  • 5 V is output when no input voltage is applied.
  • One of the operation detecting contacts 61-1, 62-1, and the third operation position detecting contacts 61-3, 62-3 of the 3-position switches 61, 62 are connected to a 24V DC power supply.
  • the other is branched in parallel and connected to voltage translators 81 and 84.
  • the signal output from the voltage converter 81 is connected to a signal processing circuit 82.
  • the signal processing circuit 82 performs signal processing and outputs the result to the relay 83.
  • a signal output from the voltage converter 84 is connected to a signal processing circuit 85.
  • the signal processing circuit 85 performs signal processing and outputs the result to the relay 86.
  • the other of the relays 83 and 86 is connected to OV!
  • the enable contact 61-4 of the 3-position switch 61 for the left hand and the enable contact 62-4 of the 3-position switch 62 for the right hand are connected in parallel, and connected in series with the normally open contact 83al of the relay 83 to enable the contact output. Signal.
  • the enable contact 61-5 of the three-position switch 61 for the left hand and the enable contact 62-5 of the three-position switch 62 for the right hand are connected in parallel, and are connected in series with the normally open contact 86a2 of the relay 86 to enable the contact output signal. Is formed.
  • FIG. 4 is a signal processing table of the signal processing circuits 82 and 85 in the present embodiment.
  • the contact state is an input signal of the signal processing circuits 82 and 85.
  • the contact state of the operation detection contacts 61—1, 62—1 and the third position detection contacts 61—3, 62-3 of the 3-position switches 61 and 62 is 0 for closed circuit, 1 for open circuit, and "Arbitrary".
  • the signal processing circuit internal state is an internal state of the signal processing circuits 82 and 85.
  • the value is 1 for the on-state, 0 for the off-state, and “arbitrary” for any on-off state.
  • the power-on state becomes 1 when the control power is supplied to the signal processing circuits 82 and 85.
  • the power-on state is 0 when the contact states 61-1, 61-3, 62-1, and 62-3 are all 0. At this time, the prohibition detection status, the timing status, and the time excess status also become 0 (state 12).
  • the prohibition detection state turns on when the contact state 61-3 becomes 1 (state 17), the contact state 62-3 becomes 1 (state 18), or when the time elapsed state described later becomes 1 (state 16). It becomes 1 in the state and becomes 0 in the off state when the contact states 61-1, 61-3, 62-1, and 62-3 all become 0.
  • the prohibition detection state is 1, the relay output is turned off.
  • the timing state is 1 when the contact states 61-1 and 62-1 are 1 and 61-3 and 62-3 are 0 (state 15), and otherwise 0. That is, the timekeeping state becomes 1 in the ON state when both of the two 3-position switches are operated to the second operation position.
  • timing status When the timing status becomes 1, timing starts for a predetermined time. If at least one of the two 3-position switches is in the first operating position during timekeeping, the timekeeping state becomes 0, stopping the timekeeping and clearing the timekeeping value (state 12, state 13, state 14).
  • the time-exceeded state is set to 1 and the inhibition detection state is set to 1 as described above (state 16).
  • the relay output is turned on when the contact status 61-1 and Z or 62-1 are 1 and the power on status, prohibition detection status, and time excess status are all 0 (status 14, status 14, status 15)
  • the clocking state is 1, so that the clocking proceeds, and when a predetermined time elapses, the overtime state becomes 1 and the inhibition detection state also becomes 1. At this time, the relay output turns off (state 16).
  • the contact state 61-3 or 62-3 becomes 1, and the inhibit state becomes 1. At this time, the relay output turns off (state 17 or state 18).
  • the signal processing in the signal processing circuits 82 and 85 has been described. It is easy to realize the signal processing circuits 82 and 85 by combining logic elements based on this description. Similar effects can be obtained by performing signal processing using a logical operation element such as a CPU.
  • the present invention is applied to a safety device when an operator approaches an automatic machine or the like that operates based on the power of a motor or the like, or an operation switch for instructing the operation of the automatic machine, thereby ensuring the safety of the worker. And the reliability of the device can be improved.

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

左右に2つのイネーブル装置(3ポジションスイッチ)を備えるティーチペンダントの操作における手の持ち替えにおいて、持ち替えのときに操作禁止となる問題があった。  ティーチペンダントを持ち替えにる際に両手で3ポジションスイッチを操作しても所定時間経過するまでは操作可能とすることで持ち替え操作を行うことができ連続したティーチペンダントの操作を可能にし、両手での操作時間が所定時間を超えると操作禁止とすることで安全性の確保を行った。

Description

明 細 書
ティーチペンダントの制御方法および装置
技術分野
[0001] 本発明は、産業用ロボットや工作機械などの装置に対して、動作の教示を行うため の操作に用いるティーチペンダントの制御方法であり、特に、ティーチペンダントによ り装置の操作を許容または禁止する制御方法の改良に関する。
背景技術
[0002] 従来力 工場の生産ラインにおいては、自動で溶接作業や部品の組み付け作業、 搬送作業などを行う産業用ロボットが多数使用されている。これらの産業用ロボットは 、専用のティーチペンダントにより予め所定の動作が教示され、その教示内容を再生 することにより、各種作業を実行している。前記ティーチペンダントは一般に教示装置 とも称されている。同様のティーチペンダントは、各種工作機械、 NC工作機械などの 加工手順を教示 (プログラム)する場合にも用いられる。
[0003] このようなティーチペンダントは、通常、教示作業者が片手で把持し、他方の手で入 力キーなどの操作を行い教示操作を行う。この場合、教示操作に伴い教示対象の産 業用ロボットや NC工作機械など(以下、総称して装置という)は、順次ステップ毎の 動作を行う。例えば、モータの駆動動作やアームの旋回動作、作業ヘッド (例えば、 溶接ガン)の通電などが行われる。この時、教示操作ミスや装置の部品などの不良に より装置が教示作業者の意図するものと異なる動作をしてしまう場合がある。このよう な場合、教示作業者を含む装置近傍の作業者への危険を回避すると共に、装置お よび周辺機器の破損を防止するために、教示操作の禁止や装置の停止が直ちに行 われるように装置の安全システムは構成しておく必要がある。
[0004] そのため、従来のティーチペンダントでは、前述のような教示作業者の意図しない 動作の際に、確実に教示操作の禁止や装置の停止が直ちに行われるようにイネーブ ルスイッチが採用されている。またイネ一ブルスィッチは教示作業者の利き手や教示 操作の効率改善のためティーチペンダントの両側に配置され、両方の手で操作がで きる様に提案され、採用されている。 [0005] 人間に危険が迫った際の驚きや感電では筋肉が萎縮するため、たとえば手は握り 締めるようになる。このためイネーブノレスィッチにモーメンタリタイプの 3ポジションスィ ツチが採用されており、ティーチペンダントを把持していない状態は後述する第 1操作 ポジションにある。装置の操作を許容する許容状態および装置の操作を禁止する禁 止状態とするために、 3ポジションスィッチの後述するィネーブル接点信号を装置に 出力している。ィネーブル接点は、押下ストロークが所定範囲より小さい第 1操作ポジ シヨンおよび押下ストロークが前記所定範囲より大きく操作される第 3操作ポジション では開路して装置の操作を禁止する禁止状態、押下ストロークが前記所定範囲以内 に操作される第 2操作ポジションでは閉路して装置の操作を許容する許容状態となる ように構成されている。また一旦第 3操作ポジションになると押下をゆるめて第 1操作 ポジションになるまでの第 2操作ポジションではそのイネ一ブル接点は閉路せず、装 置の操作を禁止する禁止状態を維持するようになって!/、る。
[0006] 教示作業者は、例えば左手でティーチペンダントを把持し、右手で教示作業を行う 場合もあれば、その逆もある。また、長時間に及ぶ教示作業においては、指や腕の 疲労を考慮して、ティーチペンダントを任意に持ち替えることができるように、左手指 が触れる部分と、右手指が触れる部分の 2ケ所に 3ポジションスィッチが配置されてお り、 2つの 3ポジションスィッチはそれぞれで装置の操作を許容するようになって!/、る。 また、片方の 3ポジションスィッチが第 3操作ポジションとなったら、両方の 3ポジショ ンスィッチが第 1操作ポジションになるまで装置の操作を禁止する禁止状態なるよう に構成することが望ましぐ特許文献 1ならびに特許文献 2で提案されている。
[0007] 特許文献 1:特開 2002-355781号公報
特許文献 2:特開 2002— 83522号公報
[0008] 特許文献 1で開示されている実施の形態では、片方の 3ポジションスィッチを握り、 第 2操作ポジションに保持すると、ィネーブル接点が閉路して装置の操作を許容する 許容状態とする。その後に他方の 3ポジションスィッチをも操作して第 2操作ポジショ ンとすると、ィネーブル接点を開路して装置の操作を禁止する禁止状態となる。すな わち、片方の 3ポジションスィッチを第 2操作ポジションとしている状態の時にのみ装 置の操作を許容する許容状態として ヽる。 特許文献 2で開示されて 、る実施の形態では、片方の 3ポジションスィッチを第 2操 作ポジションに保持するとイネ一ブル接点が閉路して装置の操作を許容する許容状 態となり、その後他方の 3ポジションスィッチを第 2操作ポジションとしても装置の操作 を許容する許容状態を維持する。
[0009] 通常、教示作業者が片手でティーチペンダントを把持し、他方の手で入力キーの 押下などの操作を行い教示操作を行う。一般に、長時間に及ぶ教示作業において は、指や腕の疲労のためにティーチペンダントを任意に持ち替える機会がある。この 持ち替え時の操作法は、 (1)ー且両方の 3ポジションスィッチを開放して第 1操作ポ ジシヨンとして他方の 3ポジションスィッチを第 2操作ポジションに操作する、あるいは( 2)両方の 3ポジションスィッチを第 2操作ポジションとして、他方を開放して第 1操作ポ ジシヨンとする、の 2つある。
発明の開示
発明が解決しょうとする課題
[0010] 特許文献 1で開示されている実施の形態では前述の 2つの操作法では共にー且装 置の操作を禁止する禁止状態になる。装置の構成や使途により、この装置の操作を 禁止する禁止状態において、確実な安全性確保のため駆動用の電源遮断と共に駆 動用エネルギーの開放を行う。一旦禁止状態となると次に装置の操作を許容する許 容状態となり装置が動作するまでには駆動用電源投入および駆動用のエネルギー 蓄積を行う必要がある。
この様に、ティーチペンダントの持ち替えにぉ 、てー且装置の操作を禁止する禁止 状態とすることは、駆動エネルギーの開放と蓄積が必要となり,時間損失とエネルギ 一の損失となる問題があった。
[0011] また、特許文献 2で開示されている実施の形態では、両方の 3ポジションスィッチを 第 2操作ポジションの状態で装置の操作を許容する許容状態としているので前述の ティーチペンダントの持ち替え操作法 (2)では禁止状態とはならな 、が、教示作業者 が片手でティーチペンダントを把持して教示操作中に装置の意図しない動作など〖こ 対する驚きで両手でティーチペンダントを把持した時には装置の操作を許容する許 容状態のままであるため安全性に問題があった。 [0012] そこで、本発明はこのような問題点に鑑みてなされたものであり、産業用ロボットや 工作機械などに対して、動作の教示を行ったり動作のシミュレーションを行う場合に 用いるティーチペンダントの制御方法において、ティーチペンダントの持ち替えで操 作を中断することなく継続でき、また安全性の配慮がされたティーチペンダントの制 御方法を提供することを目的とする。
課題を解決するための手段
[0013] 上記問題を解決するため、請求項 1に記載のティーチペンダントの制御方法は、押 下ストロークに応じて第 1操作ポジション、第 2操作ポジション、第 3操作ポジションの 3 つの操作ポジションを持つ 3ポジションスィッチを 2つ備え、前記 3ポジションスィッチ は前記第 1操作ポジションと、前記第 3操作ポジションであることを検出する検出手段 を有し、前記操作ポジションに基づ 、て装置の操作を許容または禁止するティーチ ペンダントの制御方法にぉ 、て、前記 3ポジションスィッチが共に前記第 2操作ポジ シヨンに所定の時間を超えて位置した場合に前記装置の操作を禁止とすることを特 徴とする。
[0014] また、請求項 2に記載のティーチペンダントの制御方法は、前記 3ポジションスイツ チが共に前記第 1操作ポジション力も前記第 2操作ポジションに位置した場合に時間 の計測を開始し、前記計測された時間が前記所定の時間より小さい間に、前記 3ポ ジションスィッチの少なくともどちら力 1方力 他の前記操作ポジションに位置した場 合には、前記時間の計測を停止することをことを特徴とする。
[0015] このようになっているため、ティーチペンダントを例えば左手より右手に持ち替える 場合に、ティーチペンダントに備わる 2つの 3ポジションスィッチを、まず左手での把 持状態より右手で把持の後左手の開放の一連の操作においても装置の操作を禁止 する禁止状態とすることなぐスムーズに持ち替え操作を行うことが出来るため教示操 作を連続して行うことが出来る。
また、教示操作者が装置の意図しない装置の動作などに驚き両手でティーチペン ダントを把持した時には所定時間の後に装置の操作を禁止する禁止状態とすること で安全性が向上する。
[0016] 上記問題を解決するため、請求項 3に記載のティーチペンダントの制御装置は、押 下ストロークに応じて第 1操作ポジション、第 2操作ポジション、第 3操作ポジションの 3 つの操作ポジションを持つ 3ポジションスィッチを 2つ備え、前記 3ポジションスィッチ は前記第 1操作ポジションと、前記第 3操作ポジションであることを検出する検出接点 を有し、前記操作ポジションに基づ 、て装置の操作を許容または禁止を判定する信 号処理回路を有するティーチペンダントの制御装置にお!/、て、前記信号処理回路は 、前記 3ポジションスィッチの検出接点信号を入力として、前記 3ポジションスィッチが 共に前記第 2操作ポジションに所定の時間を超えて位置した場合に前記装置の操作 を禁止確立し、前記 3ポジションスィッチを共に前記第 1操作ポジションとすることで前 記装置の操作の禁止確立を解除することを特徴とする。
[0017] この構成によれば、ティーチペンダントを把持する手の持ち替えの時でも装置の操 作を許容する許容状態となり、教示操作を連続して行うことが出来ると共に、 両方の 3ポジションスィッチがともに第 1操作ポジションに戻るまでの間は、教示可能 な許容状態になることを防止でき、ティーチペンダント操作の安全性を向上する。
[0018] 請求項 4に記載のティーチペンダントの制御装置は、前記信号処理回路は継電器 を含む回路で構成されることを特徴として 、る。
また、請求項 5に記載のティーチペンダントの制御装置は、前記信号処理回路は論 理素子あるいは論理演算素子のいずれかを含む回路で構成されることを特徴として いる。
および、前記信号処理回路は、前記ティーチペンダント本体内または前記装置に 配設されて 、ることを特徴として 、る。
[0019] このようになっているため、信号処理回路は継電器、論理素子および論理演算素 子を用いて容易に構成することができると共に、一部あるいは全部の回路をティーチ ペンダント本体内より装置内に配設することができるため、教示作業者が把持するテ ィーチペンダントを小型化、軽量ィ匕することができる。
発明の効果
[0020] 以上述べたように、本発明のティーチペンダントの制御方法によれば、ティーチぺ ンダントを把持する手の持ち替えにおいて装置の操作を禁止する禁止状態とするこ とが無ぐ教示操作を連続的に継続できることができると共に、教示操作者が装置の 意図しない装置の動作などに驚き両手でティーチペンダントを把持した時には装置 の操作を禁止する禁止状態とすることで、安全性の高!、ティーチペンダントを提供す るという効果がある。
図面の簡単な説明
[0021] [図 1]本発明を実施する第 1実施形態の回路構成図
[図 2]本発明の実施する第 1実施形態の状態遷移図
[図 3]本発明を実施する第 2実施形態の回路構成図
[図 4]本発明の実施する第 2実施形態の信号処理表
符号の説明
[0022] 61 左手用 3ポジションスィッチ
62 右手用 3ポジションスィッチ
61- -1, 61-2, 62-1, 62-2 操作検出接点
61- -3, 62-3 第 3ポジション検出接点
61- -4, 61-5, 62-4, 62-5 イネ一ブル接点
63、 66、 68 ジレー
64、 67、 69 抵抗器
65、 70 コンデンサ
71 操作検出ライン
72 第 3操作ポジション検出ライン
73 両スィッチ操作検出ライン
81、 84 電圧変
82、 85 信号処理回路
83、 86 ジレー
発明を実施するための最良の形態
[0023] 以下、本発明の具体的実施例を図に基づいて説明する。
実施例 1
[0024] 図 1は、本発明を実施する第 1実施形態の回路構成図である。回路を構成するスィ ツチ、リレーの電気品は、図示しないティーチペンダント、あるいはティーチペンダント と図示しない装置に分割されて配設されている。
61は左手用 3ポジションスィッチであり、第 1操作ポジション、第 2操作ポジション、第 3操作ポジションの 3つの操作状態がある。ィネーブル接点 61-4および 61— 5は、第 2操作ポジションでは閉路、これ以外では開路する。補助接点である操作検出接点 6 1—1および 61— 2は、第 1操作ポジションでは閉路、これ以外では開路する。また、第 3操作ポジションでは開路、それ以外では閉路する補助接点である第 3操作ポジショ ン検出接点 61— 3が備わっている。同様に右手用 3ポジションスィッチ 62には、操作 検出接点 62— 1、 62-2、第 3操作ポジション検出接点 62— 3、ィネーブル接点 62-4 、 62— 5が備わっている。
[0025] 左手用 3ポジションスィッチ 61の第 3操作ポジション検出接点 61— 3と右手用 3ポジ シヨンスィッチ 62の第 3操作ポジション検出接点 62— 3は直列接続されてリレー 66に 接続されている。尚、この第 1実施形態では電源を直流 24Vとしているので、リレー 6 6の他方は OV、左手用 3ポジションスィッチ 61の第 3操作ポジション検出接点 61— 3 の他方は直流 24Vに接続されている(直流 24V、 OVへの接続の説明は以後省略す る)。
この回路ラインは、少なくとも一方の 3ポジションスィッチを第 3操作ポジションにする と、該 3ポジションスィッチの第 3操作ポジション検出接点が開路することで第 3操作ポ ジシヨンを検出する第 3操作ポジション検出ライン 72である。
左手用 3ポジションスィッチ 61の操作検出接点 61—1と右手用 3ポジションスィッチ 6 2の操作検出接点 62— 1は直列に接続されて、少なくとも一方の 3ポジションスィッチ を操作すると開路する操作検出ライン 71を形成し、リレー 68の常開接点 68aに接続 されている。
[0026] 左手用 3ポジションスィッチ 61の操作検出接点 61—2と右手用 3ポジションスィッチ 6 2の操作検出接点 62— 2は並列に接続され、両方の 3ポジションスィッチ 61、 62を操 作すると開路する両スィッチ操作検出ライン 73を形成し、リレー 63の常開接点 63a3 と直列接続され、操作検出ライン 71に接続されている前述のリレー 68の常開接点 68 aの他方と並列接続 (ライン 74)された後、リレー 66の常開接点 66aおよびリレー 63 へ直列接続されている。
ライン 74より抵抗器 64とコンデンサ 65は直列接続され OVへ接続されて 、る。また、 抵抗器 67とリレー 66の常閉接点 66bが直列接続され、コンデンサ 65に並列接続さ れている。コンデンサ 65は、リレー 66の常開接点 66aが閉路状態で、ライン 74が電 源 24Vより遮断された時にリレー 63を所定の時間(例えば 1秒)オフ状態になるのを 遅延させるために設けられて 、る。抵抗器 64はコンデンサ 65への蓄電時に電流制 限を行ない、蓄電電流が流れる接点の保護を目的としている。リレー 66の常閉接点 6 6bは少なくとも片方の 3ポジションスィッチが第 3操作ポジションになった時に閉路し て、コンデンサ 65に蓄電された電荷を急速放電するものであり、抵抗器 67はこの急 速放電時の常閉接点 66bの接点保護を行なう。
リレー 63の常閉接点 63bはリレー 68へ接続されている。尚、リレー 68には、直列に 接続された抵抗器 69とコンデンサ 70が並列に接続されている。これは、リレー 68が オフ状態になるのを所定時間遅延させるために設けられたものである。
[0027] 左手用 3ポジションスィッチ 61のィネーブル接点 61— 4と右手用 3ポジションスィッチ 62のィネーブル接点 62— 4は並列に接続され、リレー 63の常開接点 63al、リレー 6 8の常閉接点 68b 1と直列接続されてィネーブル接点出力信号を形成している。他の ィネーブル接点 61— 5および 62— 5も同様に並列接続後リレー 63の常開接点 63a2、 リレー 68の常閉接点 68b2と直列接続されてィネーブル接点出力信号を形成してい る。尚、本実施例ではィネーブル接点出力信号を 2系統としているが、これは単一故 障においても装置の安全性を損なわないための二重化回路を構成するためであり、 十分に高い信頼性の部品材料の採用や、装置が使用されるシステムで要求がある 場合には 1系統とすることや他の目的に使用のため 3系統以上を準備しても力まわな い。
[0028] 図 2は、本実施例における状態遷移図である。 3ポジションスィッチの操作ポジショ ンと装置の操作の許容状態と禁止状態を示している。図 1の回路の動作を図 2の状 態遷移に沿って説明する。
最初に、両方の 3ポジションスィッチ 61、 62は操作されていない状態で電源の電圧 24Vが投入される(状態 Pon)と、 3ポジションスィッチ 61、 62の第 3操作ポジション検 出接点 61— 3、 62— 3は閉路しているので、これに接続されているリレー 66は通電励 磁されてオンとなる。一方、リレー 63の初期状態はオフ状態であるので、リレー 63の 常閉接点 63bは閉路しているため、これに接続されているリレー 68はオンとなり、そ の結果として、操作検出ライン 71に接続されているリレー 68の常開接点 68aは閉路 する。この時、 3ポジションスィッチ 61、 62は操作されていないので、操作検出接点 6 1—1および 62— 1は閉路しているため、リレー 63は通電励磁されてオンとなると共に コンデンサ 65には蓄電される。その結果、リレー 63の常開接点 63a3が閉路して、 3 ポジションスィッチの操作検出接点 61— 2および 62— 2も閉路しているため、リレー 63 に対する自己保持回路が形成される。なお、リレー 63のオンにより、その常閉接点で ある 63bは開路するのでリレー 68はオフする。この時、リレー 68に対してコンデンサ 7 0から放電が所定時間行われるので、リレー 63がオンした後でも、所定時間リレー 68 のオフを遅延して、リレー 63の自己保持回路形成に失敗することが防止される。所定 時間経過後(コンデンサ 70の放電終了後)、操作検出ライン 71に接続されているリレ 一 68の常開接点 68aは開路するが、前述のように、両スィッチ操作検出ライン 73お よびリレー 63の常開接点 63a3の回路により自己保持が確立されているので、リレー 63のオン状態は維持される。
[0029] この状態で、ィネーブル接点 61— 4, 62— 4が接続されているリレー 63の常開接点 6 3al、リレー 68の常閉接点 68blは閉路しているので、ィネーブル接点 61— 4, 62— 4 の状態力 Sイネ一ブル接点出力信号として出力可能となるスタンバイ状態が整う。他方 のィネーブル接点 61— 5, 62— 5側のイネ一ブル接点出力信号についても同様であ る。
両方の 3ポジションスィッチ 61、 62は操作されていないので、そのイネ一ブル接点 は開路しており、装置の操作を禁止する禁止状態 1となる (状態 1)。
[0030] 次に、 3ポジションスィッチ 61、 62を操作した場合の動作を説明する。
まず、通常の操作として、教示操作者がティーチペンダントを片手 (例えば左手)で把 持した場合、左手用 3ポジションスィッチ 61を押下することになる。その結果、操作検 出接点 61— 1、 61— 2が開路する。しかし、右手用 3ポジションスィッチ 62は操作され ていないので、操作検出接点 62— 2は閉路しており、これに接続されているリレー 63 の自己保持は確立維持される。そして、教示操作者がティーチペンダントを把持し、 左手用 3ポジションスィッチ 61は第 2操作ポジションとなっているので、ィネーブル接 点 61— 4、 61—5は閉路して、ィネーブル接点出力信号が出力され、装置の操作を許 容する許容状態 1となる (状態 2)。
[0031] 前述の許容状態 1で装置の操作中に、操作者が意図しない装置の動作で驚くなど の原因により左手用 3ポジションスィッチ 61を強く握り第 3操作ポジションとした時、左 手用 3ポジションスィッチ 61の第 3操作ポジション検出接点 61— 3が開路するため、こ れに接続されているリレー 66がオフとなり、その常開接点 66aは開路して、これに接 続されているリレー 63もオフとなり、前述の自己保持が解除される。その結果、リレー 63の常閉接点 63bは閉路して、接続されているリレー 68は通電励磁されてオンとな る。ィネーブル接点出力信号の回路にあるリレー 63の常開接点 63al、 63a2および ジレー 68の常閉接点 68bl, 68b2は開路し、 3ポジシ 3ンスィッチ 61、 62のイネーブ ル接点 61— 4、 61-5, 62-4, 62— 5が溶着などで閉路していてもィネーブル接点出 力信号の出力は遮断されて装置の操作を禁止する禁止状態 4となる (状態 3)。この 時、コンデンサ 65に蓄電されている電荷は閉路しているリレー 66の常閉接点 66bを 介して放電される。
[0032] 前述の許容状態 1で装置の操作中に、手を持ち替える時は、ー且両方の 3ポジショ ンスィッチ 61、 62を第 2操作ポジションにした後に左手用 3ポジションスィッチ 61を手 放す。
まず、両方の 3ポジションスィッチ 61、 62を第 2操作ポジションとすると、操作検出接 点 61— 1, 61-2, 62-1 , 62— 2は開路して操作検出ライン 71および両スィッチ操作 検出ライン 73への電源の供給が遮断される。すると、コンデンサ 65は放電を開始し て、リレー 63は所定の時間オフ状態になることが遅延する。すなわちリレー 63はオン 状態を維持しており、その常閉接点 63bに接続されたリレー 68もオフ状態を維持して いる。そのため、ィネーブル接点出力信号の回路にあるリレー 63の常開接点 63al、 63a2およびリレー 68の常閉接点 68bl, 68b2は閉路のままであるため、閉路となつ ているィネーブル接点 61— 4、 61-5, 62-4, 62— 5の状態がィネーブル接点出力信 号として出力されて装置の操作を許容する許容状態 3となる (状態 4)。 [0033] 次に、左手用 3ポジションスィッチ 61を手放すと、操作検出接点 61— 2が閉路してリ レー 63へ再び電源が供給されて、リレー 63に対する自己保持回路は維持される。こ の時、ィネーブル接点出力信号の回路にあるリレー 63の常開接点 63al、 63a2およ びリレー 68の常閉接点 68bl, 68b2は閉路のままであり、閉路となっているイネーブ ル接点 62— 4、 62— 5の状態力 ネーブル接点出力信号として出力されて装置の操 作を許容する許容状態 2となる (状態 5)。
[0034] 前述の許容状態 3を維持した時は、コンデンサ 65の放電によって所定の時間後リレ 一 63のオフ状態となり、常閉接点 63bは閉路して、これに接続されているリレー 68は オンとなる。ィネーブル接点出力信号の回路にあるリレー 63の常開接点 63al、 63a 2およびジレー 68の常閉接点 68bl, 68b2は開路するため、 3ポジシ 3ンスィッチ 61、 62のィネーブル接点 61— 4、 61-5, 62— 4、 62— 5が閉路していてもィネーブル接点 出力信号の出力は遮断されて装置の操作を禁止する禁止状態 2となる (状態 6)。
[0035] 前述の許容状態 3より、操作者が意図しない装置の動作で驚くなどの原因により例 えば右手用 3ポジションスィッチ 62を強く握り第 3操作ポジションとした時、右手用 3ポ ジシヨンスィッチ 62の第 3操作ポジション検出接点 62— 3が開路するので、これに接 続されているリレー 66の電源が遮断されてオフ状態となる。常開接点 66aが開路す ることで、リレー 63はオフとなり、常閉接点 63bに接続されているリレー 68はオンとな る。ィネーブル接点出力信号の回路にあるリレー 63の常開接点 63al、 63a2および リレー 68の常閉接点 68bl, 68b2は開路し、 3ポジションスィッチ 61のィネーブル接 点 61— 4、 61—5は閉路していても、ィネーブル接点出力信号の出力は遮断されて装 置の操作を禁止する禁止状態 8となる (状態 7)。この時、コンデンサ 65に蓄電されて いる電荷は閉路しているリレー 66の常閉接点 66bを介して放電される。
[0036] 前述の禁止状態 8より右手用 3ポジションスィッチ 62を第 2操作ポジションへ戻して も、コンデンサ 65は放電の後となるため、完全に放電されていなくてもリレー 63を再 びオンとするエネルギーは無いためリレー 63はオフの状態を維持する。この時リレー 68はオンとなっており、ィネーブル接点出力信号は出力されない装置の操作を禁止 する禁止状態 2となる (状態 6)。
[0037] 一旦禁止状態 1 (状態 1)以外の禁止状態 2乃至禁止状態 9となると、ィネーブル接 点出力信号回路に接続されているリレー 63の常開接点 63al、 63a2およびリレー 68 の常閉接点 68bl、 68b2は開路となり、ィネーブル接点出力信号を出力することが 出来なくなる。ィネーブル接点出力信号回路に接続されているリレー 63の常開接点 63al、 63a2およびジレー 68の常閉接点、68bl、 68b2を閉路するためには、 3ポジシ ヨンスィッチ 61、 62の 、ずれもが第 1操作ポジションである手放された状態とする必 要がある。両方の 3ポジションスィッチ 61、 62を第 1操作ポジションにすることは、これ らの操作検出接点 61— 1、 61-2, 62-1, 62— 2、第 3操作ポジション検出接点 61— 3 、 62— 3が全て閉路することである。この状態は、前述の最初に電源の電圧 24Vが投 入される時と同じであり、リレー 63、 66、 68の動作の結果、ィネーブル接点 61— 4, 6 2— 4が接続されているリレー 63の常開接点 63al、リレー 68の常閉接点 68blは閉 路してイネ一ブル接点 61— 4, 62— 4の状態力 ネーブル接点出力信号として出力可 能となるスタンバイ状態が整う。
他方のィネーブル接点 61—5, 62— 5側のイネ一ブル接点出力信号に付いても同 様である (状態 1)。
[0038] 尚、たとえば禁止状態 2 (状態 6)から禁止状態 1 (状態 1)への遷移経路については 、左手用および右手用 3ポジションスィッチ 61、 62を第一操作ポジションとするため に手放された状態とするが、左右の手放すタイミングの違いにより禁止状態 2 (状態 6 )より禁止状態 3または禁止状態 6を経由して禁止状態 1 (状態 1)へ戻る経路となる。
[0039] このように、ティーチペンダントを両手で把持してキーの操作中に、手の持ち替えを おこなう時にー且両手で 3ポジションスィッチを第 2操作ポジションとし、その後片手を 放しても、ロボットの操作を禁止状態にすることが無ぐスムーズな手の持ち替えが可 能となる。この時に危険な状態に遭遇などの要因で、少なくとも片方の 3ポジションス イッチを第 3操作ポジションとすると、即座に操作は禁止状態となり操作を禁止するこ とができるため、安全性の高!、操作が可能である。
また、少なくとも片方の 3ポジションスィッチの第 3操作ポジションを検出してイネ一 ブル接点出力信号の出力を確実に遮断して、これを解除するには両方の 3ポジショ ンスィッチが第 1操作ポジションに戻されることを検出してィネーブル接点出力信号の 出力回路を閉路、すなわち前記遮断の解除を行なっているので、ー且ィネーブル接 点出力信号の出力が遮断状態となれば、 3ポジションスィッチの各操作ポジションの 切り替わりによる各接点状態の移行タイミングや各リレーのオン、オフ切り替わりによ る接点状態の移行タイミングに左右されずに確実にィネーブル接点出力信号の出力 を遮断することができる。
実施例 2
[0040] 図 3は、本発明を実施する第 2実施形態の回路構成図である。この回路は第 1実施 形態と同様に、図示しないティーチペンダントあるいはティーチペンダントと図示しな Vヽ装置に分割されて装備されて 、る。
61、 62は 3ポジションスィッチであり、第 1実施形態と同一であるため説明を省く。 本実施形態では操作検出接点 61— 2および 62— 2は使用しない。
81および 84は電圧変換器であり、直流 24Vを 3ポジションスィッチの補助接点を介し て入力し、直流 5V信号へ変換して出力する。本実施形態ではフォト力ブラを利用し、 直流 24Vが入力されると OVが出力され、入力が無電圧の時は 5Vが出力されるよう になっている。 3ポジションスィッチ 61, 62の操作検出接点 61— 1、 62-1,第 3操作 ポジション検出接点 61— 3、 62— 3は片方を直流 24Vの電源に接続されている。他方 は並列分岐され、電圧変翻 81および 84へ接続されている。
電圧変換器 81よりの信号出力は、信号処理回路 82へ接続されている。信号処理 回路 82で信号処理を行い、結果をリレー 83へ出力している。
同様に電圧変換器 84よりの信号出力は、信号処理回路 85へ接続されている。信号 処理回路 85で信号処理を行い、結果をリレー 86へ出力している。尚、リレー 83及び リレー 86の他方は OVへ接続されて!、る。
[0041] 左手用 3ポジションスィッチ 61のィネーブル接点 61— 4と右手用 3ポジションスィッチ 62のィネーブル接点 62— 4は並列に接続され、リレー 83の常開接点 83alと直列接 続されてィネーブル接点出力信号を形成している。
同様に、左手用 3ポジションスィッチ 61のィネーブル接点 61— 5と右手用 3ポジション スィッチ 62のィネーブル接点 62— 5は並列に接続され、リレー 86の常開接点 86a2と 直列接続されてィネーブル接点出力信号を形成している。
[0042] 図 4は、本実施例における信号処理回路 82、 85の信号処理表である。 図において、接点状態は、信号処理回路 82、 85の入力信号である。 3ポジションスィ ツチ 61、 62の操作検出接点 61— 1、 62— 1および第 3ポジション検出接点 61— 3、 62 3の接点状態で、閉路では 0、開路では 1、開閉を問わない時は「任意」で表してい る。
信号処理回路内部状態は、信号処理回路 82、 85の内部状態である。オン状態で は 1、オフ状態では 0、オンオフ状態を問わない時は「任意」で表している。
[0043] 電源入状態は信号処理回路 82, 85に制御用の電源が投入されたときに 1となる。
電源入状態が 1の時はリレー出力はオフとなるようになつている(状態 11)。
電源入状態は、接点状態 61—1, 61-3, 62-1, 62— 3が全て 0となるとオフ状態の 0となる。この時、同時に禁止検出状態、計時状態が 0および時間超過状態も 0となる (状態 12)。
禁止検出状態は接点状態 61— 3が 1となる (状態 17)、接点状態 62— 3が 1となる( 状態 18)、あるいは後述の時間経過状態が 1となった時 (状態 16)にオン状態の 1と なり、接点状態 61—1, 61-3, 62-1, 62— 3が全て 0となるとオフ状態の 0となる。 禁止検出状態が 1の時はリレー出力はオフとなるようになつている。
[0044] 計時状態は接点状態 61— 1と 62— 1が 1で 61— 3と 62— 3が 0のとき(状態 15) 1となり 、これ以外では 0となる。すなわち計時状態は 2つの 3ポジションスィッチが双方とも第 2操作ポジションに操作されている時にオン状態の 1となる。
計時状態が 1となると、所定時間の計時を開始する。計時中に 2つの 3ポジションス イッチの内少なくとも片方が第 1操作ポジションになると計時状態は 0となり、計時を停 止すると共に計時値をクリアする (状態 12、状態 13、状態 14)。
計時状態が 1で前記所定時間が経過すると時間超過状態が 1となると共に、前述の ように禁止検出状態を 1とする (状態 16)。
リレー出力は接点状態 61— 1及び Z又は 62— 1が 1で電源入状態、禁止検出状態、 時間超過状態が全て 0の時にオンするようになっている(状態 14、状態 14、状態 15)
[0045] ティーチペンダントの操作を基に信号処理回路 82、 85での信号処理を説明する。
制御電源が投入されると、入力状態の如何にかかわらず電源入状態が 1となりリレ 一出力はオフとなる(状態 11)。
両方の 3ポジションスィッチ 61、 62を開放して第 1操作ポジションにすると、接点状 態 61— 1, 62-1, 61-3, 62— 3は 0となり、電源入状態は 0となる。この時リレー出力 はオフである(状態 12)。
状態 12より左手用 3ポジションスィッチ 61を第 2操作ポジションに操作すると、接点 状態 61-1が 1となり、リレー出力はオンとなる(状態 13)。
状態 12より右手用 3ポジションスィッチ 62を第 2操作ポジションに操作すると、接点 状態 62-1が 1となり、リレー出力はオンとなる(状態 14)。
両方の 3ポジションスィッチ 61、 62を第 2操作ポジションに操作すると、リレー出力 はオンであるが、計時状態が 1となり計時を開始する (状態 15)。
状態 15より片方の 3ポジションスィッチ 61または 62を開放して第 2操作ポジションと すると接点状態 61— 1または 62— 1が 0となる。この時、リレー出力はオンを維持する( 状態 13または状態 14)。
[0046] 状態 15を維持しておくと、計時状態が 1であるため計時が進み所定時間経過すると 時間超過状態が 1となると共に禁止検出状態も 1となる。この時、リレー出力はオフす る(状態 16)。
通常の教示操作中のいかなる状態よりも少なくとも片方の 3ポジションスィッチ 61ま たは 62を第 3操作ポジションとすると接点状態 61— 3または 62— 3が 1となり、禁止状 態は 1となる。この時、リレー出力はオフする(状態 17または状態 18)。
禁止検出状態が 1である状態 16、状態 17、状態 18より両方の 3ポジションスィッチ 61、 62を開放して第 1操作ポジションにすると、接点状態 61— 1, 62-1, 61-3, 62 -3は 0となり、禁止検出状態、計時状態、時間超過状態は 0となり、この時リレー出力 はオフとなる(状態 12)。
[0047] 本実施形態では信号処理回路 82, 85での信号処理について説明した。この信号 処理回路 82, 85はこの説明に基づいて論理素子を組み合わせて実現することは容 易である。また CPUなどの論理演算素子を用いて信号処理を行っても同様の効果を 奏する。
産業上の利用可能性 本発明は、モータなどの動力に基づき動作を行う自動機械などへ、作業者が接近 する時の安全装置、あるいは自動機械の動作を指示する操作スィッチに適用するこ とで、作業者の安全確保と装置の信頼性向上ができる。

Claims

請求の範囲
[1] 押下ストロークに応じて第 1操作ポジション、第 2操作ポジション、第 3操作ポジショ ンの 3つの操作ポジションを持つ 3ポジションスィッチを 2つ備え、前記 3ポジションス イッチは前記第 1操作ポジションと、前記第 3操作ポジションであることを検出する検 出手段を有し、前記操作ポジションに基づ 、て装置の操作を許容または禁止するテ ィーチペンダントの制御方法にぉ 、て、 前記 3ポジションスィッチが共に前記第 2操作ポジションに所定の時間を超えて位 置した場合に前記装置の操作を禁止とすることを特徴とするティーチペンダントの制 御方法。
[2] 前記 3ポジションスィッチが共に前記第 1操作ポジション力 前記第 2操作ポジショ ンに位置した場合に時間の計測を開始し、
前記計測された時間が前記所定の時間より小さ!、間に、前記 3ポジションスィッチ の少なくともどちら力 1方力 他の前記操作ポジションに位置した場合には、前記時 間の計測を停止することを特徴とする請求項 1記載のティーチペンダントの制御方法
[3] 押下ストロークに応じて第 1操作ポジション、第 2操作ポジション、第 3操作ポジショ ンの 3つの操作ポジションを持つ 3ポジションスィッチを 2つ備え、前記 3ポジションス イッチは前記第 1操作ポジションと、前記第 3操作ポジションであることを検出する検 出接点を有し、前記操作ポジションに基づ 、て装置の操作を許容または禁止を判定 する信号処理回路を有するティーチペンダントの制御装置において、
前記信号処理回路は、
前記 3ポジションスィッチの検出接点信号を入力として、前記 3ポジションスィッチが 共に前記第 2操作ポジションに所定の時間を超えて位置した場合に前記装置の操作 を禁止確立し、
前記 3ポジションスィッチを共に前記第 1操作ポジションとすることで前記装置の操 作の禁止確立を解除することを特徴とするティーチペンダントの制御装置。
[4] 前記信号処理回路は継電器を含む回路で構成されることを特徴とする請求項 3記 載のティーチペンダントの制御装置。 前記信号処理回路は論理素子あるいは論理演算素子のいずれかを含む回路で構 成されることを特徴とする請求項 3記載のティーチペンダントの制御装置。
前記信号処理回路は、前記ティーチペンダント本体内または前記装置に配設され ていることを特徴とする請求項 3記載のティーチペンダントの制御装置。
PCT/JP2004/007347 2003-06-09 2004-05-28 ティーチペンダントの制御方法および装置 Ceased WO2004109414A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
US10/559,336 US7337014B2 (en) 2003-06-09 2004-05-28 Teach pendant control method and device
DE112004000987.1T DE112004000987B4 (de) 2003-06-09 2004-05-28 Verfahren und Vorrichtung zum Steuern eines Programmierhandgeräts

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2003-163212 2003-06-09
JP2003163212A JP3951131B2 (ja) 2003-06-09 2003-06-09 ティーチペンダントの制御方法および装置

Publications (1)

Publication Number Publication Date
WO2004109414A1 true WO2004109414A1 (ja) 2004-12-16

Family

ID=33508748

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2004/007347 Ceased WO2004109414A1 (ja) 2003-06-09 2004-05-28 ティーチペンダントの制御方法および装置

Country Status (4)

Country Link
US (1) US7337014B2 (ja)
JP (1) JP3951131B2 (ja)
DE (1) DE112004000987B4 (ja)
WO (1) WO2004109414A1 (ja)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3951131B2 (ja) * 2003-06-09 2007-08-01 株式会社安川電機 ティーチペンダントの制御方法および装置
JP2006167884A (ja) * 2004-12-17 2006-06-29 Nachi Fujikoshi Corp ロボット教示装置およびその制御方法
JP6058378B2 (ja) * 2012-12-17 2017-01-11 株式会社ダイヘン ロボット制御システム
US9625884B1 (en) * 2013-06-10 2017-04-18 Timothy Harris Ousley Apparatus for extending control and methods thereof
JP6175976B2 (ja) * 2013-08-22 2017-08-09 村田機械株式会社 産業用機械
JP6846411B2 (ja) * 2017-03-21 2021-03-24 Idec株式会社 イネーブルスイッチおよび操作部
US10903107B2 (en) * 2017-07-11 2021-01-26 Brooks Automation, Inc. Semiconductor process transport apparatus comprising an adapter pendant
CN117222501A (zh) * 2021-06-03 2023-12-12 松下知识产权经营株式会社 使能开关装置以及具备其的负载驱动控制装置

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08171409A (ja) * 1994-12-20 1996-07-02 Tokico Ltd ロボットの制御装置
JP2002355781A (ja) * 2001-05-30 2002-12-10 Toyota Motor Corp コントロール装置及びその制御方法

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0688219B2 (ja) * 1987-10-02 1994-11-09 株式会社日立製作所 可搬式教示装置
JP3212546B2 (ja) * 1997-08-25 2001-09-25 ファナック株式会社 ロボット非常停止用デッドマンスイッチ機構並びに教示操作盤
JP3566639B2 (ja) * 2000-09-06 2004-09-15 和泉電気株式会社 教示ペンダントのイネーブル装置
JP4094429B2 (ja) * 2001-02-01 2008-06-04 Idec株式会社 イネーブルスイッチ
JP4314027B2 (ja) * 2002-12-27 2009-08-12 Idec株式会社 教示ペンダントのイネーブル装置
JP3951131B2 (ja) * 2003-06-09 2007-08-01 株式会社安川電機 ティーチペンダントの制御方法および装置

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08171409A (ja) * 1994-12-20 1996-07-02 Tokico Ltd ロボットの制御装置
JP2002355781A (ja) * 2001-05-30 2002-12-10 Toyota Motor Corp コントロール装置及びその制御方法

Also Published As

Publication number Publication date
JP2004362497A (ja) 2004-12-24
DE112004000987B4 (de) 2019-09-12
JP3951131B2 (ja) 2007-08-01
US20060138989A1 (en) 2006-06-29
US7337014B2 (en) 2008-02-26
DE112004000987T5 (de) 2006-04-13

Similar Documents

Publication Publication Date Title
EP1806761B1 (en) Robot control system
JP4320556B2 (ja) 産業用ロボットの制御装置
JP4384174B2 (ja) 電気負荷のフェールセーフ停止用の安全切換装置およびその方法
US7898118B2 (en) Safety switching apparatus and method for safely switching an electrical load on and off
WO2004109414A1 (ja) ティーチペンダントの制御方法および装置
JPH10217180A (ja) ロボットの安全装置
US20170009510A1 (en) Manipulation assisting control apparatus
JP4291523B2 (ja) コントロール装置及びその制御方法
JP2008228415A (ja) モータ駆動装置
JP3794564B2 (ja) 電源制御装置
US7064289B2 (en) Short-time arc-welding system and process for controlling such a system
JP2004166357A (ja) 自動機械の制御装置および制御方法
JP2004176732A (ja) インターロック回路を有する装置
JP4395829B2 (ja) 自動機械の動作許可装置
US20020125862A1 (en) Electrical energy distribution system and contactor for such a system
CN111555390A (zh) 一种高智能人型机器人四肢部分的配电系统
JP3775504B2 (ja) ティーチペンダントの制御装置
EP4392793A1 (en) System and method for shared hybrid transfer switch system with integrated relay self test
US11101091B2 (en) Modular safety relay circuit for the safe switching on and/or off of at least one machine
WO2004060618A1 (ja) 教示ペンダントのイネーブル装置
JPH10508977A (ja) 保護安全組み合わせ装置
JP7281699B2 (ja) ブレーキ駆動制御回路とその故障検出方法
JPH046512B2 (ja)
RU2238880C1 (ru) Дистанционный привод управления судовым двигателем
JP2007035388A (ja) 自動機械の電源供給装置

Legal Events

Date Code Title Description
AK Designated states

Kind code of ref document: A1

Designated state(s): AE AG AL AM AT AU AZ BA BB BG BR BW BY BZ CA CH CN CO CR CU CZ DE DK DM DZ EC EE EG ES FI GB GD GE GH GM HR HU ID IL IN IS KE KG KP KR KZ LC LK LR LS LT LU LV MA MD MG MK MN MW MX MZ NA NI NO NZ OM PG PH PL PT RO RU SC SD SE SG SK SL SY TJ TM TN TR TT TZ UA UG US UZ VC VN YU ZA ZM ZW

AL Designated countries for regional patents

Kind code of ref document: A1

Designated state(s): BW GH GM KE LS MW MZ NA SD SL SZ TZ UG ZM ZW AM AZ BY KG KZ MD RU TJ TM AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HU IE IT LU MC NL PL PT RO SE SI SK TR BF BJ CF CG CI CM GA GN GQ GW ML MR NE SN TD TG

121 Ep: the epo has been informed by wipo that ep was designated in this application
ENP Entry into the national phase

Ref document number: 2006138989

Country of ref document: US

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 10559336

Country of ref document: US

WWP Wipo information: published in national office

Ref document number: 10559336

Country of ref document: US

122 Ep: pct application non-entry in european phase