JP2008302455A - Carrier robot system - Google Patents
Carrier robot system Download PDFInfo
- Publication number
- JP2008302455A JP2008302455A JP2007151001A JP2007151001A JP2008302455A JP 2008302455 A JP2008302455 A JP 2008302455A JP 2007151001 A JP2007151001 A JP 2007151001A JP 2007151001 A JP2007151001 A JP 2007151001A JP 2008302455 A JP2008302455 A JP 2008302455A
- Authority
- JP
- Japan
- Prior art keywords
- acceleration
- teaching
- difference
- actual
- hand
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Landscapes
- Manipulator (AREA)
Abstract
Description
本発明は、搬送ロボットシステムに関して、搬送における教示位置のずれ量を補正する技術に関する。 The present invention relates to a technique for correcting a deviation amount of a teaching position in conveyance with respect to a conveyance robot system.
従来、例えば液晶基板等のワークをカセットからワークステーションへ搬送する搬送ロボットは公知である。搬送ロボットは、ベースと、回転駆動、上下駆動及び伸縮可能に連接される複数のアームと、被搬送物を保持するハンドとで構成される。ロボットコントローラは、搬送ロボットのアームの各駆動部を制御することで、ワークをハンドに載置し、カセットからワークステーションへ搬送する。搬送ロボットシステムは、1台の搬送ロボットと、この搬送ロボットを制御するロボットコントローラからなるシステムをいう。 Conventionally, a transfer robot that transfers a workpiece such as a liquid crystal substrate from a cassette to a workstation is known. The transfer robot includes a base, a plurality of arms that are connected to be rotationally driven, vertically driven, and extendable and a hand that holds an object to be conveyed. The robot controller controls each drive unit of the arm of the transfer robot to place the work on the hand and transfer the work from the cassette to the work station. The transfer robot system is a system composed of one transfer robot and a robot controller that controls the transfer robot.
ワークは、搬送ロボットによって、正確な教示位置に搬送されることが要求される。
例えば、ハンドのワークを載置する基準位置と、ワークの実際の載置位置(実載置位置)とには、ずれが生じる場合がある。この課題を解決するために、ワークのハンドに対するアライメント機能(載置位置補正手段)が公知となっている。アライメント機能とは、搬送ロボットのワーク搬送中において、ワークステーション内に設けられたセンサー上にワークを通過させてハンドの基準位置に対するワークのずれ量を確認し、このずれ量をフィードバックして位置補正する機能である。
特許文献1は、このアライメント機能を用いて搬送速度及び加速度を最適化する搬送ロボットシステムを開示している。
For example, there may be a difference between the reference position on which the workpiece of the hand is placed and the actual placement position (actual placement position) of the workpiece. In order to solve this problem, an alignment function (mounting position correcting means) for a work hand is known. With the alignment function, during workpiece transfer by the transfer robot, the workpiece is passed over the sensor provided in the workstation, the amount of workpiece displacement relative to the reference position of the hand is confirmed, and this displacement amount is fed back to correct the position. It is a function to do.
Patent Document 1 discloses a transport robot system that optimizes the transport speed and acceleration using this alignment function.
近年、搬送するワークが大型化し、重量も増加している。また、それに伴い、搬送ロボットのアーム長さも長くなっている。そのため、搬送中の搬送ロボットのアームにたわみが生じることで、教示位置にずれが生じることがある。このアームのたわみによるずれ量は、前述するアライメント機能では検出することができない。
そこで、解決しようとする課題は、簡易な構成で、アームのたわみによる教示位置のずれ量を補正できる搬送ロボットシステムを提供することである。
In recent years, workpieces to be transported have become larger and weight has increased. Along with this, the arm length of the transfer robot is also increased. For this reason, the teaching position may be displaced due to the deflection of the arm of the transfer robot during transfer. The deviation due to the deflection of the arm cannot be detected by the alignment function described above.
Therefore, the problem to be solved is to provide a transfer robot system that can correct the deviation amount of the teaching position due to the deflection of the arm with a simple configuration.
本発明の解決しようとする課題は以上の如くであり、次にこの課題を解決するための手段を説明する。 The problem to be solved by the present invention is as described above. Next, means for solving the problem will be described.
即ち、請求項1においては、ワークを載置保持するハンドと、前記ハンドを変位可能に構成されるアームと、前記ハンドに対するワークの基準載置位置と実載置位置との差分を検出する載置位置差分検出手段と、前記アームの実位置と教示位置との差分を補正する教示位置補正手段と、を有する搬送ロボットシステムにおいて、前記ハンドに備えられる加速度センサーと、搬送過程において前記加速度センサーによって検出される実加速度と予め指示された教示加速度との差分を算出する加速度差分算出手段と、を具備し、前記教示位置補正手段は、前記加速度差分に基づいて実位置を教示位置に補正するものである。 That is, according to the first aspect of the present invention, a hand for placing and holding a workpiece, an arm configured to displace the hand, and a loading for detecting a difference between a reference placement position and an actual placement position of the workpiece with respect to the hand. In a transfer robot system having a position difference detection means and a teaching position correction means for correcting a difference between the actual position of the arm and the teaching position, an acceleration sensor provided in the hand, and an acceleration sensor in the transfer process by the acceleration sensor Acceleration difference calculating means for calculating a difference between the detected actual acceleration and a pre-instructed teaching acceleration, and the teaching position correcting means corrects the actual position to the teaching position based on the acceleration difference. It is.
請求項2においては、請求項1記載の搬送ロボットシステムにおいて、前記載置位置差分を、前記位置差分検出手段によって載置位置差分を検出するときの前記加速度センサーによって検出される加速度に基づいて補正するものである。 According to a second aspect of the present invention, in the transport robot system according to the first aspect, the placement position difference is corrected based on an acceleration detected by the acceleration sensor when the placement position difference is detected by the position difference detection unit. To do.
本発明の効果として、以下に示すような効果を奏する。 As effects of the present invention, the following effects can be obtained.
請求項1においては、加速度センサーによって検出される加速度と予め指示された教示加速度とから、アームのたわみによる実位置と教示位置とのずれ量を検出し、実位置を教示位置に補正することができる。つまり、加速度センサーを設けるのみの簡易な構成によって、アームのたわみによるずれを補正できる。 According to a first aspect of the present invention, the amount of deviation between the actual position and the taught position due to the deflection of the arm is detected from the acceleration detected by the acceleration sensor and the instruction acceleration specified in advance, and the actual position is corrected to the taught position. it can. That is, it is possible to correct the deviation due to the deflection of the arm with a simple configuration in which only the acceleration sensor is provided.
請求項2においては、載置位置差分検出手段による載置位置計測時に、搬送ロボットを定速又は停止する必要がないため、搬送ロボットの作業時間を可及的に短縮できる。 According to the second aspect of the present invention, since it is not necessary to keep the transport robot at a constant speed or stop when the mounting position difference is detected by the mounting position difference detection means, the working time of the transport robot can be shortened as much as possible.
次に、発明の実施の形態を説明する。
図1は本発明の実施例に係る搬送ロボットシステムの全体的な構成を示す平面構成図、図2は同じく搬送ロボットの全体的な構成を示す斜視構成図、図3は同じく載置位置検出手段を示す平面構成図である。図4は同じくアームのたわみによるハンドの教示位置に対するずれを示すグラフ図、図5は同じくハンドの加速度差分を示すグラフ図、図6は同じくロボットコントローラの構成を示す構成図である。図7は同じく載置位置補正制御のタイムチャートを示すグラフ図、図8は同じくx成分の誤差テーブルを示すテーブル図である。
Next, embodiments of the invention will be described.
FIG. 1 is a plan view showing the overall structure of a transfer robot system according to an embodiment of the present invention, FIG. 2 is a perspective view showing the overall structure of the transfer robot, and FIG. FIG. 4 is a graph showing the displacement of the hand relative to the teaching position due to the deflection of the arm, FIG. 5 is a graph showing the acceleration difference of the hand, and FIG. 6 is a block diagram showing the configuration of the robot controller. FIG. 7 is a graph showing a time chart of the placement position correction control, and FIG. 8 is a table showing the error table for the x component.
まず、図1を用いて、本実施例である搬送ロボットシステム1について、簡単に説明する。
図1に示すように、搬送ロボットシステム1は、搬送ロボット10によりカセット4からワークセット位置3に向かって、ワーク6を搬送するシステムである。本実施例のワーク6は、液晶FPD用基板としている。つまり、ワーク6は、1辺が3〜4m以上の基板である。一方、カセット4は、複数枚のワーク6を上下平行に収容できる棚状のケースである。他方、ワークセット位置3は、ワーク6を次工程へ移すために一時載置するステーション位置である。
また、搬送ロボットシステム1は、搬送ロボット2の搬送途上において、載置位置検出手段としてのアライメント装置5を備えている。このアライメント装置5について、詳しくは後述する。
このような構成とすることで、搬送ロボットシステム1は、カセット4に収容されるワーク6を取り出し、アライメント装置5上を通過してワークセット位置3まで搬送する。
First, the transfer robot system 1 according to the present embodiment will be briefly described with reference to FIG.
As shown in FIG. 1, the transfer robot system 1 is a system that transfers a workpiece 6 from a cassette 4 toward a workpiece setting position 3 by a transfer robot 10. The workpiece 6 of this embodiment is a liquid crystal FPD substrate. That is, the workpiece 6 is a substrate having a side of 3 to 4 m or more. On the other hand, the cassette 4 is a shelf-like case that can accommodate a plurality of workpieces 6 vertically in parallel. On the other hand, the work set position 3 is a station position where the work 6 is temporarily placed in order to move to the next process.
In addition, the transfer robot system 1 includes an alignment device 5 serving as a placement position detection unit during the transfer of the transfer robot 2. The alignment device 5 will be described in detail later.
With such a configuration, the transfer robot system 1 takes out the workpiece 6 accommodated in the cassette 4, passes the alignment device 5, and transfers it to the workpiece setting position 3.
次に、図2を用いて、搬送ロボット10について、詳細に説明する。
図2に示すように、搬送ロボット10は、ロボットコントローラシステム20によって制御され、搬送作業を行う。
ロボットコントローラシステム20は、制御のための指令値又は設定値等を出力できるモニター21を備えている。
搬送ロボット10は、円筒座標系のロボットであり、直円筒形のベース17と、ベース17の上端に回転駆動および上下駆動可能に装着された第1アーム16と、該第1アーム16の延出端に回転駆動可能に装着された第2アーム15と、第2アーム15の延出端に回転駆動可能に装着されて、ワーク6(図示略)を保持するハンド12とで構成されている。
Next, the transfer robot 10 will be described in detail with reference to FIG.
As shown in FIG. 2, the transfer robot 10 is controlled by the robot controller system 20 and performs a transfer operation.
The robot controller system 20 includes a monitor 21 that can output a command value or a set value for control.
The transfer robot 10 is a cylindrical coordinate system robot, a right cylindrical base 17, a first arm 16 mounted on the upper end of the base 17 so as to be rotatable and vertically movable, and an extension of the first arm 16. The second arm 15 is rotatably mounted on the end, and the hand 12 is rotatably mounted on the extended end of the second arm 15 and holds the workpiece 6 (not shown).
アーム15・16及びハンド12を動かすアクチュエータ18・19は、モータ等で構成され、それぞれ回動軸部に配置されている。アクチュエータ18・19は、モータドライブ(図示略)を介してロボットコントローラ25から送られてきた指令信号(駆動信号)に基づいて駆動される。
ハンド12は、ワーク6を下支えする長尺状のフォーク13と、これらフォーク13の基端部を支持するホルダ14とで構成される。ホルダ14は、四角箱型を呈しており、その一側面から複数本のフォーク13が片持ち状に張り出し形成されている。ここで、特記すべき事項として、本実施例のホルダ14は、側面に加速度センサー24が取り付けられている。なお、加速度センサー24の取り付け位置は、本実施例に限定されることなく、ホルダ14のどの位置であっても良い。
The actuators 18 and 19 for moving the arms 15 and 16 and the hand 12 are constituted by motors or the like, and are respectively disposed on the rotation shaft portions. The actuators 18 and 19 are driven based on a command signal (drive signal) sent from the robot controller 25 via a motor drive (not shown).
The hand 12 includes a long fork 13 that supports the workpiece 6 and a holder 14 that supports the base end of the fork 13. The holder 14 has a square box shape, and a plurality of forks 13 are cantilevered from one side surface thereof. Here, as a matter to be noted, the holder 14 of the present embodiment has an acceleration sensor 24 attached to the side surface. The attachment position of the acceleration sensor 24 is not limited to the present embodiment, and may be any position of the holder 14.
次に、図3を用いて、載置位置差分検出手段としてのアライメント装置5について、詳細に説明する。
図3に示すように、ワーク6は、ハンド12に載置して搬送される。このとき、ワーク6は、教示位置(本実施例ではワークセット位置3)に向かって左右方向(x方向)及び前後方向(y方向)に対して載置すべき基準位置である載置基準位置F´が定められている。
しかし、実際には、ワーク6は、載置基準位置F´よりもずれて載置され搬送されることもある。例えば、図3では、ワーク6は、x方向にΔx、y方向にΔyずれて載置(実載置位置F)されている。アライメント装置5は、このようなワーク6の実載置位置Fと載置基準位置F´とのずれ量を検出する装置である。
Next, the alignment apparatus 5 as a mounting position difference detection means will be described in detail with reference to FIG.
As shown in FIG. 3, the work 6 is placed on the hand 12 and conveyed. At this time, the workpiece 6 is a placement reference position which is a reference position to be placed in the left-right direction (x direction) and the front-rear direction (y direction) toward the teaching position (work set position 3 in this embodiment). F ′ is defined.
However, actually, the workpiece 6 may be placed and transported with a deviation from the placement reference position F ′. For example, in FIG. 3, the work 6 is placed with a displacement Δx in the x direction and Δy in the y direction (actual placement position F). The alignment device 5 is a device that detects the amount of deviation between the actual placement position F of the workpiece 6 and the placement reference position F ′.
図3に示すように、本実施例のアライメント装置5は、1つのx方向を検出する位置センサー23xと、2つのy方向を検出する位置センサー23yとから構成されている。これらの位置センサー23x・23yは、それぞれに投光素子と受光素子とが設けられ、投光素子から可視光や赤外線光のセンサー光を略水平に照射し、受光素子にて反射光を受光するミラー反射型の光電スイッチ(光電センサー)が用いられる。位置センサー23xは、ハンド12において、左右端側に配置されるフォーク13・13のホルダ14の根元部に配置されている。位置センサー23yは、別置された前記アライメント装置5に配置されている。 As shown in FIG. 3, the alignment apparatus 5 of the present embodiment includes a position sensor 23 x that detects one x direction and a position sensor 23 y that detects two y directions. Each of the position sensors 23x and 23y is provided with a light projecting element and a light receiving element, and radiates visible light or infrared sensor light substantially horizontally from the light projecting element, and receives reflected light by the light receiving element. A mirror reflection type photoelectric switch (photoelectric sensor) is used. The position sensor 23x is arranged at the base of the holder 14 of the forks 13 and 13 arranged on the left and right end sides in the hand 12. The position sensor 23y is disposed in the alignment device 5 provided separately.
このような構成とすることで、ロボットコントローラ25は、ワーク6の搬送中においてアライメント装置5を通過させることで、ワーク6の実載置位置Fと載置基準位置F´とのずれ量ΔFを検出できる。そして、ロボットコントローラ25は、後述する教示位置補正手段26によって、検出されたずれ量ΔFを補正することができる。
このようにして、ロボット搬送システム1は、ハンド12に対するワーク6の載置位置ずれに係らず、ワークセット位置3に正確にワーク6をセットできる。なお、位置センサー23x・23x及び位置センサー23x・23yを用いることで、ワーク6の基準載置位置F´よりの角度ずれ量も検出できる。この角度ずれ量の検出については、詳細説明は省略する。以上のアライメント装置5は公知技術である。
With such a configuration, the robot controller 25 passes the alignment device 5 while the workpiece 6 is being conveyed, so that the deviation amount ΔF between the actual placement position F and the placement reference position F ′ of the workpiece 6 is obtained. It can be detected. Then, the robot controller 25 can correct the detected deviation amount ΔF by the teaching position correcting means 26 described later.
In this way, the robot transport system 1 can accurately set the workpiece 6 at the workpiece setting position 3 regardless of the placement position displacement of the workpiece 6 with respect to the hand 12. In addition, by using the position sensors 23x and 23x and the position sensors 23x and 23y, the amount of angular deviation from the reference placement position F ′ of the workpiece 6 can also be detected. Detailed description of the detection of the angular deviation amount is omitted. The above alignment apparatus 5 is a known technique.
次に、図4を用いて、アーム15・16のたわみによる教示位置のずれについて、詳細に説明する。なお、以下では前述する載置位置ずれ量ΔFは考慮しないものとする。
図4に示すように、搬送ロボット10は、開始位置Aから教示位置B´に向かって、教示点Mを経由してワーク6を搬送すると想定する。ここで、教示点とは、開始位置Aから教示位置B´までの間に予め分かっている外乱を考慮して教示位置B´に確実に到達できるように、少なくとも一つ(実際は複数)設定される点である。
しかし、実際には、教示位置B´に対して実位置Bとなるように、教示位置B´と実位置Bとにはずれが生じる。これは、アーム15・16のたわみを原因とする教示軌道R´(図4における破線)と実軌道R(図4における実線)とのずれによるものである。このようなアーム15・16のたわみは、ワーク6が大型化するほど顕著となる。
図4は、説明を分かり易くするために、教示軌道R´及び実軌道Rを3次元(x、y、z)空間によって示している。また、教示位置B´と実位置Bとのずれ量をΔRとしている。
Next, using FIG. 4, the teaching position shift due to the deflection of the arms 15 and 16 will be described in detail. In the following, it is assumed that the mounting position deviation amount ΔF described above is not considered.
As shown in FIG. 4, it is assumed that the transfer robot 10 transfers the workpiece 6 from the start position A toward the teaching position B ′ via the teaching point M. Here, at least one (actually plural) teaching points are set so that the teaching position B ′ can be reliably reached in consideration of a known disturbance between the starting position A and the teaching position B ′. It is a point.
However, actually, there is a deviation between the teaching position B ′ and the actual position B so that the actual position B is located with respect to the teaching position B ′. This is due to a deviation between the teaching trajectory R ′ (broken line in FIG. 4) and the actual trajectory R (solid line in FIG. 4) due to the deflection of the arms 15 and 16. Such deflection of the arms 15 and 16 becomes more prominent as the workpiece 6 becomes larger.
FIG. 4 shows the teaching trajectory R ′ and the actual trajectory R in a three-dimensional (x, y, z) space for easy understanding. Further, the amount of deviation between the teaching position B ′ and the actual position B is ΔR.
次に、図5を用いて、アーム15・16のたわみによる教示加速度a´のずれについて、詳細に説明する。
ここで、教示加速度a´は、前記教示軌道R´に沿ってワーク6を搬送する基準の加速度である。つまり、教示加速度a´は、ロボットコントローラ25によって搬送ロボット10に指示された加速度である。一方、実加速度aは、前記加速度センサー24によって検出される実際のアーム15・16の加速度すなわちワーク6を搬送する加速度である。前述するように教示位置B´と実位置Bとのずれ量ΔRが存在するのと同様に、教示加速度a´と実加速度aとにもずれ量Δaが存在する。
Next, the displacement of the teaching acceleration a ′ due to the deflection of the arms 15 and 16 will be described in detail with reference to FIG.
Here, the teaching acceleration a ′ is a reference acceleration for transporting the workpiece 6 along the teaching trajectory R ′. That is, the teaching acceleration a ′ is an acceleration instructed to the transport robot 10 by the robot controller 25. On the other hand, the actual acceleration a is the actual acceleration of the arms 15 and 16 detected by the acceleration sensor 24, that is, the acceleration of conveying the workpiece 6. As described above, in the same manner as the deviation amount ΔR between the teaching position B ′ and the actual position B exists, the deviation amount Δa also exists between the teaching acceleration a ′ and the actual acceleration a.
図5は、教示加速度a´と実加速度aをそれぞれ3次元(x、y、z)成分に区分けし、教示加速度ax´、ay´、az´(図5における破線)と実加速度ax、ay、az(図5における実線)として図5(a)、図5(b)及び図5(c)に示している。
図5に示すように、3次元(x、y、z)成分に区分けされたそれぞれの教示加速度a´と実際加速度aとにはずれが生じる。このずれ量Δa(Δax、Δay、Δaz)は、ΔRと同様にアーム15・16のたわみを原因とするものである。なお、図5は、搬送時間を微小区間に区切って、ずれ量Δa(Δax、Δay、Δaz)をステップ状に示している。
In FIG. 5, the teaching acceleration a ′ and the actual acceleration a are each divided into three-dimensional (x, y, z) components, and the teaching accelerations ax ′, ay ′, az ′ (broken lines in FIG. 5) and the actual accelerations ax, ay , Az (solid line in FIG. 5) are shown in FIGS. 5 (a), 5 (b) and 5 (c).
As shown in FIG. 5, there is a difference between the teaching acceleration a ′ divided into three-dimensional (x, y, z) components and the actual acceleration a. This deviation amount Δa (Δax, Δay, Δaz) is caused by the deflection of the arms 15 and 16 like ΔR. FIG. 5 shows the shift amount Δa (Δax, Δay, Δaz) in a step shape by dividing the conveyance time into minute sections.
次に、図6を用いて、ロボットコントローラシステム20について説明する。
図6に示すように、ロボットコントローラシステム20は、ロボットコントローラ25、教示位置補正手段26、及び加速度差分算出手段27、計測誤差算出手段28を備えている。教示位置補正手段26、及び加速度差分算出手段27、計測誤差算出手段28は、ロボットコントローラ25に接続されている。また、位置センサー23及び加速度センサー24は、ロボットコントローラ25に接続されている。
ロボットコントローラ25は、教示されたルート及び速度を記憶し、ワーク6を教示加速度a´に基づいて搬送するように、各駆動部に駆動信号を送る装置である。
加速度差分算出手段27は、前記加速度センサー24によって検出される実加速度aと教示加速度a´のずれ量Δaを算出する手段である。具体的には、算出される加速度ずれ量Δaは、開始位置から算出位置までの搬送時間を微小区間に区切って積算した積算量とする。
教示位置補正手段26は、ハンド12の実位置Bを教示位置B´に補正するようにハンド12(ワーク6)を移動する手段である。
計測誤差算出手段28については、詳しくは後述する。
Next, the robot controller system 20 will be described with reference to FIG.
As shown in FIG. 6, the robot controller system 20 includes a robot controller 25, a teaching position correction unit 26, an acceleration difference calculation unit 27, and a measurement error calculation unit 28. The teaching position correcting unit 26, the acceleration difference calculating unit 27, and the measurement error calculating unit 28 are connected to the robot controller 25. Further, the position sensor 23 and the acceleration sensor 24 are connected to the robot controller 25.
The robot controller 25 is a device that stores the taught route and speed and sends a drive signal to each drive unit so as to convey the workpiece 6 based on the taught acceleration a ′.
The acceleration difference calculating means 27 is a means for calculating a deviation amount Δa between the actual acceleration a detected by the acceleration sensor 24 and the teaching acceleration a ′. Specifically, the calculated acceleration deviation amount Δa is an integrated amount obtained by integrating the conveyance time from the start position to the calculated position by dividing it into minute sections.
The teaching position correcting means 26 is a means for moving the hand 12 (work 6) so as to correct the actual position B of the hand 12 to the teaching position B ′.
The measurement error calculation means 28 will be described later in detail.
このような構成とすることで、ロボットコントローラ25は、教示位置B´において、アーム15・16のたわみによるずれ量ΔRを補正できる。
すなわち、ロボットコントローラ25は、教示位置B´近傍において、加速度差分算出手段27によって算出される加速度ずれ量ΔaをΔRに変換する。ΔRとΔaは相関があるため、同じ搬送ロボット10であれば一意に求められる。ロボットコントローラ25は、教示位置補正手段26によって、実位置Bを教示位置B´に補正する制御を行う。
With this configuration, the robot controller 25 can correct the deviation amount ΔR due to the deflection of the arms 15 and 16 at the teaching position B ′.
That is, the robot controller 25 converts the acceleration deviation amount Δa calculated by the acceleration difference calculation means 27 into ΔR in the vicinity of the teaching position B ′. Since ΔR and Δa have a correlation, they are uniquely obtained for the same transfer robot 10. The robot controller 25 performs control to correct the actual position B to the teaching position B ′ by the teaching position correction unit 26.
また、上述の構成とすることで、ロボットコントローラ25は、実軌道Rにおいて、常時、アーム15・16のたわみによるずれ量ΔRを補正できる。
すなわち、教示位置補正手段26は、前記実加速度aと教示加速度a´のずれ量Δaを積算した値が設定値を越えると、ゼロとなるように(教示加速度に近づくように)ハンド12(ワーク6)の加速度を補正する。つまり、ハンド12が教示軌道R´からずれて、設定したずれ量Δaの積算値が設定値以上となると、教示加速度a´を補正して教示した教示軌道R´上をワーク6が搬送されるように補正する。具体的には、ずれ量Δaxがプラス側にずれて積算値が設定値以上となると、この積算値がゼロとなる方向(マイナス側)に教示加速度a´を補正し、教示した軌道に戻す。
Further, with the above-described configuration, the robot controller 25 can always correct the deviation amount ΔR due to the deflection of the arms 15 and 16 in the actual trajectory R.
That is, the teaching position correcting means 26 is configured so that the value obtained by integrating the deviation amount Δa between the actual acceleration a and the teaching acceleration a ′ exceeds a set value so that it becomes zero (approaching the teaching acceleration). The acceleration of 6) is corrected. That is, when the hand 12 deviates from the teaching trajectory R ′ and the integrated value of the set deviation amount Δa becomes equal to or larger than the set value, the workpiece 6 is conveyed on the teaching trajectory R ′ taught by correcting the teaching acceleration a ′. Correct as follows. Specifically, when the deviation amount Δax is shifted to the plus side and the integrated value becomes equal to or greater than the set value, the teaching acceleration a ′ is corrected in a direction (minus side) in which the integrated value becomes zero, and returned to the taught trajectory.
さらに、上述の構成とすることで、ロボットコントローラ25は、例えば、実軌道R上の教示点Mにおいて、アーム15・16のたわみによるずれ量ΔRを補正できる。
すなわち、教示位置補正手段26は、教示点Mにおいて、前記実加速度aと教示加速度a´のずれ量Δaを積算した値が設定値を越えると、ゼロとなるように(教示加速度に近づくように)ハンド12(ワーク6)の加速度を補正する。つまり、各教示点Mにおいて、ハンド12が教示軌道R´からずれて、設定したずれ量Δaの積算値が設定値以上となると、教示加速度a´を補正して教示した教示軌道R´上をワーク6が搬送されるように補正する。
Furthermore, with the above-described configuration, the robot controller 25 can correct the deviation amount ΔR due to the deflection of the arms 15 and 16 at the teaching point M on the actual trajectory R, for example.
In other words, the teaching position correcting means 26 is set to zero when the value obtained by integrating the deviation amount Δa between the actual acceleration a and the teaching acceleration a ′ exceeds the set value at the teaching point M (so as to approach the teaching acceleration). ) The acceleration of the hand 12 (work 6) is corrected. That is, at each teaching point M, when the hand 12 is deviated from the teaching trajectory R ′ and the integrated value of the set deviation amount Δa is equal to or larger than the set value, the teaching acceleration a ′ is corrected and the teaching trajectory R ′ is taught. It correct | amends so that the workpiece | work 6 may be conveyed.
なお、上述のたわみによるずれ量ΔRを補正すると同時に、前述するように、ロボットコントローラ25は、アライメント装置5により算出される載置位置ずれ量ΔFに基づいて、教示位置補正手段26によって教示位置B´を補正する制御を行うことも可能である。 At the same time as correcting the deflection amount ΔR due to the above-described deflection, the robot controller 25 uses the teaching position correction unit 26 to teach the teaching position B based on the placement position deviation amount ΔF calculated by the alignment device 5 as described above. It is also possible to perform control for correcting '.
このようにして、加速度センサー24によって検出される実加速度aとロボットコントローラ25によって搬送ロボット10に指示される教示加速度a´とよりアーム15・16のたわみによる教示位置のずれ量ΔRを検出し、実位置Bを教示位置B´に補正することができる。つまり、加速度センサー24をハンド12に取り付けるのみの簡易な構成によって、アーム15・16のたわみによるずれ量ΔRを補正できる。 In this way, the teaching position deviation amount ΔR due to the deflection of the arms 15 and 16 is detected from the actual acceleration a detected by the acceleration sensor 24 and the teaching acceleration a ′ instructed to the transport robot 10 by the robot controller 25. The actual position B can be corrected to the teaching position B ′. That is, the displacement ΔR due to the deflection of the arms 15 and 16 can be corrected with a simple configuration in which the acceleration sensor 24 is simply attached to the hand 12.
次に、図7(a)及び図7(b)を用いて、本実施例の搬送ロボットシステム1を用いる別実施例について、詳細に説明する。
図7(a)は、前述したように、搬送ロボット10は、開始位置Aから教示位置B´に向かって、ワーク6を搬送する速度変化を示すグラフである。図7(a)は、横軸を時系列tとして縦軸に速度変化vを示している。また、図7(a)中の区間taは、前記アライメント装置5を通過する時間である。
アライメント装置5での計測は、計測対象(ワーク6)が加速度運動している場合には、計測誤差を伴う。そこで、図7(a)で示すように、搬送ロボット10は、アライメント装置5を通過する際には一定速度を保ち通過している。すなわち、従来、搬送ロボットシステム1は、アライメント装置5において計測誤差が最小となるように、加速度を0としてワーク6を搬送している。
Next, another embodiment using the transfer robot system 1 of the present embodiment will be described in detail with reference to FIGS. 7A and 7B.
FIG. 7A is a graph showing a change in speed at which the transfer robot 10 transfers the workpiece 6 from the start position A toward the teaching position B ′ as described above. FIG. 7A shows the speed change v on the vertical axis with the horizontal axis as time series t. Further, a section ta in FIG. 7A is a time for passing through the alignment apparatus 5.
The measurement by the alignment apparatus 5 involves a measurement error when the measurement target (work 6) is accelerating. Therefore, as shown in FIG. 7A, the transport robot 10 passes through the alignment device 5 while maintaining a constant speed. That is, conventionally, the transfer robot system 1 transfers the workpiece 6 with an acceleration of 0 so that the measurement error in the alignment device 5 is minimized.
本実施例では、前記加速度センサー24によって、ハンド12の実加速度aが検出可能である。また、図8に示すように、前記計測誤差算出手段28(図6参照)には、各成分(x、y)の誤差テーブル28x・28yがロボットコントローラ25によって搬送ロボット10に指示されている(図8ではx成分の誤差テーブル28xを示している)。
そこで、本実施例では、区間taの加速度変化σaに基づいて、アライメント装置5の載置位置計測時の位置計測誤差(σx、σy)を補正することができる。そのため、搬送ロボット10は、アライメント装置5を加速して通過することができる。
具体的には、例えば、x方向の補正については、予め指示された誤差テーブル28xに基づいて、アライメント装置5を通過する際のx成分の加速度変化σaxに基づいてx方向の誤差σxを算出する。ロボットコントローラ25は、σxに基づいて、位置センサー23xにより検出されるΔxを補正する。
In the present embodiment, the acceleration sensor 24 can detect the actual acceleration a of the hand 12. As shown in FIG. 8, the error table 28x / 28y of each component (x, y) is instructed to the transport robot 10 by the robot controller 25 in the measurement error calculation means 28 (see FIG. 6) ( FIG. 8 shows an x component error table 28x).
Therefore, in this embodiment, the position measurement error (σx, σy) at the time of mounting position measurement of the alignment apparatus 5 can be corrected based on the acceleration change σa of the section ta. Therefore, the transfer robot 10 can pass through the alignment device 5 with acceleration.
Specifically, for example, for the correction in the x direction, the error σx in the x direction is calculated based on the acceleration change σax of the x component when passing through the alignment device 5 based on the error table 28x specified in advance. . The robot controller 25 corrects Δx detected by the position sensor 23x based on σx.
このようにして、アライメント装置5の載置位置計測時に、搬送ロボットを定速又は停止する必要がないため、搬送ロボット10の作業時間を可及的に短縮できる。 In this way, when the mounting position of the alignment apparatus 5 is measured, it is not necessary to keep the transfer robot at a constant speed or stop, so that the work time of the transfer robot 10 can be shortened as much as possible.
1 搬送ロボットシステム
5 アライメント装置
6 ワーク
10 搬送ロボット
12 ハンド
15 アーム
16 アーム
20 ロボットコントローラシステム
23 位置センサー
24 加速度センサー
25 ロボットコントローラ
26 教示位置補正手段
27 加速度差分算出手段
28 計測誤差算出手段
F 基準載置位置
F´ 実載置位置
Δx x方向の載置位置ずれ量
Δy y方向の載置位置ずれ量
A 開始位置
B´ 教示位置
B 実位置
R´ 教示軌道
R 実軌道
M 教示点
ΔR 教示位置と実位置のずれ量
a´ 教示加速度
a 実加速度
Δa 加速度ずれ量
DESCRIPTION OF SYMBOLS 1 Transfer robot system 5 Alignment apparatus 6 Work 10 Transfer robot 12 Hand 15 Arm 16 Arm 20 Robot controller system 23 Position sensor 24 Acceleration sensor 25 Robot controller 26 Teaching position correction means 27 Acceleration difference calculation means 28 Measurement error calculation means F Reference mounting Position F ′ Actual placement position Δx Placement position deviation amount in x direction Δy Placement position deviation amount in y direction A Start position B ′ Teaching position B Actual position R ′ Teaching trajectory R Actual trajectory M Teaching point ΔR Teaching position and actual Position shift amount a 'Teaching acceleration a Actual acceleration Δa Acceleration shift amount
Claims (2)
前記ハンドを変位可能に構成されるアームと、
前記ハンドに対するワークの基準載置位置と実載置位置との差分を検出する載置位置差分検出手段と、
前記アームの実位置と教示位置との差分を補正する教示位置補正手段と、
を有する搬送ロボットシステムにおいて、
前記ハンドに備えられる加速度センサーと、
搬送過程において前記加速度センサーによって検出される実加速度と予め指示された教示加速度との差分を算出する加速度差分算出手段と、
を具備し、
前記教示位置補正手段は、前記加速度差分に基づいて実位置を教示位置に補正する
ことを特徴とする搬送ロボットシステム。 A hand for placing and holding a workpiece;
An arm configured to displace the hand;
A mounting position difference detecting means for detecting a difference between a reference mounting position of the workpiece with respect to the hand and an actual mounting position;
Teaching position correction means for correcting the difference between the actual position of the arm and the teaching position;
In a transfer robot system having
An acceleration sensor provided in the hand;
An acceleration difference calculating means for calculating a difference between an actual acceleration detected by the acceleration sensor in the conveyance process and a pre-instructed teaching acceleration;
Comprising
The conveyance robot system, wherein the teaching position correction unit corrects an actual position to a teaching position based on the acceleration difference.
前記載置位置差分を、前記位置差分検出手段によって載置位置差分を検出するときの前記加速度センサーによって検出される加速度に基づいて補正する
ことを特徴とする搬送ロボットシステム。 The transfer robot system according to claim 1,
The transfer robot system, wherein the placement position difference is corrected based on acceleration detected by the acceleration sensor when the placement position difference is detected by the position difference detection means.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007151001A JP5118896B2 (en) | 2007-06-06 | 2007-06-06 | Transfer robot system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007151001A JP5118896B2 (en) | 2007-06-06 | 2007-06-06 | Transfer robot system |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2008302455A true JP2008302455A (en) | 2008-12-18 |
JP5118896B2 JP5118896B2 (en) | 2013-01-16 |
Family
ID=40231610
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007151001A Expired - Fee Related JP5118896B2 (en) | 2007-06-06 | 2007-06-06 | Transfer robot system |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5118896B2 (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010182794A (en) * | 2009-02-04 | 2010-08-19 | Juki Corp | Electronic component mounting device |
JP2011167828A (en) * | 2010-02-22 | 2011-09-01 | Sinfonia Technology Co Ltd | Conveying device |
JP2015188940A (en) * | 2014-03-27 | 2015-11-02 | 日本電産サンキョー株式会社 | industrial robot |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01173117A (en) * | 1987-12-28 | 1989-07-07 | Mitsubishi Heavy Ind Ltd | Oscillation controller for flexible structure |
JPH09252039A (en) * | 1996-03-14 | 1997-09-22 | Fujitsu Ltd | Teaching position setting method and device of transfer device |
JPH1075099A (en) * | 1996-09-02 | 1998-03-17 | Matsushita Electric Ind Co Ltd | Part-mounting device |
JP2001022423A (en) * | 1999-07-08 | 2001-01-26 | Matsushita Electric Ind Co Ltd | Method for optimizing operating speed and acceleration of conveyance robot |
-
2007
- 2007-06-06 JP JP2007151001A patent/JP5118896B2/en not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01173117A (en) * | 1987-12-28 | 1989-07-07 | Mitsubishi Heavy Ind Ltd | Oscillation controller for flexible structure |
JPH09252039A (en) * | 1996-03-14 | 1997-09-22 | Fujitsu Ltd | Teaching position setting method and device of transfer device |
JPH1075099A (en) * | 1996-09-02 | 1998-03-17 | Matsushita Electric Ind Co Ltd | Part-mounting device |
JP2001022423A (en) * | 1999-07-08 | 2001-01-26 | Matsushita Electric Ind Co Ltd | Method for optimizing operating speed and acceleration of conveyance robot |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010182794A (en) * | 2009-02-04 | 2010-08-19 | Juki Corp | Electronic component mounting device |
JP2011167828A (en) * | 2010-02-22 | 2011-09-01 | Sinfonia Technology Co Ltd | Conveying device |
JP2015188940A (en) * | 2014-03-27 | 2015-11-02 | 日本電産サンキョー株式会社 | industrial robot |
Also Published As
Publication number | Publication date |
---|---|
JP5118896B2 (en) | 2013-01-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6005299B2 (en) | Robot system and control method of robot system | |
JP6646026B2 (en) | Work system, work execution method for article, and robot | |
TWI593526B (en) | Robot teaching methods and robots | |
US9682842B2 (en) | Automated roll transport facility | |
JP6748126B2 (en) | Work robot system | |
JP2016016915A (en) | Article alignment device for aligning articles on conveyer | |
CN108780770A (en) | The teaching method of base board delivery device and baseplate transportation robot | |
US10940590B2 (en) | Calibrating a system with a conveying means and at least one robot | |
JP2016143787A (en) | Substrate transfer robot and substrate transfer method | |
JP2019188508A (en) | Working robot system and working robot | |
JP2010208816A (en) | Transfer device | |
JP5118896B2 (en) | Transfer robot system | |
JP2000071190A (en) | Workpiece carrying system | |
JP2019188507A (en) | Working robot system and working robot | |
CN113170607B (en) | Component mounting apparatus | |
KR20070030529A (en) | automatic guided vehicle with automated position correcting technique and related method | |
WO2022137917A1 (en) | Control device for substrate conveyance robot and method for controlling joint motor | |
KR102428129B1 (en) | Substrate processing apparatus, driving method of substrate processing apparatus and storage medium | |
JP2009233789A (en) | Method of controlling carrier robot | |
US12002695B2 (en) | Transport system and determination method | |
KR100819817B1 (en) | Transferring robot | |
JP7303686B2 (en) | Work position detection method for robots | |
JP2019038073A (en) | Robot system and method for performing work on conveyed workpiece | |
WO2021070599A1 (en) | Method and device for manufacturing glass plate package | |
JP2003062780A (en) | Workpiece conveying positioning method and workpiece conveying positioning device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100218 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20110824 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110906 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20111011 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120306 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120423 |
|
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: 20121016 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20121022 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 5118896 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20151026 Year of fee payment: 3 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |