(57)【特許請求の範囲】
【請求項１】
入力画像から局所特徴量を抽出する特徴量抽出手段と、
各登録場所と局所特徴量が対応づけられて保存されているデータベースを参照し、入力画像と登録場所とのマッチングを求めるマッチング手段と、
マッチングが所定の閾値以上である場合に、選ばれた登録場所の近傍の登録場所を含めて類似度を算出する類似度算出手段と、
前記類似度が所定の閾値以上である場合に、当該入力画像が登録場所であると認定する認定手段とを有する位置推定装置。
【請求項２】
前記データベースは、前記各登録場所の局所特徴量を使用して作成された、いずれの登録場所にも属さない非登録場所及びその特徴量を有する、請求項１記載の位置推定装置。
【請求項３】
前記非登録場所は、各登録場所の局所特徴量の一部又は全部が対応付けられている、請求項２記載の位置推定装置。
【請求項４】
前記入力画像が、前記非登録場所と最もマッチングする場合、当該入力画像とその特徴量を新しい登録場所としてデータベースに登録する、請求項２又は３記載の位置推定装置。
【請求項５】
マッチングスコアは、前記データベースに含まれる登録場所の数及び当該登録場所のうち、入力画素とマッチングした登録場所の数に基づき算出される、請求項１乃至４のいずれか１項記載の位置推定装置。
【請求項６】
マッチングスコアをｓｔ、前記データベースに含まれる登録場所の数をｎｔ、当該登録場所のうち、入力画素とマッチングした登録場所の数をｎｗｋ＝Ｍｊ、０＜ｊ＜ｎｔ、ｊ≠ｉ、ｍｉは、入力画像Ｍｔと現在のモデルＭｉとの間でマッチした局所特徴量の数、ｋ、ｉ、ｊ、ｔは整数としたとき、下記により前記マッチングスコアｓｔを求めることができる、請求項５記載の位置推定装置。
【数１４】
0005557189.tif 000015
【請求項７】
前記類似度算出手段は、マッチングスコアと、ガウス分布から得られる遷移確率とに基づき類似度スコアを算出する、請求項１乃至６のいずれか１項記載の位置推定装置。
【請求項８】
前記類似度スコアをβｉ、ガウシアンシグマ＝２としたとき、ｉからｋの距離を示す前記遷移確率をｐＴ（ｉ，ｋ）、考慮する隣接登録画像に関する値をω、ｉ、ｋを整数とすると、下記により、前記類似度スコアβｉを求めることができる、請求項７記載の位置推定装置。
【数１５】
0005557189.tif 000016
【請求項９】
前記類似度算出手段は、前記類似度スコアを正規化した正規化スコアを算出する、請求項７又は８記載の位置推定装置。
【請求項１０】
前記認定手段は、前記類似度スコアから前記類似度スコアの標準偏差と平均値の和を引いた値が所定の閾値以上である場合、前記入力画像を前記登録場所であると認定する、請求項７乃至９のいずれか１項記載の位置推定装置。
【請求項１１】
前記認定手段の認定結果を補正する補正手段を更に有し、前記補正手段は、前記類似度スコアを正規化した正規化スコアに基づき当該認定結果を補正した補正スコアを算出する、請求項７乃至１０のいずれか１項記載の位置推定装置。
【請求項１２】
前記類似度スコアをβｉ、前記類似度スコアの標準偏差及び平均をそれぞれσ及びμ、Ｔ＝σ＋μ、ｉは整数としたとき、前記正規化スコアＣｉは、下記の式により求めることができる、請求項１１項記載の位置推定装置。
【数１６】
0005557189.tif 000017
【請求項１３】
前記補正手段は、ω＋１≦ｉ≦ｎｔ−（ω＋１）とし、ガウシアンシグマ＝２としたとき、ｉからｋの距離を示す前記遷移確率をｐＴ（ｉ，ｋ）、考慮する隣接登録画像に関する値をω、ｉ、ｋを整数とすると、前記補正スコアＣｊは、下記により求まる、請求項１１又は１２記載の位置推定装置。
【数１７】
0005557189.tif 000018
【請求項１４】
前記特徴量抽出手段は、
前記入力画像それぞれから、局所特徴量を抽出する局所特徴量抽出手段と、
前記局所特徴量抽出手段により抽出された前記局所特徴量について、前記連続する入力画像間でマッチングをとる特徴量マッチング手段と、
前記特徴量マッチング手段により所定数連続する画像間でマッチングが取れた局所特徴量を連続特徴量として選択する連続特徴量選択手段と、
各前記連続特徴量の平均を不変特徴量として求める不変特徴量算出手段とを有する、請求項１乃至１３のいずれか１項記載の位置推定装置。
【請求項１５】
前記局所特徴量は、ＳＩＦＴ（Scale Invariant Feature Transformation）及び／又はＳＵＲＦ（Speed Up Robustness Features）の特徴量である、請求項１４項記載の位置推定装置。
【請求項１６】
入力画像から局所特徴量を抽出する特徴量抽出工程と、
各登録場所と局所特徴量が対応づけられて保存されているデータベースを参照し、入力画像と登録場所とのマッチングを求めるマッチング工程と、
マッチングが所定の閾値以上である場合に、選ばれた登録場所の近傍の登録場所を含めて類似度を算出する類似度算出工程と、
前記類似度が所定の閾値以上である場合に、当該入力画像が登録場所であると認定する認定工程とを有する位置推定方法。
【請求項１７】
所定の動作をコンピュータに実行させるためのプログラムであって、
入力画像から局所特徴量を抽出する特徴量抽出工程と、
各登録場所と局所特徴量が対応づけられて保存されているデータベースを参照し、入力画像と登録場所とのマッチングを求めるマッチング工程と、
マッチングが所定の閾値以上である場合に、選ばれた登録場所の近傍の登録場所を含めて類似度を判定する類似度算出工程と、
前記類似度が所定の閾値以上である場合に、当該入力画像が登録場所であると認定する認定工程とを有するプログラム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、ロボット装置などに好適に使用され得る位置推定装置、位置推定方法及びプログラムに関し、特に局所特徴量を使用して位置推定する位置推定装置、位置推定方法及びプログラム関する。
【背景技術】
【０００２】
自己位置の推定・特定は、人間や機械にとっては必須の能力である。今自分はどこにいるかということを知ることは、ロボットやコンピュータビジョンにとっては、常に重要である。特に、可動式のロボットにとって、今自分がどこにいるかを把握することは、ナビゲーションシステムのための基本的要求となっている。
【０００３】
従来、特許文献１に記載の位置検出装置がある。この位置検出装置では、移動体の前方視野の輝度画像を取得する輝度画像取得手段と、輝度画像取得手段と同一の視野を有し、輝度画像取得手段が輝度画像を取得するのと同時に距離画像を取得する距離画像取得手段と、少なくとも連続する２フレームの輝度画像からそれぞれ特徴点を抽出する特徴点抽出手段と、特徴点抽出手段によって抽出された特徴点の２フレーム間の位置の変位量を距離画像に基づいて算出し、当該変位量から自己位置を算出するための基準特徴点を選択する基準特徴点選択手段とを備えている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開２００２−０４８５１３号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
ところで、現在画像を撮影した場所が、ロボットが以前も訪れた場所であるか、又は全く知らない場所であるかを識別することは大変難しい。特徴量の抽出の仕方によっては、全く知らない場所をある場所に関連づけてしまうことがある。したがって、現在の位置がデータベースに登録済みの場所であるか、新しい場所であるかを切り分ける能力は大変重要である。また、当該撮影した場所が新しい場所であることが認識できれば、ＤＢを拡大していく、すなわち、地図を学習していくことが可能になる。このような、移動体、特にロボット装置に好適に搭載される位置推定装置の開発が望まれている。
【０００６】
本発明は、このような問題点を解決するためになされたものであり、現在の位置が既に登録済みの場所であるか、未登録の場所であるかを認識することができる位置推定装置、位置推定方法及びプログラムを提供することを目的とする。
【課題を解決するための手段】
【０００７】
本発明に係る位置推定装置は、入力画像から局所特徴量を抽出する特徴量抽出手段と、各登録場所と局所特徴量が対応づけられて保存されているデータベースを参照し、入力画像と登録場所とのマッチングを求めるマッチング手段と、マッチングが所定の閾値以上である場合に、選ばれた登録場所の近傍の登録場所を含めて類似度を算出する類似度算出手段と、前記類似度が所定の閾値以上である場合に、当該入力画像が登録場所であると認定する認定手段とを有するものである。
【０００８】
本発明においては、マッチングを取った後、近傍の登録場所を含めて類似度を算出することで、よりノイズに強く、正確に入力画像がデータベースに登録された登録画像であるか否かを推定することができる。
【０００９】
また、前記データベースは、前記各登録場所の局所特徴量を使用して作成された、いずれの登録場所にも属さない非登録場所及びその特徴量を有することができる。これにより、新規の場所の特定率を向上する。
【００１０】
更に、前記非登録場所は、各登録場所の局所特徴量の一部又は全部が対応付けられているものとすることができる。
【００１１】
更にまた、前記入力画像が、前記非登録場所と最もマッチングする場合、当該入力画像とその特徴量を新しい登録場所としてデータベースに登録することができる。これにより、データベースを更新することができる。
【００１２】
また、マッチングスコアは、前記データベースに含まれる登録場所の数及び当該登録場所のうち、入力画素とマッチングした登録場所の数に基づき算出されることができる。
【００１３】
更に、マッチングスコアをｓｔ、前記データベースに含まれる登録場所の数をｎｔ、当該登録場所のうち、入力画素とマッチングした登録場所の数をｎｗｋ＝Ｍｊ、０＜ｊ＜ｎｔ、ｊ≠ｉ、ｍｉは、入力画像Ｍｔと現在のモデルＭｉとの間でマッチした局所特徴量の数、ｋ、ｉ、ｊ、ｔは整数としたとき、下記により前記マッチングスコアｓｔを求めることができる。これにより、多くの登録モデルに存在する特徴量とマッチングした場合はスコアを低く、少数、例えばたった１つの登録モデルに存在する特徴量とマッチングした場合は、スコアを高く設定することができる。ｉは、データベースの中に登録されたインデックスを示す。
【００１４】
【数１】
0005557189.tif 000002
【００１５】
更にまた、前記類似度算出手段は、マッチングスコアと、ガウス分布から得られる遷移確率とに基づき類似度スコアを算出定することができる。類似スコアにより、更に位置特定率を向上することができる。
【００１６】
また、前記類似度スコアをβｉ、ガウシアンシグマ＝２としたとき、ｉからｋの距離を示す前記遷移確率をｐＴ（ｉ，ｋ）、考慮する隣接登録画像に関する値をω、ｉ、ｋを整数とすると、下記により、前記類似度スコアβｉを求めることができる。類似度スコアにより、マッチングした登録画像の近傍場所のデータも考慮されることができる。
【００１７】
【数２】
0005557189.tif 000003
【００１８】
更に、前記類似度算出手段は、前記類似度スコアを正規化した正規化スコアを算出することができる。類似度スコアは、最もマッチする登録モデルと、これに類似する登録モデルがある場合、特徴量の多くが共通となるため、類似度スコアが当該類似する登録モデルとの方が高くなる場合があり得るため、正規化することが好ましい。
【００１９】
更にまた、前記認定手段は、前記類似度スコアから前記類似度スコアの標準偏差と平均値の和を引いた値が所定の閾値以上である場合、前記入力画像を前記登録場所であると認定することができる。正規化により、より確実に入力画像の位置を特定することができる。
【００２０】
また、前記認定手段の認定結果を補正する補正手段を更に有し、前記補正手段は、前記類似度スコアを正規化した正規化スコアに基づき当該認定結果を補正した補正スコアを算出することができる。補正することで、更に場所の特定率を向上することができる。
【００２１】
更に、前記類似度スコアをβｉ、前記類似度スコアの標準偏差及び平均をそれぞれσ及びμ、Ｔ＝σ＋μ、ｉは整数としたとき、前記正規化スコアＣｉは、下記の式により求めることができる。
【００２２】
【数３】
0005557189.tif 000004
【００２３】
更にまた、前記補正手段は、ω＋１≦ｉ≦ｎｔ−（ω＋１）とし、ガウシアンシグマ＝２としたとき、ｉからｋの距離を示す前記遷移確率をｐＴ（ｉ，ｋ）、考慮する隣接登録画像に関する値をω、ｉ、ｋを整数とすると、前記補正スコアＣｊは、下記により求めることができる。補正することで、更に場所の特定率を向上することができる。
【００２４】
【数４】
0005557189.tif 000005
【００２５】
また、前記特徴量抽出手段は、前記入力画像それぞれから、局所特徴量を抽出する局所特徴量抽出手段と、前記局所特徴量抽出手段により抽出された前記局所特徴量について、前記連続する入力画像間でマッチングをとる特徴量マッチング手段と、前記特徴量マッチング手段により所定数連続する画像間でマッチングが取れた局所特徴量を連続特徴量として選択する連続特徴量選択手段と、各前記連続特徴量の平均を不変特徴量として求める不変特徴量算出手段とを有するものとすることができる。これにより、連続して撮影された画像を使用し、連続する２枚の画像間で特徴量のマッチングをとり、さらにマッチングを取った特徴量が連続して出現するもののみを抽出し、その平均の局所特徴量を求めることで、撮影位置の変化にロバストな特徴を抽出することができ、それを使用して位置を推定するため、正確に位置を特定することが可能となる。連続画像とは、ビデオ画像から取得される連続的に撮影された複数枚の画像セットである。
【００２６】
更に、前記局所特徴量は、ＳＩＦＴ（Scale Invariant Feature Transformation）及び／又はＳＵＲＦ（Speed Up Robustness Features）の特徴量とすることができる。また、これらＳＩＦＴやＳＵＲＦに限らず、スケール、回転の変動、又はノイズ等に対してロバストな他の局所特徴量を用いることも可能である。これにより、これら既存の局所特徴量を用いることで、これらの特徴量が有する性能もそのまま引き継がれ、照明変化等にも頑健な特徴として抽出・記述することが可能となる。
【００２７】
本発明に係る位置推定方法は、入力画像から局所特徴量を抽出する特徴量抽出工程と、各登録場所と局所特徴量が対応づけられて保存されているデータベースを参照し、入力画像と登録場所とのマッチングを求めるマッチング工程と、マッチングが所定の閾値以上である場合に、選ばれた登録場所の近傍の登録場所を含めて類似度を算出する類似度算出工程と、前記類似度が所定の閾値以上である場合に、当該入力画像が登録場所であると認定する認定工程とを有するものである。
【００２８】
また、本発明に係るプログラムは、上述した位置推定処理をコンピュータに実行させるものである。
【発明の効果】
【００２９】
本発明によれば、現在の位置が既に登録済みの場所であるか、未登録の場所であるかを認識することができる位置推定装置、位置推定方法及びプログラムを提供することができる。
【図面の簡単な説明】
【００３０】
【図１】本発明の実施の形態にかかる位置推定装置を示す図である。
【図２】本発明の実施の形態にかかる位置推定装置を示すフローチャートである。
【図３】正規化前後の類似度スコア及び正規化スコアを示す図である。
【図４】補正前後のマッチングスコアを示す図である。
【図５】本発明の実施の形態にかかる位置推定装置の特徴量抽出部を示す図である。
【図６】本発明の実施の形態にかかる特徴量ＰＩＲＦを抽出する方法を説明する図である。
【図７】不変特徴量抽出方法を示すフローチャートである。
【図８】本発明の実施の形態にかかる位置推定装置の推定結果を示すものである。
【図９】同じく、本発明の実施の形態にかかる位置推定装置の推定結果を示すものである。
【図１０】同じく、本発明の実施の形態にかかる位置推定装置の推定結果を示すものである。
【図１１】同じく、本発明の実施の形態にかかる位置推定装置の推定結果を示すものである。
【発明を実施するための形態】
【００３１】
以下、本発明を適用した具体的な実施の形態について、図面を参照しながら詳細に説明する。この実施の形態は、本発明を、移動型のロボット装置などに搭載される、位置を推定する位置推定装置に適用したものである。
【００３２】
図１は、本実施の形態にかかる位置推定装置を示す図である。図１に示すように、位置推定装置は、特徴量抽出部１１、マッチング部１３、類似度算出部１５、登録場所認定部１７、登録場所補正部２１及びデータベース１９を有する。
【００３３】
特徴量抽出部１１は、入力画像から局所特徴量を抽出する。局所特徴量としては、ＳＩＦＴ（Scale Invariant Feature Transformation）及び／又はＳＵＲＦ（Speed Up Robustness Features）、又は後述するＰＩＲＦ（Position-Invariant Robust Features）等を使用することができる。
【００３４】
マッチング部１３は、各登録場所と局所特徴量が対応づけられて保存されているデータベース１９を参照し、入力画像と登録場所とのマッチングを求める。データベース１９は、各登録場所毎にその識別情報と、当該登録場所の特徴量の値を対応付けたモデルテーブル１９３を登録場所の個数だけ有する。例えば、モデルテーブルは、６００（Ｍ１〜Ｍ６００）、特徴量の個数は１００（ｐ１＿１〜ｐ１＿１００）等とすることができる。
【００３５】
また、データベース１９は、各登録場所の局所特徴量を使用して作成された、いずれの登録場所にも属さない非登録場所Ｍ０及びその特徴量を有する。ここでは、当該テーブルをモデルテーブル１９１という。非登録場所Ｍ０は、各登録場所の局所特徴量の一部又は全部が対応付けられたものであり、例えば各登録場所の局所特徴量のうち、ランダムに抽出した１０％の特徴量からなるもの等とすることができる。
【００３６】
マッチング部１３は、入力画像が、非登録場所Ｍ０と最もマッチングする場合、当該入力画像とその特徴量を新しい登録場所としてデータベース１９に登録する。このマッチング部１３においては、マッチングスコアは、データベース１９に含まれる登録場所の数及び当該登録場所のうち、入力画像とマッチングした登録場所の数に基づき算出される。ここで、マッチングスコアをｓｔ、データベースに含まれる登録場所の数をｎｔ、当該登録場所のうち、入力画素とマッチングした登録場所の数をｎｗｋ＝Ｍｊ、０＜ｊ＜ｎｔ、ｊ≠ｉ、ｍｉは、入力画像Ｍｔと現在のモデルＭｉとの間でマッチした局所特徴量の数、ｋ、ｉ、ｊ、ｔは整数としたとき、下記式（１）によりマッチングスコアｓｔを求めることができる。
【００３７】
【数５】
0005557189.tif 000006
【００３８】
類似度算出部１５は、マッチングが所定の閾値以上である場合に、選ばれた登録場所の近傍の登録場所を含めて類似度を判定する。この類似度算出部１５は、マッチングスコアと、ガウス分布から得られる遷移確率とに基づき類似度スコアを算出する。ここで、類似度スコアをβｉ、ガウシアンシグマ＝２としたとき、ｉからｋの距離を示す遷移確率をｐＴ（ｉ，ｋ）、考慮する隣接登録画像の数をω、ｉ、ｋを整数とすると、下記式（２）により、類似度スコアβｉを求めることができる。
【００３９】
【数６】
0005557189.tif 000007
【００４０】
ここで、類似度算出部１５は、類似度スコアβを正規化する。正規化することにより、よりノイズにロバストなスコアを取得することができる。本実施の形態においては、類似度スコアをβｉ、類似度スコアの標準偏差及び平均をそれぞれσ及びμ、Ｔ＝σ＋μ、ｉは整数としたとき、正規化スコアＣｉは、下記の式（３）により求めることができる。
【００４１】
【数７】
0005557189.tif 000008
【００４２】
登録場所認定部１７は、類似度が所定の閾値以上である場合に、当該入力画像が登録場所であると認定する。具体的には、類似度算出部１５は、類似度スコアから類似度スコアの標準偏差σと平均値μとの和Ｔを引いた値が所定の閾値τ２より大きい場合、入力画像を前記登録場所であると判定する。
【００４３】
登録場所補正部２１は、登録場所認定部１７の認定結果を補正する。具体的には、登録場所補正部２１は、類似度スコアを正規化した正規化スコアを補正する。
【００４４】
ω＋１≦ｉ≦ｎｔ−（ω＋１）とし、ガウシアンシグマ＝２としたとき、ｉからｋの距離を示す遷移確率をｐＴ（ｉ，ｋ）、考慮する隣接登録画像の数をω、ｉ、ｋを整数とすると、補正スコアＣｊは、下記式（４）により求まる。補正結果に応じて、入力画像がいずれの登録画像に一致するかを補正して求めることができる。
【００４５】
【数８】
0005557189.tif 000009
【００４６】
次に、本実施の形態にかかる位置推定方法について説明する。図２は、本実施の形態にかかる位置推定装置を示すフローチャートである。図２に示すように、特徴量抽出部１１は、先ず入力画像を取得する。特徴量抽出部１１が特徴量として後述するＰＩＲＦを使用する場合には、この入力画像として、連続画像が入力される（ステップＳ１）。そして、類似度算出部１５は、特徴量を抽出する（ステップＳ２）。特徴量抽出部１１は、入力画像から抽出した複数の局所特徴量と入力画像が表わす場所（以下、入力場所という。）とを対応づけたモデルＭｔを生成する（ステップＳ３）。
【００４７】
次に、マッチング部１３は、データベース１９を参照してマッチングスコアＳｔを算出する。先ず、現在のモデル（入力画像モデル）Ｍｔと、データベース１９に登録してある全てのモデルとでマッチングを行う。各モデルにおける各特徴量が所定の閾値以上でマッチングが取れている場合は、マッチングしているものとしてとり扱う。
【００４８】
上述したように、データベース１９は、モデルＭ０のモデルテーブル１９１を有している。これは、各モデルが有する全部又は一部の特徴量をそれぞれ有しているもので、場所が特定できないものである。このモデルＭ０は、例えば他のモデルの３乃至４倍の特徴量を有する。もし入力モデルがこのモデルＭ０と最もマッチングが取れている場合は、入力モデルは新しいモデルとみなされ（ステップＳ５：Ｙｅｓ）、当該入力モデルＭｔを新規の場所としてデータベース１９に追加する（ステップＳ１３，１２）。ここで、モデルテーブル１９１に登録してある特徴量の例えばランダムに５つ抽出して破棄し、新規に登録する入力モデルＭｔの特徴量からランダムに５つ抽出して、モデルＭ０の特徴量の更新を行うことができる。又は、例えば新規の登録場所が例えば３００枚追加になった時点でモデルＭ０の特徴量を全部破棄し、データベースにある各モデルからランダムに例えば３つの特徴量を抽出し、これを合わせてモデルＭ０の特徴量とすることも可能である。
【００４９】
次に、入力モデルＭｔが非登録場所モデルＭ０に類似しない場合について説明する。入力モデルＭｔと各モデルの特徴量を比較するが、例えば、東京タワーのような、広範囲の場所から認識できるような特徴量は、その場所固有の特徴量としては、精度の低いものとなる。すなわち、入力モデルのある特徴量のうち、データベース１９の６００の登録モデルのうちの例えば１０％と一致してしまうような特徴量は、識別力が低いものと言える。一方で、入力モデルのある特徴量が、ある登録モデル１つの特徴量と一致する場合、その特徴量は識別能力が高いと見なすことができる。
【００５０】
これらを考慮して、各特徴量についてマッチングを取りつつ、識別力の高い特徴量のマッチングには高いスコアを、識別力の弱い特徴量のマッチングには低いスコアを付与する。このため、本実施の形態においては、下記式（１）を使用する。この式（１）に示すように、入力画素とマッチングした登録場所の数をｎｗｋが多いほどスコアＳｔが小さくなることがわかる。
【００５１】
【数９】
0005557189.tif 000010
【００５２】
次に、このスコアＳｔの最大値が所定の閾値τより大きいか否かを判定する（ステップＳ６）。ここで、スコアＳｔの最大値がＭ０ではなかったとしても、所定の閾値τより小さい場合は、入力画像モデルは登録モデルとマッチングしていないと判断し、ステップＳ１３に進み、当該入力画像モデルＭｔを新規の場所として登録する（ステップＳ１２）。所定の閾値τは例えば、３等とすることができる。
【００５３】
ここで、このスコアＳｔは、非常にセンシティブでありノイズに敏感である。そこで、このスコアＳｔから、隣接する登録モデルのデータを使用して別のスコアを求める。このスコアを、本明細書においては、類似度スコアβという。上述したように、類似度スコアβは、式（２）により求まる（ステップＳ７）。
【００５４】
【数１０】
0005557189.tif 000011
【００５５】
次に、この類似度スコアを正規化する。いくつの特徴量がマッチすればよいかを予測することは困難である。したがって、例えば隣接する登録モデルとの間でよい類似度スコアが得られていたとしても、最もマッチする登録モデルと、これに類似する登録モデルがある場合、特徴量の多くが共通となるため、類似度スコアが当該類似する登録モデルとの方が高くなる場合があり得る。したがって、類似度スコアは正規化されなければならない。本実施の形態においては、上述のように正規化スコアは、式（３）により求める。
【００５６】
【数１１】
0005557189.tif 000012
【００５７】
図３は、正規化前後の類似度スコア及び正規化スコアを示す図である。図３（ａ）に示すように、１５個の類似度スコアを正規化に使用する。ここで、ｌｎを、考慮する隣接登録モデルの個数とし、ｌｎ＝７として、１５個の類似度スコアを使用する例を示している。標準偏差σ及びその平均μの合計をＴで示す。ｌｎは、値Ｔを算出する際の制限として利用する。これは、登録モデル全体において、Ｔは非常に幅のある数であるためである。なお、ｌｎの値は、結果に大きな影響を及ぼすものではないが、Ｔを毎回計算するにあたり、同じスケールに確定するために使用するものである。正規化スコアを図３（ｂ）に示す。なお、正規化はスコアのトレンドをきれいな正規分布の形になるように修正する。
【００５８】
そして、類似度スコアβ−Ｔが所定の閾値τ２より大きいか判定する（ステップＳ８）。ここで、β−Ｔが閾値τ２より小さかった場合は、ステップＳ１１に進み、当該入力画像モデルは、登録場所とマッチングしないと判断し、ステップＳ１２に進み、当該入力画像モデルを新たな登録場所モデルとして登録する。以上により、入力画像を登録画像のいずれかに一致するものと判断してもよいが、本実施の形態においては、更に、ここで求められた登録場所を更に補正する。
【００５９】
図４は、補正前後のマッチングスコアを示す図である。図４（ａ）は、最大スコアＣｊ，ｊ＝８７を示す。ここで、マッチングスコアは、左右対称であることが好ましいため、これを上述した式（４）で補正し補正スコアＣｊを求める。
【００６０】
【数１２】
0005557189.tif 000013
【００６１】
これにより、図４（ｂ）に示すように、Ｃｊ，ｊ＝８７に補正される。なお、このように入力画像は、登録画像モデルＭ８７に一致すると判定した場合、入力画像モデルはそのまま破棄することも可能であるが、登録画像モデルＭ８７を更新することも可能である。例えば、いくつかの特徴量を入れ替えたり、平均してもよい。
【００６２】
次に、特徴量抽出部について詳細に説明する。上述したように、特徴量としては、局所特徴量であれば、どのようなものでも使用可能であるが、本願発明者等が先に出願しているＰＩＲＦを使用することで、位置推定確率を向上させることができる。
【００６３】
図５は、本発明の実施の形態にかかる位置推定装置の特徴量抽出部を示す図である。本実施の形態における特徴量抽出部は、連続して撮影された連続画像からなる入力画像から不変特徴量を抽出する。
【００６４】
特徴量抽出部１１は、入力画像それぞれから、局所特徴量を抽出する局所特徴量抽出部１１１と、局所特徴量抽出部１１１により抽出された局所特徴量について、連続する入力画像間でマッチングをとる特徴量マッチング部１１３と、特徴量マッチング部１１３により所定数連続する画像間でマッチングが取れた特徴量を連続特徴量として選択する連続特徴量選択部１１５と、各連続特徴量の平均を不変特徴量として求める不変特徴量算出部１１７とを有する。
【００６５】
以下の説明においては、不変特徴量算出部１１７が抽出する不変特徴量のことを、特徴量ＰＩＲＦ（Position-Invariant Robust Features）という。特徴量抽出部１１は、撮影位置の変化に影響を受けにくい（局所）特徴量として特徴量ＰＩＲＦを抽出する。
【００６６】
これは、本願発明者が位置の変化にロバストな特徴量を抽出すべく鋭意実験研究した結果、近くの対象については撮影位置や撮影時間帯の変化による見え方の差（特徴量変化）が大きいが、遠くの対象については変化が小さい（ランドマークの特徴量はあまり変化しない）ことを知見し、その結果本特徴量ＰＩＲＦを抽出する方法を見出したものである。
【００６７】
本実施の形態にかかる特徴量抽出部１１は、簡単には、連続画像間で局所特徴のマッチングを行い、予め定めた枚数間で、連続してマッチングのとれている特徴を選択し、選択された特徴において、それとマッチングのとれている全特徴の平均を特徴量ＰＩＲＦとして抽出・記述するものである。
【００６８】
この特徴量抽出部１１により撮影位置の変化に頑健な局所特徴のみを抽出・記述することができる。また、記述子としては、局所特徴であれば様々なものが適用可能であり、上述のように既存の局所特徴量を用いることで、既存の特徴量が持つ性能もそのまま引き継がれ、照明変化等にも頑健な特徴として抽出・記述することが可能となる
【００６９】
以下、各ブロックについて詳細に説明する。図６は、本実施の形態にかかる特徴量ＰＩＲＦを抽出する方法を説明する図である。局所特徴量抽出部１１１には、連続して撮影された連続画像が入力画像として入力される。ここで、ＰＩＲＦで要求される連続画像とは、ある画像セットであって、一定のフレームで、例えば１秒毎に２フレームなど、毎秒毎に連続的に撮影されたビデオ画像をいう。すなわち、ビデオからキャプチャされた画像は一般的に連続的であり、ＰＩＲＦにおける連続画像は、ビデオ画像を使用したものでなければならない。画像の取得率は、カメラの速度に応じて設定される。たとえば、カメラが車に搭載されていた場合、カメラの速度は１分間に約１０００ｍ／分であり、ビデオからキャプチャされる連続画像はおよそ５０乃至１００フレーム／秒となる。
【００７０】
本実施の形態においては、入力画像として全方位画像を用い、連続する画像は、１つのプレイス（place）を撮影したものを使用する。後述するように、このプレイスとは、例えば交差点から交差点までのある領域とする。当該プレイスは、いくつかの連続画像からなる複数のサブプレイスに分割される。すなわち、１つのプレイスは、複数のサブプレイスから構成される。このサブプレイス毎に１又は複数の不変特徴量を抽出する。この不変特徴量の集合をサブプレイスＰＩＲＦ辞書（PIRF-dictionary）という。１つのプレイスから抽出された全不変特徴量の集合、すなわち、上記サブプレイスＰＩＲＦ辞書の集合によりＰＩＲＦ辞書が構成される。１つのプレイスには１つのＰＩＲＦ辞書が対応する。このサブプレイスＰＩＲＦ辞書及びＰＩＲＦ辞書が抽出されたプレイスの識別情報が、ＰＩＲＦ辞書と共に上述のエリアデータベース１１に格納される。
【００７１】
先ず、局所特徴量抽出部１１１は、既存の局所特徴量抽出方法を使用して局所特徴量を抽出する。局所特徴量抽出部１１１は、例えば、ＳＩＦＴ（Scale Invariant Feature Transformation）、又はＳＵＲＦ（Speed Up Robustness Features）の特徴量を使用することができる。または、これらＳＩＦＴやＳＵＲＦに限らず、他の局所特徴量を使用することができることは勿論である。特に、スケール、回転の変動、又はノイズ等に対してロバストな他の局所特徴量を用いることが好ましい。これらの局所特徴量を用いることで、既存の特徴量が有する性能もそのまま引き継がれ、照明変化等にも頑健な特徴として抽出・記述することが可能となる。ここで、ｉ番目のエリアにおける全方位画像の数をｎｉとし、その中でｊ番目の画像から抽出された局所特徴量の集合をＵｊｉとする。ここでは、局所特徴量はｕ→で表す。
【００７２】
次に、特徴量マッチング部１１３が、連続する２枚の画像間全てについて局所特徴量ｕ→を構成する各特徴量のマッチングを行う。すなわち、ｊ＝ｑ番目の画像の全局所特徴量について、ｊ＝ｑ＋１番目の画像の全局所特徴量に対してマッチングを行う。ここでは、それぞれマッチングのとれた特徴へのインデックスをマッチング結果ベクトルｍｑｉ→として求める。
【００７３】
ここで、マッチング方法の一例について、ＳＩＦＴを例にとって説明する。画像Ｉａから抽出される特徴をｖとする。この特徴ｖが次の画像Ｉａ＋１の特徴ｖ'とマッチングするか否かを判定する。先ず、特徴ｖと画像Ｉａ＋１から抽出した全ての特徴との間のドット積（dot product）を求める。そして、最も類似する特徴ｖｆｉｒｓｔと、２番目に類似する特徴ｖｓｅｃｏｎｄを求めるために、この結果をソートする。もし、
（ｖｆｉｒｓｔ・ｖ）／（ｖｓｅｃｏｎｄ・ｖ）＞θ
が成立する場合、マッチングのとれた特徴ｖ'＝ｖｆｉｒｓｔと判定する。ここで、閾値θはたとえば０．６とすることができる。上記が成立しない場合は、画像Ｉａにおける特徴ｖにマッチングする特徴は、画像Ｉａ＋１には存在しないと判定する。
【００７４】
図６に示すように、各入力画像から６つの局所特徴量が抽出された場合について説明する。これら６つの局所特徴量間でマッチングを取り、マッチングが取れた場合にのみ、マッチングが取れた特徴量へのインデックスを付す。例えば、ｍ１ｉ→の１番目の局所特徴量は、ｍ２ｉ→の３番目の局所特徴量とマッチングがとれていることを示し、ｍ２ｉ→の３番目の特徴量は、ｍ３ｉ→の６番目の特徴量とマッチングが取れていることを示す。
【００７５】
次に、連続特徴量選択部１１５が連続特徴量を選択する。先ず、いくつのｍｑｉ→を使用して連続特徴量を求めるかを決定する。このｍｑｉ→の数を、本明細書においては、ウィンドウサイズｗともいう。また、このウィンドウサイズｗに含まれるｍｑｉ→の集合を、サブプレイスという。ここで、ウィンドウサイズｗが大きいほどより頑健な、識別力の高い連続特徴量のみを抽出できるが、大きすぎると特徴数が極端に少なくなってしまう。また、小さすぎると、頑健ではない、識別力のないような特徴量も抽出してしまうので、目的等に応じて最適な大きさとする必要がある。
【００７６】
本実施の形態においては、ウィンドウサイズｗを３とする。したがって、連続する４枚の入力画像を使用して連続特徴量を求める。すなわち、図６に示すように、１番目のサブプレイスには、ｍ１ｉ→、ｍ２ｉ→、ｍ３ｉ→が含まれ、入力画像Ｉ１、Ｉ２、Ｉ３、Ｉ４が対応する。なお、インデックスの数が０の場合は、次にマッチングする特徴量がないことを示す。よって、図６の場合、１番目のサブプレイスには、３つの連続特徴量が含まれることになる。
【００７７】
連続特徴量選択部１１５は、ウィンドウサイズｗを設定したらこのウィンドウｗをひとつずつずらしながら、そのウィンドウサイズに含まれる全方位画像４枚内で共通して出現する特徴を連続特徴量として抽出する。ウィンドウサイズｗを設定したら、連続特徴量を抽出するために用いる関数を以下のように定義する。ただし、ｂは注目するインデックスベクトルの番号とする。
【数１３】
0005557189.tif 000014
そして、全てのマッチング結果ベクトルｍｑｉ→について、ｆ（ｍｘ,ｙｉ）を計算し、ｆ（ｍｘ,ｙｉ）＞０となるときの局所特徴量ｕｘ,ｙｉ→のみを抽出する。入力画像の数がｎｉ、ウィンドウサイズがｗのとき、サブプレイスの数は、ｎｉ−ｗ＋１となる。
【００７８】
不変特徴量算出部１１７は、同一ウィンドウグループであるサブプレイス内においてマッチングがとれた局所特徴量の平均を求める。これらの平均値からなるベクトルによりＰＩＦＲ辞書が構成される。全サブプレイス（ｎｉ−ｗ＋１）個から抽出された（ｎｉ−ｗ＋１）個のサブプレイスＰＩＦＲ辞書（Ｄｊｉ，ｊ≦ｎｉ−ｗ＋１）をＰＩＲＦ辞書（Ｄｉ）に登録する。このＰＩＦＲ辞書を構成する、マッチングがとれた局所特徴量の平均各がＰＩＲＦである。
【００７９】
次に、特徴量抽出部の不変特徴量ＰＩＦＲの抽出方法について説明する。図７は、不変特徴量抽出方法を示すフローチャートである。先ず、ｉ＝１、ｊ＝１に初期化する（ステップＳ２１）。ここで、ｎｉは、プレイスＡｊに属する画像の枚数であり、ｗは、ＰＩＲＦを抽出するウィンドウサイズである。
【００８０】
次に、エリアＡｊの画像Ｉｉを入力する（ステップＳ２２）。そして、ｉがウィンドウサイズｗより大きいか否かを判定する（ステップＳ２３）。ｉがウィンドウサイズｗ以下である場合は、ｉをインクリメントし（ステップＳ３０）、ステップＳ２に戻る。
【００８１】
一方、ウィンドウサイズｗより大きい場合は、画像Ｉｉと画像Ｉｉ−１の間でマッチングを取る（ステップＳ２４）。そして、ｗ＋１枚の連続する入力画像（Ｉｉ−ｗ，…，Ｉｉ）から安定している局所特徴量（ＳＩＦＴ）を抽出する（ステップＳ２５）。ここで、本実施の形態においては、ウィンドウサイズｗを３に設定している。ウィンドウサイズｗは、何枚の連続画像からＰＩＲＦを抽出するかを示す。たとえば、ウィンドウサイズｗを３に設定した場合、ＰＩＲＦは４つの連続画像に連続して現れる特徴があるときにのみ得られる。従って、あるプレイスＡの画像イメージが４枚より少ない場合、３つの２画像間で一致する特徴を見つけるのに十分ではない。よって、画像が少なくとも４枚であるとき、プレイスＡからのＰＩＲＦの抽出をスタートすることができる。例えば、現在の画像がＩ６であるとき、ＰＩＲＦは、４枚の連続画像I３、Ｉ４、Ｉ５、Ｉ６から求めることができる。
【００８２】
次に、抽出した安定した局所特徴量の平均をＰＩＲＦとして算出する（ステップＳ２６）。次いで、エリアＡｊに含まれるＰＩＲＦを収集し、ＰＩＲＦ辞書Ｄｊに登録する（ステップＳ２７）。そして、ｉ＝ｎｊであるか否かが判断され（ステップＳ２８）、ｉ＝ｎｊであれば、ｉ＝１、ｊ＝ｊ＋１とし、ステップＳ２からの処理を繰り返す（ステップＳ２９）。ｉ＝ｎｊではない場合は、ステップＳ１０に進み、ｉをインクリメントして、ステップＳ２に戻る。
【００８３】
次に、本実施の形態の効果について説明する。図８乃至図１１は、本実施の形態にかかる位置推定装置の推定結果を示すものである。図８乃至図１１は、それぞれ、New College、City Center、Suzukakedai、混合モデルの位置推定結果を示す。図８に示すように、スケールを０．２５としたものでさえも、他の位置推定方法であるＦＡＢ−ＭＡＰよりよい精度を示していることがわかる。その他の結果についても、ＦＡＢ−ＭＡＰより極めて精度よく場所を特定できていることがわかる。
【００８４】
以上説明したように、本実施の形態においては、入力画像と登録画像のマッチングを取った後、登録場所の近傍の登録場所を含めて類似度を算出し、それを正規化して、入力画像がいずれの登録場所に一致するかを判定するため、極めて正確に、入力画像が既にデータベースに登録された登録場所であるか、初めて認識した画像であるかの切り分けを行うことができる。また、登録画像を一致しない入力画像は、そのままデータデータベースに登録することで、自律型の移ロボット装置等に搭載すれば、自己の位置を探索し、位置データベースを自身で拡大させることも可能である。
【００８５】
なお、本発明は上述した実施の形態のみに限定されるものではなく、本発明の要旨を逸脱しない範囲において種々の変更が可能であることは勿論である。
【００８６】
例えば、上述の実施の形態では、ハードウェアの構成として説明したが、これに限定されるものではなく、任意の処理を、ＣＰＵ（Central Processing Unit）にコンピュータプログラムを実行させることにより実現することも可能である。プログラムは、様々なタイプの非一時的なコンピュータ可読媒体（non-transitory computer readable medium）を用いて格納され、コンピュータに供給することができる。非一時的なコンピュータ可読媒体は、様々なタイプの実体のある記録媒体（tangible storage medium）を含む。非一時的なコンピュータ可読媒体の例は、磁気記録媒体（例えばフレキシブルディスク、磁気テープ、ハードディスクドライブ）、光磁気記録媒体（例えば光磁気ディスク）、ＣＤ−ＲＯＭ（Read Only Memory）、ＣＤ−Ｒ、ＣＤ−Ｒ／Ｗ、半導体メモリ（例えば、マスクＲＯＭ、ＰＲＯＭ（Programmable ROM）、ＥＰＲＯＭ（Erasable PROM）、フラッシュＲＯＭ、ＲＡＭ（random access memory））を含む。また、プログラムは、様々なタイプの一時的なコンピュータ可読媒体（transitory computer readable medium）によってコンピュータに供給されてもよい。一時的なコンピュータ可読媒体の例は、電気信号、光信号、及び電磁波を含む。一時的なコンピュータ可読媒体は、電線及び光ファイバ等の有線通信路、又は無線通信路を介して、プログラムをコンピュータに供給できる。
【符号の説明】
【００８７】
１１  特徴量抽出部
１３  マッチング部
１５  類似度算出部
１７  登録場所認定部
１９  データベース
２１  登録場所補正部
１９３  モデルテーブル
１９１  モデルテーブル
１１１  局所特徴量抽出部
１１３  特徴量マッチング部
１１５  連続特徴量選択部
１１７  不変特徴量算出部
【図１】
0005557189.tif 000019
【図２】
0005557189.tif 000020
【図５】
0005557189.tif 000021
【図６】
0005557189.tif 000022
【図７】
0005557189.tif 000023
【図３】
0005557189.tif 000024
【図４】
0005557189.tif 000025
【図８】
0005557189.tif 000026
【図９】
0005557189.tif 000027
【図１０】
0005557189.tif 000028
【図１１】
0005557189.tif 000029