JP7599302B2 - Industrial robot and control method thereof - Google Patents
Industrial robot and control method thereof Download PDFInfo
- Publication number
- JP7599302B2 JP7599302B2 JP2020165724A JP2020165724A JP7599302B2 JP 7599302 B2 JP7599302 B2 JP 7599302B2 JP 2020165724 A JP2020165724 A JP 2020165724A JP 2020165724 A JP2020165724 A JP 2020165724A JP 7599302 B2 JP7599302 B2 JP 7599302B2
- Authority
- JP
- Japan
- Prior art keywords
- hand
- workpiece
- arm support
- industrial robot
- axis
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 61
- 230000008569 process Effects 0.000 claims description 45
- 230000007246 mechanism Effects 0.000 claims description 38
- 230000008859 change Effects 0.000 claims description 9
- 230000004044 response Effects 0.000 claims description 7
- 210000004247 hand Anatomy 0.000 description 34
- 230000032258 transport Effects 0.000 description 12
- 230000001133 acceleration Effects 0.000 description 7
- 239000011521 glass Substances 0.000 description 5
- 239000000758 substrate Substances 0.000 description 5
- 230000000694 effects Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 239000004973 liquid crystal related substance Substances 0.000 description 3
- 230000000630 rising effect Effects 0.000 description 2
- 210000000707 wrist Anatomy 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 238000005401 electroluminescence Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 239000011347 resin Substances 0.000 description 1
- 229920005989 resin Polymers 0.000 description 1
- 238000001179 sorption measurement Methods 0.000 description 1
- 230000007723 transport mechanism Effects 0.000 description 1
- 230000003313 weakening effect Effects 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
Description
本発明は、液晶表示パネルや有機EL(エレクトロルミネッセンス)パネルに用いるガラス基板などの板状またはシート状のワークを搬送する産業用ロボットと、その制御方法とに関する。 The present invention relates to an industrial robot that transports plate- or sheet-shaped workpieces, such as glass substrates used in liquid crystal display panels and organic EL (electroluminescence) panels, and a control method for the same.
例えば液晶表示装置に用いる液晶表示パネルの製造ラインなどでは、異なる処理装置などの間でロボットを使用してガラス基板などの板状のワークを搬送する。その場合、ワークの搬送は、搬入元となる処理装置のカセットやロードロック室に対して搬送用のロボットのハンドを差し込んでそのハンドの上にワークを保持し、カセットなどからワークを載せたハンドを引き出し、ハンドにワークを載せたままロボットのアームまたはロボット全体を移動させ、次いで、搬入先となる処理装置のカセットにハンドを差し入れてそのカセットにワークを格納し、その後、ハンドだけをカセットから引き出すことによって行われる。場合によってはハンドに設けられた吸着装置を用い、ハンドの下側にワークを吸着させてそのワークを搬送させることもある。ハンドは、例えば、フォーク状の形状とされる。搬送用のロボットは、例えば、2本のアームを接続して構成されて先端にハンドを備えた水平多関節機構と、水平多関節機構ごとハンドを上下方向に昇降させる昇降機構と、鉛直軸を回転軸として水平多関節機構の全体を水平面内で旋回させる回転機構とを備える。水平多関節機構は、その2本のアームがなす角が小さくなったり大きくなったりすることによって、同一の直線上で、ハンドを前進させあるいは後退させるように動かすことができる。水平面内でハンドが動く方向の向きを変えるためには、回転機構によって水平多関節機構ごと旋回させる必要がある。さらにロボット全体を水平面内で直線移動させる搬送機構が設けられる。 For example, in a manufacturing line for liquid crystal display panels used in liquid crystal display devices, a robot is used to transport plate-shaped workpieces such as glass substrates between different processing devices. In this case, the workpiece is transported by inserting the hand of the transport robot into a cassette or load lock chamber of the processing device that is the source of the workpiece, holding the workpiece on the hand, pulling out the hand with the workpiece from the cassette, moving the arm of the robot or the entire robot with the workpiece still on the hand, then inserting the hand into a cassette of the processing device that is the destination of the workpiece and storing the workpiece in the cassette, and then pulling out only the hand from the cassette. In some cases, a suction device provided on the hand is used to suction the workpiece to the underside of the hand and transport the workpiece. The hand is, for example, fork-shaped. The transport robot is, for example, equipped with a horizontal multi-joint mechanism consisting of two connected arms and equipped with a hand at the tip, a lifting mechanism for raising and lowering the hand together with the horizontal multi-joint mechanism in the vertical direction, and a rotation mechanism for rotating the entire horizontal multi-joint mechanism in a horizontal plane around a vertical axis as the axis of rotation. The horizontal articulated mechanism can move the hand forward or backward on the same straight line by making the angle between its two arms smaller or larger. To change the direction in which the hand moves within the horizontal plane, the horizontal articulated mechanism must be rotated using a rotation mechanism. In addition, a transport mechanism is provided to move the entire robot in a straight line within the horizontal plane.
ワークを搬送するときは、ロボットが急速に動いているときであっても、ハンドに対してワークが正確に位置決めされるとともに、ワークがハンドに確実に保持される必要がある。大型であって撓み量が大きなワークのハンド上での位置ずれを抑制できる技術として特許文献1は、ワークの下面に接触する接触面を有するゴム製または樹脂製の複数のパッドをハンドに設け、パッドにおける接触面の形状を球面状とすることを開示している。 When transporting a workpiece, even if the robot is moving rapidly, the workpiece needs to be accurately positioned relative to the hand and securely held by the hand. Patent Document 1 discloses a technique for preventing misalignment of a large workpiece that has a large amount of deflection on the hand, in which the hand is provided with multiple rubber or resin pads with contact surfaces that come into contact with the underside of the workpiece, and the contact surfaces of the pads are spherical.
ワークが大型化しかつ厚さが薄くなるにつれ、ロボットによるワークの搬送中にワークが受ける風圧の影響を無視できなくなってきている。ハンド上にワークを保持して搬送するロボットの場合、風圧を受けたワークがハンド上でめくられるように動き、その結果、ハンド上でのワークの位置が変化したり、はなはだしい場合にはハンドからワークが落下することがある。ハンド上でワークの位置を固定するために吸着パッドが設けられることもあるが、風圧によって発生する力は、吸着パッドとワークの間をこじ開けるような力であるので、この力によって吸着パッドからワークが離脱することもある。風圧の影響を低減するためには、ハンドの移動速度、すなわちロボットの移動速度を低下させればよいが、そうすると、ワークの搬送に要する時間が長くなり、タクトタイムが長くなる。 As workpieces become larger and thinner, it is becoming increasingly difficult to ignore the effects of wind pressure on workpieces when they are being transported by a robot. When a robot transports a workpiece by holding it on its hand, the wind pressure causes the workpiece to move as if it is being turned over on the hand, resulting in a change in the position of the workpiece on the hand and, in severe cases, the workpiece falling from the hand. Suction pads are sometimes provided to fix the position of the workpiece on the hand, but the force generated by the wind pressure is strong enough to pry the gap between the suction pad and the workpiece, and this force can cause the workpiece to detach from the suction pad. In order to reduce the effects of wind pressure, the movement speed of the hand, i.e. the movement speed of the robot, can be reduced, but this increases the time required to transport the workpiece and therefore the takt time.
本発明の目的は、大型化しかつ厚さが薄いワークを搬送するときであっても、タクトタイムが過大に長くなることを防ぎつつ、風圧の影響を抑えてハンドに確実にワークを保持できる産業用ロボットとその制御方法とを提供することにある。 The object of the present invention is to provide an industrial robot and a control method thereof that can hold a workpiece securely in the hand while suppressing the effects of wind pressure and preventing the takt time from becoming excessively long, even when transporting a large, thin workpiece.
本発明の産業用ロボットは、動作速度についての規定値が定められて板状のワークをそのワークの水平状態を保ったまま搬送する産業用ロボットであって、基台と、ワークを保持可能なハンドと、ハンドが接続され、水平面内を回転可能なアームと、アームを支持するアーム支持部と、基台に対してアーム支持部を昇降させる昇降機構と、動作指令に応じて各軸を動作させるときに各軸が規定値で動くようにする制御を実行し、ハンドの位置を変化させる制御を行なう制御部と、を備え、ハンドは、水平面内で回転可能にアームに取り付けられており、制御部は、ハンドがワークをそのハンドの上に保持する形式のものである場合にアーム支持部を下降させることを含む動作指令を受け取ったときに、及び、ハンドがワークをそのハンドの下に保持する形式のものである場合にアーム支持部を上昇させることを含む動作指令を受け取ったときに、規定値よりも小さな動作速度に基づいてハンドの位置を変化させる減速処理を実行する。 The industrial robot of the present invention is an industrial robot that has a specified value for the operating speed and transports a plate-shaped workpiece while maintaining the workpiece in a horizontal position , and is equipped with a base, a hand capable of holding the workpiece, an arm to which the hand is connected and which can rotate in a horizontal plane , an arm support section that supports the arm, a lifting mechanism that raises and lowers the arm support section relative to the base, and a control section that executes control so that each axis moves at a specified value when each axis is operated in response to an operation command and controls to change the position of the hand , the hand being attached to the arm so as to be rotatable in a horizontal plane, and the control section executes a deceleration process to change the position of the hand based on an operating speed that is smaller than the specified value when it receives an operation command that includes lowering the arm support section if the hand is of a type that holds a workpiece on top of the hand, and when it receives an operation command that includes raising the arm support section if the hand is of a type that holds a workpiece below the hand.
ガラス基板などの板状のワークを搬送する場合、ワークはハンド上に水平に載置されるか、吸着などの手段によってワークの下側に水平に保持される。この状態でハンドごとワークを水平に動かしても、ワークはほとんど風圧を受けない。垂直方向にハンドを動かしたときにはワークは風圧を受けるが、風圧によってワークに対してハンドに押し付けられるような力がかかるときも、ハンドでのワークの位置ずれやハンドからのワークの離脱は起こらない。これに対し、ハンドから離れる方向にワークが風圧を受けるときには、すなわち、ハンドがワークをそのハンドの上に保持する形式のものである場合にアーム支持部が下降するときや、ハンドがワークをそのハンドの下に保持する形式のものである場合にアーム支持部が上昇するときには、ワークの位置ずれや離脱が起こるおそれがある。一方、産業用ロボットでは、軸ごとにあるいは全体としての動作速度の規定値が定められており、動作指令に基づいて各軸を動作させるときは、加減速の期間を除けばその規定値で動くように各軸が駆動される。そこで本発明の産業用ロボットは、ハンドから離れる方向にワークが風圧を受けるような動作指令を受け取ったときは、規定値よりも小さな動作速度でハンドの位置を変化させる減速処理を実行する。その結果、ハンドの移動中にワークが受ける風圧が小さくなり、ワークの位置ずれや離脱を防止することができる。また、ワークの位置ずれや離脱が起こるおそれがないときには減速処理を行わないので、全体としてタクトタイムが長くなることを最小限に抑えることができる。 When transporting a plate-like workpiece such as a glass substrate, the workpiece is placed horizontally on the hand or held horizontally below the workpiece by suction or other means. In this state, even if the hand and workpiece are moved horizontally, the workpiece is hardly subjected to wind pressure. When the hand is moved vertically, the workpiece is subjected to wind pressure, but even when the wind pressure applies a force that presses the workpiece against the hand, the workpiece does not shift in position in the hand or fall off from the hand. In contrast, when the workpiece is subjected to wind pressure in a direction away from the hand, that is, when the arm support part descends if the hand is a type that holds the workpiece on the hand, or when the arm support part ascends if the hand is a type that holds the workpiece below the hand, the workpiece may shift in position or fall off. On the other hand, in industrial robots, a specified value for the operating speed is set for each axis or for the entire robot, and when each axis is operated based on an operating command, each axis is driven to move at that specified value except for the period of acceleration and deceleration. Therefore, when the industrial robot of the present invention receives an operation command in which the workpiece is subjected to wind pressure in a direction away from the hand, it executes a deceleration process that changes the position of the hand at an operating speed slower than a specified value. As a result, the wind pressure received by the workpiece during the hand movement is reduced, making it possible to prevent the workpiece from shifting out of position or becoming detached. In addition, since the deceleration process is not executed when there is no risk of the workpiece becoming detached or becoming detached, it is possible to minimize the overall increase in takt time.
本発明の産業用ロボットでは、制御部は、ハンドがワークを保持しているときにのみ減速処理を実行することが好ましい。ハンドがワークを保持していないときにはワークの位置ずれや離脱はそもそも起こらないので、このようなときには減速処理を行わないようにすることにより、タクトタイムの短縮が可能になる。また制御部は、動作指令によるアーム支持部の昇降量が所定の値を超えるときにのみ減速処理を実行するようにすることが好ましい。アーム支持部の昇降量が小さいときは、加減速時間を考慮するとハンドの昇降速度の最大値が大きくならず、そのようなときにはワークの位置ずれや離脱のおそれがない。そこで、動作指令によるアーム支持部の昇降量が小さいときには減速処理を行わないようにすることにより、タクトタイムの短縮が可能になる。さらに本発明の産業用ロボットでは、減速処理は、産業用ロボットにおけるアーム支持部の昇降に関係する軸についてその軸に定められている規定値よりも小さい動作速度に基づいてその軸を駆動制御する処理であることが好ましい。アーム支持部の昇降に関係する軸についてのみその軸の速度が遅くなるように制御することにより、例えば動作指令が旋回しながらアーム支持部を降下させるものであるときに、旋回速度は低下しないので、旋回量が大きい場合などにタクトタイムが延びることを防ぐことができる。 In the industrial robot of the present invention, it is preferable that the control unit executes the deceleration process only when the hand is holding a workpiece. When the hand is not holding a workpiece, the workpiece will not be displaced or removed in the first place, so by not executing the deceleration process at such times, it is possible to shorten the takt time. In addition, it is preferable that the control unit executes the deceleration process only when the amount of lifting and lowering of the arm support part by the operation command exceeds a predetermined value. When the amount of lifting and lowering of the arm support part is small, the maximum value of the lifting and lowering speed of the hand does not become large considering the acceleration and deceleration time, and in such a case, there is no risk of the workpiece being displaced or removed. Therefore, by not executing the deceleration process when the amount of lifting and lowering of the arm support part by the operation command is small, it is possible to shorten the takt time. Furthermore, in the industrial robot of the present invention, it is preferable that the deceleration process is a process of driving and controlling an axis related to the lifting and lowering of the arm support part in the industrial robot based on an operation speed that is smaller than the specified value set for that axis. By controlling the speed of only the axis related to the raising and lowering of the arm support part to slow down, for example when an operation command is to lower the arm support part while rotating, the rotation speed does not decrease, so it is possible to prevent the tact time from being extended when the amount of rotation is large.
本発明の産業用ロボットは、基台をレールに沿って水平方向に移動させる機構を備えるものであってもよいし、垂直な回転軸の周りで基台に対して昇降機構を回転させる機構を備えるものであってもよい。さらには本発明の産業用ロボットは、アーム支持部及びアームが、アーム支持部に対するハンドの向きを所定方向に固定したままその所定方向に沿ってハンドを前進及び後退させることができる多関節機構を構成するものであってもよい。産業用ロボットの構成に応じてハンドに保持されたワークには、ハンドの移動に伴って揚力などの種々の空気力学的な力が作用するが、本発明によれば、種々の産業用ロボットにおいて、ハンドでのワークの位置ずれやハンドからのワークの離脱を防止することができる。 The industrial robot of the present invention may be equipped with a mechanism for moving the base horizontally along a rail, or may be equipped with a mechanism for rotating the lifting mechanism relative to the base around a vertical axis of rotation. Furthermore, the industrial robot of the present invention may be equipped with an articulated mechanism in which the arm support and the arm can move the hand forward and backward along a predetermined direction while fixing the orientation of the hand relative to the arm support. Depending on the configuration of the industrial robot, various aerodynamic forces such as lift act on the work held by the hand as the hand moves, but according to the present invention, it is possible to prevent the work from shifting from the hand or from coming off the hand in various industrial robots.
本発明の産業用ロボットの制御方法は、基台と、板状のワークを保持可能なハンドと、ハンドが接続され、水平面内を回転可能なアームと、アームを支持するアーム支持部と、基台に対してアーム支持部を昇降させる昇降機構と、を有し、水平面内で回転可能に前記ハンドがアームに取り付けられ、動作速度についての規定値が定められていて動作指令に応じて各軸を動作させるときに規定値で動くように各軸を制御してワークをそのワークの水平状態を保ったまま搬送する産業用ロボットの制御方法であって、ハンドがワークをそのハンドの上に保持する形式のものである場合にアーム支持部を下降させることを含む動作指令を受け取ったときに、及び、ハンドがワークをそのハンドの下に保持する形式のものである場合にアーム支持部を上昇させることを含む動作指令を受け取ったときに、規定値よりも小さな動作速度に基づいてハンドの位置を変化させる減速処理を実行する。 The control method for an industrial robot of the present invention is an industrial robot having a base, a hand capable of holding a plate-shaped workpiece, an arm to which the hand is connected and which can rotate in a horizontal plane , an arm support part supporting the arm, and a lifting mechanism for raising and lowering the arm support part relative to the base , wherein the hand is attached to the arm so as to be rotatable in a horizontal plane, and a specified value for the operating speed is set, and when each axis is operated in response to an operation command, each axis is controlled so that it moves at the specified value , thereby transporting the workpiece while maintaining its horizontal state , and when an operation command is received that includes lowering the arm support part if the hand is of a type that holds a workpiece on top of the hand, and when an operation command is received that includes raising the arm support part if the hand is of a type that holds a workpiece below the hand, a deceleration process is performed to change the position of the hand based on an operating speed that is smaller than the specified value.
本発明の産業用ロボットの制御方法では、ハンドから離れる方向にワークが風圧を受けるような動作指令を受け取ったときは、規定値よりも小さな動作速度でハンドの位置を変化させる減速処理を実行する。その結果、ハンドの移動中にワークが受ける風圧が小さくなり、ワークの位置ずれや離脱を防止することができる。また、ワークの位置ずれや離脱が起こるおそれがないときには減速処理を行わないので、全体としてタクトタイムが長くなることを最小限に抑えることができる。 In the control method for an industrial robot of the present invention, when an operational command is received that causes the workpiece to be subjected to wind pressure in a direction away from the hand, a deceleration process is executed to change the position of the hand at an operational speed slower than a specified value. As a result, the wind pressure received by the workpiece during the movement of the hand is reduced, making it possible to prevent the workpiece from shifting out of position or becoming detached. In addition, since the deceleration process is not executed when there is no risk of the workpiece becoming shifted out of position or becoming detached, it is possible to minimize the overall increase in takt time.
本発明の制御方法では、ハンドがワークを保持しているときにのみ減速処理を実行することが好ましく、また、動作指令によるアーム支持部の昇降量が所定の値を超えるときにのみ減速処理を実行することが好ましい。ハンドがワークを保持していないときや、アーム支持部の昇降量が小さくて加減速時間を考慮すればワークの昇降速度が大きくならないときは、ワークの位置ずれや離脱が起こらないので、このようなときには減速処理を行わないようにすることにより、タクトタイムの短縮が可能になる。この制御方法では、産業用ロボットにおけるアーム支持部の昇降に関係する軸についてその軸に定められている規定値よりも小さい動作速度に基づいてその軸を駆動制御する処理であることが好ましい。アーム支持部の昇降に関係する軸についてのみその軸の速度が遅くなるように制御することにより、タクトタイムが長くなることをより抑えることができる。 In the control method of the present invention, it is preferable to execute the deceleration process only when the hand is holding a workpiece, and it is also preferable to execute the deceleration process only when the amount of elevation of the arm support part by the operation command exceeds a predetermined value. When the hand is not holding a workpiece, or when the amount of elevation of the arm support part is small and the elevation speed of the workpiece does not increase considering the acceleration and deceleration time, the workpiece does not shift in position or fall off, so by not executing the deceleration process in such cases, it is possible to shorten the takt time. In this control method, it is preferable that the process is a process of driving and controlling an axis related to the elevation of the arm support part of an industrial robot based on an operating speed that is smaller than the specified value set for that axis. By controlling the speed of only the axis related to the elevation of the arm support part to be slow, it is possible to further prevent the takt time from becoming longer.
本発明によれば、大型化しかつ厚さが薄いワークを搬送するときであっても、タクトタイムが過大に長くなることを防ぎつつ、風圧の影響を抑えてハンドに確実にワークを保持することが可能になる。 According to the present invention, even when transporting large, thin workpieces, it is possible to prevent the tact time from becoming excessively long, while suppressing the effects of wind pressure and securely holding the workpiece in the hand.
次に、本発明の実施の形態について、図面を参照して説明する。図1は、本発明の実施の一形態の産業用ロボットを示す図である。この産業用ロボットは、ガラス基板などの略長方形の板状のワークを搬送することを目的とするものであって、水平多関節ロボットとしての実際の動作を行うロボット部10と、ロボット部10に対する動作指令が外部から入力し、この動作指令に基づいてロボット部10を駆動し制御する制御装置(ロボットコントローラ)40とを備えており、ロボット部10と制御装置40とはケーブルによって電気的に接続されている。ロボット部10は、ワーク50(図1には不図示)をそれぞれ保持する2つのハンド13A,13Bを備えるいわゆるダブル・ハンド・ロボットとして構成されている。図1は、ロボット部10において水平多関節機構が上昇した状態を示している。制御装置40は、動作指令が入力する制御部41と、ロボット部10に設けられている各モータ(不図示)を駆動するサーボドライバなどを含む駆動回路42とを備えている。本実施形態の産業用ロボットはワーク50の搬送に用いられるものであるので、動作指令は、基本的には、ハンド13A,13Bをどの位置に移動させるか、という指令である。したがって制御部41は、動作指令に基づいてロボット部10の軸ごとにその軸についての速度を含む指令を生成し、駆動回路42は、軸ごとの指令によってロボット部10の各軸のモータを実際に駆動する。
Next, an embodiment of the present invention will be described with reference to the drawings. FIG. 1 is a diagram showing an industrial robot according to an embodiment of the present invention. This industrial robot is intended to transport a substantially rectangular plate-shaped workpiece such as a glass substrate, and includes a
図2は、水平多関節機構が下降した状態でのロボット部10の詳細を示す図であって、(a),(b)は、それぞれ、ロボット部10の側面図及び平面図である。ロボット部10は、床面に直線で設けられた相互に平行な1対のレール21上を移動可能な基台22と、基台22の上に設けられ、基台22に内蔵されたモータ(不図示)によって、回転軸31の周りで水平面内で回転する回転台23と、回転台23に対して直立するように設けられた昇降機構24を備えている。レール21にはそれを覆うカバー25が取り付けられている。昇降機構24は、回転台23に取り付けられている固定部24Aと、不図示のモータによって固定部24Aに対して昇降する移動部24Bとを備えている。図2(a)は昇降機構24の移動部24Bがその昇降範囲での最も下に位置している状態での本実施形態のロボットを示すのに対し、図1は、移動部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が取り付けられている。
2 is a diagram showing details of the
ハンド13A,13Bは、下から保持することによって板状のワーク50を水平状態に保ったまま搬送できるように、複数の棒状部材を平行に配置したフォーク状の形状となっている。すなわちハンド13A,13Bは、ワーク50をそのハンド13A,13Bの上に保持する形式のものである。ハンド13A,13Bは、ロードロック室などに収納されているワーク50を取り出してハンド13A,13B上に保持したり、保持しているワーク50をロードロック室内などに収納するときにワーク50に対して前進または後退するが、このハンド13A,13Bの前進したり後退する方向は、棒状部材の延びる方向と平行な方向とされる。ハンド13A,13Bの左右方向すなわち前後方向に直交する方向での幅は、搬送対象のワーク50の左右方向の幅よりも短くなっている。
The
このロボットにおいて水平多関節機構は、第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とを独立して前進及び後退させることができる。
In this robot, the horizontal articulated mechanism is configured such that the
結局、本実施形態の産業用ロボットのロボット部10での動きは、レール21に沿った水平方向の移動(これをX軸あるいは走行軸の動きとする)と、鉛直軸である回転軸31の周りでの基台に対する回転(これをθ軸あるいは旋回軸の動きとする)と、ハンド13A,13Bの水平方向での前進及び後退運動(これをR軸の動きとする)と、昇降機構24によるアーム支持部26の鉛直方向での昇降(これをZ軸の動きとする)とに分解することができる。ロボット部10は、動作指令に応じた制御装置40からの駆動制御により、これらの各軸のうちの1つの軸だけを動かす動作や、2以上の軸を同時に動かす動作とを実行する。これらの軸の動きには、軸ごとにあるいは全体としての動作速度の規定値が定められている。動作速度の規定値は、対応する軸を動かすときの例えば最高速度に対応するものでであり、制御装置40の制御部41が動作指令に基づいて各軸を動作させるときは、一般に、加減速の期間を除けばその規定値で動くように各軸を制御する。なお、制御装置40は、ロボット部10内の各モータ(不図示)のサーボ制御を行なっており、各軸における動作速度の規定値は、その軸での動きの方向に依存しない。具体的にはR軸について、ハンド13A,13Bの前進運動での規定値と後退運動での規定値は同じであり、Z軸について、アーム支持部26を上昇させるときの規定値と下降させるときの規定値とは同一である。
In the end, the movement of the
本実施形態の産業用ロボットを用いたガラス基板などのワーク50の搬送について説明する。本実施形態の産業用ロボットによりワーク50を処理装置間で搬送する場合、各処理装置のカセット(あるいはロードロック室)は、水平方向にはレール21からほぼ等距離の位置に配置される。カセットの垂直方向の位置(高さ)は、昇降機構24による昇降で対応できる範囲内であれば任意である。1対のレール21からなる軌道の両側にカセットが配置されていてもよい。そして、ハンド13A上にワーク50を載置することにより搬出側の第1のカセットから搬入側の第2のカセットにワーク50を搬送するときは、ハンド13A,13Bがいずれも後退して第1アーム11A,11Bと第2アーム12A,12Bとが折り畳まれた状態で、第1のカセットに向き合う位置にまでレール21に沿ってロボット部10を移動させ、ハンド13Aの高さが第1のカセットに対応する高さとなるように、昇降機構24によってアーム支持部26を昇降させる。そして、ハンド13Aを前進させて第1のカセット内にハンド13Aを進入させ、わずかにハンド13Aを上昇させることによってハンド13A上にワーク50を載置する。その後、ハンド13Aを後退させてワーク50ごとハンド13Aを第1のカセットから引き出す。次に、ワーク50を搭載した状態で第2のカセットに向き合う位置にまでレール21に沿ってロボット部10を移動させ、ハンド13Aの高さが第2のカセットに対応する高さとなるように、昇降機構24によってアーム支持部26を昇降させる。ロボット部10をレール21に移動させているときに、同時にアーム支持部26を昇降させることも可能であり、ロボット部10に対して教示を行うときも水平移動と昇降とを同時に行わせるようにするのが一般的であり、また、その方が実際にワーク50を搬送するときのタクトタイムが短縮する。そして、ワーク50を載せたままハンド13Aを前進させて第2のカセット内にハンド13Aを進入させ、わずかにハンド13Aを下降させることによって第2のカセット内にワーク50を載置し、ハンド13Aを後退させて第2のカセットからハンド13Aを引き出す。以上の動作によって。第1のカセットから第2のカセットへワーク50が搬送されたことになる。1対のレール21からなる軌道を挟む一方の側に第1のカセットが配置し、他方の側に第2のカセットが配置しているときは、上記の動作に加え、回転軸31の周りでの回転の動作が実行される。
The following describes the transportation of a
ロボット部10によるワーク50の搬送について説明したが、搬送中に風圧によってハンド13A,13Bにおけるワーク50の位置がずれたり、ハンド13A,13Bからワーク50が脱落するおそれがある。そこで本実施形態では、ワーク50の位置ずれや落下を防ぐための制御を行なう。本実施形態の産業用ロボットでは、ワーク50はハンド13A,13Bの上に載置される。ハンド13A,13Bが水平に動いているのであれば、ワーク50にはほどんと風圧は加わらず、ワーク50の位置ずれや脱落は起こらない。ハンド13A,13Bが上昇しているときは、ハンド13A,13Bにワーク50を押し付ける方向で風圧が作用するので、ワーク50の位置ずれや脱落は起こらない。これに対しハンド13A,13Bが下降しているときは、ワーク50にはハンド13A,13B上で浮き上がり、めくられるような力が作用し、ワーク50の位置ずれや脱落が起こりやすくなる。水平運動あるいは旋回運動を伴ってワーク50が下降するときは、空気力学的な揚力がワーク50に加わるので、このときもワーク50の位置ずれや脱落が起こりやすい。
The transportation of the
そこで本実施形態では、動作指令に基づいてロボット部10を動作させるときに、その動作指令がアーム支持部26を下降させることを含む動作指令であるときに、動作速度の規定値よりも小さな動作速度(低減速度)を使用してその動作指令に基づくロボット部10の運動を制御する。アーム支持部26を下降させることを含む動作指令とは、アーム支持部23を下降させるだけすなわちZ軸だけを動かす動作指令だけでなく、Z軸を含む複数の軸を同時に動かす動作指令、例えばロボット部10を水平方向に動かしつつ(X軸を動かしつつ)同時にアーム支持部23を下降させるような動作指令も含むことを意味する。動作速度の規定値よりも小さな低減速度を使用してロボット部10の運動を制御することを減速処理と呼ぶ。減速処理では、例えば規定値の70%となる速度を低減速度とし、加減速時間を除いた期間においてロボットの少なくともZ軸が低減速度で動作するような制御が行われる。規定値からどの程度低減した値を低減速度とするかは、ロボット部10の構成(特に吸着用の部材の使用の有無やハンドにおけるワークとの接触部の材質)やワーク50のサイズなどによって適宜に定められる。軸ごとの規定値と、規定値に対する低減速度の値の比は、制御部41に予め記憶されている。減速処理において全ての軸に対して低減速度を適用してもよいが、アーム支持部23の昇降に関係するZ軸だけに低減速度を適用した方が、一般にタクトタイムが短くなる。上述したように減速処理を行わないとすればZ軸についての上昇と下降における動作速度の規定値は一般に等しいから、減速処理を行うことにより、上昇時の最高速度よりも下降時の最高速度が低くなる。
Therefore, in this embodiment, when the
図3は、本実施形態の産業用ロボットのロボット部10の制御方法を示すフローチャートであり、制御部41が減速処理を行うとき動作を示している。制御装置40に対してロボット部10に対する動作指令が入力したら、まずステップ101において制御部41は、その動作指令を解析し、どの軸をどれだけ動かすことを意図した動作指令であるかを調べる。ステップ101における動作指令の解析は、減速処理を行うか否かに関係なく、制御装置40によってロボット部10の各軸を駆動するために必要な処理である。次に制御部41は、ステップ102において、ハンド13A,13B上にワーク50が載せられている否かを判定する。ハンド13A,13B上にワーク50が載せられているか否かの判別は、ハンド13A,13B上に設けた不図示の接触センサの出力に基づいてもよいし、入力する一連の動作指令を解析した結果に基づいてもよい。ここでハンド13A,13B上にワーク50が載せられていないときは、ワーク50の位置ずれや脱落が起こり得ないときであり、したがって減速処理を行う必要がないときであるから。処理はステップ106に移行する。なお、ステップ102による判断を行わずに、ワーク50の有無によらずにアーム支持部26の下降時に減速処理を行うこととする構成も可能である。
Figure 3 is a flow chart showing a method for controlling the
ワーク50がハンド13A,13Bに載せられているとステップ102において判定したときは、制御部41は、ステップ103において、その動作指令がアーム支持部26の下降動作を含む動作指令であるかを判定する。アーム支持部26の下降動作を含まない動作指令であるときは、減速処理を行う必要がないときであるから、処理はステップ106に移行する。アーム支持部26の下降動作を含むとステップ103において判定したときは、次に、ステップ104において、その下降量が所定値以上であるか否かを判定する。カセット内でワーク50を積み下ろすときのようにアーム支持部26の下降量がわずかな場合には、加減速時間も考慮すればハンド13A,13Bの下降速度の最大値も小さくなり、そのようなときにはワーク50の位置ずれや脱落のおそれもないので、減速処理を行う必要はない。また、減速処理を行って低減速度が設定されたときは、加速度及び減速度に影響が及ぶことがある。そこで、下降量が所定値以上ではないときには、減速処理を行わないこととして、次に、ステップ106の処理を実行する。一方、アーム支持部26の下降量が所定以上の場合には、減速処理の実行のために、ステップ105の処理を実行する。なお、ステップ104による判断を行わずに、下降量によらずにアーム支持部26の下降時に減速処理を行うこととする構成も可能である。
When it is determined in
ステップ105では、制御部41は、減速処理として、ロボットの動作速度の規定値の例えば70%を低減速度とし、少なくともZ軸に対してこの低減速度を適用しながら動作指令に基づいて各軸の駆動制御を行なう。動作指令に基づく駆動制御が終われば、次の動作指令に基づく制御を実行するために、処理はステップ101に戻る。一方、ステップ106では、制御部41は、ロボットの動作速度の規定値をそのまま適用しながら動作指令に基づいて各軸の駆動制御を行ない、動作指令に基づく駆動制御が終われば、次の動作指令に基づく制御を実行するために、処理はステップ101に戻る。
In
以上説明した本実施形態の産業用ロボットでは、アーム支持部26を下降させることを含む動作指令を受け取ったときに、規定値よりも小さな動作速度(低減速度)に基づいてハンドの位置を変化させる減速処理を実行することにより、ワーク50が受ける風圧が弱くなり、ワーク50の位置ずれや脱落を防ぐことが可能になる。低減速度は、少なくともZ軸すなわちアーム支持部26を下降させる動きの制御に適用される。風圧によるワークの位置ずれや脱落を防ぐ方法として、ワークのサイズやロボットの構成に応じてロボットの動作速度の規定値自体を小さくし、すべての動作指令に対してゆっくりとロボットを動作させることも考えられるが、本実施形態では、ワーク50の位置ずれや脱落の恐れがある動作指令を実行するときにのみ減速処理を行うので、タクトタイムの増加を大きく抑えることが可能になる。
In the industrial robot of the present embodiment described above, when an operation command including lowering the
上述の産業用ロボットは、ハンド13A,13Bの上にワーク50を載置してワークを搬送するものであるが、本発明は、何らかの吸引手段や吸着手段を用いてハンド13A,13Bの下側にワーク50を保持する形式の産業用ロボットにも適用することができる。そのような場合には、アーム支持部26を上昇させることを含む動作指令を受け取ったときに、少なくともアーム支持部26の上昇に対して低減速度が適用されるように減速処理を行えばよい。
The above-mentioned industrial robot transports the
10…ロボット部;11A,11B…第1アーム;12A,12B…第2アーム;13A,13B…ハンド;21…レール;22…基台;23…回転台;24…昇降機構;24A…固定部;24B…移動部;25…カバー;26…アーム支持部;31…回転軸;32…共通軸;33A,33B…軸;34A,34B…手首軸;40…制御装置;41…制御部;42…駆動回路;50…ワーク。 10...Robot section; 11A, 11B...First arm; 12A, 12B...Second arm; 13A, 13B...Hand; 21...Rail; 22...Base; 23...Rotary table; 24...Lifting mechanism; 24A...Fixed section; 24B...Moving section; 25...Cover; 26...Arm support section; 31...Rotary axis; 32...Common axis; 33A, 33B...Axis; 34A, 34B...Wrist axis; 40...Control device; 41...Control section; 42...Drive circuit; 50...Work.
Claims (11)
基台と、
ワークを保持可能なハンドと、
前記ハンドが接続され、水平面内を回転可能なアームと、
前記アームを支持するアーム支持部と、
前記基台に対して前記アーム支持部を昇降させる昇降機構と、
動作指令に応じて各軸を動作させるときに前記各軸が前記規定値で動くようにする制御を実行し、前記ハンドの位置を変化させる制御を行なう制御部と、
を備え、
前記ハンドは、水平面内で回転可能に前記アームに取り付けられており、
前記制御部は、前記ハンドが前記ワークを当該ハンドの上に保持する形式のものである場合に前記アーム支持部を下降させることを含む前記動作指令を受け取ったときに、及び、前記ハンドが前記ワークを当該ハンドの下に保持する形式のものである場合に前記アーム支持部を上昇させることを含む前記動作指令を受け取ったときに、前記規定値よりも小さな動作速度に基づいて前記ハンドの位置を変化させる減速処理を実行する、産業用ロボット。 An industrial robot having a specified value for the operating speed and capable of transporting a plate-shaped workpiece while maintaining the workpiece in a horizontal state ,
The base and
A hand capable of holding a workpiece;
an arm to which the hand is connected and which is rotatable within a horizontal plane ;
an arm support portion that supports the arm;
a lifting mechanism for lifting and lowering the arm support part relative to the base;
a control unit that executes control so that each axis moves at the specified value when the axis is operated in response to an operation command, and controls to change the position of the hand;
Equipped with
The hand is attached to the arm so as to be rotatable within a horizontal plane,
The control unit executes a deceleration process to change the position of the hand based on an operating speed lower than the specified value when the control unit receives the operating command including lowering the arm support part if the hand is of a type that holds the workpiece on top of the hand, and when the control unit receives the operating command including raising the arm support part if the hand is of a type that holds the workpiece below the hand.
前記ハンドが前記ワークを当該ハンドの上に保持する形式のものである場合に前記アーム支持部を下降させることを含む前記動作指令を受け取ったときに、及び、前記ハンドが前記ワークを当該ハンドの下に保持する形式のものである場合に前記アーム支持部を上昇させることを含む前記動作指令を受け取ったときに、前記規定値よりも小さな動作速度に基づいて前記ハンドの位置を変化させる減速処理を実行する、産業用ロボットの制御方法。 A control method for an industrial robot comprising: a base, a hand capable of holding a plate-shaped workpiece, an arm to which the hand is connected and rotatable within a horizontal plane , an arm support section supporting the arm, and a lifting mechanism for raising and lowering the arm support section relative to the base, the hand being attached to the arm so as to be rotatable within a horizontal plane, a prescribed value for an operating speed being set, and each axis being controlled so as to move at the prescribed value when each axis is operated in response to an operation command, thereby transporting the workpiece while maintaining the horizontal state of the workpiece ,
A method for controlling an industrial robot, comprising: executing a deceleration process for changing the position of the hand based on an operating speed that is smaller than the specified value when receiving an operating command that includes lowering the arm support part if the hand is of a type that holds the workpiece on the hand; and when receiving an operating command that includes raising the arm support part if the hand is of a type that holds the workpiece below the hand.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2020165724A JP7599302B2 (en) | 2020-09-30 | 2020-09-30 | Industrial robot and control method thereof |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2020165724A JP7599302B2 (en) | 2020-09-30 | 2020-09-30 | Industrial robot and control method thereof |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2022057451A JP2022057451A (en) | 2022-04-11 |
| JP7599302B2 true JP7599302B2 (en) | 2024-12-13 |
Family
ID=81110301
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2020165724A Active JP7599302B2 (en) | 2020-09-30 | 2020-09-30 | Industrial robot and control method thereof |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7599302B2 (en) |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2008155361A (en) | 2006-07-11 | 2008-07-10 | Yaskawa Electric Corp | Articulated robot |
| JP2015217509A (en) | 2014-05-16 | 2015-12-07 | 日本電産サンキョー株式会社 | Hand for industrial robot and industrial robot |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH11340297A (en) * | 1998-05-21 | 1999-12-10 | Dainippon Screen Mfg Co Ltd | Method and device for transporting substrate |
-
2020
- 2020-09-30 JP JP2020165724A patent/JP7599302B2/en active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2008155361A (en) | 2006-07-11 | 2008-07-10 | Yaskawa Electric Corp | Articulated robot |
| JP2015217509A (en) | 2014-05-16 | 2015-12-07 | 日本電産サンキョー株式会社 | Hand for industrial robot and industrial robot |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2022057451A (en) | 2022-04-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR102115690B1 (en) | Substrate transfer robot and operation method | |
| JP5429256B2 (en) | Robot system | |
| KR101291495B1 (en) | Robot and its teaching method | |
| JP6368376B2 (en) | Wafer transfer method and apparatus | |
| CN103189168A (en) | Conveyance robot | |
| JP4485980B2 (en) | Substrate transport apparatus and substrate transport method | |
| JP2005142443A (en) | Cassette apparatus and thin substrate transfer system | |
| JP7599302B2 (en) | Industrial robot and control method thereof | |
| JP4758432B2 (en) | Work storage device | |
| KR101333891B1 (en) | Method for substrate carrying-in/carrying-out and substrate carrying-in/carrying-out system | |
| JP4542998B2 (en) | Substrate loading / unloading assist device | |
| JP7610947B2 (en) | Industrial robot and control method thereof | |
| JP4633294B2 (en) | Transfer robot transfer type transfer device and transfer robot transfer method | |
| JP4772530B2 (en) | Substrate carry-in / carry-in method and substrate carry-in / carry-in system | |
| JP7514154B2 (en) | Industrial robot and control method thereof | |
| CN113727813B (en) | Substrate transport robot and control method of substrate transport robot | |
| KR20230106662A (en) | Robots and teaching methods | |
| JP2023081152A (en) | INDUSTRIAL ROBOT AND INDUSTRIAL ROBOT TEACHING METHOD | |
| JP4316336B2 (en) | Component mounting head and component mounting apparatus | |
| KR102851943B1 (en) | Apparatus for transferring wafer | |
| JP2019220651A (en) | Substrate transfer device and operation method of the same | |
| US20240158182A1 (en) | Transport apparatus | |
| JP4597810B2 (en) | Substrate processing apparatus and substrate transfer method | |
| CN119404301A (en) | Robot system, robot control method, and robot control program | |
| KR20230099611A (en) | Appratus for transferring and mehod of transferring |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20230808 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20240313 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20240326 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20240723 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20240924 |
|
| 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: 20241119 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20241203 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7599302 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |