JP2021022643A5 - - Google Patents
Download PDFInfo
- Publication number
- JP2021022643A5 JP2021022643A5 JP2019137804A JP2019137804A JP2021022643A5 JP 2021022643 A5 JP2021022643 A5 JP 2021022643A5 JP 2019137804 A JP2019137804 A JP 2019137804A JP 2019137804 A JP2019137804 A JP 2019137804A JP 2021022643 A5 JP2021022643 A5 JP 2021022643A5
- Authority
- JP
- Japan
- Prior art keywords
- work
- hand
- hands
- robot
- detection sensor
- 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.)
- Granted
Links
- 210000004247 hand Anatomy 0.000 description 27
- 238000003708 edge detection Methods 0.000 description 15
- 238000001514 detection method Methods 0.000 description 11
- 230000033001 locomotion Effects 0.000 description 11
- 210000000707 wrist Anatomy 0.000 description 11
- 230000003028 elevating effect Effects 0.000 description 3
- 238000005452 bending Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
Description
本発明のワーク位置検出方法では、ハンドごとの多関節機構を共通軸において本体に取り付けるようにした上で、第1方向に沿って後退しているときのハンドの手首軸からみて共通軸の位置よりも前進方向の位置でエッジ検出センサを本体に取り付けることが好ましい。この構成によれば、ハンドが後退位置にあるときにエッジ検出センサによってワークの辺を検出可能にしつつ、手首軸とエッジ検出センサとの距離を十分とることができて検出対象ではないワークを保持するハンドを手首軸の周りでの回転させるときの回転角を小さくすることができる。 In the work position detection method of the present invention, the articulated mechanism for each hand is attached to the main body on a common axis, and then the position of the common axis as viewed from the wrist axis of the hand when retracting along the first direction. It is preferable to attach the edge detection sensor to the main body at a position in the forward direction. According to this configuration, the edge detection sensor can detect the side of the work when the hand is in the retracted position, and the work that is not the detection target can be held by keeping a sufficient distance between the wrist axis and the edge detection sensor. The angle of rotation when rotating the hand around the wrist axis can be reduced.
ハンド13A,13Bは、下から保持することによって板状のワーク50を水平状態に保ったまま搬送できるように、複数の棒状部材を平行に配置したフォーク状の形状となっている。ワーク50を保持する状態で、ハンド13A,13Bは、第2アーム12A,12Bとの接続位置である根元側を除いてハンド13A,13Bの全体がワーク50によって覆われる。ハンド13A,13Bは、ロードロック室などに収納されているワーク50を取り出してハンド13A,13B上に保持したり、保持しているワーク50をロードロック室内などに収納するときにワーク50に対して前進または後退するが、このハンド13A,13Bの前進したり後退する方向は、棒状部材の延びる方向と平行な方向とされる。ハンド13A,13Bの左右方向すなわち前後方向に直交する方向での幅は、搬送対象のワーク50の左右方向の幅よりも短くなっている。 The hands 13A and 13B have a fork-like shape in which a plurality of rod-shaped members are arranged in parallel so that the plate-shaped work 50 can be conveyed while being held in a horizontal state by holding the hands 13A and 13B from below. In the state of holding the work 50, the hands 13A and 13B are entirely covered by the work 50 except for the root side which is the connection position with the second arms 12A and 12B. The hands 13A and 13B are used with respect to the work 50 when the work 50 stored in the load lock chamber or the like is taken out and held on the hands 13A or 13B, or when the held work 50 is stored in the load lock chamber or the like. The forward or backward direction of the hands 13A and 13B is parallel to the extending direction of the rod-shaped member. The width of the hands 13A and 13B in the left-right direction, that is, in the direction orthogonal to the front-back direction is shorter than the width in the left-right direction of the work 50 to be conveyed.
このロボットにおいて水平多関節機構は、第1アーム11A,11Bと第2アーム12A,12Bとに組み込まれたリンク機構により、支持部26が延びる方向とは直交する方向で直線運動でハンド13A,13Bが前進及び後退運動を行うように構成されている。すなわち両方のハンド13A,13Bは同一方向に前進及び後退を行う。共通軸32に対してハンド13A,13Bの先端が遠ざかる動きが前進運動であり、前進運動とは反対方向の動きが後退運動である。第1アーム11A,11Bと第2アーム12A,12Bとは全体して屈曲運動を行い、それにも関わらず水平面内でのハンド13A,13Bの向きを一定とするために、ハンド13A,13Bは、それぞれ、第2アーム12A,12Bの先端の位置で手首軸34A,34Bの周りで水平面内を回転可能に取り付けられている。上側の水平多関節機構は、支持部26に設けられたモータ(不図示)が駆動されることによって、第1アーム11A及び第2アーム12Aが動き、ハンド13Aはその向きを保ったまま、支持部26の延びる方向とは直交する方向に移動する。同様に下側の水平多関節機構は、支持部26に設けられたモータ(不図示)が駆動されることによって、第1アーム11B及び第2アーム12Bが動き、ハンド13Bはその向きを保ったまま、支持部26の延びる方向とは直交する方向に移動する。このロボットでは、ハンド13Aとハンド13Bとを独立して移動させることができ、これらの移動の途中で手首軸34Aと手首軸34Bとが上下方向に正確に整列する、すなわちハンド13Aとハンド13Bとが相互に上下方向に正確に重なり合うことができるようになっている。 In this robot, the horizontal articulated mechanism is a link mechanism incorporated in the first arms 11A and 11B and the second arms 12A and 12B, and the hands 13A and 13B are linearly moved in a direction orthogonal to the direction in which the support portion 26 extends. Is configured to perform forward and backward movements. That is, both hands 13A and 13B move forward and backward in the same direction. The movement in which the tips of the hands 13A and 13B move away from the common axis 32 is the forward movement, and the movement in the direction opposite to the forward movement is the backward movement. The first arms 11A and 11B and the second arms 12A and 12B perform bending motions as a whole, and nevertheless, in order to keep the directions of the hands 13A and 13B in the horizontal plane constant, the hands 13A and 13B are used. They are rotatably attached in the horizontal plane around the wrist shafts 34A and 34B at the positions of the tips of the second arms 12A and 12B, respectively. In the upper horizontal articulated mechanism, the first arm 11A and the second arm 12A move by driving a motor (not shown) provided in the support portion 26, and the hand 13A supports the hand 13A while maintaining its orientation. The portion 26 moves in a direction orthogonal to the extending direction. Similarly, in the lower horizontal articulated mechanism, the first arm 11B and the second arm 12B move by driving a motor (not shown) provided on the support portion 26, and the hand 13B keeps its orientation. As it is, it moves in a direction orthogonal to the extending direction of the support portion 26. In this robot, the hand 13A and the hand 13B can be moved independently, and the wrist shaft 34A and the wrist shaft 34B are accurately aligned in the vertical direction during these movements, that is, the hand 13A and the hand 13B. Can overlap each other exactly in the vertical direction.
さらにロボットには、水平多関節機構が取り付けられている支持部26に対しては静止している位置であって、ハンド13A,13Bにワーク50が保持されている状態であればハンド13A,13Bの前進後退運動によってワーク50の縦方向辺が通過する位置に、例えば遮光センサからなるエッジ検出センサ28が設けられている。ここに示す例では、エッジ検出センサ28は、昇降機構24の移動部24Bに取り付けられている。エッジ検出センサ28は、ハンド13A,13B上におけるワーク50の載置位置の左右方向におけるずれを検出するものであり、ワーク50の縦方向辺についてその左右方向における位置を検出する例えば一次元センサによって構成されている。エッジ検出センサ28はコの字形の外形を有し、コの字による開口部を検出空間として、この検出空間内にワーク50が入り込んだ時にワーク50の縦方向辺を検出する。エッジ検出センサ28は、両方のハンド13A,13Bによって保持されるワーク50に共通に設けられている。本実施形態のロボットでは上下方向におけるハンド13A,13B間の間隔は一定であり、エッジ検出センサ28の開口部の開口幅は、このハンド13A,13B間の間隔よりも大きく、両方のハンド13A,13Bがいずれもワーク50を搭載しているときにワーク50が通過可能なようになっている。本実施形態のロボットは搬送用のロボットであってハンド13A,13Bを前進させることによりロードロック室などからワーク50を取り出し、またロードロック室にワーク50を収納するものであるから、ハンド13A,13Bを前進させた状態ではワーク50は検出空間から離れ、ハンド13A,13Bを後退させた状態でワーク50が検出空間に入り込むこととなる。 Further, if the robot is in a stationary position with respect to the support portion 26 to which the horizontal articulated mechanism is attached and the work 50 is held by the hands 13A and 13B, the hands 13A and 13B An edge detection sensor 28 made of, for example, a light-shielding sensor is provided at a position where the vertical side of the work 50 passes by the forward / backward movement of the work 50. In the example shown here, the edge detection sensor 28 is attached to the moving portion 24B of the elevating mechanism 24. The edge detection sensor 28 detects the deviation of the mounting position of the work 50 on the hands 13A and 13B in the left-right direction, and detects the position of the vertical side of the work 50 in the left-right direction, for example, by a one-dimensional sensor. It is configured. The edge detection sensor 28 has a U-shaped outer shape , and the U-shaped opening is used as a detection space, and when the work 50 enters the detection space, the vertical side of the work 50 is detected. The edge detection sensor 28 is commonly provided on the work 50 held by both hands 13A and 13B. In the robot of the present embodiment, the distance between the hands 13A and 13B in the vertical direction is constant, and the opening width of the opening of the edge detection sensor 28 is larger than the distance between the hands 13A and 13B. The work 50 can pass through when the work 50 is mounted on any of the 13Bs. Since the robot of the present embodiment is a transport robot and moves the hands 13A and 13B forward to take out the work 50 from the load lock chamber and the like, and stores the work 50 in the load lock chamber, the hands 13A and 13A, When the 13B is advanced, the work 50 is separated from the detection space, and when the hands 13A and 13B are retracted, the work 50 enters the detection space.
次に、ロボットにおけるエッジ検出センサ28の位置について説明する。ハンド13A,13Bが取り付けられている水平多関節機構が上下方向に昇降する場合、ハンド13A,13Bがどの高さにあってもワーク50のエッジを検出できることが好ましいから、ロボットにおいて水平多関節機構とともに昇降する位置にエッジ検出センサ28が設けられていることが好ましい。搬送用のロボットでは、ロボット全体が水平面上を平行移動しているときに周囲の物体に対してワーク50やハンド13A,13Bが衝突することを避けるために、平行移動を行っているときはハンド13A,13Bは後退状態とされる。ワーク50の縦方向辺の検出もハンド13A,13Bが後退状態にあるときに行うことが好ましい。また、検出対象以外のワークを保持しているハンドをその手首軸の周りで回転させるときは、回転量が小さい方が好ましい。回転量を小さくする観点からは、ハンドが後退状態にあるときの手首軸の位置からできるだけ遠方にエッジ検出センサ28が取り付けられていることが好ましいことになる。例えば、後退状態にあるハンド13A,13Bの手首軸34A,34Bから見て、支持部26における水平多関節機構の取り付け位置である共通軸32の位置よりも前進方向側の位置でエッジ検出センサがロボットに取り付けられていることが好ましい。 Next, the position of the edge detection sensor 28 in the robot will be described. When the horizontal articulated mechanism to which the hands 13A and 13B are attached moves up and down, it is preferable that the edge of the work 50 can be detected regardless of the height of the hands 13A and 13B. It is preferable that the edge detection sensor 28 is provided at a position where it moves up and down together with the mechanism. In the transport robot, in order to prevent the work 50 and the hands 13A and 13B from colliding with surrounding objects when the entire robot is moving in parallel on the horizontal plane, the hand is moving in parallel. 13A and 13B are in the retracted state. It is preferable that the detection of the vertical side of the work 50 is also performed when the hands 13A and 13B are in the retracted state. Further, when rotating a hand holding a work other than the detection target around the wrist axis, it is preferable that the amount of rotation is small. From the viewpoint of reducing the amount of rotation, it is preferable that the edge detection sensor 28 is attached as far as possible from the position of the wrist axis when the hand is in the retracted state. For example, when viewed from the wrist shafts 34A and 34B of the hands 13A and 13B in the retracted state, the edge detection sensor is located at a position on the forward direction side from the position of the common shaft 32 which is the mounting position of the horizontal articulated mechanism on the support portion 26. It is preferably attached to the robot.
次に、本実施形態のロボットがロードロック室あるいはカセットなどに収納されているワーク50を取り出してハンド13B上に保持する動作について説明する。このときすでにハンド13Aは後退状態にあって別のワークを保持しているものとする。ハンド13Bはワーク50を保持せずに後退状態にあるものとする。ロボットは、レール21に沿って対象のロードロック室の前まで移動し、昇降機構24によりハンド13Bの高さをロードロック室の高さに合わせる。そして、アーム11B,12Bが駆動されてハンド13Bは前進し、ロードロック室に収納されているワーク50の下方の位置までロードロック室の内部に進入する。この状態で昇降機構24によりハンド13Bを上昇させるとワーク50がハンド13B上に載置されることになる。このとき、ハンド13Bに設けられた1対のセンサ27によってワーク50の横方向辺を検出し、横方向辺の位置がハンド13Bでの基準位置に一致するように、ハンド13Bの前進量を制御する。1対のセンサ27の検出結果から、傾斜角を求めることができる。理想的には傾斜角はゼロであるべきであるので、1対のセンサ27によって検出される傾斜角がゼロとなるように手首軸34Bの周りでハンド13Bを回転させることによって、ワーク50は、その横方向辺とハンド13Bの左右方向とが一致するようにハンド13B上に載置されることになる。ハンド13B上にワーク50を載置するときに傾斜角を補正すれば、ワーク50の縦方向辺の向きとハンド13Bの前後方向とが一致しているので、後述するように左右方向でのワーク50の位置の補償を行うときの計算が簡単なものとなる。 Next, an operation in which the robot of the present embodiment takes out the work 50 stored in the load lock chamber or the cassette and holds it on the hand 13B will be described. At this time, it is assumed that the hand 13A is already in the retracted state and holds another work. It is assumed that the hand 13B is in the retracted state without holding the work 50. The robot moves along the rail 21 to the front of the target load lock chamber, and the height of the hand 13B is adjusted to the height of the load lock chamber by the elevating mechanism 24. Then, the arms 11B and 12B are driven, and the hand 13B moves forward and enters the inside of the load lock chamber to a position below the work 50 housed in the load lock chamber. If the hand 13B is raised by the elevating mechanism 24 in this state, the work 50 will be placed on the hand 13B. At this time, a pair of sensors 27 provided on the hand 13B detects the lateral side of the work 50, and controls the amount of advance of the hand 13B so that the position of the lateral side matches the reference position on the hand 13B. do. The tilt angle can be obtained from the detection results of the pair of sensors 27. Ideally, the tilt angle should be zero, so by rotating the hand 13B around the wrist axis 34B so that the tilt angle detected by the pair of sensors 27 is zero, the work 50 It will be placed on the hand 13B so that the lateral side thereof and the left-right direction of the hand 13B coincide with each other. If the tilt angle is corrected when the work 50 is placed on the hand 13B, the direction of the vertical side of the work 50 and the front-back direction of the hand 13B are the same. The calculation when compensating for the position of 50 becomes simple.
ロードロック室内でハンド13B上にワーク50が載置されたら、アーム11B,12Bが駆動されてハンド13Bは後退し、後退状態となる。このとき、エッジ検出センサ28の検出空間には、ハンド13A,13Bにそれぞれ載置されているワーク50が入り込んでいる。新たに載置されたワークであるハンド13B上のワーク50における左右方向の位置を決定する必要があるから、上述したようにハンド13Aをその手首軸34Aの周りで回転させてハンド13A上のワーク50を検出空間から退出させ、エッジ検出センサ28によってハンド13B上のワークの縦方向辺の位置を検出する。検出された縦方向辺の位置から、ハンド13Bにおける左右方向でのワーク50のずれ量が決定される。このずれ量に基づいて、ロボットがワーク50をレール21に沿って別のロードロック室まで平行移動により搬送する移動量を定めることにより、搬送先のロードロック室に対して正確にワーク50を格納できるようになる。なお、傾斜角を補正しない状態でワーク50の搬送先までロボットが平行移動する場合には、ロボットの移動量の算出に際して傾斜角の影響を考慮する必要がある。
When the work 50 is placed on the hand 13B in the load lock chamber, the arms 11B and 12B are driven and the hand 13B retracts to a retracted state. At this time, the work 50 placed on the hands 13A and 13B, respectively, has entered the detection space of the edge detection sensor 28. Since it is necessary to determine the position in the left-right direction of the work 50 on the hand 13B, which is a newly placed work, the hand 13A is rotated around the wrist shaft 34A as described above, and the work on the hand 13A is rotated. 50 is moved out of the detection space, and the position of the vertical side of the work on the hand 13B is detected by the edge detection sensor 28. From the position of the detected vertical side, the amount of displacement of the work 50 in the left-right direction in the hand 13B is determined. Based on this amount of deviation, the robot determines the amount of movement of the work 50 by translation along the rail 21 to another load lock chamber, so that the work 50 can be accurately transferred to the destination load lock chamber. It will be possible to store it. When the robot moves in parallel to the transfer destination of the work 50 without correcting the tilt angle, it is necessary to consider the influence of the tilt angle when calculating the movement amount of the robot.
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019137804A JP7303686B2 (en) | 2019-07-26 | 2019-07-26 | Work position detection method for robots |
CN202010703131.1A CN112297036B (en) | 2019-07-26 | 2020-07-21 | Workpiece position detection method in robot |
TW109124800A TWI718081B (en) | 2019-07-26 | 2020-07-22 | Workpiece position detection method in robot |
KR1020200091562A KR102386597B1 (en) | 2019-07-26 | 2020-07-23 | Method for detecting work position of robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019137804A JP7303686B2 (en) | 2019-07-26 | 2019-07-26 | Work position detection method for robots |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2021022643A JP2021022643A (en) | 2021-02-18 |
JP2021022643A5 true JP2021022643A5 (en) | 2022-07-13 |
JP7303686B2 JP7303686B2 (en) | 2023-07-05 |
Family
ID=74483551
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019137804A Active JP7303686B2 (en) | 2019-07-26 | 2019-07-26 | Work position detection method for robots |
Country Status (4)
Country | Link |
---|---|
JP (1) | JP7303686B2 (en) |
KR (1) | KR102386597B1 (en) |
CN (1) | CN112297036B (en) |
TW (1) | TWI718081B (en) |
Family Cites Families (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000071187A (en) * | 1998-08-27 | 2000-03-07 | Komatsu Ltd | Workpiece carrying robot |
JP3339840B2 (en) * | 1999-09-28 | 2002-10-28 | タツモ株式会社 | Horizontal articulated industrial robot and control method thereof |
JP3955499B2 (en) | 2001-08-07 | 2007-08-08 | 日本電産サンキョー株式会社 | Hand positioning method and apparatus |
TW550651B (en) * | 2001-08-08 | 2003-09-01 | Tokyo Electron Ltd | Substrate conveying apparatus, substrate processing system, and substrate conveying method |
DE112004001210T5 (en) * | 2003-07-04 | 2006-06-08 | Rorze Corp. | Transport device and transport control method for a thin plate |
JP2005193303A (en) * | 2003-12-26 | 2005-07-21 | Mitsubishi Heavy Ind Ltd | Substrate transporting device |
US20060216137A1 (en) * | 2004-07-02 | 2006-09-28 | Katsunori Sakata | Carrying apparatus and carrying control method for sheet-like substrate |
JP2008135630A (en) * | 2006-11-29 | 2008-06-12 | Jel:Kk | Substrate conveying device |
JP5146641B2 (en) * | 2007-06-06 | 2013-02-20 | 株式会社安川電機 | Substrate transfer robot and control method of substrate transfer robot |
KR101502130B1 (en) * | 2008-07-10 | 2015-03-13 | 주식회사 원익아이피에스 | Transfer apparatus, Transfer chamber having the same and vacuum processing system including the same |
US8958907B2 (en) * | 2011-03-31 | 2015-02-17 | Sinfonia Technology Co., Ltd. | Robot arm apparatus |
JP5664570B2 (en) * | 2012-02-09 | 2015-02-04 | 東京エレクトロン株式会社 | Substrate processing apparatus and substrate processing method |
JP5532110B2 (en) * | 2012-11-16 | 2014-06-25 | 株式会社安川電機 | Substrate transfer robot and substrate transfer method |
KR102181121B1 (en) * | 2016-09-20 | 2020-11-20 | 주식회사 원익아이피에스 | Substrate transfer apparatus and control method of substrate transfer apparatus |
JP6593316B2 (en) * | 2016-12-15 | 2019-10-23 | 株式会社ダイフク | Goods transport vehicle |
JP7023094B2 (en) * | 2017-12-05 | 2022-02-21 | 日本電産サンキョー株式会社 | robot |
-
2019
- 2019-07-26 JP JP2019137804A patent/JP7303686B2/en active Active
-
2020
- 2020-07-21 CN CN202010703131.1A patent/CN112297036B/en active Active
- 2020-07-22 TW TW109124800A patent/TWI718081B/en active
- 2020-07-23 KR KR1020200091562A patent/KR102386597B1/en active IP Right Grant
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101570574B1 (en) | Substrate transfer robot and substrate transfer method | |
KR101421351B1 (en) | Parallel robot | |
CN107428463B (en) | Load storage device | |
US7905699B2 (en) | Transfer robot, transfer method, and control method | |
CN109834710B (en) | Robot and robot system | |
JP2010162635A (en) | Method for correcting position and attitude of self-advancing robot | |
WO2016125752A1 (en) | Substrate transfer robot and substrate transfer method | |
CN108217537B (en) | Article transport vehicle | |
TWI684500B (en) | Robot diagnosis method | |
JP2007283436A (en) | Robot, robot system, and attitude control method of hand device | |
JP2019166657A5 (en) | ||
JP6924112B2 (en) | A method for obtaining the positional relationship between the board transfer device and the board transfer robot and the board mounting portion. | |
JP4506255B2 (en) | Wafer position teaching method and robot thereof | |
TW201314827A (en) | Carrying vehicle | |
JP2021022643A5 (en) | ||
JP5590411B2 (en) | Stacker crane | |
JP2010152618A (en) | Robot, and method of calibrating straight movement start position to teaching position for robot | |
KR102213545B1 (en) | Method of calculating correcting value of industrial robot | |
KR102209497B1 (en) | Method of calculating correction value of industrial robot | |
JP7303686B2 (en) | Work position detection method for robots | |
JP5118896B2 (en) | Transfer robot system | |
JP6923688B2 (en) | Robots and robot systems | |
CN111052337B (en) | Diagnostic method for robot | |
JP5665417B2 (en) | Industrial robot | |
KR101331368B1 (en) | Substrate transferring robot having function of correcting meandering and method for correcting meandering thereof |