JP2003121112A - 位置検出装置 - Google Patents

Abstract

(57)【要約】 【課題】 撮像手段によりマーカを傾斜した方向から撮
像した場合でも、その中心位置を正確に検出することを
可能とする。 【解決手段】 ロボット本体１のアームの先端にマーカ
Ｍを設ける。このマーカＭを、半径ｒ1 の外円Ｃ1 と、
半径ｒ2 （＝ｍｒ1 （０＜ｍ＜１））の内円Ｃ2 とから
なる同心円とする。前記マーカＭ部分を撮像するＣＣＤ
カメラ１５を設置面２に設け、視覚認識装置は、ＣＣＤ
カメラ１５により撮像されたマーカＭの画像データか
ら、各円Ｃ1 ，Ｃ2 の重心位置φ1 ，φ2 を夫々算出
し、マーカＭの真の中心位置φを、 【数１９】 の式で算出する。

Description

【発明の詳細な説明】

【０００１】

【発明の属する技術分野】本発明は、例えばロボット等
の位置検出対象に設けられたマーカを、傾斜した方向か
ら撮像した場合でも、その中心位置を正確に検出するこ
とを可能とした位置検出装置に関する。

【０００２】

【発明が解決しようとする課題】産業用ロボット例えば
組立用の多関節（６軸）型ロボットを用いたシステムに
おいては、ロボットアームの位置が、重力等の影響を受
けることによって、理論上（計算機環境上）の位置から
若干の位置ずれを生ずる場合がある。そこで、その位置
ずれの補正のため、ロボットアームに例えば円形のマー
カを設けると共に、固定設備側に、そのマーカ部分を撮
像してマーカ位置を検出する視覚認識装置を設けること
が考えられている。この場合、前記視覚認識装置は、Ｃ
ＣＤカメラによりマーカ部分を撮像し、その画像データ
を画像処理装置により処理して、前記マーカ画像の重心
位置を算出することにより、マーカの中心位置を検出す
るようになっている。

【０００３】ところで、上記のように視覚認識によりマ
ーカ位置を検出する場合、ＣＣＤカメラとマーカとが正
対して位置する（マーカ表示面がＣＣＤカメラの光軸に
垂直となっている）ときには、マーカ画像の重心位置に
よりマーカの中心位置を高精度で検出することができる
が、実際には、マーカ表示面がＣＣＤカメラに対して傾
斜していることも多く、この場合斜めに投影された画像
を撮像してしまうことになる。このため、撮影したマー
カ画像が真円ではなく歪みを有した状態となり、その重
心を求めても、マーカの真の中心位置に一致しない不都
合が生ずる。

【０００４】本発明は上記事情に鑑みてなされたもの
で、その目的は、撮像手段によりマーカを撮像すること
に基づいて位置検出を行うにものにあって、マーカを傾
斜した方向から撮像した場合でも、その中心位置を正確
に検出することを可能とした位置検出装置を提供するに
ある。

【０００５】

【課題を解決するための手段】本発明者らは、円形のマ
ーカを傾斜方向から撮像した場合におけるマーカ画像の
重心位置の真の中心位置からのずれ量は、その傾斜角度
と、撮像視点から投影面までの距離と、マーカの半径と
によってほぼ決まることに着目し、マーカを、半径の異
なる少なくとも２つの同心円を有したものとし、それら
同心円の半径が異なることに起因して各円の画像の重心
が異なってくることを利用して、マーカの真の中心位置
を求めることが可能であることを確認し、本発明を成し
遂げたのである。

【０００６】即ち、本発明の請求項１の位置検出装置に
よれば、位置検出対象に設けられるマーカを、半径の異
なる２以上の同心円を平面上に表示して構成し、撮像手
段のマーカを撮像した画像データに基づいてマーカの中
心位置を算出する算出手段を、各同心円画像の重心位置
を夫々算出し、それら複数の重心位置からマーカの中心
位置を求めるように構成したので、マーカを傾斜した方
向から撮像した場合でも、そのマーカの中心位置を正確
に算出することが可能となる。

【０００７】より具体的には、本発明者らの研究によれ
ば、半径ｒ1 の外円及び半径ｍｒ1（０＜ｍ＜１）の内
円の２つの同心円について夫々重心位置φ1 及びφ2 を
算出することにより、マーカの真の中心位置φを、

【数２】 の式で簡単に算出することができる（請求項２の発
明）。尚、マーカの中心位置φの算出方法としては、こ
れ以外にも、複数の同心円の各円の重心と面積とから最
小自乗法により求めるなど、様々な方法がある。

【０００８】また、このとき、算出手段を、撮像手段の
光軸に垂直な面に対するマーカの表示面の傾斜角度を併
せて算出するように構成することができ（請求項３の発
明）、これにより、マーカの位置だけでなくマーカ表示
面つまり位置検出対象の撮像手段に対する傾斜角度をも
検出することが可能となる。さらには、本発明の位置検
出装置は、ロボットの位置検出に適用し、算出手段によ
り算出されたマーカの中心位置に基づいてロボットの位
置補正を行うことができ（請求項４の発明）、これによ
り、比較的簡単で安価な構成で、ロボットの位置補正を
正確に行うことができるようになる。

【０００９】

【発明の実施の形態】以下、本発明を例えば組立用の垂
直多関節（６軸）型ロボットの位置補正に適用した一実
施例について、図面を参照しながら説明する。図１は、
本実施例に係る位置検出装置の位置検出対象となるロボ
ット本体１が、組立作業設備の設置面（作業台）２上に
設置されている様子（外観）を概略的に示しており、ま
ず、このロボット本体１の全体構成について簡単に述べ
る。

【００１０】このロボット本体１は、前記設置面２上に
固定設置されたベース３上に、第１アーム４が垂直軸を
中心に回動（旋回）可能に設けられ、その第１アーム４
の先端に、第２アーム５が水平軸を中心に回動可能に設
けられ、その第２アーム５の先端に、第３アーム６が水
平軸を中心に回動可能に設けられている。さらに、その
第３アーム６の先端面部に、第４アーム７が同軸回転可
能に設けられ、第４アーム７の先端には、第５アーム８
が回転可能に設けられ、第５アーム８の先端面に第６ア
ーム９が同軸回転可能に設けられて構成されている。そ
して、前記第６アーム９の先端面は、図示しないハンド
等のエンドエフェクタが着脱（交換）自在に取付けられ
るエンドエフェクタ取付面１０とされている。

【００１１】また、上記したロボット本体１の各アーム
４〜９は、エンコーダ付きのサーボモータ（図示せず）
によりそれぞれ駆動されるようになっており、それら各
サーボモータは、ロボット制御装置（コントローラ）１
１（図２にのみ図示）によりフィードバック制御される
ようになっている。このロボット制御装置１１は、マイ
コンを主体として構成され、図２に示すように、前記ロ
ボット本体１を制御する制御部１２や、作業プログラム
や作業位置データ等が記憶される記憶部１３を備えて構
成されている。これにて、ロボット制御装置１１は、記
憶部１３に記憶された作業プログラムに従い、作業位置
データに基づいてロボット本体１を制御し、以て部品の
組立作業等を自動的に実行させるようになっている。

【００１２】さて、上記ロボット本体１の位置（この場
合、エンドエフェクタ取付面１０の位置及び姿勢）を検
出するための、本実施例に係る位置検出装置１４の構成
について、以下述べる。ここで、まず図１に示すよう
に、前記エンドエフェクタ取付面１０の中心部には、タ
ーゲットとなるマーカＭが設けられるようになってい
る。本実施例では、このマーカＭは、エンドエフェクタ
取付面１０の中心を中心とした半径の異なる２つの同心
円、即ち外円Ｃ1 及び内円Ｃ2 を平面Ｓ（図３，図４参
照）上に表示して構成されている。位置検出装置１４
は、例えばロボット本体１が作業開始前（あるいは教示
前）において原点位置に位置している状態で、エンドエ
フェクタ取付面１０に設けられたマーカＭ（同心円Ｃ1
，Ｃ2 ）の３次元の中心位置φ及び前記平面Ｓの傾斜
角度θを検出するようになっている。

【００１３】前記位置検出装置１４は、図２に示すよう
に、前記マーカＭ部分を撮像する撮像手段たるＣＣＤカ
メラ１５や、マイコンを主体してなり前記ＣＣＤカメラ
１５からの画像データを処理する視覚認識装置１６等か
ら構成される。前記ＣＣＤカメラ１５は、図１に示すよ
うに、設備の設置面２上に、前記ロボット本体１に対向
して前記エンドエフェクタ取付面１０のマーカＭを撮像
可能な位置（且つ作業の邪魔にならない位置）に設けら
れる。

【００１４】このとき、本実施例では、このＣＣＤカメ
ラ１５は、ロボット本体１に向って左右に２個が設けら
れており、詳しい説明は省略するが、これら２台のＣＣ
Ｄカメラ１５を用いることにより、ＣＣＤカメラ１５か
らマーカＭ（投影面）までの距離Ｌをも高精度に検出で
きるようになっている。さらに、各ＣＣＤカメラ１５
は、垂直軸を中心に回動（旋回）可能に設けられると共
に、水平軸を中心に上下方向に回動（角度変更）可能に
設けられており、カメラ駆動装置１７によって、前記マ
ーカＭを視野のほぼ中央部にて撮像できる向き（理論的
に正対する位置）となるように移動されるようになって
いる。

【００１５】前記視覚認識装置１６は、図２に示すよう
に、前記ＣＣＤカメラ１５により撮像されたマーカＭ部
分の画像データを記憶する画像記憶部１８や、その画像
データを処理する演算処理部１９等を備えて構成され
る。また、前記演算処理部１９は、前記カメラ駆動装置
１７の駆動制御をも行うようになっており、この際、各
ＣＣＤカメラ１５の位置（三次元的な撮影角度）を自ら
認識できることは勿論である。

【００１６】そして、詳しくは後の作用説明にて述べる
ように、この視覚認識装置１６（演算処理部１９）は、
そのソフトウエア構成（処理プログラムの実行）によ
り、前記ＣＣＤカメラ１５によりマーカＭ部分を撮像
し、その画像データを処理して、同心円Ｃ1 ，Ｃ2 の画
像上の重心位置φ1 ，φ2 を夫々算出し、それら重心位
置φ1 ，φ2 から前記マーカＭの中心位置φを求めるよ
うになっている。従って、演算処理部１９が算出手段と
して機能するようになっている。

【００１７】このとき、より具体的には、演算処理部１
９には、前記マーカＭの外円Ｃ1 の半径ｒ1 や、内円Ｃ
2 の半径ｒ2 等の予め必要なデータが入力されており、
内円Ｃ2 の半径ｒ2 をｒ2 ＝ｍｒ1 （０＜ｍ＜１）とす
ると、算出された重心位置φ1 及びφ2 から、マーカＭ
の真の中心位置φを、

【数３】 の式で算出するようになっている。

【００１８】さらに、本実施例では、演算処理部１９
は、中心位置φと例えば外円Ｃ1 の重心位置φ1 との間
のずれ量Δφ、並びに、ＣＣＤカメラ１５からマーカＭ
の投影面間での距離Ｌ、及び外円Ｃ1 の半径ｒ1 から、
前記ＣＣＤカメラ１５の光軸に垂直な面に対する前記マ
ーカＭの表示面Ｓの傾斜角度θを併せて算出するように
構成されている。そして、検出されたマーカＭの中心位
置φ及びマーカＭの表示面Ｓの傾斜角度θは、ロボット
制御装置１１に送られ、ロボット本体１の位置補正（記
憶部１３に記憶されている作業位置データの補正）に用
いられるようになっている。

【００１９】次に、上記構成の作用について、図３及び
図４も参照して述べる。上述のように、ロボット本体１
にあっては、アーム４〜９の位置が、重力等の影響を受
けることによって、理論上（計算機環境上）の位置から
若干の位置ずれを生ずる場合がある。そこで、その位置
ずれの補正のため、組立作業を行う前（あるいは教示作
業前）に、位置検出装置１４により、アーム先端のエン
ドエフェクタ取付面１０のマーカＭの位置を検出し、位
置ずれ補正を行う。

【００２０】ここで、円形のマーカの位置を検出する場
合、ＣＣＤカメラ１５とマーカＭとが正対して位置する
（マーカＭの表示面ＳがＣＣＤカメラ１５の光軸に垂直
となっている）ときには、マーカ画像の重心位置の検出
によりマーカＭの中心位置を求めることができる。とこ
ろが、実際には、マーカＭの表示面ＳがＣＣＤカメラ１
５に対して傾斜していることも多く、この場合、斜めに
投影された画像を撮像してしまい、マーカＭの画像が真
円ではなく歪みを有した状態となり、その重心を求めて
も、マーカＭの真の中心位置φに一致しない不都合が生
ずる。

【００２１】今、図３に示すように、半径ｒの円Ｃが表
示面Ｓに表示され、これを撮像するＣＣＤカメラ１５の
光軸ｌに垂直な面に対してその表示面Ｓが角度θ傾斜し
ている場合、円Ｃの真の中心位置に対する画像の重心位
置の誤差の角度成分Δφは、以下ようにして求めること
ができる。但し、ここでは、ＣＣＤカメラ１５の視点Ｖ
を原点とし、視点Ｖと円Ｃの中心とを結ぶ線（光軸ｌ）
をｚ軸に一致させ、表示面Ｓがｘ軸方向に対して角度θ
傾いているものとし、視点Ｖ（原点）から投影面までの
距離をＬとしている。

【００２２】即ち、円Ｃを含む球の方程式は、

【数４】 で表され、面Ｓの方程式は、 ｘｓｉｎθ＋（ｚ−Ｌ）ｃｏｓθ＝０ ｚ−Ｌ＝−ｘｔａｎθ …（２） （２）式を（１）式に代入すると、

【数５】 となる。

【００２３】これにて、円Ｃの円周の座標は、

【数６】 となり、これから、光軸ｌに垂直な平面（ｚ＝Ｌ）に投
影された座標は、

【数７】 となる。ここで、ａ（Ｌ−ｘｔａｎθ）＝Ｌより、ａ＝
Ｌ／（Ｌ−ｘｔａｎθ）であるから、上記座標は、

【数８】 となる。

【００２４】Ｘ＝Ｌｘ／（Ｌ−ｘｔａｎθ）とおくと、
ｘ＝ＬＸ／（Ｌ＋Ｘｔａｎθ）より、上記座標は、

【数９】 で表される。この式から、重心を求めるときの積分範囲
は、

【数１０】 となる。

【００２５】さらに、距離Ｌで規格化するために、ｔ＝
Ｘ／Ｌ、α＝ｒ／Ｌとおくと、Ｘ＝Ｌｔより、

【数１１】 この式より、重心を求めるときの積分範囲は、

【数１２】 となる。

【００２６】数値計算の結果、重心位置の誤差（傾きθ
に起因した真の中心からのずれ）の角度成分Δφは、次
式で近似される。

【００２７】

【数１３】

【００２８】さて、本実施例においては、図４に示すよ
うに、マーカＭが、半径ｒ1 の外円Ｃ1 と、半径ｒ2 の
内円Ｃ2 （但しｒ2 ＝ｍｒ1 （０＜ｍ＜１））とからな
る同心円から構成される、そして、位置検出装置１４
は、前記マーカＭ部分をＣＣＤカメラ１５により撮像
し、視覚認識装置１６（演算処理部１９）により、その
画像データに基づいて、各円Ｃ1 ，Ｃ2 の重心位置φ1
，φ2 を夫々算出し、それらから次のようにしてマー
カＭの真の中心位置φを算出することができる。

【００２９】即ち、上記（３）式で示されるように、半
径ｒの円Ｃに関しては，傾きθに起因した重心位置の誤
差の角度成分Δφは、

【数１４】 で表すことができ、Δφが十分に小さいときには、

【数１５】 で近似できる。但し、α＝ｒ／Ｌ、ｋ（θ）＝０．５３
９ｓｉｎ２θである。

【００３０】マーカＭ（円Ｃ1 ，Ｃ2 ）の真の中心位置
をφとし、外円Ｃ1 の重心位置φ1の誤差をΔφ1 、内
円Ｃ2 の重心位置φ2 の誤差をΔφ2 とすると、 φ＝φ1 −Δφ1 φ＝φ2 −Δφ2 であるから、α1 ＝ｒ1 ／Ｌ、α2 ＝ｒ2 ／Ｌとする
と、上記（４）式から、

【数１６】 が成立つ。

【００３１】上記（５）式にα2 の二乗を乗算したもの
から、（６）式にα1 の二乗を乗算したものを減算する
と、

【数１７】 となる。これに、α1 ＝ｒ1 ／Ｌ、α2 ＝ｍｒ1 ／Ｌを
代入すると、

【数１８】 が得られる。

【００３２】従って、この（７）式に、算出されたφ1
，φ2 、及び、既知のｍを代入することにより、真の
中心位置φを容易に算出することができるのである。
尚、表示面Ｓに傾斜がない、つまりθ＝０の場合には、
各円Ｃ1 ，Ｃ2 の重心位置φ1 ，φ2 が一致し、且つ誤
差成分Δφが０となるので、それら重心位置φ1 ，φ2
が中心位置φに一致することは勿論であり、この場合に
も上記（７）式が成立つ。つまり、表示面Ｓの傾斜の有
無に関係なく、上記（７）式を用いて中心位置φを算出
できるのである。

【００３３】また、詳しい説明は省略するが、距離Ｌが
高精度で検出できるので、例えば上記（３）式等から明
らかなように、このＬの値や半径ｒ、誤差成分Δφを用
いて、表示面Ｓの傾斜角度θを容易に算出することが可
能である。そして、算出されたマーカＭの正しい中心位
置φ及び表示面Ｓの傾斜角度θに基づいて、ロボット本
体１の高精度の位置ずれ補正を行うことができ、ひいて
は、ロボット本体１による高精度の組立作業を実行する
ことができるのである。

【００３４】このように本実施例によれば、ＣＣＤカメ
ラ１５によりマーカＭを撮像することに基づいて位置検
出を行うにものにあって、マーカＭを同心円Ｃ1 ，Ｃ2
から構成し、それら各円Ｃ1 ，Ｃ2 の重心を算出するこ
とに基づいて、上記（７）式を用いて簡単に正しい中心
位置φを算出することができる。従って、マーカＭを傾
斜した方向から撮像した場合でも、その中心位置φを正
確に検出することができるという優れた効果を得ること
ができる。また、本実施例では、マーカＭの中心位置φ
に加えて、マーカＭの表示面Ｓの傾斜角度θをも併せて
算出するようにしたので、比較的簡単で安価な構成で、
ロボット本体１の位置補正を正確に行うことができ、ひ
いては高精度の作業を行うことができるようになる。

【００３５】尚、上記した実施例では、マーカＭに半径
の異なる２つの同心円Ｃ1 ，Ｃ2 を設けて上記（７）式
により中心位置φを算出する構成としたが、マーカの中
心位置φの算出方法としては、先に計算した上記（４）
式を利用した下記のような方法も考えられる。これらの
場合、マーカに３個以上の同心円を設けても良いことは
勿論である。

【００３６】複数の同心円の各円の重心と面積とを算
出し、それらから最小二乗法により求める。 円の半径を等比級数で決めた複数の同心円からマーカ
を構成し、その比率と、算出された各円の重心と面積と
から、最小二乗法により求める。 円の大きさにより重心を算出する際の量子化ばらつき
が異なるので、それを考慮し重み付け最小二乗法により
求める。このとき、円の半径に比例した重み付けを行う
ことができる。

【００３７】その他、上記実施例では、撮像手段（ＣＣ
Ｄカメラ１５）を移動（向き変更）可能に設けるように
したが、撮像手段を固定して設けても良く、また、撮像
手段は１個のみでも実施可能である。マーカＭを設ける
位置としても、エンドエフェクタ取付面１０に限らず、
ロボット本体１の位置検出したいところに設ければ良
く、この場合、マーカＭを複数箇所に設けることも可能
である。上記のようにロボットに適用する際に、ロボッ
ト側に撮像手段を設け、固定設備側にマーカを設けるよ
うにしても、同様に実施することができる。自走ロボッ
トにも適用することができる。さらには、ロボットの位
置決め以外にも、本発明は、視覚により三次元の位置検
出を行うもの全般に適用することができるなど、要旨を
逸脱しない範囲内で適宜変更して実施し得るものであ
る。

【図面の簡単な説明】

【図１】本発明の一実施例を示すもので、ロボット本体
及びＣＣＤカメラの設置状態を示す斜視図

【図２】システムの電気的構成を概略的に示すブロック
図

【図３】表示面の傾きに起因した重心位置の誤差の算出
方法を説明するための図

【図４】同心円を用いた中心位置の算出方法を説明する
ための図

【符号の説明】

図面中、１はロボット本体、１０はエンドエフェクタ取
付面、１１はロボット制御装置、１４は位置検出装置、
１５はＣＣＤカメラ（撮像手段）、１６は視覚認識装
置、１７はカメラ駆動装置、１８は画像記憶部、１９は
演算処理部（算出手段）、Ｍはマーカ、Ｃ1 は外円、Ｃ
2 は内円、Ｓは表示面を示す。

───────────────────────────────────────────────────── フロントページの続き (72)発明者 川口 裕司 愛知県刈谷市昭和町１丁目１番地 株式会 社デンソー内 (72)発明者 塚田 敏彦 愛知県愛知郡長久手町大字長湫字横道41番 地の１ 株式会社豊田中央研究所内 (72)発明者 松原 弘幸 愛知県愛知郡長久手町大字長湫字横道41番 地の１ 株式会社豊田中央研究所内 (72)発明者 和田 隆志 愛知県愛知郡長久手町大字長湫字横道41番 地の１ 株式会社豊田中央研究所内 Ｆターム(参考） 2F065 AA01 AA06 AA17 AA20 AA31 BB28 EE08 EE12 FF04 FF09 FF61 JJ03 JJ05 JJ26 NN20 PP05 QQ24 QQ25 QQ31 RR05 UU09 3C007 BS12 KS17 KT02 KT06 LT13 MT00 5E313 AA11 CC04 DD03 EE03 FF32 FF40 FG10

Claims (4)

【特許請求の範囲】
1. 【請求項１】 位置検出対象に設けられたマーカを撮像
   する撮像手段と、この撮像手段の画像データに基づい
   て、前記マーカの中心位置を算出する算出手段とを備え
   る位置検出装置であって、 前記マーカは、半径の異なる２以上の同心円を平面上に
   表示して構成され、 前記算出手段は、前記各同心円画像の重心位置を夫々算
   出し、それら複数の重心位置から前記マーカの中心位置
   を求めることを特徴とする位置検出装置。
2. 【請求項２】 前記算出手段は、半径ｒ1 の外円及び半
   径ｍｒ1 （０＜ｍ＜１）の内円の２つの同心円について
   夫々重心位置φ1 及びφ2 を算出し、さらに、次式によ
   り中心位置φを算出することを特徴とする請求項１記載
   の位置検出装置。 【数１】
3. 【請求項３】 前記算出手段は、前記撮像手段の光軸に
   垂直な面に対する前記マーカの表示面の傾斜角度を併せ
   て算出するように構成されていることを特徴とする請求
   項１又は２記載の位置検出装置。
4. 【請求項４】 前記位置検出対象はロボットであり、前
   記算出手段により算出された前記マーカの中心位置が、
   該ロボットの位置補正に用いられることを特徴とする請
   求項１ないし３のいずれかに記載の位置検出装置。