JP3968429B2 - 位置情報処理装置 - Google Patents
位置情報処理装置 Download PDFInfo
- Publication number
- JP3968429B2 JP3968429B2 JP2003008831A JP2003008831A JP3968429B2 JP 3968429 B2 JP3968429 B2 JP 3968429B2 JP 2003008831 A JP2003008831 A JP 2003008831A JP 2003008831 A JP2003008831 A JP 2003008831A JP 3968429 B2 JP3968429 B2 JP 3968429B2
- Authority
- JP
- Japan
- Prior art keywords
- absolute position
- estimation result
- distribution
- probability distribution
- image
- 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.)
- Expired - Lifetime
Links
Images
Landscapes
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
- Length Measuring Devices By Optical Means (AREA)
Description
【発明の属する技術分野】
本発明は、被計測対象(携帯電話やPDAなどの小型デバイス、人体など)の絶対位置を、被計測対象に装着可能な小型・軽量かつ安価なセンサ群によって取得するための位置情報処理装置に関するものである。
【0002】
【従来の技術】
従来から、位置情報取得装置としては、GPS(Global Positioning System)が用いられている。これは、GPS衛星からの信号を受信し、現在の絶対位置を取得する技術であり、その他にも、位置情報取得装置に関係する技術として、環境中に設置された赤外線ビーコンや電波ビーコンから発信される信号を受信し、現在の絶対位置を取得する技術、カメラ等から得られる画像と事前に登録されている画像群データベースの各画像と照合することによって現在の絶対位置を取得する技術が知られている。
【0003】
また、基準位置からの相対的な移動ベクトルを、車輪の速度・向きに基づいて取得する技術、慣性センサ(加速度センサ・角速度センサ・傾斜センサ)を組み合わせてこれらの計測結果を積算することによって位置情報を取得する技術、歩行者動作を検出することによって移動量を計測し、磁気コンパスなどによって移動方位を計測することによって位置情報を取得する技術などが知られている。
【特許文献1】
米国特許第5583779号明細書
【特許文献2】
特開平11−211479号公報
【特許文献3】
特許第3038452号公報
【特許文献4】
特開平8−178681号公報
【非特許文献1】
「超音波3次元タグを用いた人の日常活動の頑強な計測〜冗長なセンサ情報に基づくロバスト位置推定〜」(第20回日本ロボット学会創立20周年記念学術講演会予稿集、3C18(1)-(4), 2002)
【非特許文献2】
「赤外線ビーコンと歩数計測を用いたウェアラブル型注釈提示システム」
(信学技報, PRMU2002-68, pp. 71-76, 2002)
【非特許文献3】
「ウェアラブル拡張現実システムのための利用者のビューベースト位置・方位取得手法」(日本バーチャルリアリティ学会論文誌, vol. 7, no. 2, pp. 139-150, 2002)
【非特許文献4】
“Constellation: A Wide-range wireless motion-tracking system for augmented reality and virtual set applications,” (SIGGRAPH 1998, pp. 371-378, 1998)
【非特許文献5】
「新版応用カルマンフィルタ」(朝倉書店, 1999)
【非特許文献6】
“Introduction to Random Signals and Applied Kalman Filtering (Third Edition)”, (John Wiley & Sons.)
【非特許文献7】
“Incremental Motion-Based Location Recognition,” (Proceedings of International Symposium on Wearable Computers (ISWC2001), pp. 123-130, 2001)
【0004】
【解決しようとする課題】
従来における技術は、絶対位置を計測する装置と相対位置を計測する装置を組み合わせて、効率的に計測対象の絶対位置を取得する観点からの配慮が欠けているという問題がある。これは、外部状態を観測するセンシング装置に基づいて推定される絶対位置は常時取得可能であるとは限らないが、このための配慮に欠けているという問題である。
【0005】
例えば、GPSを利用する場合、衛星からの信号が遮断される環境下では、絶対位置を取得することはできない。また、画像群をデータベースに用いた位置・方位取得手法(非特許文献3を参照)では、現在位置で撮影された画像がデータベースに登録されていないとき、絶対位置を取得することはできない。絶対位置を取得するためには、多くの場合、このような問題が伴う。
【0006】
内部状態を観測するセンシング装置に基づいて推定される相対位置移動は、常時取得可能であることが多い。例えば、慣性センサ群から構成される慣性航法装置(IMU)においては、外部環境からのいかなる入力も必要とせず、基準位置からの相対位置移動ベクトルを算出することができる。
【0007】
本発明は、上記のような問題点に鑑みてなされたものであり、本発明は、間欠的に利用可能である絶対位置取得装置と常時利用可能である相対位置取得装置を効率的に組み合わせて、高い精度で位置情報を得ることできる位置情報処理装置を提供することにある。
【0008】
【課題を解決するための手段】
本発明の位置情報処理装置は、次のような基本的な原理を用いて位置情報の処理を行う。すなわち、一般に、センシング装置などの観測結果に基づいて算出される絶対位置には、一定の不確からしさが伴っており、その性質は用いるセンシング装置および算出方法によって異なる。なお、ここでは、離散的に観測結果が観測されるセンシング装置を対象としている。
【0009】
このため、本発明においては、センシング装置によって観測される観測結果の確からしさの分布を考慮に入れ、観測結果に基づいて算出される絶対位置の推定結果に対して確からしさの分布を付与し、その確からしさの分布に基づいて、次の離散時刻において実行される絶対位置の推定過程を変化させる。
【0010】
本発明の位置情報処理装置においては、計測対象が移動しうる範囲内の外部環境に関する事前の知識となる情報データベース装置が具備されている。この情報データベース装置は、絶対位置を情報検索のためのキーとして用いることができるものであり、位置情報処理では、現在の絶対位置の推定結果とその確からしさの分布に基づいて、現在の絶対位置の候補範囲を定めることにより、現在の状態に対応する情報を検索し、参照して、効率的に絶対位置の推定処理過程を遂行することができるようにする。
【0011】
具体的には、本発明の位置情報処理装置は、第1の態様として、計測対象の外部状態を観測する外部状態センシング装置と、前記計測対象の内部状態を観測する内部状態センシング装置と、前記計測対象の現在の絶対位置の推定結果を記憶する位置記憶装置と、前記計測対象の現在の絶対位置の推定結果の確からしさの分布を記憶する分布記憶装置と、前記計測対象が移動しうる範囲の外部環境に関する情報を記憶し、絶対位置の候補範囲を検索キーとして用いて記憶されている情報を検索し、該当する情報を取り出す機構を備えた情報データベース装置と、外部状態センシング装置により外部状態の観測結果が得られた場合、前記位置記憶装置から読み出される現在の絶対位置の推定結果および前記分布記憶装置から読み出される現在の絶対位置の推定結果の確からしさの分布によって決定される現在の絶対位置の候補範囲を検索キーとして、前記情報データベース装置から取り出された前記検索キーに該当する情報と、前記外部状態センシング装置が取得した観測結果とを照合し、前記計測対象の最新の絶対位置の推定結果および前記推定結果の確からしさの分布を取得する絶対位置分布取得装置と、前記内部状態センシング装置の観測結果と、前記観測結果の確からしさの分布に基づいて、前記計測対象の相対的な位置移動ベクトルによる相対位置の推定結果および前記推定結果の確からしさの分布を常時取得する相対位置分布取得装置と、前記絶対位置分布取得装置により取得された絶対位置の推定結果と前記相対位置分布取得装置により取得された相対位置の推定結果を併合して、現在の絶対位置の推定結果を更新・取得する位置推定結果併合更新装置と、前記絶対位置分布取得装置により取得された絶対位置の推定結果の確からしさの分布と前記相対位置分布取得装置により取得された相対位置の推定結果の確からしさの分布をカルマンフィルタの枠組みにより併合して、現在の絶対位置の推定結果の確からしさの分布を更新する分布併合更新装置と、前記位置推定結果併合更新装置によって取得された最新の絶対位置の推定結果を前記位置記憶装置に格納し、前記分布併合更新装置によって取得された最新の前記推定結果の確からしさの分布を前記分布記憶装置に格納する格納処理装置と、を備えることを特徴とする。
【0012】
本発明の位置情報処理装置は、第2の態様として、前記絶対位置分布取得装置は、前記位置記憶装置から読み出される絶対位置の推定結果と、前記分布記憶装置から読み出される絶対位置の推定結果の確からしさの分布によって決定される絶対位置の候補範囲を検索キーとして前記情報データベース装置から取り出される情報と、前記外部状態センシング装置から得られる観測結果とを照合することで、絶対位置の推定結果と前記推定結果の確からしさの分布を取得する照合処理装置を含む構成とされることを特徴とするものである。
【0013】
本発明の位置情報処理装置は、第3の態様として、前記計測対象の前記外部状態センシング装置は、画像撮影装置を含み、前記情報データベース装置は、撮影位置が既知である画像群を、外部環境に関する情報として記憶し、前記現在の絶対位置の推定結果と前記推定結果の分布に基づいて決定される検索キーにより現在の絶対位置の候補範囲内に撮影位置が含まれる画像群を検索し、該当する画像群を取り出す機構を備えた画像群データベース装置を含んでおり、前記絶対位置分布取得装置は、前記位置記憶装置から読み出される現在の絶対位置の推定結果と、前記分布記憶装置から読み出される現在の絶対位置の推定結果の確からしさの分布に基づいて決定される現在の絶対位置の候補範囲を検索キーとして前記情報データベース装置を検索し、検索結果に該当する画像群が存在するとき、前記画像群の各画像もしくは前記画像群の各画像の特徴量と、前記画像撮影装置から取得される画像もしくは前記画像撮影装置から取得される画像の特徴量を照合する画像照合装置を含む構成とされることを特徴とするものである。
【0014】
本発明の位置情報処理装置は、第4の態様として、前記計測対象として歩行する人間を対象とし、歩行者の移動手段である歩行動作による相対位置移動を計測するための内部状態センシング装置として、慣性センサ群および磁気センサを用い、前記相対位置分布取得装置には、慣性センサ群と磁気センサのセンサ出力と前記慣性センサ群と磁気センサによる観測結果の確からしさの分布に基づいて、歩行者の歩行動作検出と歩幅推定、移動方向を検出し相対位置ベクトルを算出し、前記相対位置ベクトルの確からしさの分布を算出する演算装置を備えることを特徴とするものである。
【0015】
また、本発明の位置情報処理装置は、第5の態様として、前記外部状態センシング装置として、外部環境側に設置されている絶対位置に対応して固有の信号を送出している信号発生装置からの信号を受信する信号受信装置を備え、前記情報データベース装置は、固有の信号と絶対位置の対応関係をデータとして記憶しているデータベース装置であり、前記絶対位置分布取得装置は、前記信号受信装置によって信号が受信されているとき、前記受信信号に対応する絶対位置を前記データベース装置から取り出して現在の絶対位置の推定結果を取得し、前記受信信号の強度などの性質に基づいて前記推定結果の確からしさの分布を取得することを特徴とするものである。
【0016】
【発明の実施の形態】
図1は、本発明の第1の実施例を示すブロック図である。第1の実施例において、計測対象は、例えば、人や自転車、自動車、航空機などである。また、計測対象の外部状態の測定データの例としては、CCDカメラ等によって取得される画像、もしくは画像列、外部環境側に設置された赤外線ビーコンまたは電波ビーコンから発信される信号を受信する装置によって取得される信号、マイク等によって取得される音声データ、温度センサによって取得される温度、磁気センサによって取得される磁気ベクトル、光量センサによって取得される光量、もしくはこれらの組み合わせなどである。
【0017】
外部状態センシング装置102は、上述したような計測対象の外部状態を取得する装置であり、具体的には、CCDカメラなどの画像撮影装置、マイクなどの音声取得装置、外部環境に設置された赤外線ビーコンまたは電波ビーコンから発信される信号の受信機(非特許文献2を参照)、外部環境に設置された信号トランスポンダ(定型信号を受信すると、自身の固有番号を表す信号を送り返す装置)群とそれらに対する信号送受信機(非特許文献4を参照)、外部環境付近の基地局情報を受信する携帯電話またはPHS、超音波信号を発信する装置および無線信号を受信する装置であって外部環境側に受信機群を備えてこれらの受信機群による3次元位置計測結果を無線信号によって送出する装置(非特許文献1を参照)、光量センサなどが用いられる。
【0018】
情報データベース装置103は、計測対象が移動しうる外部環境に関する情報を記憶したデータベース装置であり、絶対位置の範囲を検索キーとして、記憶された情報から該当する情報を取り出す機構を備えている装置である。これは、磁気記憶装置(ハードディスクなど)または光記憶装置(CDなど)、光磁気記憶装置に、必要な情報を記憶しておき、それらの情報を読み出すデータ処理装置により構成される。マイクロプロセッサ(CPU)および汎用計算機のプログラムの組み合わせ手段により構成される。ここに記憶される情報としては、例えば、環境中の各地点において事前に撮影された画像と前記画像が撮影された絶対位置の対応テーブル、外部環境に配置された赤外線ビーコンまたは電波ビーコンが発信する信号データとその信号が受信されうる絶対位置の対応テーブル、携帯電話またはPHSによって受信される基地局情報と絶対位置の対応テーブル、などを基本単位として、絶対位置もしくはその範囲をキーとして対応する情報を取り出し可能な形式で保存されたデータである。
【0019】
現在の絶対位置記憶装置105は、現在の絶対位置の推定結果を記憶している装置であり、絶対位置の確からしさ分布記憶装置106は、その推定結果の確からしさの分布を記憶している装置である。ここでの推定結果の確からしさの分布の例としては、単一の正規分布を仮定した場合には、絶対位置ベクトルと分散・共分散行列がある。または、絶対位置を離散化した2次元あるいは3次元テーブルにおいて、各要素に確からしさをあらわす非負数を格納する表現方法などがある。そのようなデータを利用する。
【0020】
絶対位置の推定結果および推定結果の確からしさの分布取得装置(絶対位置分布取得装置)101は、外部状態センシング装置によって取得される観測結果から、記憶装置105から読み出される現在の絶対位置の推定結果および記憶装置106から読み出される前記推定結果の確からしさの分布に基づいて、最新の絶対位置の推定結果(出力1)および前記推定結果の確からしさの分布(出力2)を算出し、取得して出力する装置である。その算出過程において、情報データベース装置103に記憶されている情報が、以下のような過程を介して参照される。
【0021】
記憶装置105から読み出される現在の絶対位置の推定結果と、記憶装置106から読み出される前記推定結果の確からしさの分布に基づいて、絶対位置の候補範囲を決定することができる。前記候補範囲を検索キーとして用いて、情報データベース装置103から、前記検索キーに該当するデータを検索し、存在する場合、該当データ群を取り出す。これらの該当データ群は現在の絶対位置の候補範囲に対応するデータであり、最新の絶対位置の推定結果と前記推定結果の算出過程に前記該当データ群を勘案することによって、より適切かつ正確な推定結果およびその分布を取得できる。該当するデータが存在しない場合、分布取得装置101は、有効な出力が得られないことをあらわすデータ出力を、出力1と出力2に出力する。
【0022】
現在の絶対位置の推定結果の分布を、最新の絶対位置の推定結果および前記推定結果の分布に反映させる手段として、確からしさの分布を正規分布とみなすカルマンフィルタの枠組み(非特許文献5または非特許文献6を参照)を用いる。
【0023】
ここでの外部状態センシング装置102を複数個備える場合は、後述するように、分布取得装置101と外部状態センシング装置102と情報データベース装置103の関係は、図12に示すような構成として、複数個の分布取得装置(絶対位置分布取得装置)101(図12の場合、N個)の出力結果を併合し、最終的な出力である絶対位置の推定結果(出力1)と前記推定結果の確からしさの分布(出力2)を生成して、出力する絶対位置の推定結果と推定結果の確からしさの併合・更新処理装置111を備える。
【0024】
また、内部状態センシング装置109は、計測対象の内部状態を観測する装置である。ここでの内部状態の例としては、計測対象の速度ベクトルや加速度ベクトル、角速度ベクトル、角加速度ベクトル、重力加速度ベクトル(傾斜角)、磁気ベクトルなどである。計測対象が人間である場合は、人間がとる動作の有無とその大きさ(例えば、歩行動作と歩幅)などが挙げられ、内部状態センシング装置109は、これらのいずれかもしくはこれらの組み合わせを観測するセンサ群であり、観測結果に対して確からしさの分布を同時に取得可能なものである。相対位置の推定結果および推定結果の確からしさの分布取得装置(相対位置分布取得装置)104は、内部状態センシング装置109によって取得された観測結果と観測結果の確からしさの分布に基づいて、計測対象の相対的な移動ベクトルを算出し、相対位置の推定結果(出力1)として出力し、同時に、推定結果の確からしさの分布(出力2)を算出し、出力する装置である。
【0025】
相対的な移動ベクトルを算出する方法として、各離散時刻における加速度ベクトルを二重積分して積算する方法、速度ベクトルを積分して積算する方法、計測対象が人間である場合は、歩行動作が人間の移動手段であるため、歩行動作の検出処理と歩幅の推定処理、移動方向の推定処理によって、人間の歩行による相対移動ベクトルを算出できる(特許文献1を参照)。人間の移動方向の推定には、磁気センサを用いて地磁気ベクトルを取得する方法、基準姿勢角からの相対的な姿勢角変化を計測する方法(特許文献2または特許文献3を参照)を用いて、移動方向の推定を行う。
【0026】
ここでの内部状態センシング装置を複数個備える場合は、後述するように、内部状態センシング装置109と、相対位置の推定結果および推定結果の確からしさの分布取得装置104との関係は、図13に示すような構成として、絶対位置の推定結果および相対位置の推定結果を併合して最新の現在位置を取得する装置107は、分布取得装置101からの出力1(最新の絶対位置の推定結果)と、分布取得装置104からの出力1(相対位置の推定結果)を併合して、最新の絶対位置の推定結果を更新して出力する。
【0027】
絶対位置の推定結果の確からしさの分布および相対位置の推定結果の確からしさの分布を併合して最新の絶対位置の推定結果の確からしさを取得する装置108は、分布取得装置101からの出力2(最新の絶対位置の推定結果の確からしさの分布)と分布取得装置104からの出力2(相対位置の推定結果の確からしさの分布)を併合し、最新の絶対位置の推定結果の確からしさの分布を算出し、出力する。格納処理装置110は、装置107の出力と装置108の出力を、それぞれ記憶装置105と記憶装置106に格納する処理を行う装置である。
【0028】
上記の実施例における各装置による信号処理は、汎用計算機(CPU)のプログラム処理によっても実現される。次に、このようなプログラム処理による処理の流れについて説明する。
【0029】
図2に示すフローチャートは、第1の実施例に対応する処理の流れを示すフローチャートである。ここで処理では、ステップS101において外部状態センシング装置102から観測結果を取得し、ステップS102において現在の絶対位置記憶装置105から現在の絶対位置の推定結果を取得し、ステップS103において絶対位置の確からしさ分布記憶装置106から前記推定結果の確からしさの分布を取得する。そして、ステップS104においては、ステップS102で取得された絶対位置の推定結果と、ステップS103で取得された前記推定結果の確からしさの分布に基づいて、現在の絶対位置の候補範囲を決定する。
【0030】
ステップS105においては、ステップS104で決定された絶対位置の候補範囲をキーとして、情報データベース装置103から対応する情報を取り出す。次のステップS106において、ステップS101で得られた観測結果と、ステップS102で得られた現在位置の推定結果と、ステップS103で得られた前記推定結果の確からしさの分布と、ステップS105で取り出された情報に基づいて、最新の絶対位置の推定結果と、その推定結果の確からしさの分布を算出する。
【0031】
次に、ステップS107において、内部状態センシング装置109から観測結果と前記観測結果の確からしさの分布を取得して、次のステップS108において、前のステップS107で得られた観測結果と確からしさの分布に基づいて、相対位置(すなわち計測対象の移動ベクトル)の推定結果とその確からしさの分布を算出する。次に、ステップS109において、ステップS106で得られた最新の絶対位置の推定結果と、ステップS108で得られた相対位置の推定結果を併合し、最新の絶対位置の推定結果を更新する。そして、ステップS110において、ステップS106で得られた最新の絶対位置の推定結果の確からしさの分布と、ステップS108で得られた相対位置の推定結果の確からしさを併合して、最新の絶対位置の推定結果の確からしさの分布を更新する。ステップS111においては、ステップS109で更新された最新の現在位置の推定結果を格納処理装置110を用いて記憶装置105へ格納し、ステップS110で更新された最新の絶対位置の推定結果の確からしさの分布を格納処理装置110を用いて記憶装置106へ格納する。次のステップS112において、ステップS109で更新された最新の絶対位置の推定結果を本装置の出力1として出力する。ステップS113においては、ステップS110で更新された最新の絶対位置の推定結果の確からしさの分布を本装置の出力2として出力する。
【0032】
図3は、本発明の第2の実施例を示すブロック図である。第2の実施例は、第1の実施例(図1)の構成において、絶対位置取得ための装置(絶対位置の推定結果および推定結果の確からしさの分布取得装置101)に代えて、照合処理装置201を備えるものとなっている。照合処理装置201が行う処理である照合処理の例としては、外部状態センシング装置102が観測する離散時刻における単独データと、事前に取得されていたモデルパターンデータとの照合処理、外部状態センシング装置102が観測する離散時刻における時系列データと、事前に登録されていたモデル時系列パターンデータとの照合処理(例えば動的計画法に基づくマッチング処理)などである。
【0033】
上記の実施例における各装置による信号処理は、汎用計算機(CPU)のプログラム処理によっても実現される。次に、このようなプログラム処理による処理の流れについて説明する。
【0034】
図4に示すフローチャートは、第2の実施例に対応する処理の流れを示すフローチャートである。ここで処理では、ステップS201において、外部状態センシング装置102から観測結果を取得し、ステップS202において、現在の絶対位置記憶装置105から現在の絶対位置を取得し、ステップS203において絶対位置の確からしさ分布記憶装置106から絶対位置の確からしさの分布を取得する。次に、ステップS204において、ステップS202で取得された絶対位置の推定結果と、ステップS203で取得された前記絶対位置の確からしさの分布に基づいて、現在の絶対位置の候補範囲を決定する。ステップS205において、ステップS204で決定された現在の絶対位置の候補範囲を検索キーとしてデータベース装置103から該当するデータ群を検索して取り出す。ステップS206において、ステップS201で得られた観測結果と、ステップS205で得られた該当するデータ群を照合し、その照合結果とステップS202で取得された現在位置の推定結果と、ステップS203で取得された現在位置の推定結果の確からしさの分布に基づいて、最新の絶対位置の推定結果と前記推定結果の確からしさの分布を装置201を用いて算出する。ステップS207において109から観測結果とその確からしさの分布を取得し、ステップS208において、ステップS207で取得された観測結果とその確からしさの分布に基づいて相対位置の推定結果および前記推定結果の確からしさの分布を装置104を用いて算出する。ステップS209において、ステップS206で算出された最新の絶対位置の推定結果と、ステップS208で算出された相対位置の推定結果を併合し、最新の絶対位置の推定結果を装置107を用いて算出して更新する。ステップS210において、ステップS206で算出された最新の絶対位置の推定結果の確からしさの分布と、ステップS208で算出された相対位置の推定結果の確からしさの分布を併合し、最新の絶対位置の推定結果の確からしさの分布を装置108を用いて算出する。ステップS211において、ステップS209で算出された最新の絶対位置の推定結果を格納処理装置110を用いて記憶装置105へ格納し、ステップS210で算出された最新の絶対位置の推定結果の分布を格納処理装置110を用いて記憶装置106へ格納する。
【0035】
ステップS212において、ステップS209で算出された最新の絶対位置の推定結果を、出力1として出力し、ステップS213において、ステップS210で算出された最新の絶対位置の推定結果の分布を、出力2として出力する。
【0036】
図5は、本発明の第3の実施例を示すブロック図である。第3の実施例は、第1の実施例(図1)の構成の外部状態センシング装置102に代えて、画像撮影装置301を備え、絶対位置取得ための装置(絶対位置の推定結果および推定結果の確からしさの分布取得装置101)に代えて、画像照合装置302を備える構成となっている。そのため、第1の実施例(図1)の構成の情報データベース装置103に変えて、画像群データベース装置303を備えている。
【0037】
画像撮影装置301としては、例えば、CCDカメラもしくはCMOSカメラなどを用いる。画像照合装置302は、画像間の位置合わせ処理に基づいて画像間の幾何変換パラメータを算出し、前記変換パラメータを用いて画像間の輝度差分等が一定の閾値以下になったとき二つの画像が照合されたとみなす手法(非特許文献3を参照)を用いて画像を照合する。マイクロプロセッサ(CPU)とその手法の処理プログラムにより実装される。各画像には対応する絶対位置が対応づけられており、この画像照合により、絶対位置を求める。そのため、ここでの画像群データベース装置303は、画像群の各画像をその各画像が撮影された絶対位置と結びつけて記憶している記憶装置(もしくは記憶媒体)となっている。絶対位置およびその範囲が検索のキーとして与えられたとき、撮影位置が該当する画像群を検索し、取り出す機構を備えたデータベース装置である。記憶する画像群のデータベースの内容を記憶した記憶媒体(磁気ディスク、光ディスク、光磁気ディスクなど)とその内容を検索し、情報を取り出す汎用計算機のプログラム等によって構成される。
【0038】
図6は、本発明の第4の実施例を示すブロック図である。この実施例の構成においては、相対位置ベクトルの推定過程において、人間の歩行動作に基づくdead−reckoningに対する対応を行っている。このため、第1の実施例(図1)の構成の内部状態センシング装置109に代えて、慣性センサ群および磁気センサ401を備え、また、相対位置の推定結果および推定結果の確からしさの分布取得装置104に代えて、歩行動作検出に基づく相対位置の推定結果および確からしさの分布を取得する装置402を備えている。
【0039】
人間の歩行動作を検出するセンサとしては、鉛直方向の加速度成分と進行方向への加速度成分に検出し、その時系列パターンの照合により、人間の歩行動作を精度良く検出する。このため、人間の歩行移動の方向を検出する手段として、地磁気ベクトルを検出する磁気センサを用いる。
【0040】
この実施例では、内部状態センシング装置109として、すなわち、内部状態センシング装置109に代えて、慣性センサ群(例えば加速度センサ(3軸)とジャイロセンサ(3軸))と地磁気ベクトルを計測する磁気センサ(3軸)を用いる。これらのセンサはいずれも誤差分布の特性が既知(概ね正規分布を用いて近似可能)であり、したがって、観測結果の確からしさの分布を得ることができる。また、前述したように、相対位置の推定結果および推定結果の確からしさの分布取得装置104に代えて、慣性センサ群と磁気センサによる観測結果とその確からしさの分布に基づいて、歩行動作の検出と歩幅の推定、移動方向の検出を処理する装置402を備える。慣性センサ群と磁気センサによる観測結果とその確からしさの分布に基づいて、歩行動作の検出と歩幅の推定、移動方向の検出を実現する方法は、公知であり、この発明とは直接関係しないので、詳細な説明は省略する(特許文献1、非特許文献7を参照)
【0041】
図7は、本発明の第5の実施例を示すブロック図であり、また、図8は、第5の実施例に対応する処理の流れを示すフローチャートである。図7に示す第5の実施例は、図5に示す第3の実施例の要素と、図6に示す第4の実施例の要素を組み合わせたものとなっている。
【0042】
上記の実施例における各装置による信号処理については、図8に示すフローチャートのように、汎用計算機(CPU)によるプログラム処理によっても実現される。
【0043】
図9は、本発明の第6の実施例を示すブロック図である。この実施例においては、外部環境側に設置されたビーコン信号(設置された絶対位置に固有の信号)を送出するビーコン信号発生装置503を利用するための構成となっている。そのため、外部状態センシング装置102に代えて、ビーコン信号を受信するビーコン信号受信装置502を備え、絶対位置の推定結果および推定結果の確からしさの分布取得装置101に代えて、ビーコン信号照合装置およびビーコン信号強度処理装置501を備えた構成としている。また、情報データベース装置103に代えて、ビーコン信号情報データベース装置504を備える構成としている。ビーコン信号情報データベース装置504は、ビーコン信号とその信号が対応する絶対位置の対応関係を記憶し、ビーコン信号を検索のキーとして該当する絶対位置を検索し、取り出す機構を備えているものである。
【0044】
ビーコン信号照合処理およびビーコン信号強度処理装置502は、ビーコン信号発生装置503から発信され、ビーコン信号受信装置502において受信されたビーコン信号を検索のキーとして、ビーコン信号情報データベース装置504に対して検索し、該当する絶対位置を取り出すことによって、現在の絶対位置の推定結果を取得し、受信されたビーコン信号の強度や方向などから推定結果の確からしさの分布を算出する。
【0045】
上記の実施例における各装置による信号処理は、汎用計算機(CPU)のプログラム処理によっても実現される。次に、このようなプログラム処理による処理の流れについて説明する。
【0046】
図10に示すフローチャートは、第6の実施例に対応する処理の流れを示すフローチャートである。この処理においては、まず、ステップS501において、ビーコン信号受信装置502からビーコン信号を取得する(存在する場合に限られる)。次に、ステップS502においては、受信したビーコン信号を検索キーとして、ビーコン信号情報データベース装置504を検索し、ビーコン信号に対応する絶対位置を取り出すことで、絶対位置の推定結果を取得する。
【0047】
そして、ステップS503において、ステップS501で受信したビーコン信号の強度や方向などの性質に基づいて、ステップS502で取得された絶対位置の推定結果の確からしさの分布を算出する。次に、ステップS504において内部状態センシング装置から観測結果とその確からしさの分布を取得する。ステップS505においては、ステップS504で取得された観測結果と前記観測結果の確からしさの分布に基づいて相対位置の推定結果および前記推定結果の確からしさの分布を算出する。ステップS506においては、ステップS502で得られた絶対位置の推定結果と、ステップS505で得られた相対位置の推定結果を併合して、最新の絶対位置の推定結果を算出する。
【0048】
次のステップS507においては、ステップS503で得られた絶対位置の推定結果の確からしさの分布と、ステップS505で得られた相対位置の推定結果の確からしさの分布を併合して、最新の絶対位置の推定結果の確からしさの分布を算出する。ステップS508においては、ステップS506で算出された絶対位置の推定結果を格納処理装置110を用いて記憶装置105へ格納し、ステップS507で取得された絶対位置の推定結果の確からしさの分布を、格納処理装置110を用いて記憶装置106へ格納する。
【0049】
ステップS509において、ステップS506で算出された絶対位置の推定結果を本装置の出力1として出力し、ステップS510において、ステップS507で算出された絶対位置の推定結果の確からしさの分布を本装置の出力2として出力する。
【0050】
図11は、本発明の第7の実施例を示すブロック図である。図11に示す第7の実施例は、図6に示す第4の実施例の要素と、図9に示す第6の実施例の要素を組み合わせたものとなっている。
【0051】
【発明の効果】
以上に説明したように、本発明による位置情報処理装置の各実施例の構成を用いることで、一般的に高い計算コストを要し、必ずしも常時実行可能であることが保証されない絶対位置取得過程を効率よく実行することができる。具体的に説明すると、絶対位置の推定結果とその確からしさの分布から決定される絶対位置の候補範囲を検索キーとして情報データベース装置から該当データを検索し、該当データが存在しない場合には、絶対位置取得過程を実行せず、該当データが存在する場合について、外部状態センシング装置が取得した観測結果と該当データを照合することにより、該当データのみに基づいた絶対位置取得を実行すれば良いため、必要な計算コストは低く抑えることができるという効果を奏する。
【図面の簡単な説明】
【図1】 本発明の第1の実施例を示すブロック図である。
【図2】 第1の実施例に対応する処理の流れを示すフローチャートである。
【図3】 本発明の第2の実施例を示すブロック図である。
【図4】 第2の実施例に対応する処理の流れを示すフローチャートである。
【図5】 本発明の第3の実施例を示すブロック図である。
【図6】 本発明の第4の実施例を示すブロック図である。
【図7】 本発明の第5の実施例を示すブロック図である。
【図8】 第5の実施例に対応する処理の流れを示すフローチャートである。
【図9】 本発明の第6の実施例を示すブロック図である。
【図10】 第6の実施例に対応する処理の流れを示すフローチャートである。
【図11】 本発明の第7の実施例を示すブロック図である。
【図12】 外部状態センシング装置を複数備える場合の変形例の構成を示す図である。
【図13】 内部状態センシング装置を複数備える場合の変形例の構成を示す図である。
【符号の説明】
101…分布取得装置、
102…外部状態センシング装置、
103…情報データベース装置、
104…分布取得装置、
105…現在の絶対位置記憶装置、
106…絶対位置の確からしさ分布記憶装置、
107…併合装置、
108…確からしさ取得装置、
109…内部状態センシング装置、
110…格納処理装置、
Claims (5)
- 計測対象の外部状態を観測する外部状態センシング装置と、
前記計測対象の内部状態を観測する内部状態センシング装置と、
前記計測対象の現在の絶対位置の推定結果を記憶する位置記憶装置と、
前記計測対象の現在の絶対位置の推定結果の確からしさの分布を記憶する分布記憶装置と、
前記計測対象が移動しうる範囲の外部環境に関する情報を記憶し、絶対位置の候補範囲を検索キーとして用いて記憶されている情報を検索し、該当する情報を取り出す機構を備えた情報データベース装置と、
外部状態センシング装置により外部状態の観測結果が得られた場合、前記位置記憶装置から読み出される現在の絶対位置の推定結果および前記分布記憶装置から読み出される現在の絶対位置の推定結果の確からしさの分布によって決定される現在の絶対位置の候補範囲を検索キーとして、前記情報データベース装置から取り出された前記検索キーに該当する情報と、前記外部状態センシング装置が取得した観測結果とを照合し、前記計測対象の最新の絶対位置の推定結果および前記推定結果の確からしさの分布を取得する絶対位置分布取得装置と、
前記内部状態センシング装置の観測結果と、前記観測結果の確からしさの分布に基づいて、前記計測対象の相対的な位置移動ベクトルによる相対位置の推定結果および前記推定結果の確からしさの分布を常時取得する相対位置分布取得装置と、
前記絶対位置分布取得装置により取得された絶対位置の推定結果と前記相対位置分布取得装置により取得された相対位置の推定結果を併合して、現在の絶対位置の推定結果を更新・取得する位置推定結果併合更新装置と、
前記絶対位置分布取得装置により取得された絶対位置の推定結果の確からしさの分布と前記相対位置分布取得装置により取得された相対位置の推定結果の確からしさの分布をカルマンフィルタの枠組みにより併合して、現在の絶対位置の推定結果の確からしさの分布を更新する分布併合更新装置と、
前記位置推定結果併合更新装置によって取得された最新の絶対位置の推定結果を前記位置記憶装置に格納し、前記分布併合更新装置によって取得された最新の前記推定結果の確からしさの分布を前記分布記憶装置に格納する格納処理装置と、
を備えることを特徴とする位置情報処理装置。 - 請求項1記載の位置情報処理装置において、
前記絶対位置分布取得装置は、前記位置記憶装置から読み出される絶対位置の推定結果と、前記分布記憶装置から読み出される絶対位置の推定結果の確からしさの分布によって決定される絶対位置の候補範囲を検索キーとして前記情報データベース装置から取り出される情報と、前記外部状態センシング装置から得られる観測結果とを照合することで、絶対位置の推定結果と前記推定結果の確からしさの分布を取得する照合処理装置を含む構成とされる
ことを特徴とする位置情報処理装置。 - 請求項1記載の位置情報処理装置において、
前記計測対象の前記外部状態センシング装置は、画像撮影装置を含み、
前記情報データベース装置は、撮影位置が既知である画像群を、外部環境に関する情報として記憶し、前記現在の絶対位置の推定結果と前記推定結果の分布に基づいて決定される検索キーにより現在の絶対位置の候補範囲内に撮影位置が含まれる画像群を検索し、該当する画像群を取り出す機構を備えた画像群データベース装置を含んでおり、
前記絶対位置分布取得装置は、前記位置記憶装置から読み出される現在の絶対位置の推定結果と、前記分布記憶装置から読み出される現在の絶対位置の推定結果の確からしさの分布に基づいて決定される現在の絶対位置の候補範囲を検索キーとして前記情報データベース装置を検索し、検索結果に該当する画像群が存在するとき、前記画像群の各画像もしくは前記画像群の各画像の特徴量と、前記画像撮影装置から取得される画像もしくは前記画像撮影装置から取得される画像の特徴量を照合する画像照合装置を含む構成とされる
ことを特徴とする位置情報処理装置。 - 請求項1記載の位置情報処理装置において、
前記計測対象として歩行する人間を対象とし、歩行者の移動手段である歩行動作による相対位置移動を計測するための内部状態センシング装置として、慣性センサ群および磁気センサを用い、
前記相対位置分布取得装置には、慣性センサ群と磁気センサのセンサ出力と前記慣性センサ群と磁気センサによる観測結果の確からしさの分布に基づいて、歩行者の歩行動作検出と歩幅推定、移動方向を検出し相対位置ベクトルを算出し、前記相対位置ベクトルの確からしさの分布を算出する演算装置を備える
ことを特徴とする位置情報処理装置。 - 請求項1記載の位置情報処理装置において、さらに、
前記外部状態センシング装置として、外部環境側に設置されている絶対位置に対応して固有の信号を送出している信号発生装置からの信号を受信する信号受信装置を備え、
前記情報データベース装置は、固有の信号と絶対位置の対応関係をデータとして記憶しているデータベース装置であり、
前記絶対位置分布取得装置は、前記信号受信装置によって信号が受信されているとき、前記受信信号に対応する絶対位置を前記データベース装置から取り出して現在の絶対位置の推定結果を取得し、前記受信信号の強度などの性質に基づいて前記推定結果の確からしさの分布を取得する
ことを特徴とする位置情報処理装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003008831A JP3968429B2 (ja) | 2003-01-16 | 2003-01-16 | 位置情報処理装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003008831A JP3968429B2 (ja) | 2003-01-16 | 2003-01-16 | 位置情報処理装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004219332A JP2004219332A (ja) | 2004-08-05 |
JP3968429B2 true JP3968429B2 (ja) | 2007-08-29 |
Family
ID=32898504
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003008831A Expired - Lifetime JP3968429B2 (ja) | 2003-01-16 | 2003-01-16 | 位置情報処理装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3968429B2 (ja) |
Families Citing this family (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4714853B2 (ja) * | 2006-05-18 | 2011-06-29 | 独立行政法人産業技術総合研究所 | デッドレコニング装置 |
JP2008304269A (ja) * | 2007-06-06 | 2008-12-18 | Sony Corp | 情報処理装置、および情報処理方法、並びにコンピュータ・プログラム |
US7995801B2 (en) * | 2007-06-08 | 2011-08-09 | National Institute Of Advanced Industrial Science And Technology | Mobile positioning system |
JP4931241B2 (ja) * | 2007-09-25 | 2012-05-16 | Kddi株式会社 | 歩行者の進行方向の方向転換を判定する携帯端末及びプログラム |
JP2010058217A (ja) * | 2008-09-03 | 2010-03-18 | Toyota Auto Body Co Ltd | ネジの焼付き防止装置 |
JP2010085390A (ja) * | 2008-09-03 | 2010-04-15 | Toyota Auto Body Co Ltd | 締付け位置検出装置 |
JP5274192B2 (ja) * | 2008-10-07 | 2013-08-28 | Kddi株式会社 | 位置推定システム、位置推定サーバおよび位置推定方法 |
JP4866951B2 (ja) | 2009-09-16 | 2012-02-01 | 株式会社日立製作所 | 測位組み合わせ決定システム |
JP5314548B2 (ja) * | 2009-09-16 | 2013-10-16 | 株式会社日立製作所 | 自律移動システム及び自律移動装置 |
US8983124B2 (en) | 2009-12-03 | 2015-03-17 | National Institute Of Advanced Industrial Science And Technology | Moving body positioning device |
JP5168601B2 (ja) | 2010-03-31 | 2013-03-21 | アイシン・エィ・ダブリュ株式会社 | 自車位置認識システム |
JP5062497B2 (ja) * | 2010-03-31 | 2012-10-31 | アイシン・エィ・ダブリュ株式会社 | 風景画像認識を用いた自車位置検出システム |
JP5477167B2 (ja) * | 2010-05-27 | 2014-04-23 | 株式会社豊田中央研究所 | 移動体 |
JP4845068B2 (ja) * | 2010-10-22 | 2011-12-28 | 独立行政法人産業技術総合研究所 | デッドレコニング装置 |
JP2018185182A (ja) * | 2017-04-25 | 2018-11-22 | 東京電力ホールディングス株式会社 | 位置特定装置 |
-
2003
- 2003-01-16 JP JP2003008831A patent/JP3968429B2/ja not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JP2004219332A (ja) | 2004-08-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9292936B2 (en) | Method and apparatus for determining location | |
JP3837533B2 (ja) | 姿勢角処理装置および姿勢角処理方法 | |
Elloumi et al. | Indoor pedestrian localization with a smartphone: A comparison of inertial and vision-based methods | |
Tian et al. | A multi-mode dead reckoning system for pedestrian tracking using smartphones | |
EP2434256B1 (en) | Camera and inertial measurement unit integration with navigation data feedback for feature tracking | |
JP5339304B2 (ja) | 移動体の測位装置 | |
US20180328753A1 (en) | Local location mapping method and system | |
JP3968429B2 (ja) | 位置情報処理装置 | |
EP2946167B1 (en) | Method and apparatus for determination of misalignment between device and pedestrian | |
EP3213031B1 (en) | Simultaneous localization and mapping by using earth's magnetic fields | |
Ahn et al. | RescueMe: An indoor mobile augmented-reality evacuation system by personalized pedometry | |
JP5953677B2 (ja) | 情報処理装置、情報処理方法、プログラム、及び記録媒体 | |
US20130142384A1 (en) | Enhanced navigation through multi-sensor positioning | |
KR102226846B1 (ko) | Imu 센서와 카메라를 이용한 하이브리드 실내 측위 시스템 | |
Pei et al. | Motion recognition assisted indoor wireless navigation on a mobile phone | |
CN105814609A (zh) | 用于用户识别、跟踪与设备关联的融合设备与图像运动 | |
JP5742794B2 (ja) | 慣性航法装置及びプログラム | |
Serra et al. | Inertial navigation systems for user-centric indoor applications | |
KR101523147B1 (ko) | 실내 측위 장치 및 방법 | |
JP2007309803A (ja) | デッドレコニング装置 | |
JP3706907B2 (ja) | 携帯者の現在位置および方位推定方法 | |
JP2004274101A (ja) | 移動体識別システム | |
Herrera et al. | Analysis of a kalman approach for a pedestrian positioning system in indoor environments | |
KR20160004084A (ko) | 실내 보행자 위치 추적 장치 및 방법 | |
Saadatzadeh et al. | Pedestrian dead reckoning using smartphones sensors: an efficient indoor positioning system in complex buildings of smart cities |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20040818 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20061107 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070109 |
|
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: 20070508 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 3968429 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
EXPY | Cancellation because of completion of term |