JP2012185202A - 局所地図生成装置、グローバル地図生成装置、及びプログラム - Google Patents

局所地図生成装置、グローバル地図生成装置、及びプログラム Download PDF

Info

Publication number
JP2012185202A
JP2012185202A JP2011046349A JP2011046349A JP2012185202A JP 2012185202 A JP2012185202 A JP 2012185202A JP 2011046349 A JP2011046349 A JP 2011046349A JP 2011046349 A JP2011046349 A JP 2011046349A JP 2012185202 A JP2012185202 A JP 2012185202A
Authority
JP
Japan
Prior art keywords
information
local map
trajectory
moving body
local
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
Application number
JP2011046349A
Other languages
English (en)
Other versions
JP5589900B2 (ja
Inventor
Sachiko Kojima
祥子 小島
Noriyoshi Suzuki
徳祥 鈴木
Junichi Meguro
淳一 目黒
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Central R&D Labs Inc
Original Assignee
Toyota Central R&D Labs Inc
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Toyota Central R&D Labs Inc filed Critical Toyota Central R&D Labs Inc
Priority to JP2011046349A priority Critical patent/JP5589900B2/ja
Priority to US14/002,890 priority patent/US9103680B2/en
Priority to PCT/JP2012/055464 priority patent/WO2012118207A1/ja
Publication of JP2012185202A publication Critical patent/JP2012185202A/ja
Application granted granted Critical
Publication of JP5589900B2 publication Critical patent/JP5589900B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38—Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804—Creation or updating of map data
    • G01C21/3833—Creation or updating of map data characterised by the source of data
    • G01C21/3848—Data obtained from both position sensors and additional sensors
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T17/00—Three dimensional [3D] modelling, e.g. data description of 3D objects
    • G06T17/05—Geographic models
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/10—Terrestrial scenes

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • General Physics & Mathematics (AREA)
  • Geometry (AREA)
  • Software Systems (AREA)
  • Automation & Control Theory (AREA)
  • Computer Graphics (AREA)
  • Theoretical Computer Science (AREA)
  • Navigation (AREA)
  • Instructional Devices (AREA)

Abstract

【課題】簡易な構成で、精度の高い地図を生成することができるようにする。
【解決手段】撮像装置１４によって前方画像を撮像し、ＧＰＳ情報取得部２２によって、ドップラー周波数を含む衛星情報を取得する。位置・速度ベクトル算出部２４によって、ドップラー周波数を用いて速度ベクトルを算出する。軌跡算出部２６によって、自車両の位置の軌跡を算出する。投影画像生成部３０によって、前方画像から路面に投影した投影画像を生成する。ローカルマップ生成部３２によって、自車両の軌跡上の各点について得られた路面画像を、軌跡上の各点における移動体の進行方向と、撮像装置１４の設置位置及び姿勢とに基づいて定められる、ローカルマップの各領域に記録する。
【選択図】図１

Description

本発明は、局所地図生成装置、グローバル地図生成装置、及びプログラムに係り、特に、移動体の周辺の環境情報を記録した局所地図、またはグローバル地図を生成する局所地図生成装置、グローバル地図生成装置、及びプログラムに関する。
従来、計測された位置とビデオカメラからアフィン変換して生成された路面画像に対し、複数車線のデータを統合するときなどに生じる路面画像の位置ずれを考慮し、評価された位置精度に応じて精度が高いパスを基準パスとして、路面画像を統合する路面表示地図生成方法が知られている（特許文献１）。
特開２０１０−１７５７５６号公報
しかしながら、上記の特許文献１に記載の技術は、高精度な位置と高精度な軌跡が予め取得できる計測車両を想定したものであり、一般の車両には適用できない、という問題がある。また、路面マークの位置合わせについても基準パスを想定し、精度が高いほうに合わせる手法を用いているが、これは高精度計測車両であれば可能であるものである。通常のナビ用ＧＰＳでは、特に都心部において数１０ｍの測位誤差が生じる可能性があり、郊外路でも数ｍの精度であるため、基準パスへ位置を合わせようとしても、精度は向上しない、という問題がある。
本発明は、上記の問題点を解決するためになされたもので、簡易な構成で、精度の高い地図を生成することができる局所地図生成装置、グローバル地図生成装置、及びプログラムを提供することを目的とする。
上記目的を達成するために、第１の発明の局所地図生成装置は、移動体に搭載され、かつ、設置位置から見た前記移動体の周辺の環境情報を取得する環境情報取得手段と、複数のＧＰＳ衛星の各々から送信された前記ＧＰＳ衛星の各々の位置に関する情報、前記ＧＰＳ衛星の各々と前記移動体との距離に関する情報、及び前記ＧＰＳ衛星の各々に対する前記移動体の相対速度に関する情報を含む衛星情報を取得する衛星情報取得手段と、前記衛星情報取得手段により取得された前記衛星情報に基づいて、前記移動体の進行方向を含む速度ベクトル、又は前記移動体の速度及び前記移動体の進行方向を示す速度情報を算出する算出手段と、前記算出手段により算出された前記移動体の前記速度情報を積算して、前記移動体の位置の軌跡を算出する軌跡算出手段と、前記軌跡算出手段によって算出された前記移動体の位置の軌跡上の各点について前記環境情報取得手段によって取得された前記環境情報を、前記軌跡上の各点における前記移動体の進行方向と、前記環境情報取得手段の設置位置及び姿勢とに基づいて定められる、前記移動体の位置の軌跡を含む局所地図上の各領域に記録する局所地図生成手段と、を含んで構成されている。
第２の発明に係る局所地図生成プログラムは、コンピュータを、移動体に搭載され、かつ、設置位置から見た前記移動体の周辺の環境情報を取得する環境情報取得手段を含む局所地図生成装置の各手段として機能させるためのプログラムであって、複数のＧＰＳ衛星の各々から送信された前記ＧＰＳ衛星の各々の位置に関する情報、前記ＧＰＳ衛星の各々と前記移動体との距離に関する情報、及び前記ＧＰＳ衛星の各々に対する前記移動体の相対速度に関する情報を含む衛星情報を取得する衛星情報取得手段、前記衛星情報取得手段により取得された前記衛星情報に基づいて、前記移動体の進行方向を含む速度ベクトル、又は前記移動体の速度及び前記移動体の進行方向を示す速度情報を算出する算出手段、前記算出手段により算出された前記移動体の前記速度情報を積算して、前記移動体の位置の軌跡を算出する軌跡算出手段、及び前記軌跡算出手段によって算出された前記移動体の位置の軌跡上の各点について前記環境情報取得手段によって取得された前記環境情報を、前記軌跡上の各点における前記移動体の進行方向と、前記環境情報取得手段の設置位置及び姿勢とに基づいて定められる、前記移動体の位置の軌跡を含む局所地図上の各領域に記録する局所地図生成手段として機能させるためのプログラムである。
第１の発明及び第２の発明によれば、環境情報取得手段によって、設置位置から見た移動体の周辺の環境情報を取得する。衛星情報取得手段によって、複数のＧＰＳ衛星の各々から送信されたＧＰＳ衛星の各々の位置に関する情報、ＧＰＳ衛星の各々と移動体との距離に関する情報、及びＧＰＳ衛星の各々に対する移動体の相対速度に関する情報を含む衛星情報を取得する。
そして、算出手段によって、衛星情報取得手段により取得され衛星情報に基づいて、移動体の進行方向を含む速度ベクトル、又は移動体の速度及び移動体の進行方向を示す速度情報を算出する。軌跡算出手段によって、算出手段により算出された移動体の速度情報を積算して、移動体の位置の軌跡を算出する。
そして、局所地図生成手段によって、軌跡算出手段によって算出された移動体の位置の軌跡上の各点について環境情報取得手段によって取得された環境情報を、軌跡上の各点における移動体の進行方向と、環境情報取得手段の設置位置及び姿勢とに基づいて定められる、移動体の位置の軌跡を含む局所地図上の各領域に記録する。
このように、速度情報を積算して移動体の軌跡を算出し、移動体の軌跡上の各点について取得された周辺の環境情報を、局所地図上の各領域に記録することにより、簡易な構成で、精度の高い地図を生成することができる。
第３の発明に係る局所地図生成装置は、移動体に搭載され、かつ、設置位置から見た前記移動体の周辺の環境情報を取得する環境情報取得手段と、前記移動体の運動状態を検出する運動状態検出手段と、前記運動状態検出手段により検出された前記移動体の運動状態に基づいて、前記移動体の基準方向の方位角を推定する方位角推定手段と、前記運動状態検出手段により検出された前記移動体の運動状態を積算し、前記積算された前記移動体の運動状態と、前記方位角推定手段によって推定された前記方位角とに基づいて、前記移動体の位置の軌跡を算出する軌跡算出手段と、前記軌跡算出手段によって算出された前記移動体の位置の軌跡上の各点について前記環境情報取得手段によって取得された前記環境情報を、前記軌跡上の各点における前記移動体の進行方向と、前記環境情報取得手段の設置位置及び姿勢とに基づいて定められる、前記移動体の位置の軌跡を含む局所地図上の各領域に記録する局所地図生成手段と、を含んで構成されている。
第４の発明に係るプログラムは、コンピュータを、移動体に搭載され、かつ、設置位置から見た前記移動体の周辺の環境情報を取得する環境情報取得手段を含む局所地図生成装置の各手段として機能させるためのプログラムであって、前記移動体の運動状態を検出する運動状態検出手段により検出された前記移動体の運動状態に基づいて、前記移動体の基準方向の方位角を推定する方位角推定手段、前記運動状態検出手段により検出された前記移動体の運動状態を積算し、前記積算された前記移動体の運動状態と、前記方位角推定手段によって推定された前記方位角とに基づいて、前記移動体の位置の軌跡を算出する軌跡算出手段、及び前記軌跡算出手段によって算出された前記移動体の位置の軌跡上の各点について前記環境情報取得手段によって取得された前記環境情報を、前記軌跡上の各点における前記移動体の進行方向と、前記環境情報取得手段の設置位置及び姿勢とに基づいて定められる、前記移動体の位置の軌跡を含む局所地図上の各領域に記録する局所地図生成手段として機能させるためのプログラムである。
第３の発明及び第４の発明によれば、環境情報取得手段によって、設置位置から見た移動体の周辺の環境情報を取得する。運動状態検出手段によって、移動体の運動状態を検出する。
そして、方位角推定手段によって、運動状態検出手段により検出された移動体の運動状態に基づいて、移動体の基準方向の方位角を推定する。軌跡算出手段によって、運動状態検出手段により検出された移動体の運動状態を積算し、積算された移動体の運動状態と、方位角推定手段によって推定された方位角とに基づいて、移動体の位置の軌跡を算出する。
そして、局所地図生成手段によって、軌跡算出手段によって算出された移動体の位置の軌跡上の各点について環境情報取得手段によって取得された環境情報を、軌跡上の各点における移動体の進行方向と、環境情報取得手段の設置位置及び姿勢とに基づいて定められる、移動体の位置の軌跡を含む局所地図上の各領域に記録する。
このように、移動体の方位角を推定すると共に運動状態を積算して移動体の軌跡を算出し、移動体の軌跡上の各点について取得された周辺の環境情報を、局所地図上の各領域に記録することにより、簡易な構成で、精度の高い地図を生成することができる。
第３の発明に係る局所地図生成装置は、複数のＧＰＳ衛星の各々から送信された前記ＧＰＳ衛星の各々の位置に関する情報、前記ＧＰＳ衛星の各々と前記移動体との距離に関する情報、及び前記ＧＰＳ衛星の各々に対する前記移動体の相対速度に関する情報を含む衛星情報を取得する衛星情報取得手段と、前記衛星情報取得手段により取得された前記衛星情報に基づいて、前記移動体の進行方向を含む速度ベクトル、又は前記移動体の速度及び前記移動体の進行方向を示す速度情報を算出する算出手段と、を更に含み、前記方位角推定手段は、前記運動状態検出手段により検出された前記移動体の運動状態、及び前記算出手段によって算出された前記速度情報に基づいて、前記移動体の基準方向の方位角を推定し、前記軌跡算出手段は、前記運動状態検出手段により検出された前記移動体の運動状態、前記算出手段によって算出された前記速度情報、及び前記方位角推定手段によって推定された前記方位角に基づいて、前記移動体の位置の軌跡を算出するようにすることができる。これによって、精度よく軌跡を算出することができ、より精度の高い地図を生成することができる。
上記の算出手段は、前記ＧＰＳ衛星の各々の位置に関する情報、及び前記ＧＰＳ衛星の各々と前記移動体との距離に関する情報から得られる前記移動体の位置に基づいて、前記移動体から見た前記ＧＰＳ衛星の各々の方向を算出し、時系列の前記ＧＰＳ衛星の各々の位置に関する情報に基づいて、前記ＧＰＳ衛星の各々の速度を算出し、前記移動体から見た前記ＧＰＳ衛星の各々の方向、前記ＧＰＳ衛星の各々の速度、及び前記ＧＰＳ衛星の各々に対する前記移動体の相対速度に関する情報に基づいて、前記移動体のＧＰＳ衛星の各々の方向の速度を算出し、複数の前記移動体のＧＰＳ衛星の各々の方向の速度に基づいて、前記移動体の速度ベクトルを算出するようにすることができる。これによって、精度よく速度ベクトルを算出することができ、精度よく軌跡を算出することができる。
上記のＧＰＳ衛星の各々の位置に関する情報を、衛星軌道情報とし、前記ＧＰＳ衛星の各々と前記移動体との距離に関する情報を、擬似距離情報とし、前記ＧＰＳ衛星の各々に対する前記移動体の相対速度に関する情報を、ドップラー周波数情報とすることができる。
上記の前記環境情報取得手段を、前記移動体の周辺を撮像する撮像手段、又は前記移動体の周辺に存在する物体までの距離情報を計測するレーザレーダとすることができる。
第５の発明に係るグローバル地図生成装置は、上記の局所地図生成装置と、前記生成された複数の局所地図を記憶した局所地図記憶手段と、複数の局所地図間で、前記局所地図に記録された前記環境情報を照合し、前記環境情報を照合させた状態で前記複数の局所地図を合成する合成手段と、前記合成手段によって合成された前記複数の局所地図の前記軌跡上の少なくとも１点の絶対位置を推定する位置推定手段と、前記位置推定手段によって推定された絶対位置に基づいて、絶対座標系で表わされるグローバル地図上に、前記合成手段によって合成された前記複数の局所地図を記録するグローバル地図生成手段と、を含んで構成されている。
第５の発明によれば、局所地図生成装置によって局所地図を生成し、局所地図記憶手段は、生成された複数の局所地図を記憶する。
そして、合成手段によって、複数の局所地図間で、局所地図に記録された環境情報を照合し、環境情報を照合させた状態で複数の局所地図を合成する。位置推定手段によって、合成手段によって合成された複数の局所地図の軌跡上の少なくとも１点の絶対位置を推定する。
そして、グローバル地図生成手段によって、位置推定手段によって推定された絶対位置に基づいて、絶対座標系で表わされるグローバル地図上に、合成手段によって合成された複数の局所地図を記録する。
このように、精度の高い局所地図を生成し、局所地図に記録された環境情報を照合して複数の局所地図を合成し、絶対座標系で表わされるグローバル地図上に、合成された複数の局所地図を記録することにより、簡単な構成で、精度の高いグローバル地図を生成することができる。
第６の発明に係るグローバル地図生成装置は、上記の衛星情報取得手段を含む局所地図生成装置と、前記生成された局所地図を記憶した局所地図記憶手段と、複数の局所地図間で、前記局所地図に記録された前記環境情報を照合し、前記環境情報を照合させた状態で前記複数の局所地図を合成する合成手段と、前記合成手段によって合成された前記複数の局所地図の前記軌跡上の少なくとも１点の絶対位置を推定する位置推定手段と、前記位置推定手段によって推定された絶対位置に基づいて、絶対座標系で表わされるグローバル地図上に、前記合成手段によって合成された前記複数の局所地図を記録するグローバル地図生成手段と、を含むグローバル地図生成装置であって、前記局所地図生成手段は、前記軌跡算出手段によって算出された前記移動体の位置の軌跡上の前記少なくとも１点について、前記衛星情報取得手段によって取得された前記衛星情報を前記局所地図に記録し、前記位置推定手段は、前記複数の局所地図の照合結果に基づいて求められる前記複数の局所地図の各々の前記少なくとも１点間の相対位置と、前記複数の局所地図の各々に記録された前記衛星情報とに基づいて、前記合成された前記複数の局所地図の前記軌跡上の前記少なくとも１点の絶対位置を推定することを特徴としている。
第６の発明によれば、局所地図生成装置によって局所地図を生成し、局所地図記憶手段は、記生成された複数の局所地図を記憶する。このとき、局所地図生成手段は、軌跡算出手段によって算出された移動体の位置の軌跡上の少なくとも１点について、衛星情報取得手段によって取得された衛星情報を局所地図に記録する。
そして、合成手段によって、複数の局所地図間で、局所地図に記録された環境情報を照合し、環境情報を照合させた状態で複数の局所地図を合成する。位置推定手段によって、複数の局所地図の照合結果に基づいて求められる複数の局所地図の各々の少なくとも１点間の相対位置と、複数の局所地図の各々に記録された衛星情報とに基づいて、合成された複数の局所地図の軌跡上の少なくとも１点の絶対位置を推定する。
そして、グローバル地図生成手段によって、位置推定手段によって推定された絶対位置に基づいて、絶対座標系で表わされるグローバル地図上に、合成手段によって合成された複数の局所地図を記録する。
このように、精度の高い局所地図を生成し、局所地図に記録された環境情報を照合して複数の局所地図を合成し、絶対座標系で表わされるグローバル地図上に、合成された複数の局所地図を記録することにより、簡単な構成で、精度の高いグローバル地図を生成することができる。
上記第５の発明及び第６の発明に係るグローバル地図生成装置は、前記移動体の絶対位置を算出する位置算出手段を更に含み、前記局所地図生成手段は、前記軌跡算出手段によって算出された前記移動体の位置の軌跡上の前記少なくとも１点について前記位置算出手段によって算出された絶対位置を、前記局所地図に記録し、前記位置推定手段は、前記合成手段によって合成された前記複数の局所地図の各々の前記少なくとも１点について記録された絶対位置に基づいて、前記少なくとも１点の絶対位置を推定するようにすることができる。これによって、移動体の位置の軌跡上の少なくとも１点の絶対位置を精度よく推定することができる。
なお、本発明のプログラムを記憶する記憶媒体は、特に限定されず、ハードディスクであってもよいし、ＲＯＭであってもよい。また、ＣＤ−ＲＯＭやＤＶＤディスク、光磁気ディスクやＩＣカードであってもよい。更にまた、該プログラムを、ネットワークに接続されたサーバ等からダウンロードするようにしてもよい。
以上説明したように、本発明の局所地図生成装置及びプログラムによれば、速度情報を積算して、あるいは、移動体の方位角を推定すると共に運動状態を積算して、移動体の軌跡を算出し、移動体の軌跡上の各点について取得された周辺の環境情報を、局所地図上の各領域に記録することにより、簡易な構成で、精度の高い地図を生成することができる、という効果が得られる。
また、本発明のグローバル地図生成装置によれば、精度の高い局所地図を生成し、局所地図に記録された環境情報を照合して複数の局所地図を合成し、絶対座標系で表わされるグローバル地図上に、合成された複数の局所地図を記録することにより、簡単な構成で、精度の高いグローバル地図を生成することができる、という効果が得られる。
第１の実施の形態に係る局所地図生成装置を示すブロック図である。 （Ａ）前方画像の一例を示す図、及び（Ｂ）前方画像を路面に投影する様子を示す図である。 本発明の第１の実施の形態に係る局所地図生成装置の位置・速度ベクトル算出部を示すブロック図である。 （Ａ）、（Ｂ）車両座標系とカメラ座標系を説明するための図である。 前方画像上の位置を路面に投影したときの位置を説明するための図である。 自車両の軌跡に沿って投影画像を記録する様子を示す図である。 実際の路面とローカルマップ上の投影画像とのずれを説明するための図である。 ローカルマップのデータ構成の例を示す図である。 第１の実施の形態に係る局所地図生成装置のコンピュータにおけるローカルマップ生成処理ルーチンの内容を示すフローチャートである。 第１の実施の形態に係る局所地図生成装置のコンピュータにおけるローカルマップ生成処理の内容を示すフローチャートである。 第１の実施の形態に係る局所地図生成装置のコンピュータにおける速度ベクトル算出処理の内容を示すフローチャートである。 第２の実施の形態に係る局所地図生成装置を示すブロック図である。 第２の実施の形態に係る局所地図生成装置のコンピュータにおけるローカルマップ生成処理の内容を示すフローチャートである。 第３の実施の形態に係る局所地図生成装置を示すブロック図である。 第４の実施の形態に係るグローバル地図生成装置を示すブロック図である。 ＧＰＳ情報の一例を示す図である。 複数回走行において生成されたローカルマップを示す図である。 複数回走行において生成されたローカルマップを示す図である。 複数回走行において生成されたローカルマップを照合した様子を示す図である。 複数回走行において生成されたローカルマップの各々の原点で取得したＧＰＳ情報を用いて絶対位置を推定するための方法を説明するための図である。 第４の実施の形態に係るグローバル地図生成装置のコンピュータにおけるグローバルマップ生成処理ルーチンの内容を示すフローチャートである。 第４の実施の形態に係るグローバル地図生成装置のコンピュータにおけるグローバルマップ生成処理ルーチンの内容を示すフローチャートである。 第４の実施の形態に係るグローバル地図生成装置のコンピュータにおける運転支援制御処理ルーチンの内容を示すフローチャートである。 第５の実施の形態に係るグローバル地図生成装置を示すブロック図である。
以下、図面を参照して本発明の実施の形態を詳細に説明する。なお、第１の実施の形態では、車両に搭載され、ＧＰＳ衛星から発信されたＧＰＳ情報を取得すると共に、自車両の周辺の画像を記録したローカルマップを生成する局所地図生成装置に、本発明を適用した場合を例に説明する。
図１に示すように、第１の実施の形態に係る局所地図生成装置１０は、ＧＰＳ衛星からの電波を受信するＧＰＳ受信部１２と、自車両の前方を撮像する撮像装置１４と、ＧＰＳ受信部１２によって受信されたＧＰＳ衛星からの受信信号、及び撮像装置１４によって撮像された前方画像に基づいて、自車両の位置を原点とした座標系で表わされるローカルマップを生成すると共に、過去に生成された周辺のローカルマップを運転支援装置１８へ出力するコンピュータ２０と、を備えている。なお、撮像装置１４が、環境情報取得手段の一例である。
ＧＰＳ受信部１２は、複数のＧＰＳ衛星からの電波を受信して、受信した全てのＧＰＳ衛星からの受信信号から、ＧＰＳ衛星の情報を取得し、コンピュータ２０に出力する。
撮像装置１４は、図２（Ａ）に示すような前方画像を繰り返し撮像し、コンピュータ２０へ出力する。
運転支援装置１８は、入力されたローカルマップに基づいて、前方の制御対象との位置関係を取得し、カーブ警報や一時停止支援などの運転支援を行う。
コンピュータ２０は、ＣＰＵ、後述するローカルマップ生成処理ルーチンを実現するためのプログラムを記憶したＲＯＭ、データを一時的に記憶するＲＡＭ、及びＨＤＤ等の記憶装置で構成されている。
コンピュータ２０を以下で説明するローカルマップ生成処理ルーチンに従って機能ブロックで表すと、図１に示すように、ＧＰＳ受信部１２から、電波を受信した全てのＧＰＳ衛星について、ＧＰＳ衛星の情報を取得すると共に、ＧＰＳ擬似距離データ、ドップラー周波数、及びＧＰＳ衛星の位置座標を算出して取得するＧＰＳ情報取得部２２と、取得したＧＰＳ情報に基づいて、各時刻における自車両の位置及び速度ベクトルを算出する位置・速度ベクトル算出部２４と、算出された所定時間分の速度ベクトルを積算して、所定時間における自車両の位置の軌跡を算出する軌跡算出部２６と、撮像装置１４によって各時刻において撮像された前方画像を取得する画像取得部２８と、取得した前方画像を、鳥瞰図となるように平面に投影した投影画像を生成する投影画像生成部３０と、算出された所定時間の軌跡に沿って、各地点の投影画像を記録したローカルマップを生成するローカルマップ生成部３２と、生成された複数のローカルマップを記憶するローカルマップ記憶部３４とを備えている。なお、位置・速度ベクトル算出部２４が、算出手段及び位置算出手段の一例である。
ＧＰＳ情報取得部２２は、ＧＰＳ受信部１２から、電波を受信した全てのＧＰＳ衛星について、ＧＰＳ衛星の情報を取得すると共に、ＧＰＳ擬似距離データを取得する。また、ＧＰＳ情報取得部２２は、各ＧＰＳ衛星から送信される信号の既知の周波数と、各ＧＰＳ衛星から受信した受信信号の周波数とに基づいて、各ＧＰＳ衛星からの受信信号のドップラー周波数を各々算出する。なお、ドップラー周波数は、ＧＰＳ衛星と自車との相対速度による、搬送波周波数のドップラーシフト量を観測したものである。
位置・速度ベクトル算出部２４は、図３に示すように、取得したＧＰＳ情報に基づいて、ＧＰＳ衛星の位置及び自車両の位置を算出する位置算出部５１と、取得した各ＧＰＳ衛星のドップラー周波数に基づいて、各ＧＰＳ衛星に対する自車両の相対速度を算出する相対速度算出部６０と、取得した各ＧＰＳ衛星の位置座標の時系列データに基づいて、各ＧＰＳ衛星の速度ベクトルを算出する衛星速度算出部６２と、算出された自車両の位置及び各ＧＰＳ衛星の位置座標に基づいて、各ＧＰＳ衛星の方向（角度の関係）を算出する衛星方向算出部６６と、算出された相対速度、各ＧＰＳ衛星の速度ベクトル、及び各ＧＰＳ衛星の方向に基づいて、各ＧＰＳ衛星方向の自車両の速度を算出する衛星方向自車速算出部６８と、算出された複数の各ＧＰＳ衛星方向の自車両の速度に基づいて、自車両の速度ベクトルを算出する自車両速度算出部７０と、を含んだ構成で表すことができる。
位置算出部５１は、ＧＰＳ衛星の軌道情報及びＧＰＳ衛星が電波を送信した時刻に基づいて、ＧＰＳ衛星の位置座標を各々算出する。
また、位置算出部５１は、以下のように、ＧＰＳ情報取得部２２によって取得された各ＧＰＳ衛星のＧＰＳ擬似距離データを用いて、自車両の位置を算出する。
ＧＰＳを用いた測位では、既知であるＧＰＳ衛星の位置座標と、各ＧＰＳ衛星から受信した受信信号の伝播距離である擬似距離とに基づいて、三角測量の原理に従って、自車両の位置が推定される。
ここで、ＧＰＳ衛星までの真の距離ｒｊは、以下の（１）式で表され、ＧＰＳで観測される擬似距離ρｊは、以下の（２）式で表される。
Figure 2012185202
ただし、（Ｘｊ，Ｙｊ，Ｚｊ）がＧＰＳ衛星ｊの位置座標であり、（ｘ，ｙ，ｚ）が自車両の位置座標である。ｓは、ＧＰＳ受信部１２の時計誤差による距離誤差である。
上記（１）式、（２）式より、４つ以上のＧＰＳ衛星のＧＰＳ擬似距離データから得られる以下の（３）式の連立方程式を解くことによって、自車両の位置（ｘ、ｙ、ｚ）が算出される。
Figure 2012185202
相対速度算出部６０は、ドップラー周波数とＧＰＳ衛星に対する相対速度との関係を表わす以下の（４）式に従って、各ＧＰＳ衛星からの受信信号のドップラー周波数から、各ＧＰＳ衛星に対する自車両の相対速度を算出する。
Figure 2012185202
ただし、ｖｊはＧＰＳ衛星ｊに対する相対速度であり、Ｄ１ｊはＧＰＳ衛星ｊから得られるドップラー周波数（ドップラーシフト量）である。また、Ｃは光速であり、Ｆ１は、ＧＰＳ衛星から送信される信号の既知のＬ１周波数である。
衛星速度算出部６２は、取得した各ＧＰＳ衛星の位置座標の時系列データから、ケプラーの方程式の微分を用いて、各ＧＰＳ衛星の速度ベクトル（３次元速度ＶＸｊ、ＶＹｊ、ＶＺｊ）を算出する。例えば、非特許文献（Ｐｒａｔａｐ Ｍｉｓｒａ ａｎｄ Ｐｅｒ Ｅｎｇｅ原著 日本航海学会ＧＰＳ研究会訳：“精説ＧＰＳ基本概念・測位原理・信号と受信機”正陽文庫，２００４．）に記載された方法を用いて、各ＧＰＳ衛星の速度ベクトルを算出することができる。
衛星方向算出部６６は、算出された自車両の位置及び各ＧＰＳ衛星の位置座標に基づいて、各ＧＰＳ衛星ｊの位置と自車両の位置との角度関係（水平方向に対する仰角θｊ、北方向に対する方位角φｊ）を、各ＧＰＳ衛星の方向として算出する。
衛星方向自車速算出部６８は、算出された各ＧＰＳ衛星に対する自車両の相対速度ｖｊ、各ＧＰＳ衛星の速度ベクトル（ＶＸｊ、ＶＹｊ、ＶＺｊ）、及び各ＧＰＳ衛星の方向Ｒｊ（θｊ、φｊ）に基づいて、以下の（５）式に従って、各ＧＰＳ衛星ｊの方向の自車両の速度Ｖｖｊを算出する。
Figure 2012185202
ｖｊは、ＧＰＳ衛星ｊに対する自車両の相対速度（衛星方向におけるＧＰＳ衛星との相対速度）である。また、Ｖｓｊは、自車方向のＧＰＳ衛星ｊの速度であり、Ｖｓｊ＝Ｒｊ［ＶＸｊ，ＶＹｊ，ＶＺｊ］Ｔにより求まる。また、Ｖｖｊは、ＧＰＳ衛星ｊの方向の自車速であり、ｖＣｂは、クロックバイアス変動である。
上述したように、ＧＰＳ衛星方向の自車速は、ＧＰＳ衛星位置の三次元位置ではなく、ＧＰＳ衛星との方位関係によってのみ算出される。ＧＰＳ衛星は遥か遠方にあり、１日で地球をほぼ２周するため１分間の角度変化は０．５度である。通常、ＧＰＳ衛星とＧＰＳ受信機との時計誤差は通常１ｍｓｅｃ以下であるため、ＧＰＳ衛星との方位関係に大きな影響はない。また、同じくＧＰＳ衛星は遥か遠方にあるため、自車の位置決定に数１００ｍ程度の誤差が生じていたとしても、ＧＰＳ衛星との方位関係に大きな影響はない。このため、擬似距離に誤差が乗りやすい状況であったとしても、ＧＰＳ衛星方向の自車速は、比較的正確に算出され得る。
自車両速度算出部７０は、以下に説明するように、自車両の速度ベクトルの最適推定を行う。
まず、自車の速度ベクトルを（Ｖｘ，Ｖｙ，Ｖｚ）としたとき、ＧＰＳ衛星方向の自車両の速度Ｖｖｊとの関係は以下の（６）式で表される。
Figure 2012185202
各ＧＰＳ衛星ｊについて得られる上記（６）式より、Ｖｘ，Ｖｙ，Ｖｚ及びＣｂを推定値とした、以下の（７）式で表される連立方程式が得られる。
Figure 2012185202
電波を受信したＧＰＳ衛星が４個以上である場合に、上記（７）式の連立方程式を解くことによって、自車両の速度ベクトル（Ｖｘ，Ｖｙ，Ｖｚ）の最適値を算出する。
軌跡算出部２６は、算出された所定時間分の自車両の速度ベクトルを積算して、当該所定時間における自車両の位置の軌跡を算出する。
投影画像生成部３０は、取得した前方画像を、図２（Ｂ）に示すように、平面（路面）に投影した投影画像を生成する。このとき、路面マークなどの路面構造に関する領域を検出し、検出された路面構造領域を、路面に投影した投影画像を生成する。なお、前方画像を路面に投影してから、路面構造領域を検出するようにしてもよい。
例えば、図４（Ａ）、（Ｂ）に示すように、自車両のＧＰＳ受信部１２のアンテナを中心とした車両座標系（Ｘｖ，Ｙｖ，Ｚｖ）と、撮像装置１４の中心の垂線の足を原点としたカメラ座標系（Ｘｃ’，Ｙｃ’，Ｚｃ’）との対応関係を、以下の（８）式のように定義する。
Figure 2012185202
ただし、ｖＬａｔｅｒａｌ、ｖＬｏｎｇｉｔｕｄｉｎａｌ、ｖＨｅｉｇｈｔは、車両座標系とカメラ座標系との原点のオフセット成分を表わし、φは、ＸＹ平面における、撮像装置１４の撮像方向（カメラ座標系の軸）と車両座標系の軸（自車両の進行方向）とのなす角を表わす。
そして、図５に示すように、前方画像上の検出位置（ｍ，ｎ）を、以下の（９）式のように投影画像上における位置（ｘ、ｙ）に変換することにより、投影画像を生成する。
Figure 2012185202
ただし、Ｈｅｉｇｈｔは、撮像装置１４の設置位置の高さを表わし、θｃは、ＹＺ平面における、撮像装置１４の撮像方向（カメラ座標系の軸）と車両座標系の軸とのなす角を表わす。また、Ｍは前方画像の横方向のピクセル数であり、αは、前方画像の横方向の長さ［ｍｍ］である。Ｎは前方画像の縦方向のピクセル数であり、βは、前方画像の縦方向の長さ［ｍｍ］である。（ｍ0，ｎ0）は、前方画像上の撮像中心であり、ｆは、焦点距離である。
ローカルマップ生成部３２は、図６に示すように、算出された所定時間の軌跡に沿って、各地点における投影画像を記録したローカルマップを生成する。ここで、ローカルマップ上の車両位置（ｅｖ，ｎｖ，ｕｖ）において検出された画像上（ｍｉ，ｎｉ）の、ローカルマップ上の位置（Ｕi，Ｅi，Ｎi）は、以下の（１０）式に従って算出される。
Figure 2012185202
ただし、φは、ロール角であり、θはピッチ角であり、Ψはヨー角（方位角：北方向を基準とした車両進行方向の角度）である。（Ｚｖｉ，Ｘｖｉ，Ｙｖｉ）Tは車両中心の座標系における、位置（ｍｉ，ｎｉ）を水平面に投影した位置であり、上記（８）式、（９）式から求められる。
上記のように、カメラの視点は高精度な軌跡推定によって取得し、その軌跡に沿って路面画像を記録していくことで高精度なローカルマップを生成する。特に、ＧＰＳのドップラー周波数を用いた軌跡推定は絶対方位の推定が可能であるため、方位角のドリフトがない軌跡推定が可能であり、蓄積誤差も少ない特徴がある。
また、アプリケーションごとに必要とされる精度及び範囲（たとえば５０ｍ先の停止線を0.3ｍの精度で取得したいなど）を確保できる範囲でローカルマップを生成する。本実施の形態における軌跡推定誤差は、例えば、１００ｍあたり0.1〜１ｍであり、その範囲であれば高精度なローカルマップ生成が期待できる。位置算出部５１で得られる位置精度はさほど高くない（数ｍ〜数１０ｍ）ため、絶対位置には誤差がある可能性があるため、生成されたローカルマップは、図７のように実際の道路路面マークの位置とはズレが生じる可能性がある。しかしながら、一定範囲においては蓄積誤差が少ないため、相対位置精度が高いローカルマップが得られる。
また、ローカルマップの構成の実例を図８に示す。たとえば、ある絶対位置を基点とし、そこから軌跡でローカルマップは生成される。その時の、方位推定精度が高いＧＰＳドップラーを利用するため、ローカルマップは軌跡の線形にそった形ではなく、直交座標系で統一することが適当であることが一つの特徴である。
また、一つのマップ上にすべての情報が展開されてもよいが、上記図８に示すように、カメラ画像から得られる情報（路面ペイントレイヤ）と軌跡の情報（軌跡情報レイヤ）とそれらから得られる統合情報（走路情報レイヤ）と、意味付けされた情報（意味情報レイヤ又は規制情報レイヤ）とが分かれた層に保持され、情報の更新やアルゴリズム改良が容易な形であることが望ましい。ただし、情報の構成方法は上記の限りではない。
また、ローカルマップ生成部３２は、更に、上記の自車両の軌跡の始点について位置算出部５１によって算出された自車両の位置（絶対位置）を、ローカルマップの原点として、ローカルマップに記録する。
ローカルマップ記憶部３４は、ローカルマップ生成部３２によって生成された複数のローカルマップが記憶されている。
コンピュータ２０は、更に、自車両の現在位置の周辺について生成されたローカルマップを検索するローカルマップ検索部３６と、現時点で生成されたローカルマップと検索されたローカルマップとを照合し、照合結果と共に、検索されたローカルマップを運転支援装置１８へ出力する照合部３８とを備えている。
ローカルマップ検索部３６は、ローカルマップが生成された場合に、位置算出部５１によって算出された自車両の位置をキーとして、自車両の位置の周辺について生成されたローカルマップを、ローカルマップ記憶部３４から検索する。
照合部３８は、現時点で生成されたローカルマップと検索されたローカルマップとの間で、ローカルマップ上に記録された投影画像に基づく照合を行い、照合結果に基づくローカルマップ間の相対位置と共に、検索されたローカルマップを、運転支援装置１８へ出力する。なお、投影画像に基づく照合では、例えば、投影画像から複数の特徴点を抽出し、特徴点間の対応付けによって、照合を行えばよい。
また、ローカルマップの検索には、必ずしも現在生成されたローカルマップで照合をとる必要はなく、撮像１回毎の投影画像や短い距離のローカルマップ（生成途中のもの）を用いて照合してもよい。
このとき、運転支援装置１８では、入力された相対位置に基づいて、ローカルマップに記録された投影画像上の路面構造に関する領域の位置を取得し、取得した位置と、路面構造とに基づいて、カーブ警報や一時停止支援などの運転支援を行う。
次に、第１の実施の形態に係る局所地図生成装置１０の作用について説明する。
まず、ＧＰＳ受信部１２によって、複数のＧＰＳ衛星から電波を繰り返し受信しているときに、コンピュータ２０において、図９に示すローカルマップ生成処理ルーチンが繰り返し実行される。
まず、ステップ１００において、ローカルマップ生成処理を実行し、自車両が走行している軌跡の周辺に関するローカルマップを生成する。
そして、ステップ１０２において、上記ステップ１００で生成されたローカルマップの原点の位置（後述するステップ１３６で算出された自車両の位置）をキーとして、当該位置の周辺について生成されたローカルマップを、ローカルマップ記憶部３４から検索して取得する。
次のステップ１０４では、上記ステップ１００で生成されたローカルマップの平行移動量Δｄ（＝（Δｅi，Δｎi，Δｕi））の初期値を設定する。また、後述する相関値の最大値を初期値として０に設定する。ステップ１０６において、上記ステップ１００で生成されたローカルマップを、上記ステップ１０４又は後述するステップ１１６で設定された平行移動量Δｄだけ平行移動させて、ステップ１０８で、上記ステップ１０２で取得したローカルマップとの相関値を算出する。相関値の算出では、ローカルマップに記録されている投影画像から特徴点を抽出し、ローカルマップ間で特徴点の対応付けを行い、対応付けを行った結果（例えば、対応付けられた特徴点間の距離）に基づいて、相関値を算出すればよい。
そして、ステップ１１０では、上記ステップ１０８で算出された相関値が、相関値の最大値より大きいか否かを判定し、最大値以下である場合には、ステップ１１４へ移行する。一方、算出された相関値が、相関値の最大値より大きい場合には、ステップ１１２において、相関値の最大値を更新して、ステップ１１４へ移行する。
ステップ１１４では、平行移動量Δｄが予め定められた探索範囲内であるか否かを判定し、探索範囲内であると、ステップ１１６において、平行移動量Δｄを、Δｄ＋δｄに更新して、上記ステップ１０６へ戻る。一方、平行移動量Δｄが予め定められた探索範囲を超えた場合には、ステップ１１８へ移行し、相関値が最大値となった平行移動量を決定する。
そして、ステップ１２０において、上記ステップ１１８で決定された平行移動量に基づいて、現在のローカルマップに対する、上記ステップ１０２で取得したローカルマップの相対位置を求め、求められた相対位置と共に、上記ステップ１０２で取得したローカルマップを、運転支援装置１８に出力して、ローカルマップ生成処理ルーチンを終了する。
上記ステップ１００は、図１０に示すローカルマップ生成処理によって実現される。
まず、ステップ１３０において、ＧＰＳ受信部１２から複数のＧＰＳ衛星の情報を取得すると共に、複数のＧＰＳ衛星のＧＰＳ擬似距離データ、ドップラー周波数、及びＧＰＳ衛星の位置座標を算出して取得する。
そして、ステップ１３２において、撮像装置１４によって撮像された前方画像を取得する。次のステップ１３４では、上記ステップ１３２で取得した前方画像を、路面に投影した投影画像を生成する。
そして、ステップ１３６において、各ＧＰＳ衛星のＧＰＳ擬似距離データを用いて、上記（１）〜（３）式に従って、自車両の位置を算出する。
次に、ステップ１３８で、後述する速度ベクトル算出処理を実行して、速度ベクトルを推定する。そして、ステップ１４０において、処理を開始してから所定時間経過したか否かを判定し、所定時間経過していない場合には、上記ステップ１３０へ戻る。一方、所定時間経過した場合には、所定時間分の投影画像及び速度ベクトルが得られたと判断し、ステップ１４２へ移行する。
ステップ１４２では、上記ステップ１３８で算出された所定時間分の速度ベクトルを積算して、自車両の軌跡を算出する。そして、ステップ１４４において、上記ステップ１４２で算出された自車両の軌跡に沿って、軌跡の各点について、上記ステップ１３４で生成された投影画像を記録して、ローカルマップを生成し、ローカルマップ記憶部３４に格納し、リターンする。
また、上記ステップ１３８は、図１１に示す速度ベクトル算出処理によって実現される。
ステップ１５０において、上記（４）式に従って、各ＧＰＳ衛星からの受信信号のドップラー周波数から、各ＧＰＳ衛星に対する自車両の相対速度ｖｊを算出する。
次に、ステップ１５２で、取得した各ＧＰＳ衛星の位置座標の時系列データから、ケプラーの方程式の微分を用いて、各ＧＰＳ衛星の速度ベクトル（ＶＸｊ、ＶＹｊ、ＶＺｊ）を算出する。
次に、ステップ１５４で、上記ステップ１３６で算出された自車両の位置、及び上記ステップ１３０で取得された各ＧＰＳ衛星の位置座標に基づいて、各ＧＰＳ衛星ｊの位置と自車両の位置との角度関係Ｒｊ（水平方向に対する仰角θｊ、北方向に対する方位角φｊ）を、各ＧＰＳ衛星の方向として算出する。
次に、ステップ１５６で、上記ステップ１５０で算出された各ＧＰＳ衛星に対する自車両の相対速度ｖｊ、上記ステップ１５２で算出された各ＧＰＳ衛星の速度ベクトルＶｊ（ＶＸｊ、ＶＹｊ、ＶＺｊ）、及び上記ステップ１５４で算出された各ＧＰＳ衛星の方向Ｒｊ（θｊ、φｊ）に基づいて、上記（５）式に従って、各ＧＰＳ衛星ｊの方向の自車両の速度Ｖｖｊを算出する。（５）式における自車方向のＧＰＳ衛星ｊの速度Ｖｓｊは、Ｖｓｊ＝Ｒｊ［ＶＸｊ，ＶＹｊ，ＶＺｊ］Ｔにより算出する。
次に、ステップ１５８で、上記（６）式、及び（７）式に従って、自車両の速度ベクトル（Ｖｘ，Ｖｙ，Ｖｚ）の最適値を算出して、リターンする。
以上説明したように、第１の実施の形態に係る局所地図生成装置によれば、ドップラー周波数を用いて算出された速度ベクトルを積算して、自車両の軌跡を算出し、自車両の軌跡上の各点について取得された路面投影画像を、ローカルマップ上の各領域に記録することにより、簡易な構成で、精度の高いローカルマップを生成することができる。
また、高精度な軌跡を利用することを特徴とするため、一定の範囲内の軌跡の異積誤差は小さい。高精度軌跡に沿って検出した路面構造情報を記録することによって、情報間の相対位置関係の精度は高くなる。そのため、絶対的な位置精度は正しくなくても、ローカルな地図精度が確保できるため、ローカルマップ内では地図の情報を有効に利用でき、適切な運転支援を行なうことができる。
次に、第２の実施の形態に係る局所地図生成装置について説明する。なお、第１の実施の形態と同様の構成となる部分については、同一符号を付して説明を省略する。
第２の実施の形態では、ＧＰＳ情報を用いずに、ローカルマップを生成している点が、第１の実施の形態と異なっている。
図１２に示すように、第２の実施の形態に係る局所地図生成装置２１０は、撮像装置１４と、自車両の進行方向の方位角を検出する磁気センサ２１２と、自車両のヨーレートを検出するジャイロセンサ２１３と、自車両の速度を検出する速度センサ２１４と、磁気センサ２１２、ジャイロセンサ２１３、及び速度センサ２１４の各検出値と、撮像装置１４によって撮像された前方画像とに基づいて、ローカルマップを生成するコンピュータ２２０と、を備えている。なお、磁気センサ２１２、ジャイロセンサ２１３、及び速度センサ２１４は、運動状態検出手段の一例である。
コンピュータ２２０は、磁気センサ２１２の検出値に基づいて、自車両の進行方向の方位角を決定する方位決定部２２４と、決定された方位角、ジャイロセンサ２１３からの検出値、及び速度センサ２１４からの検出値に基づいて、所定時間における自車両の軌跡を算出する軌跡算出部２２６と、画像取得部２８と、投影画像生成部３０と、ローカルマップ生成部３２と、ローカルマップ記憶部３４とを備えている。
軌跡算出部２２６は、ジャイロセンサ２１３によって検出された所定時間分のヨーレート及び速度センサ２１４によって検出された所定時間分の速度を積算し、積算した結果と、方位決定部２２４によって決定された進行方向の方位角とに基づいて、当該所定時間における自車両の位置の軌跡を算出する。
次に、第２の実施の形態におけるローカルマップ生成処理について、図１３を参照して説明する。なお、第１の実施の形態と同様の処理については同一符号を付して説明を省略する。
まず、ステップ２５０において、磁気センサ２１２、ジャイロセンサ２１３、及び速度センサ２１４の各々からセンサ出力を取得する。そして、ステップ１３２において、撮像装置１４によって撮像された前方画像を取得し、次のステップ１３４では、上記ステップ１３２で取得した前方画像を、路面に投影した投影画像を生成する。
そして、ステップ１４０において、処理を開始してから所定時間経過したか否かを判定し、所定時間経過していない場合には、上記ステップ２５０へ戻る。一方、所定時間経過した場合には、所定時間分の投影画像及びセンサ出力が得られたと判断し、ステップ２５２へ移行する。
ステップ２５２では、上記ステップ２５０で取得した磁気センサ２１２からの出力に基づいて、後述するステップ２５４で算出する軌跡の始点における自車両の進行方向の方位角を決定する。
そして、ステップ２５４において、上記ステップ２５０で取得した所定時間分のジャイロセンサ２１３及び速度センサ２１４からの出力と、上記ステップ２５２で決定された方位角とに基づいて、自車両の軌跡を算出する。そして、ステップ１４４において、上記ステップ１４２で算出された自車両の軌跡に沿って、軌跡の各点について、上記ステップ１３４で生成された投影画像を記録して、ローカルマップを生成し、ローカルマップ記憶部３４に格納し、リターンする。
なお、第２の実施の形態に係る局所地図生成装置の他の構成及び作用については、第１の実施の形態と同様であるため、説明を省略する。
以上説明したように、第２の実施の形態に係る局所地図生成装置によれば、磁気センサから自車両の方位角を推定すると共に、ジャイロセンサ及び速度センサによって検出されるヨーレート及び速度を積算して、自車両の軌跡を算出し、自車両の軌跡上の各点について取得された路面投影画像を、ローカルマップ上の各領域に記録することにより、簡易な構成で、精度の高いローカルマップを生成することができる。
次に、第３の実施の形態に係る局所地図生成装置について説明する。なお、第１の実施の形態と同様の構成となる部分については、同一符号を付して説明を省略する。
第３の実施の形態では、ＧＰＳ情報から算出される速度ベクトルと、磁気センサ、ジャイロセンサ、及び速度センサからのセンサ出力とを組み合わせて、自車両の軌跡を算出している点が、第１の実施の形態と異なっている。
図１４に示すように、第３の実施の形態に係る局所地図生成装置３１０は、ＧＰＳ受信部１２、撮像装置１４と、磁気センサ２１２と、ジャイロセンサ２１３と、速度センサ２１４と、ＧＰＳ受信部１２によって受信されたＧＰＳ衛星からの受信信号、磁気センサ２１２、ジャイロセンサ２１３、及び速度センサ２１４の各検出値、並びに撮像装置１４によって撮像された前方画像に基づいて、ローカルマップを生成するコンピュータ３２０と、を備えている。
コンピュータ３２０は、ＧＰＳ情報取得部２２、位置・速度ベクトル算出部２４、方位決定部２２４と、決定された方位角、ジャイロセンサ２１３からの検出値、速度センサ２１４からの検出値、及び算出された速度ベクトルに基づいて、所定時間における自車両の軌跡を算出する軌跡算出部３２６と、画像取得部２８と、投影画像生成部３０と、ローカルマップ生成部３２と、ローカルマップ記憶部３４とを備えている。
軌跡算出部３２６は、ＧＰＳの測位状況が劣化していない場合に、上記第１の実施の形態と同様に、所定時間分の速度ベクトルを積算して、当該所定時間における自車両の位置の軌跡を算出する。また、軌跡算出部３２６は、ＧＰＳの測位状況が劣化している場合には、上記第２の実施の形態と同様に、ジャイロセンサ２１３によって検出された所定時間分のヨーレート及び速度センサ２１４によって検出された所定時間分の速度を積算し、積算した結果と、方位決定部２２４によって決定された進行方向の方位角とに基づいて、当該所定時間における自車両の位置の軌跡を算出する。
なお、特に測位状況にかかわらず、常時、ＧＰＳ受信部１２、磁気センサ２１２、ジャイロセンサ２１３、及び速度センサ２１４を用いて軌跡を推定してもよい。
なお、第３の実施の形態に係る局所地図生成装置の他の構成及び作用については、第１の実施の形態と同様であるため、説明を省略する。
このように、ドップラー周波数に基づいて算出される速度ベクトルを積算して移動体の軌跡を算出し、自車両の軌跡上の各点について取得された路面投影画像を、ローカルマップ上の各領域に記録することにより、簡易な構成で、精度の高いローカルマップを生成することができる。また、ＧＰＳ情報が得られない場合においても、磁気センサから自車両の方位角を推定すると共に、ジャイロセンサ及び速度センサにより検出されたヨーレート及び速度を積算して、自車両の軌跡を算出し、自車両の軌跡上の各点について取得された路面投影画像を、ローカルマップ上の各領域に記録することにより、安定して、ローカルマップを生成することができる。
次に、第４の実施の形態について説明する。第４の実施の形態では、絶対座標系で表わされるグローバルマップを生成するグローバル地図生成装置に、本発明を適用した場合を例に説明する。なお、第１の実施の形態と同様の構成となる部分については、同一符号を付して説明を省略する。
図１５に示すように、第４の実施の形態に係るグローバル地図生成装置４１０は、ＧＰＳ受信部１２と、撮像装置１４と、ＧＰＳ受信部１２によって受信されたＧＰＳ衛星からの受信信号、及び撮像装置１４によって撮像された前方画像に基づいて、ローカルマップを生成し、ローカルマップを合成して、グローバルマップを生成すると共に、グローバルマップから得られる自車両周辺の情報を運転支援装置１８へ出力するコンピュータ４２０と、を備えている。
コンピュータ４２０を以下で説明するグローバルマップ生成処理ルーチン及び運転支援制御処理ルーチンに従って機能ブロックで表すと、上記図１５に示すように、ＧＰＳ情報取得部２２と、位置・速度ベクトル算出部２４と、軌跡算出部２６と、画像取得部２８と、投影画像生成部３０と、算出された所定時間の軌跡に沿って、投影画像を記録したローカルマップを生成すると共に、当該軌跡の始点（当該ローカルマップの原点）において得られたＧＰＳ情報をローカルマップに記録するローカルマップ生成部４３２と、ローカルマップ記憶部３４と、ローカルマップ検索部３６と、生成されたローカルマップと検索されたローカルマップとを照合すると共に、照合結果に基づいて、２つのローカルマップの相対位置を出力するローカルマップ照合部４３８と、照合させた状態で、生成されたローカルマップと検索されたローカルマップとを合成するローカルマップ合成部４４０と、生成されたローカルマップ及び検索されたローカルマップの各々からＧＰＳ情報を取得するＧＰＳ情報取得部４４２と、取得した２つのローカルマップのＧＰＳ情報と、２つのローカルマップの相対位置とに基づいて、絶対位置を推定する位置推定部４４４と、推定された絶対位置に基づいて、合成したローカルマップを、グローバルマップ上に記録するグローバルマップ生成部４４６と、グローバルマップ記憶部４４８と、を備えている。
ローカルマップ生成部４３２は、上記の第１の実施の形態と同様に、ローカルマップを生成する。また、ローカルマップ生成部４３２は、更に、上記の自車両の軌跡における始点について、ＧＰＳ情報取得部２２によって取得された、図１６に示すようなＧＰＳ情報を、ローカルマップに記録する。
なお、ＧＰＳ情報を記録する地点はローカルマップの原点（軌跡の始点）である必要はなく、計測回のたびに記録していてもよいし、一定間隔でもよいし、特定の箇所でもよい。複数のローカルマップの照合が可能であり、グローバルな精度向上が可能であるならば、そのデータ種別や保持頻度は問わない。
ローカルマップ照合部４３８は、生成されたローカルマップと検索されたローカルマップとの間で、ローカルマップ上に記録された投影画像に基づく照合を行い、照合結果に基づくローカルマップ間の相対位置を、ローカルマップ合成部４４０へ出力する。
ローカルマップ合成部４４０は、ローカルマップ照合部４３８による照合結果に基づいて、生成されたローカルマップと検索されたローカルマップとを照合させた状態で合成する。
次に、本実施の形態の原理について説明する。
ローカルマップ生成部４３２によって生成された高精度なローカルマップは、一定の範囲内においては周辺の相対位置関係が精度よく記録されている。その高精度な相対位置関係が保持されたローカルマップを、図１７、図１８に示すように複数回走行によって複数枚用意する。生成された複数枚のローカルマップは、その起点や範囲にズレはあったとしても、記録された情報間の相対位置関係が正しいため、図１９に示すように、情報同士の対応付けによってローカルマップ間の相対位置関係を精度よく取得することが可能になる。
一方、一般的なＧＰＳを用いた測位結果は数ｍ〜都心部では数十ｍの誤差をもつ。しかしながら、複数枚のローカルマップの相対位置関係とその時のＧＰＳ情報とを利用し、測位結果の最適値を求めることで高精度化が可能になる。
通常のＧＰＳを用いた測位は可視衛星が４以上存在しないと測位ができない。また反射波が主波となるような場合、その影響を大きく受け測位誤差が大きくなる可能性がある。しかしながら、相対位置関係を利用して別走行時の他地点で得られたＧＰＳ情報を利用することで、仮想的に衛星数を増加させることができる。また、別時刻の衛星を用いることができるため、衛星の配置に偏りがなくなり、精度が向上する可能性がある。また、衛星数が増加することから誤差の大きい衛星を排除しやすくなり、精度向上を実現できる。
そこで、本実施の形態では、ＧＰＳ情報取得部４４２によって、生成されたローカルマップ及び検索されたローカルマップの各々から、原点について記録されたＧＰＳ情報を取得する。
また、位置推定部４４４は、取得した２つのローカルマップのＧＰＳ情報と、２つのローカルマップの相対位置とに基づいて、現時点で生成されたローカルマップの原点の絶対位置を推定する。
ここで、２つの地点で得られたＧＰＳ情報と、２つの地点の相対位置とを用いて、絶対位置を推定する原理について説明する。
まず、同一地点（Ｘv、Ｙｖ、Ｚｖ）におけるＧＰＳデータの蓄積による位置推定では、以下の（１１）式が成立する。
Figure 2012185202
取得した各ＧＰＳ衛星の擬似距離ごとに式が成立し、蓄積したデータ数分集めた数の式が成立する。受信機の時計誤差であるクロックバイアスは受信タイミングごとに異なるため、蓄積データ数分のクロックバイアスを推定する必要がある。未知数は（Ｘｖ、Ｙｖ、Ｚv）とｎ個のＣbであるため、３＋ｎ個分の衛星数が蓄積によって確保されていれば方程式を解くことができる。しかし、通常、移動体において常に同一地点で計測することは現実的ではない。
上記（１１）式は、測位地点が異なる、各地点（Ｘｖ（ｔ0），‘Ｙv（ｔ0），Ｚｖ（ｔ0）），（Ｘｖ（ｔｉ），Ｙｖ（ｔｉ），Ｚｖ（ｔｉ））ごとにも成立するため、以下の（１２）式に示す方程式が得られる。
Figure 2012185202
移動車両の場合、同一地点での取得が困難であるため、上記（１２）式の方程式に相当するが、上記（１２）式はデータを取得した時刻に相当する位置（Ｘｖ（ｔｉ），Ｙｖ（ｔｉ），Ｚｖ（ｔｉ））ごとに成立するため、未知数が４×ｎとなり、蓄積の意味がない。しかしながら、本実施の形態では、各位置間の相対位置を、ローカルマップの照合結果から取得し、相対位置（ΔＸｉ0（ｔ0），ΔＹｉ0（ｔ0），ΔＺｉ0（ｔ0））を求め、相対位置を用いて（Ｘｖ（ｔｉ），Ｙｖ（ｔｉ），Ｚｖ（ｔｉ））は（Ｘｖ（ｔｉ），Ｙｖ（ｔｉ），Ｚｖ（ｔｉ））＝（Ｘｖ（ｔ0）−Δｘｉ0（ｔ0），Ｙｖ（ｔ0）−Δｙｉ0（ｔ0），Ｚｖ（ｔ0）−Δｚｉ0（ｔ0））と表現できる。そのため、上記（１２）式が、以下の（１３）式の形に書き換えられる。
Figure 2012185202
上記（１３）式は各時刻での位置間の相対位置が得られているため、未知数は３＋ｎとなるため、上記（１１）式と同じになる。よって、同一地点で繰り返し計測することと同じ状況を実現できる。
また、照合されたローカルマップの原点間の相対位置関係とその時のＧＰＳ情報とを用いた、最適位置推定について図２０に示す。この最適位置推定では、上記（１３）式に必要な情報を前段から取得し、最適推定を行う。上記（１３）式において、推定パラメータは３次元位置と各時刻の受信機のクロックバイアスの３＋ｎ個としたが、高さの制限や受信機の性能などによって、パラメータを減ずることもできる。相対位置関係を用いて、各地点のＧＰＳ情報を用いて位置推定をする限りにおいては、特に最適位置推定のパラメータ数やその最適解の求め方については、特に限定しない。
上記の最適位置推定において、衛星数を仮想的に増加させることが可能であるため、平均化の効果により測位精度の向上が見込まれる。平均化の効果だけでなく、衛星数が増えているため、測位に必要な衛星の組み合わせを様々に変化させることができる。特定の衛星を測位に利用した場合に他の組み合わせと測位結果が異なる場合、その衛星から信号がマルチパスである可能性が高い。蓄積によりマルチパスの判定が容易であるため、積極的にマルチパス判定を行い、マルチパスと考えられる衛星の情報を用いないようにすることで、精度向上が期待できる。
以上説明したように、位置推定部４４４は、合成した２つ以上のローカルマップのＧＰＳ情報と、２つのローカルマップの相対位置とに基づいて、上記（１３）式に従って、現時点で生成されたローカルマップの原点について、絶対位置を推定する。また、未知数が４つのとき、衛星数が５以上である場合には、衛星の組み合わせ毎に、絶対位置を推定し、推定された絶対位置に基づいて、マルチパス判定を行い、マルチパスと判定された衛星の情報を除去して、再度、現時点で生成されたローカルマップの原点の絶対位置の推定を行う。未知数が３＋ｎの場合、４＋ｎの衛星数があるとマルチパス判定ができる。なお、絶対位置の推定は、検索されたローカルマップの原点について行ってもよく、２つ以上のローカルマップの原点の各々について行ってもよい。
グローバルマップ生成部４４６は、絶対座標系で表されたグローバルマップ上の、位置推定部４４４によって推定された絶対位置に従って定められる領域に、合成されたローカルマップを記録する。
グローバルマップ記憶部４４８は、グローバルマップ生成部４４６によって生成されたグローバルマップが記憶されている。
コンピュータ４２０は、更に、位置算出部５１によって算出された自車両の位置に基づいて、グローバルマップ記憶部４４８から、自車両の周辺のマップ情報を取得し、運転支援装置１８へ出力するマップ情報取得部４５０を備えている。
マップ情報取得部４５０は、位置算出部５１によって算出された自車両の位置をキーとして、グローバルマップ記憶部４４８から、自車両の位置の周辺について記録されたマップ情報（ローカルマップに記録された情報）を検索し、運転支援装置１８へ出力する。
次に、第４の実施の形態に係るグローバル地図生成装置４１０の作用について説明する。なお、第１の実施の形態と同様の処理については、同一符号を付して説明を省略する。
まず、ＧＰＳ受信部１２によって、複数のＧＰＳ衛星から電波を繰り返し受信しているときに、コンピュータ４２０において、図２１、２２に示すグローバルマップ生成処理ルーチンが繰り返し実行される。
まず、ステップ１００において、上記図１０に示すローカルマップ生成処理を実行し、自車両が走行している軌跡の周辺に関するローカルマップを生成する。次のステップ４５８では、上記ステップ１３０で軌跡の始点について取得されたＧＰＳ情報を、生成されたローカルマップに記録する。
そして、ステップ１０２において、上記ステップ１００で生成されたローカルマップの原点の位置をキーとして、当該位置の周辺について生成されたローカルマップを、ローカルマップ記憶部３４から検索して取得する。
次のステップ１０４では、上記ステップ１００で生成されたローカルマップの平行移動量Δｄ（＝（Δｅi，Δｎi，Δｕi））の初期値を設定すると共に、相関値の最大値を０に設定する。ステップ１０６において、上記ステップ１００で生成されたローカルマップを、設定された平行移動量Δｄだけ平行移動させて、ステップ１０８で、上記ステップ１０２で取得したローカルマップとの相関値を算出する。
そして、ステップ１１０では、上記ステップ１０８で算出された相関値が、相関値の最大値より大きいか否かを判定し、最大値以下である場合には、ステップ１１４へ移行する。一方、算出された相関値が、相関値の最大値より大きい場合には、ステップ１１２において、相関値の最大値を更新して、ステップ１１４へ移行する。
ステップ１１４では、平行移動量Δｄが予め定められた探索範囲内であるか否かを判定し、探索範囲内であると、ステップ１１６において、平行移動量Δｄを、Δｄ＋δｄに更新して、上記ステップ１０６へ戻る。一方、平行移動量Δｄが予め定められた探索範囲を超えた場合には、ステップ１１８へ移行し、相関値が最大値となった平行移動量を決定する。
そして、ステップ４６０において、上記ステップ１１８で決定された平行移動量に基づいて、現在のローカルマップの原点に対する、上記ステップ１０２で取得したローカルマップの原点の相対位置を求めると共に、上記ステップ１００で生成されたローカルマップを、設定された平行移動量Δｄだけ平行移動させた状態で、上記ステップ１０２で取得したローカルマップと合成する。
次のステップ４６２では、上記ステップ４５８で記録されたＧＰＳ情報を取得すると共に、上記ステップ１０２で取得したローカルマップに記録された原点のＧＰＳ情報を取得する。そして、ステップ４６４において、上記ステップ４６０で算出された相対位置と、上記ステップ４６２で取得したＧＰＳ情報とに基づいて、上記ステップ１００で生成されたローカルマップの原点の絶対位置を推定する。
そして、ステップ４６６において、上記ステップ４６４で推定された絶対位置に基づいて、グローバルマップ上に、上記ステップ４６０で合成されたローカルマップを記録して、グローバルマップ生成処理ルーチンを終了する。
上記のグローバルマップ生成処理ルーチンが繰り返し実行されることにより、複数地点において、合成されたローカルマップが記録されたグローバルマップが生成される。
また、コンピュータ４２０によって、図２３に示す運転支援制御処理ルーチンが繰り返し実行される。
まず、ステップ４７０において、ＧＰＳ受信部１２から複数のＧＰＳ衛星の情報を取得すると共に、複数のＧＰＳ衛星のＧＰＳ擬似距離データ、ドップラー周波数、及びＧＰＳ衛星の位置座標を算出して取得する。
そして、ステップ４７２において、各ＧＰＳ衛星のＧＰＳ擬似距離データを用いて、上記（１）〜（３）式に従って、自車両の位置を算出する。次のステップ４７４では、グローバルマップ記憶部４４８から、上記ステップ４７２で算出された自車両の位置をキーとして、周辺のマップ情報を取得し、ステップ４７６において、上記ステップ４７４で取得したマップ情報を、運転支援装置１８に出力して、運転支援制御処理ルーチンを終了する。
以上説明したように、第４の実施の形態に係るグローバル地図生成装置によれば、精度の高いローカルマップを生成し、ローカルマップに記録された路面投影画像を照合して複数のローカルマップを合成し、推定された絶対位置に従って、絶対座標系で表わされるグローバルマップ上に、合成された複数のローカルマップを記録することにより、簡単な構成で、精度の高いグローバルマップを生成することができる。
軌跡精度が高いため、一定範囲内の相対精度は高いが、広範囲になると誤差が蓄積する。そのため、なんらかの拘束条件が必要であり、本実施の形態では、共通の座標系である絶対位置で拘束する。通常のナビ用ＧＰＳの精度はせいぜい数メートルであるため、一度の走行では絶対的な精度が低い。一方、繰り返し走行して生成されたローカルマップの相対精度は高いため、複数のローカルマップ間の相対位置関係は高精度に取得可能である。ローカルマップ間の相対位置が取得できれば、相対位置関係を拘束条件にして、絶対位置を最適化することで精度が向上する。ナビ用ＧＰＳを用いた場合、たとえば各ローカルマップを生成したときのＧＰＳ情報を集め、複数回分のデータで測位を行うことができる。そうすることで衛星の数が増え、さらに誤差の大きい衛星を排除しやすくなり、絶対位置の高精度化が期待できる。このように、繰り返し効果により、ＧＰＳの測位精度より高い精度で、グローバルマップを生成することができる。
また、通常は、専用の計測車両で走行し、人手によって必要な情報を抽出するものであるが、本実施の形態では、一般車両に搭載されるセンサで、高精度な計測車両と同等の精度で、地図を生成することができるため、地図の生成コストを低減することができる。
また、一般車両によって取得可能なデータを用いており、常時データの計測が可能であるため、高精度な地図の更新が容易であり、地図のメンテナンスコストを低減することができる。
また、高精度な軌跡を利用して、相対的な精度が確保されたローカルマップを生成し、繰り返し走行によって得られた複数のローカルマップの位置あわせによってローカルマップ間の相対位置を高精度に取得し、その相対位置関係を拘束条件として、絶対精度を確保することができる。
また、ローカルマップ間の相対位置を推定し、相対位置を媒介させることにより、走行しながら得られた異なる地点でのＧＰＳ情報同士を統合することが可能になる。そのため、同一地点でＧＰＳ情報を取得する必要がない。
また、１回のＧＰＳ情報の取得では衛星数が不足する場合においても、複数回分のＧＰＳ情報を用いることで、衛星数を模擬的に増加させることができるため、測位が可能になり、測位率が向上する。
次に、第５の実施の形態に係るグローバル地図生成装置について説明する。なお、第１の実施の形態及び第４の実施の形態と同様の構成となる部分については、同一符号を付して説明を省略する。
第５の実施の形態では、合成されたローカルマップの各々に記録された測位結果に基づいて、最適推定を行うことにより、絶対位置を推定している点が、第４の実施の形態と異なっている。
図２４に示すように、第５の実施の形態に係るグローバル地図生成装置５１０のコンピュータ５２０は、ＧＰＳ情報取得部２２と、位置・速度ベクトル算出部２４と、軌跡算出部２６と、画像取得部２８と、投影画像生成部３０と、ローカルマップ生成部３２と、ローカルマップ記憶部３４と、ローカルマップ検索部３６と、ローカルマップ照合部４３８と、ローカルマップ合成部４４０と、生成されたローカルマップ及び検索されたローカルマップの各々について記録された測位結果に基づいて、絶対位置を推定する位置推定部５４４と、グローバルマップ生成部４４６と、グローバルマップ記憶部４４８と、マップ情報取得部４５０とを備えている。
ローカルマップ生成部３２は、算出された所定時間の軌跡に沿って、投影画像を記録したローカルマップを生成すると共に、当該軌跡の各地点について位置算出部５１により算出された位置（測位結果）をローカルマップに記録する。
位置推定部５４４は、生成されたローカルマップ及び検索されたローカルマップの各々について記録された、各点の測位結果に基づいて、例えば、最小二乗法などを用いた最適推定を行って、生成されたローカルマップの軌跡上の各地点の絶対位置を推定する。
なお、第５の実施の形態に係るグローバル地図生成装置５１０の構成及び作用については、第４の実施の形態と同様であるため、説明を省略する。
このように、ローカルマップ間の相対位置と、ローカルマップ上に記録された測位結果とに基づいて、最適推定を行うことにより、精度良く絶対位置を推定することができ、精度の高いグローバルマップを生成することができる。
なお、上記の実施の形態では、ローカルマップ上の軌跡の各点について測位結果を記録する場合を例に説明したが、これに限定されるものではなく、ローカルマップ上の軌跡の原点や特定点について測位結果を記録し、これらの測位結果に基づいて、絶対位置を最適推定するようにしてもよい。
また、上記の第１の実施の形態〜第４の実施の形態では、ローカルマップ上の軌跡の原点について測位結果を記録する場合を例に説明したが、これに限定されるものではなく、ローカルマップ上の軌跡の他の特定点について測位結果を記録するようにしてもよい。
また、ローカルマップ上の軌跡の各点について測位結果を記録するようにしてもよい。この場合、ＲＴＫ−ＧＰＳなどの干渉測位によって高精度に計測できた結果のみを記録するようにしてもよい。また、ＧＰＳと各種センサとを統合して求めた自車両の位置を記録するようにしてもよい。
また、ビーコンなどによって、常に計測できる固定点を利用して、測位しても良い。また、画像から得られる特定の地点を利用して測位してもよい。この場合には、正確な位置情報を対応付けて画像を記憶した画像照合データベースを設け、撮像画像と、画像照合データベースの画像とを照合することにより、測位するようにすればよい。
また、周辺の環境情報を取得する手段として撮像装置を用いた場合を例に説明したが、これに限定されるものではなく、複数台の撮像装置を用いて、ステレオによって物体までの距離を推定し、その値を、環境情報として用いてもいい。また、レーザレーダを用いて、周辺に存在する物体までの距離を直接計測するようにしてもよい。また、撮像装置とレーザーとを組み合わせて、周辺の環境情報を取得するようにしてもよい。
また、ローカルマップ記憶部やグローバルマップ記憶部を、車両と通信可能なサーバに設けてもよい。これによって、自車両が初めて走行する道路であっても、他車両が走行した道路であれば、マップの情報を利用することが可能になる。
また、グローバルマップを生成する際に、絶対位置を推定する場合を例に限定されるものではなく、上記第４の実施の形態または第５の実施の形態で説明した絶対位置を推定する技術を、上記第１の実施の形態〜第３の実施の形態に適用してもよい。これによって、ローカルマップ上の特定点の絶対位置精度を向上させることができるため、相対位置で記述されたローカルマップの精度も向上し、相対位置精度だけでなく、絶対位置精度を向上させることも可能になる。
また、上記実施の形態では、速度ベクトルを算出する場合を例に説明したが、これに限定されるものではなく、自車両の方位角を算出すると共に、自車両の速度を検出し、自車両の方位角と速度からなる速度情報を用いてもよい。この場合には、所定時間分の自車両の方位角と速度とから軌跡を算出するようにすればよい。
また、上記の第４の実施の形態、第５の実施の形態において、上記の第２の実施の形態または第３の実施の形態で説明した技術を適用してもよい。例えば、ＧＰＳ情報を用いずに自車両の軌跡を算出したり、ＧＰＳ情報と各種センサ出力とを用いて自車両の軌跡を算出するようにしてもよい。
また、ＧＰＳの計測値とジャイロ、速度センサの組み合わせによる複合航法結果を用いて、自車両の位置を算出するようにしてもよい。
また、上記実施の形態では、車両に搭載される局所地図生成装置やグローバル地図生成装置について説明したが、本発明の局所地図生成装置やグローバル地図生成装置が搭載される移動体は車両に限定されない。例えば、局所地図生成装置またはグローバル地図生成装置をロボットに搭載してもよいし、歩行者が携帯できるように局所生成装置またはグローバル地図生成装置をポータブル端末として構成するようにしてもよい。
１０、２１０、３１０ 局所地図生成装置
１２ 受信部
１４ 撮像装置
２０、２２０、３２０、４２０、５２０ コンピュータ
２２ ＧＰＳ情報取得部
２４ 位置・速度ベクトル算出部
２６、２２６、３２６ 軌跡算出部
２８ 画像取得部
３０ 投影画像生成部
３２、４３２ ローカルマップ生成部
３４ ローカルマップ記憶部
３６ ローカルマップ検索部
３８ 照合部
５１ 位置算出部
７０ 自車両速度算出部
２１２ 磁気センサ
２１３ ジャイロセンサ
２１４ 速度センサ
２２４ 方位決定部
４１０、５１０、５１０ グローバル地図生成装置
４３８ ローカルマップ照合部
４４０ ローカルマップ合成部
４４２ ＧＰＳ情報取得部
４４４、５４４位置推定部
４４６ グローバルマップ生成部
４４８ グローバルマップ記憶部

Claims (11)

  1. 移動体に搭載され、かつ、設置位置から見た前記移動体の周辺の環境情報を取得する環境情報取得手段と、
    複数のＧＰＳ衛星の各々から送信された前記ＧＰＳ衛星の各々の位置に関する情報、前記ＧＰＳ衛星の各々と前記移動体との距離に関する情報、及び前記ＧＰＳ衛星の各々に対する前記移動体の相対速度に関する情報を含む衛星情報を取得する衛星情報取得手段と、
    前記衛星情報取得手段により取得された前記衛星情報に基づいて、前記移動体の進行方向を含む速度ベクトル、又は前記移動体の速度及び前記移動体の進行方向を示す速度情報を算出する算出手段と、
    前記算出手段により算出された前記移動体の前記速度情報を積算して、前記移動体の位置の軌跡を算出する軌跡算出手段と、
    前記軌跡算出手段によって算出された前記移動体の位置の軌跡上の各点について前記環境情報取得手段によって取得された前記環境情報を、前記軌跡上の各点における前記移動体の進行方向と、前記環境情報取得手段の設置位置及び姿勢とに基づいて定められる、前記移動体の位置の軌跡を含む局所地図上の各領域に記録する局所地図生成手段と、
    を含む局所地図生成装置。
  2. 移動体に搭載され、かつ、設置位置から見た前記移動体の周辺の環境情報を取得する環境情報取得手段と、
    前記移動体の運動状態を検出する運動状態検出手段と、
    前記運動状態検出手段により検出された前記移動体の運動状態に基づいて、前記移動体の基準方向の方位角を推定する方位角推定手段と、
    前記運動状態検出手段により検出された前記移動体の運動状態を積算し、前記積算された前記移動体の運動状態と、前記方位角推定手段によって推定された前記方位角とに基づいて、前記移動体の位置の軌跡を算出する軌跡算出手段と、
    前記軌跡算出手段によって算出された前記移動体の位置の軌跡上の各点について前記環境情報取得手段によって取得された前記環境情報を、前記軌跡上の各点における前記移動体の進行方向と、前記環境情報取得手段の設置位置及び姿勢とに基づいて定められる、前記移動体の位置の軌跡を含む局所地図上の各領域に記録する局所地図生成手段と、
    を含む局所地図生成装置。
  3. 複数のＧＰＳ衛星の各々から送信された前記ＧＰＳ衛星の各々の位置に関する情報、前記ＧＰＳ衛星の各々と前記移動体との距離に関する情報、及び前記ＧＰＳ衛星の各々に対する前記移動体の相対速度に関する情報を含む衛星情報を取得する衛星情報取得手段と、
    前記衛星情報取得手段により取得された前記衛星情報に基づいて、前記移動体の進行方向を含む速度ベクトル、又は前記移動体の速度及び前記移動体の進行方向を示す速度情報を算出する算出手段と、を更に含み、
    前記方位角推定手段は、前記運動状態検出手段により検出された前記移動体の運動状態、及び前記算出手段によって算出された前記速度情報に基づいて、前記移動体の基準方向の方位角を推定し、
    前記軌跡算出手段は、前記運動状態検出手段により検出された前記移動体の運動状態、前記算出手段によって算出された前記速度情報、及び前記方位角推定手段によって推定された前記方位角に基づいて、前記移動体の位置の軌跡を算出する請求項２記載の局所地図生成装置。
  4. 前記算出手段は、前記ＧＰＳ衛星の各々の位置に関する情報、及び前記ＧＰＳ衛星の各々と前記移動体との距離に関する情報から得られる前記移動体の位置に基づいて、前記移動体から見た前記ＧＰＳ衛星の各々の方向を算出し、時系列の前記ＧＰＳ衛星の各々の位置に関する情報に基づいて、前記ＧＰＳ衛星の各々の速度を算出し、前記移動体から見た前記ＧＰＳ衛星の各々の方向、前記ＧＰＳ衛星の各々の速度、及び前記ＧＰＳ衛星の各々に対する前記移動体の相対速度に関する情報に基づいて、前記移動体のＧＰＳ衛星の各々の方向の速度を算出し、複数の前記移動体のＧＰＳ衛星の各々の方向の速度に基づいて、前記移動体の速度ベクトルを算出する請求項１又は３記載の局所地図生成装置。
  5. 前記ＧＰＳ衛星の各々の位置に関する情報を、衛星軌道情報とし、前記ＧＰＳ衛星の各々と前記移動体との距離に関する情報を、擬似距離情報とし、前記ＧＰＳ衛星の各々に対する前記移動体の相対速度に関する情報を、ドップラー周波数情報とした請求項１、３、又は４記載の局所地図生成装置。
  6. 前記環境情報取得手段を、前記移動体の周辺を撮像する撮像手段、又は前記移動体の周辺に存在する物体までの距離情報を計測するレーザレーダとした請求項１〜請求項５の何れか１項記載の局所地図生成装置。
  7. 請求項１〜請求項６の何れか１項に記載の局所地図生成装置と、
    前記生成された複数の局所地図を記憶した局所地図記憶手段と、
    複数の局所地図間で、前記局所地図に記録された前記環境情報を照合し、前記環境情報を照合させた状態で前記複数の局所地図を合成する合成手段と、
    前記合成手段によって合成された前記複数の局所地図の前記軌跡上の少なくとも１点の絶対位置を推定する位置推定手段と、
    前記位置推定手段によって推定された絶対位置に基づいて、絶対座標系で表わされるグローバル地図上に、前記合成手段によって合成された前記複数の局所地図を記録するグローバル地図生成手段と、
    を含むグローバル地図生成装置。
  8. 請求項１、３、４、又は５に記載の局所地図生成装置と、
    前記生成された局所地図を記憶した局所地図記憶手段と、
    複数の局所地図間で、前記局所地図に記録された前記環境情報を照合し、前記環境情報を照合させた状態で前記複数の局所地図を合成する合成手段と、
    前記合成手段によって合成された前記複数の局所地図の前記軌跡上の少なくとも１点の絶対位置を推定する位置推定手段と、
    前記位置推定手段によって推定された絶対位置に基づいて、絶対座標系で表わされるグローバル地図上に、前記合成手段によって合成された前記複数の局所地図を記録するグローバル地図生成手段と、を含むグローバル地図生成装置であって、
    前記局所地図生成手段は、前記軌跡算出手段によって算出された前記移動体の位置の軌跡上の前記少なくとも１点について、前記衛星情報取得手段によって取得された前記衛星情報を前記局所地図に記録し、
    前記位置推定手段は、前記複数の局所地図の照合結果に基づいて求められる前記複数の局所地図の各々の前記少なくとも１点間の相対位置と、前記複数の局所地図の各々に記録された前記衛星情報とに基づいて、前記合成された前記複数の局所地図の前記軌跡上の前記少なくとも１点の絶対位置を推定することを特徴とするグローバル地図生成装置。
  9. 前記移動体の絶対位置を算出する位置算出手段を更に含み、
    前記局所地図生成手段は、前記軌跡算出手段によって算出された前記移動体の位置の軌跡上の前記少なくとも１点について前記位置算出手段によって算出された絶対位置を、前記局所地図に記録し、
    前記位置推定手段は、前記合成手段によって合成された前記複数の局所地図の各々の前記少なくとも１点について記録された絶対位置に基づいて、前記少なくとも１点の絶対位置を推定する請求項１〜請求項７の何れか１項記載のグローバル地図生成装置。
  10. コンピュータを、移動体に搭載され、かつ、設置位置から見た前記移動体の周辺の環境情報を取得する環境情報取得手段を含む局所地図生成装置の各手段として機能させるためのプログラムであって、
    複数のＧＰＳ衛星の各々から送信された前記ＧＰＳ衛星の各々の位置に関する情報、前記ＧＰＳ衛星の各々と前記移動体との距離に関する情報、及び前記ＧＰＳ衛星の各々に対する前記移動体の相対速度に関する情報を含む衛星情報を取得する衛星情報取得手段、
    前記衛星情報取得手段により取得された前記衛星情報に基づいて、前記移動体の進行方向を含む速度ベクトル、又は前記移動体の速度及び前記移動体の進行方向を示す速度情報を算出する算出手段、
    前記算出手段により算出された前記移動体の前記速度情報を積算して、前記移動体の位置の軌跡を算出する軌跡算出手段、及び
    前記軌跡算出手段によって算出された前記移動体の位置の軌跡上の各点について前記環境情報取得手段によって取得された前記環境情報を、前記軌跡上の各点における前記移動体の進行方向と、前記環境情報取得手段の設置位置及び姿勢とに基づいて定められる、前記移動体の位置の軌跡を含む局所地図上の各領域に記録する局所地図生成手段
    として機能させるためのプログラム。
  11. コンピュータを、移動体に搭載され、かつ、設置位置から見た前記移動体の周辺の環境情報を取得する環境情報取得手段を含む局所地図生成装置の各手段として機能させるためのプログラムであって、
    前記移動体の運動状態を検出する運動状態検出手段により検出された前記移動体の運動状態に基づいて、前記移動体の基準方向の方位角を推定する方位角推定手段、
    前記運動状態検出手段により検出された前記移動体の運動状態を積算し、前記積算された前記移動体の運動状態と、前記方位角推定手段によって推定された前記方位角とに基づいて、前記移動体の位置の軌跡を算出する軌跡算出手段、及び
    前記軌跡算出手段によって算出された前記移動体の位置の軌跡上の各点について前記環境情報取得手段によって取得された前記環境情報を、前記軌跡上の各点における前記移動体の進行方向と、前記環境情報取得手段の設置位置及び姿勢とに基づいて定められる、前記移動体の位置の軌跡を含む局所地図上の各領域に記録する局所地図生成手段
    として機能させるためのプログラム。
JP2011046349A 2011-03-03 2011-03-03 局所地図生成装置、グローバル地図生成装置、及びプログラム Active JP5589900B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2011046349A JP5589900B2 (ja) 2011-03-03 2011-03-03 局所地図生成装置、グローバル地図生成装置、及びプログラム
US14/002,890 US9103680B2 (en) 2011-03-03 2012-03-02 Local map generating device, local map generating system, global map generating device, global map generating system, and program
PCT/JP2012/055464 WO2012118207A1 (ja) 2011-03-03 2012-03-02 局所地図生成装置、局所地図生成システム、グローバル地図生成装置、グローバル地図生成システム、及びプログラム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2011046349A JP5589900B2 (ja) 2011-03-03 2011-03-03 局所地図生成装置、グローバル地図生成装置、及びプログラム

Publications (2)

Publication Number Publication Date
JP2012185202A true JP2012185202A (ja) 2012-09-27
JP5589900B2 JP5589900B2 (ja) 2014-09-17

Family

ID=46758131

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2011046349A Active JP5589900B2 (ja) 2011-03-03 2011-03-03 局所地図生成装置、グローバル地図生成装置、及びプログラム

Country Status (3)

Country Link
US (1) US9103680B2 (ja)
JP (1) JP5589900B2 (ja)
WO (1) WO2012118207A1 (ja)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014228637A (ja) * 2013-05-21 2014-12-08 株式会社デンソー 道路情報送信装置、地図生成装置、道路情報収集システム
WO2017057053A1 (ja) * 2015-09-30 2017-04-06 ソニー株式会社 情報処理装置、情報処理方法
JP2017111448A (ja) * 2015-12-16 2017-06-22 ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツングＲｏｂｅｒｔ Ｂｏｓｃｈ Ｇｍｂｈ 地図を構築するための方法及び装置
KR20190048953A (ko) * 2017-10-31 2019-05-09 현대자동차주식회사 차량의 헤딩 추정 장치 및 방법
JP2020056757A (ja) * 2018-10-04 2020-04-09 ソニー株式会社 情報処理装置および方法、プログラム、並びに移動体制御システム
WO2023149358A1 (ja) * 2022-02-01 2023-08-10 キヤノン株式会社 制御システム、制御方法、及び記憶媒体

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9123152B1 (en) * 2012-05-07 2015-09-01 Google Inc. Map reports from vehicles in the field
US10533863B2 (en) 2014-10-10 2020-01-14 Here Global B.V. Apparatus and associated methods for use in lane-level mapping of road intersections
US9891057B2 (en) 2015-03-23 2018-02-13 Kabushiki Kaisha Toyota Chuo Kenkyusho Information processing device, computer readable storage medium, and map data updating system
CN108007471B (zh) * 2016-10-28 2021-06-29 北京四维图新科技股份有限公司 车辆引导区块获取方法和装置以及自动驾驶方法和系统
JP6852638B2 (ja) 2017-10-10 2021-03-31 トヨタ自動車株式会社 自動運転車両の配車システム、自動運転車両、及び配車方法
KR102561263B1 (ko) 2018-04-04 2023-07-28 삼성전자주식회사 지도 데이터를 생성하는 전자 장치 및 그 동작 방법
WO2020014929A1 (zh) * 2018-07-19 2020-01-23 深圳市大疆创新科技有限公司 地图构建方法、可移动平台及计算机可读存储介质
DE112018008077T5 (de) * 2018-10-19 2021-09-23 Harman Becker Automotive Systems Gmbh Globale Kartenerstellung unter Verwendung lokaler bordeigener Karten, die durch Flottenbewegungsbahnen und -beobachtungen erstellt wurden
CN111380543B (zh) * 2018-12-29 2023-05-05 沈阳美行科技股份有限公司 地图数据生成方法及装置
US12085653B2 (en) * 2019-04-09 2024-09-10 Pioneer Corporation Position estimation device, estimation device, control method, program and storage media
WO2021035471A1 (en) * 2019-08-26 2021-03-04 Beijing Voyager Technology Co., Ltd. Systems and methods for positioning a target subject
CN110517531B (zh) * 2019-09-05 2021-08-17 武汉中海庭数据技术有限公司 一种基于高精度地图数据的多层停车场定位方法
CN111060135B (zh) * 2019-12-10 2021-12-17 亿嘉和科技股份有限公司 一种基于局部地图的地图修正方法及系统
KR102218881B1 (ko) * 2020-05-11 2021-02-23 네이버랩스 주식회사 차량 위치 결정 방법 및 시스템
CN111891047A (zh) * 2020-07-21 2020-11-06 苏州车萝卜汽车电子科技有限公司 一种投射显示的设备和方法
CN112731505A (zh) * 2020-12-09 2021-04-30 深圳市锐驰曼科技发展有限公司 一种基于车载视频终端环境过滤突变gps速度的方法
CN112685527B (zh) * 2020-12-31 2024-09-17 北京迈格威科技有限公司 建立地图的方法、装置和电子系统
DE102021208525A1 (de) 2021-08-05 2023-02-09 Volkswagen Aktiengesellschaft Verfahren und Kartenerzeugungseinrichtung für ein Fahrzeug zur Erzeugung einer hochauflösenden Karte einer Bodenfläche in einem Fahrzeugumfeld

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002206934A (ja) * 2001-01-11 2002-07-26 Matsushita Electric Ind Co Ltd ナビゲーション装置
JP2007249103A (ja) * 2006-03-20 2007-09-27 Zenrin Co Ltd 道路画像作成システム及び道路画像作成方法，及び道路画像合成装置
JP2008249639A (ja) * 2007-03-30 2008-10-16 Mitsubishi Electric Corp 自己位置標定装置、自己位置標定方法および自己位置標定プログラム
JP2009109203A (ja) * 2007-10-26 2009-05-21 Seiko Epson Corp 測位システム、端末装置、情報処理装置、測位システムの制御方法及び測位システムの制御プログラム
JP2009223220A (ja) * 2008-03-18 2009-10-01 Zenrin Co Ltd 路面標示地図生成方法
JP2009250895A (ja) * 2008-04-09 2009-10-29 Sumitomo Electric Ind Ltd 方位特定装置、方位特定方法及びコンピュータプログラム
JP2010175756A (ja) * 2009-01-29 2010-08-12 Zenrin Co Ltd 路面標示地図生成方法及び路面標示地図生成装置

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
IL117279A (en) * 1996-02-27 2000-01-31 Israel Aircraft Ind Ltd System for detecting obstacles on a railway track
JPH1063181A (ja) 1996-08-22 1998-03-06 Japan Radio Co Ltd 地図データベース作成編集支援方法
US5999878A (en) * 1997-04-11 1999-12-07 Navigation Technologies Corp. System and method for acquiring geographic data for forming a digital database of road geometry in a geographic region
US6438491B1 (en) * 1999-08-06 2002-08-20 Telanon, Inc. Methods and apparatus for stationary object detection
TW586012B (en) * 2002-10-23 2004-05-01 Eastern Broadcasting Co Ltd Real time positioning and audio/video formation supplying system and method thereof
JP3725134B2 (ja) * 2003-04-14 2005-12-07 株式会社エヌ・ティ・ティ・ドコモ 移動通信システム、移動通信端末、及びプログラム。
JP2005173784A (ja) * 2003-12-09 2005-06-30 Nec Corp 映像情報配信システム及び方法と装置並びにプログラム
JP2005134429A (ja) 2003-10-28 2005-05-26 Pioneer Electronic Corp 交通状況報知装置、そのシステム、その方法、そのプログラム、および、そのプログラムを記録した記録媒体
US7228230B2 (en) 2004-11-12 2007-06-05 Mitsubishi Denki Kabushiki Kaisha System for autonomous vehicle navigation with carrier phase DGPS and laser-scanner augmentation
JP2006242978A (ja) 2005-02-28 2006-09-14 Mitsubishi Heavy Ind Ltd 移動経路地図作成方法
JP5388082B2 (ja) 2006-09-07 2014-01-15 株式会社豊田中央研究所 静止物地図生成装置
EP2490198A4 (en) * 2009-10-02 2013-05-15 Mitsubishi Electric Corp PARK ASSIST DEVICE

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002206934A (ja) * 2001-01-11 2002-07-26 Matsushita Electric Ind Co Ltd ナビゲーション装置
JP2007249103A (ja) * 2006-03-20 2007-09-27 Zenrin Co Ltd 道路画像作成システム及び道路画像作成方法，及び道路画像合成装置
JP2008249639A (ja) * 2007-03-30 2008-10-16 Mitsubishi Electric Corp 自己位置標定装置、自己位置標定方法および自己位置標定プログラム
JP2009109203A (ja) * 2007-10-26 2009-05-21 Seiko Epson Corp 測位システム、端末装置、情報処理装置、測位システムの制御方法及び測位システムの制御プログラム
JP2009223220A (ja) * 2008-03-18 2009-10-01 Zenrin Co Ltd 路面標示地図生成方法
JP2009250895A (ja) * 2008-04-09 2009-10-29 Sumitomo Electric Ind Ltd 方位特定装置、方位特定方法及びコンピュータプログラム
JP2010175756A (ja) * 2009-01-29 2010-08-12 Zenrin Co Ltd 路面標示地図生成方法及び路面標示地図生成装置

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014228637A (ja) * 2013-05-21 2014-12-08 株式会社デンソー 道路情報送信装置、地図生成装置、道路情報収集システム
WO2017057053A1 (ja) * 2015-09-30 2017-04-06 ソニー株式会社 情報処理装置、情報処理方法
JP2017111448A (ja) * 2015-12-16 2017-06-22 ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツングＲｏｂｅｒｔ Ｂｏｓｃｈ Ｇｍｂｈ 地図を構築するための方法及び装置
KR20190048953A (ko) * 2017-10-31 2019-05-09 현대자동차주식회사 차량의 헤딩 추정 장치 및 방법
KR102406515B1 (ko) * 2017-10-31 2022-06-10 현대자동차주식회사 차량의 헤딩 추정 장치 및 방법
JP2020056757A (ja) * 2018-10-04 2020-04-09 ソニー株式会社 情報処理装置および方法、プログラム、並びに移動体制御システム
JP7135690B2 (ja) 2018-10-04 2022-09-13 ソニーグループ株式会社 情報処理装置および方法、プログラム、並びに移動体制御システム
WO2023149358A1 (ja) * 2022-02-01 2023-08-10 キヤノン株式会社 制御システム、制御方法、及び記憶媒体

Also Published As

Publication number Publication date
US20140074393A1 (en) 2014-03-13
US9103680B2 (en) 2015-08-11
JP5589900B2 (ja) 2014-09-17
WO2012118207A1 (ja) 2012-09-07

Similar Documents

Publication Publication Date Title
JP5589900B2 (ja) 局所地図生成装置、グローバル地図生成装置、及びプログラム
JP6656886B2 (ja) 情報処理装置、制御方法、プログラム及び記憶媒体
US11237005B2 (en) Method and arrangement for sourcing of location information, generating and updating maps representing the location
CN102565832B (zh) 用附加车载视觉传感器加强gps或gps/传感器车辆定位的方法
KR101210597B1 (ko) 이동체의 맵 매칭 장치 및 그 방법
CN106052691B (zh) 激光测距移动制图中闭合环误差纠正方法
CN107735692A (zh) 用于对车辆进行定位的方法和设备
JP2008249639A (ja) 自己位置標定装置、自己位置標定方法および自己位置標定プログラム
CN102089624A (zh) 用于建立公路地图和确定车辆位置的方法和系统
JP2009053059A (ja) 対象特定装置、対象特定方法および対象特定プログラム
JP5286653B2 (ja) 静止物地図生成装置
JP6589410B2 (ja) 地図生成装置及びプログラム
CN103033822B (zh) 移动信息确定装置、方法以及接收机
JP2009204385A (ja) 標定装置、標定方法および標定プログラム
Gustafsson et al. Navigation and tracking of road-bound vehicles
Chiang et al. Multifusion schemes of INS/GNSS/GCPs/V-SLAM applied using data from smartphone sensors for land vehicular navigation applications
Yang et al. Resilient smartphone positioning using native sensors and PPP augmentation
JP2012098185A (ja) 方位角推定装置及びプログラム
Niu et al. MGINS: A Lane-Level Localization System for Challenging Urban Environments Using Magnetic Field Matching/GNSS/INS Fusion
JP2021085880A (ja) 移動体の定位誤差の分析
JP2022547373A (ja) セルラーベースのナビゲーション方法
Forno et al. Techniques for improving localization applications running on low-cost IoT devices
JP4884109B2 (ja) 移動軌跡算出方法、移動軌跡算出装置及び地図データ生成方法
JP2013108961A (ja) 測位装置及びプログラム
Davidson et al. Uninterrupted portable car navigation system using GPS, map and inertial sensors data

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20120627

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130723

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130924

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20131105

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20140106

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: 20140701

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20140714

R151 Written notification of patent or utility model registration

Ref document number: 5589900

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151