Pat
J-GLOBAL ID：201303016427388974

自己位置推定装置、自己位置推定方法およびプログラム

Inventor：
中尾 学

About 中尾 学


Applicant, Patent owner：
富士通株式会社

About 富士通株式会社


Agent (2)： 大菅 義之 ,  ▲徳▼永 民雄
Gazette classification：公開公報
Application number (International application number)：2011157099
Publication number (International publication number)：2013025401
Application date： Jul. 15, 2011
Publication date： Feb. 04, 2013
Summary：
【課題】自己位置を正確に推定することが可能な自己位置推定装置、自己位置推定方法およびプログラムを提供する。【解決手段】自己位置推定装置は、撮影部、距離算出部、ランドマーク位置取得部、自己位置推定部、移動位置予測部、観測尤度計算部、視野内ランドマーク抽出部、撮影角度変更部、撮影制御部を有している。ランドマーク位置取得部は、各ランドマークの位置を取得する。自己位置推定部は、取得された画像、算出された距離、および上記位置に基づき自己位置を推定する。移動位置予測部は、推定された自己位置に基づき予測位置を算出する。撮影角度変更部は、視野内ランドマーク抽出部が抽出した視野内ランドマークについて観測尤度計算部が計算した観測尤度と、視野内ランドマークの観測角度とに応じて撮影角度を変更する。撮影制御部は、変更後の撮影角度で撮影した画像に基づき自己位置を更新する。【選択図】図2
Claim (excerpt)：
自己位置を推定する自己位置推定装置であって、 複数のランドマークの内の少なくとも一つのランドマークの画像を含む画像を撮影する撮影部と、 前記自己位置推定装置から前記少なくとも一つのランドマークまでの距離を算出する距離算出部と、 前記少なくとも一つのランドマークの位置を取得するランドマーク位置取得部と、 前記画像、前記距離、および前記少なくとも一つのランドマークの位置に基づき前記自己位置推定装置の自己位置を推定する自己位置推定部と、 前記自己位置推定部により推定された自己位置に基づき前記自己位置推定装置の移動時の将来の予測位置を算出する移動位置予測部と、 前記予測位置において前記少なくとも一つのランドマークが観測される観測尤度を算出する観測尤度計算部と、 前記予測位置において前記画像が撮影される際の撮影角度に応じて観測される前記少なくとも一つのランドマークのうちの視野内ランドマークを抽出するとともに、それぞれの前記視野内ランドマークの観測角度を算出する視野内ランドマーク抽出部と、 抽出された前記視野内ランドマークの前記観測尤度と前記観測角度とに応じて前記撮影部の撮影角度を変更する撮影角度変更部と、 変更後の前記撮影角度で前記画像が撮影されるように撮影を制御する撮影制御部と、 を有し、 前記自己位置推定部は、変更後の前記撮影角度で撮影された画像と前記ランドマーク位置取得部により取得される前記少なくとも一つのランドマークの位置とに基づき前記自己位置推定装置の現在位置を更新することを特徴とする自己位置推定装置。
IPC (4)：
G05D 1/02 ,  G01S 3/786 ,  G09B 29/10 ,  G01S 5/16
FI (4)：
G05D1/02 K ,  G01S3/786 ,  G09B29/10 A ,  G01S5/16
F-Term (14)：
2C032HB12 ,  2C032HC08 ,  2C032HD03 ,  2C032HD16 ,  5H301AA01 ,  5H301BB14 ,  5H301CC03 ,  5H301CC06 ,  5H301CC08 ,  5H301DD01 ,  5H301FF11 ,  5H301GG09 ,  5H301GG23 ,  5H301GG29
Patent cited by the Patent：
Cited by examiner (3)

Return to Previous Page

TOP

BOTTOM