JP7246955B2 - Correction method and system - Google Patents
Correction method and system Download PDFInfo
- Publication number
- JP7246955B2 JP7246955B2 JP2019023425A JP2019023425A JP7246955B2 JP 7246955 B2 JP7246955 B2 JP 7246955B2 JP 2019023425 A JP2019023425 A JP 2019023425A JP 2019023425 A JP2019023425 A JP 2019023425A JP 7246955 B2 JP7246955 B2 JP 7246955B2
- Authority
- JP
- Japan
- Prior art keywords
- jig
- hole
- dimensional sensor
- control unit
- angle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Description
本発明の実施形態は、治具、補正方法及びシステムに関する。 Embodiments of the present invention relate to jigs, correction methods, and systems.
ロボットの制御などに用いられる測定装置には、レーザを所定の方向に走査し対象物との距離を測定するものがある。そのような測定装置は、レーザを走査して形成される走査面を所望の平面に合致させる必要がある。たとえば、オペレータは、水準器などを用いて走査面が所望の面に合致するように測定装置を設置する。 2. Description of the Related Art Among measuring devices used for controlling robots, etc., there is one that scans a laser in a predetermined direction and measures the distance to an object. Such a measuring device needs to match the scanning plane formed by scanning the laser to a desired plane. For example, the operator uses a spirit level or the like to position the measuring device so that the scan plane is aligned with the desired plane.
しかしながら、上記のように測定装置を設置しても測定装置の製造誤差などによって走査面と所望の面とが合致しない場合がある。 However, even if the measuring device is installed as described above, there are cases where the scanning plane and the desired plane do not match due to manufacturing errors of the measuring device.
そこで、適切に走査面を所望の面に合致させる技術が求められる。 Therefore, there is a demand for a technique for properly matching the scanning surface to the desired surface.
上記の課題を解決するため、適切に走査面を設定することができる治具、補正方法及びシステムを提供する。 In order to solve the above problems, a jig, a correction method, and a system are provided that can appropriately set the scanning plane.
実施形態によれば、プロセッサによって実行される補正方法は、一定方向を走査し、対象物までの距離を測定する一次元センサの光を反射する平面部を有する部材と、前記部材に、前記一次元センサの走査面の中心軸と前記一次元センサから前記部材に延びる軸との為す角度に対して許容される誤差に基づき算出される幅よりも小さい幅を有する穴と、を備える治具を第１の位置と、前記一次元センサから前記治具に向う方向に前記第１の位置から所定の距離移動した第２の位置と、に移動させ、前記治具を前記第１の位置に設置した場合の前記穴の観測結果及び前記治具を前記第２の位置に設置した場合の前記穴の観測結果に基づいて、前記一次元センサの前記穴の高さに沿った方向の角度又は前記高さに沿った方向における位置を補正する。
According to an embodiment, a correction method performed by a processor includes: a member having a planar portion that reflects light of a one-dimensional sensor that scans in a certain direction and measures the distance to an object; a jig having a width smaller than a width calculated based on an allowable error with respect to the angle between the central axis of the scanning surface of the original sensor and the axis extending from the one-dimensional sensor to the member. A first position and a second position moved from the first position by a predetermined distance in a direction from the one-dimensional sensor toward the jig, and the jig is installed at the first position. The angle of the direction along the height of the hole of the one-dimensional sensor or the Correct the position along the height .
以下、図面を参照しながら実施形態について説明する。 Hereinafter, embodiments will be described with reference to the drawings.
実施形態に係るロボットシステムは、ロボットが備えるハンドなどを用いて所定の動作を行う。たとえば、ロボットシステムは、ハンドを用いて所定の物品をピッキングする。 A robot system according to an embodiment performs a predetermined action using a hand or the like of the robot. For example, a robot system picks up a predetermined article using a hand.
ロボットシステムは、距離を測定する測定装置を用いて、ハンドの位置を測定する。ロボットシステムは、測定装置の測定結果に基づいてロボットを制御する。 The robot system measures the position of the hand using a distance measuring device. The robot system controls the robot based on the measurement results of the measuring device.
また、ロボットシステムは、測定装置の設置時などにおいて、測定装置のキャリブレーションを行う。即ち、ロボットシステムは、測定装置の走査面を所望の平面（目標平面）に合致させる。 Further, the robot system calibrates the measuring device when the measuring device is installed. That is, the robot system aligns the scanning plane of the measuring device with the desired plane (target plane).
図１は、実施形態に係るロボットシステム１の構成例を概略的に示す。図１が示すように、ロボットシステム１は、ロボット１００、測定装置２００及び治具３００などから構成される。
FIG. 1 schematically shows a configuration example of a
なお、ロボットシステム１は、図１が示すような構成の他に必要に応じた構成を具備したり、ロボットシステム１から特定の構成が除外されたりしてもよい。
In addition to the configuration shown in FIG. 1 , the
ここでは、所定の水平方向をＸ軸方向（第１の方向）とし、測定装置２００から治具３００に向う方向をＹ軸方向（第２の方向）とし、垂直方向をＺ軸方向（第３の方向）とする。
Here, the predetermined horizontal direction is defined as the X-axis direction (first direction), the direction from the
ロボット１００は、所定の物品をピッキングする。ロボット１００は、ピッキングした物品を所定の積載領域に積載する。
A
ロボット１００は、ロボットアーム１０２及びハンド１０３などから構成される。
The
ロボットアーム１０２は、後述する制御部１０１の制御によって駆動するマニピュレータである。たとえば、ロボットアーム１０２は、棒状のフレーム及びフレームを駆動するモータなどから構成される。ロボットアーム１０２のフレームは、モータなどの駆動によって所定の位置に移動する。
The
ハンド１０３は、ロボットアーム１０２の先端に設置されているエンドエフェクタである。ハンド１０３は、ロボットアーム１０２の移動に伴って移動する。ハンド１０３は、ロボットアーム１０２が所定の方向に移動することにより、物品を把持する位置まで移動する。ハンド１０３は、物品を把持する。
A
ハンド１０３は、物品を把持するグリッパを備える。グリッパは、複数の指と、複数の指を連結している複数の関節機構とを備える。関節機構は、関節機構の動作に連動して指が動作するように構成されてよい。グリッパは、例えば、複数の指による２点以上の接点で、対向する複数の方向から荷物に対して力を加える。これにより、ハンド１０３は、指と荷物との間に生じる摩擦によって物品を把持する。
The
なお、ハンド１０３は、吸着パッドなどを備えるものであってもよい。ハンド１０３の構成は、物品を把持可能な種々の把持機構を用いてよく、特定の構成に限定されるものではない。
Note that the
ここでは、ハンド１０３は、測定装置２００のキャリブレーションを行うための治具３００を把持する。治具３００については、後述する。
Here, the
測定装置２００は、レーザ２１１を対象物に照射して対象物との距離を測定する。測定装置２００は、レーザ２１１を所定の方向に走査し当該方向において対象物の各部との距離を測定する。ここでは、測定装置２００がレーザ２１１を走査して形成される面を走査面２１２とする。
The
測定装置２００は、ロボット１００と所定の距離離れた位置に設置される。測定装置２００は、治具３００の所定の面に対向する位置に設置される。即ち、測定装置２００は、治具３００の各部との距離を測定可能な位置に配置される。
The
次に、ロボットシステム１の構成例について説明する。図２は、ロボットシステム１の構成例を示すブロック図である。
Next, a configuration example of the
図２が示すように、ロボットシステム１は、ロボット１００、測定装置２００及び治具３００から構成される。
As shown in FIG. 2, the
まず、ロボット１００について説明する。
First, the
ロボット１００は、制御部１０１、ロボットアーム１０２及びハンド１０３などを備える。制御部１０１とロボットアーム１０２及びハンド１０３とは、通信可能に接続する。なお、ロボット１００は、図２が示すような構成の他に必要に応じた構成を具備したり、ロボット１００から特定の構成が除外されたりしてもよい。
The
ロボットアーム１０２及びハンド１０３については、前述の通りである。
The
制御部１０１は、ロボット１００全体を制御する。たとえば、制御部１０１は、外部からの信号などに基づいてロボットアーム１０２及びハンド１０３を制御する。制御部１０１は、ロボットアーム１０２を制御してハンド１０３を所定の位置に移動させる。制御部１０１は、ハンド１０３を移動させると、ハンド１０３に所定の物品を把持させる。
The
また、制御部１０１は、ハンド１０３に物品を把持させた状態でロボットアーム１０２を移動させて物品を所定の位置まで搬送する。制御部１０１は、物品を所定の積載領域まで搬送すると、ハンド１０３を制御して物品を解放する。
Further, the
ここでは、制御部１０１は、ハンド１０３に治具３００を把持させる。また、制御部１０１は、治具３００を目標平面と交差する所定の位置（初期位置）に保持する。
Here, the
また、制御部１０１は、後述する制御部２０１に通信可能に接続する。制御部１０１は、制御部２０１からの制御信号に基づいてロボットアーム１０２を制御し治具３００を所定の位置に搬送する。
Also, the
たとえば、制御部１０１は、プロセッサなどから構成される。たとえば、制御部１０１は、ＰＣ又はＡＳＩＣ（Application Specific Integrated Circuit）などから構成される。制御部１０１の構成は、特定に構成に限定されるものではない。
For example, the
次に、測定装置２００について説明する。
Next, the measuring
図２が示すように、測定装置２００は、制御部２０１、ＬＲＦ２０２及び補正部２０３などを備える。制御部２０１とＬＲＦ２０２及び補正部２０３とは、通信可能に接続する。なお、測定装置２００は、図２が示すような構成の他に必要に応じた構成を具備したり、測定装置２００から特定の構成が除外されたりしてもよい。
As shown in FIG. 2, the
制御部２０１は、測定装置２００全体を制御する。たとえば、制御部２０１は、ＬＲＦ２０２からのセンサ信号に基づいて補正部２０３を制御する。また、制御部２０１は、制御部１０１と通信可能に接続する。制御部２０１は、所定の位置に治具３００を移動させる制御信号を制御部１０１に送信する。制御部２０１の機能例及び動作例については後に詳述する。
The
たとえば、制御部２０１は、プロセッサなどから構成される。たとえば、制御部２０１は、ＰＣ又はＡＳＩＣ（Application Specific Integrated Circuit）などから構成される。制御部２０１の構成は、特定に構成に限定されるものではない。
For example, the
ＬＲＦ（Laser Range Finder）２０２（一次元センサ）は、レーザ２１１を照射し対象物との距離を測定する。ＬＲＦ２０２は、レーザ２１１を所定の一定方向に走査し当該方向において対象物との距離を測定する。即ち、ＬＲＦ２０２は、所定の振れ幅でレーザ２１１を走査する。ＬＲＦ２０２は、レーザ２１１を走査して走査面２１２を形成する。
An LRF (Laser Range Finder) 202 (one-dimensional sensor) irradiates a
たとえば、ＬＲＦ２０２は、レーザ２１１の光源と光源から照射される光の反射光を検出する光センサとを備えるものであってもよい。ＬＲＦ２０２は、光源から照射されるレーザ２１１（可視光又は不可視光）の反射光に基づいて距離を測定する。たとえば、ＬＲＦ２０２は、照射されたレーザ２１１が対象物で反射し光センサに届くまでの時間に基づいて当該測定対象との距離を測定するＴｏＦ（Ｔｉｍｅ－ｏｆ－Ｆｌｉｇｈｔ）方式で距離を測定する。
For example, the
また、ＬＲＦ２０２は、光源を所定の方向に走査する駆動部などを備えてもよい。
In addition, the
ＬＲＦ２０２は、測定した距離を示すセンサ信号を制御部２０１に送信する。
LRF202 transmits the sensor signal which shows the measured distance to the
補正部２０３は、制御部２０１からの制御に従ってＬＲＦ２０２の位置及び角度を補正する。たとえば、補正部２０３は、ＬＲＦ２０２を支持する台として形成される。補正部２０３は、ＬＲＦ２０２の位置及び角度を変更するためのアクチュエータなどから構成される。
A
補正部２０３は、ＬＲＦ２０２の位置の補正としてＬＲＦ２０２をＸ軸方向、Ｙ軸方向及びＺ軸方向に移動させる。また、補正部２０３は、ＬＲＦ２０２の角度の補正としてＬＲＦ２０２をパン方向、チルト方向及びロール方向に回転させる。
The
パン方向は、Ｚ軸周りの回転方向である。 The pan direction is the direction of rotation about the Z axis.
図３は、補正部２０３がパン方向にＬＲＦ２０２を回転させる動作例を示す。図３が示すように、補正部２０３は、Ｚ軸を中心にＬＲＦ２０２を回転させる。即ち、補正部２０３は、ＬＲＦ２０２を水平面と平行に回転させる。
FIG. 3 shows an operation example in which the
チルト方向は、レーザ２１１と直交する水平軸（Ｘ軸）周りの回転方向である。
The tilt direction is the direction of rotation about the horizontal axis (X-axis) perpendicular to the
図４は、補正部２０３がチルト方向にＬＲＦ２０２を回転させる動作例を示す。図４が示すように、補正部２０３は、水平軸を中心にＬＲＦ２０２を回転させる。即ち、補正部２０３は、ＬＲＦ２０２を上下方向に回転させる。
FIG. 4 shows an operation example in which the
ロール方向は、レーザ２１１と平行な軸（Ｙ軸）周りの回転方向である。
The roll direction is the direction of rotation about an axis (Y-axis) parallel to the
図５は、補正部２０３がロール方向にＬＲＦ２０２を回転させる動作例を示す。図５が示すように、補正部２０３は、レーザ２１１の照射方向と平行な軸を中心にＬＲＦ２０２を回転させる。
FIG. 5 shows an operation example in which the
次に、治具３００について説明する。図６は、治具３００の構成例を示す。
Next, the
治具３００は、所定の大きさの矩形に形成される。治具３００は、レーザ２１１を反射する平面部を有する部材から構成される。たとえば、治具３００は、プラスチック又は金属などから構成される。
The
治具３００は、穴３０１を備える。
The
穴３０１は、治具３００の中央部に形成される。穴３０１は、治具３００の一方の面から対向する面まで形成される。即ち、穴３０１は、治具３００を貫通する。
A
穴３０１は、所定の大きさの矩形に形成される。ここでは、穴３０１の幅は、Ｗであり、高さはＨである。
The
また、治具３００は、穴３０１と目標平面とが交差する位置に保持される。即ち、治具３００は、穴３０１の上辺と下辺との間に目標平面が収まるように保持される。
Also, the
次に、制御部２０１が実現する機能について説明する。たとえば、制御部２０１が実現する機能は、内部のプロセッサがメモリなどに格納されるプログラムを実行することで実現される。
Next, functions realized by the
まず、制御部２０１は、Ｘ軸方向（穴３０１の幅に沿った方向）及びパン方向の角度（穴３０１の幅に沿った方向の角度）においてＬＲＦ２０２をキャリブレーションする機能を有する。
First, the
ここでは、制御部２０１は、走査面２１２の中心軸（振れ幅の中心軸）に穴３０１が重なるようにＬＲＦ２０２をキャリブレーションする。
Here, the
図７は、走査面２１２の中心軸と穴３０１とが重なっていない状態の例を示す。図７が示す例では、ロボットシステム１は、目標平面５００を設定する。目標平面５００は、Ｘ軸及びＹ軸の平行な平面である。また、中心軸Ｃ１は、走査面２１２の中心を通過するレーザの光路である。また、ここでは、測定装置２００から治具３００までの距離をＬとする。また、中心軸Ｃ１と、測定装置２００から穴３０１に延びる軸Ｃ２との角度をθとする。
FIG. 7 shows an example of a state in which the center axis of the
図７が示すように、中心軸Ｃ１は、穴３０１を通過しない。即ち、中心軸Ｃ１と穴３０１とは重なっていない。
As shown in FIG. 7, central axis C1 does not pass through
制御部２０１は、ＬＲＦ２０２を用いて治具３００の各部との距離を測定する。制御部２０１は、所定の振り幅でレーザ２１１を走査し治具３００の各部との距離を測定する。即ち、制御部２０１は、走査面２１２と交差する部分との距離を測定する。
The
図８は、制御部２０１が取得する測定結果の例を示す。
FIG. 8 shows an example of measurement results acquired by the
図８が示す例では、横軸は、Ｘ軸を示す。縦軸は、距離（即ち、Ｙ軸方向の距離）を示す。図８が示すように、制御部２０１は、凸部Ｄを観測する。凸部Ｄの上辺は、ＬＲＦ２０２が測定可能な距離の上限を示す。凸部Ｄは、対象物がない領域に形成される。即ち、凸部Ｄは、穴３０１が形成される領域に生じる。
In the example shown in FIG. 8, the horizontal axis represents the X axis. The vertical axis indicates distance (that is, distance in the Y-axis direction). As shown in FIG. 8, the
図８が示す例では、凸部Ｄと中心軸Ｃ１とは、重ならない。即ち、凸部Ｄに中心軸Ｃ１が収まらない。 In the example shown in FIG. 8, the convex portion D and the central axis C1 do not overlap. That is, the central axis C1 does not fit in the protrusion D.
制御部２０１は、凸部の観測結果に基づいてＬＲＦ２０２の位置及び角度を補正する。即ち、制御部２０１は、凸部Ｄに中心軸Ｃ１が収まらない場合、補正部２０３を制御してＬＲＦ２０２の位置及び角度を補正する。たとえば、制御部２０１は、補正部２０３を用いてＬＲＦ２０２の位置をＸ軸方向において補正し、又は、ＬＲＦ２０２の角度をパン方向において補正する。また、制御部２０１は、ＬＲＦ２０２の位置をＸ軸方向において補正し、かつ、ＬＲＦ２０２の角度をパン方向において補正してもよい。
The
制御部２０１は、ＬＲＦ２０２の位置及び角度を補正すると、再度、ＬＲＦ２０２を用いて治具３００の各部との距離を測定する。
After correcting the position and angle of the
制御部２０１は、凸部Ｄに中心軸Ｃ１が収まらない場合、再度、補正部２０３を制御してＬＲＦ２０２の位置及び角度を補正する。
When the center axis C1 does not fit within the convex portion D, the
制御部２０１は、凸部Ｄに中心軸Ｃ１が収まるまで、上記の動作を繰り返す。
The
図９は、走査面２１２の中心軸Ｃ１と穴３０１とが重なっている状態の例を示す。図９が示すように、中心軸Ｃ１は、穴３０１を通過する。
FIG. 9 shows an example of a state in which the center axis C1 of the
図１０は、図９の状態において、制御部２０１が取得する測定結果の例を示す。
FIG. 10 shows an example of measurement results acquired by the
図１０が示すように、制御部２０１は、凸部Ｄを観測する。図１０が示す例では、凸部Ｄは、中心軸Ｃ１と重なる位置に形成される。
As shown in FIG. 10, the
前述のように、制御部２０１は、凸部Ｄに中心軸Ｃ１が収まるまで、ＬＲＦ２０２の位置及び角度を補正する。即ち、制御部２０１は、凸部Ｄに中心軸Ｃ１が収まると、Ｘ軸方向の位置及びパン方向の角度の補正を完了する。
As described above, the
そのため、穴３０１の幅Ｗ（凸部Ｄの幅）は、ＬＲＦ２０２の中心軸Ｃ１と軸Ｃ２との為す角度に対して許容される誤差θａに基づき算出される幅よりも小さい。即ち、治具３００の穴３０１の幅Ｗは、以下の式を満たす。
Therefore, the width W of the hole 301 (the width of the protrusion D) is smaller than the width calculated based on the error θa allowed for the angle between the central axis C1 and the axis C2 of the
Ｗ＜ｔａｎθａ×Ｌ
また、制御部２０１は、Ｚ軸方向（穴３０１の高さに沿った方向）及びチルト方向の角度（穴３０１の高さに沿った方向の角度）においてＬＲＦ２０２をキャリブレーションする機能を有する。
W<tan θa×L
The
ここでは、制御部２０１は、走査面２１２の中心軸Ｃ１が目標平面５００に重なるようにＬＲＦ２０２をキャリブレーションする。
Here, the
図１１は、走査面２１２の中心軸Ｃ１と目標平面５００とが重なっていない状態の例を示す。
FIG. 11 shows an example of a state in which the central axis C1 of the
図１１では、中心軸Ｃ１と目標平面５００との角度を角度θとする。
In FIG. 11, the angle between the central axis C1 and the
図１１が示すように、中心軸Ｃ１と目標平面５００とは重なっていない。図１１が示す例では、中心軸Ｃ１は、目標平面５００よりも上に向いている。
As shown in FIG. 11, the central axis C1 and the
制御部２０１は、ＬＲＦ２０２を用いて二箇所において治具３００の各部との距離を測定する。制御部２０１は、位置Ｙ１（第１の位置）（たとえば、初期位置）及び測定装置２００から治具３００に向う方向（Ｙ軸方向）に位置Ｙ１から所定の距離離れた位置Ｙ２（第２の位置）に存在する治具３００の各部との距離を測定する。
The
図１１が示す例では、治具３００が位置Ｙ１に存在する場合、中心軸Ｃ１は、穴３０１を通過する。他方、治具３００が位置Ｙ２に存在する場合、中心軸Ｃ１は、目標平面５００よりも上に向いているため、穴３０１を通過しない。
In the example shown in FIG. 11, the central axis C1 passes through the
まず、制御部２０１は、位置Ｙ１に存在する治具３００の各部との距離を測定する。制御部２０１は、治具３００の各部との距離を測定すると、位置Ｙ１から位置Ｙ２に治具３００を移動させる。たとえば、制御部２０１は、治具３００を位置Ｙ２に移動させる制御信号を制御部１０１に送信する。ここで、制御部１０１は、当該制御信号に従って治具３００を位置Ｙ２に移動させる。
First, the
制御部２０１は、位置Ｙ２に治具３００を移動させると、治具３００の各部との距離を測定する。
When the
図１２は、制御部２０１が位置Ｙ１及びＹ２に存在する治具３００までの距離を測定した測定結果を示す。
FIG. 12 shows the measurement result of the
図１２が示すように、制御部２０１は、位置Ｙ１に存在する治具３００を測定した場合、図１０と同様に、凸部Ｄ１を観測する。
As shown in FIG. 12, when the
他方、制御部２０１は、位置Ｙ２に存在する治具３００を測定した場合、凸部を観測しない。治具３００が位置Ｙ２に存在する場合、中心軸Ｃ１は、穴３０１を通過しないため、制御部２０１は、治具３００において穴３０１以外の領域を測定する。その結果、制御部２０１は、凸部を観測しない。
On the other hand, when the
制御部２０１は、凸部の観測結果に基づいてＬＲＦ２０２の位置及び角度を補正する。即ち、制御部２０１は、治具３００が位置Ｙ１又は位置Ｙ２に存在するときの何れかにおいて凸部を観測しない場合、補正部２０３を制御してＬＲＦ２０２の位置及び角度を補正する。たとえば、制御部２０１は、補正部２０３を用いてＬＲＦ２０２の位置をＺ軸方向において補正し、又は、ＬＲＦ２０２の角度をチルト方向において補正させる。また、制御部２０１は、ＬＲＦ２０２の位置をＺ軸方向において補正し、かつ、ＬＲＦ２０２の角度をチルト方向において補正してもよい。
The
制御部２０１は、ＬＲＦ２０２の位置及び角度を補正すると、再度、ＬＲＦ２０２を用いて位置Ｙ１及び位置Ｙ２に存在する治具３００の各部との距離を測定する。
After correcting the position and angle of the
即ち、制御部２０１は、位置Ｙ２から位置Ｙ１に治具３００を移動させる。たとえば、制御部２０１は、治具３００を位置Ｙ１に移動させる制御信号を制御部１０１に送信する。ここで、制御部１０１は、当該制御信号に従って治具３００を位置Ｙ１に移動させる。
That is, the
制御部２０１は、治具３００を位置Ｙ１に移動させると、前述の通り、ＬＲＦ２０２を用いて位置Ｙ１及び位置Ｙ２に存在する治具３００の各部との距離を測定する。
When the
制御部２０１は、治具３００が位置Ｙ１又は位置Ｙ２に存在するときに凸部を観測しない場合、再度、補正部２０３を制御してＬＲＦ２０２の位置及び角度を補正する。
When the
制御部２０１は、治具３００が位置Ｙ１及び位置Ｙ２に存在するときの何れにおいても凸部を観測するまで、上記の動作を繰り返す。
The
図１３は、走査面２１２の中心軸Ｃ１と目標平面５００とが重なっている状態の例を示す。図１３が示すように、中心軸Ｃ１は、治具３００が位置Ｙ１及び位置Ｙ２に存在する場合の何れにおいても穴３０１を通過する。
FIG. 13 shows an example of a state in which the central axis C1 of the
図１４は、図１３の状態において、制御部２０１が取得する測定結果の例を示す。
FIG. 14 shows an example of measurement results acquired by the
図１４が示すように、制御部２０１は、治具３００が位置Ｙ１に存在する場合、凸部Ｄ１を観測する。同様に、制御部２０１は、治具３００が位置Ｙ２に存在する場合、凸部Ｄ２を観測する。
As shown in FIG. 14, the
前述のように、制御部２０１は、治具３００が位置Ｙ１及び位置Ｙ２に存在するときの何れにおいても凸部を観測するまで、ＬＲＦ２０２の位置及び角度を補正する。即ち、制御部２０１は、治具３００が位置Ｙ１及び位置Ｙ２に存在するときの何れにおいても走査面２１２が穴３０１を通過すると、ロール方向の角度の補正を完了する。
As described above, the
なお、制御部２０１は、３つ以上の位置に治具３００を移動させてキャリブレーションを行ってもよい。たとえば、制御部２０１は、位置Ｙ２からＹ軸方向に所定の距離離れた位置Ｙ３に治具３００を移動させる。制御部２０１は、治具３００が位置Ｙ１、位置Ｙ２及び位置Ｙ３に存在するときの何れにおいても凸部を観測するまでＬＲＦ２０２の位置及び角度を補正する。
Note that the
また、制御部２０１は、ロール方向の角度（走査面２１２の中心軸Ｃ１を中心とした回転方向の角度）においてＬＲＦ２０２をキャリブレーションする機能を有する。
The
ここでは、制御部２０１は、走査面２１２が目標平面５００に重なるようにＬＲＦ２０２をキャリブレーションする。
Here, the
図１５は、制御部２０１がキャリブレーションに際して測定する治具３００の位置を示す。図１５が示すように、制御部２０１は、位置Ｘ１（第３の位置）と位置Ｘ２（第４の位置）とに存在する治具３００の各部との距離を測定する。
FIG. 15 shows the position of the
位置Ｘ１は、初期位置（位置Ｙ１）から所定の距離Ｘ軸方向に移動した位置である。即ち、位置Ｘ１は、中心軸Ｃ１から所定の距離離れた位置である。また、位置Ｘ２は、初期位置から位置Ｘ１とは逆方向に同一の距離移動した位置である。即ち、位置Ｘ２は、位置Ｘ１と中心軸Ｃ１を挟んで対向する位置である。 A position X1 is a position moved in the X-axis direction by a predetermined distance from the initial position (position Y1). That is, the position X1 is a position a predetermined distance away from the central axis C1. A position X2 is a position that is the same distance away from the initial position in the direction opposite to that of the position X1. That is, the position X2 is a position facing the position X1 across the central axis C1.
治具３００は、位置Ｘ１及び位置Ｘ２において走査面２１２に含まれる。
図１６は、走査面２１２と目標平面５００とが重なっていない状態の例を示す。
FIG. 16 shows an example of a state in which the
図１６では、走査面２１２と目標平面５００との為す角度を角度θとする。また、中心軸Ｃ１と穴３０１との距離を距離Ｌとする。
In FIG. 16, the angle between the
図１６が示すように、走査面２１２と目標平面５００とは重なっていない。図１６が示す例では、走査面２１２は、目標平面５００から角度θ傾いている。
As shown in FIG. 16,
制御部２０１は、ＬＲＦ２０２を用いて位置Ｘ１及び位置Ｘ２において治具３００の各部との距離を測定する。
The
図１６が示す例では、治具３００が位置Ｘ１に存在する場合、走査面２１２は、目標平面５００から傾いているため、穴３０１を通過しない。同様に、治具３００が位置Ｘ２に存在する場合、走査面２１２は、穴３０１を通過しない。
In the example shown in FIG. 16, when the
まず、制御部２０１は、位置Ｘ１に治具３００を移動させる。たとえば、制御部２０１は、治具３００を位置Ｘ１に移動させる制御信号を制御部１０１に送信する。ここで、制御部１０１は、当該制御信号に従って治具３００を位置Ｘ１に移動させる。
First, the
制御部２０１は、治具３００を位置Ｘ１に移動させると、治具３００の各部との距離を測定する。制御部２０１は、位置Ｘ１に存在する治具３００の各部との距離を測定すると、位置Ｘ１から位置Ｘ２に治具３００を移動させる。たとえば、制御部２０１は、治具３００を位置Ｘ２に移動させる制御信号を制御部１０１に送信する。ここで、制御部１０１は、当該制御信号に従って治具３００を位置Ｘ２に移動させる。
When the
制御部２０１は、位置Ｘ２に治具３００を移動させると、治具３００の各部との距離を測定する。
When the
図１７は、制御部２０１が位置Ｘ１及びＸ２に存在する治具３００までの距離を測定した測定結果を示す。
FIG. 17 shows the measurement result of the
図１７が示すように、制御部２０１は、位置Ｘ１に存在する治具３００を測定した場合、凸部を観測しない。治具３００が位置Ｘ１に存在する場合、走査面２１２は、穴３０１を通過しないため、制御部２０１は、治具３００において穴３０１以外の領域を測定する。その結果、制御部２０１は、凸部を観測しない。
As shown in FIG. 17, the
同様に、制御部２０１は、位置Ｘ２に存在する治具３００を測定した場合、凸部を観測しない。
Similarly, the
制御部２０１は、凸部の観測結果に基づいてＬＲＦ２０２の角度を補正する。即ち、制御部２０１は、治具３００が位置Ｘ１又は位置Ｘ２に存在するときの何れかにおいて凸部を観測しない場合、補正部２０３を制御してＬＲＦ２０２の角度を補正する。たとえば、制御部２０１は、補正部２０３を用いてロール方向に回転させる。
The
制御部２０１は、ＬＲＦ２０２の角度を補正すると、再度、ＬＲＦ２０２を用いて位置Ｘ１及び位置Ｘ２に存在する治具３００の各部との距離を測定する。
After correcting the angle of the
制御部２０１は、治具３００が位置Ｘ１又は位置Ｘ２に存在するときの何れかにおいて凸部を観測しない場合、再度、補正部２０３を制御してＬＲＦ２０２の角度を補正する。
When the
制御部２０１は、治具３００が位置Ｘ１及び位置Ｘ２に存在するときの何れにおいても凸部を観測するまで、上記の動作を繰り返す。
The
図１８は、走査面２１２と目標平面５００とが重なっている状態の例を示す。図１８が示すように、走査面２１２は、治具３００が位置Ｘ１及び位置Ｘ２に存在する場合の何れにおいても穴３０１を通過する。
FIG. 18 shows an example of a state in which the
図１９は、図１８の状態において、制御部２０１が取得する測定結果の例を示す。
FIG. 19 shows an example of measurement results acquired by the
図１９が示すように、制御部２０１は、治具３００が位置Ｘ１に存在する場合、凸部Ｄ１を観測する。同様に、制御部２０１は、治具３００が位置Ｘ２に存在する場合、凸部Ｄ２を観測する。
As shown in FIG. 19, the
前述のように、制御部２０１は、治具３００が位置Ｘ１及び位置Ｘ２に存在するときの何れにおいても凸部を観測するまで、ＬＲＦ２０２の角度を補正する。即ち、制御部２０１は、治具３００が位置Ｘ１及び位置Ｘ２に存在するときの何れにおいても走査面２１２が穴３０１を通過すると、ロール方向の角度の補正を完了する。
As described above, the
そのため、穴３０１の高さＨは、ＬＲＦ２０２の走査面２１２と目標平面５００との角度に対して許容される誤差θｂに基づき算出される大きさよりも小さい。即ち、治具３００の穴３０１の高さＨは、以下の式を満たす。
Therefore, the height H of the
Ｈ＜ｔａｎθｂ×Ｌ
なお、制御部２０１は、３つ以上の位置に治具３００を移動させてキャリブレーションを行ってもよい。たとえば、制御部２０１は、位置Ｘ１又は位置Ｘ２からＸ軸方向に所定の距離離れた位置Ｘ３に治具３００を移動させる。制御部２０１は、治具３００が位置Ｘ１、位置Ｘ２及び位置Ｘ３に存在するときの何れにおいても凸部を観測するまでＬＲＦ２０２の角度を補正する。
H<tan θb×L
Note that the
次に、制御部２０１の動作例について説明する。
Next, an operation example of the
図２０は、制御部２０１の動作例について説明するためのフローチャートである。
FIG. 20 is a flowchart for explaining an operation example of the
まず、制御部２０１は、補正部２０３を用いてパン方向及びＸ軸方向においてＬＲＦ２０２のキャリブレーションを行う（Ｓ１）。パン方向及びＸ軸方向においてＬＲＦ２０２のキャリブレーションを行うと、制御部２０１は、補正部２０３を用いてチルト方向及びＺ軸方向においてＬＲＦ２０２のキャリブレーションを行う（Ｓ２）。
First, the
チルト方向及びＺ軸方向においてＬＲＦ２０２のキャリブレーションを行うと、制御部２０１は、補正部２０３を用いてロール方向においてＬＲＦ２０２のキャリブレーションを行う（Ｓ３）。補正部２０３を用いてロール方向においてＬＲＦ２０２のキャリブレーションを行うと、制御部２０１は、動作を終了する。
After calibrating the
次に、制御部２０１が補正部２０３を用いてパン方向及びＸ軸方向においてＬＲＦ２０２のキャリブレーションを行う動作例（Ｓ１）について説明する。
Next, an operation example (S1) in which the
図２１は、制御部２０１が補正部２０３を用いてパン方向及びＸ軸方向においてＬＲＦ２０２のキャリブレーションを行う動作例（Ｓ１）について説明するためのフローチャートである。
FIG. 21 is a flowchart for explaining an operation example (S1) in which the
まず、制御部２０１は、ＬＲＦ２０２を用いて治具３００の各部との距離を測定する（Ｓ１１）。治具３００の各部との距離を測定すると、制御部２０１は、測定結果の凸部に中心軸Ｃ１が含まれるか判定する（Ｓ１２）。
First, the
測定結果の凸部に中心軸Ｃ１が含まれないと判定すると（Ｓ１２、ＮＯ）、制御部２０１は、補正部２０３を用いてＸ軸方向又はパン方向においてＬＲＦ２０２を補正する（Ｓ１３）。
If it is determined that the central axis C1 is not included in the convex portion of the measurement result (S12, NO), the
Ｘ軸方向又はパン方向においてＬＲＦ２０２を補正すると、制御部２０１は、Ｓ１１に戻る。
After correcting the
測定結果の凸部に中心軸Ｃ１が含まれると判定すると（Ｓ１２、ＹＥＳ）、制御部２０１は、動作を終了する。
When determining that the central axis C1 is included in the convex portion of the measurement result (S12, YES), the
次に、制御部２０１が補正部２０３を用いてチルト方向及びＺ軸方向においてＬＲＦ２０２のキャリブレーションを行う動作例（Ｓ２）について説明する。
Next, an operation example (S2) in which the
図２２は、制御部２０１が補正部２０３を用いてチルト方向及びＺ軸方向においてＬＲＦ２０２のキャリブレーションを行う動作例（Ｓ２）について説明するためのフローチャートである。
FIG. 22 is a flowchart for explaining an operation example (S2) in which the
まず、制御部２０１は、治具３００を位置Ｙ１に移動させる（Ｓ２１）。治具３００を位置Ｙ１に移動させると、制御部２０１は、ＬＲＦ２０２を用いて治具３００の各部との距離を測定する（Ｓ２２）。
First, the
治具３００の各部との距離を測定すると、制御部２０１は、治具３００を位置Ｙ２に移動させる（Ｓ２３）。治具３００を位置Ｙ２に移動させると、制御部２０１は、ＬＲＦ２０２を用いて治具３００の各部との距離を測定する（Ｓ２４）。
After measuring the distance to each part of the
ＬＲＦ２０２を用いて治具３００の各部との距離を測定すると、制御部２０１は、治具３００が位置Ｙ１及び位置Ｙ２に存在するときの何れにおいても凸部を観測するか判定する（Ｓ２５）。
After measuring the distance to each part of the
治具３００が位置Ｙ１及び位置Ｙ２に存在するときの何れかにおいて凸部を観測しないと判定すると（Ｓ２５、ＮＯ）、制御部２０１は、補正部２０３を用いてＺ軸方向又はチルト方向においてＬＲＦ２０２を補正する（Ｓ２６）。
When it is determined that the convex portion is not observed at either of the positions Y1 and Y2 of the jig 300 (S25, NO), the
Ｚ軸方向又はチルト方向においてＬＲＦ２０２を補正すると、制御部２０１は、Ｓ２１に戻る。
After correcting the
治具３００が位置Ｙ１及び位置Ｙ２に存在するときの何れにおいても凸部を観測すると判定すると（Ｓ２５、ＹＥＳ）、制御部２０１は、動作を終了する。
When it is determined that the convex portion is observed at both positions Y1 and Y2 of the jig 300 (S25, YES), the
なお、治具３００が初期状態において位置Ｙ１に存在する場合、制御部２０１は、Ｓ２２から実行してもよい。
In addition, when the
次に、制御部２０１が補正部２０３を用いてロール方向においてＬＲＦ２０２のキャリブレーションを行う動作例（Ｓ３）について説明する。
Next, an operation example (S3) in which the
図２３は、制御部２０１が補正部２０３を用いてロール方向においてＬＲＦ２０２のキャリブレーションを行う動作例（Ｓ３）について説明するためのフローチャートである。
FIG. 23 is a flowchart for explaining an operation example (S3) in which the
まず、制御部２０１は、治具３００を位置Ｘ１に移動させる（Ｓ３１）。治具３００を位置Ｘ１に移動させると、制御部２０１は、ＬＲＦ２０２を用いて治具３００の各部との距離を測定する（Ｓ３２）。
First, the
治具３００の各部との距離を測定すると、制御部２０１は、治具３００を位置Ｘ２に移動させる（Ｓ３３）。治具３００を位置Ｘ２に移動させると、制御部２０１は、ＬＲＦ２０２を用いて治具３００の各部との距離を測定する（Ｓ３４）。
After measuring the distance to each part of the
ＬＲＦ２０２を用いて治具３００の各部との距離を測定すると、制御部２０１は、治具３００が位置Ｘ１及び位置Ｘ２に存在するときの何れにおいても凸部を観測するか判定する（Ｓ３５）。
After measuring the distance to each part of the
治具３００が位置Ｘ１及び位置Ｘ２に存在するときの何れかにおいて凸部を観測しないと判定すると（Ｓ３５、ＮＯ）、制御部２０１は、補正部２０３を用いてロール方向においてＬＲＦ２０２を補正する（Ｓ３６）。
If it is determined that the convex portion is not observed when the
ロール方向においてＬＲＦ２０２を補正すると、制御部２０１は、Ｓ３１に戻る。
After correcting the
治具３００が位置Ｘ１及び位置Ｘ２に存在するときの何れにおいても凸部を観測すると判定すると（Ｓ３５、ＹＥＳ）、制御部２０１は、動作を終了する。
If it is determined that the convex portion is observed at both positions X1 and X2 of the jig 300 (S35, YES), the
なお、制御部２０１は、Ｓ１乃至Ｓ３の何れかを実行しなくともよい。
Note that the
また、制御部１０１は、オペレータからの入力に従って治具３００を位置Ｘ１、位置Ｘ２、位置Ｙ１及び位置Ｙ２などに移動させてもよい。この場合、制御部２０１は、オペレータからの入力に従って治具３００の各部との距離を測定してもよい。
Further, the
また、測定装置２００は、オペレータによってキャリブレーションされてもよい。たとえば、オペレータは、設置台などを調整して測定装置２００をＸ軸、Ｙ軸及びＺ軸方向に移動させてもよい。また、オペレータは、ＬＲＦ２０２をパン方向、チルト方向及びロール方向に補正してもよい。この場合、制御部２０１は、自身又はＬＲＦ２０２が適正な位置又は角度に設置されたことを外部に表示してもよい。
Also, the measuring
また、オペレータは、治具３００を位置Ｘ１、位置Ｘ２、位置Ｙ１及び位置Ｙ２などに移動させてもよい。
Also, the operator may move the
また、穴３０１は、治具３００に形成される窪みであってもよい。即ち、穴３０１は、貫通していなくともよい。
Also, the
また、穴３０１は、治具３００の中央部に形成されなくともよい。穴３０１が形成される位置は、特定の位置に限定されるものではない。
Also, the
また、ロボットアーム１０２は、ハンド１０３の代わりに治具３００を取り付けられてもよい。即ち、治具３００は、ロボット１００のエンドエフェクタとしてロボットアーム１０２に取り付けられてもよい。
Also, the
また、制御部２０１は、制御部１０１の機能（又は一部の機能）を実現するものであってもよい。また、制御部１０１は、制御部２０１の機能（又は一部の機能）を実現するものであってもよい。また、制御部１０１及び制御部２０１は、１つの装置として形成されてもよい。
Also, the
以上のように構成される測定装置は、所定の位置にある治具の各部との距離を測定する。治具には、穴が形成される。そのため、測定装置は、治具に形成される穴（たとえば、凸部）を測定する。測定装置は、穴の測定の有無などに従って、自身の位置及び角度を補正する。その結果、測定装置は、自身の位置及び角度を適切にキャリブレーションすることができる。 The measuring device configured as described above measures the distance to each part of the jig at a predetermined position. A hole is formed in the jig. Therefore, the measuring device measures holes (for example, protrusions) formed in the jig. The measuring device corrects its own position and angle according to whether or not the hole is measured. As a result, the measuring device can properly calibrate its position and angle.
本発明のいくつかの実施形態を説明したが、これらの実施形態は、例として提示したものであり、発明の範囲を限定することは意図していない。これら新規な実施形態は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、変更を行うことができる。これら実施形態やその変形は、発明の範囲や要旨に含まれるとともに、特許請求の範囲に記載された発明とその均等の範囲に含まれる。
以下に、本願の出願当初の特許請求の範囲に記載された発明を付記する。
［Ｃ１］
一定方向を走査し、対象物までの距離を測定する一次元センサの光を反射する平面部を有する部材と、
前記部材に、前記一次元センサの走査面の中心軸と前記一次元センサから前記部材に延びる軸との為す角度に対して許容される誤差に基づき算出される幅よりも小さい幅を有する穴と、
を備える治具。
［Ｃ２］
前記穴の高さは、前記一次元センサの走査面と目標平面との為す角度に対して許容される誤差に基づき算出される大きさよりも小さい、
Ｃ１に記載の治具。
［Ｃ３］
前記穴は、矩形に形成される、
Ｃ１又は２に記載の治具。
［Ｃ４］
前記穴は、前記部材の中央に形成される、
Ｃ１乃至３の何れか１項に記載の治具。
［Ｃ５］
前記部材は、矩形に形成される、
Ｃ１乃至４の何れか１項に記載の治具。
［Ｃ６］
Ｃ１乃至５の何れか１項に記載の治具の各部との距離を、前記一次元センサを用いて測定し、
測定結果に基づいて、前記一次元センサの位置又は角度を補正する、
補正方法。
［Ｃ７］
前記穴が観測された位置に基づいて前記一次元センサの前記穴の幅に沿った方向の角度又は前記幅に沿った方向において前記一次元センサの位置を補正する、
Ｃ６に記載の補正方法。
［Ｃ８］
前記穴は、前記治具の中央に形成され、
前記穴が観測される領域と前記一次元センサの走査面の中心軸とが重なるように、前記一次元センサの前記幅に沿った方向の角度又は前記幅に沿った方向における位置を補正する、
Ｃ７に記載の補正方法。
［Ｃ９］
前記治具を第１の位置と、前記一次元センサから前記治具に向う方向に前記第１の位置から所定の距離移動した第２の位置と、に移動させ、
前記治具を前記第１の位置に設置した場合の前記穴の観測結果及び前記治具を前記第２の位置に設置した場合の前記穴の観測結果に基づいて、前記一次元センサの前記穴の高さに沿った方向の角度又は前記高さに沿った方向における位置を補正する、
Ｃ６乃至８の何れか１項に記載の補正方法。
［Ｃ１０］
前記治具を前記第１の位置に設置した場合に前記穴が観測され、かつ、前記治具を前記第２の位置に設置した場合に前記穴が観測されるように、前記一次元センサの前記高さに沿った方向の角度又は前記高さに沿った方向における位置を補正する、
Ｃ９に記載の補正方法。
［Ｃ１１］
前記治具を前記一次元センサの走査面の中心軸から前記幅に沿った方向に所定の距離離れた第３の位置と、前記第３の位置と前記走査面の中心軸を挟んで対向する第４の位置と、に移動させ、
前記治具を前記第３の位置に設置した場合の前記穴の観測結果及び前記治具を前記第４の位置に設置した場合の前記穴の観測結果に基づいて、前記一次元センサの前記走査面の中心軸を中心とした回転方向の角度を補正する、
Ｃ６乃至１０の何れか１項に記載の補正方法。
［Ｃ１２］
前記治具を前記第３の位置に設置した場合に前記穴が観測され、かつ、前記治具を前記第４の位置に設置した場合に前記穴が観測されるように、前記一次元センサの前記回転方向の角度を補正する、
Ｃ１１に記載の補正方法。
［Ｃ１３］
前記治具は、ロボットアームの先端に設置される、
Ｃ６乃至１２の何れか１項に記載の補正方法。
［Ｃ１４］
ロボットとＣ１乃至５の何れか１項に記載の治具と測定装置とを備えるロボットシステムであって、
前記ロボットは、
ロボットアームを備え、
前記治具は、
前記ロボットアームによって目標平面と交差する位置に設置され、
前記測定装置は、
一定方向を走査し、対象物までの距離を測定する一次元センサと、
前記一次元センサの角度又は位置を補正する補正部と、
前記一次元センサを用いて前記治具の各部との距離を測定し、
前記穴の観測結果に基づいて、前記補正部を用いて前記一次元センサの角度又は位置を補正する、
制御部と、
を備える、
ロボットシステム。
While several embodiments of the invention have been described, these embodiments have been presented by way of example and are not intended to limit the scope of the invention. These novel embodiments can be implemented in various other forms, and various omissions, replacements, and modifications can be made without departing from the scope of the invention. These embodiments and modifications thereof are included in the scope and gist of the invention, and are included in the scope of the invention described in the claims and equivalents thereof.
The invention described in the scope of claims at the time of filing of the present application will be additionally described below.
[C1]
A member having a planar portion that reflects light from a one-dimensional sensor that scans in a certain direction and measures the distance to an object;
a hole in the member having a width smaller than a width calculated based on a permissible error with respect to an angle between the central axis of the scanning surface of the one-dimensional sensor and an axis extending from the one-dimensional sensor to the member; ,
Jig with
[C2]
The height of the hole is smaller than the size calculated based on the permissible error for the angle formed by the scanning plane of the one-dimensional sensor and the target plane.
The jig according to C1.
[C3]
the hole is formed in a rectangular shape,
The jig according to C1 or 2.
[C4]
The hole is formed in the center of the member,
The jig according to any one of C1 to 3.
[C5]
The member is formed in a rectangular shape,
The jig according to any one of C1 to 4.
[C6]
Measure the distance from each part of the jig according to any one of C1 to 5 using the one-dimensional sensor,
correcting the position or angle of the one-dimensional sensor based on the measurement result;
correction method.
[C7]
correcting the position of the one-dimensional sensor in the angle along the width of the hole of the one-dimensional sensor or in the direction along the width based on the position where the hole was observed;
The correction method described in C6.
[C8]
The hole is formed in the center of the jig,
correcting the angle of the one-dimensional sensor in the direction along the width or the position in the direction along the width so that the area where the hole is observed and the central axis of the scanning surface of the one-dimensional sensor overlap;
The correction method described in C7.
[C9]
moving the jig to a first position and a second position that is a predetermined distance from the first position in a direction from the one-dimensional sensor toward the jig;
Based on the observation result of the hole when the jig is installed at the first position and the observation result of the hole when the jig is installed at the second position, the hole of the one-dimensional sensor correcting the angle in the direction along the height of or the position in the direction along the height of
The correction method according to any one of C6 to 8.
[C10]
The one-dimensional sensor is arranged such that the hole is observed when the jig is installed at the first position and the hole is observed when the jig is installed at the second position. correcting the angle in the direction along the height or the position in the direction along the height;
Correction method described in C9.
[C11]
The jig is opposed to a third position separated by a predetermined distance in a direction along the width from the central axis of the scanning plane of the one-dimensional sensor, with the third position and the central axis of the scanning plane interposed therebetween. move to a fourth position and
The scanning of the one-dimensional sensor based on the observation result of the hole when the jig is installed at the third position and the observation result of the hole when the jig is installed at the fourth position correcting the angle of rotation around the central axis of the face,
The correction method according to any one of C6 to C10.
[C12]
The one-dimensional sensor is arranged such that the hole is observed when the jig is installed at the third position and the hole is observed when the jig is installed at the fourth position. correcting the angle in the direction of rotation;
The correction method described in C11.
[C13]
The jig is installed at the tip of the robot arm,
The correction method according to any one of C6 to C12.
[C14]
A robot system comprising a robot, the jig according to any one of C1 to C5, and a measuring device,
The robot is
Equipped with a robot arm,
The jig is
installed at a position intersecting the target plane by the robot arm,
The measuring device is
a one-dimensional sensor that scans in a certain direction and measures the distance to an object;
a correction unit that corrects the angle or position of the one-dimensional sensor;
measuring the distance from each part of the jig using the one-dimensional sensor;
correcting the angle or position of the one-dimensional sensor using the correction unit based on the observation result of the hole;
a control unit;
comprising
robot system.
１…ロボットシステム、１００…ロボット、１０１…制御部、１０２…ロボットアーム、１０３…ハンド、２００…測定装置、２０１…制御部、２０２…ＬＲＦ、２０３…補正部、２１１…レーザ、２１２…走査面、３００…治具、３０１…穴、５００…目標平面。
DESCRIPTION OF
Claims (12)
一定方向を走査し、対象物までの距離を測定する一次元センサの光を反射する平面部を有する部材と、前記部材に、前記一次元センサの走査面の中心軸と前記一次元センサから前記部材に延びる軸との為す角度に対して許容される誤差に基づき算出される幅よりも小さい幅を有する穴と、を備える治具を第１の位置と、前記一次元センサから前記治具に向う方向に前記第１の位置から所定の距離移動した第２の位置と、に移動させ、
前記治具を前記第１の位置に設置した場合の前記穴の観測結果及び前記治具を前記第２の位置に設置した場合の前記穴の観測結果に基づいて、前記一次元センサの前記穴の高さに沿った方向の角度又は前記高さに沿った方向における位置を補正する、
補正方法。 A correction method performed by a processor, comprising:
a member having a planar portion that reflects light from a one-dimensional sensor that scans a fixed direction and measures the distance to an object; a hole having a width smaller than a width calculated based on an allowable error for an angle formed with an axis extending through a member; to a second position that is a predetermined distance from the first position in the opposite direction;
Based on the observation result of the hole when the jig is installed at the first position and the observation result of the hole when the jig is installed at the second position, the hole of the one-dimensional sensor correcting the angle in the direction along the height of or the position in the direction along the height of
correction method .
請求項１に記載の補正方法。 The height of the hole is smaller than the size calculated based on the permissible error for the angle formed by the scanning plane of the one-dimensional sensor and the target plane.
The correction method according to claim 1.
請求項１又は２に記載の補正方法。 the hole is formed in a rectangular shape,
The correction method according to claim 1 or 2.
請求項１乃至３の何れか１項に記載の補正方法。 The hole is formed in the center of the member,
The correction method according to any one of claims 1 to 3.
請求項１乃至４の何れか１項に記載の補正方法。 The member is formed in a rectangular shape,
The correction method according to any one of claims 1 to 4.
請求項１乃至５の何れか１項に記載の補正方法。 correcting the position of the one-dimensional sensor in the angle along the width of the hole of the one-dimensional sensor or in the direction along the width based on the position where the hole was observed;
The correction method according to any one of claims 1 to 5 .
前記穴が観測される領域と前記一次元センサの走査面の中心軸とが重なるように、前記一次元センサの前記幅に沿った方向の角度又は前記幅に沿った方向における位置を補正する、
請求項６に記載の補正方法。 The hole is formed in the center of the jig,
correcting the angle of the one-dimensional sensor in the direction along the width or the position in the direction along the width so that the area where the hole is observed and the central axis of the scanning surface of the one-dimensional sensor overlap;
The correction method according to claim 6.
請求項１乃至７の何れか１項に記載の補正方法。 The one-dimensional sensor is arranged such that the hole is observed when the jig is installed at the first position and the hole is observed when the jig is installed at the second position. correcting the angle in the direction along the height or the position in the direction along the height;
The correction method according to any one of claims 1 to 7 .
前記治具を前記第３の位置に設置した場合の前記穴の観測結果及び前記治具を前記第４の位置に設置した場合の前記穴の観測結果に基づいて、前記一次元センサの前記走査面の中心軸を中心とした回転方向の角度を補正する、
請求項１乃至８の何れか１項に記載の補正方法。 The jig is opposed to a third position separated by a predetermined distance in a direction along the width from the central axis of the scanning plane of the one-dimensional sensor, with the third position and the central axis of the scanning plane interposed therebetween. move to a fourth position and
The scanning of the one-dimensional sensor based on the observation result of the hole when the jig is installed at the third position and the observation result of the hole when the jig is installed at the fourth position correcting the angle of rotation around the central axis of the face,
The correction method according to any one of claims 1 to 8 .
請求項９に記載の補正方法。 The one-dimensional sensor is arranged such that the hole is observed when the jig is installed at the third position, and the hole is observed when the jig is installed at the fourth position. correcting the angle in the direction of rotation;
The correction method according to claim 9 .
請求項１乃至１０の何れか１項に記載の補正方法。 The jig is installed at the tip of the robot arm,
The correction method according to any one of claims 1 to 10 .
前記ロボットは、
ロボットアームを備え、
前記治具は、
前記ロボットアームによって目標平面と交差する位置に設置され、
一定方向を走査し、対象物までの距離を測定する一次元センサの光を反射する平面部を有する部材と、
前記部材に、前記一次元センサの走査面の中心軸と前記一次元センサから前記部材に延びる軸との為す角度に対して許容される誤差に基づき算出される幅よりも小さい幅を有する穴と、
を備え、
前記ロボットは、前記治具を第１の位置と、前記一次元センサから前記治具に向う方向に前記第１の位置から所定の距離移動した第２の位置と、に移動させ、
前記測定装置は、
前記一次元センサと、
前記一次元センサの角度又は位置を補正する補正部と、
前記治具を前記第１の位置に設置した場合の前記穴の観測結果及び前記治具を前記第２の位置に設置した場合の前記穴の観測結果に基づいて、前記一次元センサの前記穴の高さに沿った方向の角度又は前記高さに沿った方向における位置を補正する制御部と、
を備える、
ロボットシステム。
A robot system comprising a robot , a jig , and a measuring device,
The robot is
Equipped with a robot arm,
The jig is
installed at a position intersecting the target plane by the robot arm,
A member having a planar portion that reflects light from a one-dimensional sensor that scans in a certain direction and measures the distance to an object;
a hole in the member having a width smaller than a width calculated based on a permissible error with respect to an angle between the central axis of the scanning surface of the one-dimensional sensor and an axis extending from the one-dimensional sensor to the member; ,
with
The robot moves the jig to a first position and to a second position that is a predetermined distance from the first position in a direction from the one-dimensional sensor toward the jig,
The measuring device is
the one-dimensional sensor;
a correction unit that corrects the angle or position of the one-dimensional sensor;
Based on the observation result of the hole when the jig is installed at the first position and the observation result of the hole when the jig is installed at the second position, the hole of the one-dimensional sensor a control unit that corrects the angle in the direction along the height of or the position in the direction along the height ;
comprising
robot system.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2019023425A JP7246955B2 (en) | 2019-02-13 | 2019-02-13 | Correction method and system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2019023425A JP7246955B2 (en) | 2019-02-13 | 2019-02-13 | Correction method and system |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2020131297A JP2020131297A (en) | 2020-08-31 |
| JP7246955B2 true JP7246955B2 (en) | 2023-03-28 |
Family
ID=72261878
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2019023425A Active JP7246955B2 (en) | 2019-02-13 | 2019-02-13 | Correction method and system |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7246955B2 (en) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112428264B (en) * | 2020-10-26 | 2021-12-07 | 中国计量大学 | Robot arm correction method and system |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009172718A (en) | 2008-01-24 | 2009-08-06 | Canon Inc | Working device and calibration method of the same |
| JP2014235074A (en) | 2013-06-03 | 2014-12-15 | パナソニック株式会社 | Calibration jig and calibration method of optical interference measurement device |
| JP2015182144A (en) | 2014-03-20 | 2015-10-22 | キヤノン株式会社 | Robot system and calibration method of robot system |
-
2019
- 2019-02-13 JP JP2019023425A patent/JP7246955B2/en active Active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009172718A (en) | 2008-01-24 | 2009-08-06 | Canon Inc | Working device and calibration method of the same |
| JP2014235074A (en) | 2013-06-03 | 2014-12-15 | パナソニック株式会社 | Calibration jig and calibration method of optical interference measurement device |
| JP2015182144A (en) | 2014-03-20 | 2015-10-22 | キヤノン株式会社 | Robot system and calibration method of robot system |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2020131297A (en) | 2020-08-31 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107530877B (en) | Robot teaching method and robot | |
| EP3503029B1 (en) | Calibrating method and calibration apparatus | |
| US9002516B2 (en) | Calibration method for tool center point of a robot manipulator | |
| CN109648603B (en) | Measuring system | |
| KR102184953B1 (en) | Robot and teaching method of robot | |
| US11597093B2 (en) | Calibration method for laser processing robot | |
| JP2011251384A (en) | Transfer device | |
| JP6900290B2 (en) | Robot system | |
| US10020216B1 (en) | Robot diagnosing method | |
| JP2017019072A (en) | Position measurement system | |
| JP2011177845A (en) | Method for calibrating robot and robot calibration device | |
| JP6622772B2 (en) | Measuring system | |
| US20190129400A1 (en) | Robot, robot system, and method for setting coordinate system of robot | |
| JP7246955B2 (en) | Correction method and system | |
| JP2010162611A (en) | Relative teaching method | |
| JP2012223871A (en) | Origin correction method and system of robot joint | |
| JP2020049641A (en) | Control device, robot system, and robot | |
| WO2021241187A1 (en) | Shape measurement device and shape measurement method | |
| CN111344119A (en) | Apparatus and method for robot | |
| JP7103200B2 (en) | Transport system and transport control method | |
| US20200101618A1 (en) | Control device, robot system, and robot | |
| US20190043750A1 (en) | Robot diagnosing method | |
| KR20110109723A (en) | System and method for teaching an automatical machine | |
| KR20230040575A (en) | Teaching system of robot assembly provided in vacuum chamber | |
| JP2023053455A (en) | Industrial robot and control method for industrial robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220117 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20221129 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20221220 |
|
| RD01 | Notification of change of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7421 Effective date: 20230105 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230131 |
|
| 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: 20230214 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230315 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7246955 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |