Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP7303686B2 - Work position detection method for robots - Google Patents
[go: Go Back, main page]

JP7303686B2 - Work position detection method for robots - Google Patents

Work position detection method for robots Download PDF

Info

Publication number
JP7303686B2
JP7303686B2 JP2019137804A JP2019137804A JP7303686B2 JP 7303686 B2 JP7303686 B2 JP 7303686B2 JP 2019137804 A JP2019137804 A JP 2019137804A JP 2019137804 A JP2019137804 A JP 2019137804A JP 7303686 B2 JP7303686 B2 JP 7303686B2
Authority
JP
Japan
Prior art keywords
hand
work
workpiece
hands
robot
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2019137804A
Other languages
Japanese (ja)
Other versions
JP2021022643A5 (en
JP2021022643A (en
Inventor
典彦 瀧澤
康一 戸崎
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.)
Nidec Instruments Corp
Original Assignee
Nidec Instruments Corp
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 Nidec Instruments Corp filed Critical Nidec Instruments Corp
Priority to JP2019137804A priority Critical patent/JP7303686B2/en
Priority to CN202010703131.1A priority patent/CN112297036B/en
Priority to TW109124800A priority patent/TWI718081B/en
Priority to KR1020200091562A priority patent/KR102386597B1/en
Publication of JP2021022643A publication Critical patent/JP2021022643A/en
Publication of JP2021022643A5 publication Critical patent/JP2021022643A5/ja
Application granted granted Critical
Publication of JP7303686B2 publication Critical patent/JP7303686B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Program-controlled manipulators
    • B25J9/16Program controls
    • B25J9/1674Program controls characterised by safety, monitoring, diagnostic
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/088Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/087Controls for manipulators by means of sensing devices, e.g. viewing or touching devices for sensing other physical parameters, e.g. electrical or chemical properties
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Program-controlled manipulators
    • B25J9/02Program-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/04Program-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
    • B25J9/041Cylindrical coordinate type
    • B25J9/042Cylindrical coordinate type comprising an articulated arm
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Program-controlled manipulators
    • B25J9/16Program controls
    • B25J9/1612Program controls characterised by the hand, wrist, grip control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Program-controlled manipulators
    • B25J9/16Program controls
    • B25J9/1679Program controls characterised by the tasks executed
    • HELECTRICITY
    • H10SEMICONDUCTOR DEVICES; ELECTRIC SOLID-STATE DEVICES NOT OTHERWISE PROVIDED FOR
    • H10PGENERIC PROCESSES OR APPARATUS FOR THE MANUFACTURE OR TREATMENT OF DEVICES COVERED BY CLASS H10
    • H10P72/00Handling or holding of wafers, substrates or devices during manufacture or treatment thereof
    • H10P72/50Handling or holding of wafers, substrates or devices during manufacture or treatment thereof for positioning, orientation or alignment

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Health & Medical Sciences (AREA)
  • General Health & Medical Sciences (AREA)
  • Orthopedic Medicine & Surgery (AREA)
  • Manipulator (AREA)
  • Container, Conveyance, Adherence, Positioning, Of Wafer (AREA)

Description

本発明は、液晶表示パネル用のガラス基板などの板状のワークの搬送に用いられるロボットに関し、特に、ロボットのハンド上でのワークの位置を検出する方法に関する。 The present invention relates to a robot used for transporting a plate-shaped work such as a glass substrate for a liquid crystal display panel, and more particularly to a method for detecting the position of the work on the hand of the robot.

液晶表示装置の製造ラインなどでは、異なる処理装置などの間でロボットを使用して基板などのワークを搬送する。その場合、ワークの搬送は、搬入元となる処理装置のロードロック室やカセットに対してロボットのハンドを差し込んでそのハンドの上にワークを保持し、ロードロック室などからワークを載せたハンドを引き出し、ハンドにワークを載せたままロボットのアームあるいはロボット全体を移動させ、次いで、搬入先となる処理装置のロードロック室にハンドを差し入れてそのロードロック室にワークを格納し、その後、ハンドだけをロードロック室から引き出すことによって行われる。ハンドは、例えば、フォーク状の形状とされる。ロボットは、例えば、2本のアームを接続して構成されて先端にハンドを備えた水平多関節機構と、水平多関節機構ごとハンドを上下方向に昇降させる昇降機構と、鉛直軸を回転軸として水平多関節機構の全体を水平面内で旋回させる回転機構とを備えるものである。水平多関節機構は、その2本のアームがなす角が小さくなったり大きくなったりすることによって同一の直線上でハンドを前進させあるいは後退させるように動かす。水平面内でハンドが動く方向の向きを変えるためには、回転機構によって水平多関節機構ごと旋回させる必要がある。さらにロボット全体を水平面内で直線移動させる搬送機構が設けられる。このようなロボットの一例が特許文献1に記載されている。以下の説明において、ハンドの前進及び後退の方向を前後方向と呼び、前後方向と直交する方向を左右方向と呼ぶ。 2. Description of the Related Art In a manufacturing line of a liquid crystal display device or the like, robots are used to transport works such as substrates between different processing devices. In that case, the work is transported by inserting the robot hand into the load lock chamber or cassette of the processing equipment from which the work is carried in, holding the work on the hand, and then removing the hand with the work on it from the load lock chamber, etc. The robot arm or the entire robot is moved with the work placed on the hand, then the hand is inserted into the load lock chamber of the processing equipment to which the work is to be carried in, the work is stored in the load lock chamber, and then only the hand is moved. from the load lock chamber. The hand is, for example, shaped like a fork. The robot consists of, for example, a horizontal articulated mechanism that is configured by connecting two arms and has a hand at the tip, an elevating mechanism that vertically moves the hand together with the horizontal articulated mechanism, and a vertical axis as a rotation axis. and a rotation mechanism for rotating the entire horizontal multi-joint mechanism in a horizontal plane. The horizontal articulated mechanism moves the hand forward or backward along the same straight line by decreasing or increasing the angle formed by the two arms. In order to change the direction in which the hand moves in the horizontal plane, it is necessary to rotate the horizontal multi-joint mechanism by a rotation mechanism. Further, a transport mechanism is provided for linearly moving the entire robot in a horizontal plane. An example of such a robot is described in Patent Document 1. In the following description, the forward and backward direction of the hand is called the front-back direction, and the direction perpendicular to the front-back direction is called the left-right direction.

ワークは、ハンド上の指定された位置に載置されないと、搬送先であるロードロック室に格納する際に誤差を生じるおそれがある。長方形のワークであれば、ハンド上の所定の位置においてワークの4辺がハンドの前後方向及び左右方向に対して整列している状態が一般に指定位置であるとされる。以下の説明において、ワークにおいてハンドの前後方向と平行となるべき辺のことをワークの縦方向辺と呼び、ハンドの左右方向と平行となるべき辺のことをワークの横方向辺と呼ぶ。ハンド上でのワークの指定位置からのずれは、ハンドの前後方向での指定位置からのずれ、ハンドの左右方向における指定位置からのずれ、及び、ワークの横方向辺とハンドの左右方向とがなす角度におけるずれの3通りが考えられる。ワークの横方向辺とハンドの左右方向とがなす角のことを傾斜角と呼び、ワークが指定位置にあるときは傾斜角は0である。このうち、前後方向でのずれと傾斜角は、ワークの横方向辺を検出するためのセンサをハンドに設けることによって補償することができる。ワークが基準位置にあるときにハンド上におけるそのワークの左右方向に延びるエッジすなわち横方向辺に対応する位置の2か所にワークを検出するためのセンサを配置し、このセンサが同時に横方向辺を検出するようにハンドの前進または後退量と水平多関節機構ごとハンドを旋回させる旋回量とを制御すれば、前後方向でのずれと傾斜角とが生じないようにワークをハンドに載置することができる。あるいはずれ量を求めておき、ワークを搬送先のロードロック室に搬送する際にずれ量に基づいて補償を行うことができる。 If the work is not placed on the specified position on the hand, there is a risk of an error occurring when the work is stored in the load lock chamber to which it is transferred. In the case of a rectangular workpiece, the specified position is generally defined as a state in which the four sides of the workpiece are aligned with respect to the front-rear direction and left-right direction of the hand at a predetermined position on the hand. In the following description, a side of the work that should be parallel to the front-rear direction of the hand is called a vertical side of the work, and a side that should be parallel to the left-right direction of the hand is called a horizontal side of the work. The deviation of the workpiece from the designated position on the hand includes the deviation from the designated position in the front-rear direction of the hand, the deviation from the designated position in the left-right direction of the hand, and the difference between the horizontal side of the workpiece and the left-right direction of the hand. Three types of deviations in the formed angle are conceivable. The angle formed by the horizontal side of the work and the horizontal direction of the hand is called the tilt angle, and the tilt angle is 0 when the work is at the specified position. Of these, the deviation in the front-rear direction and the tilt angle can be compensated for by providing the hand with a sensor for detecting the lateral side of the work. When the work is in the reference position, sensors for detecting the work are arranged at two positions corresponding to the lateral edges of the work on the hand. By controlling the forward or backward amount of the hand and the turning amount of turning the hand with the horizontal multi-joint mechanism so as to detect be able to. Alternatively, it is possible to obtain the amount of deviation and perform compensation based on the amount of deviation when transporting the workpiece to the load lock chamber of the transport destination.

しかしながら左右方向のずれは、ハンドの左右方向の長さよりもワークの横方向辺の長さが大きいという一般的な場合には、ハンドに設けたセンサによってはワークの縦方向辺を検出することができないので、ずれ量を求めることができず、またこのずれを補償することもできない。そこで特許文献2には、水平多関節機構の動作によっては影響を受けない位置にエッジ検出センサを取り付け、例えば、昇降機構に固定されるようにエッジ検出センサを取り付け、ワークの縦方向辺の位置をこのエッジ検出センサによって検出することを開示している。エッジ検出センサとしては、遮光型の一次元位置センサであるラインセンサなどを用いることができる。ハンドにおけるワークの搭載位置の左右方向のずれは、エッジ検出センサでの検出結果に基づいて搬送機構によるロボットの移動量を調節することによって補償することができる。さらにワークの搬送効率を高めるため、特許文献2は、独立して制御される2組の水平多関節機構を設けて各水平多関節機構にハンドを取り付けたロボットを開示している。このロボットは、2つのハンドの前進及び後退する方向が相互に同一の方向であり、かつ、2つのハンドが上下方向に相互に正確に重なり合う位置をとれるように構成されている。上下方向でのハンド間の間隔は狭く、ハンド上に保持されたワークの左右方向のエッジは、2つのハンドに対して共通のものとして設けられた1つのラインセンサによって検出される。 However, in the case where the horizontal side of the workpiece is larger than the horizontal length of the hand, it is possible to detect the vertical side of the workpiece depending on the sensor provided on the hand. Therefore, the amount of deviation cannot be determined, and the deviation cannot be compensated for. Therefore, in Patent Document 2, an edge detection sensor is attached at a position that is not affected by the operation of the horizontal multi-joint mechanism. is detected by this edge detection sensor. As the edge detection sensor, a light shielding one-dimensional position sensor such as a line sensor can be used. The shift in the lateral direction of the mounting position of the work in the hand can be compensated for by adjusting the amount of movement of the robot by the transport mechanism based on the detection result of the edge detection sensor. In order to further improve the work transfer efficiency, Patent Document 2 discloses a robot in which two sets of independently controlled horizontal multi-joint mechanisms are provided and a hand is attached to each horizontal multi-joint mechanism. This robot is constructed so that the forward and backward directions of the two hands are the same, and the two hands can be positioned so as to precisely overlap each other in the vertical direction. The distance between the hands in the vertical direction is narrow, and the horizontal edge of the work held on the hand is detected by one line sensor provided in common for the two hands.

特開2003-117862号公報Japanese Patent Application Laid-Open No. 2003-117862 特開2008-302451号公報JP 2008-302451 A

それぞれハンドを備える2以上の水平多関節機構を有してワークの搬送に用いられるロボットにおいて、ワークのエッジすなわち縦方向辺の位置を検出するためのエッジ検出センサをハンド間で共用する場合、エッジ検出センサの検出空間内でワークが重なっているとワークのエッジを検出することができない。ハンド上のワークの左右方向の位置を検出するためには、エッジ検出センサの検出空間内には検出対象のワーク以外のワークが存在してはならない。このため2以上のハンドがそれぞれワークを保持している場合には、検出対象のワーク以外のワークがエッジ検出センサの検出空間には存在しなくなるように、検出対象のワーク以外のワークを移動させる必要が生じる。しかしながら、ワークの移動のためにハンドを動かすためには時間がかかり、また、ロボットの位置によってはロボットの周囲の壁面などの干渉のためにハンドを前進させてワークを移動させることができないことも起こり得る。ロボットの位置のためにハンドを前進させることができないときは、より広い空間までロボットを移動させる、あるいは水平多関節機構ごとハンドの向きを変えることも考えられるが、このような動作をさせるためにも時間を要する。 In a robot that has two or more horizontal multi-joint mechanisms each having a hand and is used for transporting a work, when an edge detection sensor for detecting the position of the edge of the work, that is, the position of the vertical side of the work is shared between the hands, the edge If the works overlap in the detection space of the detection sensor, the edges of the work cannot be detected. In order to detect the lateral position of the workpiece on the hand, there must be no workpiece other than the workpiece to be detected within the detection space of the edge detection sensor. Therefore, when two or more hands each hold a work, the work other than the work to be detected is moved so that the work other than the work to be detected does not exist in the detection space of the edge detection sensor. need arises. However, it takes time to move the hand to move the work, and depending on the position of the robot, it may not be possible to advance the hand to move the work due to interference from walls around the robot. It can happen. If the hand cannot be moved forward due to the position of the robot, it is possible to move the robot to a wider space or change the direction of the hand with the horizontal multi-joint mechanism. also takes time.

本発明の目的は、複数のハンドを有するロボットにおいて、ハンドの大きな移動を伴うことなくワークの重なり合いを解消してワークのエッジ位置を検出できるようにしたワーク位置検出方法を提供することにある。 SUMMARY OF THE INVENTION It is an object of the present invention to provide a work position detection method that enables a robot having a plurality of hands to detect the edge position of the work by eliminating overlapping of the works without large movements of the hands.

本発明のワーク位置検出方法は、複数のハンドを有してハンドごとにワークを載置することが可能なロボットにおけるワーク位置検出方法であって、ロボットは、ロボットの本体と、ハンドごとに設けられてハンドの向きを第1方向に固定したまま第1方向に沿ってそのハンドを前進及び後退させることができる多関節機構と、複数のハンドに共通に本体に取り付けられたエッジ検出センサと、を備えて、多関節機構を駆動することによって複数のハンドを上下方向に重なり合う位置とすることができるように構成されており、エッジ検出センサは、複数のハンドが第1方向に移動したとき各ハンドに搭載されているワークが通過する領域を含むように検出空間を有して検出空間内において第1方向とは直交する第2方向でのワークの辺の位置を検出するように構成されており、ロボットは、さらに、ハンドごとに、多関節機構とそのハンドとを接続する手首軸の周りで第1方向から逸れる方向にハンドを回転させる機構を備え、第2方向での辺の位置の検出の対象としないワークを保持しているハンドを機構によってそのハンドの手首軸の周りで回転させることにより検出の対象としないワークを検出空間内から退出させて、辺の位置の検出の対象とするワークの辺の位置をエッジ検出センサによって検出する工程を有する。 A workpiece position detecting method according to the present invention is a workpiece position detecting method for a robot having a plurality of hands and capable of placing a workpiece on each hand. a multi-joint mechanism capable of advancing and retreating the hand along the first direction while fixing the orientation of the hand in the first direction; an edge detection sensor commonly attached to the main body of the plurality of hands; , and is configured such that the plurality of hands can be positioned to overlap each other in the vertical direction by driving the multi-joint mechanism, and the edge detection sensor detects each of the hands when the plurality of hands moves in the first direction. It has a detection space so as to include an area through which the work mounted on the hand passes, and is configured to detect the position of the side of the work in a second direction orthogonal to the first direction in the detection space. The robot further comprises, for each hand, a mechanism for rotating the hand in a direction deviating from the first direction around a wrist axis connecting the multi-joint mechanism and the hand, and for determining the position of the side in the second direction. By rotating the hand holding the workpiece not to be detected by the mechanism around the wrist axis of the hand, the workpiece not to be detected is moved out of the detection space, and the position of the side is detected. detecting the position of the side of the workpiece to be processed by an edge detection sensor.

本発明のワーク位置検出方法によれば、手首軸の周りでハンドを回転させるだけでワークの重なり合いを解消できて検出対象のワークの辺をエッジ検出センサで検出できるようになるので、ハンドを前進するために要する時間などを削減することができる。 According to the work position detection method of the present invention, by simply rotating the hand around the wrist axis, overlapping of the works can be eliminated and the edges of the work to be detected can be detected by the edge detection sensor. It is possible to reduce the time required for

本発明のワーク位置検出方法では、エッジ検出センサは、後退した位置にあるハンドに載置されたワークの辺の位置を検出するように本体に取り付けられていることが好ましい。後退した位置にあるハンドは、ロボットの周囲の壁面などから最も干渉を受けにくい状態にあるから、この構成によれば、ワークの重なり合いを解消するためにロボットの周囲に設けなければならない空間を小さくすることができるので、省スペースでロボットを設置することができる。 In the work position detection method of the present invention, it is preferable that the edge detection sensor is attached to the main body so as to detect the position of the side of the work placed on the hand in the retracted position. Since the hand in the retracted position is least likely to be interfered with by walls surrounding the robot, this configuration reduces the space that must be provided around the robot in order to eliminate overlapping of workpieces. Therefore, the robot can be installed in a small space.

本発明のワーク位置検出方法では、複数のハンドの各々が第2方向に沿って離隔して設けられた1対のセンサを備えるようにし、ワークをハンドに載置するためにワークに向かってハンドを前進させるときに、1対のセンサを用いてハンドに対するワークの傾斜角を求め、傾斜角に応じて手首軸の周りでハンドを回転させることにより、傾斜角が0となるようにワークをハンドに載置することができる。このようにワークをハンドに載置することにより、載置したワークを搬送先まで搬送するときのロボットの移動量の計算を簡単なものとすることができる。 In the workpiece position detection method of the present invention, each of the plurality of hands is provided with a pair of sensors spaced apart along the second direction, and the hand is moved toward the workpiece to place the workpiece on the hand. When moving forward, the tilt angle of the work with respect to the hand is determined using a pair of sensors, and the hand is rotated around the wrist axis according to the tilt angle, so that the tilt angle is zero. can be placed on By placing the work on the hand in this way, it is possible to simplify the calculation of the amount of movement of the robot when carrying the placed work to the destination.

本発明のワーク位置検出方法では、ハンドごとの多関節機構を共通軸において本体に取り付けるようにした上で、第1方向に沿って後退しているときのハンドの手首軸からみて共通軸の位置よりも前進方向の位置でエッジ検出センサを本体に取り付けることが好ましい。この構成によれば、ハンドが後退位置にあるときにエッジ検出センサによってワークの辺を検出可能にしつつ、手首軸とエッジ検出センサとの距離を十分とることができて検出対象ではないワークを保持するハンドを手首軸の周りでの回転させるときの回転角を小さくすることができる。 In the workpiece position detection method of the present invention, the multi-joint mechanism for each hand is attached to the main body along the common axis, and the position of the common axis viewed from the wrist axis of the hand when retreating 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 edges of the workpiece can be detected by the edge detection sensor when the hand is in the retracted position, and a sufficient distance can be secured between the wrist axis and the edge detection sensor to hold a workpiece that is not a detection target. It is possible to reduce the rotation angle when rotating the hand to rotate around the wrist axis.

本発明のワーク位置検出方法では、ハンドごとの多関節機構を共通軸において本体に取り付けるようにした上で、第1方向に沿って後退しているときのハンドの手首軸からみて共通軸の位置よりも前進方向の位置でエッジ検出センサを本体に取り付けることが好ましい。この構成によれば、ハンドが後退位置にあるときにエッジ検出センサによってワークの辺を検出可能にしつつ、手首軸とエッジ検出センサとの距離を十分とることができて検出対象ではないワークのハンドを手首軸の周りでの回転させるときの回転角を小さくすることができる。 In the workpiece position detection method of the present invention, the multi-joint mechanism for each hand is attached to the main body along the common axis, and the position of the common axis viewed from the wrist axis of the hand when retreating 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 edges of the workpiece can be detected by the edge detection sensor when the hand is in the retracted position, and the distance between the wrist axis and the edge detection sensor can be sufficiently secured, so that the hand of the workpiece which is not a detection target can be detected. can be rotated around the wrist axis.

本発明によれば、複数のハンドを有するロボットにおいて、ハンドの大きな移動を伴うことなくワークの重なり合いを解消してワークのエッジ位置を検出できるようになる。 According to the present invention, in a robot having a plurality of hands, it is possible to eliminate overlapping of workpieces and detect the edge positions of workpieces without large movements of the hands.

(a),(b)はそれぞれ本発明の実施の一形態のロボットの側面図及び平面図である。(a) and (b) are a side view and a plan view, respectively, of a robot according to an embodiment of the present invention. 水平多関節機構が上昇した状態でのロボットを示す側面図である。FIG. 10 is a side view showing the robot with the horizontal multi-joint mechanism raised; ロボットのハンドの動きを説明する図である。It is a figure explaining a motion of the hand of a robot.

次に、本発明の好ましい実施の形態について、図面を参照して説明する。図1は本発明の実施の一形態のロボットを示しており、(a),(b)はそれぞれ側面図及び平面図である。図1に示すロボットは、液晶表示パネルの製造に用いるガラス基板などの略長方形の板状のワーク50を搬送する水平多関節型のものであり、ワーク50をそれぞれ保持する2つのハンド13A,13Bを備えるいわゆるダブル・ハンド・ロボットである。また図2は、図1に示すロボットにおいて水平多関節機構が上昇した状態を示している。 Preferred embodiments of the present invention will now be described with reference to the drawings. FIG. 1 shows a robot according to one embodiment of the present invention, and (a) and (b) are a side view and a plan view, respectively. The robot shown in FIG. 1 is of a horizontal multi-joint type that transports a substantially rectangular plate-like work 50 such as a glass substrate used for manufacturing a liquid crystal display panel, and has two hands 13A and 13B that hold the work 50 respectively. is a so-called double-handed robot. 2 shows a state in which the horizontal articulated mechanism is raised in the robot shown in FIG.

ロボットは、床面に直線で設けられた相互に平行な1対のレール21上を移動可能な基台22と、基台22の上に設けられ、基台22に内蔵されたモータ(不図示)によって、回転軸31の周りで水平面内で回転する回転台23と、回転台23に対して直立するように設けられた昇降機構24を備えている。レール21にはそれを覆うカバー25が取り付けられている。昇降機構24は、回転台23に取り付けられている固定部24Aと、不図示のモータによって固定部24Aに対して昇降する移動部24Bとを備えている。図1(a)は昇降機構24の移動部24Bがその昇降範囲での最も下に位置している状態での本実施形態のロボットを示すのに対し、図2は、移動部24Bが上昇した状態でのロボットを示している。移動部24Bには水平多関節機構を保持する支持部26が水平方向に延びるように設けられており、支持部26の先端には2組の水平多関節機構が上下方向に配列して取り付けられている。上側の水平多関節機構は、支持部26に取り付けられて共通軸32の周りで水平面内を回転可能な第1アーム11Aと、第1アーム11Aの先端に取り付けられて軸33Aの周りで水平面内を回転可能な第2アーム12Aを備えており、第2アーム12Aの先端にハンド13Aが取り付けられている。同様に下側の水平多関節機構は、支持部26に取り付けられて共通軸32の周りで水平面内を回転可能な第1アーム11Bと、第1アーム11Bの先端に取り付けられて軸33Bの周りで水平面内を回転可能な第2アーム12Bを備えており、第2アーム12Bの先端にハンド13Bが取り付けられている。ロボットにおいて水平多関節機構とそれに取り付けられたハンド13A,13Bとを除いた部分が、ロボットの本体である。 The robot comprises a base 22 which is movable on a pair of mutually parallel rails 21 linearly provided on the floor, and a motor (not shown) provided on the base 22 and built in the base 22. ), a rotary table 23 that rotates in a horizontal plane around a rotary shaft 31 and an elevating mechanism 24 that is provided upright with respect to the rotary table 23 are provided. A cover 25 is attached to the rail 21 to cover it. The lifting mechanism 24 includes a fixed portion 24A attached to the turntable 23 and a moving portion 24B that moves up and down with respect to the fixed portion 24A by a motor (not shown). 1(a) shows the robot of the present embodiment with the moving part 24B of the lifting mechanism 24 positioned at the lowest position in its lifting range, while FIG. 2 shows the moving part 24B raised. It shows the robot in a state. A support portion 26 for holding a horizontal articulated mechanism is provided in the moving portion 24B so as to extend in the horizontal direction. ing. The upper horizontal articulated mechanism includes a first arm 11A that is attached to the support portion 26 and is rotatable in the horizontal plane around the common shaft 32, and a first arm 11A that is attached to the tip of the first arm 11A and is rotatable in the horizontal plane around the shaft 33A. A hand 13A is attached to the tip of the second arm 12A. Similarly, the lower horizontal articulated mechanism includes a first arm 11B that is attached to the support portion 26 and can rotate in the horizontal plane around the common shaft 32, and a first arm 11B that is attached to the tip of the first arm 11B and rotates around the shaft 33B. and a second arm 12B that can rotate in a horizontal plane, and a hand 13B is attached to the tip of the second arm 12B. The main body of the robot is the portion of the robot excluding the horizontal articulated mechanism and the hands 13A and 13B attached thereto.

ハンド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-like members are arranged in parallel so that the plate-like work 50 can be conveyed while being held in a horizontal state by being held from below. While holding the work 50, the hands 13A and 13B are entirely covered with the work 50 except for the root side where the hands 13A and 13B are connected to the second arms 12A and 12B. The hands 13A and 13B take out a workpiece 50 stored in a load lock chamber or the like and hold it on the hands 13A and 13B, or move the workpiece 50 when storing the held workpiece 50 in the load lock chamber or the like. The direction in which the hands 13A and 13B advance or retreat is parallel to the direction in which the rod member extends. The width of the hands 13A and 13B in the left-right direction, ie, the direction perpendicular to the front-rear direction, is shorter than the width of the workpiece 50 to be conveyed in the left-right direction.

このロボットにおいて水平多関節機構は、第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 multi-joint mechanism moves the hands 13A and 13B linearly in a direction perpendicular to the direction in which the support portion 26 extends by means of a link mechanism incorporated in the first arms 11A and 11B and the second arms 12A and 12B. is configured for forward and backward motion. That is, both hands 13A, 13B move forward and backward in the same direction. Forward movement is movement in which the tips of the hands 13A and 13B move away from the common shaft 32, and backward movement is movement in the opposite direction to the forward movement. The first arms 11A, 11B and the second arms 12A, 12B as a whole perform a bending motion, and in spite of that, the hands 13A, 13B are kept in a constant orientation in the horizontal plane. They are attached at the positions of the tips of the second arms 12A and 12B so as to be rotatable in the horizontal plane around the wrist shafts 34A and 34B. In the upper horizontal multi-joint mechanism, the first arm 11A and the second arm 12A are moved by driving a motor (not shown) provided in the support part 26, and the hand 13A is supported while maintaining its orientation. It moves in a direction perpendicular to the direction in which the portion 26 extends. Similarly, in the lower horizontal articulated mechanism, the first arm 11B and the second arm 12B are moved by driving the motor (not shown) provided in the support part 26, and the hand 13B maintains its orientation. It moves in a direction perpendicular to the direction in which the support portion 26 extends. In this robot, the hand 13A and the hand 13B can be moved independently, and the wrist axis 34A and the wrist axis 34B are precisely aligned in the vertical direction during these movements. can be accurately superimposed on each other in the vertical direction.

ハンド13A,13Bは、いずれも、長方形であるワーク50の横方向辺のうちハンド13A,13Bの後退方向に位置する横方向辺を検出するためのセンサ27を備えている。センサ27は、ハンド13A,13Bの各々においてその左右方向の端部となる2か所に設けられており、センサ27を用いることにより、ハンド13A,13Bの前後方向でのワーク50の位置のずれの補償と、ワーク50の横方向辺とハンド13A,13Bの左右方向とがなす傾斜角の補償とを行うことができる。 Each of the hands 13A and 13B includes a sensor 27 for detecting the lateral side of the rectangular workpiece 50 located in the backward direction of the hands 13A and 13B. The sensors 27 are provided at two locations on the left and right ends of each of the hands 13A and 13B. and compensation for the tilt angle formed by the lateral side of the workpiece 50 and the lateral direction of the hands 13A and 13B.

さらにロボットには、水平多関節機構が取り付けられている支持部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が検出空間に入り込むこととなる。 Furthermore, if the robot is in a position where it is stationary with respect to the support section 26 to which the horizontal multi-joint mechanism is attached and the workpiece 50 is held by the hands 13A and 13B, the hands 13A and 13B can move. An edge detection sensor 28, for example, a light shielding sensor, is provided at a position through which the longitudinal side of the work 50 passes due to the forward and backward movement of the . In the example shown here, the edge detection sensor 28 is attached to the moving portion 24B of the lifting mechanism 24 . The edge detection sensor 28 detects lateral deviation of the placement position of the work 50 on the hands 13A and 13B. It is configured. The edge detection sensor 28 has a U-shaped outer shape , and detects the vertical side of the workpiece 50 when the workpiece 50 enters the detection space, using the U-shaped opening as a detection space. The edge detection sensor 28 is commonly provided for the work 50 held by both hands 13A and 13B. In the robot of this embodiment, the distance between the hands 13A and 13B in the vertical direction is constant, and the width of the opening of the edge detection sensor 28 is greater than the distance between the hands 13A and 13B. The work 50 can pass through when all of the 13B are loaded with the work 50.例文帳に追加The robot of the present embodiment is a transfer robot, and moves forward the hands 13A and 13B to take out the work 50 from a load lock chamber or the like and store the work 50 in the load lock chamber. The workpiece 50 leaves the detection space when the hands 13B are advanced, and enters the detection space when the hands 13A and 13B are retracted.

ハンド13A,13Bのそれぞれに搭載されたワーク50に対してエッジ検出センサ28が共通に設けられているとしても、ワーク50の辺の位置を検出するためには、エッジ検出センサ28の検出空間内には検出対象のワーク50だけが存在している必要があり、検出対象ではないワーク50は検出空間内に存在してはならない。ハンド13A,13Bの両方がそれぞれワーク50を保持している状態では、検出対象のワーク50を保持していない方のハンドを移動させて検出対象のワーク50のみが検出空間内に存在するようにする必要がある。従来は、検出対象ではないワーク50を搭載しているハンドを前進させることにより検出対象のワーク50のみが検出空間内に存在するようにしているが、そのようにハンドを移動させることには時間がかかり、また、ロボットの周囲の壁面などとの衝突を避けるためにそのようにハンドを移動させることが困難な場合もある。そこで本実施形態では、ロボットとして、ハンド13A,13Bごとに設けられた不図示のモータにより、手首軸34A,34Bの周りでハンド13A,13Bをその本来の前後方向から例えば±数度の範囲で回転させることができるものを使用する。そして、検出対象以外のワーク50を保持しているハンドについては、本来の前後方向からずれるようにその手首軸の周りで回転させる。その結果、手首軸の周りで回転させたハンドに保持されたワーク50はエッジ検出センサ28の検出空間から抜け出すこととなり、検出対象のワーク50のみが検出空間内に存在するようにすることができる。 Even if the edge detection sensor 28 is commonly provided for the workpiece 50 mounted on each of the hands 13A and 13B, in order to detect the position of the side of the workpiece 50, the detection space of the edge detection sensor 28 is required. Only the workpiece 50 to be detected must exist in the space, and the workpiece 50 not to be detected must not exist in the detection space. When both hands 13A and 13B hold workpieces 50, the hand that does not hold the workpiece 50 to be detected is moved so that only the workpiece 50 to be detected exists within the detection space. There is a need to. Conventionally, a hand carrying a workpiece 50 not to be detected is advanced so that only the workpiece 50 to be detected exists in the detection space. In addition, it may be difficult to move the hand in such a manner to avoid collisions with walls around the robot. Therefore, in this embodiment, as a robot, a motor (not shown) provided for each of the hands 13A and 13B rotates the hands 13A and 13B around the wrist shafts 34A and 34B within a range of, for example, ±several degrees from their original forward and backward directions. Use something that can rotate. Then, the hand holding the workpiece 50 other than the detection target is rotated around the wrist axis so as to deviate from the original front-rear direction. As a result, the workpiece 50 held by the hand rotated around the wrist axis comes out of the detection space of the edge detection sensor 28, so that only the workpiece 50 to be detected exists in the detection space. .

図3は、本実施形態のロボットにおけるエッジ検出センサ28によるワーク50の縦方向辺の検出を模式的に示す図である。ワーク50としてはガラス基板を想定しており、平面図で表したときにはワーク50の向こう側が透けて見えているものとする。説明のため、ハンド13A,13Bに保持されているワーク50をそれぞれワーク50A,50Bと表記する。(a)は、ハンド13A,13Bが後退位置にあって上下方向に重なり合っている状態を示す平面図であり、(b)は(a)に対応する側面図である。エッジ検出センサ28の検出空間には2枚のワーク50A,50Bが存在するので、ワーク50A,50Bのいずれについても辺の位置の検出を行うことはできない。ここで下側のハンド13Bが保持しているワーク50Bの辺の位置を検出することとすると、本実施形態では、上側のハンド13Aをその手首軸34Aの周りでエッジ検出センサ28から遠ざかるように回転させる。その結果、上側のハンド13Aが保持しているワーク50Aはエッジ検出センサ28の検出空間からは外れることとなり、エッジ検出センサ28は、下側のハンド13Bが保持しているワーク50Bの辺を検出できるようになる。図3において、(c)は手首軸34Aの周りでハンド13Aを回転させた状態を示す平面図であり、(d)は(c)に対応する側面図である。 FIG. 3 is a diagram schematically showing detection of the vertical side of the workpiece 50 by the edge detection sensor 28 in the robot of this embodiment. It is assumed that the work 50 is a glass substrate, and that the other side of the work 50 can be seen through when represented in a plan view. For the sake of explanation, the works 50 held by the hands 13A and 13B are denoted as works 50A and 50B, respectively. (a) is a plan view showing a state in which the hands 13A and 13B are in the retracted position and vertically overlapped, and (b) is a side view corresponding to (a). Since there are two works 50A and 50B in the detection space of the edge detection sensor 28, it is impossible to detect the position of the sides of either of the works 50A and 50B. Assuming that the position of the side of the workpiece 50B held by the lower hand 13B is to be detected, in this embodiment, the upper hand 13A is moved away from the edge detection sensor 28 around the wrist axis 34A. rotate. As a result, the work 50A held by the upper hand 13A is out of the detection space of the edge detection sensor 28, and the edge detection sensor 28 detects the sides of the work 50B held by the lower hand 13B. become able to. In FIG. 3, (c) is a plan view showing a state in which the hand 13A is rotated around the wrist axis 34A, and (d) is a side view corresponding to (c).

一方、手首軸の周りで本来の前後方向から傾く方向にハンドを回転させない従来のロボットでは、検出対象ではないワーク50を保持したハンドを前進させる必要がある。図3に示す例において下側のハンド13Bに保持されたワーク50Bの辺を検出するためには、上側のハンド13Aを前進させる必要がある。図3において、(e)は上側のハンド13Aを前進させた状態を示す平面図であり、(f)は(e)に対応する側面図である。 On the other hand, in a conventional robot that does not rotate the hand about the wrist axis in a direction inclined from the original front-rear direction, it is necessary to advance the hand holding the workpiece 50 that is not the object of detection. In the example shown in FIG. 3, it is necessary to advance the upper hand 13A in order to detect the side of the workpiece 50B held by the lower hand 13B. In FIG. 3, (e) is a plan view showing a state in which the upper hand 13A is advanced, and (f) is a side view corresponding to (e).

次に、ロボットにおけるエッジ検出センサ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 explained. When the horizontal articulated mechanism to which the hands 13A and 13B are attached moves up and down in the vertical direction, it is preferable that the edges of the workpiece 50 can be detected regardless of the height of the hands 13A and 13B. It is preferable that an edge detection sensor 28 is provided at a position that moves up and down together with the mechanism. In the transfer robot, the hands 13A and 13B are moved in parallel to prevent the work 50 and the hands 13A and 13B from colliding with surrounding objects while the entire robot is moving in parallel on the horizontal plane. 13A and 13B are in a retracted state. It is preferable to detect the vertical side of the workpiece 50 when the hands 13A and 13B are in the retracted state. Further, when the hand holding a work other than the detection target is rotated around its wrist axis, it is preferable that the amount of rotation is small. From the viewpoint of reducing the amount of rotation, it is preferable to attach the edge detection sensor 28 as far away 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 detected at a position on the forward direction side of the position of the common shaft 32, which is the mounting position of the horizontal articulated mechanism in the support section 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, the operation of the robot of this embodiment to take out the work 50 stored in the load lock chamber or cassette and hold 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 is holding another work. It is assumed that the hand 13B does not hold the workpiece 50 and is in a retracted state. The robot moves along the rail 21 to the front of the target load-lock chamber, and the lifting mechanism 24 adjusts the height of the hand 13B to the height of the load-lock chamber. Then, the arms 11B and 12B are driven to move the hand 13B forward and enter the load-lock chamber to a position below the work 50 stored in the load-lock chamber. When the hand 13B is lifted by the elevating mechanism 24 in this state, the workpiece 50 is placed on the hand 13B. At this time, the lateral sides of the workpiece 50 are detected by a pair of sensors 27 provided on the hand 13B, and the advance amount of the hand 13B is controlled so that the lateral sides coincide with the reference positions of 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 workpiece 50 is It is placed on the hand 13B so that its lateral side and the left-right direction of the hand 13B are aligned. 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-rear direction of the hand 13B match. It simplifies the calculations when performing 50 position compensation.

ロボットによってワーク50を例えば他のロードロック室に搬送する際に回転軸31の周りで回転台23を回転させてハンド13Bの前後方向の向きも回転させる必要がある場合には、傾斜角の値を記憶した上で、ハンド13A上でのワーク50の傾斜角をゼロとするような動作を行うことなく、回転軸31の周りで回転台23を回転させるときに傾斜角の分も考慮して回転量を決めるようにすればよい。この場合は、ハンド13Bにワーク50を載せるときに傾斜角の補正を行わないので、その分、時間を短縮することができる。 If it is necessary to rotate the turntable 23 around the rotation shaft 31 and also rotate the hand 13B in the front-rear direction when transferring the workpiece 50 to another load-lock chamber, for example, by the robot, the value of the tilt angle is is memorized, and the tilt angle is also taken into consideration when rotating the turntable 23 around the rotation shaft 31 without performing an operation to make the tilt angle of the work 50 on the hand 13A zero. It is sufficient to determine the amount of rotation. In this case, since the tilt angle is not corrected when the workpiece 50 is placed on the hand 13B, the time can be shortened accordingly.

ロードロック室内でハンド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 workpiece 50 is placed on the hand 13B in the load lock chamber, the arms 11B and 12B are driven to retract the hand 13B, and the hand 13B is in a retracted state. At this time, the detection space of the edge detection sensor 28 is filled with the works 50 placed on the hands 13A and 13B. Since it is necessary to determine the lateral position of the workpiece 50 on the hand 13B, which is a newly placed workpiece, the hand 13A is rotated around its wrist axis 34A as described above to move the workpiece on the hand 13A. 50 is withdrawn from the detection space, and the edge detection sensor 28 detects the position of the vertical side of the workpiece on the hand 13B. From the detected position of the vertical side, the shift amount of the workpiece 50 in the left-right direction in the hand 13B is determined. Based on this amount of deviation, the movement amount of the robot to transport the work 50 by parallel movement along the rail 21 to another load lock chamber is determined, so that the work 50 can be accurately transported to the destination load lock chamber. be able to store. When the robot moves parallel to the destination of the workpiece 50 without correcting the tilt angle, it is necessary to consider the influence of the tilt angle when calculating the amount of movement of the robot.

以上説明した本実施形態のロボットでは、水平多関節機構の先端に取り付けられたハンドを後退状態とした状態でそのハンドの手首軸の周りでハンドを回転させることにより、ハンドを前進方向に移動させる必要なく、検出対象ではないワークをエッジ検出センサ28の検出空間から退出させることができ、ワークの縦方向辺の位置の検出に要する時間を短縮することができる。また、ハンドを前進させないので、ロボットの周囲の空間が狭い場合であってもワークの縦方向辺の位置の検出を行えるようになる。 In the robot of this embodiment described above, the hand attached to the tip of the horizontal multi-joint mechanism is moved in the forward direction by rotating the hand around the wrist axis of the hand while the hand is in the retracted state. A work that is not to be detected can be moved out of the detection space of the edge detection sensor 28, and the time required to detect the position of the vertical side of the work can be shortened. Moreover, since the hand is not moved forward, the position of the vertical side of the workpiece can be detected even if the space around the robot is narrow.

上述したロボットでは、ハンドを前進後退運動させるための水平多関節機構とは別に、水平多関節機構の全体を回転軸31の周りで旋回させるための機構が設けられている。レール21の延長方向に沿ってその一方の側だけにロードロック室などが設けられている場合には、上述した傾斜角は手首軸34A,34Bの周りでのハンド13A,13Bの回転によって補償できるので、水平多関節機構を大きく旋回させる必要がなくなり、そのため回転軸31や回転台23を設けずに基台22に昇降機構24をそのまま取り付けるようにすることも可能である。また以上の説明は、2つのハンド13A,13Bを有するロボットに関するものであるが、ハンドの数が3以上のロボットであっても、検出対象ではないワークを保持するハンドをその手首軸の周りで回転させることにより、ワークの縦方向辺の位置の検出に要する時間を短縮することができる。また、ハンドを前進させないので、ロボットの周囲の空間が狭い場合であってもワークの縦方向辺の位置の検出を行えるようになる。 In the robot described above, a mechanism for turning the entire horizontal multi-joint mechanism around the rotation shaft 31 is provided in addition to the horizontal multi-joint mechanism for moving the hand forward and backward. If a load lock chamber or the like is provided only on one side along the extending direction of the rail 21, the above-described inclination angle can be compensated for by rotating the hands 13A and 13B around the wrist axes 34A and 34B. Therefore, it is possible to mount the lifting mechanism 24 directly on the base 22 without providing the rotating shaft 31 and the rotating table 23. As shown in FIG. Also, the above description relates to a robot having two hands 13A and 13B. By rotating the workpiece, it is possible to shorten the time required to detect the position of the vertical side of the workpiece. Moreover, since the hand is not moved forward, the position of the vertical side of the workpiece can be detected even if the space around the robot is narrow.

11A,11B…第1アーム;12A,12B…第2アーム;13A,13B…ハンド;21…レール;22…基台;23…回転台;24…昇降機構;24A…固定部;24B…移動部;25…カバー;26…支持部;27…センサ;28…エッジ検出センサ;31…回転軸;32…共通軸;33A,33B…軸;34A,34B…手首軸;50…ワーク。 11A, 11B... first arm; 12A, 12B... second arm; 13A, 13B... hand; 21... rail; 22... base; 25... Cover; 26... Support portion; 27... Sensor; 28... Edge detection sensor; 31... Rotary shaft; 32... Common shaft;

Claims (5)

複数のハンドを有して前記ハンドごとにワークを載置することが可能なロボットにおけるワーク位置検出方法であって、
前記ロボットは、ロボットの本体と、ハンドごとに設けられて前記ハンドの向きを第1方向に固定したまま前記第1方向に沿って当該ハンドを前進及び後退させることができる多関節機構と、前記複数のハンドに共通に前記本体に取り付けられたエッジ検出センサと、を備えて、前記多関節機構を駆動することによって前記複数のハンドを上下方向に重なり合う位置とすることができるように構成されており、
前記エッジ検出センサは、前記複数のハンドが前記第1方向に移動したとき各ハンドに搭載されている前記ワークが通過する領域を含むように検出空間を有して前記検出空間内において前記第1方向とは直交する第2方向での前記ワークの辺の位置を検出するように構成されており、
前記ロボットは、さらに、ハンドごとに、前記多関節機構と当該ハンドとを接続する手首軸の周りで前記第1方向から逸れる方向に前記ハンドを回転させる機構を備え、
前記第2方向での前記辺の位置の検出の対象としない前記ワークを保持している前記ハンドを前記機構によって当該ハンドの手首軸の周りで回転させることにより前記検出の対象としない前記ワークを前記検出空間内から退出させて、前記辺の位置の検出の対象とする前記ワークの前記辺の位置を前記エッジ検出センサによって検出する工程を有する、ワーク位置検出方法。
A workpiece position detection method for a robot having a plurality of hands and capable of placing a workpiece on each hand, comprising:
The robot includes a main body of the robot, a multi-joint mechanism provided for each hand and capable of moving the hand forward and backward along the first direction while fixing the orientation of the hand in the first direction, and and an edge detection sensor attached to the main body in common to the plurality of hands, and by driving the multi-joint mechanism, the plurality of hands can be positioned to overlap each other in the vertical direction. cage,
The edge detection sensor has a detection space so as to include an area through which the work mounted on each hand passes when the plurality of hands move in the first direction, and the edge detection sensor has the first edge detection space within the detection space. configured to detect the position of the side of the workpiece in a second direction perpendicular to the direction,
The robot further comprises, for each hand, a mechanism for rotating the hand in a direction deviating from the first direction around a wrist axis connecting the multi-joint mechanism and the hand,
The work that is not subject to detection of the position of the side in the second direction is rotated around the wrist axis of the hand by rotating the hand holding the work that is not subject to detection of the position of the side in the second direction. A work position detection method, comprising the step of withdrawing from the detection space and detecting the position of the side of the work whose position of the side is to be detected by the edge detection sensor.
前記エッジ検出センサは、後退した位置にある前記ハンドに載置された前記ワークの前記辺の位置を検出するように前記本体に取り付けられている、請求項1に記載のワーク位置検出方法。 2. The work position detection method according to claim 1, wherein said edge detection sensor is attached to said main body so as to detect the position of said side of said work placed on said hand in a retracted position. 前記複数のハンドの各々は、前記第2方向に沿って離隔して設けられた1対のセンサを備え、
前記ワークを前記ハンドに載置するために前記ワークに向かって前記ハンドを前進させるときに、前記1対のセンサを用いて前記ハンドに対する前記ワークの傾斜角を求め、前記傾斜角に応じて前記手首軸の周りで前記ハンドを回転させることにより、前記傾斜角が0となるように前記ワークを前記ハンドに載置する、請求項1または2に記載のワーク位置検出方法。
each of the plurality of hands includes a pair of sensors spaced apart along the second direction;
When the hand is advanced toward the work in order to place the work on the hand, the tilt angle of the work with respect to the hand is obtained using the pair of sensors, and the tilt angle is determined according to the tilt angle. 3. The workpiece position detection method according to claim 1, wherein the workpiece is placed on the hand so that the tilt angle is zero by rotating the hand around the wrist axis.
前記複数のハンドの各々は、前記第2方向に沿って離隔して設けられた1対のセンサを備え、
前記ワークを前記ハンドに載置するために前記ワークに向かって前記ハンドを前進させるときに、前記1対のセンサを用いて前記ハンドに対する前記ワークの傾斜角を求め、前記傾斜角を記憶して前記ワークを前記ハンドに載置する、請求項1または2に記載のワーク位置検出方法。
each of the plurality of hands includes a pair of sensors spaced apart along the second direction;
When the hand is advanced toward the work in order to place the work on the hand, the pair of sensors is used to determine the tilt angle of the work with respect to the hand, and the tilt angle is stored. 3. The workpiece position detection method according to claim 1, wherein the workpiece is placed on the hand.
前記ハンドごとの前記多関節機構は共通軸において前記本体に取り付けられ、
前記エッジ検出センサは、前記第1方向に沿って後退しているときの前記ハンドの前記手首軸からみて前記共通軸の位置よりも前進方向の位置で前記本体に取り付けられている、請求項1乃至4のいずれか1項に記載のワーク位置検出方法。
the articulated mechanism for each hand is attached to the body at a common axis;
2. The edge detection sensor is attached to the main body at a position in the forward direction relative to the position of the common axis when viewed from the wrist axis of the hand when the hand is retracted along the first direction. 5. A workpiece position detection method according to any one of items 1 to 4.
JP2019137804A 2019-07-26 2019-07-26 Work position detection method for robots Active JP7303686B2 (en)

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 JP2021022643A5 (en) 2022-07-13
JP7303686B2 true 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)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7784264B2 (en) * 2021-10-01 2025-12-11 ニデックインスツルメンツ株式会社 Industrial robot and control method for industrial robot
JP2024077370A (en) * 2022-11-28 2024-06-07 ニデックインスツルメンツ株式会社 Robot system and hand position correction method

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000071187A (en) 1998-08-27 2000-03-07 Komatsu Ltd Work transfer robot
WO2005004230A1 (en) 2003-07-04 2005-01-13 Rorze Corporation Carrying apparatus and carrying control method for sheet-like substrate
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 transfer device
JP2008302451A (en) 2007-06-06 2008-12-18 Yaskawa Electric Corp Liquid crystal transfer robot and control method thereof
JP2013165119A (en) 2012-02-09 2013-08-22 Tokyo Electron Ltd Substrate processing apparatus and method

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
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
JP2005193303A (en) * 2003-12-26 2005-07-21 Mitsubishi Heavy Ind Ltd Substrate transporting device
KR101502130B1 (en) * 2008-07-10 2015-03-13 주식회사 원익아이피에스 A transfer apparatus, a transfer chamber in which the transfer apparatus is installed, and a vacuum processing system
US8958907B2 (en) * 2011-03-31 2015-02-17 Sinfonia Technology Co., Ltd. Robot arm apparatus
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

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000071187A (en) 1998-08-27 2000-03-07 Komatsu Ltd Work transfer robot
WO2005004230A1 (en) 2003-07-04 2005-01-13 Rorze Corporation Carrying apparatus and carrying control method for sheet-like substrate
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 transfer device
JP2008302451A (en) 2007-06-06 2008-12-18 Yaskawa Electric Corp Liquid crystal transfer robot and control method thereof
JP2013165119A (en) 2012-02-09 2013-08-22 Tokyo Electron Ltd Substrate processing apparatus and method

Also Published As

Publication number Publication date
TWI718081B (en) 2021-02-01
KR102386597B1 (en) 2022-04-15
TW202103873A (en) 2021-02-01
CN112297036A (en) 2021-02-02
CN112297036B (en) 2023-06-06
KR20210012950A (en) 2021-02-03
JP2021022643A (en) 2021-02-18

Similar Documents

Publication Publication Date Title
JP4499038B2 (en) Thin plate substrate transfer apparatus and transfer control method thereof
CN108217537B (en) Item handling vehicle
EP1346266B1 (en) Robot motion compensation system
JP5532110B2 (en) Substrate transfer robot and substrate transfer method
JP5578973B2 (en) Industrial robot
JP2016107378A (en) Industrial robot and teaching method of industrial robot
US10020216B1 (en) Robot diagnosing method
JP7303686B2 (en) Work position detection method for robots
JP2013018617A (en) Carrying vehicle
WO2020217737A1 (en) Conveyance device
JP2000071190A (en) Work transfer system
JP4468159B2 (en) Substrate processing apparatus and transfer position alignment method thereof
JP2004203604A (en) Transfer method and transfer device for square platelike workpiece
KR102783064B1 (en) Control device of substrate return robot and control method of joint motor
KR102795982B1 (en) Industrial robots
JP2021022643A5 (en)
JP2000071187A (en) Work transfer robot
JP5118896B2 (en) Transfer robot system
KR102239871B1 (en) Auto teaching system
JP7443142B2 (en) Industrial robots and industrial robot control methods
JP7495265B2 (en) ROBOT SYSTEM AND METHOD FOR CONTROLLING ROBOT SYSTEM
JP7443141B2 (en) Industrial robots and industrial robot control methods
JP5665417B2 (en) Industrial robot
JP7784264B2 (en) Industrial robot and control method for industrial robot
KR102793036B1 (en) Correction value calculation method for industrial robot and control method for industrial robot

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220705

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220705

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20230518

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20230606

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230623

R150 Certificate of patent or registration of utility model

Ref document number: 7303686

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150