JP4074598B2 - Navigation device and current position calculation method - Google Patents
Navigation device and current position calculation method Download PDFInfo
- Publication number
- JP4074598B2 JP4074598B2 JP2004084193A JP2004084193A JP4074598B2 JP 4074598 B2 JP4074598 B2 JP 4074598B2 JP 2004084193 A JP2004084193 A JP 2004084193A JP 2004084193 A JP2004084193 A JP 2004084193A JP 4074598 B2 JP4074598 B2 JP 4074598B2
- Authority
- JP
- Japan
- Prior art keywords
- current position
- branch
- gradient
- road
- change
- 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 - Fee Related
Links
Images
Landscapes
- Instructional Devices (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Description
本発明は、ナビゲーション装置に関し、特に車載用ナビゲーション装置の現在位置算出の技術に関する。 The present invention relates to a navigation device, and more particularly to a technique for calculating a current position of an in-vehicle navigation device.
従来、ナビゲーション装置は、方位センサ、距離センサ、GPS、地図データを用いて、2次元的な位置や方位から地図上の現在位置を求めていた。したがって、高低差を持つ分岐後の道路が平面的に近接している場合、現在位置を正確に求めるのは困難であった。この点、特許文献1には、それぞれの道路の高低差を利用して、現在位置を求める技術が記載されている。特許文献1の技術では、鉛直方向の加速度を検出し、鉛直方向の移動の有無に基づいて、いずれかの道路上に現在位置があるかを推測する。具体的には、高速道路等に流入する際の一般的な道路の斜度(角度)に基づいて角度閾値を設定する。そして、角度閾値を越える鉛直方向の移動があったか否かで、いずれの道路上に現在位置があるかを判断する。
Conventionally, a navigation apparatus has obtained a current position on a map from a two-dimensional position and direction using a direction sensor, a distance sensor, GPS, and map data. Therefore, it is difficult to accurately obtain the current position when the road after branching with a height difference is close in plan. In this regard,
しかし、分岐後の道路の斜度は、道路によって異なる。したがって、一般的な斜度を持たない道路について、特許文献1の技術を適用しても現在位置を正確に求めることはできない。
However, the slope of the road after branching differs depending on the road. Therefore, even if the technique of
本発明は上記事情に鑑みてなされたものであり、本発明の目的は、分岐点を通過後の現在位置をより精度良く求めることにある。 The present invention has been made in view of the above circumstances, and an object of the present invention is to obtain a current position after passing through a branch point with higher accuracy.
上記課題を解決すべく本発明のナビゲーション装置の位置算出方法は、ナビゲーション装置に、高さ方向の変化を求める検出装置と、地図上の道路の勾配情報を含む地図データを記憶する記憶装置とを備えさせる。そして、前記ナビゲーション装置に、分岐後の道路上の現在位置を求める場合、前記検出装置により求めた高さ方向の変化と、より一致する勾配情報を有する道路上に、現在位置を求める位置算出ステップを行わせる。 In order to solve the above-described problem, a navigation device position calculation method according to the present invention includes a navigation device that includes a detection device that determines a change in height direction and a storage device that stores map data including road gradient information on a map. Prepare. Then, when obtaining the current position on the road after branching to the navigation device, a position calculating step for obtaining the current position on the road having gradient information that more closely matches the change in the height direction obtained by the detection device. To do.
例えば、ナビゲーション装置であって、
地図上の道路について勾配情報を含む地図データを記憶する手段と、
移動方位及び移動距離の変化を取得する手段と、
高さ方向の変化を求める高度変化検出手段と、
道路に分岐があるか否かを判定する分岐判定手段と、
前記分岐判定手段により分岐があると判定された場合に、分岐先の複数の道路に勾配があるか否か判定する勾配判定手段と、
地図上の現在位置を求める現在位置算出手段と、を備え、
前記現在位置算出手段は、
前記分岐判定手段により分岐があると判定されるまでの間、前記移動方位及び移動距離の変化を用いて前記現在位置を地図上の道路に合わせ込む第1のマッチング方法により、前記現在位置を求め、
前記分岐判定手段により分岐があると判定された場合で、前記勾配判定手段により、分岐先の複数の道路に勾配がないと判定された場合、前記第1のマッチング方法により現在位置を求め続け、
前記分岐判定手段により分岐があると判定された場合で、前記勾配判定手段により分岐先の複数の道路に勾配があると判定された場合、監視距離を定め、
当該監視距離を移動する間、前記高度変化検出手段により求めた高さ方向の変化と、より一致する勾配情報を有する道路上に前記現在位置を求める第2のマッチング方法により、前記現在位置を求め、前記監視距離を移動した後は、前記第1のマッチング方法により現在位置を求め
前記第2のマッチング方法は、
前記勾配判定手段により勾配があると判定された道路に、前記監視距離の長さに応じて、高さ方向の変化の閾値を設定し、
前記高度変化検出手段により求めた高さ方向の変化が、前記閾値を越えた場合に、その閾値が設定された道路に現在位置を求める。
For example, a navigation device,
Means for storing map data including gradient information for roads on the map;
Means for obtaining a change in movement direction and movement distance;
Altitude change detection means for obtaining a change in the height direction,
Branch determination means for determining whether or not there is a branch on the road;
A slope determining means for determining whether or not there is a slope on a plurality of roads to which the road is branched when the branch determining means determines that there is a branch;
A current position calculating means for obtaining a current position on a map,
The current position calculating means includes
Until the branch determination unit determines that there is a branch, the current position is obtained by a first matching method in which the current position is matched with a road on a map using the change in the moving direction and the moving distance. ,
When it is determined that there is a branch by the branch determination unit, and when the gradient determination unit determines that there is no gradient on the plurality of roads to be branched, the current position is continuously obtained by the first matching method,
When it is determined that there is a branch by the branch determination unit, and when it is determined by the gradient determination unit that there is a gradient on a plurality of roads to be branched, a monitoring distance is determined,
While moving the monitoring distance, the current position is obtained by the second matching method for obtaining the current position on a road having gradient information that more closely matches the change in the height direction obtained by the altitude change detecting means. After moving the monitoring distance, the current position is obtained by the first matching method.
The second matching method is:
In accordance with the length of the monitoring distance, a threshold value for a change in the height direction is set on the road determined to have a gradient by the gradient determination unit,
When the change in the height direction obtained by the altitude change detection means exceeds the threshold value, the current position is obtained on the road where the threshold value is set.
また、前記ナビゲーション装置に、少なくとも分岐後の道路について前記検出装置により求めた高さ方向の変化を学習データとして記憶装置に記憶させる学習データ記憶ステップと、分岐後の道路上の現在位置を求める場合、前記検出装置により求まる高さ方向の変化が、前記学習データ記憶ステップにより記憶した学習データと、より一致する道路上に現在位置を求める位置算出ステップを行わせるようにしてもよい。 Further, in the case where the navigation device stores a learning data storage step in which a change in the height direction obtained by the detection device for at least the road after branching is stored in the storage device as learning data, and a current position on the road after branching The position calculation step for obtaining the current position on the road more closely matches the learning data stored in the learning data storage step with the change in the height direction obtained by the detection device.
本発明によれば、分岐点を通過後の現在位置をより精度良く求めることができる。 According to the present invention, the current position after passing through the branch point can be obtained more accurately.
以下に、本発明の一実施形態について、図面を参照して説明する。 An embodiment of the present invention will be described below with reference to the drawings.
図1は、本発明の一実施形態を適用した車載用ナビゲーション装置1000の概略構成図である。図示するように、本実施形態の車載用ナビゲーション装置1000は、演算処理部1と、ディスプレイ2と、データ記憶装置3と、音声入出力装置4と、入力装置5と、車輪速センサ6と、地磁気センサ7と、ジャイロセンサ8と、GPS(Global Positioning System)受信装置9とを有する。
FIG. 1 is a schematic configuration diagram of an in-
演算処理部1は、様々な処理を行う中心的ユニットである。例えば各種センサ6〜8やGPS受信装置9から出力される情報を基にして現在地を検出し、得られた現在地情報に基づいて、表示に必要な地図データをデータ記憶装置3から読み出す。また、読み出した地図データをグラフィックス展開し、そこに現在地を示すマークを重ねてディスプレイ2へ表示する。また、データ記憶装置3に記憶されている地図データを用いて、ユーザから指示された目的地と現在地(出発地)とを結ぶ最適な経路(推奨経路)を探索し、音声入出力装置4やディスプレイ2を用いてユーザを誘導する。
The
ディスプレイ2は、演算処理部1で生成されたグラフィックス情報を表示するユニットで、CRTや液晶ディスプレイなどで構成される。演算処理部1とディスプレイ2との間の信号S1は、RGB信号やNTSC(National Television System Committee)信号で接続するのが一般的である。
The
データ記憶装置3は、CD-ROMやDVD-ROMやHDDやICカードといった記憶媒体で構成されている。この記憶媒体には、地図データ等が記憶されている。 The data storage device 3 includes a storage medium such as a CD-ROM, DVD-ROM, HDD, or IC card. This storage medium stores map data and the like.
図2は、地図データ記憶装置3に記憶されている地図データの構成例を示す図である。図示するように、メッシュ領域毎に地図データ310が記憶されている。地図データ310は、メッシュ領域の識別コード(メッシュID)311、および、そのメッシュ領域に含まれる道路を構成する各リンクのリンクデータ312を有する。リンクデータ312は、リンクの識別コード(リンクID)3121、リンクを構成する2つのノード(開始ノード、終了ノード)の座標情報3122、リンクを含む道路の種別情報3123、リンクの長さを示すリンク長情報3124、リンクの勾配情報3125、2つのノードにそれぞれ接続するリンクのリンクID(接続リンクID)3126などを有する。また、地図データ310には、対応するメッシュ領域に含まれている道路以外の地図構成物の情報(名称、種別、座標情報など)も含まれている。
FIG. 2 is a diagram illustrating a configuration example of map data stored in the map data storage device 3. As shown in the figure,
リンクの勾配情報3125は、そのリンクが上り勾配か、下り勾配か、水平(勾配がない)かの情報を含む。
The
図1に戻って説明を続ける。音声入出力装置4は、演算処理部1で生成したユーザへのメッセージを音声信号に変換し出力すると共に、ユーザが発した声を認識し演算処理部1にその内容を転送する処理を行う。
Returning to FIG. 1, the description will be continued. The voice input / output device 4 converts the message to the user generated by the
入力装置5は、ユーザからの指示を受け付けるユニットで、スクロールキー、縮尺変更キーなどのハードスイッチ、ジョイスティック、ディスプレイ上に貼られたタッチパネルなどで構成される。
The
センサ6〜8およびGPS受信装置9は、車載用ナビゲーション装置で現在地(自車位置)を検出するために使用するものである。車輪速センサ6は、車輪の円周と計測される車輪の回転数の積から距離を測定し、さらに対となる車輪の回転数の差から移動体が曲がった角度を計測する。地磁気センサ7は、地球が保持している磁場を検知し、移動体が向いている方角を検出する。ジャイロ8は、光ファイバジャイロや振動ジャイロ等で構成され、移動体が回転した角度を検出するものである。GPS受信装置9は、GPS衛星からの信号を受信し移動体とGPS衛星間の距離と距離の変化率を3個以上の衛星に対して測定することで移動体の現在地、進行速度および進行方位を測定する。
The sensors 6 to 8 and the GPS receiver 9 are used for detecting the current location (own vehicle position) by the vehicle-mounted navigation device. The wheel speed sensor 6 measures the distance from the product of the wheel circumference and the measured number of rotations of the wheel, and further measures the angle at which the moving body is bent from the difference in the number of rotations of the paired wheels. The
なお、ジャイロ8は、垂直方向の加速度も検出する。検出結果は、演算処理部1により積分され、垂直方向(高さ方向)の変化量の算出に利用される。
The
また、車載用ナビゲーション装置1000は、VICS情報等の交通情報を受信する不図示の光ビーコン受信機、電波ビーコン受信機等を備えている。
The in-
図3は、演算処理部1のハードウェア構成例を示す図である。
FIG. 3 is a diagram illustrating a hardware configuration example of the
図示するように、演算処理部1は、各デバイス間をバス32で接続した構成としてある。演算処理部1は、数値演算及び各デバイスを制御するといった様々な処理を実行するCPU(Central Processing Unit)21と、地図データ記憶装置3から読み出した地図データや演算データなどを格納するRAM(Random Access Memory)22と、プログラムやデータを格納するROM(Read Only Memory)23と、メモリ間およびメモリと各デバイスとの間のデータ転送を実行するDMA(Direct Memory Access)24と、グラフィックス描画を実行し且つ表示制御を行う描画コントローラ25と、グラフィックスイメージデータを蓄えるVRAM(Video Random Access Memory)26と、イメージデータをRGB信号に変換するカラーパレット27と、アナログ信号をデジタル信号に変換するA/D変換器28と、シリアル信号をバスに同期したパラレル信号に変換するSCI(Serial Communication Interface)29と、パラレル信号をバスに同期させてバス上にのせるPIO(Parallel Input/Output)30と、パルス信号を積分するカウンタ31と、を有する。
As illustrated, the
図4は、演算処理部1の機能構成を示す図である。
FIG. 4 is a diagram illustrating a functional configuration of the
図示するように、演算処理部1は、ユーザ操作解析部41と、経路探索部42と、表示処理部45と、現在位置演算部46と、マップマッチ処理部47と、軌跡記憶部49と、学習データ記憶部55とを有する。
As shown in the figure, the
現在位置演算部46は、車輪速センサ6で計測される距離パルスデータS5およびジャイロ8で計測される角加速度データS7を各々積分した結果得られる距離データおよび角度データを用い、そのデータを時間軸で積分していくことにより、初期位置(X,Y)から自車走行後の位置である現在地(X′,Y′)を定期的に演算し、マップマッチ処理部47に出力する処理を行う。ここで、自車の回転した角度と進む方位との関係を一致させるため、地磁気センサ7から得られる方位データS6と、ジャイロ8から得られる角加速度データS7を積分した角度データとを参照して、自車が進行している方向の絶対方位を推定する。なお、車輪速センサ6のデータおよびジャイロ8のデータを各々積分してゆくと、誤差が蓄積するため、ある時間周期でGPS受信装置9から得られた位置データS8をもとに蓄積した誤差をキャンセルするという処理を施して、現在地の情報をマップマッチ処理部47に出力する。
The current
マップマッチ処理部47は、現在地周辺の地図データと、後述する軌跡記憶部49に記憶されている走行軌跡とを互いに照らし合わせ、形状の相関が最も高い道路(リンク)上に、現在位置演算部46より定期的に出力される現在地を合わせ込むというマップマッチ処理を行う。現在位置演算部46で得られる現在地の情報にはセンサ誤差が含まれているため、さらに位置精度を高めることを目的に、マップマッチ処理を行う。これにより、現在地は、多くの場合、走行道路と一致するようになる。
The map
軌跡記憶部49は、マップマッチ処理部47でマップマッチ処理が施された現在地の情報を、軌跡データとして自車が所定距離走行する度に記憶する。なお、この軌跡データは、これまで走行してきた道路につき、対応する地図上の道路に軌跡マークを描画するために用いられる。
The
ユーザ操作解析部41は、入力装置5に入力されたユーザからの要求を受け、その要求内容を解析して、その要求内容に対応する処理が実行されるように演算処理部1の各部を制御する。例えば、ユーザが推奨経路の探索を要求したときは、目的地を設定するため、地図をディスプレイ2に表示する処理を地図表示部45に要求し、さらに、現在地(出発地)から目的地までの経路を演算する処理を経路探索部42に要求する。
The user
経路探索部42は、ダイクストラ法等を用いて、指定された2地点(現在地、目的地)間を結ぶ経路のコスト(例えば、旅行時間)が最少となる経路を探索する。また、探索した経路を用いて、経路誘導を行う。
The
表示処理部45は、ユーザ操作解析部41から出力される命令を受け、グラフィック処理部51が、様々な種類のメニューやグラフなどを描画するようにメニュー描画コマンドを生成する。
The
学習データ記憶部55は、過去に走行した道路の分岐点通過後の所定距離内の高さ変化に関する情報と、その情報を蓄積し平均することにより作成された学習データ(分岐点からの距離と勾配変化)を記憶する。学習データの作成処理については後述する。
The learning
[動作の説明] 次に、上記のように構成される車載用ナビゲーション装置1000の動作を説明する。
[Description of Operation] Next, the operation of the vehicle-mounted
上記のように構成される車載用ナビゲーション装置1000は、各種センサ6〜9の出力に基づく位置や方位から、2次元的なマップマッチング処理により、地図上の現在位置を求める。また、地図上の道路の分岐点を通過する場合、分岐点後の道路の勾配を利用して、3次元的なマップマッチング処理により、地図上の現在位置をより精度よく求める。すなわち、図11(A)の平面図に示すように、本線とそれを外れるランプが点Xで分岐しており、互いに近接している場合、2次元マップマッチングでは、どちらの道路に現在位置が存在するのかを判断するのは難しい。そこで、図11(B)の高さ変化図に示すように、ふたつの道路が高さの変化に違いがある場合、その違いを利用して3次元的なマップマッチング処理により、いずれの道路に現在位置があるかを判断する。
The in-
以下に、分岐点を通過する場合の現在位置の算出処理について説明する。 Below, the calculation process of the present position when passing through a branch point will be described.
図6は、車載用ナビゲーション装置1000が分岐点を通過する場合の現在位置算出処理の流れの概略を示すフロー図である。
FIG. 6 is a flowchart showing an outline of the flow of the current position calculation process when the in-
このフローは、車載用ナビゲーション装置1000が分岐点に差し掛かったときに開始される。なお、分岐点に差し掛かったか否かの判断は、マップマッチ処理部47により、データ記憶装置3に記憶されているリンクデータ312を参照して、現在走行中のリンクに接続するリンクが複数あるか否かで判定される。
This flow is started when the vehicle-mounted
まず、マップマッチ処理部47は、通過しようとしている分岐点が処理対象の分岐であるか否か判定する(S100)
図7は、処理対象の分岐か否かの判定処理の流れを示すフロー図である。まず、マップマッチ処理部47は、データ記憶装置3に記憶されているリンクデータ312のリンク勾配情報3125を参照して、分岐後のリンクに勾配情報があるか否かを調べる(S102)。いずれのリンクにも勾配情報がない場合(S102でNo)、マップマッチ処理部47は、現在通過しようとしている分岐を処理対象の分岐でないと判定する(S108)。
First, the map
FIG. 7 is a flowchart showing a flow of a determination process for determining whether or not a branch is a processing target. First, the map
一方、分岐後のリンクのいずれかに勾配情報がある場合(S104でYes)、マップマッチ処理部47は、二つのリンクの勾配が同じでないか否かを判定する(S104)。勾配が同じである場合(S104でNo)、例えば、二つのリンクの勾配がともに上り(又はともに下り)である場合、マップマッチ処理部47は、現在通過しようとしている分岐を処理対象の分岐でないと判定する(S108)。
On the other hand, when there is gradient information in any of the links after branching (Yes in S104), the map
一方、勾配が異なる場合(S104でYes)、例えば、一方のリンクの勾配が上り(又は下り)で他方が水平の場合、一方のリンクの勾配が上り(又は下り)で他方の勾配が下り(又は上り)である場合、マップマッチ処理部47は、現在通過しようとしている分岐を処理対象の分岐であると判定する(S110)。
On the other hand, when the gradients are different (Yes in S104), for example, when the gradient of one link is up (or down) and the other is horizontal, the gradient of one link is up (or down) and the other is down ( If it is (or up), the map
図6に戻って説明する。通過しようとする分岐が処理対象の分岐でない場合(S100でNo)、マップマッチ処理部47は、本処理を終了する。そして、再び分岐点に差し掛かるまでの間、現在位置演算部46により算出された現在位置を基に、2次元的なマップマッチング処理により、地図上の現在位置を求める。
Returning to FIG. If the branch to be passed is not a branch to be processed (No in S100), the map
一方、通過しようとする分岐が処理対象の分岐である場合(S100でYes)、マップマッチ処理部47は、3次元マッチング処理を行う(S210〜S240)。
On the other hand, when the branch to be passed is a branch to be processed (Yes in S100), the map
3次元マッチング処理には、監視距離走行中に行われる閾値を用いたマッチング処理(S210)と、監視距離走行後に行われる学習データを用いたマッチング処理(S240)とがある。 The three-dimensional matching process includes a matching process (S210) using a threshold value that is performed during monitoring distance traveling and a matching process (S240) that is performed after learning distance traveling using learning data.
マップマッチ処理部47は、まず、閾値を用いてマッチング処理(S210
を行う。
First, the map
I do.
図8は、閾値を用いたマッチング処理の流れを示すフロー図である。まず、マップマッチ処理部47は、監視距離を設定する(S2102)。具体的には、マップマッチ処理部47は、対象の分岐が、本線とその本線から外れるランプとの分岐である場合は、ランプの距離を監視距離と設定する。それ以外の場合は、所定の距離(予め定めた距離。例えば、1km)を監視距離と設定する。
FIG. 8 is a flowchart showing a flow of matching processing using a threshold. First, the map
次に、マップマッチ処理部47は、高さ変化量の閾値を設定する(S2104)。具体的には、マップマッチ処理部47は、学習データ記憶部55を参照して、分岐から監視距離までの区間(監視距離区間)について学習データがある場合は、学習データに基づいて閾値を設定する。この場合は、監視距離区間の高さ変化量の最大値に所定の係数(例えば0.8)を乗じた値を閾値に設定する。
Next, the map
学習データがない場合、マップマッチ処理部47は、閾値テーブル340に基づいて閾値を設定する。なお、閾値テーブル340は、予め、データ記憶装置3に記憶されている。図5は、閾値テーブル340の構成を示す。図示するように、閾値テーブル340は、監視距離342ごとの閾値344を含む。なお、閾値344は、上り勾配の場合と、下り勾配の場合とがある。マップマッチ処理部47は、この閾値テーブル340を参照して、監視距離と勾配に対応する閾値を抽出して、閾値に設定する。
When there is no learning data, the map
閾値の設定(S2104)をすると、次に、マップマッチ処理部47は、監視距離を走行したか否かを判定する(S2106)。具体的には、マップマッチ処理部47は、車輪速センサ6の出力から求まる分岐点からの移動距離を求め、S2102に設定した監視距離を走行したか否かを求める。監視距離を走行した場合(S2106でYes)、マップマッチ処理部47は、閾値を用いたマッチング処理を終了する。
Once the threshold value is set (S2104), the map
一方、監視距離を走行していない場合(S2106でNo)、マップマッチ処理部47は、通常の2次元的なマップマッチング処理を行う(S2107)。すなわち、マップマッチ処理部47は、現在地周辺の地図データと、軌跡記憶部49に記憶されている走行軌跡とを互いに照らし合わせ、地図上の2次元的な形状の相関が高い道路(リンク)上に、現在地を合わせ込む処理を行う。
On the other hand, when the vehicle is not traveling the monitoring distance (No in S2106), the map
次にマップマッチ処理部47は、ジャイロセンサ8の出力に基づいて、分岐点から現在位置までの、高さ方向の変化量を求める(S2108)。具体的には、ジャイロセンサ8から出力される高さ方向の加速度を移動時間で積分したものを累積し、高さ方向への移動距離を算出する。
Next, the map
次に、マップマッチ処理部47は、分岐点から現在位置までの高さ変化量が、S2104で設定した閾値を越えたか否かを判定する(S2110)。閾値を越えていない場合(S2110でNo)、マップマッチ処理部47は、S2106で戻って処理を続ける。なお、マップマッチ処理部47は、上り勾配の場合については、高さ変化量が閾値以上となったか否かを判定し、下り勾配の場合については、閾値以下になったか否かを判定する。
Next, the map
一方、閾値を越えた場合(S2110でYes)、マップマッチ処理部47は、その越えた閾値を設けた道路の方に、現在位置を合わせこむ(S2112)。なお、既にその道路にマッチングされている場合は、そのまま次の処理に移行する。
On the other hand, when the threshold value is exceeded (Yes in S2110), the map
次に、マップマッチ処理部47は、S2106と同様の方法で、監視距離を走行したか否か判定する(S2114)。監視距離を走行した場合(S2116でYes)、マップマッチ処理部47は、閾値を用いたマッチング処理を終了する。
Next, the map
一方、監視距離を走行していない場合(S2116でNo)、マップマッチ処理部47は、通常のマップマッチ処理を行う(S2107)。ただし、マップマッチ処理部47は、S2112でマッチングされた道路上に、現在位置を求めるようにする。そして、S2114に戻って処理を続ける。
On the other hand, when the vehicle is not traveling the monitoring distance (No in S2116), the map
以上、閾値を用いたマッチング処理について説明した。 The matching process using the threshold has been described above.
図6に戻って説明する。次に、マップマッチ処理部47は、学習データ記憶部55を参照して、分岐後の道路の両方について学習データがあるか否か判定する(S230)。両方の道路の学習データがない場合(S230でNo)、マップマッチ処理部47は、本処理を終了する。一方、両方の道路の学習データがある場合(S230でYes)、マップマッチ処理部47は、学習データを用いて、現在位置のマッチング処理を行う(S240)。すなわち、監視距離を走行中(若しくは、閾値マッチングが終了するまで)は、閾値を用いてマッチングを行い、その後、さらに学習データを用いたマッチングを行う。これにより、二重にマッチングを行い、精度よく現在位置を求めることとした。
Returning to FIG. Next, the map
図9は、学習データを用いたマッチング処理の流れを示すフロー図である。 FIG. 9 is a flowchart showing a flow of matching processing using learning data.
マップマッチ処理部47は、分岐後の道路ごとに、以下の処理を行う。まず、マップマッチ処理部47は、今回走行して得た監視距離内の高さ変化量の情報(「採取データ」ともいう。)および学習データを比較して、高さ変化量の差の絶対値を求める。差の絶対値は、監視距離を複数に分割した区分ごとに求める。そして、求めた区分ごとの差の絶対値の平均を算出する(S2406)。分岐後の道路ごとに、差の絶対値の平均を算出すると(S2407)、マップマッチ処理部47は、差の絶対値の平均が最も小さくなる道路に現在位置を合わせ込む(S2408)。
The map
以上、学習データを用いた現在位置のマッチング処理について説明した。以上のようにして、3次元マッチングが終了すると、マップマッチ処理部47は、再び分岐に差し掛かるまでの間、通常の2次元マップマッチングを行い、地図上の現在位置を求める。
Heretofore, the current position matching process using the learning data has been described. As described above, when the three-dimensional matching is completed, the map
なお、図9に示すフローでは、監視距離区間を複数に分割して、分割した区分ごとに、採取データと学習データの高さ変化量の差を求めているが、分岐点からの距離ごとに(例えば、10mごとに)、高さ変化量の差を求めるようにしてもよい。 In the flow shown in FIG. 9, the monitoring distance section is divided into a plurality of parts, and the difference in height change between the collected data and the learning data is obtained for each divided section, but for each distance from the branch point. You may make it obtain | require the difference of height change amount (for example, every 10 m).
次に、学習データの作成処理について説明する。 Next, learning data creation processing will be described.
図10は、学習データ作成処理の流れを示すフロー図である。学習データは、監視距離を走行することにより得られた高さ変化の情報をもとに作成される。また、監視距離を走行後に入手される様々な情報を基に、実際に分岐点を通過後どちらの道路を走行したかがある程度確認できた場合に行う。 FIG. 10 is a flowchart showing the flow of learning data creation processing. The learning data is created based on height change information obtained by traveling the monitored distance. Further, this is performed when it is possible to confirm to some extent which road has actually traveled after passing through the branch point based on various information obtained after traveling the monitoring distance.
まず、マップマッチ処理部47は、分岐点を通過後、所定の距離(例えば30km)を走行したか否かを判定する(S310)。所定の距離を走行した場合(S310でYes)は、マップマッチ処理部47は、分岐点通過後の経路が特定できなかったとして、学習データを作成せずに、本処理を終了する。
First, the map
一方、所定の距離を走行していない場合(S310でNo)、マップマッチ処理部47は、分岐点通過後の経路が特定できたか否かを判定する(S320)。具体的には、マップマッチ処理部47は、以下のようにして分岐点通過後の経路を特定する。
On the other hand, if the vehicle has not traveled the predetermined distance (No in S310), the map
例えば、マップマッチ処理部47は、電波ビーコン、光ビーコン等から入手される交通情報から現在走行中の経路を特定し、それに基づいて分岐通過後の経路を特定する。
For example, the map
また、対象の分岐が、高速道路とそれを外れるランプとの分岐であった場合で、かつ、VICS情報から現在高速道路を走行中であることが判断できる場合、マップマッチ処理部47は、分岐後の経路が高速道路側の経路であると特定する。VICS情報が得られない場合でも、高速道路を走行中であることが判断できる場合(例えば、時速80kmで3km以上走行している場合)、マップマッチ処理部47は、分岐後の経路が高速道路側の経路であると特定する。
If the target branch is a branch between a highway and a ramp that deviates from it, and if it can be determined from the VICS information that the vehicle is currently driving on the highway, the map
また、分岐点通過後、減速または停止を繰り返す場合は、高速道路を降りたことが推測できるので、マップマッチ処理部47は、分岐後の経路がランプ側の経路であると特定する。
In addition, when the vehicle repeatedly decelerates or stops after passing through the branch point, it can be assumed that the user has got off the highway, so the map
分岐点通過後の経路が特定できていない場合(S320でNo)、マップマッチ処理部47は、S310に戻って処理を続ける。
If the route after the branch point cannot be identified (No in S320), the map
一方、分岐点通過後の経路が特定できた場合(S320でYes)、マップマッチ処理部47は、監視距離を走行して得られた高さ変化の情報(分岐点からの距離と、高さ変化との関係の情報)を、特定した経路側の道路のものとして学習データ記憶部55に記憶する。なお、その道路について初めて高さ変化の情報を記憶する場合は、その高さ変化の情報を学習データとして記憶する。一方、その道路について既に高さ変化の情報が記憶されている場合、それらを平均して学習データとする。こうして作成された学習データは、分岐点からの距離に対する高さの変化を表すものとなり、その道路の高さ変化に関する地形データとなる。
On the other hand, when the route after the branch point can be identified (Yes in S320), the map
以上、学習データ作成処理について説明した。上記フローによれば、分岐後の経路が確定した時点で学習データを作成するので、より正確な学習データを得ることができる。 The learning data creation process has been described above. According to the above flow, learning data is created when a route after branching is determined, so that more accurate learning data can be obtained.
また、同じ道路を通過するたびに、その道路の高さ変化の情報が蓄積され、蓄積された情報を基に、学習データが作成される。したがって、通行回数が多くなるほど、より精度の高い学習データ(地形データ)が得られることになる。 Further, every time the vehicle passes the same road, information on the height change of the road is accumulated, and learning data is created based on the accumulated information. Therefore, as the number of passes increases, more accurate learning data (terrain data) can be obtained.
以上、本発明が適用された一実施形態について説明した。 The embodiment to which the present invention is applied has been described above.
本実施形態によれば、分岐通過後の道路が近接している場合でも、勾配を利用することにより、地図上の現在位置を精度よく求めることができる。 According to this embodiment, even when roads after passing through a branch are close to each other, the current position on the map can be accurately obtained by using the gradient.
また、高さ変化に関する閾値を設定して、分岐後の現在位置の道路を求めるので、処理が単純である。 In addition, since a threshold value related to the height change is set and the road at the current position after branching is obtained, the processing is simple.
また、閾値は、高さ変化について過去に得た学習データを用いて設定する。すなわち、一律に設定するのではなく、その分岐後の道路固有の閾値が設定することができる。したがって、より正確に、分岐後の現在位置のある道路を求めることができる。 The threshold value is set using learning data obtained in the past with respect to the height change. That is, instead of setting uniformly, a road-specific threshold after the branching can be set. Therefore, the road with the current position after branching can be obtained more accurately.
また、監視距離走行後は、その分岐後の道路固有の学習データを用いたマッチングにより、現在位置を見直すので、二重にマッチングを行うことになる。したがって、より精度よく現在位置を求めることができる。 In addition, after traveling over the monitoring distance, the current position is reviewed by matching using the road-specific learning data after the branching, so that double matching is performed. Therefore, the current position can be obtained with higher accuracy.
なお、本発明は上記の実施形態に限定されるものではなく、その要旨の範囲内で様々な変形が可能である。 In addition, this invention is not limited to said embodiment, A various deformation | transformation is possible within the range of the summary.
例えば、図6〜図10で示した各処理のステップは、本願発明の要旨の範囲内で順番を変更することができる。 For example, the order of the processing steps shown in FIGS. 6 to 10 can be changed within the scope of the gist of the present invention.
また、上記実施形態では、2つの道路に分岐する場合について、主に説明したが、3以上の道路に分岐する場合でも、上記実施形態を適用できる。例えば、閾値を越える道路が複数ある場合は、まず、その複数の道路に絞り、その複数の道路のうちから2次元マップマッチングにより、よりマッチする道路に現在位置を求めるようにする。また、学習データを有する道路が3以上ある場合でも、より採取データに近い学習データを持つ道路に現在位置を求めるようにする。 Moreover, although the case where it branches to two roads was mainly demonstrated in the said embodiment, the said embodiment is applicable also when branching to three or more roads. For example, when there are a plurality of roads exceeding the threshold, first, the roads are narrowed down to the plurality of roads, and the current position is obtained from the plurality of roads by a two-dimensional map matching for a more matching road. Even when there are three or more roads having learning data, the current position is obtained on a road having learning data closer to the collected data.
また、本発明を車載用ナビゲーション装置に適用した例について説明したが、本発明は車載用以外のナビゲーション装置にも適用することができる。 Moreover, although the example which applied this invention to the vehicle-mounted navigation apparatus was demonstrated, this invention is applicable also to navigation apparatuses other than vehicle-mounted.
1・・・演算処理部、2・・・ディスプレイ、3・・・データ記憶装置、4・・・音声出入力装置、5・・・入力装置、6・・・車輪速センサ、7・・・地磁気センサ、8・・・ジャイロ、9・・・GPS受信機、11・・・車内LAN装置、21・・・CPU、22・・・RAM、23・・・ROM、24・・・DMA、25・・・描画コントローラ、26・・・VRAM、27・・・カラーパレット、28・・・A/D変換器、29・・・SCI、30・・・PIO、31・・・カウンタ、41・・・ユーザ操作解析部、42・・・経路探索部、45・・・表示処理部、46・・・現在位置演算部、47・・・マップマッチ処理部、49・・・軌跡記憶部、55・・・学習データ記憶部
DESCRIPTION OF
Claims (3)
地図上の道路について勾配情報を含む地図データを記憶する手段と、
移動方位及び移動距離の変化を取得する手段と、
高さ方向の変化を求める高度変化検出手段と、
道路に分岐があるか否かを判定する分岐判定手段と、
前記分岐判定手段により分岐があると判定された場合に、分岐先の複数の道路に勾配があるか否か判定する勾配判定手段と、
地図上の現在位置を求める現在位置算出手段と、を備え、
前記現在位置算出手段は、
前記分岐判定手段により分岐があると判定されるまでの間、前記移動方位及び移動距離の変化を用いて前記現在位置を地図上の道路に合わせ込む第1のマッチング方法により、前記現在位置を求め、
前記分岐判定手段により分岐があると判定された場合で、前記勾配判定手段により、分岐先の複数の道路に勾配がないと判定された場合、前記第1のマッチング方法により現在位置を求め続け、
前記分岐判定手段により分岐があると判定された場合で、前記勾配判定手段により分岐先の複数の道路に勾配があると判定された場合、監視距離を定め、
当該監視距離を移動する間、前記高度変化検出手段により求めた高さ方向の変化に、より一致する勾配情報を有する道路上に前記現在位置を求める第2のマッチング方法により、前記現在位置を求め、前記監視距離を移動した後は、前記第1のマッチング方法により現在位置を求め、
前記第2のマッチング方法は、
前記勾配判定手段により勾配があると判定された道路に、前記監視距離の長さに応じて、高さ方向の変化の閾値を設定し、
前記高度変化検出手段により求めた高さ方向の変化が、前記閾値を越えた場合に、その閾値が設定された道路に現在位置を求める
ことを特徴とするナビゲーション装置。 A navigation device,
Means for storing map data including gradient information for roads on the map;
Means for obtaining a change in movement direction and movement distance;
Altitude change detection means for obtaining a change in the height direction,
Branch determination means for determining whether or not there is a branch on the road;
A slope determining means for determining whether or not there is a slope on a plurality of roads to which the road is branched when the branch determining means determines that there is a branch;
A current position calculating means for obtaining a current position on a map,
The current position calculating means includes
Until the branch determination unit determines that there is a branch, the current position is obtained by a first matching method in which the current position is matched with a road on a map using the change in the moving direction and the moving distance. ,
When it is determined that there is a branch by the branch determination unit, and when the gradient determination unit determines that there is no gradient on the plurality of roads to be branched, the current position is continuously obtained by the first matching method,
When it is determined that there is a branch by the branch determination unit, and when it is determined by the gradient determination unit that there is a gradient on a plurality of roads to be branched, a monitoring distance is determined,
While moving the monitoring distance, the current position is obtained by the second matching method for obtaining the current position on a road having gradient information that more closely matches the change in the height direction obtained by the altitude change detecting means. , After moving the monitoring distance, find the current position by the first matching method,
The second matching method is:
In accordance with the length of the monitoring distance, a threshold value for a change in the height direction is set on the road determined to have a gradient by the gradient determination unit,
A navigation device characterized in that, when a change in a height direction obtained by the altitude change detection means exceeds the threshold value, a current position is obtained on a road where the threshold value is set .
前記勾配情報は、少なくとも、上り勾配又は下り勾配を示す情報であり、
前記勾配判定手段は、
分岐先の複数の道路に対応する勾配情報が存在し、
かつ互いに異なる勾配である場合に、
分岐先の複数の道路に勾配があると判定する
ことを特徴とするナビゲーション装置。 The navigation device according to claim 1,
The gradient information is information indicating at least an ascending gradient or a descending gradient,
The gradient determination means includes
There is gradient information corresponding to multiple roads at the branch destination,
And when the slopes are different from each other,
A navigation device characterized in that it is determined that a plurality of roads at a branch destination have a gradient.
前記ナビゲーション装置は、
地図上の道路について勾配情報を含む地図データを記憶する装置を備え、
移動方位及び移動距離の変化を取得するステップと、
高さ方向の変化を求める高度変化検出ステップと、
道路に分岐があるか否かを判定する分岐判定ステップと、
前記分岐判定ステップにより分岐があると判定された場合に、分岐先の複数の道路に勾配があるか否か判定する勾配判定ステップと、
地図上の現在位置を求める現在位置算出ステップと、を行い、
前記現在位置算出ステップは、
前記分岐判定ステップにより分岐があると判定されるまでの間、前記移動方位及び移動距離の変化を用いて前記現在位置を地図上の道路に合わせ込む第1のマッチング方法により、前記現在位置を求め、
前記分岐判定ステップにより分岐があると判定された場合で、前記勾配判定ステップにより、分岐先の複数の道路に勾配がないと判定された場合、前記第1のマッチング方法により現在位置を求め続け、
前記分岐判定ステップにより分岐があると判定された場合で、前記勾配判定ステップにより分岐先の複数の道路に勾配があると判定された場合、監視距離を定め、
当該監視距離を移動する間、前記高度変化検出ステップにより求めた高さ方向の変化に、より一致する勾配情報を有する道路上に前記現在位置を求める第2のマッチング方法により、前記現在位置を求め、前記監視距離を移動した後は、前記第1のマッチング方法により現在位置を求め、
前記第2のマッチング方法は、
前記勾配判定手段により勾配があると判定された道路に、前記監視距離の長さに応じて、高さ方向の変化の閾値を設定し、
前記高度変化検出手段により求めた高さ方向の変化が、前記閾値を越えた場合に、その閾値が設定された道路に現在位置を求める
ことを特徴とするナビゲーション装置の現在位置算出方法。 A method for calculating a current position of a navigation device,
The navigation device
A device for storing map data including gradient information for roads on the map,
Obtaining a change in travel direction and travel distance;
Altitude change detection step for finding a change in height direction,
A branch determination step for determining whether or not there is a branch on the road;
A gradient determining step for determining whether or not there is a gradient on a plurality of roads to be branched when it is determined that there is a branch in the branch determination step;
Performing a current position calculating step for obtaining a current position on the map;
The current position calculating step includes:
Until the branch determination step determines that there is a branch, the current position is obtained by a first matching method in which the current position is matched with a road on a map using the change in the movement direction and the movement distance. ,
If it is determined by the branch determination step that there is a branch, and if it is determined by the gradient determination step that there are no gradients on the plurality of roads to be branched, the current position is continuously determined by the first matching method,
When it is determined by the branch determination step that there is a branch, and when it is determined by the gradient determination step that there is a gradient on a plurality of roads to be branched, a monitoring distance is determined,
While moving the monitoring distance, the current position is obtained by the second matching method for obtaining the current position on a road having gradient information that more closely matches the change in the height direction obtained by the altitude change detection step. , After moving the monitoring distance, find the current position by the first matching method,
The second matching method is:
In accordance with the length of the monitoring distance, a threshold value for a change in the height direction is set on the road determined to have a gradient by the gradient determination unit,
A method for calculating a current position of a navigation device, characterized in that, when a change in a height direction obtained by the altitude change detection means exceeds the threshold value, a current position is obtained on a road where the threshold value is set .
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004084193A JP4074598B2 (en) | 2004-03-23 | 2004-03-23 | Navigation device and current position calculation method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004084193A JP4074598B2 (en) | 2004-03-23 | 2004-03-23 | Navigation device and current position calculation method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2005274187A JP2005274187A (en) | 2005-10-06 |
JP4074598B2 true JP4074598B2 (en) | 2008-04-09 |
Family
ID=35174037
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004084193A Expired - Fee Related JP4074598B2 (en) | 2004-03-23 | 2004-03-23 | Navigation device and current position calculation method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4074598B2 (en) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008032591A (en) * | 2006-07-31 | 2008-02-14 | Alpine Electronics Inc | Angular velocity calculating device, offset determination method therefor, and vehicle stop detector |
JP2008175716A (en) * | 2007-01-19 | 2008-07-31 | Xanavi Informatics Corp | Navigation system for specifying one's own vehicle position based on altitude variation, and its method |
JP5276922B2 (en) * | 2008-08-12 | 2013-08-28 | 株式会社日立製作所 | Current position calculation device |
US8775063B2 (en) * | 2009-01-26 | 2014-07-08 | GM Global Technology Operations LLC | System and method of lane path estimation using sensor fusion |
JP5691145B2 (en) * | 2009-08-10 | 2015-04-01 | ソニー株式会社 | Vehicle route determination method and navigation apparatus |
CN114485687B (en) * | 2020-11-13 | 2023-09-26 | 博泰车联网科技(上海)股份有限公司 | Vehicle position determining method and related device |
-
2004
- 2004-03-23 JP JP2004084193A patent/JP4074598B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2005274187A (en) | 2005-10-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7948397B2 (en) | Image recognition apparatuses, methods and programs | |
KR100266882B1 (en) | Navigation device | |
US7194356B2 (en) | Route search method in navigation system | |
US7634356B2 (en) | Navigation device | |
EP1760433A1 (en) | Navigation device | |
JP2005201793A (en) | Route retrieval method of navigation system | |
US9109919B2 (en) | Curved-section-information supplying apparatus and curved-section-information supplying method | |
JP2007278765A (en) | Navigation device and map data updating method | |
JP2008175716A (en) | Navigation system for specifying one's own vehicle position based on altitude variation, and its method | |
JP4374242B2 (en) | Navigation device and computer program. | |
JP4409965B2 (en) | Navigation device and route search method thereof | |
JP2006215189A (en) | Display method of navigation system | |
JP4074598B2 (en) | Navigation device and current position calculation method | |
JP4776276B2 (en) | Navigation device | |
US20080189035A1 (en) | Map display apparatus for vehicle | |
JP2005274315A (en) | Route search method for navigation system | |
JP5068114B2 (en) | In-vehicle navigation device and icon display method in in-vehicle navigation device | |
JP4520870B2 (en) | Navigation device and current position display method | |
JP4409968B2 (en) | Route guidance method for navigation device and navigation device | |
JP2005121425A (en) | Route searching method for navigation system | |
JP2005274186A (en) | Acceleration calculation method of navigation device | |
JP4307947B2 (en) | Navigation device and route search method | |
JP2007263683A (en) | On-vehicle navigation system | |
JP4335654B2 (en) | Navigation device and route search method for navigation device | |
JP2006275766A (en) | Navigation system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20061215 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20061219 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070208 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20070821 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070919 |
|
A911 | Transfer of reconsideration by examiner before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20071214 |
|
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: 20080115 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20080125 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110201 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110201 Year of fee payment: 3 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313111 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110201 Year of fee payment: 3 |
|
R371 | Transfer withdrawn |
Free format text: JAPANESE INTERMEDIATE CODE: R371 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110201 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120201 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120201 Year of fee payment: 4 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313111 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120201 Year of fee payment: 4 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120201 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130201 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140201 Year of fee payment: 6 |
|
LAPS | Cancellation because of no payment of annual fees |