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
JP7599302B2 - Industrial robot and control method thereof - Google Patents
[go: Go Back, main page]

JP7599302B2 - Industrial robot and control method thereof - Google Patents

Industrial robot and control method thereof Download PDF

Info

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
Application number
JP2020165724A
Other languages
Japanese (ja)
Other versions
JP2022057451A (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 JP2020165724A priority Critical patent/JP7599302B2/en
Publication of JP2022057451A publication Critical patent/JP2022057451A/en
Application granted granted Critical
Publication of JP7599302B2 publication Critical patent/JP7599302B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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.

特開2015-217509号公報JP 2015-217509 A

ワークが大型化しかつ厚さが薄くなるにつれ、ロボットによるワークの搬送中にワークが受ける風圧の影響を無視できなくなってきている。ハンド上にワークを保持して搬送するロボットの場合、風圧を受けたワークがハンド上でめくられるように動き、その結果、ハンド上でのワークの位置が変化したり、はなはだしい場合にはハンドからワークが落下することがある。ハンド上でワークの位置を固定するために吸着パッドが設けられることもあるが、風圧によって発生する力は、吸着パッドとワークの間をこじ開けるような力であるので、この力によって吸着パッドからワークが離脱することもある。風圧の影響を低減するためには、ハンドの移動速度、すなわちロボットの移動速度を低下させればよいが、そうすると、ワークの搬送に要する時間が長くなり、タクトタイムが長くなる。 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 is a diagram showing a configuration of an industrial robot according to an embodiment of the present invention; (a),(b)はそれぞれロボット部の側面図及び平面図である。1A and 1B are a side view and a plan view, respectively, of the robot part. ロボット部の動作速度の制御方法を示すフローチャートである。10 is a flowchart showing a method for controlling the movement speed of the robot unit.

次に、本発明の実施の形態について、図面を参照して説明する。図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 robot section 10 that performs actual operations as a horizontal articulated robot, and a control device (robot controller) 40 that receives operation commands for the robot section 10 from the outside and drives and controls the robot section 10 based on the operation commands, and the robot section 10 and the control device 40 are electrically connected by a cable. The robot section 10 is configured as a so-called double-handed robot that includes two hands 13A and 13B that each hold a workpiece 50 (not shown in FIG. 1). FIG. 1 shows a state in which the horizontal articulated mechanism is raised in the robot section 10. The control device 40 includes a control section 41 to which operation commands are input, and a drive circuit 42 including a servo driver that drives each motor (not shown) provided in the robot section 10. Since the industrial robot of this embodiment is used to transport the workpiece 50, the operation command is basically a command to move the hands 13A and 13B to a certain position. Therefore, the control unit 41 generates a command including the speed for each axis of the robot unit 10 based on the operation command, and the drive circuit 42 actually drives the motor of each axis of the robot unit 10 based on the command for each axis.

図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 robot part 10 in a state where the horizontal articulated mechanism is lowered, and (a) and (b) are a side view and a plan view of the robot part 10, respectively. The robot part 10 is equipped with a base 22 that can move on a pair of parallel rails 21 that are provided in a straight line on the floor surface, a rotating table 23 that is provided on the base 22 and rotates in a horizontal plane around a rotating shaft 31 by a motor (not shown) built into the base 22, and a lifting mechanism 24 that is provided upright relative to the rotating table 23. A cover 25 that covers the rail 21 is attached. The lifting mechanism 24 is equipped with a fixed part 24A that is attached to the rotating table 23 and a moving part 24B that moves up and down relative to the fixed part 24A by a motor (not shown). FIG. 2(a) shows the robot of this embodiment in a state where the moving part 24B of the lifting mechanism 24 is located at the lowest position in its lifting range, while FIG. 1 shows the robot in a state where the moving part 24B is raised. The moving section 24B is provided with an arm support section 26 that holds the horizontal multi-joint mechanism, which extends horizontally, and two sets of horizontal multi-joint mechanisms are attached to the tip of the arm support section 26 in an array in the vertical direction. The upper horizontal multi-joint mechanism includes a first arm 11A that is attached to the arm support section 26 and can rotate in a horizontal plane around a common axis 32, and a second arm 12A that is attached to the tip of the first arm 11A and can rotate in a horizontal plane around an axis 33A, and a hand 13A is attached to the tip of the second arm 12A. Similarly, the lower horizontal multi-joint mechanism includes a first arm 11B that is attached to the arm support section 26 and can rotate in a horizontal plane around a common axis 32, and a second arm 12B that is attached to the tip of the first arm 11B and can rotate in a horizontal plane around an axis 33B, and a hand 13B is attached to the tip of the second arm 12B.

ハンド13A,13Bは、下から保持することによって板状のワーク50を水平状態に保ったまま搬送できるように、複数の棒状部材を平行に配置したフォーク状の形状となっている。すなわちハンド13A,13Bは、ワーク50をそのハンド13A,13Bの上に保持する形式のものである。ハンド13A,13Bは、ロードロック室などに収納されているワーク50を取り出してハンド13A,13B上に保持したり、保持しているワーク50をロードロック室内などに収納するときにワーク50に対して前進または後退するが、このハンド13A,13Bの前進したり後退する方向は、棒状部材の延びる方向と平行な方向とされる。ハンド13A,13Bの左右方向すなわち前後方向に直交する方向での幅は、搬送対象のワーク50の左右方向の幅よりも短くなっている。 The hands 13A and 13B are fork-shaped with multiple rod-shaped members arranged in parallel so that the plate-shaped workpiece 50 can be transported while being kept horizontal by holding it from below. That is, the hands 13A and 13B are of a type that holds the workpiece 50 on the hands 13A and 13B. The hands 13A and 13B move forward or backward relative to the workpiece 50 when taking out the workpiece 50 stored in a load lock chamber or the like and holding it on the hands 13A and 13B, or storing the held workpiece 50 in a load lock chamber or the like, and the direction in which the hands 13A and 13B move forward or backward is parallel to the direction in which the rod-shaped members extend. The width of the hands 13A and 13B in the left-right direction, i.e., the direction perpendicular to the front-back direction, is shorter than the left-right width of the workpiece 50 to be transported.

このロボットにおいて水平多関節機構は、第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 hands 13A, 13B move forward and backward in a linear motion perpendicular to the direction in which the arm support 26 extends, by a link mechanism incorporated in the first arm 11A, 11B and the second arm 12A, 12B. In other words, both hands 13A, 13B move forward and backward in the same direction. The movement of the tips of the hands 13A, 13B away from the central axis 32 is forward movement, and the movement in the opposite direction to the forward movement is backward movement. The first arms 11A, 11B and the second arms 12A, 12B perform bending movements as a whole, and in order to keep the orientation of the hands 13A, 13B constant in the horizontal plane, the hands 13A, 13B are attached at the tips of the second arms 12A, 12B so as to be rotatable in the horizontal plane around the wrist axes 34A, 34B, respectively. In the upper horizontal multi-joint mechanism, a motor (not shown) provided on the arm support section 26 is driven to move the first arm 11A and the second arm 12A, and the hand 13A moves in a direction perpendicular to the extension direction of the arm support section 26 while maintaining its orientation. Similarly, in the lower horizontal multi-joint mechanism, a motor (not shown) provided on the arm support section 26 is driven to move the first arm 11B and the second arm 12B, and the hand 13B moves in a direction perpendicular to the extension direction of the arm support section 26 while maintaining its orientation. In this robot, the hands 13A and 13B can be moved forward and backward independently.

結局、本実施形態の産業用ロボットのロボット部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 robot section 10 of the industrial robot of this embodiment can be broken down into horizontal movement along the rail 21 (this is the X-axis or travel axis movement), rotation around the vertical axis of rotation 31 relative to the base (this is the θ-axis or pivot axis movement), horizontal forward and backward movement of the hands 13A and 13B (this is the R-axis movement), and vertical lifting and lowering of the arm support section 26 by the lifting mechanism 24 (this is the Z-axis movement). The robot section 10 executes an operation to move only one of these axes or an operation to move two or more axes simultaneously by drive control from the control device 40 in response to an operation command. A specified value of the operating speed is set for each axis or for the entire axis for the movements of these axes. The specified value of the operating speed corresponds to, for example, the maximum speed when moving the corresponding axis, and when the control section 41 of the control device 40 operates each axis based on an operation command, it generally controls each axis to move at the specified value except for the period of acceleration and deceleration. The control device 40 performs servo control of each motor (not shown) in the robot unit 10, and the specified value of the operating speed for each axis does not depend on the direction of movement on that axis. Specifically, for the R axis, the specified value for the forward movement of the hands 13A, 13B is the same as the specified value for the backward movement, and for the Z axis, the specified value for raising the arm support unit 26 is the same as the specified value for lowering it.

本実施形態の産業用ロボットを用いたガラス基板などのワーク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 workpiece 50 such as a glass substrate using the industrial robot of this embodiment. When the industrial robot of this embodiment transports the workpiece 50 between processing devices, the cassettes (or load lock chambers) of each processing device are arranged at approximately equal distances from the rail 21 in the horizontal direction. The vertical position (height) of the cassette is arbitrary as long as it is within a range that can be handled by the lifting mechanism 24. The cassettes may be arranged on both sides of a track consisting of a pair of rails 21. When the workpiece 50 is transported from the first cassette on the unloading side to the second cassette on the loading side by placing the workpiece 50 on the hand 13A, the robot unit 10 is moved along the rail 21 to a position facing the first cassette with both hands 13A and 13B retreated and the first arms 11A and 11B and the second arms 12A and 12B folded, and the arm support unit 26 is raised and lowered by the lifting mechanism 24 so that the height of the hand 13A corresponds to the height of the first cassette. Then, the hand 13A is advanced to enter the first cassette, and the hand 13A is raised slightly to place the workpiece 50 on the hand 13A. After that, the hand 13A is retracted to pull the hand 13A together with the workpiece 50 out of the first cassette. Next, the robot unit 10 is moved along the rail 21 to a position facing the second cassette with the workpiece 50 mounted thereon, and the arm support unit 26 is raised and lowered by the lifting mechanism 24 so that the height of the hand 13A corresponds to the height of the second cassette. When the robot unit 10 is moved to the rail 21, the arm support unit 26 can be raised and lowered at the same time. When teaching the robot unit 10, it is common to simultaneously perform horizontal movement and lifting and lowering, and this shortens the tact time when actually transporting the workpiece 50. Then, with the workpiece 50 still on it, the hand 13A is advanced to enter the second cassette, the hand 13A is lowered slightly to place the workpiece 50 in the second cassette, and the hand 13A is then retracted to pull the hand 13A out of the second cassette. Through the above operations, the workpiece 50 is transported from the first cassette to the second cassette. When the first cassette is placed on one side of the track consisting of a pair of rails 21 and the second cassette is placed on the other side, in addition to the above operations, a rotation operation around the rotation axis 31 is performed.

ロボット部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 workpiece 50 by the robot unit 10 has been described, but there is a risk that the position of the workpiece 50 on the hands 13A and 13B may shift or fall off from the hands 13A and 13B due to wind pressure during transportation. Therefore, in this embodiment, control is performed to prevent the workpiece 50 from shifting or falling off. In the industrial robot of this embodiment, the workpiece 50 is placed on the hands 13A and 13B. If the hands 13A and 13B are moving horizontally, almost no wind pressure is applied to the workpiece 50, and the workpiece 50 does not shift or fall off. When the hands 13A and 13B are rising, wind pressure acts in a direction that presses the workpiece 50 against the hands 13A and 13B, so the workpiece 50 does not shift or fall off. On the other hand, when the hands 13A and 13B are descending, the workpiece 50 is lifted up on the hands 13A and 13B, and a force that turns it over acts on the workpiece 50, making it easier for the workpiece 50 to shift or fall off. When the workpiece 50 descends with horizontal or rotating motion, aerodynamic lift is applied to the workpiece 50, so the workpiece 50 is also prone to shifting or falling off.

そこで本実施形態では、動作指令に基づいてロボット部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 robot part 10 is operated based on a motion command, if the motion command includes lowering the arm support part 26, the motion of the robot part 10 based on the motion command is controlled using a motion speed (reduced speed) smaller than the specified value of the motion speed. A motion command including lowering the arm support part 26 means not only a motion command to only lower the arm support part 23, i.e., to move only the Z axis, but also a motion command to simultaneously move multiple axes including the Z axis, for example, a motion command to move the robot part 10 horizontally (while moving the X axis) and lower the arm support part 23 at the same time. Controlling the motion of the robot part 10 using a reduced speed smaller than the specified value of the motion speed is called deceleration processing. In deceleration processing, for example, a speed that is 70% of the specified value is set as the reduced speed, and control is performed so that at least the Z axis of the robot operates at the reduced speed during the period excluding the acceleration and deceleration time. The extent to which the reduced speed is reduced from the specified value is determined appropriately depending on the configuration of the robot part 10 (especially whether or not a member for suction is used and the material of the contact part of the hand with the workpiece) and the size of the workpiece 50. The specified value for each axis and the ratio of the reduced speed value to the specified value are stored in advance in the control unit 41. Although the reduced speed may be applied to all axes in the deceleration process, applying the reduced speed only to the Z axis related to the raising and lowering of the arm support unit 23 generally shortens the takt time. As described above, if the deceleration process is not performed, the specified values for the operating speeds for the rising and lowering of the Z axis are generally equal, so by performing the deceleration process, the maximum speed during descent is lower than the maximum speed during ascent.

図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 robot section 10 of the industrial robot of this embodiment, and shows the operation when the control section 41 performs deceleration processing. When an operation command for the robot section 10 is input to the control device 40, first in step 101, the control section 41 analyzes the operation command and checks which axis is intended to be moved and how much. The analysis of the operation command in step 101 is a process necessary for the control device 40 to drive each axis of the robot section 10, regardless of whether deceleration processing is performed or not. Next, in step 102, the control section 41 determines whether the workpiece 50 is placed on the hands 13A and 13B. The determination of whether the workpiece 50 is placed on the hands 13A and 13B may be based on the output of a contact sensor (not shown) provided on the hands 13A and 13B, or may be based on the result of analyzing a series of input operation commands. Here, when the workpiece 50 is not placed on the hands 13A and 13B, the workpiece 50 cannot be displaced or fall off, and therefore there is no need to perform deceleration processing. The process proceeds to step 106. It is also possible to configure the system so that deceleration processing is performed when the arm support portion 26 descends, regardless of whether or not a workpiece 50 is present, without making the determination in step 102.

ワーク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 step 102 that the workpiece 50 is placed on the hands 13A and 13B, the control unit 41 determines in step 103 whether the operation command is an operation command including the lowering operation of the arm support unit 26. When the operation command does not include the lowering operation of the arm support unit 26, it is not necessary to perform the deceleration process, and the process proceeds to step 106. When it is determined in step 103 that the operation command includes the lowering operation of the arm support unit 26, it is next determined in step 104 whether the lowering amount is equal to or greater than a predetermined value. When the lowering amount of the arm support unit 26 is small, such as when unloading the workpiece 50 in a cassette, the maximum value of the lowering speed of the hands 13A and 13B is also small when the acceleration and deceleration time is taken into consideration, and in such a case, there is no risk of the workpiece 50 being displaced or falling off, so there is no need to perform the deceleration process. In addition, when the reduction speed is set by performing the deceleration process, the acceleration and deceleration may be affected. Therefore, when the lowering amount is not equal to or greater than the predetermined value, the deceleration process is not performed, and the process of step 106 is then executed. On the other hand, if the amount of descent of the arm support part 26 is equal to or greater than a predetermined amount, the process of step 105 is executed to execute the deceleration process. Note that it is also possible to configure the system so that the deceleration process is executed when the arm support part 26 is lowered, regardless of the amount of descent, without making the determination in step 104.

ステップ105では、制御部41は、減速処理として、ロボットの動作速度の規定値の例えば70%を低減速度とし、少なくともZ軸に対してこの低減速度を適用しながら動作指令に基づいて各軸の駆動制御を行なう。動作指令に基づく駆動制御が終われば、次の動作指令に基づく制御を実行するために、処理はステップ101に戻る。一方、ステップ106では、制御部41は、ロボットの動作速度の規定値をそのまま適用しながら動作指令に基づいて各軸の駆動制御を行ない、動作指令に基づく駆動制御が終われば、次の動作指令に基づく制御を実行するために、処理はステップ101に戻る。 In step 105, the control unit 41 performs deceleration processing by setting the reduced speed to, for example, 70% of the specified value of the robot's motion speed, and performs drive control of each axis based on the motion command while applying this reduced speed to at least the Z axis. When drive control based on the motion command is completed, the process returns to step 101 to execute control based on the next motion command. On the other hand, in step 106, the control unit 41 performs drive control of each axis based on the motion command while still applying the specified value of the robot's motion speed, and when drive control based on the motion command is completed, the process returns to step 101 to execute control based on the next motion command.

以上説明した本実施形態の産業用ロボットでは、アーム支持部26を下降させることを含む動作指令を受け取ったときに、規定値よりも小さな動作速度(低減速度)に基づいてハンドの位置を変化させる減速処理を実行することにより、ワーク50が受ける風圧が弱くなり、ワーク50の位置ずれや脱落を防ぐことが可能になる。低減速度は、少なくともZ軸すなわちアーム支持部26を下降させる動きの制御に適用される。風圧によるワークの位置ずれや脱落を防ぐ方法として、ワークのサイズやロボットの構成に応じてロボットの動作速度の規定値自体を小さくし、すべての動作指令に対してゆっくりとロボットを動作させることも考えられるが、本実施形態では、ワーク50の位置ずれや脱落の恐れがある動作指令を実行するときにのみ減速処理を行うので、タクトタイムの増加を大きく抑えることが可能になる。 In the industrial robot of the present embodiment described above, when an operation command including lowering the arm support portion 26 is received, a deceleration process is performed to change the position of the hand based on an operation speed (reduced speed) that is smaller than the specified value, thereby weakening the wind pressure received by the workpiece 50 and preventing the workpiece 50 from being displaced or falling off. The reduced speed is applied to at least the Z axis, i.e., to control the movement of lowering the arm support portion 26. As a method of preventing the workpiece from being displaced or falling off due to wind pressure, it is possible to reduce the specified value of the robot's operation speed itself depending on the size of the workpiece and the configuration of the robot, and operate the robot slowly for all operation commands. However, in this embodiment, the deceleration process is performed only when an operation command that may cause the workpiece 50 to be displaced or fall off is executed, making it possible to significantly suppress an increase in takt time.

上述の産業用ロボットは、ハンド13A,13Bの上にワーク50を載置してワークを搬送するものであるが、本発明は、何らかの吸引手段や吸着手段を用いてハンド13A,13Bの下側にワーク50を保持する形式の産業用ロボットにも適用することができる。そのような場合には、アーム支持部26を上昇させることを含む動作指令を受け取ったときに、少なくともアーム支持部26の上昇に対して低減速度が適用されるように減速処理を行えばよい。 The above-mentioned industrial robot transports the workpiece 50 by placing it on the hands 13A and 13B, but the present invention can also be applied to industrial robots that use some kind of suction or adsorption means to hold the workpiece 50 below the hands 13A and 13B. In such cases, when an operation command including lifting the arm support part 26 is received, deceleration processing can be performed so that a reduced speed is applied to at least the lifting of the arm support part 26.

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.
前記制御部は、前記ハンドが前記ワークを保持しているときにのみ前記減速処理を実行する、請求項1に記載の産業用ロボット。 The industrial robot according to claim 1, wherein the control unit executes the deceleration process only when the hand is holding the workpiece. 前記制御部は、前記動作指令による前記アーム支持部の昇降量が所定の値を超えるときにのみ前記減速処理を実行する、請求項1または2に記載の産業用ロボット。 The industrial robot according to claim 1 or 2, wherein the control unit executes the deceleration process only when the amount of lift of the arm support unit in response to the operation command exceeds a predetermined value. 前記減速処理は、前記産業用ロボットにおける前記アーム支持部の昇降に関係する軸について当該軸に定められている規定値よりも小さい動作速度に基づいて当該軸を駆動制御する処理である、請求項1乃至3のいずれか1項に記載の産業用ロボット。 The industrial robot according to any one of claims 1 to 3, wherein the deceleration process is a process of controlling the drive of an axis related to the elevation of the arm support part of the industrial robot based on an operating speed that is lower than a specified value set for that axis. 前記基台をレールに沿って水平方向に移動させる機構を備える、請求項1乃至4のいずれか1項に記載の産業用ロボット。 The industrial robot according to any one of claims 1 to 4, further comprising a mechanism for moving the base horizontally along a rail. 垂直な回転軸の周りで前記基台に対して前記昇降機構を回転させる機構を備える、請求項1乃至5のいずれか1項に記載の産業用ロボット。 The industrial robot according to any one of claims 1 to 5, further comprising a mechanism for rotating the lifting mechanism relative to the base about a vertical axis of rotation. 前記アーム支持部及び前記アームは、前記アーム支持部に対する前記ハンドの向きを所定方向に固定したまま前記所定方向に沿って前記ハンドを前進及び後退させることができる多関節機構を構成する、請求項1乃至6のいずれか1項に記載の産業用ロボット。 The industrial robot according to any one of claims 1 to 6, wherein the arm support and the arm form a multi-joint mechanism that can move the hand forward and backward along a predetermined direction while fixing the orientation of the hand relative to the arm support in the predetermined direction. 基台と、板状のワークを保持可能なハンドと、前記ハンドが接続され、水平面内を回転可能なアームと、前記アームを支持するアーム支持部と、前記基台に対して前記アーム支持部を昇降させる昇降機構と、を有し、水平面内で回転可能に前記ハンドが前記アームに取り付けられ、動作速度についての規定値が定められていて動作指令に応じて各軸を動作させるときに前記規定値で動くように前記各軸を制御して前記ワークを当該ワークの水平状態を保ったまま搬送する産業用ロボットの制御方法であって、
前記ハンドが前記ワークを当該ハンドの上に保持する形式のものである場合に前記アーム支持部を下降させることを含む前記動作指令を受け取ったときに、及び、前記ハンドが前記ワークを当該ハンドの下に保持する形式のものである場合に前記アーム支持部を上昇させることを含む前記動作指令を受け取ったときに、前記規定値よりも小さな動作速度に基づいて前記ハンドの位置を変化させる減速処理を実行する、産業用ロボットの制御方法。
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.
前記ハンドが前記ワークを保持しているときにのみ前記減速処理を実行する、請求項7に記載の産業用ロボットの制御方法。 The method for controlling an industrial robot according to claim 7, wherein the deceleration process is performed only when the hand is holding the workpiece. 前記動作指令による前記アーム支持部の昇降量が所定の値を超えるときにのみ前記減速処理を実行する、請求項7または8に記載の産業用ロボットの制御方法。 The method for controlling an industrial robot according to claim 7 or 8, wherein the deceleration process is executed only when the amount of lift of the arm support part in response to the operation command exceeds a predetermined value. 前記減速処理は、前記産業用ロボットにおける前記アーム支持部の昇降に関係する軸について当該軸に定められている規定値よりも小さい動作速度に基づいて当該軸を駆動制御する処理である、請求項8乃至10のいずれか1項に記載の産業用ロボットの制御方法。 The method for controlling an industrial robot according to any one of claims 8 to 10, wherein the deceleration process is a process for controlling the drive of an axis related to the elevation of the arm support part of the industrial robot based on an operating speed that is lower than a specified value set for that axis.
JP2020165724A 2020-09-30 2020-09-30 Industrial robot and control method thereof Active JP7599302B2 (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (2)

* Cited by examiner, † Cited by third party
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