特許 7286388 位置推定システム、位置推定装置、位置推定方法、及びプログラム

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】特許公報(B2)

(11)【特許番号】

(24)【登録日】2023-05-26

(45)【発行日】2023-06-05

(54)【発明の名称】位置推定システム、位置推定装置、位置推定方法、及びプログラム

(51)【国際特許分類】

   G06T 7/70 20170101AFI20230529BHJP

   G01C 15/00 20060101ALI20230529BHJP

   G01C 11/04 20060101ALI20230529BHJP

   G06T 7/00 20170101ALI20230529BHJP

【ＦＩ】

G06T7/70 A

G01C15/00 101

G01C11/04

G06T7/00 300F

【請求項の数】 7

(21)【出願番号】P 2019075141

(22)【出願日】2019-04-10

(65)【公開番号】P2020173617

(43)【公開日】2020-10-22

【審査請求日】2022-02-02

(73)【特許権者】

【識別番号】000002299

【氏名又は名称】清水建設株式会社

(74)【代理人】

【識別番号】100149548

【弁理士】

【氏名又は名称】松沼 泰史

(74)【代理人】

【識別番号】100161506

【弁理士】

【氏名又は名称】川渕 健一

(74)【代理人】

【識別番号】100161207

【弁理士】

【氏名又は名称】西澤 和純

(72)【発明者】

【氏名】ファム フック

【審査官】小太刀 慶明

(56)【参考文献】

【文献】特開２０１５－１８４０５４（ＪＰ，Ａ）

【文献】特開２０１７－１２９５６７（ＪＰ，Ａ）

【文献】島岡 弘正 外，全方位カメラの色相情報を用いたＬＲＦによるロボットの自己位置推定の拡張，映像情報メディア学会技術報告 ITE Technical Report，Vol. 35, No. 47，2011年11月18日，pp. 13-16

(58)【調査した分野】(Int.Cl.，ＤＢ名)

Ｇ０６Ｔ ７／００

Ｇ０１Ｃ １５／００

Ｇ０１Ｃ １１／０４

(57)【特許請求の範囲】

【請求項1】

単眼による撮像装置と、
現実空間を所定の特徴種別による特徴量で表した特徴量空間を示す特徴量地図を記憶する記憶部と、
前記撮像装置により撮像して得られた撮像画像の特徴量を示す参照画像と、前記特徴量地図の特徴量空間における座標と角度とにより設定した投影中心ごとに応じて生成される投影画像とを比較した結果に基づいて、前記撮像装置に対応する位置を推定する位置推定部とを備え、
前記記憶部は、それぞれ異なる現実空間の範囲をそれぞれ異なる所定の特徴種別による特徴量で表した特徴量空間を示す複数の特徴量地図を記憶し、
前記位置推定部は、前記複数の特徴量地図ごとに応じて生成される投影画像と、比較対象の投影画像と同じ特徴種別の特徴量による参照画像とをそれぞれ比較した結果に基づいて、前記撮像装置に対応する位置を推定する
位置推定システム。

【請求項2】

前記特徴種別の１つは、画像から抽出した特定の物体についてのエッジの情報である
請求項１に記載の位置推定システム。

【請求項3】

前記特徴種別の１つは、画像から抽出した特定の物体についての色の情報である
請求項１または２に記載の位置推定システム。

【請求項4】

前記記憶部は、同じ現実空間をそれぞれ異なる所定の特徴種別による特徴量で表した複数の特徴量地図を記憶し、
前記位置推定部は、前記複数の特徴量地図ごとに応じて生成される投影画像と、比較対象の投影画像と同じ特徴種別の特徴量による参照画像とをそれぞれ比較した結果に基づいて、前記撮像装置に対応する位置を推定する
請求項１から３のいずれか一項に記載の位置推定システム。

【請求項5】

単眼による撮像装置により撮像して得られた撮像画像の特徴量を示す参照画像と、現実空間を所定の特徴種別による特徴量で表した特徴量地図が示す特徴量空間において座標と角度とにより設定した投影中心ごとに応じて生成される投影画像とを比較した結果に基づいて、前記撮像装置に対応する位置を推定する位置推定部であって、
それぞれ異なる現実空間の範囲をそれぞれ異なる所定の特徴種別による特徴量で表した特徴量空間を示す複数の特徴量地図ごとに応じて生成される投影画像と、比較対象の投影画像と同じ特徴種別の特徴量による参照画像とをそれぞれ比較した結果に基づいて、前記撮像装置に対応する位置を推定する位置推定部
を備える位置推定装置。

【請求項6】

単眼による撮像装置により撮像して得られた撮像画像の特徴量を示す参照画像と、現実空間を所定の特徴種別による特徴量で表した特徴量地図が示す特徴量空間において座標と角度とにより設定した投影中心ごとに応じて生成される投影画像とを比較した結果に基づいて、前記撮像装置に対応する位置を推定する位置推定ステップであって、
それぞれ異なる現実空間の範囲をそれぞれ異なる所定の特徴種別による特徴量で表した特徴量空間を示す複数の特徴量地図ごとに応じて生成される投影画像と、比較対象の投影画像と同じ特徴種別の特徴量による参照画像とをそれぞれ比較した結果に基づいて、前記撮像装置に対応する位置を推定する位置推定ステップ
を備える位置推定方法。

【請求項7】

コンピュータを、
単眼による撮像装置により撮像して得られた撮像画像の特徴量を示す参照画像と、現実空間を所定の特徴種別による特徴量で表した特徴量地図が示す特徴量空間において座標と角度とにより設定した投影中心ごとに応じて生成される投影画像とを比較した結果に基づいて、前記撮像装置に対応する位置を推定する位置推定部であって、
それぞれ異なる現実空間の範囲をそれぞれ異なる所定の特徴種別による特徴量で表した特徴量空間を示す複数の特徴量地図ごとに応じて生成される投影画像と、比較対象の投影画像と同じ特徴種別の特徴量による参照画像とをそれぞれ比較した結果に基づいて、前記撮像装置に対応する位置を推定する位置推定部
として機能させるためのプログラム。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、位置推定システム、位置推定装置、位置推定方法、及びプログラムに関する。

【背景技術】

【0002】

車両やロボット等の移動体の自己位置（向きも含む）を推定する技術として、Ｖｉｓｕａｌ ＳＬＡＭ（Simultaneous Localization And Mapping）が知られている。Ｖｉｓｕａｌ ＳＬＡＭは、撮像装置（カメラ）により撮像して得られた画像から特徴点を抽出し、抽出された特徴点を加工して三次元点群を生成するとともに撮像装置の位置姿勢を推定する（例えば、非特許文献１参照）。

【先行技術文献】

【非特許文献】

【0003】

【文献】Jun SHIMAMURA, Masashi MORIMOTO, and Hideki KOIKE, "Robust vSLAM for dynamic scenes", Proc.12th IAPR Conference on Machine Vision Applications, June 2011, p.344-347

【発明の概要】

【発明が解決しようとする課題】

【0004】

しかしながら、上記のようなＶｉｓｕａｌ ＳＬＡＭの技術では、一般にステレオカメラを用いて視差の異なる立体視の撮像画像を得るようにされていることから、ハードウェアの小型化や低コスト化が難しい。単眼の撮像装置を用いて位置推定を行うＶｉｓｕａｌ ＳＬＡＭの技術も知られている。しかしながら、単眼の撮像装置により撮像された二次元画像から高い精度の三次元点群を生成することが難しいことから、良好な精度で位置推定を行うことが難しい。

【0005】

本発明は、このような事情に鑑みてなされたもので、単眼の撮像装置により撮像される二次元の撮像画像を用いながらも良好な精度で位置推定を行えるようにすることを目的とする。

【課題を解決するための手段】

【0006】

上述した課題を解決する本発明の一態様は、単眼による撮像装置と、現実空間を所定の特徴種別による特徴量で表した特徴量空間を示す特徴量地図を記憶する記憶部と、前記撮像装置により撮像して得られた撮像画像の特徴量を示す参照画像と、前記特徴量地図の特徴量空間に設定した投影中心に応じて生成される投影画像とを比較した結果に基づいて、前記撮像装置に対応する位置を推定する位置推定部とを備える位置推定システムである。

【0007】

また、本発明の一態様は、単眼による撮像装置により撮像して得られた撮像画像の特徴量を示す参照画像と、現実空間を所定の特徴種別による特徴量で表した特徴量地図が示す特徴量空間に設定した投影中心に応じて生成される投影画像とを比較した結果に基づいて、前記撮像装置に対応する位置を推定する位置推定部を備える位置推定装置である。

【0008】

また、本発明の一態様は、単眼による撮像装置により撮像して得られた撮像画像の特徴量を示す参照画像と、現実空間を所定の特徴種別による特徴量で表した特徴量地図が示す特徴量空間に設定した投影中心に応じて生成される投影画像とを比較した結果に基づいて、前記撮像装置に対応する位置を推定する位置推定ステップを備える位置推定方法である。

【0009】

また、本発明の一態様は、コンピュータを、単眼による撮像装置により撮像して得られた撮像画像の特徴量を示す参照画像と、現実空間を所定の特徴種別による特徴量で表した特徴量地図が示す特徴量空間に設定した投影中心に応じて生成される投影画像とを比較した結果に基づいて、前記撮像装置に対応する位置を推定する位置推定部として機能させるためのプログラムである。

【発明の効果】

【0010】

以上説明したように、本発明によれば、単眼の撮像装置により撮像される二次元の撮像画像を用いながらも良好な精度で位置推定を行えるようになるという効果が得られる。

【図面の簡単な説明】

【0011】

【図1】第１実施形態における位置推定システムの構成例を示す図である。

【図2】第１実施形態における位置推定の手法例を説明する図である。

【図3】第１実施形態における位置推定装置が実行する処理手順例を示すフローチャートである。

【図4】第２実施形態における位置推定の手法例を説明する図である。

【発明を実施するための形態】

【0012】

＜第１実施形態＞
図１は、本実施形態の位置推定システム１の構成例を示している。同図の位置推定システム１は、撮像装置１００、位置推定装置２００、及び情報出力装置３００を備える。
本実施形態の位置推定システムは、例えば車両やロボット等の移動体に備えられる。また、例えば移動体には撮像装置１００と情報出力装置３００が備えられ、位置推定装置２００としての機能がクラウドサーバ等に備えられた構成であってもよい。この場合には、移動体の撮像装置１００と情報出力装置３００とを、無線経由でクラウドサーバと通信可能に接続して構成される。また、情報出力装置３００を、移動体とは別の場所に備えるようにしてもよい。

【0013】

撮像装置１００は、撮像を行う。本実施形態の撮像装置１００は、例えばステレオカメラなどのようなものではなく、単眼によるものである。

【0014】

位置推定装置２００は、撮像装置１００により撮像して得られた画像（撮像画像）を利用して位置を推定する装置である。本実施形態において推定の対象となる「位置」は、空間における点としての座標と、当該座標を基点とする方向を含む。
位置推定装置２００は、機能部として、入出力インターフェース部２０１、情報処理部２０２、及び記憶部２０３を備える。

【0015】

入出力インターフェース部２０１は、位置推定装置２００と外部との情報の入出力を行う部位である。撮像装置１００が出力する撮像画像は、入出力インターフェース部２０１が入力し、情報処理部２０２に渡すようにされる。
また、情報処理部２０２が出力した画像、音声等の情報は、入出力インターフェース部２０１から情報出力装置３００に出力される。

【0016】

情報処理部２０２は、自己の位置（自己位置）の推定に関する情報処理を実行する。情報処理部２０２としての機能は、位置推定装置２００において備えられるＣＰＵ（Central Processing Unit）が、プログラムを実行することにより実現される。同図の情報処理部２０２は、位置推定部２２１を備える。
位置推定部２２１は、撮像装置１００に対応する位置を推定する。つまり、位置推定部２２１は、撮像装置１００が備えられる移動体の位置を推定する。

【0017】

記憶部２０３は、位置推定装置２００に対応する各種の情報を記憶する。本実施形態の記憶部２０３は、第１特徴量地図記憶部２３１を備える。第１特徴量地図記憶部２３１は第１特徴量地図を記憶する。「特徴量地図」は、現実空間を所定の特徴量種別による特徴量で表した特徴量空間の情報である。本実施形態における第１特徴量地図がどのような特徴量種別の特徴量によるものであるのかについては後述する。
また、第２特徴量地図記憶部２３２は、第２実施形態に対応する記憶部であることから、ここでの説明は省略する。

【0018】

情報出力装置３００は、位置推定装置２００から出力された情報を出力する。情報出力装置３００は、表示装置であってもよいし、音声出力装置であってもよいし、印刷装置であってもよい。

【0019】

図２を参照して、本実施形態の位置推定システム１による位置推定の手法例について説明する。
同図においては、現実空間ＲＷＳが示されている。同図では、街区環境を現実空間ＲＷＳとした例が示されている。このような街区環境としての現実空間ＲＷＳにおいては、建造物ＢＬ、看板、標識等のランドマークＬＭ、街路樹や植栽された草木などとしての植栽物ＰＬ等が存在する。

【0020】

現実空間ＲＷＳにおいて、移動体に備えられる撮像装置１００が、或る空間内の位置（座標）にて或る撮像方向により撮像を行う。これにより、撮像装置１００の投影中心Ｃ１を原点とする投影面に対応する撮像画像ＰＩが得られる。

【0021】

位置推定装置２００における位置推定部２２１は、撮像画像ＰＩを取得する。位置推定部２２１は、取得した撮像画像ＰＩから所定の特徴種別による特徴量を抽出した特徴量画像を生成する。本実施形態における特徴量は、建造物ＢＬのエッジである。建造物ＢＬの形状は、一般に平面の組み合わせとなるものが多く、角部の輪郭も明確であることから、エッジとしての特徴量により表現しやすい。
位置推定部２２１は、撮像画像ＰＩについて画像認識処理を行うことで撮像画像ＰＩにおける建造物ＢＬを認識し、認識した建造物ＢＬを対象にエッジ検出を行うことで、撮像画像ＰＩにおける建造物ＢＬのエッジが示される特徴量画像を生成することができる。位置推定部２２１は、このように生成される特徴量画像を参照画像（基準画像）ＰＲＦとして扱う。

【0022】

本実施形態の第１特徴量地図記憶部２３１が記憶する第１特徴量地図は、例えば、同図の現実空間ＲＷＳとしての街区環境に存在する建造物ＢＬについてエッジ検出を行い、検出されたエッジとしての特徴量により表される特徴量空間の情報として生成されたものである。
同図には、第１特徴量地図が反映された特徴量空間ＶＲＳが示されている。特徴量空間ＶＲＳにおいては、第１特徴量地図において示される建造物ＢＬのエッジにより形成される特徴量群ＧＦＴが存在する。
位置推定部２２１は、同図の特徴量空間ＶＲＳにおいて、座標（ｘ，ｙ）と角度（θ）との組み合わせごとに対応して投影中心Ｃ２を設定し、特徴量空間ＶＲＳにおいて、設定された投影中心Ｃ２ごとの投影面に対応する投影画像ＰＰＲを生成する。このような投影画像ＰＰＲには、投影中心Ｃ２の座標（ｘ，ｙ）と角度（θ）に応じて投影面内に収まる建造物ＢＬのエッジが含まれることになる。なお、投影中心Ｃ２の座標はｘ軸座標、ｙ軸座標、及びｚ軸座標による三次元座標として表されてもよい。
位置推定部２２１は、このように生成された複数の投影画像ＰＰＲを、参照画像ＰＲＦと比較する比較対象画像ＰＣＭとして扱う。

【0023】

なお、第１特徴量地図記憶部２３１は、予め生成された投影画像ＰＰＲと、対応の投影中心Ｃ２（座標（ｘ，ｙ）、角度θ）とを紐付けた情報を、第１特徴量地図として記憶してもよい。

【0024】

位置推定部２２１は、参照画像ＰＲＦと複数の比較対象画像ＰＣＭとを比較し、比較結果に基づいて、撮像装置１００が対応する位置を推定する。
このため、例えば位置推定部２２１は、参照画像ＰＲＦと比較対象画像ＰＣＭの相関についての分布を求めるようにされてよい。具体的例として、位置推定部２２１は、参照画像ＰＲＦと比較対象画像ＰＣＭのそれぞれとを比較することにより、比較対象画像ＰＣＭごとに参照画像ＰＲＦとの類似度を求める。位置推定部２２１は、比較対象画像ＰＣＭごとの投影中心Ｃ２（ｘ，ｙ，θ）に対する類似度のヒストグラム（確率分布）を生成する。位置推定部２２１は、生成された確率分布に基づいて、参照画像ＰＲＦに最も近似する比較対象画像ＰＣＭが対応する投影中心Ｃ２（ｘ，ｙ，θ）を選択する。
選択された投影中心Ｃ２は、特徴量空間ＶＲＳ内の座標と方向を示す。特徴量空間ＶＲＳ内の座標と方向は、現実空間ＲＷＳにおける座標と方向とに対応付けられている。そこで、位置推定部２２１は、選択された投影中心Ｃ２（ｘ，ｙ，θ）を、現実空間ＲＷＳにおける位置に変換する。このようにして求められた位置は、現実空間ＲＷＳにおける撮像装置１００の投影中心Ｃ２の位置である。投影中心Ｃ２は、撮像装置１００が搭載された移動体に対応する位置となる。このようにして本実施形態の位置推定システムは、移動体の自己位置を推定することができる。

【0025】

このような本実施形態の位置推定システム１による自己位置の推定手法であれば、参照画像ＰＲＦは立体視によるものでなくともよい。このため、撮像装置１００については単眼のものを採用できる。
そのうえで、本実施形態の位置推定システム１では、特徴量地図を予め記憶しておき、撮像画像から生成した特徴量画像としての参照画像ＰＲＦと、特徴量地図から生成した投影画像による比較対象画像ＰＣＭとを比較するようにされている。即ち、本実施形態の位置推定システム１は、Ｖｉｓｕａｌ ＳＬＡＭのように三次元点群を用いない。単眼の撮像装置により撮像された画像から生成される三次元点群については精度が十分でないことから、位置推定の精度が低下する。これに対して、本実施形態の位置推定システム１は、特徴量地図を利用することで、三次元点群の利用を不要としている。これにより、本実施形態の位置推定システム１は、撮像装置１００として単眼によるものを用いながらも、良好な精度で移動体の自己位置の推定を行うことが可能になる。
また、ＳＬＡＭ等の技術では、予め用意した三次元点群地図を用いるのであるが、三次元点群地図の作成、管理には相当のコストや手間を要する。本実施形態の位置推定システム１において予め用意される特徴量地図は、例えば建造物ＢＬのエッジとしての特徴量を示すものであることから、三次元点群地図と比較して作成は容易であり、管理も簡易でよい。

【0026】

図３のフローチャートは、位置推定装置２００が実行する処理手順例を示している。
ステップＳ１０１：位置推定装置２００において、位置推定部２２１は、撮像装置１００により撮像して得られた撮像画像ＰＩを取得する。
ステップＳ１０２：位置推定部２２１は、ステップＳ１０１により取得した撮像画像ＰＩから建造物ＢＬのエッジを抽出して、参照画像ＰＲＦを生成する。
ステップＳ１０３：位置推定部２２１は、第１特徴量地図を利用して、所定の座標と角度による投影中心Ｃ２ごとに対応する投影画像ＰＰＲを生成し、生成された投影画像ＰＰＲを、比較対象画像ＰＣＭとする。
ステップＳ１０４：位置推定部２２１は、ステップＳ１０２により参照画像ＰＲＦと、ステップＳ１０３により生成された比較対象画像ＰＣＭとを比較する。
ステップＳ１０５：位置推定部２２１は、ステップＳ１０４による比較の結果に基づいて、現実空間ＲＷＳにおける投影中心Ｃ１を求め、求められた投影中心Ｃ１に応じた移動体の自己位置を決定する。

【0027】

＜第２実施形態＞
続いて、第２実施形態について説明する。先の第１実施形態においては、第１特徴量地図として、現実空間ＲＷＳにいて存在する建造物ＢＬのエッジによる地図を用いた。本実施形態においては、第１特徴量地図に代えて、第２特徴量地図を用いる。
第２特徴量地図は、現実空間ＲＷＳにおいて存在するランドマークＬＭと植栽物ＰＬの色を特徴量として表した特徴量空間（色空間）の情報である。
本実施形態の位置推定装置２００の構成としては、記憶部２０３において第２特徴量地図記憶部２３２が備えられる。本実施形態においては、第１特徴量地図記憶部２３１は省略されてよい。

【0028】

図４を参照して、本実施形態の位置推定システム１による位置推定の手法例について説明する。
同図においては、図２と同じ現実空間ＲＷＳが示されている。同図では、街区環境を現実空間ＲＷＳとした例が示されている。同図の現実空間ＲＷＳにおいても、移動体に備えられる撮像装置１００が、或る空間内の位置（座標）にて或る撮像方向により撮像を行うことで、投影中心Ｃ１を原点とする投影面に対応する撮像画像ＰＩが得られている。

【0029】

本実施形態の位置推定装置２００の位置推定部２２１は、取得した撮像画像ＰＩから、ランドマークＬＭと植栽物ＰＬの色情報を特徴量として抽出した特徴量画像を生成し、生成された特徴量画像を参照画像ＰＲＦとする。ランドマークＬＭは、例えば看板等であるので周囲よりも目立たせるために特徴的な色彩を有するものが多い。また、植栽物ＰＬは、例えば周囲の建造物ＢＬとは異なる葉等の緑が特徴的である。このため、ランドマークＬＭや植栽物ＰＬは、色情報としての特徴量により表現しやすい。

【0030】

本実施形態の第２特徴量地図記憶部２３２が記憶する第２特徴量地図は、同図の現実空間ＲＷＳに存在する物体のうちからランドマークＬＭと植栽物ＰＬの色情報を抽出し、抽出された色情報としての特徴量により表される特徴量空間として生成されたものである。
同図には、第２特徴量地図が反映された特徴量空間ＶＲＳが示されている。特徴量空間ＶＲＳにおいては、第２特徴量地図において示されるランドマークＬＭと植栽物ＰＬの色情報により形成される特徴量群ＧＦＴが存在する。
位置推定部２２１は、同図の特徴量空間ＶＲＳにおいて、座標（ｘ，ｙ）と角度（θ）との組み合わせごとに対応して投影中心Ｃ２を設定し、特徴量空間ＶＲＳにおいて、設定された投影中心Ｃ２ごとの投影面に対応する投影画像ＰＰＲを生成する。このような投影画像ＰＰＲには、投影中心Ｃ２の座標（ｘ，ｙ）と角度（θ）に応じて投影面内に収まるランドマークＬＭと植栽物ＰＬの色情報が含まれることになる。
位置推定部２２１は、このように生成された複数の投影画像ＰＰＲを、参照画像ＰＲＦと比較する比較対象画像ＰＣＭとして扱う。

【0031】

位置推定部２２１は、参照画像ＰＲＦと複数の比較対象画像ＰＣＭとを比較し、比較結果に基づいて、撮像装置１００が対応する位置を推定する。
本実施形態においても、位置推定部２２１は、第１実施形態と同様に参照画像ＰＲＦと比較対象画像ＰＣＭの相関についての分布を求めることで、移動体の自己位置を推定することができる。

【0032】

このような本実施形態の位置推定システム１による自己位置の推定手法によっても、第１実施形態と同様に、撮像装置１００として単眼によるものを用いながらも、良好な精度で移動体の自己位置の推定を行うことが可能になる。

【0033】

＜第３実施形態＞
続いて、第３実施形態について説明する。本実施形態においては、位置推定にあたり第１特徴量地図と第２特徴量地図とを併用する。
本実施形態の位置推定装置２００の構成としては、記憶部２０３において第１特徴量地図記憶部２３１と第２特徴量地図記憶部２３２とが備えられる。

【0034】

本実施形態の位置推定部２２１は、第１特徴量地図を利用して得られた確率分布と、第２特徴量地図を利用して得られた確率分布とを総合的に判断して、移動体の自己位置を決定する。ここでの総合的な判断の手法として、１つには、位置推定部２２１は、第１特徴量地図に対応する確率分布と第２特徴量分布に対応する確率分布とを統合して１つの確率分布とする。位置推定部２２１は、統合された確率分布に基づいて移動体の自己位置を決定するようにされてよい。

【0035】

また、１つには位置推定部２２１は、第１特徴量地図に対応する確率分布と第２特徴量分布に対応する確率分布とのそれぞれの分布状態に基づいて、信頼性の高いほうの確率分布を選択する。そのうえで、位置推定部２２１は、選択した確率分布に基づいて移動体の自己位置を決定するようにされてよい。
例えば、似たような形状の建造物ＢＬが密集しているような場所では、第１特徴量地図を利用した位置推定精度が低下する場合がある。同様に、似たような植栽物ＰＬが密集している場合には、第２特徴量地図を利用した位置推定精度が低下する場合がある。そこで、上記のような位置推定の手法とすることで、位置推定の精度の低下を抑止できる。

【0036】

＜第４実施形態＞
続いて、第４実施形態について説明する。本実施形態においても、第３実施形態と同様に、位置推定にあたり第１特徴量地図と第２特徴量地図とを併用する。
そのうえで、本実施形態においては、第１特徴量地図と第２特徴量地図とで、現実空間ＲＷＳにおいてそれぞれ異なる空間範囲を対応させたものを用意する。

【0037】

現実空間ＲＷＳにおける建造物ＢＬ、ランドマークＬＭや植栽物ＰＬの存在状況から、第１特徴量を利用した位置推定の精度と第２特徴量を利用した位置推定の精度とのいずれが高いのかは事前に判断できる。そこで、現実空間ＲＷＳにおいて、第１特徴量を利用した位置推定の精度のほうが高いと判断された空間範囲については、第１特徴量地図を作成し、第１特徴量地図記憶部２３１に記憶させる。一方、現実空間ＲＷＳにおいて、第２特徴量を利用した位置推定の精度のほうが高いと判断された空間範囲については、第２特徴量地図を作成し、第２特徴量地図記憶部２３２に記憶させる。

【0038】

本実施形態における位置推定部２２１は、位置推定にあたり、撮像画像ＰＩに基づいて、建造物ＢＬのエッジを特徴量とする参照画像ＰＲＦと、ランドマークＬＭや植栽物ＰＬの色情報を特徴量とする参照画像ＰＲＦとの双方を生成してよい。
そのうえで、位置推定部２２１は、第１特徴量地図から生成した比較対象画像ＰＣＭについては、建造物ＢＬのエッジを特徴量とする参照画像ＰＲＦと比較する。また、位置推定部２２１は、第２特徴量地図から生成した比較対象画像ＰＣＭについては、ランドマークＬＭや植栽物ＰＬの色情報を特徴量とする参照画像ＰＲＦと比較する。
この場合、位置推定部２２１は、第１特徴量地図に対応する比較結果により得られた分布確率と、第２特徴量地図に対応する比較結果により得られた分布確率とを統合した分布確率に基づいて、移動体の位置を決定してよい。

【0039】

なお、上記各実施形態において、特徴量地図に対応する特徴量の特徴種別は、エッジや色情報に限定されない。例えば、撮像により得られた撮像画像の内容（例えば、撮像画像における画素のパターン）そのものが特徴量であると捉えて、撮像画像をそのまま参照画像としてよい。この場合、第１特徴量地図については、現実空間ＲＷＳにおける建造物ＢＬをできるだけ忠実に再現した三次元オブジェクトを含む空間を表す情報とされてよい。同様に、第２特徴量地図については、現実空間ＲＷＳにおけるランドマークＬＭや植栽物ＰＬをできるだけ忠実に再現した三次元オブジェクトを含む空間を表す情報とされてよい。

【0040】

なお、本実施形態において、特徴量地図に対応して特徴量を抽出する対象となる物体については、建造物ＢＬ、もしくはランドマークＬＭや植栽物ＰＬに限定されない。特徴量を抽出する対象となる物体については、例えば、地形等をはじめとして、現実空間の環境においてどのようなものが位置推定に好適であるのかについて考慮のうえで適宜変更されてよい。

【0041】

なお、位置推定システム１において、位置推定を行うにあたって併用する特徴量地図の数は３以上であってもよい。

【0042】

なお、上述の位置推定装置２００としての機能を実現するためのプログラムをコンピュータ読み取り可能な記録媒体に記録して、この記録媒体に記録されたプログラムをコンピュータシステムに読み込ませ、実行することにより上述の位置推定装置２００としての処理を行ってもよい。ここで、「記録媒体に記録されたプログラムをコンピュータシステムに読み込ませ、実行する」とは、コンピュータシステムにプログラムをインストールすることを含む。ここでいう「コンピュータシステム」とは、ＯＳや周辺機器等のハードウェアを含むものとする。また、「コンピュータシステム」は、通信回線を含むネットワークを介して接続された複数のコンピュータ装置を含んでもよい。記録媒体には、当該プログラムを配信するために配信サーバからアクセス可能な内部または外部に設けられた記録媒体も含まれる。

【符号の説明】

【0043】

１ 位置推定システム、１００ 撮像装置、２００ 位置推定装置、２０１ 入出力インターフェース部、２０２ 情報処理部、２０３ 記憶部、２２１ 位置推定部、２３１ 第１特徴量地図記憶部、２３２ 第２特徴量地図記憶部、３００ 情報出力装置

【図1】

【図2】

【図3】

【図4】