JPH11156768A - Conveying device and its control method - Google Patents

Conveying device and its control method

Info

Publication number
JPH11156768A
JPH11156768A JP33146797A JP33146797A JPH11156768A JP H11156768 A JPH11156768 A JP H11156768A JP 33146797 A JP33146797 A JP 33146797A JP 33146797 A JP33146797 A JP 33146797A JP H11156768 A JPH11156768 A JP H11156768A
Authority
JP
Japan
Prior art keywords
arm
drive shaft
driving
drive
detection plate
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.)
Pending
Application number
JP33146797A
Other languages
Japanese (ja)
Inventor
Yasuhide Matsumura
泰秀 松村
Masabumi Kanetomo
正文 金友
Hideo Kashima
秀夫 鹿島
Tsutomu Fujimoto
勉 藤本
Seiji Iizuka
清次 飯塚
Hironao Kamaya
弘直 釜谷
Kazuichi Sugiyama
和一 杉山
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.)
Hitachi Ltd
Original Assignee
Hitachi 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 Hitachi Ltd filed Critical Hitachi Ltd
Priority to JP33146797A priority Critical patent/JPH11156768A/en
Publication of JPH11156768A publication Critical patent/JPH11156768A/en
Pending legal-status Critical Current

Links

Abstract

PROBLEM TO BE SOLVED: To increase the acceleration and to reduce the original point returning time, in order to reduce the conveying time, in a conveying device. SOLUTION: In order to make equal the angular speeds of two driving motors, the signals of the position detectors of both driving motors are compared, and the difference of both motors is feedbacked to a motor controller at one side, so as to correct the delay or the advance, and the synchronism of the two driving motors is made possible to take constantly. A sensor to detect the existence of a wafer cassette 4 is installed to the carrier 3 of a conveying device, and when the wafer cassette 4 is loaded, the acceleration of the conveyance is suppressed to a limited value, and when there is no wafer cassette 4, the acceleration is carried out to the maximum output of the driving system. In order to reduce the time to return to an original point, sensors are provided to the detecting plates of the driving shaft to drive the first arm 1a and the driving shaft to drive the first arm 1b respectively, the forms of the detecting plates are made in a semicircular form, it is classified into four patterns by the detecting conditions of two sensors, the rotating direction of the arm is defined in respective pattern, and the rotation is carried out depending on the difinision respectively.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は半導体の製造装置に
係り、特に被搬送物としてウェハを入れたウェハカセッ
トを無人で搬送するために使用される搬送装置およびそ
の制御方法に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a semiconductor manufacturing apparatus, and more particularly, to a transfer apparatus used for unmanned transfer of a wafer cassette containing a wafer as an object to be transferred, and a control method thereof.

【0002】[0002]

【従来の技術】半導体製造工程の中で、ウェハをハンド
リングする手段として搬送ロボットもしくは搬送装置と
呼ばれるロボットが各種使用されている。そのなかで、
ウェハ等の基板を搬送するロボットで、連結された二本
の腕を一対持ち、一対の腕で一つのキャリアを支え、一
対の腕を同時に駆動し、キャリアを支えている腕の支点
が腕の駆動軸上を通過できるロボットについて特願平8
−84941号(出願参照)に詳細に述べられている。
2. Description of the Related Art In a semiconductor manufacturing process, various types of robots called transfer robots or transfer devices are used as means for handling wafers. Among them,
A robot that transports a substrate such as a wafer, has a pair of two connected arms, supports one carrier with a pair of arms, drives a pair of arms simultaneously, and the fulcrum of the arm supporting the carrier is Japanese Patent Application No. Hei 8 for a robot that can pass on the drive shaft
No. -8,491 (see application).

【0003】[0003]

【発明が解決しようとする課題】従来の搬送装置では、
第1の腕Aを駆動するA駆動モータ、第1の腕Bを駆動
するB駆動モータ、そして腕の稼動する面の法線方向に
駆動させるためのZ軸駆動モータはそれぞれのモータド
ライバ接続され、そしてモータドライバをコントロール
するコントローラにつながれ、その上位には搬送装置全
体の動きを制御するコンピュータのCPUに接続されて
いる。
SUMMARY OF THE INVENTION In a conventional transfer device,
An A drive motor for driving the first arm A, a B drive motor for driving the first arm B, and a Z-axis drive motor for driving in the normal direction of the surface on which the arm operates are connected to respective motor drivers. The controller is connected to a controller for controlling the motor driver, and is connected to a CPU of a computer for controlling the operation of the entire transfer apparatus.

【0004】また従来の搬送装置ではA駆動モータに対
しB駆動モータを逆方向に回転させるとキャリアは直線
方向に動き、同一方向に回転させるとキャリアは回転方
向に動く。いまキャリアを直線方向に移動させる場合に
ついて考えてみると、先に述べたようにA駆動モータ
と、B駆動モータを逆方向に回転させれば良いのだが、
この時二つのモータの角速度を等しくしておかないと、
キャリアの動きは直線成分だけではなく回転成分も含ん
でしまう。つまりキャリアの加速度に注目すると、キャ
リアがX地点からY地点に移動する時間が同じならば、
キャリアの動きが直線成分だけの場合の加速度よりも、
直線成分と回転成分を含む場合の加速度方が大きくな
る。
In the conventional transport device, when the B drive motor is rotated in the reverse direction with respect to the A drive motor, the carrier moves in a linear direction, and when the B drive motor is rotated in the same direction, the carrier moves in the rotational direction. Now, consider the case where the carrier is moved in a linear direction. As described above, it is sufficient to rotate the A drive motor and the B drive motor in opposite directions.
At this time, if you do not make the angular velocity of the two motors equal,
The movement of the carrier includes not only a linear component but also a rotational component. In other words, focusing on the acceleration of the carrier, if the time for the carrier to move from the X point to the Y point is the same,
Than the acceleration when the movement of the carrier is only a linear component,
The acceleration when the linear component and the rotational component are included increases.

【0005】搬送装置のキャリアに載せられたウェハカ
セットの中に入っているウェハは、ウェハがウェハカセ
ット内で静止しているためには、ウェハとウェハカセッ
トの摩擦係数から求められる加速度の値を超えなければ
良い。もしウェハがウェハカセット内で静止していない
で動いたならば、塵埃が発生しウェハを汚染することに
なり、許されない。
A wafer contained in a wafer cassette placed on a carrier of a transfer device has an acceleration value obtained from a friction coefficient between the wafer and the wafer cassette because the wafer is stationary in the wafer cassette. Good if not exceeded. If the wafer moves in the wafer cassette without being stationary, dust is generated and contaminates the wafer, which is not allowed.

【0006】つまりウェハがウェハカセット内で静止し
ている条件の加速度が示されているならば、キャリアの
移動時間は加速度が直線成分と回転成分を含むよりも、
当然、加速度が直線成分だけの方が移動時間は小さくな
る。しかし従来はA駆動モータから見た負荷と、B駆動
モータから見た負荷を完全に等しくできないため、この
二つのモータの角速度を等しくすることができず、キャ
リアには直線成分と回転成分を含む加速度が発生してい
た。
[0006] In other words, if the acceleration under the condition that the wafer is stationary in the wafer cassette is indicated, the moving time of the carrier is longer than the acceleration including the linear component and the rotating component.
Naturally, the movement time is shorter when the acceleration is only the linear component. However, conventionally, since the load viewed from the A drive motor and the load viewed from the B drive motor cannot be completely equalized, the angular velocities of the two motors cannot be equalized, and the carrier includes a linear component and a rotational component. Acceleration was occurring.

【0007】次に、搬送装置のキャリアにウェハカセッ
トが載っている時は、上記で述べたように加速度が制限
されるが、キャリアに何も載っていない時は駆動モータ
の能力いっぱいの加速度で加速した方が全体の作業時間
は短くなる。しかし従来の搬送装置はキャリアにウェハ
カセットを載せた状態での最高加速度で常時稼動させて
いたため、作業時間を短くすることはできなかった。
Next, when the wafer cassette is mounted on the carrier of the transfer device, the acceleration is limited as described above, but when nothing is mounted on the carrier, the acceleration is at the full capacity of the drive motor. Acceleration reduces the overall work time. However, the conventional transfer device has always been operated at the maximum acceleration with the wafer cassette mounted on the carrier, so that the working time could not be shortened.

【0008】次に、搬送装置を稼動させている時、何ら
かの理由でキャリアや腕が障害物と接触する事故が発生
する時がある。この時キャリアや腕をダメージから保護
するため、何らかの保護手段を設けるが、従来は第1の
腕Aを駆動するA駆動モータ、第1の腕Bを駆動するB
駆動モータ、そして腕の稼動する面の法線方向に駆動さ
せるためのZ軸駆動モータの出力軸と負荷の間に機械式
のトルクリミッタを設け、キャリアや腕が障害物と接触
してトルクがある値を超えたらトルクリミッタが働いて
モータと切り離し、キャリアや腕にダメージを与えない
ようにしていた。
Next, when the transport device is operated, an accident may occur in which the carrier or the arm contacts an obstacle for some reason. At this time, some protection means is provided to protect the carrier and the arm from damage. Conventionally, an A drive motor for driving the first arm A and a B drive motor for driving the first arm B are provided.
A mechanical torque limiter is installed between the drive motor and the output shaft of the Z-axis drive motor for driving the arm in the direction normal to the working surface, and the load. When a certain value was exceeded, a torque limiter was activated to disconnect from the motor so as not to damage the carrier or arm.

【0009】また、モータを接続しているドライバの電
流を監視し、キャリアや腕が障害物と接触してモータの
発生トルクが大きくなると、当然それはモータに流す電
流も大きくなるので、電流値がある値を超えるとドライ
バを停止させ保護していた。
Also, the current of the driver connected to the motor is monitored, and when the carrier or arm comes into contact with an obstacle and the generated torque of the motor increases, naturally the current flowing to the motor also increases. When a certain value was exceeded, the driver was stopped and protected.

【0010】しかし以上述べた方法の欠点は、トルクま
たは電流ともある一定の値で制限しているところにあ
る。トルク電流とも負荷の大きさだけではなく、キャリ
アの位置により変化するし、また搬送装置の外周温度、
搬送装置の運転経過時間によっても変わって行く。つま
りこれらの変化に対処するためには、トルクまたは電流
のピーク値に対して十分余裕を持った値を制限値にしな
ければならない。すると、障害物と接触して瞬時に保護
が働かないため、キャリアや腕、または接触した相手の
ダメージも大きくなった。
However, a disadvantage of the method described above is that both the torque and the current are limited to a certain value. The torque current varies not only with the magnitude of the load but also with the position of the carrier.
It also changes depending on the operation elapsed time of the transfer device. That is, in order to cope with these changes, a value having a sufficient margin with respect to the peak value of the torque or the current must be set as the limit value. As a result, the protection was not instantaneously activated upon contact with the obstacle, so that the carrier, the arm, and the contacted person also became more damaged.

【0011】次に、停電または先に述べたようにキャリ
アや腕の接触により保護回路が働いて電源が遮断した場
合、電源が復帰した時に搬送装置の現在地が分からなく
なるのを防ぐため、A駆動モータ、B駆動モータ、Z軸
駆動モータにはアブソリュートエンコーダを使用してい
た。しかしアブソリュートエンコーダはインクリメンタ
ルエンコーダと比較して大変高価であり、搬送装置のコ
ストを上昇させる一因となっていた。
Next, in the case where the power is cut off due to a power failure or the contact of a carrier or an arm to activate the protection circuit as described above, the A drive is performed to prevent the current position of the transport device from being known when the power is restored. Absolute encoders were used for the motor, the B drive motor, and the Z axis drive motor. However, the absolute encoder is very expensive as compared with the incremental encoder, and has been one of the causes for increasing the cost of the transfer device.

【0012】次に、搬送装置の動作であるが、キャリア
は直線運動、回転運動、上下運動が可能となっている
が、従来の動作の一例として、腕を伸ばしてキャリアを
直進させ、上昇してウェハカセットを受け取り、腕を縮
めてキャリアを直進させ、キャリアを旋回させ、腕を伸
ばしてキャリアを直進させ、下降してウェハカセットを
渡し、腕を縮めてキャリアを直進させ、キャリアを逆に
旋回さて元に戻るという作業の流れを行ってきた。しか
しこの動作時間をもっと縮めたいという要求があった。
Next, as for the operation of the transfer device, the carrier can perform a linear motion, a rotary motion, and an up-and-down motion. As an example of the conventional operation, the carrier is moved straight by extending the arm and moved up. Receiving the wafer cassette, retracting the arm and moving the carrier straight, turning the carrier, extending the arm and moving the carrier straight, descending and passing the wafer cassette, contracting the arm and moving the carrier straight and reversing the carrier I turned around and went back to work. However, there was a demand to further reduce the operation time.

【0013】次に、A駆動モータ、B駆動モータに安価
なインクリメンタルエンコーダを使用した場合の原点信
号について述べる。先に述べたように停電または保護回
路が働いて電源が遮断した場合、電源が復帰した時に搬
送装置の現在地が分からなくなるので、まず原点位置を
探し、そこから再スタートする必要がある。従来の搬送
装置では、第1の腕Aを駆動する駆動軸と第1の腕Bを
駆動する駆動軸それぞれに、円周上一個所を切り欠いた
検出板とセンサを各一個を取り付けて原点信号を検出し
ていた。そのため、電源が復帰して原点位置を探す場
合、A駆動モータ、B駆動モータとも予め定めた回転方
向にのみ回転させるため、場合によっては350度以上
回転させる必要があり、原点復帰に時間がかかってい
た。
Next, an origin signal when an inexpensive incremental encoder is used for the A drive motor and the B drive motor will be described. As described above, when the power is cut off due to a power failure or a protection circuit, the current position of the transport device cannot be determined when the power is restored. Therefore, it is necessary to first find the origin position and restart from there. In the conventional transfer device, a detection plate and a sensor, each of which is cut out at one location on the circumference, are attached to the drive shaft for driving the first arm A and the drive shaft for driving the first arm B, respectively. Signal was detected. Therefore, when the power is restored and the origin position is searched, both the A drive motor and the B drive motor rotate only in a predetermined rotation direction, and in some cases, it is necessary to rotate the motor by 350 degrees or more. I was

【0014】[0014]

【課題を解決するための手段】A駆動モータとB駆動モ
ータの角速度を等しくするために、A駆動モータの位置
検出器の信号と、B駆動モータの位置検出器の信号を比
較し、どちらか一方を基準としてその差分を取り出し、
基準ではない方のモータコントローラにフィードバック
し遅れもしくは進みを補正し常にA駆動モータとB駆動
モータの同期が取れるようにした。
In order to equalize the angular velocities of the A drive motor and the B drive motor, a signal of a position detector of the A drive motor is compared with a signal of a position detector of the B drive motor. Take the difference based on one,
Feedback is made to the non-reference motor controller to correct the delay or advance so that the A drive motor and the B drive motor can always be synchronized.

【0015】キャリアに適切な加速度を与える手段とし
て、搬送装置のキャリアにウェハカセットの有無を検出
するセンサを付け、ウェハカセットが載っている時は搬
送の加速度を制限される値に押さえ、ウェハカセットが
無い時にはその駆動系の持つ最大出力まで加速するよう
にした。
As means for giving an appropriate acceleration to the carrier, a sensor for detecting the presence or absence of a wafer cassette is provided on the carrier of the transfer device, and when the wafer cassette is mounted, the transfer acceleration is suppressed to a value which is limited. When there is no drive, it accelerates to the maximum output of the drive system.

【0016】キャリアや腕が障害物に接触した場合の保
護手段として、A駆動モータ、B駆動モータ、Z軸駆動
モータのモータに流れる電流を搬送の一周期分検出し、
予め搬送の一周期分記録させている電流値の制限値と比
較して、保護回路を働かさせるようにした。
As a protection means when the carrier or the arm comes into contact with an obstacle, a current flowing through the motors of the A drive motor, the B drive motor, and the Z axis drive motor is detected for one cycle of the conveyance.
The protection circuit is activated by comparing the current value with the limit value of the current value recorded for one cycle in advance.

【0017】インクリメンタルエンコーダを使用してア
ブソリュートエンコーダと同じ機能を持たせる手段とし
て、速度検出器と位置検出器を付けたモータに、通電時
にはブレーキが解除され電源を切るとブレーキが働く負
作動ブレーキを付け、位置検出器の信号はコンピュータ
を通して電池でバックアップされたメモリに記録される
ようにした。それにより、電源が遮断した場合でもメモ
リに位置検出器の信号が保存され、モータの位置も負作
動ブレーキにより固定される。そのため、電源を再び投
入しても、モータの位置とインクリメンタルエンコーダ
の位置信号の関係が変わらないので、アブソリュートエ
ンコーダを使用した時と同じ効果が得られる。
As a means for providing the same function as an absolute encoder by using an incremental encoder, a motor provided with a speed detector and a position detector is provided with a negative operation brake which is released when the power is supplied and is activated when the power is turned off. In addition, the signal of the position detector was recorded in a memory backed up by a battery through a computer. As a result, even when the power is cut off, the signal of the position detector is stored in the memory, and the position of the motor is also fixed by the negative operation brake. Therefore, even if the power is turned on again, the relationship between the position of the motor and the position signal of the incremental encoder does not change, so that the same effect as when the absolute encoder is used can be obtained.

【0018】搬送時間を短縮する手段として、キャリア
の直線運動、回転運動、上下運動の二つ以上の運動を組
み合わせて制御することにした。
As means for shortening the transport time, control is performed by combining two or more of the linear motion, the rotary motion, and the vertical motion of the carrier.

【0019】原点復帰の時間を短縮する手段として、第
1の腕Aを駆動する駆動軸と、第1の腕Bを駆動する駆
動軸のそれぞれに検出板を設けセンサを付け、検出板の
形状を半円形とし、第1の腕Aと第1の腕Bのセンサの
検出状態で四つのパターンに分類し、それぞれのパター
ンにおいて腕の回転方向を定義しておきそれに従って回
転させるようにした。
As means for shortening the time for returning to the origin, a detection plate is provided on each of the drive shaft for driving the first arm A and the drive shaft for driving the first arm B, and a sensor is attached to the drive shaft. Is divided into four patterns according to the detection state of the sensors of the first arm A and the first arm B, and the rotation direction of the arm is defined in each pattern, and the arm is rotated according to the direction.

【0020】[0020]

【発明の実施の形態】図1、図2、図3は本発明を適用
する搬送装置の実施例である。ただし「従来の技術」で
述べたように、連結された二本の腕を一対持ち、一対の
腕で一つのキャリアを支え、一対の腕を同時に駆動し、
キャリアを支えている腕の支点が腕の駆動軸上を通過で
きるロボットについての構造は特願平8−84941号
(出願参照)に詳細に述べられているので、構造につい
て重複する部分は割愛する。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS FIGS. 1, 2 and 3 show an embodiment of a transfer apparatus to which the present invention is applied. However, as described in the "prior art", holding two connected arms, supporting one carrier with a pair of arms, simultaneously driving a pair of arms,
The structure of the robot that allows the fulcrum of the arm supporting the carrier to pass on the drive shaft of the arm is described in detail in Japanese Patent Application No. 8-84841 (refer to the application), and the overlapping part of the structure is omitted. .

【0021】図1はこの搬送装置の俯瞰図であり、同軸
の駆動軸に結合された第1の腕A1aと第1の腕B1b
が配置され、回転自在な軸受け6aと6bを介して第2
の腕A2aと第2の腕B2bとが連結されている。そし
て、第2の腕A2aと第2の腕B2bはそれぞれの腕の
開き角が同一になるような関節の機構7aと7bを介し
てキャリア3が結合されている。キャリア3にはウェハ
カセット4が載っている。ウェハカセット4は直進方向
8、軸心5を回転中心として回転方向9そして上下方向
10に移動可能となっている。
FIG. 1 is a bird's-eye view of this transfer device, in which a first arm A1a and a first arm B1b connected to a coaxial drive shaft.
Is arranged, and the second is provided via rotatable bearings 6a and 6b.
Arm A2a and the second arm B2b are connected to each other. The carrier 3 is connected to the second arm A2a and the second arm B2b via joint mechanisms 7a and 7b such that the opening angles of the arms are the same. A wafer cassette 4 is mounted on the carrier 3. The wafer cassette 4 is movable in a rectilinear direction 8, a rotational direction 9 about the axis 5 as a center of rotation, and a vertical direction 10.

【0022】図2は搬送装置の上面図である。図2
(a)は第1の腕A1aと第1の腕B1bの回転方向1
1aと11b、それに第2の腕A2aと第2の腕B2b
の回転方向12aと12bを腕を伸ばす方向に回転させ
て直進方向8に移動したところである。図2(b)は回
転方向11aと11b、それに回転方向12aと12b
を腕を縮める方向に回転させ、原点位置に移動したとこ
ろを表している。この時キャリア3を支えている腕の関
節機構7aと7bが腕の駆動軸の軸心5を通過してい
る。
FIG. 2 is a top view of the transfer device. FIG.
(A) is the rotation direction 1 of the first arm A1a and the first arm B1b.
1a and 11b, and a second arm A2a and a second arm B2b
Are rotated in the direction in which the arm is extended, and are moved in the straight traveling direction 8. FIG. 2B shows the rotation directions 11a and 11b and the rotation directions 12a and 12b.
Is rotated in the direction to shrink the arm, and is moved to the origin position. At this time, the arm joint mechanisms 7a and 7b supporting the carrier 3 pass through the axis 5 of the drive shaft of the arm.

【0023】図3は搬送装置の断面図である。第1の腕
A1aは同軸の駆動軸13aに結合され、歯車14aを
介して駆動モータ16aに結合した歯車15aと噛み合
っている。第1の腕B1bも同様に、同軸の駆動軸13
bに結合され、歯車14bを介して駆動モータ16bに
結合した歯車15bと噛み合っている。この図から明ら
かなように、駆動モータ16aと16bを回転させる
と、同軸の駆動軸13aと13bの軸心を回転中心とし
て、第1の腕A1aと1bが回転する構造となってい
る。そしてこの駆動モータ16aと16bの回転方向を
逆方向に回転させればキャリア3は直進方向8の移動を
行い、同一方向に回転させればキャリア3は回転方向9
の移動をおこなう。これらの機構は直進ガイド20aと
20bで支えられ、Z軸駆動モータ17と結合したボー
ルネジ軸18、ボールネジナット19により上下方向1
0に移動できる構造となっている。
FIG. 3 is a sectional view of the transfer device. The first arm A1a is coupled to a coaxial drive shaft 13a and meshes with a gear 15a coupled to a drive motor 16a via a gear 14a. Similarly, the first arm B1b has a coaxial drive shaft 13
b, and meshes with a gear 15b connected to a drive motor 16b via a gear 14b. As is apparent from this figure, when the drive motors 16a and 16b are rotated, the first arms A1a and 1b rotate around the axis of the coaxial drive shafts 13a and 13b. By rotating the driving motors 16a and 16b in the opposite directions, the carrier 3 moves in the rectilinear direction 8;
Make the move. These mechanisms are supported by rectilinear guides 20a and 20b, and are vertically moved by a ball screw shaft 18 and a ball screw nut 19 connected to a Z-axis drive motor 17.
It has a structure that can be moved to zero.

【0024】図4は搬送装置の制御系を示している。図
4(a)は制御系の全体構成図で、第1の腕A1aの駆
動モータ16a、第1の腕B1bの駆動モータ16b、
Z軸駆動モータ17はそれぞれドライバ31a,31
b,31cと接続し、ドライバはコントローラ32と接
続し、その上位にはコンピュータのCPU33に接続し
ている。図4(b)は駆動モータ一個の系について詳し
く説明したものである。駆動モータ16の内部はモータ
本体34、速度検出器35、位置検出器36とからなっ
ている。速度検出器35の速度信号37は、ドライバ3
1にフィードバックされる。また位置検出器36の位置
信号38はコントローラにフィードバックされる。そし
て位置検出器36の零相信号39はコンピュータにフィ
ードバックされる。図4(b)では一般的なデジタルサ
ーボの例で述べたが、ソフトウェアサーボを使用しても
構成はほぼ同じである。
FIG. 4 shows a control system of the transfer device. FIG. 4A is an overall configuration diagram of a control system, in which a drive motor 16a of a first arm A1a, a drive motor 16b of a first arm B1b,
The Z-axis drive motor 17 includes drivers 31a, 31
b, 31c, the driver is connected to the controller 32, and above it is connected to the CPU 33 of the computer. FIG. 4 (b) explains in detail the system of one drive motor. The inside of the drive motor 16 includes a motor body 34, a speed detector 35, and a position detector 36. The speed signal 37 of the speed detector 35 is
1 is fed back. The position signal 38 of the position detector 36 is fed back to the controller. Then, the zero-phase signal 39 of the position detector 36 is fed back to the computer. FIG. 4B shows an example of a general digital servo, but the configuration is almost the same even when software servo is used.

【0025】図4において、第1の腕A1aの駆動モー
タ16a、第1の腕B1bの駆動モータ16b、Z軸駆
動モータ17はそれぞれドライバ31a,31b,31
cと接続されているが、ここで第1の腕A1aの駆動モ
ータ16の回転方向に対し、第1の腕B1bの駆動モー
タ16bを同一方向に回転させればキャリアは駆動軸と
直角な平面内で駆動軸を原点とする円の半径方向の動き
を行い、逆方向に回転させればキャリアは駆動軸と直角
な平面内で駆動軸を原点とする回転方向の動きを行う。
この時、第1の腕A1aの駆動モータ16a、第1の腕
B1bの駆動モータ16bの回転方向および回転速度を
CPU33で制御することにより、キャリアの駆動は半
径方向の動きと回転方向の動きを同時に行うことができ
る。また当然Z軸駆動モータ17も同時に駆動すること
ができるので、作業時間を短縮することができる。
In FIG. 4, the drive motor 16a of the first arm A1a, the drive motor 16b of the first arm B1b, and the Z-axis drive motor 17 are drivers 31a, 31b, 31 respectively.
When the drive motor 16b of the first arm B1b is rotated in the same direction as the rotation direction of the drive motor 16 of the first arm A1a, the carrier becomes a plane perpendicular to the drive shaft. When the carrier moves in the radial direction of the circle with the drive shaft as the origin and rotates in the opposite direction, the carrier moves in the plane perpendicular to the drive shaft in the rotation direction with the drive shaft as the origin.
At this time, by controlling the rotation direction and the rotation speed of the drive motor 16a of the first arm A1a and the drive motor 16b of the first arm B1b by the CPU 33, the drive of the carrier is performed in the radial direction and the rotational direction. Can be done simultaneously. In addition, since the Z-axis drive motor 17 can be driven at the same time, the work time can be reduced.

【0026】図5は、第1の腕A1aの駆動モータ16
aと第1の腕B1bの駆動モータ16bを同期を取って
駆動する実施例を示したものである。駆動モータ16a
と駆動モータ16bの駆動する構成は基本的には図4
(b)と同じであるが、位置検出器36a、36bの位
置信号38a,38bを補正コントローラ41に入力
し、38aと38bの差分をとって、その差分を補正信
号42とし、これをコントローラ32へフィードバック
する。そして、補整信号42の正負の符号により遅れ進
みを判定し、この図の例では16bを基準として駆動モ
ータ16aの入力パルス数を、遅れていれば時間当たり
のパルス数を増やし、進んでいればパルス数を減らすこ
とにより駆動モータ16aと駆動モータ16bの同期を
取っている。
FIG. 5 shows the driving motor 16 of the first arm A1a.
This shows an embodiment in which a is driven in synchronization with the drive motor 16b of the first arm B1b. Drive motor 16a
The configuration in which the driving motor 16b is driven is basically the same as that shown in FIG.
The same as (b), except that the position signals 38a and 38b of the position detectors 36a and 36b are input to the correction controller 41, the difference between 38a and 38b is obtained, and the difference is used as the correction signal 42, which is used as the controller 32. Feedback to Then, the advance of the delay is determined by the sign of the compensation signal 42. In the example of this figure, the number of input pulses of the drive motor 16a is increased based on 16b. The drive motor 16a and the drive motor 16b are synchronized by reducing the number of pulses.

【0027】図6は、キャリア3にウェハカセット4の
検出手段を設け、搬送の加速度を変える方法を示す実施
例である。図6(a)は制御系の構成図で、キャリア3
にウェハカセット4を搭載している。キャリア3にはセ
ンサ51が取り付けられ、ウェハカセット4の有無を検
出する。その信号はA/D変換器52を通してCPU3
3に入力される。ここでセンサ51がオンオフスイッチ
ならばA/D変換器52は必要としないで直接CPU3
3に入力できる。図6(b)は駆動軸13a,13bの
角速度と直線方向8または回転方向9または上下方向1
0の移動の駆動時間との関係を示す図である。この図に
示すように、被搬送物であるウェハカセット4が乗って
いる場合、角速度はある値に押さえられ駆動時間が決ま
るが、ウェハカセット4が無い場合はこの駆動系で出せ
る最大の角速度にすることにより、起動時間を短くする
ことができる。
FIG. 6 is an embodiment showing a method of providing a detecting means for the wafer cassette 4 on the carrier 3 to change the acceleration of the transfer. FIG. 6A is a configuration diagram of the control system, in which the carrier 3
Is mounted with a wafer cassette 4. A sensor 51 is attached to the carrier 3 and detects the presence or absence of the wafer cassette 4. The signal is sent to the CPU 3 through the A / D converter 52.
3 is input. Here, if the sensor 51 is an on / off switch, the A / D converter 52 is not required and the CPU 3
3 can be entered. FIG. 6B shows the angular velocities of the drive shafts 13a and 13b and the linear direction 8 or the rotational direction 9 or the vertical direction 1.
FIG. 9 is a diagram showing a relationship between a movement of a movement of 0 and a driving time. As shown in this figure, when the wafer cassette 4 which is the object to be transported is on board, the angular velocity is suppressed to a certain value and the driving time is determined, but when there is no wafer cassette 4, the maximum angular velocity that can be output by this driving system is set. By doing so, the startup time can be shortened.

【0028】図7は、キャリア3や第1の腕1a、1b
や第2の腕2a、2b等が障害物と接触した場合の保護
の実施例を示している。図7(a)は制御系の構成図
で、駆動モータ16aはドライバ31a、駆動モータ1
6bはドライバ31b、Z軸駆動モータ17はドライバ
31cと接続しているが、ドライバとモータの間に電流
測定器61a,61b,61cを接続する。電流測定器
61a,61b,61cで測定した電流値はCPU33
に送られ、メモリ62に記録された電流の制限値と比較
される。
FIG. 7 shows the carrier 3 and the first arms 1a and 1b.
An example of protection in the case where the second arm 2a, 2b or the like comes into contact with an obstacle is shown. FIG. 7A is a configuration diagram of a control system, in which a drive motor 16a includes a driver 31a and a drive motor 1
6b is connected to the driver 31b, and the Z-axis drive motor 17 is connected to the driver 31c. Current measuring devices 61a, 61b, 61c are connected between the driver and the motor. The current values measured by the current measuring devices 61a, 61b, 61c are
And compared with the current limit value recorded in the memory 62.

【0029】図7(b)は駆動モータ一系統について、
搬送の一周期の駆動時間とその時モータに流れる電流の
関係を表した図である。この駆動時の電流の実測値とメ
モリに記録された電流の制限値を比較し、電流の制限値
を超えたならば保護のプログラムを動作させ搬送装置を
停止させる。この駆動時の電流の実測値は、搬送装置の
設置場所の温度や搬送装置の駆動経過時間などによって
変化して行く。そのため電流の制限値を最適にする方法
として、一周期の駆動を数回繰り返し、その時のチャー
トの平均を取り、それにある係数を掛けて新たな電流の
制限のチャートにすることができる。これにより先に述
べたような温度や経時変化により誤動作しない保護が可
能になる。
FIG. 7B shows one system of the drive motor.
FIG. 4 is a diagram illustrating a relationship between a driving time of one cycle of conveyance and a current flowing through a motor at that time. The actual measured value of the current at the time of driving is compared with the current limit value recorded in the memory. If the current limit value is exceeded, the protection program is activated to stop the transport device. The actual measured value of the current at the time of driving changes depending on the temperature of the installation location of the transfer device, the elapsed drive time of the transfer device, and the like. Therefore, as a method of optimizing the current limit value, one cycle of driving is repeated several times, an average of the chart at that time is obtained, and a certain coefficient is multiplied to obtain a new current limit chart. This enables protection against malfunctions due to temperature and aging as described above.

【0030】図8は、駆動モータの位置検出器36に安
価なインクリメンタルエンコーダを使用し、高価なアブ
ソリュートエンコーダを使用した場合と同じ機能を持た
せるための実施例を示している。この図は駆動モータ一
系統のみを表しているが、実際には三系統ある。駆動モ
ータはモータ本体34、速度検出器35、負作動ブレー
キ71、位置検出器36で構成されている。ここで負作
動ブレーキ71は、ブレーキに電流を流している状態で
はブレーキが解除されており、電流を切断している状態
ではブレーキが制動状態になっている。位置検出器36
の位置信号38は、コントローラ32にフィードバック
されているだけではなく、CPU33を通り制御バス7
4を通してメモリ62に記録される。メモリ62は電池
73でバックアップされ、電源が切れてもメモリ62の
情報は消去されないようになっている。コントローラ3
2からドライバ72を通して負作動ブレーキ71を制御
している。いま搬送装置の電源が落ちた場合を考えてみ
る。電源が落ちた瞬間に負作動ブレーキ71が働き、モ
ータの軸を固定する。一方、メモリ62には電源が落ち
る直前の位置検出器36の位置信号38がメモリ62に
記録されている。つまり電源が落ちた瞬間のモータの機
械的な位置と、その時の位置検出器36の位置信号38
の関係が保存されているため、再び電源が入った時には
電源が落ちる直前の状態が再現できる。
FIG. 8 shows an embodiment in which an inexpensive incremental encoder is used for the position detector 36 of the drive motor and the same function as when an expensive absolute encoder is used. Although this diagram shows only one drive motor system, there are actually three systems. The drive motor includes a motor body 34, a speed detector 35, a negative operation brake 71, and a position detector 36. Here, the brake of the negative operation brake 71 is released when a current is flowing through the brake, and the brake is in a braking state when the current is cut off. Position detector 36
Is not only fed back to the controller 32 but also passes through the CPU 33 to the control bus 7.
4 is recorded in the memory 62. The memory 62 is backed up by a battery 73 so that information in the memory 62 is not erased even when the power is turned off. Controller 3
2 controls the negative operation brake 71 through the driver 72. Now, consider the case where the power supply of the transfer device is turned off. At the moment when the power is turned off, the negative operation brake 71 operates to fix the shaft of the motor. On the other hand, the position signal 38 of the position detector 36 immediately before the power is turned off is recorded in the memory 62. That is, the mechanical position of the motor at the moment when the power is turned off and the position signal 38 of the position detector 36 at that time.
Since the relationship is stored, the state immediately before the power is turned off can be reproduced when the power is turned on again.

【0031】[0031]

【表1】 [Table 1]

【0032】図9、図10、表1は、駆動モータの位置
検出器36に安価なインクリメンタルエンコーダを使用
しているが、図8に示すような対策を講じていない時の
原点復帰時間を短くするための実施例を示す。
FIGS. 9 and 10 and Table 1 show that although the inexpensive incremental encoder is used for the position detector 36 of the drive motor, the home return time when the countermeasure shown in FIG. 8 is not taken is shortened. An example for performing the above will be described.

【0033】図9は、搬送装置の断面図で、同軸の駆動
軸13aは第1の腕A1aと検出板A81aに結合さ
れ、同軸の駆動軸13bは第1の腕B1bと検出板B8
1bに結合されている。検出板A81aはセンサA82
aで位置を検出し、検出板B81bはセンサB82bで
位置を検出する。
FIG. 9 is a cross-sectional view of the transfer device, in which the coaxial drive shaft 13a is connected to the first arm A1a and the detection plate A81a, and the coaxial drive shaft 13b is connected to the first arm B1b and the detection plate B8.
1b. The detection plate A81a is a sensor A82.
The position is detected by a, and the detection plate B81b detects the position by the sensor B82b.

【0034】図10は搬送装置の平面図で、原点位置に
いる状態を表したものであり、図10(a)は図2
(b)と同じ状態である。図10(b)は図10(a)
の原点に停止している状態での平面図で検出板81とセ
ンサ82の関係を示したものである。検出板は半円形
で、原点位置で半円形の直径線とセンサの位置が一致す
るように構成している。ここで検出板の半円の円の中心
は検出板A81aと検出板B81bとでは一致してい
る。いま搬送装置が任意の位置で停止した場合、表1に
示すセンサのオンオフ状態にしたがって、駆動モータ1
6a、16bを動かすことにより短時間に原点に復帰で
きる。
FIG. 10 is a plan view of the transfer device, showing a state at the origin position. FIG.
This is the same state as (b). FIG. 10 (b) is the same as FIG.
3 shows the relationship between the detection plate 81 and the sensor 82 in a plan view in a state where the detection plate 81 is stopped at the origin. The detection plate is semicircular, and is configured such that the semicircular diameter line coincides with the position of the sensor at the origin position. Here, the center of the semicircle of the detection plate coincides with the detection plate A81a and the detection plate B81b. If the transport device stops at an arbitrary position, the drive motor 1 is turned on according to the on / off state of the sensor shown in Table 1.
By moving 6a and 16b, it is possible to return to the origin in a short time.

【0035】以上述べてきた実施の形態では、駆動モー
タにサーボモータを用いて述べてきたが、これらのモー
タはパルスモータに置き換えても同様の効果が得られ
る。
In the embodiments described above, the servo motors are used as drive motors. However, the same effects can be obtained by replacing these motors with pulse motors.

【0036】[0036]

【発明の効果】以上述べてきた搬送装置および搬送方法
を用いることによって、搬送装置の加速度を大きくする
ことができるので、搬送時間の短縮を図ることができ
た。また原点復帰時間を短くすることができるので、搬
送時間の短縮も含め全体の作業時間の短縮を図ることが
できた。
By using the transfer apparatus and the transfer method described above, the acceleration of the transfer apparatus can be increased, and the transfer time can be reduced. In addition, since the home return time can be shortened, the overall working time including the transport time can be shortened.

【0037】そして、キャリアや腕が障害物と接触して
もダメージを受けることが少ないので、メンテナンスの
停止時間を削減できると共に費用も削減できた。
Since the carrier and the arm are hardly damaged even if they come into contact with the obstacle, the maintenance stop time can be reduced and the cost can be reduced.

【0038】また、高価なアブソリュートエンコーダを
使用すること無く、安価なインクリメンタルエンコーダ
で同等の性能が出るので搬送装置の製造コストの削減に
貢献できた。
Further, since the same performance can be obtained with an inexpensive incremental encoder without using an expensive absolute encoder, it was possible to contribute to a reduction in the manufacturing cost of the transfer device.

【図面の簡単な説明】[Brief description of the drawings]

【図1】本発明の実施例である搬送装置の斜視図であ
る。
FIG. 1 is a perspective view of a transport device according to an embodiment of the present invention.

【図2】本発明を適用する搬送装置の平面図である。FIG. 2 is a plan view of a transfer device to which the present invention is applied.

【図3】本発明を適用する搬送装置の断面図である。FIG. 3 is a sectional view of a transfer device to which the present invention is applied.

【図4】本発明の搬送装置の制御系のブロック線図であ
る。
FIG. 4 is a block diagram of a control system of the transport device of the present invention.

【図5】本発明の駆動モータの同期を取る制御系のブロ
ック線図である。
FIG. 5 is a block diagram of a control system for synchronizing drive motors according to the present invention.

【図6】本発明の被搬送物の有無により加速度を変える
ための制御系のブロック線図(a)及び駆動軸の角速度
と駆動時間との関係を示す特性図(b)である。
6A and 6B are a block diagram of a control system for changing an acceleration depending on the presence or absence of a transferred object according to the present invention, and a characteristic diagram showing a relationship between an angular velocity of a driving shaft and a driving time.

【図7】本発明の駆動系保護のための制御系のブロック
線図(a)及びドライバ電流と駆動時間との関係を示す
特性図(b)である。
7A is a block diagram of a control system for protecting a drive system according to the present invention, and FIG. 7B is a characteristic diagram showing a relationship between a driver current and a drive time.

【図8】本発明のインクリメンタルエンコーダを用いた
制御系のブロック線図である。
FIG. 8 is a block diagram of a control system using the incremental encoder of the present invention.

【図9】本発明の原点復帰時間を短縮させるための搬送
装置の断面図である。
FIG. 9 is a cross-sectional view of a transport device for shortening the time required to return to the original position according to the present invention.

【図10】本発明の原点復帰時間を短縮させるための搬
送装置の説明図である。
FIG. 10 is an explanatory view of a transfer device for shortening the time required for returning to the original position according to the present invention.

【符号の説明】[Explanation of symbols]

1a,1b…第1の腕、2…第2の腕、3…キャリア、
4…ウェハカセット、5…軸心、6…a,6b軸受、7
…関節機構、8…直進方向、9…回転方向、10…上下
方向、11…第1の腕の回転方向、12a,12b…第
2の腕の回転方向、13a,13b…駆動軸、14…歯
車、15…歯車、16a,16b…駆動モータ、17…
Z軸駆動モータ、18…ボールネジ軸、19…ボールネ
ジナット、20…直進ガイド、31a,31b…ドライ
バ、32…コントローラ、33…CPU、34…モータ
本体、35…速度検出器、36…位置検出器、37…速
度信号、38…位置信号、39…零相信号、41…補正
コントローラ、42…補正信号、51…センサ、52…
A/D変換器、61…電流測定器、62…メモリ、71
…負作動ブレーキ、72…ドライバ、73…電池、74
…制御バス、81…検出板、82…センサ。
1a, 1b: first arm, 2: second arm, 3: carrier,
4 wafer cassette, 5 shaft center, 6 a, 6b bearing, 7
... joint mechanism, 8 ... straight direction, 9 ... rotation direction, 10 ... vertical direction, 11 ... rotation direction of first arm, 12a, 12b ... rotation direction of second arm, 13a, 13b ... drive shaft, 14 ... Gears, 15 ... Gears, 16a, 16b ... Drive motors, 17 ...
Z-axis drive motor, 18: Ball screw shaft, 19: Ball screw nut, 20: Straight guide, 31a, 31b: Driver, 32: Controller, 33: CPU, 34: Motor body, 35: Speed detector, 36: Position detector 37, speed signal, 38, position signal, 39, zero-phase signal, 41, correction controller, 42, correction signal, 51, sensor, 52,
A / D converter, 61: current measuring device, 62: memory, 71
... Negative operation brake, 72 ... Driver, 73 ... Battery, 74
... a control bus, 81 ... a detection plate, 82 ... a sensor.

フロントページの続き (72)発明者 藤本 勉 栃木県下都賀郡大平町大字富田800番地 株式会社日立製作所冷熱事業部内 (72)発明者 飯塚 清次 栃木県下都賀郡大平町大字富田800番地 株式会社日立製作所冷熱事業部内 (72)発明者 釜谷 弘直 栃木県下都賀郡大平町大字富田800番地 株式会社日立製作所冷熱事業部内 (72)発明者 杉山 和一 栃木県下都賀郡大平町富田709番地の2 株式会社日立栃木エレクトロニクス内Continued on the front page (72) Inventor, Tsutomu Fujimoto 800, Tomita, Ohira-machi, Shimotsuga-gun, Tochigi Pref.Hitachi, Ltd.Cooling Division, (72) Inventor Kiyoji Iizuka 800, Tomita, Ohira-cho, Shimotsuga-gun, Tochigi Hitachi, Ltd. Within the Cooling and Heating Business Division (72) Inventor Hironao Kamagai 800, Tomita, Odaicho, Shimotsuga-gun, Tochigi Prefecture Inside the Cooling and Heating Business Division Hitachi, Ltd. (72) Inventor Kazuichi Sugiyama 709-2, Tomita, Ohira-cho, Shimotsuga-gun, Tochigi In electronics

Claims (11)

【特許請求の範囲】[Claims] 【請求項1】二軸の駆動軸を同軸に配し、各々駆動軸の
同一側の一端には軸を回転させるための駆動系を持ち、
駆動軸の他端には軸と結合して駆動可能な一対の第1の
腕と、第1の腕の他端には第1の腕に対して駆動軸と直
角を成す平面で回転自在な構成からなる一対の第2の腕
を結合させ、そして第2の腕の他端には各々第2の腕の
開き角を同一にする機構を具備する関節と、各々関節の
回転中心軸で支持された被搬送物を載置するキャリアを
有し、前記キャリアを支持する関節部が駆動軸の回転中
心軸上を通過可能な搬送装置において、二軸の駆動軸を
回転させるための駆動系に二軸の回転の同期を取る手段
を設けたことを特徴とする搬送装置。
1. A drive system comprising: two drive shafts arranged coaxially; a drive system for rotating the shafts at one end on the same side of each drive shaft;
The other end of the drive shaft is a pair of first arms that can be driven by being connected to the shaft, and the other end of the first arm is rotatable on a plane perpendicular to the drive shaft with respect to the first arm. A pair of second arms having the same configuration, and the other end of the second arm is provided with a joint having a mechanism to make the opening angle of the second arm the same, and each is supported by the rotation center axis of the joint. In a transport device having a carrier on which the transported object is placed, and a joint that supports the carrier can pass on the rotation center axis of the drive shaft, a drive system for rotating the two drive shafts is provided. A transport device comprising means for synchronizing rotation of two axes.
【請求項2】二軸の駆動軸を同軸に配し、各々駆動軸の
同一側の一端には軸を回転させるための駆動系を持ち、
駆動軸の他端には軸と結合して駆動可能な一対の第1の
腕と、第1の腕の他端には第1の腕に対して駆動軸と直
角を成す平面で回転自在な構成からなる一対の第2の腕
を結合させ、そして第2の腕の他端には各々第2の腕の
開き角を同一にする機構を具備する関節と、各々関節の
回転中心軸で支持された被搬送物を載置するキャリアを
有し、前記キャリアを支持する関節部が駆動軸の回転中
心軸上を通過可能な搬送装置において、二軸の駆動軸を
回転させるための駆動系で二軸の回転の同期を取って制
御することを特徴とする搬送装置の制御方法。
2. A drive system comprising: two drive shafts arranged coaxially; a drive system for rotating the shafts at one end on the same side of each drive shaft;
The other end of the drive shaft is a pair of first arms that can be driven by being connected to the shaft, and the other end of the first arm is rotatable on a plane perpendicular to the drive shaft with respect to the first arm. A pair of second arms having the same configuration, and the other end of the second arm is provided with a joint having a mechanism to make the opening angle of the second arm the same, and each is supported by the rotation center axis of the joint. In a transport device having a carrier on which the transported object is placed, and a joint supporting the carrier can pass on the rotation center axis of the drive shaft, a drive system for rotating the two drive shafts is provided. A control method of a transport device, wherein the control is performed while synchronizing the rotation of two axes.
【請求項3】請求項1記載の搬送装置において、キャリ
アに被搬送物の有無を検出する手段を設け、あるいはキ
ャリアに被搬送物の質量を検出する手段を設け、前記検
出手段からの信号により駆動系の角速度または角加速
度、あるいは角速度と角加速度を変えて駆動する手段を
設けたことを特徴とする搬送装置。
3. The transport device according to claim 1, wherein a means for detecting the presence or absence of an object to be transported is provided on the carrier, or a means for detecting the mass of the object to be transported is provided on the carrier, and a signal from the detecting means is provided. A transport device comprising means for driving by changing the angular velocity or angular acceleration of the drive system, or the angular velocity and angular acceleration.
【請求項4】請求項1記載の搬送装置において、キャリ
アに被搬送物の有無を検出する手段を設け、あるいはキ
ャリアに被搬送物の質量を検出する手段を設け、前記検
出手段からの信号により駆動系の角速度または角加速
度、あるいは角速度と角加速度を変えて駆動する制御を
行うことを特徴とする搬送装置の制御方法。
4. The transfer device according to claim 1, wherein a means for detecting the presence or absence of an object to be transferred is provided on the carrier, or a means for detecting the mass of the object to be transferred is provided on the carrier, and a signal from the detection means is provided. A control method for a transport device, comprising: performing control of driving by changing an angular velocity or an angular acceleration of a drive system or an angular velocity and an angular acceleration.
【請求項5】請求項1記載の搬送装置において、駆動系
の駆動モータに供給する電流の検出手段およびその電流
値を記録する手段を設け、ある任意の時期に搬送装置を
駆動しその電流値を記録してその値を基準値とし、それ
以後の搬送装置の駆動時に電流値を検出して基準値と比
較し、基準値との比率が事前に設定された値から外れた
時は、異常な駆動状態が発生した場合と判定して予め定
められた処理を行う手段を設けたことを特徴とする搬送
装置。
5. The transfer device according to claim 1, further comprising means for detecting a current supplied to the drive motor of the drive system and means for recording the current value, and driving the transfer device at an arbitrary time to obtain the current value. Is recorded as a reference value, and the current value is detected and compared with the reference value when the transport device is driven thereafter, and when the ratio with the reference value deviates from a preset value, an abnormality is detected. And a means for performing a predetermined process by determining that an abnormal driving state has occurred.
【請求項6】請求項1記載の搬送装置において、駆動系
の駆動モータに供給する電流の検出手段およびその電流
値を記録する手段を設け、ある任意の時期に搬送装置を
駆動しその電流値を記録してその値を基準値とし、それ
以後の搬送装置の駆動時に電流値を検出して基準値と比
較し、基準値との比率が事前に設定された値から外れた
時は、異常な駆動状態が発生した場合と判定して予め定
められた処理を行うことを特徴とする搬送装置の制御方
法。
6. The transfer apparatus according to claim 1, further comprising means for detecting a current supplied to a drive motor of a drive system and means for recording the current value, and driving the transfer apparatus at an arbitrary time and controlling the current value. Is recorded as a reference value, and the current value is detected and compared with the reference value when the transport device is driven thereafter, and when the ratio with the reference value deviates from a preset value, an abnormality is detected. A control method for a transport device, comprising: determining that a special driving state has occurred; and performing a predetermined process.
【請求項7】請求項1記載の搬送装置において、駆動系
の駆動モータと結合されたブレーキおよびインクリメン
タルエンコーダを設け、ブレーキはモータ駆動時には解
除され、モータに電流が供給されない場合あるいは制御
装置の電源が遮断された場合には、ブレーキが作動して
モータおよびインクリメンタルエンコーダが動かない構
成とし、インクリメンタルエンコーダと接続したカウン
タには電源が供給されない場合でもカウントした値が消
去されないような手段を設け、このエンコーダの値を用
いてモータの制御をすることを特徴とする搬送装置の制
御方法。
7. The transfer device according to claim 1, further comprising a brake and an incremental encoder coupled to a drive motor of a drive system, wherein the brake is released when the motor is driven, and when no current is supplied to the motor or when a power supply of the control device is supplied. When the power supply is interrupted, the brake is activated and the motor and the incremental encoder do not move.The counter connected to the incremental encoder is provided with a means for preventing the counted value from being erased even when power is not supplied. A method for controlling a transport device, comprising controlling a motor using a value of an encoder.
【請求項8】請求項1記載の搬送装置において、駆動系
の駆動モータと結合されたブレーキおよびインクリメン
タルエンコーダを設け、ブレーキはモータ駆動時には解
除され、モータに電流が供給されない場合あるいは制御
装置の電源が遮断された場合には、ブレーキが作動して
モータおよびインクリメンタルエンコーダが動かない構
成とし、インクリメンタルエンコーダと接続したカウン
タには電源が供給されない場合でもカウントした値が消
去されないような手段を設け、このエンコーダの値を用
いてモータの制御をする手段を設けたことを特徴とする
搬送装置。
8. The transfer device according to claim 1, further comprising a brake and an incremental encoder coupled to a drive motor of a drive system, wherein the brake is released when the motor is driven, and when no current is supplied to the motor or a power supply of the control device. When the power supply is interrupted, the brake is activated and the motor and the incremental encoder do not move.The counter connected to the incremental encoder is provided with a means for preventing the counted value from being erased even when power is not supplied. A transport device comprising means for controlling a motor using a value of an encoder.
【請求項9】請求項1記載の搬送装置において、二軸の
駆動軸と第1の腕、第2の腕、関節部およびキャリアを
結合した一連の機構系を駆動する駆動モータ2個を具備
し、前記駆動モータ2個の回転でキャリアを駆動軸と直
角を成す平面上で駆動する構成とし、駆動モータ2個の
回転方向を同一方向または逆方向とすることにより、キ
ャリアは駆動軸と直角な平面内で駆動軸を原点とする円
の半径方向の動き、または回転方向の動きを行い、一
方、前記構成の機構系を駆動軸と平行方向に駆動可能な
機構系を駆動する駆動モータを具備し、キャリアは駆動
軸と直角な平面の法線方向の動きを行い、半径方向の動
き、回転方向の動き、および平面の法線方向の動きのそ
れぞれが独立に動くこと、または二つの動きが同時に起
こること、および三つの動きが同時に起こるように制御
することを特徴とする搬送装置の制御方法。
9. The transfer device according to claim 1, further comprising two drive motors for driving a series of mechanical systems in which the two drive shafts and the first arm, the second arm, the joint, and the carrier are connected. The carrier is driven on a plane perpendicular to the drive shaft by the rotation of the two drive motors, and the rotation of the two drive motors is set to the same direction or the opposite direction, so that the carrier is perpendicular to the drive shaft. A drive motor that drives a mechanical system capable of driving the mechanical system having the above-described configuration in a direction parallel to the drive shaft, while performing a radial movement or a rotational movement of a circle with the drive shaft as the origin within a simple plane. Equipped, the carrier performs a normal movement in a plane perpendicular to the drive shaft, the radial movement, the rotational movement, and the normal movement in the plane each move independently, or two movements Happen at the same time, and three The method of conveying apparatus movement of and controls to occur simultaneously.
【請求項10】請求項1記載の搬送装置において、第1
の腕Aを駆動する駆動軸にA検出板、第1の腕Bを駆動
する駆動軸にB検出板を設け、A検出板、B検出板は半
円の形状とし、かつそれぞれの検出板を検知するセンサ
を各一個づつ設け、搬送装置が異常停止した際に、A検
出板、B検出板ともセンサが感知しているならば第1の
腕Aを駆動する駆動軸を順方向に回転させ、かつ第1の
腕Bを駆動する駆動軸を逆方向に回転させ、またA検出
板、B検出板ともセンサが感知していないならば、第1
の腕Aを駆動する駆動軸を逆方向に回転させ、かつ第1
の腕Bを駆動する駆動軸を順方向に回転させ、またA検
出板のセンサが感知し、B検出板のセンサが感知してい
ないならば、第1の腕Aを駆動する駆動軸と第1の腕B
を駆動する駆動軸を共に順方向に回転させ、またA検出
板のセンサが感知していないで、B検出板のセンサが感
知しているらば、第1の腕Aを駆動する駆動軸と第1の
腕Bを駆動する駆動軸を共に逆方向に回転させ、それぞ
れのセンサの状態が反転した時駆動軸を停止させること
により原点位置に復帰させる制御を行う手段を設けたこ
とをことを特徴とする搬送装置。
10. The transfer device according to claim 1, wherein
A detection plate is provided on the drive shaft for driving the arm A, and a B detection plate is provided on the drive shaft for driving the first arm B. The A detection plate and the B detection plate have a semicircular shape, and each detection plate is If one sensor is provided for each detection, and the A detection plate and the B detection plate both sense the sensor when the transport device stops abnormally, the drive shaft for driving the first arm A is rotated in the forward direction. And the drive shaft for driving the first arm B is rotated in the opposite direction. If neither the A detection plate nor the B detection plate has detected the sensor, the first
The drive shaft for driving the arm A of the first
The drive shaft for driving the first arm A is rotated by rotating the drive shaft for driving the arm B in the forward direction, and if the sensor on the A detection plate senses and the sensor on the B detection plate does not sense. One arm B
And the drive shaft for driving the first arm A, if the sensor of the B detection plate does not sense and the sensor of the B detection plate senses, A means for rotating the drive shaft for driving the first arm B in the opposite direction and stopping the drive shaft when the state of each sensor is reversed to return to the home position is provided. Characteristic transport device.
【請求項11】請求項1記載の搬送装置において、第1
の腕Aを駆動する駆動軸にA検出板、第1の腕Bを駆動
する駆動軸にB検出板を設け、A検出板、B検出板は半
円の形状とし、かつそれぞれの検出板を検知するセンサ
を各一個づつ設け、搬送装置が異常停止した際に、A検
出板、B検出板ともセンサが感知しているならば第1の
腕Aを駆動する駆動軸を順方向に回転させ、かつ第1の
腕Bを駆動する駆動軸を逆方向に回転させ、またA検出
板、B検出板ともセンサが感知していないならば、第1
の腕Aを駆動する駆動軸を逆方向に回転させ、かつ第1
の腕Bを駆動する駆動軸を順方向に回転させ、またA検
出板のセンサが感知し、B検出板のセンサが感知してい
ないならば、第1の腕Aを駆動する駆動軸と第1の腕B
を駆動する駆動軸を共に順方向に回転させ、またA検出
板のセンサが感知していないで、B検出板のセンサが感
知しているらば、第1の腕Aを駆動する駆動軸と第1の
腕Bを駆動する駆動軸を共に逆方向に回転させ、それぞ
れのセンサの状態が反転した時駆動軸を停止させること
により原点位置に復帰させる制御を行うことを特徴とす
る搬送装置の制御方法。
11. The transfer device according to claim 1, wherein
A detection plate is provided on the drive shaft for driving the arm A, and a B detection plate is provided on the drive shaft for driving the first arm B. The A detection plate and the B detection plate have a semicircular shape, and each detection plate is If one sensor is provided for each detection, and the A detection plate and the B detection plate both sense the sensor when the transport device stops abnormally, the drive shaft for driving the first arm A is rotated in the forward direction. And the drive shaft for driving the first arm B is rotated in the opposite direction. If neither the A detection plate nor the B detection plate has detected the sensor, the first
The drive shaft for driving the arm A of the first
The drive shaft for driving the first arm A is rotated by rotating the drive shaft for driving the arm B in the forward direction, and if the sensor on the A detection plate senses and the sensor on the B detection plate does not sense. One arm B
And the drive shaft for driving the first arm A, if the sensor of the B detection plate does not sense and the sensor of the B detection plate senses, A transport device, comprising: rotating a drive shaft for driving the first arm B in the opposite direction, and performing control to return to the origin position by stopping the drive shaft when the state of each sensor is reversed. Control method.
JP33146797A 1997-12-02 1997-12-02 Conveying device and its control method Pending JPH11156768A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP33146797A JPH11156768A (en) 1997-12-02 1997-12-02 Conveying device and its control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP33146797A JPH11156768A (en) 1997-12-02 1997-12-02 Conveying device and its control method

Publications (1)

Publication Number Publication Date
JPH11156768A true JPH11156768A (en) 1999-06-15

Family

ID=18243980

Family Applications (1)

Application Number Title Priority Date Filing Date
JP33146797A Pending JPH11156768A (en) 1997-12-02 1997-12-02 Conveying device and its control method

Country Status (1)

Country Link
JP (1) JPH11156768A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013066987A (en) * 2011-09-26 2013-04-18 Nikon Corp Abnormal condition determining apparatus, driving device, and robot apparatus
CN107081757A (en) * 2017-05-17 2017-08-22 成都瑞迪机械科技有限公司 Control system for robot palletizer
KR20190050481A (en) * 2017-11-03 2019-05-13 주식회사 싸이맥스 Wafer transfer apparatus for reading a scale formed on a shaft through an encoder and detecting the position

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013066987A (en) * 2011-09-26 2013-04-18 Nikon Corp Abnormal condition determining apparatus, driving device, and robot apparatus
CN107081757A (en) * 2017-05-17 2017-08-22 成都瑞迪机械科技有限公司 Control system for robot palletizer
KR20190050481A (en) * 2017-11-03 2019-05-13 주식회사 싸이맥스 Wafer transfer apparatus for reading a scale formed on a shaft through an encoder and detecting the position

Similar Documents

Publication Publication Date Title
US6047812A (en) Asynchronous soft conveyor system
JPH02282970A (en) Mechanical detection of contact in control system
US5834917A (en) Robot controller
JPH11156768A (en) Conveying device and its control method
JP3370845B2 (en) Absolute encoder
JP5092267B2 (en) Motor drive device and emergency stop method thereof
KR100404153B1 (en) Position control method of convey driving unit and position control system
JP2005176493A (en) Emergency stop method for motor driving device
JP2580757B2 (en) Wafer transfer device and origin return method thereof
JPS63162179A (en) Precision fitting method
JP4385404B2 (en) Motor drive device and method for emergency stop of motor drive device
JPH0425386A (en) Control method for industrial robot
JPS6263093A (en) Method of detecting work
JP2649381B2 (en) Teaching method of rotating linear unit
JP3855629B2 (en) Robot interference detection device
JP2667080B2 (en) Transfer control device
JPS58196986A (en) Industrial robot
JP2834055B2 (en) Wafer transfer device in vacuum processing chamber
JP2000005977A (en) Controller for machine tool
JP2576956B2 (en) Industrial robot rotation angle detector
KR0175556B1 (en) Method and apparatus for variable controlling work space in the horizontal mutli-joint robot
KR0176508B1 (en) A control system of a brake-mounted motor
JPS6066680A (en) Abnormality detecting circuit of motor drive controller
JPH01183388A (en) Robot moving device
JPH11170122A (en) Positioning control device