JP2004145664A - 3次元姿勢検出用立体、3次元姿勢検出方法、3次元姿勢検出装置、3次元姿勢検出プログラム、およびそのプログラムを記録した記録媒体 - Google Patents
3次元姿勢検出用立体、3次元姿勢検出方法、3次元姿勢検出装置、3次元姿勢検出プログラム、およびそのプログラムを記録した記録媒体 Download PDFInfo
- Publication number
- JP2004145664A JP2004145664A JP2002310169A JP2002310169A JP2004145664A JP 2004145664 A JP2004145664 A JP 2004145664A JP 2002310169 A JP2002310169 A JP 2002310169A JP 2002310169 A JP2002310169 A JP 2002310169A JP 2004145664 A JP2004145664 A JP 2004145664A
- Authority
- JP
- Japan
- Prior art keywords
- rotationally symmetrical
- dimensional
- posture
- dimensional posture
- axis
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Length Measuring Devices By Optical Means (AREA)
- Image Processing (AREA)
- Closed-Circuit Television Systems (AREA)
- Image Analysis (AREA)
Abstract
【解決手段】3次元姿勢検出装置3は、立体1をカメラ2で撮像して得られた画像から、まず、軸姿勢算出部11によって、立体1の表面に描かれた図形の位置に基づき、表面と立体1の軸とが交わる点(すなわち、極)の位置を検出し、立体1の軸の姿勢を算出し、次に、立体姿勢算出部12によって、図形と予め用意しておいたテンプレート画像群との比較、あるいは、図形の色情報に基づき、立体1の姿勢を算出する。
【選択図】 図1
Description
【発明の属する技術分野】
本発明は、カメラで撮像した画像から対象物の3次元姿勢を検出するための方法および装置に関する。
【0002】
【従来の技術】
従来、デザインが既知である立体をカメラで撮像し、その画像において、立体の「辺」や「頂点」といった特徴点の位置を基にするか、立体全体の画像のテンプレート(3次元モデル)を用いるなどして、該立体の姿勢を算出していた(非特許文献1参照)。
【0003】
【非特許文献1】
岡本恭一、久野義徳、岡田敏、「3次元物体認識における姿勢計算方式」、情報処理学会全国大会講演論文集、1990年、第40巻、第1号、p.384−385
【0004】
【発明が解決しようとする課題】
しかし、上述した従来技術では、姿勢特定のためのマッチング処理において、立体全体の画像のテンプレート画像(3次元モデル)を用いていたため、テンプレート画像の記憶容量が大きくなり、またマッチング処理の計算コストがかかるという欠点があった。
【0005】
本発明の目的は、テンプレート画像の記憶容量およびマッチング処理の計算コストを小さく抑えることができる、3次元姿勢検出用立体、3次元姿勢検出方法、3次元姿勢検出装置、3次元姿勢検出プログラム、およびそのプログラムを記録した記録媒体を提供することにある。
【0006】
【課題を解決するための手段】
本発明の3次元姿勢検出用立体は、少なくとも一部分が回転対称体であり、前記回転対称体の表面と該回転対称体の軸とが交わる位置に配置された図形を含む、姿勢により見え方が異なる図形を回転対称体の表面に有する。
【0007】
また、本発明の3次元姿勢検出方法は、前記3次元姿勢検出用立体の撮像画像から、該立体の3次元姿勢を検出する方法であって、
撮像画像から回転対称体の表面と該回転対称体の軸とが交わる位置を検出し、該軸の姿勢を算出する軸姿勢算出段階と、
撮像画像と立体の種々の姿勢に対応する図形のテンプレート画像群とを比較することにより立体の姿勢を算出する立体姿勢算出段階とを有する。
【0008】
また、本発明の3次元姿勢検出装置は、3次元姿勢検出用立体の撮像画像を入力することによって、該立体の3次元姿勢を検出する装置であって、
撮像画像から回転対称体の表面と該回転対称体の軸とが交わる位置を検出し、該軸の姿勢を算出する軸姿勢算出手段と、
撮像画像と立体の種々の姿勢に対応する図形のテンプレート画像群とを比較することにより立体の姿勢を算出する立体姿勢算出手段とを有する。
【0009】
立体の3次元姿勢特定のための各マッチング処理において、立体表面に描かれた図形の一部分である比較的小さなサイズの図形を用いる。これにより、立体全体ではなくその図形の領域にのみ対応したテンプレート画像を用いればよくなり、テンプレート画像の記憶容量およびマッチング処理の計算コストを小さく抑えることができる。
【0010】
【発明の実施の形態】
次に、本発明の実施の形態について図面を参照して説明する。
【0011】
[第1の実施形態]
図1は本発明の3次元姿勢検出用立体の第1の例と第1の実施形態の3次元姿勢検出装置のブロック図である。
【0012】
3次元姿勢検出装置3は軸姿勢算出部11と立体姿勢算出部12から構成され、3次元姿勢検出用立体1(以下、立体1と称す)をカメラ2で撮像した画像から立体1の姿勢を算出する。
【0013】
本実施形態では、立体1の重心Cをカメラ2の光軸上の所定の位置に固定することによって、撮像画像上における立体1の重心の位置が既知であることを前提としている。
【0014】
3次元姿勢検出装置3は、立体1をカメラ2で撮像して得られた画像から、まず、軸姿勢算出部11によって、立体1の表面に描かれた図形の位置に基づき、表面と立体1の軸とが交わる点(すなわち、極)の位置を検出し、立体1の軸の姿勢を算出し、次に、立体姿勢算出部12によって、図形と予め用意しておいたテンプレート画像群との比較、あるいは、図形の色情報に基づき、立体1の姿勢を算出する。
【0015】
以下、本実施形態では、3次元姿勢検出用立体1の第1の実施形態として、1個の非回転対称図形が表面に描かれた既知の楕円体を用い、その撮像画像から立体1の姿勢を求める方法を説明する。
【0016】
図2(a)は立体1の例、図2(b)は立体1の表面上の図形の配置を説明するための図である。図2(b)において、Lは楕円体の軸であり、Pは楕円体の表面と軸Lとが交わる点、すなわち、楕円体の極である。非回転対称図形(この例では文字「A」)は、図2(a)のように、その重心Gが極Pの位置に一致するように楕円体の表面に描かれている。
【0017】
図3および図4は図形のテンプレート画像の計算機による作成方法を説明するための図である。
【0018】
図3において、CVは無限遠に配置してある仮想カメラ、Oは計算機内の仮想空間の原点、Xは水平方向の軸、Yは垂直方向の軸、Zは仮想カメラCVの光軸、SVは図形(この例では文字「A」)を配置した仮想平面、Gは仮想平面SV上の点であり図形の重心である。仮想平面SVは線分OGに垂直であり、距離OGは仮想楕円体の長半径に等しいとする。また、点GはYZ平面上にあるとし、線分OGと軸Zとのなす角度をθ1とする。ここで、仮想平面SVとYZ平面との交線をTとすると、この直線Tは点Gを通り線分OGに垂直となっている。そこで、仮想平面SVが線分OGを軸として回転した際の偏角を直線Tを基準とした角度で表わすこととし、これをθ2とする。なお、説明のため、図3では図形をその輪郭のみで示している。
【0019】
図4は仮想平面SV上の図形(この例では文字「A」)をXY平面に射影して得られた仮想カメラCVの画像である。GTは重心Gの画像上での位置である。テンプレート画像は、この仮想カメラCVの画像を、図形を含み、かつGTを中心とする矩形領域で切り出した部分画像にガウシアンフィルタ等によるぼかし処理を施して作成する。
【0020】
図5は作成されたテンプレート画像群が配置されたテーブルである。図3で示した仮想空間において、角度θ1については例えば0度から90度までの1度刻みとし、角度θ2については例えば0度から359度までの1度刻みとし、これらの角度θ1,θ2のすべての組み合わせに対して仮想カメラCVの画像を算出し、それぞれに対応するテンプレート画像を作成し、テーブルに配置しておく。
【0021】
図6は楕円体の軸Lの実空間における姿勢と極Pの撮像画像上における位置との関係を説明するための図である。図6(a)は楕円体の斜視図であり、図6(b)はこの楕円体をカメラ2で撮影した画像である。図6(a)において、Cは楕円体の中心、Xは水平方向の軸、Yは垂直方向の軸、Zはカメラ2の光軸、B1は極Pと軸Zを含む平面と軸Yとのなす角度、B2は軸Lと軸Zとのなす角度、Dは極Pと軸Zとの距離である。図6(b)において、CSは楕円体の中心Cの撮像画像上での位置、PSは極Pの撮像画像上での位置、B1は直線CSPSが垂直方向から時計回りになす角度、DSはCSとPS間の距離である。また、PSの撮像画像上での座標を(u,v)、Pの実空間における座標を(x,y,z)とする。ここで、撮像画像上での楕円体の重心位置CSが既知であることから、これを撮像画像上での原点、また、カメラの撮像倍率をαとし、
u=αx, v=αy, DS=αD
の関係が成り立つとする。ここで、実空間における点CとP間の距離をDCPとすると、以下の関係が成り立つ。
【0022】
【数1】
なお、これらの関係は、DCP、すなわち実空間におけるCと対象点Pとの間の距離さえ既知であれば、対象点Pが楕円体の極以外の任意の点であっても、対象点Pと直線CPの姿勢との関係として成立する。
【0023】
図7は撮像画像から楕円体の部分を切り出した部分画像を示している。図7(a)は濃淡画像であり、図7(b)は同画像を2値化した画像である。説明のため、図7(b)では図形をその輪郭のみで示している。図7(b)において、PSは極Pの撮像画像上での位置であり、これは撮像画像上での図形の重心に一致している。
【0024】
図8は立体1の姿勢を求める手順を示すフローチャートである。
1.撮像画像を2値化した画像(図7(b))から図形の重心を求め、その位置をPSとする(ステップ21)。
2.式(1)を用いて、軸Lの姿勢すなわち角度B1およびB2を求める(ステップ22)。
3.2で得られた角度B2に最も近い角度を図5に示したテーブルの角度θ1欄から選択し、マッチング処理に用いるテンプレート画像群の列を決定する(ステップ23)。
4.撮像画像(図7(a))をCSの周りに角度−B1だけ回転させた濃淡画像を得る(ステップ24)。
5.3で決定された列に含まれる全てのテンプレート画像(図5の例では360個)と4で得られた濃淡画像との正規化相関手法等によるマッチング処理を点PSの回転後の点の近傍において逐次行う(ステップ25)。
6.5で得られたマッチングの度合い(スコア)が最大となるテンプレート画像を見つけ、そのテンプレート画像に対応する角度θ2を求め、これを立体1の軸Lの周りの回転方向の姿勢を表わす角度B3とする(ステップ26)。
7.以上により得られた角度B1、B2、およびB3を立体1の姿勢とする(ステップ27)。
【0025】
図9に上記と同様の手順で姿勢を検出することができる立体1の第2の例として、1個の非回転対称図形が表面に描かれた正四角台形錐体を示す。図9(a)は立体1の例、図9(b)は立体1の表面上の図形の配置を説明するための図である。図9(b)において、Lは正四角台形錐体の軸であり、Pは正四角台形錐体の表面と軸Lとが交わる点である。非回転対称図形(この例では文字「A」)は、図9(a)のように、その重心GがPの位置に一致するように正四角台形錐体の表面に描かれている。
【0026】
図10に上記と同様の手順で姿勢を検出することができる立体1の第3の例として、1個の非回転対称図形が表面に描かれた正四角台形錐の殻状体を示す。図10(a)は立体1の例、図10(b)は立体1の表面上の図形の配置を説明するための図である。図10(b)において、Lは正四角台形錐殻状体の軸であり、Pは正四角台形錐殻状体の表面と軸Lとが交わる点である。非回転対称図形(この例では文字「A」)は、図10(a)のように、その重心GがPの位置に一致するように正四角台形錐殻状体の表面に描かれている。
【0027】
図11に上記と同様の手順で姿勢を検出することができる立体1の第4の例として、1個の非回転対称図形が表面に描かれた準正多面体を示す。非回転対称図形(この例では文字「A」)は、図11のように、その重心Gが準正多面体の1つの面の重心の位置に一致するように準正多面体の表面に描かれている。
【0028】
図12に上記と同様の手順で姿勢を検出することができる立体1の第5の例として、1個の非回転対称図形が表面に描かれた正多面体を示す。非回転対称図形(この例では文字「A」)は、図12のように、その重心Gが正多面体の1つの面の重心の位置に一致するように正多面体の表面に描かれている。
【0029】
[第2の実施形態]
本実施形態では、3次元姿勢検出用立体1の第6の例として、2種類の大きさの4個の回転対称図形と3個の非回転対称図形が表面に描かれた既知の楕円体を用い、その撮像画像から立体1の姿勢を求める方法を説明する。
【0030】
図13は立体1の表面上の図形の配置を説明するための図である。わかり易くするため、図13では楕円体面上の図形を平面的に表現している。図13(a)は上面図であり、図13(b)は側面図である。楕円体の極Pの位置に大きいドットが、極Pを中心とした回転対称の位置Q1、Q2、Q3に小さいドットがそれぞれ描かれている。また、Q1、Q2、Q3に描かれた各ドットからPに描かれたドットに向かう方向を姿勢の基準として、Pに描かれたドットとQ1、Q2、Q3に描かれた3個のドットとの各中点にそれぞれ異なる3個の図形が描かれている。
【0031】
図14は立体1に描かれた各ドットの3次元的な位置関係を説明するための図である。図14(a)において、Pは楕円体の極であり、大きいドットの位置である。Qi(i=1,2,3)は各小さいドットの位置、Cは楕円体の重心、DPQは実空間上でのPとQi間の距離、DQQは実空間上でのQiとQj間の距離、DCQは実空間上でのCとQi間の距離である。図14(b)において、Miは点P、QiおよびCを含む平面上の点であり、線分PQiの垂直二等分線が楕円体の表面と交わる点である。
【0032】
図15(a)および(b)は、それぞれ大きいドットおよび小さいドットを検出するためのテンプレート画像であり、実際にはガウシアンフィルタ等によるぼかし処理を施して作成されている。
【0033】
図16は互いに異なる3種類の図形を検出するためのテンプレート画像群が配置されたテーブルである。各テンプレート画像は第1の実施形態で説明した方法で作成してある。
【0034】
図17は撮像画像から楕円体の部分を切り出した部分画像を示している。図17(a)は濃淡画像であり、図17(b)は楕円体の姿勢を求める手順を説明するための図である。説明のため、図17(b)では各ドットをその輪郭のみで示している。図17(b)において、PSは極Pの撮像画像上での位置であり、これは撮像画像上での大きいドットの位置に一致している。また、QSi(i=1,2,3)はそれぞれQiの撮像画像上での位置、MSiはMiの撮像画像上での位置である。
【0035】
図18は立体1の姿勢を求める手順を示すフローチャートである。
1.大きいドットを検出するためのテンプレート画像(図15(a))と濃淡画像(図17(a))との正規化相関手法等によるマッチング処理を行い、マッチングスコアが最大となる撮像画像上での大きいドットの位置を求め、その位置をPSとする(ステップ31)。
2.小さいドットを検出するためのテンプレート画像(図15(b))と濃淡画像(図17(a))との正規化相関手法等によるマッチング処理を行い、マッチングスコアが最大となる撮像画像上での小さいドットの位置QSiを求める(ステップ32)。
3.1で求められたPSから、式(1)、式(2)を用いて、軸Lの姿勢すなわち角度B1、B2、および点Pの実空間上での位置を求める(ステップ33)。
4.2で求められたQSiから、式(1)、式(2)を用いて、直線CQiの姿勢すなわち角度BQi1、BQi2、および点Qiの実空間上での位置を求める(ステップ34)。ただし、式(1)、式(2)において、DCPの代わりにDCQを用いることとする。
5.点Pおよび点Qiの実空間上での位置から、図14(b)の関係を用いて、点Miの位置と直線CMiの姿勢すなわち角度BMi1およびBMi2を求める(ステップ35)。
6.式(2)を用いて、点Miの撮像画像上での位置MSiを求める(ステップ36)。ただし、式(2)において、DCPの代わりに、CとMi間の距離を用いることとする。
7.5で得られた角度BMi2に最も近い角度を図16に示したテーブルの角度θ1欄から選択し、マッチング処理に用いる3種類のテンプレート画像群の列を決定する(ステップ37)。
8.撮像画像(図17(a))をCSの周りに角度−BMi1だけ回転させた濃淡画像を得る(ステップ38)。
9.7で決定された列に含まれる3種類の全てのテンプレート画像(図16の例では1080個)と8で得られた濃淡画像との正規化相関手法等によるマッチング処理を点MSiの回転後の点の近傍において逐次行う(ステップ39)。
10.9で得られたマッチングの度合い(スコア)が最大となるテンプレート画像を見つけ、対象としている図形が3種類の図形のうちの何れであるかを特定することにより、対象とした小さいドットQiがQ1、Q2、Q3の何れであるかを特定する(ステップ40)。
11.特定されたQiに基づき、立体1の軸Lの周りの回転方向の姿勢を表わす角度B3を算出する。すなわち、特定されたQiを軸Zの周りに角度−B1だけ回転させ、さらに軸Xの周りに角度−B2だけ回転させた点の軸Zの周りの偏角を求め、これをB3とする(ステップ41)。
12.以上により得られた角度B1、B2、およびB3を立体1の姿勢とする(ステップ42)。
【0036】
[第3の実施形態]
本実施形態では、3次元姿勢検出用立体1の第7の例として、同一の大きさの4個の回転対称図形と3個の非回転対称図形が表面に描かれた既知の楕円体を用い、その撮像画像から立体1の姿勢を求める方法を説明する。第2の実施形態とは、楕円体の極Pの位置に描かれたドットとその周囲に描かれたドットとの判別方法のみが異なるので、この判別方法のみを説明する。
【0037】
図19は立体1の表面上の図形の配置を説明するための図である。わかり易くするため、図19では楕円体面上の図形を平面的に表現している。図19(a)は上面図であり、図19(b)は側面図である。楕円体の極Pの位置および極Pを中心とした回転対称の位置Q1、Q2、Q3に全て同一の大きさのドットが描かれている。また、Q1、Q2、Q3に描かれた各ドットからPに描かれたドットに向かう方向を姿勢の基準として、Pの描かれたドットとQ1、Q2、Q3に描かれた3個のドットとの各中点にそれぞれ異なる3個の図形が描かれている。さらに、立体1に描かれた各ドットの3次元的な位置関係は図14と同様であるとする。ただし、本実施形態では、DPQとDQQとが十分異なるように各ドットの位置を設定しておく。
【0038】
図20はドットを検出するためのテンプレート画像であり、実際にはガウシアンフィルタ等によるぼかし処理を施して作成されている。
【0039】
図21は撮像画像から楕円体の部分を切り出した部分画像を示している。図21(a)は濃淡画像であり、図21(b)は楕円体の姿勢を求める手順を説明するための図である。説明のため、図21(b)では各ドットをその輪郭のみで示している。図21(b)において、PSは極Pの撮像画像上での位置、QSi(i=1,2,3)はそれぞれQiの撮像画像上での位置である。
【0040】
図22は立体1のPに描かれたドットとQ1、Q2、Q3に描かれたドットのうちの1つを判別する手順を示すフローチャートである。
1.ドットを検出するためのテンプレート画像(図20)と濃淡画像(図21(a))との正規化相関手法等によるマッチング処理を行い、各ドットについて、マッチングスコアが最大となる撮像画像上での位置を全て求める(ステップ51)。
2.求められた各点について、式(1)、式(2)を用いて、実空間上での位置を算出する(ステップ52)。ただし、式(1)、式(2)において、DCPの代わりに全てDCQを用いることとする。本実施形態では、DPQとDQQとが十分異なるため、このような近似を用いても各ドットを正しく判別することができる。
3.求められた点が2個以下の場合は処理を中止する(ステップ53)。
4.求められた点が3個以上の場合、これらの中から2個を選ぶ全ての組合わせについて、選んだ2個の点間の実空間における距離を求め、この距離と立体1における既知のDQQとの差の絶対値が所定の閾値より大きくなる1組を選定する(ステップ54)。
5.選定された組の2個の点をP1、P2、それ以外の任意の点をQiとし、P1とQi間の距離を求める(ステップ55)。その際、P1、P2の実空間上での位置として、DCPにCとP間の距離を代入した式(1)、式(2)により算出したものを用いる。
6.5で求められたP1とQi間の距離と立体1における既知のDPQとの差の絶対値が、所定の閾値より小さければP1をPに描かれたドットとし、そうでなければP2をPに描かれたドットとする(ステップ56)。
【0041】
以下、第2の実施形態における手順3以降を実行すればよい。
【0042】
図23に上記と同様の手順で姿勢を検出することができる立体1の第8の例として、図19に示した立体におけるドットに代えて円が表面に描かれた楕円体を示す。わかり易くするため、図23では楕円体面上の図形を平面的に表現している。図23(a)は上面図であり、図23(b)は側面図である。楕円体の極Pの位置および極Pを中心とした回転対称の位置Q1、Q2、Q3に全て同一の大きさの円が描かれている。また、Q1、Q2、Q3に描かれた各円からPに描かれた円に向かう方向を姿勢の基準として、Pに描かれた円とQ1、Q2、Q3に描かれた3個の円との各中点にそれぞれ異なる3個の図形が描かれている。さらに、立体1に描かれた各円の3次元的な位置関係は図14と同様であるとする。ただし、DPQとDQQとが十分異なるように各円の位置を設定しておく。
【0043】
図24は円を検出するためのテンプレート画像であり、実際にはガウシアンフィルタ等によるぼかし処理を施して作成されている。
【0044】
図25に上記と同様の手順で姿勢を検出することができる立体1の第9の例として、同一の大きさの4個の回転対称図形と3個の非回転対称図形が表面に描かれた正六角台形錐体を示す。わかり易くするため、図25では正六角台形錐体面上の図形を平面的に表現している。図25(a)は上面図であり、図25(b)は側面図である。Lは正六角台形錐体の軸であり、Pは軸Lと上底面とが交わる点である。Pの位置および1個おきの側面の左右の中央で、かつPから等距離の位置Q1、Q2、Q3に全て同一の大きさのドットが描かれている。また、Q1、Q2、Q3に描かれた各ドットからPに描かれたドットに向かう方向を姿勢の基準として、Pに描かれたドットとQ1、Q2、Q3に描かれた3個のドットとの各中点にそれぞれ異なる3個の図形が描かれている。但し、PとQi間の距離DPQとQiとQj間の距離DQQとが十分異なるように各ドットの位置を設定しておく。
【0045】
図26に上記と同様の手順で姿勢を検出することができる立体1の第10の例として、同一の大きさの4個の回転対称図形と3個の非回転対称図形が表面に描かれた放物面体を示す。わかり易くするため、図26では放物面体の表面上の図形を平面的に表現している。図26(a)は上面図であり、図26(b)は側面図である。Lは放物面体の軸であり、Pは軸Lと放物面体の表面とが交わる点、すなわち、放物面体の極である。放物面体の極Pの位置および極Pを中心とした回転対称の位置Q1、Q2、Q3に全て同一の大きさのドットが描かれている。また、Q1、Q2、Q3に描かれた各ドットからPに描かれたドットに向かう方向を姿勢の基準として、Pに描かれたドットとQ1、Q2、Q3に描かれた3個のドットとの各中点にそれぞれ異なる3個の図形が描かれている。但し、PとQi間の距離DPQとQiとQj間の距離DQQとが十分異なるように各ドットの位置を設定しておく。
【0046】
[第4の実施形態]
本実施形態では、3次元姿勢検出用立体1の第11の例として、同一の大きさでかつ互いに異なる色の4個の回転対称図形が表面に描かれた既知の楕円体を用い、その撮像画像から立体1の姿勢を求める方法を説明する。
【0047】
図27は立体1の表面上の図形の配置を説明するための図である。わかり易くするため、図27では楕円体面上の図形を平面的に表現している。図27(a)は上面図であり、図27(b)は側面図である。楕円体の極Pの位置に黒のドットが、極Pを中心とした回転対称の位置Q1、Q2、Q3にそれぞれ赤、緑、青のドットが描かれている。また、立体1に描かれた各ドットの3次元的な位置関係は図14と同様であるとする。さらに、ドットを検出するためのテンプレート画像は図20と同様である。
【0048】
図28は撮像画像から楕円体の部分を切り出した部分画像を示している。図28(a)は濃淡画像であり、図28(b)はカラー画像である。PSは極Pの撮像画像上での位置、QSi(i=1,2,3)はそれぞれQiの撮像画像上での位置である。
【0049】
図29は立体1の姿勢を求める手順を示すフローチャートである。
1.ドットを検出するためのテンプレート画像(図20)と濃淡画像(図28(a))との正規化相関手法等によるマッチング処理を行い、各ドットについて、マッチングスコアが最大となる撮像画像上での位置を全て求める(ステップ61)。
2.求められた各点におけるカラー画像(図28(b))の色情報から各ドットを判別する(ステップ62)。
3.2で判別されたPSから、式(1)を用いて、軸Lの姿勢すなわち角度B1およびB2を求める(ステップ63)。
4.Qi(Q1、Q2、Q3のいずれか)に描かれた1個のドットについて、式(1)、式(2)を用いて、実空間上での位置を求める(ステップ64)。ただし、式(1)、式(2)において、DCPの代わりにDCQを用いることとする。
5.4で求められたQiに基づき、立体1の軸Lの周りの回転方向の姿勢を表わす角度B3を算出する(ステップ65)。すなわち、求められたQiを軸Zの周りに角度−B1だけ回転させ、さらに軸Xの周りに角度−B2だけ回転させた点の軸Zの周りの偏角を求め、これをB3とする。
6.以上により得られた角度B1、B2、およびB3を立体1の姿勢とする(ステップ66)。
【0050】
以上の実施形態で説明した、立体の姿勢を求める方法では、各々のマッチング処理において、立体表面に描かれた図形の一部分である比較的小さなサイズの図形を用いるので、立体全体ではなくその図形の領域にのみ対応したテンプレート画像を用いればよく、テンプレート画像の記憶容量およびマッチング処理の計算コストを小さく抑えることができる。
【0051】
なお、本発明の3次元姿勢検出方法は専用のハードウェアにより実現されるもの以外に、その機能を実現するためのプログラムを、コンピュータ読み取り可能な記録媒体に記録して、この記録媒体に記録されたプログラムをコンピュータシステムに読み込ませ、実行するものであってもよい。コンピュータ読み取り可能な記録媒体とは、フロッピーディスク、光磁気ディスク、CD−ROM等の記録媒体、コンピュータシステムに内蔵されるハードディスク装置等の記憶装置を指す。さらに、コンピュータ読み取り可能な記録媒体は、インターネットを介してプログラムを送信する場合のように、短時間の間、動的にプログラムを保持するもの(伝送媒体もしくは伝送波)、その場合のサーバとなるコンピュータシステム内部の揮発性メモリのように、一定時間プログラムを保持しているものも含む。
【0052】
【発明の効果】
以上説明したように、本発明は、立体の3次元姿勢を検出するにあたって、姿勢特定のための各マッチング処理において、立体表面に描かれた図形の一部分である比較的小さなサイズの図形を用いるので、立体全体ではなくその図形の領域にのみ対応したテンプレート画像を用いればよく、テンプレート画像の記憶容量およびマッチング処理の計算コストを小さく抑えることができる。
【図面の簡単な説明】
【図1】本発明の3次元姿勢検出用立体の第1の例と第1の実施形態の3次元姿勢検出装置のブロック図である。
【図2】立体1の第1の例と、その表面上の図形の配置を説明するための図である。
【図3】図形のテンプレート画像の計算機による作成方法を説明するための図である。
【図4】仮想平面SV上の図形をXY平面に投影して得られた仮想カメラCVの画像を示す図である。
【図5】作成されたテンプレート画像群が配置されたテーブルを示す図である。
【図6】楕円体の軸Lと実空間における姿勢と極Pの撮像画像上における位置の関係を説明するための図である。
【図7】撮像画像から楕円体の部分を切り出した部分画像を示す図である。
【図8】第1の実施形態の3次元姿勢検出装置における立体1の姿勢を求める手順を示すフローチャートである。
【図9】立体1の第2の例を示す図である。
【図10】立体1の第3の例を示す図である。
【図11】立体1の第4の例を示す図である。
【図12】立体1の第5の例を示す図である。
【図13】立体1の第6の例の表面上の図形の配置を説明するための図である。
【図14】立体1に描かれた各ドットの3次元的な位置関係を説明するための図である。
【図15】大きいドット、小さいドットを検出するためのテンプレート画像を示す図である。
【図16】互いに異なる3種類の図形を検出するためのテンプレート画像群が配置されたテーブルを示す図である。
【図17】撮像画像から楕円体の部分を切り出した部分画像を示す図である。
【図18】第2の実施形態の3次元姿勢検出装置における立体1の姿勢を求める手順を示すフローチャートである。
【図19】立体1の第7の例の表面上の図形の配置を説明するための図である。
【図20】ドットを検出するためのテンプレート画像を示す図である。
【図21】撮像画像から楕円体の部分を切り出した部分画像を示す図である。
【図22】第3の実施形態の3次元姿勢検出装置における立体1の姿勢を求める手順を示すフローチャートである。
【図23】立体1の第8の例を示す図である。
【図24】円を検出するためのテンプレート画像を示す図である。
【図25】立体1の第9の例を示す図である。
【図26】立体1の第10の例を示す図である。
【図27】立体1の第11の例の表面上の図形の配置を説明するための図である。
【図28】撮像画像から楕円体の部分を切り出した部分画像を示す図である。
【図29】第4の実施形態の3次元姿勢検出装置における立体1の姿勢を求める手順を示すフローチャートである。
【符号の説明】
1 3次元姿勢検出用立体
2 カメラ
3 3次元姿勢検出装置
11 軸姿勢検出部
12 立体姿勢算出部
21〜27,31〜42,51〜56,61〜66 ステップ
Claims (14)
- 3次元姿勢検出装置に撮像画像を入力することによって、その3次元姿勢を検出することが可能な立体であって、
少なくとも一部分が回転対称体であり、前記回転対称体の表面と該回転対称体の軸とが交わる位置に配置された図形を含む、姿勢により見え方が異なる図形を前記回転対称体の表面に有する3次元姿勢検出用立体。 - 前記回転対称体の表面と該回転対称体の軸とが交わる位置に配置された図形は非回転対称図形である、請求項1に記載の3次元姿勢検出用立体。
- 前記姿勢により見え方が異なる図形は、前記回転対称体の表面と該回転対称体の軸とが交わる位置に配置された回転対称図形と、該回転対称図形を中心とする点対称の位置に配置された2個以上の回転対称図形とを含む、請求項1に記載の3次元姿勢検出用立体。
- 前記姿勢により見え方が異なる図形は、前記点対称の位置に配置された回転対称図形とそれぞれ対になる互いに異なる図形をさらに含む、請求項3に記載の3次元姿勢検出用立体。
- 前記点対称の位置に配置された回転対称図形は、互いに異なる色である、請求項3に記載の3次元姿勢検出用立体。
- 前記回転対称体は、楕円体、方物面体、回転対称台形錐体、正多面体、準正多面体、およびそれらの殻状体のいずれかである、請求項1から5のいずれかに記載の3次元姿勢検出用立体。
- 少なくとも一部分が回転対称体であり、前記回転対称体の表面と該回転対称体の軸とが交わる位置に配置された図形を含む、姿勢により見え方が異なる図形を前記回転対称体の表面に有する3次元姿勢検出用立体の撮像画像から、該立体の3次元姿勢を検出する方法であって、
前記撮像画像から前記回転対称体の表面と該回転対称体の軸とが交わる位置を検出し、該軸の姿勢を算出する軸姿勢算出段階と、
前記撮像画像と前記立体の種々の姿勢に対応する前記図形のテンプレート画像群とを比較することにより前記立体の姿勢を算出する立体姿勢算出段階とを有する3次元姿勢検出方法。 - 前記3次元姿勢検出用立体は、前記回転対称体の表面と該回転対称体の軸とが交わる位置に配置された回転対称図形と、該回転対称図形を中心とする点対称の位置に配置された2個以上の回転対称図形と、前記点対称の位置に配置された回転対称図形とそれぞれ対になる互いに異なる図形とを有しており、
前記立体姿勢算出段階は、
前記撮像画像と前記立体の種々の姿勢に対応する前記点対称の位置に配置された回転対称図形のテンプレート画像群とを比較することにより前記立体の姿勢の候補を算出する段階と、
前記撮像画像と前記立体の種々の姿勢に対応する前記互いに異なる図形のテンプレート画像群とを比較することにより前記候補の中から前記立体の正確な姿勢を選択する段階とを有する、請求項7に記載の3次元姿勢検出方法。 - 前記3次元姿勢検出用立体は、前記回転対称体の表面と該回転対称体の軸とが交わる位置に配置された回転対称図形と、該回転対称図形を中心とする点対称の位置に配置された2個以上の互いに異なる色の回転対称図形とを有しており、
前記立体姿勢算出段階は、
前記撮像画像と前記立体の種々の姿勢に対応する前記点対称の位置に配置された回転対称図形のテンプレート画像群とを比較することにより前記立体の姿勢の候補を算出する段階と、
前記撮像画像の前記点対称の位置に配置された回転対称図形のいずれかの位置における色情報に基づき前記候補の中から前記立体の正確な姿勢を選択する段階とを有する、請求項7に記載の3次元姿勢検出方法。 - 少なくとも一部分が回転対称体であり、前記回転対称体の表面と該回転対称体の軸とが交わる位置に配置された図形を含む、姿勢により見え方が異なる図形を前記回転対称体の表面に有する3次元姿勢検出用立体の撮像画像を入力することによって、該立体の3次元姿勢を検出する装置であって、
前記撮像画像から前記回転対称体の表面と該回転対称体の軸とが交わる位置を検出し、該軸の姿勢を算出する軸姿勢算出手段と、
前記撮像画像と前記立体の種々の姿勢に対応する前記図形のテンプレート画像群とを比較することにより前記立体の姿勢を算出する立体姿勢算出手段とを有する3次元姿勢検出装置。 - 前記3次元姿勢検出用立体は、前記回転対称体の表面と該回転対称体の軸とが交わる位置に配置された回転対称図形と、該回転対称図形を中心とする点対称の位置に配置された2個以上の回転対称図形と、前記点対称の位置に配置された回転対称図形とそれぞれ対になる互いに異なる図形とを有しており、
前記立体姿勢算出手段は、
前記撮像画像と前記立体の種々の姿勢に対応する前記点対称の位置に配置された回転対称図形のテンプレート画像群とを比較することにより前記立体の姿勢の候補を算出する手段と、
前記撮像画像と前記立体の種々の姿勢に対応する前記互いに異なる図形のテンプレート画像群とを比較することにより前記候補の中から前記立体の正確な姿勢を選択する手段とを有する、請求項10に記載の3次元姿勢検出装置。 - 前記3次元姿勢検出用立体は、前記回転対称体の表面と該回転対称体の軸とが交わる位置に配置された回転対称図形と、該回転対称図形を中心とする点対称の位置に配置された2個以上の互いに異なる色の回転対称図形とを有しており、
前記立体姿勢算出手段は、
前記撮像画像と前記立体の種々の姿勢に対応する前記点対称の位置に配置された回転対称図形のテンプレート画像群とを比較することにより前記立体の姿勢の候補を算出する手段と、
前記撮像画像の前記点対称の位置に配置された回転対称図形のいずれかの位置における色情報に基づき前記候補の中から前記立体の正確な姿勢を選択する手段とを有する、請求項10に記載の3次元姿勢検出装置。 - 請求項7から9のいずれかに記載の3次元姿勢検出方法をコンピュータに実行させるための3次元姿勢検出プログラム。
- 請求項7から9のいずれかに記載の3次元姿勢検出方法をコンピュータに実行させるための3次元姿勢検出プログラムを記録した、コンピュータで読取り可能な記録媒体。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002310169A JP3962311B2 (ja) | 2002-10-24 | 2002-10-24 | 3次元姿勢検出方法、3次元姿勢検出装置、3次元姿勢検出プログラム、およびそのプログラムを記録した記録媒体 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002310169A JP3962311B2 (ja) | 2002-10-24 | 2002-10-24 | 3次元姿勢検出方法、3次元姿勢検出装置、3次元姿勢検出プログラム、およびそのプログラムを記録した記録媒体 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004145664A true JP2004145664A (ja) | 2004-05-20 |
JP3962311B2 JP3962311B2 (ja) | 2007-08-22 |
Family
ID=32455764
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2002310169A Expired - Fee Related JP3962311B2 (ja) | 2002-10-24 | 2002-10-24 | 3次元姿勢検出方法、3次元姿勢検出装置、3次元姿勢検出プログラム、およびそのプログラムを記録した記録媒体 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3962311B2 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006038815A (ja) * | 2004-07-30 | 2006-02-09 | Toshiba Corp | パターン評価方法、プログラムおよびパターン評価装置 |
JP2018032111A (ja) * | 2016-08-22 | 2018-03-01 | 株式会社ソニー・インタラクティブエンタテインメント | 情報処理装置、情報処理システム、操作用オブジェクト、および情報処理方法 |
-
2002
- 2002-10-24 JP JP2002310169A patent/JP3962311B2/ja not_active Expired - Fee Related
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006038815A (ja) * | 2004-07-30 | 2006-02-09 | Toshiba Corp | パターン評価方法、プログラムおよびパターン評価装置 |
JP2018032111A (ja) * | 2016-08-22 | 2018-03-01 | 株式会社ソニー・インタラクティブエンタテインメント | 情報処理装置、情報処理システム、操作用オブジェクト、および情報処理方法 |
WO2018037975A1 (ja) * | 2016-08-22 | 2018-03-01 | 株式会社ソニー・インタラクティブエンタテインメント | 情報処理装置、情報処理システム、操作用オブジェクト、および情報処理方法 |
US10957070B2 (en) | 2016-08-22 | 2021-03-23 | Sony Interactive Entertainment Inc. | Information processing apparatus, information processing system, operation object, and information processing method |
Also Published As
Publication number | Publication date |
---|---|
JP3962311B2 (ja) | 2007-08-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8638986B2 (en) | Online reference patch generation and pose estimation for augmented reality | |
JP4340968B2 (ja) | 画像処理装置および方法、記録媒体、並びにプログラム | |
US8660362B2 (en) | Combined depth filtering and super resolution | |
US20130335532A1 (en) | Image processing apparatus, image processing method, and program | |
CN108369473A (zh) | 影响增强现实的虚拟对象的方法 | |
CN112257696B (zh) | 视线估计方法及计算设备 | |
WO2009044148A1 (en) | Apparatus and method of image analysis | |
JP2010282295A (ja) | 画像処理装置、画像処理方法及びプログラム | |
US11922568B2 (en) | Finite aperture omni-directional stereo light transport | |
Azad et al. | Combining appearance-based and model-based methods for real-time object recognition and 6d localization | |
KR102556759B1 (ko) | 카메라-라이다 캘리브레이션 장치 및 방법 | |
US11954817B2 (en) | Method of plane tracking | |
JP4056891B2 (ja) | 3次元位置・姿勢検出装置、方法、プログラムおよび記録媒体 | |
JP3962311B2 (ja) | 3次元姿勢検出方法、3次元姿勢検出装置、3次元姿勢検出プログラム、およびそのプログラムを記録した記録媒体 | |
EP3933687B1 (en) | An image processing method and system | |
JP7262689B1 (ja) | 情報処理装置、生成方法、及び生成プログラム | |
JP2001059715A (ja) | 実物体の時空間画像を用いた形状復元方法及び画像処理方法並びに形状復元システム | |
FRM | Hop0000000 | |
JPWO2002048961A1 (ja) | 画像処理装置、画像処理方法、記録媒体、及びプログラム | |
JP2010277164A (ja) | モデルデータ作成装置、モデルデータ作成方法、物体認識装置、及び物体認識方法 | |
ming Dong et al. | A hybrid method for robot navigation based on MR code landmark | |
WO2024144802A1 (en) | Reductive iteration convolution-based keypoint detection | |
Bradley et al. | Tracking a sphere with six degrees of freedom | |
CN110348440A (zh) | 牌照检测方法、装置、电子设备及存储介质 | |
CN115131575A (zh) | 一种棋盘格角点自动检测排序方法、装置及存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050124 |
|
RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20050124 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20050124 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20050614 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20070104 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070131 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070327 |
|
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: 20070509 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070518 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100525 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110525 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120525 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130525 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140525 Year of fee payment: 7 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
LAPS | Cancellation because of no payment of annual fees |