JP2890874B2 - ロボットアーム相対姿勢補正方法 - Google Patents
ロボットアーム相対姿勢補正方法Info
- Publication number
- JP2890874B2 JP2890874B2 JP6034791A JP6034791A JP2890874B2 JP 2890874 B2 JP2890874 B2 JP 2890874B2 JP 6034791 A JP6034791 A JP 6034791A JP 6034791 A JP6034791 A JP 6034791A JP 2890874 B2 JP2890874 B2 JP 2890874B2
- Authority
- JP
- Japan
- Prior art keywords
- end effector
- robot arm
- mark
- camera
- relative posture
- 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.)
- Expired - Fee Related
Links
Landscapes
- Length Measuring Devices By Optical Means (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Description
【０００１】
【産業上の利用分野】この発明はロボットアーム相対姿
勢補正方法、とくに組立ドッキング作業などを行なう際
にロボット相対姿勢位置決めのためのマークを用いた相
対姿勢補正の方法に関するものである。
勢補正方法、とくに組立ドッキング作業などを行なう際
にロボット相対姿勢位置決めのためのマークを用いた相
対姿勢補正の方法に関するものである。
【０００２】
【従来の技術】従来、この種のマークとしては立体的な
マークが考えられており、立体マークの見える位置と見
え方により、並進位置ずれと回転ずれを検出するように
なっている。図４および図５は各々、例えば特開平２−
２６４８０４号公報に示された従来のロボットアーム相
対姿勢補正方法に用いられるマークを示す断面図および
正面図である。図において、位置決めマーク１は、中心
円２から段差を設け、円錐台状にくり抜いて形成された
中間リング３と、正面に設けられた最外リング４とを備
えている。中心円２は、図５に示すように、白色に塗ら
れており、その表面には中心で交差する十字ライン５が
設けられている。この十字ライン５は、黒色に塗られそ
の形状と中心位置が明瞭にされている。中間リング３
は、中心円２と同じく白色に塗られている。また中間リ
ング３には、十字ライン５の延長上に位置する黒色の切
れ目６が設けられている。最外リング４は、中心円２お
よび中間リング３と同心をなし、その表面は白色に塗ら
れている。また円錐台状にくり抜くことによって形成さ
れたテーパ壁７、８は中心円２と中間リング３と最外リ
ング４との輪郭を明瞭にするために黒色に塗られてい
る。
マークが考えられており、立体マークの見える位置と見
え方により、並進位置ずれと回転ずれを検出するように
なっている。図４および図５は各々、例えば特開平２−
２６４８０４号公報に示された従来のロボットアーム相
対姿勢補正方法に用いられるマークを示す断面図および
正面図である。図において、位置決めマーク１は、中心
円２から段差を設け、円錐台状にくり抜いて形成された
中間リング３と、正面に設けられた最外リング４とを備
えている。中心円２は、図５に示すように、白色に塗ら
れており、その表面には中心で交差する十字ライン５が
設けられている。この十字ライン５は、黒色に塗られそ
の形状と中心位置が明瞭にされている。中間リング３
は、中心円２と同じく白色に塗られている。また中間リ
ング３には、十字ライン５の延長上に位置する黒色の切
れ目６が設けられている。最外リング４は、中心円２お
よび中間リング３と同心をなし、その表面は白色に塗ら
れている。また円錐台状にくり抜くことによって形成さ
れたテーパ壁７、８は中心円２と中間リング３と最外リ
ング４との輪郭を明瞭にするために黒色に塗られてい
る。
【０００３】従来の位置決めマークは以上のように構成
されており、カメラの光軸とマークの中心軸が一致して
いるときはカメラ視野の中心に図５のように撮像され、
一致していなければ、例えば図６のように位置決めマー
クの十字ラインの中心位置１７と中間リングおよび最外
リング（中心位置１６）が偏心して撮像されるので、図
５のように撮像されるように偏心している方向に位置を
修正すればよく、カメラの光軸とマークの中心軸が一致
しているが回転ずれを生じている場合は中間リングの切
れ目が所定位置からずれるのでそのずれ量に対応して回
転修正をほどこせばよいとされている。
されており、カメラの光軸とマークの中心軸が一致して
いるときはカメラ視野の中心に図５のように撮像され、
一致していなければ、例えば図６のように位置決めマー
クの十字ラインの中心位置１７と中間リングおよび最外
リング（中心位置１６）が偏心して撮像されるので、図
５のように撮像されるように偏心している方向に位置を
修正すればよく、カメラの光軸とマークの中心軸が一致
しているが回転ずれを生じている場合は中間リングの切
れ目が所定位置からずれるのでそのずれ量に対応して回
転修正をほどこせばよいとされている。
【０００４】
【発明が解決しようとする課題】従来のロボットアーム
相対姿勢補正方法は以上のようになされており、上述し
た従来の位置決めマークと位置決め方法には以下の欠点
があった。 （１）マーク自体が複雑な形状と配色になっており、コ
ンピュータによる画像処理技術で自動認識させるのに複
雑なプログラムが必要である。 （２）また、上述のような位置修正方法で、カメラ光軸
と位置決めマークの中心軸が合ったとしても、それは実
際に対象物に作用するエンドエフェクタの位置が合った
ことを保証せず、そのためにはカメラ光軸とエンドエフ
ェクタの中心軸との相対関係を厳密に校正しておく必要
がある。このことを図を用いて説明する。図７におい
て、１０はカメラ、２０、２０’はエンドエフェクタ、
３０、３０’は各々エンドエフェクタ２０、２０’と一
体となっているロボットアームであり、カメラ１０の光
軸は位置決めマーク１の中心軸に合っている。この時カ
メラの光軸とエンドエフェクタの中心軸の相対位置関係
が厳密に校正されていればエンドエフェクタは２０’に
示されるようにエンドエフェクタ作用位置４０の位置に
合うが、さもなければ例えばエンドエフェクタ２０の位
置となってエンドエフェクタ作用位置４０からはずれ
る。この相対位置関係はカメラのレンズを交換したり、
焦点を変えてもずれることがあり、またエンドエフェク
タの中心軸はロボットに取り付けた状態では観測しがた
いため、その厳密な校正は現実には非常に困難である。 （３）上述のようにカメラ光軸と位置決めマークの中心
軸が合ったのち、軸の回転ずれを修正するが、十字ライ
ンの中心位置と中間リングの切れ目の位置の差から回転
角を計算するため、精度を上げることが難しく、しかも
わずかな回転角の誤差でもカメラ取り付けアームがなが
いとエンドエフェクタの位置の誤差は大きくなる。この
ことを図を用いて説明する。図８はカメラ光軸の方向か
ら見た図で、３５はカメラ取付アームである。図におい
て、カメラ光軸と位置決めマークの中心軸は合っている
が、中間リングの切れ目の位置の計測エラーから回転角
がθだけずれて認識されたため、本来ならば２０’の位
置にエンドエフェクタが来るべきところが２０の位置に
きたことを示している。このずれ量はカメラ光軸中心と
エンドエフェクタの中心軸の距離が大きいほど大きくな
る。
相対姿勢補正方法は以上のようになされており、上述し
た従来の位置決めマークと位置決め方法には以下の欠点
があった。 （１）マーク自体が複雑な形状と配色になっており、コ
ンピュータによる画像処理技術で自動認識させるのに複
雑なプログラムが必要である。 （２）また、上述のような位置修正方法で、カメラ光軸
と位置決めマークの中心軸が合ったとしても、それは実
際に対象物に作用するエンドエフェクタの位置が合った
ことを保証せず、そのためにはカメラ光軸とエンドエフ
ェクタの中心軸との相対関係を厳密に校正しておく必要
がある。このことを図を用いて説明する。図７におい
て、１０はカメラ、２０、２０’はエンドエフェクタ、
３０、３０’は各々エンドエフェクタ２０、２０’と一
体となっているロボットアームであり、カメラ１０の光
軸は位置決めマーク１の中心軸に合っている。この時カ
メラの光軸とエンドエフェクタの中心軸の相対位置関係
が厳密に校正されていればエンドエフェクタは２０’に
示されるようにエンドエフェクタ作用位置４０の位置に
合うが、さもなければ例えばエンドエフェクタ２０の位
置となってエンドエフェクタ作用位置４０からはずれ
る。この相対位置関係はカメラのレンズを交換したり、
焦点を変えてもずれることがあり、またエンドエフェク
タの中心軸はロボットに取り付けた状態では観測しがた
いため、その厳密な校正は現実には非常に困難である。 （３）上述のようにカメラ光軸と位置決めマークの中心
軸が合ったのち、軸の回転ずれを修正するが、十字ライ
ンの中心位置と中間リングの切れ目の位置の差から回転
角を計算するため、精度を上げることが難しく、しかも
わずかな回転角の誤差でもカメラ取り付けアームがなが
いとエンドエフェクタの位置の誤差は大きくなる。この
ことを図を用いて説明する。図８はカメラ光軸の方向か
ら見た図で、３５はカメラ取付アームである。図におい
て、カメラ光軸と位置決めマークの中心軸は合っている
が、中間リングの切れ目の位置の計測エラーから回転角
がθだけずれて認識されたため、本来ならば２０’の位
置にエンドエフェクタが来るべきところが２０の位置に
きたことを示している。このずれ量はカメラ光軸中心と
エンドエフェクタの中心軸の距離が大きいほど大きくな
る。
【０００５】この発明は上記のような問題点を解消する
ためになされたもので、画像処理技術で容易に自動認識
できる簡単なマークを用いて、作業対象とエンドエフェ
クタの相対姿勢を精度よく合わせることができるロボッ
トアーム相対姿勢補正方法を提供することを目的として
いる。
ためになされたもので、画像処理技術で容易に自動認識
できる簡単なマークを用いて、作業対象とエンドエフェ
クタの相対姿勢を精度よく合わせることができるロボッ
トアーム相対姿勢補正方法を提供することを目的として
いる。
【０００６】
【課題を解決するための手段】この発明に係わるロボッ
トアーム相対姿勢補正方法は、エンドエフェクタが作用
すべき位置を中心とする同一円周上に、３個以上のマー
クを配置し、上記エンドエフェクタと一体となっている
ロボットアーム軸に取り付けたテレビカメラで、上記ロ
ボットアーム軸を所定量だけ回転させて上記マークを順
次撮像し、撮像された上記マークの、上記テレビカメラ
の同一視野における位置を各々計測し、その計測結果に
基づいて上記エンドエフェクタの相対姿勢補正量を計算
し、この相対姿勢補正量によりエンドエフェクタの姿勢
を補正するものである。
トアーム相対姿勢補正方法は、エンドエフェクタが作用
すべき位置を中心とする同一円周上に、３個以上のマー
クを配置し、上記エンドエフェクタと一体となっている
ロボットアーム軸に取り付けたテレビカメラで、上記ロ
ボットアーム軸を所定量だけ回転させて上記マークを順
次撮像し、撮像された上記マークの、上記テレビカメラ
の同一視野における位置を各々計測し、その計測結果に
基づいて上記エンドエフェクタの相対姿勢補正量を計算
し、この相対姿勢補正量によりエンドエフェクタの姿勢
を補正するものである。
【０００７】
【作用】この発明のロボットアーム相対姿勢補正方法で
は、エンドエフェクタが作用すべき位置を中心とする同
一円周上に複数配置したマークを、エンドエフェクタと
一体となっているロボットアームの先端の軸に取り付け
たテレビカメラで、該ロボットアーム軸を所定量だけ回
転させて順次撮像し、該マークが該テレビカメラの視野
に写る位置により、エンドエフェクタの相対姿勢補正量
を計算してロボットアームの相対姿勢を補正するように
しているので、簡単なマークにより精度のよい相対姿勢
補正が可能となり、また作業対象とエンドエフェクタの
中心軸のずれも検出でき、相対姿勢を精度よく合わせる
ことができる。
は、エンドエフェクタが作用すべき位置を中心とする同
一円周上に複数配置したマークを、エンドエフェクタと
一体となっているロボットアームの先端の軸に取り付け
たテレビカメラで、該ロボットアーム軸を所定量だけ回
転させて順次撮像し、該マークが該テレビカメラの視野
に写る位置により、エンドエフェクタの相対姿勢補正量
を計算してロボットアームの相対姿勢を補正するように
しているので、簡単なマークにより精度のよい相対姿勢
補正が可能となり、また作業対象とエンドエフェクタの
中心軸のずれも検出でき、相対姿勢を精度よく合わせる
ことができる。
【０００８】
【実施例】実施例１． 図１は、この発明の一実施例を示すもので、１−１〜１
−４は４こからなる位置決めマーク、１０はカメラ、２
０はエンドエフェクタ、３０はエンドエフェクタと一体
となったロボットアーム、３５はカメラ１０を該ロボッ
トアームに取り付けるためのカメラ取り付けアーム、４
０はエンドエフェクタ２０が作用する作用位置で、この
マークは該作用位置４０を中心とする同一円周上に９０
度間隔で設置されている。各位置決めマークは円錐台の
形状をなしており、その側面は上面や背景と明確に区別
できるように、黒く配色されている。
−４は４こからなる位置決めマーク、１０はカメラ、２
０はエンドエフェクタ、３０はエンドエフェクタと一体
となったロボットアーム、３５はカメラ１０を該ロボッ
トアームに取り付けるためのカメラ取り付けアーム、４
０はエンドエフェクタ２０が作用する作用位置で、この
マークは該作用位置４０を中心とする同一円周上に９０
度間隔で設置されている。各位置決めマークは円錐台の
形状をなしており、その側面は上面や背景と明確に区別
できるように、黒く配色されている。
【０００９】次に動作について図２のフローチャートに
従って説明する。まずステップＳ１ではロボットアーム
を制御してエンドエフェクタをその作用位置近くに概略
位置決めする。ステップＳ２ではエンドエフェクタの軸
回りに９０度づつロボットアームをカメラとともに回転
させて順次該カメラでこのマーク１−１〜１−４を撮像
し、撮像し終えたら−２７０度回転させてエンドエフェ
クタをもとの位置に戻す。ステップＳ３ではこのマーク
の撮像データから、エンドエフェクタの目標位置からの
ずれ量を計算する。ステップＳ４ではそのずれ量を評価
して、それが許容範囲なら位置決め完了とし、さもなけ
れば、計算したずれ量をもとにロボットアームを制御し
てエンドエフェクタの位置を補正する。
従って説明する。まずステップＳ１ではロボットアーム
を制御してエンドエフェクタをその作用位置近くに概略
位置決めする。ステップＳ２ではエンドエフェクタの軸
回りに９０度づつロボットアームをカメラとともに回転
させて順次該カメラでこのマーク１−１〜１−４を撮像
し、撮像し終えたら−２７０度回転させてエンドエフェ
クタをもとの位置に戻す。ステップＳ３ではこのマーク
の撮像データから、エンドエフェクタの目標位置からの
ずれ量を計算する。ステップＳ４ではそのずれ量を評価
して、それが許容範囲なら位置決め完了とし、さもなけ
れば、計算したずれ量をもとにロボットアームを制御し
てエンドエフェクタの位置を補正する。
【００１０】ここでステップＳ３についてもう少し詳し
く説明する。位置決めマークはエンドエフェクタが作用
すべき位置を中心とする同心円上に９０度毎に配置され
ており、カメラはエンドエフェクタの中心軸の回りに９
０度づつ回転させられて該マークを撮像するので、この
マークが各視野の同じ位置に撮像されるならば、エンド
エフェクタが作用すべき位置の中心軸とエンドエフェク
タの中心軸が一致していることは容易にわかる。該中心
軸の軸回りの回転ずれについては、マークの像位置の視
野中心からの変位と、カメラ光軸とエンドエフェクタ中
心軸の距離から計算される。図３は４つのマークが撮像
された例を示す。図中破線の十字マークは視野の中心を
示し、１００−１〜１００−４は各々マーク１−１〜１
−４を撮像した時の視野で、破線の大小の円はエンドエ
フェクタの位置決めが正しかった場合に写った各マーク
の円錐台の側面の境界を示し、実線の大小の円はエンド
エフェクタの位置決めがずれていた場合に写った各マー
クの円錐台の側面の下辺および上辺の境界を示すもの
で、この側面の上下２つの境界は請求項２で述べている
マークの高さの異なる二つの部分に相当する。
く説明する。位置決めマークはエンドエフェクタが作用
すべき位置を中心とする同心円上に９０度毎に配置され
ており、カメラはエンドエフェクタの中心軸の回りに９
０度づつ回転させられて該マークを撮像するので、この
マークが各視野の同じ位置に撮像されるならば、エンド
エフェクタが作用すべき位置の中心軸とエンドエフェク
タの中心軸が一致していることは容易にわかる。該中心
軸の軸回りの回転ずれについては、マークの像位置の視
野中心からの変位と、カメラ光軸とエンドエフェクタ中
心軸の距離から計算される。図３は４つのマークが撮像
された例を示す。図中破線の十字マークは視野の中心を
示し、１００−１〜１００−４は各々マーク１−１〜１
−４を撮像した時の視野で、破線の大小の円はエンドエ
フェクタの位置決めが正しかった場合に写った各マーク
の円錐台の側面の境界を示し、実線の大小の円はエンド
エフェクタの位置決めがずれていた場合に写った各マー
クの円錐台の側面の下辺および上辺の境界を示すもの
で、この側面の上下２つの境界は請求項２で述べている
マークの高さの異なる二つの部分に相当する。
【００１１】図３の実線の大小の円のように各マークが
中心からずれて写った場合のエンドエフェクタのずれ量
の計算方法について説明する。３次元空間のずれとして
はｘｙｚの各軸に平行な並進ずれと、ｘｙｚ各軸の回り
の回転ずれとを考えなければならないが、カメラやマー
クの配置設計データから、上記並進ずれと回転ずれが発
生したとき、カメラ視野のどの位置にマークが撮像され
るかは、幾何学的な座標変換により容易に計算できる。
しかし逆に撮像された位置から並進ずれ量ｄｘ、ｄｙ、
ｄｚと回転ずれ量θｘ、θｙ、θｚを解析的に求めるこ
とは一般的にできない。そこでずれ量ｄｘ、ｄｙ、ｄ
ｚ、θｘ、θｙ、θｚを仮定し、仮定に基づいて各マー
クの撮像位置を計算し、実際の撮像位置との距離の２乗
和を評価値Ｖとして、Ｖが最小になるようなｄｘ、ｄ
ｙ、ｄｚ、θｘ、θｙ、θｚを最急降下法などの数学的
手法をもちいて求める。
中心からずれて写った場合のエンドエフェクタのずれ量
の計算方法について説明する。３次元空間のずれとして
はｘｙｚの各軸に平行な並進ずれと、ｘｙｚ各軸の回り
の回転ずれとを考えなければならないが、カメラやマー
クの配置設計データから、上記並進ずれと回転ずれが発
生したとき、カメラ視野のどの位置にマークが撮像され
るかは、幾何学的な座標変換により容易に計算できる。
しかし逆に撮像された位置から並進ずれ量ｄｘ、ｄｙ、
ｄｚと回転ずれ量θｘ、θｙ、θｚを解析的に求めるこ
とは一般的にできない。そこでずれ量ｄｘ、ｄｙ、ｄ
ｚ、θｘ、θｙ、θｚを仮定し、仮定に基づいて各マー
クの撮像位置を計算し、実際の撮像位置との距離の２乗
和を評価値Ｖとして、Ｖが最小になるようなｄｘ、ｄ
ｙ、ｄｚ、θｘ、θｙ、θｚを最急降下法などの数学的
手法をもちいて求める。
【００１２】この手順を次に説明する。座標系の原点は
エンドエフェクタの中心軸上でカメラのレンズ中心面と
交わる位置とする。 ［１］まず作業対象とエンドエフェクタの相対位置は設
計通りであると仮定する。即ち、ｄｘ＝０、ｄｙ＝０、
ｄｚ＝０、θｘ＝０、θｙ＝０、θｚ＝０とする。 ［２］仮定されたｄｘ、ｄｙ、ｄｚ、θｘ、θｙ、θｚ
に対して、各マークが位置すべき空間座標を設計データ
から計算する。これは設計された空間座標に対してθ
ｘ、θｙ、θｚから計算されるいわゆる回転マトリクス
を掛けた後、並進ベクトル（ｄｘ、ｄｙ、ｄｚ）を加え
ることで得られる。 ［３］計算されたマーク座標から、カメラで撮像した時
のマークの結像位置を計算する。これは幾何光学のレン
ズの式から計算することができる。マークである円錐台
の側面の下辺と上辺の中心位置は一般に異なっている。 ［４］次に、実際に撮像された円錐台の側面の下辺と上
辺の中心位置とそれぞれ対応するマークの［３］で計算
された結像位置との距離の２乗和を評価値Ｖとして求め
る。ずれが生じている場合はこの値はゼロでない正の値
となる。撮像された円錐台の側面の下辺と上辺の中心位
置を求めるには、円錐台の側面は黒く写っているのでそ
の外側と内側の周囲を画像処理によりたどってその重心
を求めることにより得られる。 ［５］次にｄｘを＋△ｘ変化させたときと、−△ｘ変化
させたときとのＶの値を［２］〜［４］のステップと同
様にして求め、［４］で求めたＶの値より小さい値を得
られるｄｘを新しいｄｘとして採用する。△ｘはある微
小な値である。 ［６］ｄｙ、ｄｚ、θｘ、θｙ、θｚについても［５］
と同様にして新しい値を採用する。 ［７］［２］〜［６］のステップを繰り返し、評価値Ｖ
のより小さい値がもはや得られなくなった時点で計算を
終了し、その時のｄｘ、ｄｙ、ｄｚ、θｘ、θｙ、θｚ
の値が求めるべきずれ量である。ｄｘ、ｄｙ、ｄｚ、θ
ｘ、θｙ、θｚが求まればその値にしたがってロボット
アームの位置を制御してエンドエフェクタの位置を補正
することができる。なお、３こ以上のマークを用いるよ
うにしているのは、上記のように未知数がｄｘ、ｄｙ、
ｄｚ、θｘ、θｙ、θｚの６こあり、１つのマークの観
測でその位置ｘｙの２つの値しか得られ無いためであ
る。
エンドエフェクタの中心軸上でカメラのレンズ中心面と
交わる位置とする。 ［１］まず作業対象とエンドエフェクタの相対位置は設
計通りであると仮定する。即ち、ｄｘ＝０、ｄｙ＝０、
ｄｚ＝０、θｘ＝０、θｙ＝０、θｚ＝０とする。 ［２］仮定されたｄｘ、ｄｙ、ｄｚ、θｘ、θｙ、θｚ
に対して、各マークが位置すべき空間座標を設計データ
から計算する。これは設計された空間座標に対してθ
ｘ、θｙ、θｚから計算されるいわゆる回転マトリクス
を掛けた後、並進ベクトル（ｄｘ、ｄｙ、ｄｚ）を加え
ることで得られる。 ［３］計算されたマーク座標から、カメラで撮像した時
のマークの結像位置を計算する。これは幾何光学のレン
ズの式から計算することができる。マークである円錐台
の側面の下辺と上辺の中心位置は一般に異なっている。 ［４］次に、実際に撮像された円錐台の側面の下辺と上
辺の中心位置とそれぞれ対応するマークの［３］で計算
された結像位置との距離の２乗和を評価値Ｖとして求め
る。ずれが生じている場合はこの値はゼロでない正の値
となる。撮像された円錐台の側面の下辺と上辺の中心位
置を求めるには、円錐台の側面は黒く写っているのでそ
の外側と内側の周囲を画像処理によりたどってその重心
を求めることにより得られる。 ［５］次にｄｘを＋△ｘ変化させたときと、−△ｘ変化
させたときとのＶの値を［２］〜［４］のステップと同
様にして求め、［４］で求めたＶの値より小さい値を得
られるｄｘを新しいｄｘとして採用する。△ｘはある微
小な値である。 ［６］ｄｙ、ｄｚ、θｘ、θｙ、θｚについても［５］
と同様にして新しい値を採用する。 ［７］［２］〜［６］のステップを繰り返し、評価値Ｖ
のより小さい値がもはや得られなくなった時点で計算を
終了し、その時のｄｘ、ｄｙ、ｄｚ、θｘ、θｙ、θｚ
の値が求めるべきずれ量である。ｄｘ、ｄｙ、ｄｚ、θ
ｘ、θｙ、θｚが求まればその値にしたがってロボット
アームの位置を制御してエンドエフェクタの位置を補正
することができる。なお、３こ以上のマークを用いるよ
うにしているのは、上記のように未知数がｄｘ、ｄｙ、
ｄｚ、θｘ、θｙ、θｚの６こあり、１つのマークの観
測でその位置ｘｙの２つの値しか得られ無いためであ
る。
【００１３】なお、上記［１］〜［７］のステップの説
明で、円錐台の上辺と下辺の両方のデータを用いるよう
に説明したが、その一方だけでもｄｘ、ｄｙ、ｄｚ、θ
ｘ、θｙ、θｚを求めることができる。ただし上記説明
のように一度の撮像データから円錐台の上辺と下辺の両
方の中心位置を求めて計算するようにすれば、情報量が
多いため［２］〜［６］のステップの繰り返し回数を少
なくできる効果がある。
明で、円錐台の上辺と下辺の両方のデータを用いるよう
に説明したが、その一方だけでもｄｘ、ｄｙ、ｄｚ、θ
ｘ、θｙ、θｚを求めることができる。ただし上記説明
のように一度の撮像データから円錐台の上辺と下辺の両
方の中心位置を求めて計算するようにすれば、情報量が
多いため［２］〜［６］のステップの繰り返し回数を少
なくできる効果がある。
【００１４】また、上記説明では、マークとして円錐台
を用いる場合を説明したが、これは角錐台でもよく、ま
た円錐台もしくは角錐台の形にくり抜いた形状でもよ
い。また、立体構造をしていなくともよい。
を用いる場合を説明したが、これは角錐台でもよく、ま
た円錐台もしくは角錐台の形にくり抜いた形状でもよ
い。また、立体構造をしていなくともよい。
【００１５】
【発明の効果】以上のように、この発明によればエンド
エフェクタが作用すべき位置を中心とする同一円周上に
複数配置したマークを、エンドエフェクタと一体となっ
ているロボットアームの先端の軸に取り付けたテレビカ
メラで、該ロボットアーム軸を所定量だけ回転させて順
次撮像し、該マークが該テレビカメラの視野に写る位置
により、エンドフェクタの相対姿勢補正量を計算してロ
ボットアームの相対姿勢を補正するようにしているの
で、従来のように複雑なマークにする必要がなく、簡単
ですみ、エンドエフェクタの中心軸の位置決め精度がよ
く、中心軸回りの回転ずれも離れた複数のマークにより
精度よく検出できるため、結果的に精度よい位置決めが
なされる効果がある。
エフェクタが作用すべき位置を中心とする同一円周上に
複数配置したマークを、エンドエフェクタと一体となっ
ているロボットアームの先端の軸に取り付けたテレビカ
メラで、該ロボットアーム軸を所定量だけ回転させて順
次撮像し、該マークが該テレビカメラの視野に写る位置
により、エンドフェクタの相対姿勢補正量を計算してロ
ボットアームの相対姿勢を補正するようにしているの
で、従来のように複雑なマークにする必要がなく、簡単
ですみ、エンドエフェクタの中心軸の位置決め精度がよ
く、中心軸回りの回転ずれも離れた複数のマークにより
精度よく検出できるため、結果的に精度よい位置決めが
なされる効果がある。
【図１】 この発明の一実施例によるロボットアーム相
対姿勢補正方法を示す説明図である。
対姿勢補正方法を示す説明図である。
【図２】 この発明の一実施例によるロボットアーム相
対姿勢補正方法を示すフローチャートである。
対姿勢補正方法を示すフローチャートである。
【図３】 この発明の一実施例によるロボットアーム相
対姿勢補正方法を示す説明図である。
対姿勢補正方法を示す説明図である。
【図４】 従来のロボットアーム相対姿勢補正方法に用
いる位置決めマークを示す断面図である。
いる位置決めマークを示す断面図である。
【図５】 従来のロボットアーム相対姿勢補正方法に用
いる位置決めマークを示す正面図である。
いる位置決めマークを示す正面図である。
【図６】 従来のロボットアーム相対姿勢補正方法を説
明する説明図である。
明する説明図である。
【図７】 従来のロボットアーム相対姿勢補正方法にお
けるエラーの発生を説明する説明図である。
けるエラーの発生を説明する説明図である。
【図８】 従来のロボットアーム相対姿勢補正方法にお
けるエラーの発生を説明する説明図である。
けるエラーの発生を説明する説明図である。
１−１ 位置決めマーク １−２ 位置決めマーク １−３ 位置決めマーク １−４ 位置決めマーク １０ カメラ ２０ エンドエフェクタ ３０ ロボットアーム ３５ カメラ取付けアーム ４０ エンドエフェクタ作用位置
───────────────────────────────────────────────────── フロントページの続き (72)発明者 広岡 美和子 尼崎市塚口本町８丁目１番１号 三菱電 機株式会社 産業システム研究所内 (56)参考文献 特開 平１−193902（ＪＰ，Ａ) 特開 昭62−95403（ＪＰ，Ａ) 特開 平２−264804（ＪＰ，Ａ) 特開 昭64−91005（ＪＰ，Ａ) 特開 平２−300608（ＪＰ，Ａ) 特開 平１−320431（ＪＰ，Ａ) (58)調査した分野(Int.Cl.6，ＤＢ名) G05B 19/19 B25J 9/10 B25J 13/08 B25J 19/04 G01B 11/00
Claims (1)
- 【請求項１】 ロボットの作業対象において、エンドエ
フェクタが作用すべき位置を中心とする同一円周上に、
３個以上のマークを配置し、上記エンドエフェクタと一
体となっているロボットアーム軸に取り付けたテレビカ
メラで、上記ロボットアーム軸を所定量だけ回転させて
上記マークを順次撮像し、撮像された上記マークの、上
記テレビカメラの同一視野における位置を各々計測し、
その計測結果に基づいて上記エンドエフェクタの相対姿
勢補正量を計算し、この相対姿勢補正量によりエンドエ
フェクタの姿勢を補正するようにしたロボットアーム相
対姿勢補正方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP6034791A JP2890874B2 (ja) | 1991-03-25 | 1991-03-25 | ロボットアーム相対姿勢補正方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP6034791A JP2890874B2 (ja) | 1991-03-25 | 1991-03-25 | ロボットアーム相対姿勢補正方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH04313106A JPH04313106A (ja) | 1992-11-05 |
| JP2890874B2 true JP2890874B2 (ja) | 1999-05-17 |
Family
ID=13139543
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP6034791A Expired - Fee Related JP2890874B2 (ja) | 1991-03-25 | 1991-03-25 | ロボットアーム相対姿勢補正方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2890874B2 (ja) |
Families Citing this family (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3339090B2 (ja) * | 1993-02-25 | 2002-10-28 | ソニー株式会社 | 位置検出方法 |
| JP2004333368A (ja) * | 2003-05-09 | 2004-11-25 | Photron Ltd | 移動物体撮影系の三次元定数取得用キャリブレーション治具 |
| KR100608650B1 (ko) * | 2004-12-15 | 2006-08-08 | 엘지전자 주식회사 | 로봇의 목표물 추적방법 |
| KR100608651B1 (ko) * | 2004-12-22 | 2006-08-08 | 엘지전자 주식회사 | 로봇의 목표물 추적방법 |
| JP4418841B2 (ja) | 2008-01-24 | 2010-02-24 | キヤノン株式会社 | 作業装置及びその校正方法 |
| JP5515654B2 (ja) * | 2009-11-10 | 2014-06-11 | 株式会社安川電機 | ロボットシステム |
| US9110457B2 (en) | 2010-06-22 | 2015-08-18 | Siemens Healthcare Diagnostics Inc. | Methods, systems, and apparatus for calibration of a positional offset between an end effector and a position sensor |
| JP5924582B2 (ja) * | 2012-04-16 | 2016-05-25 | 大日本印刷株式会社 | 位置合わせシステム、位置合わせ方法及び構造体の製造方法 |
| JP6976098B2 (ja) * | 2017-07-31 | 2021-12-08 | Ntn株式会社 | リンク作動式作業装置 |
| WO2023012894A1 (ja) * | 2021-08-03 | 2023-02-09 | ファナック株式会社 | ロボットシステム、制御装置、診断方法および診断プログラム |
-
1991
- 1991-03-25 JP JP6034791A patent/JP2890874B2/ja not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JPH04313106A (ja) | 1992-11-05 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US6044308A (en) | Method and device for robot tool frame calibration | |
| US5329469A (en) | Calibration method for a visual sensor | |
| US6114824A (en) | Calibration method for a visual sensor | |
| JP2710850B2 (ja) | ワーク把持装置、ワーク及びその収納ケース | |
| US7324217B2 (en) | Device and method for measuring components | |
| US20200262080A1 (en) | Comprehensive model-based method for gantry robot calibration via a dual camera vision system | |
| CN110146038A (zh) | 筒形件装配转角的分布式单目相机激光测量装置及方法 | |
| JP7189988B2 (ja) | ビジョンシステムの３次元校正のためのシステム及び方法 | |
| JP2890874B2 (ja) | ロボットアーム相対姿勢補正方法 | |
| US20230021095A1 (en) | Product Inspection System and Method | |
| KR20170087996A (ko) | 로봇의 캘리브레이션 장치 및 그 방법 | |
| CN115066313B (zh) | 用于加工装置的工件的安装方法、工件安装支援***及存储介质 | |
| TWI708667B (zh) | 運動裝置之位置與姿態校正裝置及系統與方法 | |
| CN110211175B (zh) | 准直激光器光束空间位姿标定方法 | |
| JP3511551B2 (ja) | ロボットアームの状態検出方法および検出システム | |
| JP3466340B2 (ja) | 自立走行ロボットの三次元位置姿勢較正方法 | |
| JPH0626770B2 (ja) | ワークのはめ合い方法 | |
| JP4284765B2 (ja) | ロボットハンド位置計測装置 | |
| JPH04211807A (ja) | ロボットの設置誤差の推定方法及びその装置並びにロボット駆動制御方法及び基準付き作業台及び基準 | |
| JP2546037B2 (ja) | ターゲットマーク | |
| CN112428265B (zh) | 一种测量***以及测量方法 | |
| CN116619350A (zh) | 一种基于双目视觉测量的机器人误差标定方法 | |
| Wieghardt et al. | Self-calibration of a mobile manipulator using structured light | |
| JPH0774964B2 (ja) | ロボットの位置決め誤差補正方法 | |
| JP3562096B2 (ja) | 位置検出方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080226 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090226 Year of fee payment: 10 |
|
| LAPS | Cancellation because of no payment of annual fees |