JPH08334346A - Present location calculating device - Google Patents
Present location calculating deviceInfo
- Publication number
- JPH08334346A JPH08334346A JP13953595A JP13953595A JPH08334346A JP H08334346 A JPH08334346 A JP H08334346A JP 13953595 A JP13953595 A JP 13953595A JP 13953595 A JP13953595 A JP 13953595A JP H08334346 A JPH08334346 A JP H08334346A
- Authority
- JP
- Japan
- Prior art keywords
- current position
- road
- vehicle
- candidate point
- reliability
- 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
Links
Landscapes
- Navigation (AREA)
- Traffic Control Systems (AREA)
- Instructional Devices (AREA)
Abstract
Description
【0001】[0001]
【産業上の利用分野】本発明は、車両等の移動体に搭載
され、該移動体の走行距離、進行方位などを測定して、
これにより、当該移動体の現在位置を算出する現在位置
算出装置に関するものである。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention is mounted on a moving body such as a vehicle and measures the traveling distance and traveling direction of the moving body.
Accordingly, the present invention relates to a current position calculation device that calculates the current position of the moving body.
【0002】[0002]
【従来技術】従来より、道路上を走行する車両の現在位
置を算出する現在位置算出装置において、該車両の現在
位置は、ジャイロ等の方位センサにより測定した車両の
進行方向と、車速センサまたは距離センサにより測定し
た車両の走行距離とに基づいて算出されている。2. Description of the Related Art Conventionally, in a current position calculating device for calculating the current position of a vehicle traveling on a road, the current position of the vehicle is the traveling direction of the vehicle measured by a direction sensor such as a gyro and the vehicle speed sensor or the distance. It is calculated based on the travel distance of the vehicle measured by the sensor.
【0003】また、車両の走行距離は、一般的には、ト
ランスミッションの出力軸、または、タイヤの回転数を
計測して、その回転数に、タイヤ1回転あたりに車両が
進む距離である距離係数を乗ずることにより求められて
いる。Further, the mileage of a vehicle is generally a distance coefficient which is a distance traveled by the vehicle per one rotation of the tire by measuring the rotational speed of the output shaft of the transmission or the tire. It is calculated by multiplying by.
【0004】さらに、このように車両の進行方向と走行
距離から求めた現在位置の誤差を補正するために、特開
昭63−148115号公報に記載のように、道路に整
合するように、求められた車両の現在位置を修正する、
いわゆる、マップマッチングの技術が知られており、こ
のマップマッチングの技術により、現在位置算出の精度
を高めることができる。Further, in order to correct the error of the current position obtained from the traveling direction of the vehicle and the traveling distance in this way, as described in Japanese Patent Laid-Open No. 63-148115, it is obtained so as to match the road. The current position of the vehicle
A so-called map matching technique is known, and this map matching technique can improve the accuracy of current position calculation.
【0005】[0005]
【発明が解決しようとする課題】しかしながら、車両の
仮想現在位置に対して所定の範囲内に位置するすべての
道路を検索する処理を実行することが必要であり、その
ために要する時間は、当該所定の範囲内に位置する道路
の密度に依存し、特に、道路が市街地内に存在するもの
であった場合には、処理時間が著しく長くなる。さら
に、道路上に求められた現在位置候補点の信頼度を算出
するために要する処理時間も長くなる。However, it is necessary to execute a process of searching for all roads located within a predetermined range with respect to the virtual current position of the vehicle, and the time required for this is the predetermined time. Depending on the density of the roads located within the range, especially when the roads exist in the city area, the processing time becomes extremely long. Further, the processing time required to calculate the reliability of the current position candidate point obtained on the road also becomes long.
【0006】道路を検索するための処理時間および信頼
度を算出するための処理時間が、著しく長くなることに
より、装置が実行すべき他の処理、たとえば、方位セン
サのデータの読み取り、車速センサまたは距離センサの
データの読み取り、或いは、車速センサまたは距離セン
サのデータに基づく車両の走行距離の算出などを適切に
行うことができない場合があるという問題点があった。Since the processing time for searching the road and the processing time for calculating the reliability are remarkably lengthened, other processing to be executed by the device, such as reading of data of a direction sensor, a vehicle speed sensor or There is a problem in that it may not be possible to appropriately read the data of the distance sensor or appropriately calculate the traveling distance of the vehicle based on the vehicle speed sensor or the data of the distance sensor.
【0007】本発明は、マップマッチングの精度を損な
うことなく、その処理負荷を軽減することができる現在
位置算出装置を提供することを目的とする。It is an object of the present invention to provide a current position calculation device capable of reducing the processing load without impairing the accuracy of map matching.
【0008】[0008]
【課題を解決する手段】本発明の目的は、車両に搭載さ
れ、該車両の現在位置を算出する現在位置算出装置であ
って、車両の進行方位を検出する方位検出手段と、車両
の走行距離を算出する距離算出手段と、道路データを格
納した道路データ格納手段と、前記進行方位および前記
走行距離に基づき得られた相対変位に基づいて、車両の
現在位置を仮想現在位置として推定し、該仮想現在位置
を前記道路データ格納手段の道路データと照合して、道
路上の現在位置の候補点をその信憑性を示す信頼度とと
もに算出し、該信頼度の最も高い候補点を現在位置と認
定するマップマッチング手段とを備え、該マップマッチ
ング手段は、前記信頼度の最も高い候補点以外の候補点
についても次回の仮想現在位置の推定およびそれに伴う
候補点の算出を行い、その際、算出された信頼度が予め
定めた程度より低い候補点を削除することを特徴とする
現在位置算出装置により達成される。SUMMARY OF THE INVENTION An object of the present invention is a current position calculating device mounted on a vehicle for calculating the current position of the vehicle, the direction detecting means for detecting the traveling direction of the vehicle, and the traveling distance of the vehicle. Based on the relative displacement obtained based on the traveling azimuth and the traveled distance, the vehicle current position is estimated as a virtual current position, The virtual current position is collated with the road data of the road data storage means, the candidate point of the current position on the road is calculated together with the reliability indicating its credibility, and the candidate point with the highest reliability is recognized as the current position. Map matching means for performing the next virtual current position estimation and calculation of the candidate points associated with the candidate points other than the candidate point having the highest reliability. , Where, calculated reliability is achieved by the current position calculating device and deletes candidate point lower than degree of advance.
【0009】この装置において、前記予め定めた程度よ
り低い候補点は、例えば、前記最も信頼度の高い候補点
の信頼度に比べて予め定められた量以上低い信頼度を有
する候補点である。In this apparatus, the candidate points lower than the predetermined degree are, for example, candidate points having a reliability lower than the reliability of the candidate point having the highest reliability by a predetermined amount or more.
【0010】前記マップマッチング手段は、好ましく
は、前記仮想現在位置の周辺の道路に対する距離、およ
びその道路方位と車両方位との方位差に基づいて、当該
道路上に求まる候補点の信頼度を算出する。The map matching means preferably calculates the reliability of a candidate point found on the road based on the distance to the road around the virtual current position and the heading difference between the road heading and the vehicle heading. To do.
【0011】前記マップマッチング手段は、道路外にあ
る仮想現在位置に対応する道路上の候補点がみつからな
いとき、当該道路外にある仮想現在位置を候補点とし、
該道路外の候補点を削除するか否かを判定する際に用い
る前記予め定められた程度を、道路上の候補点に比べて
削除されや易いように設定することもできる。When the candidate point on the road corresponding to the virtual current position outside the road is not found, the map matching means sets the virtual current position outside the road as a candidate point,
The predetermined degree used when determining whether or not to delete the candidate points outside the road can be set to be easily deleted as compared with the candidate points on the road.
【0012】[0012]
【作用】マップマッチング処理においては、原則的に
は、車両の現在位置に対して新たに求められた相対走行
距離および進行方位に基づいて、仮想現在位置を算出
し、この仮想現在位置を付近の道路データと対照して、
最も確からしい(信頼度が最も高い)と判断される道路
上の位置を求め、これを現在位置と認定する。しかし、
誤差による誤認定を防止するために、最も確からしいと
判断された現在位置の候補点以外の候補点のデータを直
ちに破棄せず、その候補点についてもそれに基づく新た
な候補点を算出し、これらの候補点の中から最も確から
しい候補点を現在位置と認定する。In the map matching process, in principle, the virtual current position is calculated based on the relative traveling distance and the heading newly obtained with respect to the current position of the vehicle, and the virtual current position is calculated in the vicinity. In contrast to road data,
The position on the road that is judged to be the most probable (highest reliability) is obtained, and this is recognized as the current position. But,
In order to prevent misidentification due to error, data of candidate points other than the candidate point of the current position that is judged to be the most probable is not immediately discarded, and new candidate points are calculated based on that data as well. The most probable candidate point among the candidate points of is identified as the current position.
【0013】このように最も確からしい候補点以外の候
補点のデータも保持して、これらから新たな候補点を求
めると、保持すべきデータが相当数に増大する可能性が
ある。これは、リアルタイムに処理すべきマップマッチ
ング処理の実行においてプロセッサに過大な処理負荷を
課すおそれがある。特に、市街地のように道路が密集し
ている地域では、この問題が顕著となる。本発明では、
候補点に関して与えられたその信憑性を示す信頼度を検
査して、信頼度が予め定めた程度より低い候補点を削除
する。If data of candidate points other than the most probable candidate points are held in this way and new candidate points are obtained from these, there is a possibility that the data to be held will increase to a considerable number. This may impose an excessive processing load on the processor in executing the map matching process to be processed in real time. This problem is particularly noticeable in areas with dense roads such as urban areas. In the present invention,
The confidence level given to a candidate point, which indicates its credibility, is checked, and the candidate point having a reliability level lower than a predetermined level is deleted.
【0014】これによって、マップマッチング処理の信
頼性を維持しながら、その処理における処理対象の数、
すなわち処理負荷を軽減し、処理実行に要する時間を短
縮することが可能となる。Thus, while maintaining the reliability of the map matching process, the number of objects to be processed in the process,
That is, it is possible to reduce the processing load and the time required to execute the processing.
【0015】[0015]
【実施例】以下、添付図面に基づいて、本発明の実施例
につき詳細に説明を加える。Embodiments of the present invention will be described below in detail with reference to the accompanying drawings.
【0016】図1は、本発明の実施例にかかる現在位置
算出装置の構成を示すブロックダイヤグラムである。図
1に示すように、この現在位置算出装置10は、車両の
ヨーレイトを検出することで進行方位変化を検出する角
速度センサ11と、地磁気を検出することで車両の進行
方位を検出する地磁気センサ12と、車両のトランスミ
ッションの出力軸の回転に比例した時間間隔でパルスを
出力する車速センサ13を備えている。FIG. 1 is a block diagram showing the configuration of the present position calculating apparatus according to the embodiment of the present invention. As shown in FIG. 1, the present position calculation device 10 includes an angular velocity sensor 11 that detects a yaw rate of a vehicle to detect a change in traveling direction, and a geomagnetic sensor 12 that detects a traveling direction of a vehicle by detecting geomagnetism. And a vehicle speed sensor 13 that outputs pulses at time intervals proportional to the rotation of the output shaft of the vehicle transmission.
【0017】また、現在位置周辺の地図や現在位置を示
すマーク等を表示するディスプレイ17と、ディスプレ
イ17に表示する地図の縮尺切り替えの指令をユーザに
(運転者)から受け付けるスイッチ14と、デジタル地
図データを記憶しておくCD−ROM15と、そのCD
−ROM15から地図データを読みだすためのドライバ
16とを備えている。また、以上に示した各周辺装置の
動作の制御を行うコントローラ18を備えている。本実
施例において、上述したディジタル地図データには、複
数の線分の端部を示す座標から構成される道路データ、
或いは、該道路の道幅を示す道路幅データ、道路が高速
道路或いは一般道路であるかを示す高速道路フラグなど
が含まれる。Further, a display 17 for displaying a map around the current position, a mark indicating the current position, etc., a switch 14 for accepting a command for switching the scale of the map displayed on the display 17 from the user (driver), a digital map. CD-ROM 15 for storing data and its CD
A driver 16 for reading map data from the ROM 15. Further, the controller 18 for controlling the operation of each peripheral device described above is provided. In the present embodiment, the digital map data described above includes road data composed of coordinates indicating the ends of a plurality of line segments,
Alternatively, it includes road width data indicating the road width of the road, a highway flag indicating whether the road is a highway or a general road, and the like.
【0018】コントローラ18は、角速度センサ11の
信号(アナログ)をデジタル信号に変換するA/D変換
器19と、地磁気センサ12の信号(アナログ)をデジ
タル信号に変換するA/D変換器20と、車速センサ1
3から出力されるパルス数を0.1秒毎にカウントする
カウンタ26と、スイッチ14の押圧の有無を入力する
パラレルI/O21と、CD−ROM15から読みださ
れた地図データを転送するDMA(Direct Memory Acce
ss)コントローラ22と、ディスプレイ17に地図画像
を表示する表示プロセッサ23とを有する。The controller 18 includes an A / D converter 19 for converting the signal (analog) of the angular velocity sensor 11 into a digital signal, and an A / D converter 20 for converting the signal (analog) of the geomagnetic sensor 12 into a digital signal. , Vehicle speed sensor 1
A counter 26 that counts the number of pulses output from the CPU 3 every 0.1 seconds, a parallel I / O 21 that inputs whether or not the switch 14 is pressed, and a DMA (that transfers the map data read from the CD-ROM 15 ( Direct Memory Acce
ss) It has a controller 22 and a display processor 23 for displaying a map image on the display 17.
【0019】また、コントローラ18は、さらに、マイ
クロプロセッサ24と、メモリ25とを有する。マイク
ロプロセッサ24は、A/D変換器19を介して得た角
速度センサ11の信号、A/D変換器20を介して得た
地磁気センサ12の信号、カウンタ26がカウントした
車速センサ13の出力パルス数、パラレルI/O21を
介して入力するスイッチ14の押圧の有無、DMAコン
トロ−ラ22を介して得たCD−ROM15からの地図
データを受け入れて、それら信号に基づいて処理を行
い、車両の現在位置を算出して、それを表示プロセッサ
23を介してディスプレイ17に表示させる。この車両
位置の表示は、図2に示すように、すでにディスプレイ
17に表示している地図上に矢印マ−ク等を重畳して表
示することにより行う。これにより、ユーザは、地図上
で車両の現在位置を知ることができる。メモリ25は、
このような動作を実現するための処理(後述)の内容を
規定するプログラムなどを格納したROMと、マイクロ
プロセッサ24が処理を行う場合にワ−クエリアとして
使用するRAMとを含んでいる。The controller 18 also has a microprocessor 24 and a memory 25. The microprocessor 24 outputs the signal of the angular velocity sensor 11 obtained through the A / D converter 19, the signal of the geomagnetic sensor 12 obtained through the A / D converter 20, and the output pulse of the vehicle speed sensor 13 counted by the counter 26. Number, whether or not the switch 14 is pressed through the parallel I / O 21, and the map data from the CD-ROM 15 obtained through the DMA controller 22 are received and processed based on those signals, The current position is calculated and displayed on the display 17 via the display processor 23. The display of the vehicle position is performed by superimposing an arrow mark or the like on the map which is already displayed on the display 17, as shown in FIG. This allows the user to know the current position of the vehicle on the map. The memory 25 is
It includes a ROM that stores a program that defines the contents of processing (described later) for realizing such operations, and a RAM that is used as a work area when the microprocessor 24 performs the processing.
【0020】以下、このように構成された現在位置算出
装置10の動作について説明する。The operation of the present position calculating device 10 thus configured will be described below.
【0021】装置10の動作は、全般的に、車両の進行
方位及び走行距離を算出する処理と、算出された進行方
位及び距離から車両の現在位置を決定する処理と、得ら
れた車両位置および方位を表示する処理との三つの処理
に分けることができるため、これらについて順次説明す
る。The operation of the apparatus 10 is generally performed by a process of calculating the traveling direction and the traveling distance of the vehicle, a process of determining the current position of the vehicle from the calculated traveling direction and distance, and the obtained vehicle position and Since it can be divided into three processes, that is, the process of displaying the azimuth, these processes will be described sequentially.
【0022】図3に、車両の進行方位及び走行距離を算
出する処理の流れを説明する。FIG. 3 illustrates the flow of processing for calculating the heading and traveling distance of the vehicle.
【0023】この処理は、一定周期、たとえば100m
S毎に起動され実行されるマイクロプロセッサ24のル
ーチンである。This processing is carried out at a fixed cycle, for example, 100 m.
This is a routine of the microprocessor 24 that is activated and executed for each S.
【0024】このルーチンでは、最初、A/D変換器1
9から角速度センサ11の出力値を読み込む(ステップ
301)。この角速度センサ11の出力値には、方位変
化が出力されるので、車両の進行方向の相対的な値しか
検出できない。このため、次に、A/D変換器20から
地磁気センサ12の出力値を読み込み(ステップ30
2)、この地磁気センサ12の出力値により算出された
絶対方位と角速度センサ11から出力される方位変化
(角速度出力)とを用いて、車両の推定方位を決定する
(ステップ303)。In this routine, first, the A / D converter 1
The output value of the angular velocity sensor 11 is read from 9 (step 301). Since the azimuth change is output as the output value of the angular velocity sensor 11, only a relative value in the traveling direction of the vehicle can be detected. Therefore, next, the output value of the geomagnetic sensor 12 is read from the A / D converter 20 (step 30
2) The estimated azimuth of the vehicle is determined using the absolute azimuth calculated from the output value of the geomagnetic sensor 12 and the azimuth change (angular velocity output) output from the angular velocity sensor 11 (step 303).
【0025】この方位の決定は、たとえば、長い時間、
車速が低い時には、角速度センサの誤差が大きいので、
一定時間以上車速が低い場合には、地磁気センサ方位の
みを利用するという方法により行う。This azimuth determination can be performed, for example, for a long time,
When the vehicle speed is low, the error of the angular velocity sensor is large, so
When the vehicle speed is low for a certain period of time or more, the method is performed by using only the geomagnetic sensor direction.
【0026】次に、車速センサ13の出力するパルス数
を、0.1秒毎に、カウンタ26で計数して、その計数
値を読み込む(ステップ304)。この読み込んだ値
に、距離係数を乗算することで、0.1秒間に進んだ距
離を求める(ステップ305)。Next, the number of pulses output from the vehicle speed sensor 13 is counted by the counter 26 every 0.1 seconds, and the counted value is read (step 304). By multiplying the read value by the distance coefficient, the distance advanced in 0.1 second is obtained (step 305).
【0027】次に、このようにして求められた0.1秒
間あたりの走行距離値を、前回得られた値に積算して、
車両の走行距離が20mとなったかどうかを調べ(ステ
ップ306)、20mに満たない場合(ステップ306
でノー(No))、今回の処理を終了して、新たな処理
を開始する。Next, the traveling distance value per 0.1 second thus obtained is integrated with the value obtained last time,
It is checked whether or not the traveling distance of the vehicle has reached 20 m (step 306).
No, the current process is terminated and a new process is started.
【0028】走行距離算出処理の結果、積算された走行
距離が一定距離、例えば20mとなった場合(ステップ
306でイエス(Yes))、その時点での進行方向と
走行距離(20m)とを出力する(ステップ307)。
ステップ307では、さらに、積算距離を初期化して、
新たに走行距離の積算を開始する。As a result of the traveling distance calculation processing, when the accumulated traveling distance becomes a fixed distance, for example, 20 m (Yes in step 306), the traveling direction and traveling distance (20 m) at that time are output. (Step 307).
In step 307, the integrated distance is further initialized,
Start a new mileage integration.
【0029】次に、算出された進行方位および走行距離
に基づいて、車両の仮想現在位置を算出し、算出された
仮想現在位置に基づき、車両の候補点を求める処理につ
いて説明する。Next, the process of calculating the virtual current position of the vehicle on the basis of the calculated heading and traveling distance and obtaining the candidate point of the vehicle based on the calculated virtual current position will be described.
【0030】図4に、この処理の流れを示す。FIG. 4 shows the flow of this processing.
【0031】本処理は、図3からの進行方位および走行
距離が出力されるのを受けて起動され、実行されるマイ
クロプロセッサ24のルーチンである。すなわち、本処
理は、車両が20m進む毎に起動される。This processing is a routine of the microprocessor 24 which is started and executed in response to the output of the traveling direction and the traveling distance from FIG. That is, this process is started every time the vehicle advances 20 m.
【0032】さて、この処理では、まず、先のステップ
307で出力されたセンサデータ、すなわち進行方位と
走行距離とを読み込む(ステップ41)。In this process, first, the sensor data output in the previous step 307, that is, the traveling direction and the traveling distance are read (step 41).
【0033】ついで、マップマッチング処理を行う(ス
テップ42)。これは、後に詳述するように、候補点の
信頼度の算出処理を含む。Next, a map matching process is performed (step 42). This includes a process of calculating the reliability of candidate points, as will be described in detail later.
【0034】次に、このマップマッチング処理で得られ
た最も信頼度の高い候補点である表示候補点の信頼度よ
り一定の値Qだけ低い信頼度の値Pを求める(ステップ
43)。このPの値は、信頼度の最大値を100とした
場合、40〜50程度の予め定めた値である。候補点が
後述するマッチング状態かフリー状態かに応じてQの値
を切り替えるようにしてもよい。その場合、フリー状態
候補点の方が削除されやすくなるように、フリー状態候
補点に対するQ値をマッチング状態の候補点に対するQ
値に比べて低くする。Next, a reliability value P lower than the reliability of the display candidate point which is the highest reliability candidate point obtained by the map matching process by a constant value Q is obtained (step 43). The value of P is a predetermined value of about 40 to 50 when the maximum value of reliability is 100. The value of Q may be switched depending on whether the candidate point is a matching state or a free state described later. In that case, the Q value for the free state candidate points is set to the Q value for the matching state candidate points so that the free state candidate points are more easily deleted.
Lower the value.
【0035】ついで、表示候補点以外の候補点の信頼度
を上記の求めたPの値と比較する(ステップ44)。そ
の信頼度がP値以上であれば(ステップ44,No)、
そのままステップ46へ移行し、P値より小さければ
(ステップ44,Yes)、ステップ45へ進む。ステ
ップ45では、当該候補(および後述する各種情報)を
メモリから削除する。この削除によって、次のマップマ
ッチング処理においてこの候補点から新たな候補点を求
める処理が省略され、処理負担を軽減することができ
る。Next, the reliability of candidate points other than the display candidate points is compared with the value of P obtained above (step 44). If the reliability is equal to or higher than the P value (step 44, No),
If it is smaller than the P value (Yes in step 44), the process proceeds to step 45. In step 45, the candidate (and various information described later) is deleted from the memory. By this deletion, the process of obtaining a new candidate point from this candidate point in the next map matching process is omitted, and the processing load can be reduced.
【0036】表示候補点以外のすべての候補点につい
て、ステップ44以降の処理を繰り返して、本処理を終
了する(ステップ46)。The processing from step 44 onward is repeated for all candidate points other than the display candidate points, and this processing ends (step 46).
【0037】図5に、マップマッチング処理の詳細を示
す。FIG. 5 shows the details of the map matching process.
【0038】マップマッチング処理においては、まず、
車両の移動量を緯度経度方向、別々に、それぞれ求め
る。さらに、これらの各方向における移動量を、前回の
車両の候補点を求める処理で得られた車両の候補点の位
置に加算して、現在車両が存在すると推定される位置で
ある仮想現在位置(A)を求める(ステップ421)。
この候補点の詳細については後述する。もし、装置の始
動直後など、前回の車両の候補点を求める処理で得られ
た候補点が存在しない場合には、別途設定された位置
を、前回得られた候補点の位置として用いて仮想現在位
置(A)を求める。In the map matching process, first,
The amount of movement of the vehicle is obtained separately in the latitude and longitude directions. Further, the movement amount in each of these directions is added to the position of the vehicle candidate point obtained in the previous process for obtaining the vehicle candidate point, and the virtual current position (position where the current vehicle is estimated to exist) ( A) is calculated (step 421).
Details of this candidate point will be described later. If there is no candidate point obtained in the previous process of finding candidate points for the vehicle, such as immediately after the start of the device, the position set separately is used as the position of the previously obtained candidate point and the virtual current is used. Find position (A).
【0039】次に、得られた仮想現在位置(A)の周辺
の地図の道路データを、CD−ROM15から、ドライ
バ16およびDMAコントローラ23を介して読み出す
(ステップ422)。このとき、仮想現在位置(A)を
得るために用いた候補点が道路上の候補点であれば、当
該仮想現在位置(A)から距離検索範囲D内の線分であ
ってその道路を表す線分またはこれにつながる線分を選
択する。道路上の候補点でない候補点(フリー状態の候
補点)の場合には、当該仮想現在位置(A)から距離検
索範囲D内の線分を選択する。この際、当該仮想現在位
置を得るために用いた候補点に関する信頼度(前回補正
されたもの)に基づいて、道路の検索範囲Dを可変とし
てもよい。すなわち、信頼度の高い候補点から得た仮想
現在位置に関しては、より狭い範囲内に含まれる線分を
選択し、逆に信頼度の低い候補点から得た仮想現在位置
に関しては、より広い範囲に含まれる線分を選択する。
信頼度に基づいて、検索範囲を可変とする理由は、信頼
度が小さい場合には、前回求めた現在位置の精度に対す
る信憑性が低いと考えられるので、より広い範囲を検索
して道路を探す方が、正しい現在位置を求める上で適当
であるからである。Next, the road data of the obtained map around the virtual current position (A) is read from the CD-ROM 15 via the driver 16 and the DMA controller 23 (step 422). At this time, if the candidate point used to obtain the virtual current position (A) is a candidate point on the road, a line segment within the distance search range D from the virtual current position (A) represents the road. Select a line segment or a line segment connected to it. If the candidate point is not a candidate point on the road (free candidate point), a line segment within the distance search range D from the virtual current position (A) is selected. At this time, the road search range D may be variable based on the reliability of the candidate points used to obtain the virtual current position (corrected last time). That is, for the virtual current position obtained from the highly reliable candidate point, the line segment included in the narrower range is selected, and conversely, the virtual current position obtained from the less reliable candidate point is wider range. Select the line segment included in.
The reason for changing the search range based on the reliability is that the reliability of the accuracy of the current position obtained last time is considered to be low when the reliability is low, so a wider range is searched to find the road. This is because it is more appropriate to obtain the correct current position.
【0040】なお、前述したように、本実施例において
は、道路データとして、図6に示すように、2点間を結
ぶ複数の線分51ないし55で近似し、それら線分を、
その始点と終点の座標によって表したものなどを用いて
いる。たとえば、線分53は、その始点(x3、y3)
と終点(x4、y4)によって表現される。As described above, in this embodiment, road data is approximated by a plurality of line segments 51 to 55 connecting two points as shown in FIG.
The one represented by the coordinates of the start point and the end point is used. For example, the line segment 53 has its starting point (x3, y3)
And the end point (x4, y4).
【0041】次に、ステップ422で取り出された線分
の中から、その線分の方位が、求められている進行方向
と、所定値以内にある線分だけを選択し(ステップ42
3)、さらに、取り出されたn個すべての線分に対し
て、仮想現在位置(A)から垂線をおろし、その垂線L
(n)の長さを求める(ステップ424)。Next, from the line segments extracted in step 422, only the line segments whose azimuth is within the predetermined traveling direction and the required traveling direction are selected (step 42).
3) Further, for all of the extracted n line segments, a perpendicular is drawn from the virtual current position (A), and the perpendicular L
The length of (n) is obtained (step 424).
【0042】次に、これら垂線の長さに基づき、ステッ
プ423で選択されたすべての線分に対して、以下の式
によりに定義されるエラーコスト値ec(n)を算出す
る。Next, based on the lengths of these perpendiculars, the error cost value ec (n) defined by the following equation is calculated for all the line segments selected in step 423.
【0043】ec(n)=α×|θcar−θ(n)|+
β|L(n)| ここに、θcarは仮想現在位置(A)における車両方
位、θ(n)は、線分の方位、L(n)は、仮想現在位
置(A)から線分までの距離、すなわち垂線の長さ、α
およびβは、重み係数である。これら重み係数の値は、
進行方向と道路の方位のずれと現在位置と道路のずれの
どちらを、現在位置の属する道路を選択する上で重視す
るかによって変化させてよい。たとえば、進行方向と方
位が近い道路を重視する場合は、αを大きくするように
する。Ec (n) = α × | θcar−θ (n) | +
β | L (n) | where θcar is the vehicle direction at the virtual current position (A), θ (n) is the direction of the line segment, and L (n) is the direction from the virtual current position (A) to the line segment. Distance, ie the length of the perpendicular, α
And β are weighting factors. The values of these weighting factors are
It may be changed depending on which of the deviation between the traveling direction and the direction of the road and the deviation between the current position and the road is given priority in selecting the road to which the current position belongs. For example, when a road whose direction is close to the traveling direction is important, α is increased.
【0044】ここで、候補点につき説明を加える。装置
の始動直後など、初期的な状態においては、仮想現在位
置(A)は、ユーザ(運転者)がスイッチ14を用いて
所定の情報を入力することなどにより、一意的に定ま
り、かつ、これは道路に対応する線分上に位置する。し
かしながら、車両が走行した後には、ジャイロなどのセ
ンサの誤差などにより、仮想現在位置(A)が、道路に
対応する線分に存在しなくなる場合がある。その結果、
たとえば、図7に示すように、道路が分岐している場
合、すなわち、道路に対応する線分61の節点68か
ら、二つの線分64および65があらわれる場合に、い
ずれの線分に対応する道路上に車両が存在するかを明確
にすることができない場合が多い。Here, the candidate points will be further described. In an initial state such as immediately after the start of the device, the virtual current position (A) is uniquely determined by the user (driver) inputting predetermined information using the switch 14 and the like. Is located on the line segment corresponding to the road. However, after the vehicle has traveled, the virtual current position (A) may not exist on the line segment corresponding to the road due to an error in a sensor such as a gyro. as a result,
For example, as shown in FIG. 7, when a road is branched, that is, when two line segments 64 and 65 appear from a node 68 of the line segment 61 corresponding to the road, which line segment corresponds to which line segment. Often it is not possible to determine if a vehicle is present on the road.
【0045】したがって、このような場合に、本実施例
においては、考えられ得る二つの線分上に存在する所定
の点を候補点として設定し、これらの現在位置、エラー
コスト、後述する累算エラーコストなどを、それぞれ、
メモリ25のRAMの所定の領域に記憶するように構成
されている。なお、説明を容易にするため、以下の説明
においては、特に複数の候補点であることを明示しない
限り、単一の候補点から、新たな一以上の候補点を生成
することとする。Therefore, in such a case, in this embodiment, predetermined points existing on two conceivable line segments are set as candidate points, and their current position, error cost, and accumulation to be described later. Error cost, etc.
The memory 25 is configured to be stored in a predetermined area of the RAM. In addition, in order to facilitate the description, in the following description, one or more new candidate points will be generated from a single candidate point, unless it is clearly indicated that there are a plurality of candidate points.
【0046】ついで、算出されたエラーコストec
(n)と、前回の処理で得られた候補点に関連する累算
エラーコストesとにしたがって、下記の式により定義
される、今回の処理における累算エラーコストes
(n)を算出する(ステップ425)。Then, the calculated error cost ec
According to (n) and the cumulative error cost es related to the candidate points obtained in the previous processing, the cumulative error cost es in the current processing defined by the following formula
(N) is calculated (step 425).
【0047】 es(n)=(1−k)×es+k×ec(n) ここに、kは、0より大きく1より小さな重み係数であ
る。この累算エラーコストes(n)は、前回以前の処
理において算出されたエラーコストを、今回の処理にお
いて算出されるエラーコストにどのくらい反映させるか
を表わしている。Es (n) = (1−k) × es + k × ec (n) Here, k is a weighting coefficient larger than 0 and smaller than 1. This accumulated error cost es (n) represents how much the error cost calculated in the previous process is reflected in the error cost calculated in this process.
【0048】さらに、算出された累算エラーコストes
(n)に基づき、下記の式に定義される信頼度trst
(n)を算出する(ステップ425)。Furthermore, the calculated cumulative error cost es
The reliability trst defined by the following equation based on (n)
(N) is calculated (step 425).
【0049】 trst(n)=100/(1+es(n)) この式から明らかなように、累算エラーコストec
(n)が大きくなるのにしたがって、信頼度trst
(n)は減少し、0(ゼロ)に近づく。その一方、これ
が小さくなるのにしたがって、信頼度trst(n)は
増大し、その値は、100に近づく。Trst (n) = 100 / (1 + es (n)) As is clear from this equation, the accumulated error cost ec
The reliability trst increases as (n) increases.
(N) decreases and approaches 0 (zero). On the other hand, as it becomes smaller, the reliability trst (n) increases, and its value approaches 100.
【0050】このような処理をすることにより、ある候
補点に対する現在位置Aより所定の範囲内に存在するn
個の線分に関連する信頼度trst(n)が求められ
る。信頼度は、このように、選択された各線分に対して
算出されるものであるが、本明細書中では、便宜上、そ
の線分上に求められる候補に対する信頼度としても扱
う。By performing such processing, n existing within a predetermined range from the current position A for a certain candidate point
The reliability trst (n) associated with each line segment is obtained. The reliability is calculated for each of the selected line segments in this way, but in the present specification, for the sake of convenience, it is also treated as the reliability for the candidates obtained on the line segment.
【0051】ついで、ある候補点から、対応する線分に
沿って、車両の進行した距離Rに対応する長さだけ進め
られた点を、新たな候補点C(n)とする(ステップ4
26)。したがって、ある候補点の位置する線分或いは
これに接続された線分であって、その方位と車両方位と
の差が所定値以下であるような線分の本数がnである場
合には、n個の新たな候補点C(n)が生成されること
になる。後述するフリー状態の候補点が存在する場合、
候補点の位置する線分が存在せず、この候補点に対する
次の候補点の算出時(ステップ422〜426)には対
応する仮想現在位置から所定範囲D内のすべての線分を
取り出すので、候補点の数が多くなりうる。Then, a point advanced from a certain candidate point along the corresponding line segment by a length corresponding to the distance R traveled by the vehicle is set as a new candidate point C (n) (step 4).
26). Therefore, when the number of line segments in which a certain candidate point is located or a line segment connected to this is such that the difference between the azimuth and the vehicle azimuth is a predetermined value or less is n, N new candidate points C (n) will be generated. If there is a candidate point in the free state described later,
Since there is no line segment where the candidate point is located, and when the next candidate point for this candidate point is calculated (steps 422 to 426), all line segments within the predetermined range D are extracted from the corresponding virtual current position. The number of candidate points can be large.
【0052】最後に、これらの候補点から、最も信頼度
の高い候補点を表示候補として選出し、この表示データ
候補点データを出力する(ステップ427)。より具体
的には、最も信頼度の値の大きな候補点Cを、表示候補
点CD、すなわち、ディスプレイ17上に表示するため
の候補点として、その位置、累算エラーコスト、信頼
度、後述するマッチング状態であるかフリー状態である
かを示す状態フラグなどを、メモリ25のRAMの所定
の領域に記憶するとともに、表示候補点以外の他の候補
点の位置、累算エラーコスト、信頼度、状態フラグなど
も、RAMの所定の領域に記憶する。Finally, from these candidate points, the candidate point having the highest reliability is selected as a display candidate, and this display data candidate point data is output (step 427). More specifically, the candidate point C having the highest reliability value is used as a display candidate point CD, that is, a candidate point for displaying on the display 17, its position, accumulated error cost, reliability, which will be described later. A state flag indicating the matching state or the free state is stored in a predetermined area of the RAM of the memory 25, and the positions of candidate points other than the display candidate points, accumulated error cost, reliability, The status flag and the like are also stored in a predetermined area of the RAM.
【0053】ここで、具体的な道路を例に挙げて、マッ
プマッチングの作用を考える。たとえば、図7に示すよ
うに、線分61上に存在したある候補点62に対して、
現在位置Aが、点63に示す位置に表わされるとする。
このような場合に、現在位置Aから、候補点62が位置
する線分61に接続された線分であって、その方位と車
両方位との差が所定値以下であるような線分64、65
を取り出し、現在位置Aから、線分64、65までの距
離L(1)、L(2)を算出するともに、算出された距
離、線分64、65の角度θ(1)、θ(2)および車
両方位θcarなどに基づき、関連するエラーコスト、累
算エラーコスト、信頼度を算出する。さらに、図3のス
テップ307で求められた車両の走行距離Rに基づき、
ある候補点62から、線分61および64、或いは、線
分61および65に沿って、走行距離Rに対応する長さ
だけ進められた位置を算出し、この位置に対応する点
を、それぞれ候補点66、67とする。Here, the action of map matching will be considered by taking a concrete road as an example. For example, as shown in FIG. 7, for a certain candidate point 62 existing on the line segment 61,
It is assumed that the current position A is represented by the position indicated by the point 63.
In such a case, a line segment 64 connected from the current position A to the line segment 61 in which the candidate point 62 is located, and the difference between the azimuth and the vehicle azimuth is a predetermined value or less, 65
And the distances L (1) and L (2) from the current position A to the line segments 64 and 65 are calculated, and the calculated distances and the angles θ (1) and θ (2 of the line segments 64 and 65 are calculated. ) And the vehicle heading θcar, etc., the associated error cost, accumulated error cost, and reliability are calculated. Further, based on the traveling distance R of the vehicle obtained in step 307 of FIG.
From a certain candidate point 62, a position advanced by a length corresponding to the traveling distance R along line segments 61 and 64 or line segments 61 and 65 is calculated, and points corresponding to this position are respectively candidate. Mark points 66 and 67.
【0054】さらに、図8に示すように、線分64上の
候補点66に対して、新たな現在位置Aが、点71に示
す位置に表わされ、その一方、線分65上の候補点67
に対して、新たな現在位置A’が、点72に示す位置に
表わされるとする。この場合には、現在位置Aから、線
分64に接続された線分であって、その方位と車両方位
との差が所定値以下であるような線分73、74を取り
出すとともに、新たな現在位置A’から、線分65に接
続された線分であって、その方位と車両方位との差が所
定値以下であるような線分75を取り出す。ついで、現
在位置Aから、線分73、74までのそれぞれの距離L
1(1)およびL1(2)を算出するともに、現在位置
A’から、線分75までの距離L2(1)を算出する。
さらに、現在位置Aに関連して算出された距離、線分7
3、74の角度θ1(1)およびθ1(2)ならびに車
両方位θcarなどに基づき、関連するエラーコスト、累
算エラーコストおよび信頼度を算出するとともに、現在
位置A’に関連して算出された距離、線分75の角度θ
2(1)および車両方位θcarなどに基づき、関連する
エラーコスト、累算エラーコストおよび信頼度を算出す
る。Further, as shown in FIG. 8, with respect to the candidate point 66 on the line segment 64, the new current position A is represented at the position indicated by the point 71, while the candidate on the line segment 65 is selected. Point 67
On the other hand, it is assumed that the new current position A ′ is represented by the position indicated by the point 72. In this case, from the current position A, line segments 73 and 74 which are connected to the line segment 64 and in which the difference between the azimuth and the vehicle azimuth is equal to or less than a predetermined value are taken out, and a new segment is added. From the current position A ′, a line segment 75 which is connected to the line segment 65 and whose difference between the direction and the vehicle direction is equal to or less than a predetermined value is extracted. Then, the distance L from the current position A to the line segments 73 and 74
1 (1) and L1 (2) are calculated, and the distance L2 (1) from the current position A ′ to the line segment 75 is calculated.
Furthermore, the distance calculated in relation to the current position A and the line segment 7
Based on the angles θ1 (1) and θ1 (2) of 3,74, the vehicle direction θcar, and the like, the related error cost, accumulated error cost, and reliability are calculated, as well as the current position A ′. Distance, angle of line segment 75
Based on 2 (1) and the vehicle direction θcar, the related error cost, accumulated error cost, and reliability are calculated.
【0055】さらに、図3のステップ307で求められ
た車両の走行距離Rに基づき、候補点66から、線分6
4および73、或いは、線分64および74に沿って、
若しくは、候補点67から、線分65および75に沿っ
て、車両の走行距離Rに対応する長さだけ進められた位
置を算出し、この位置に対応する点を、それぞれ新たな
候補点とする。図9は、このように新たに求められた候
補点81ないし83を示している。Furthermore, based on the traveling distance R of the vehicle obtained in step 307 of FIG.
4 and 73, or along line segments 64 and 74,
Alternatively, a position advanced from the candidate point 67 along the line segments 65 and 75 by a length corresponding to the mileage R of the vehicle is calculated, and the points corresponding to this position are respectively set as new candidate points. . FIG. 9 shows the candidate points 81 to 83 newly obtained in this way.
【0056】ここで、候補点のマッチング状態およびフ
リー状態について説明する。ある線分上に位置する候補
点に対する現在位置Aから、該候補点が位置する線分或
いは、これに接続された線分であって、その方位と車両
の進行方位との差が所定値以下であるような線分が存在
しない場合が考えられる。この場合には、現在位置A自
体を、当該候補点から算出された次の候補点として取り
扱う。本実施例においては、このようにして得られた候
補点を、フリー状態の候補点と称する。これに対して、
それ以外の状態、すなわち、ある線分上に位置する候補
点に対する現在位置Aから、該候補点が位置する線分或
いはこれに接続された線分であって、その方位と車両の
進行方位との差が所定値以下であるような線分が存在
し、その結果、特定の線分上に次の候補点が存在し得る
状態をマッチング状態と称する。Here, the matching state and the free state of the candidate points will be described. From the current position A for a candidate point located on a certain line segment, the line segment at which the candidate point is located or a line segment connected thereto, and the difference between the direction and the traveling direction of the vehicle is not more than a predetermined value. It is possible that there is no line segment such as. In this case, the current position A itself is treated as the next candidate point calculated from the candidate points. In this embodiment, the candidate points obtained in this way are called free state candidate points. On the contrary,
In other states, that is, from the current position A for a candidate point located on a certain line segment, to the line segment where the candidate point is located or to the line segment connected thereto, the direction and the traveling direction of the vehicle A state in which there is a line segment whose difference is less than or equal to a predetermined value, and as a result, the next candidate point can exist on a particular line segment is called a matching state.
【0057】また、候補点が位置する線分或いはこれに
接続された線分であって、その方位と車両の進行方位と
の差が所定値以下であるような線分が存在しない場合
に、ステップ425で算出すべきエラーコストec
(n)には、マッチング状態である場合に得られるエラ
ーコストの値よりも大きな一定の値が与えられる。Further, when there is no line segment where the candidate point is located or which is connected to this line segment and the difference between the direction and the traveling direction of the vehicle is less than a predetermined value, Error cost ec to be calculated in step 425
(N) is given a constant value that is larger than the value of the error cost obtained in the matching state.
【0058】なお、このフリー状態候補点を基に新たな
候補点を求める際には、フリー状態の候補点に対する仮
想現在位置そのものを新たなフリー状態の候補点とする
とともに、その仮想現在位置から所定の範囲D内に、そ
の方位と車両の進行方位との差が所定値以下の線分が存
在する場合には、仮想現在位置から当該線分におろされ
た垂線とこの線分との交点をも、候補点とする。When obtaining a new candidate point based on this free state candidate point, the virtual current position itself for the free state candidate point is set as a new free state candidate point, and the virtual current position is calculated from the virtual current position. If a line segment whose difference between the direction and the traveling direction of the vehicle is equal to or less than a predetermined value exists within the predetermined range D, the intersection point of the perpendicular line drawn from the virtual current position to the line segment and this line segment. Is also a candidate point.
【0059】以上の説明から容易に予測されるように、
マップマッチング処理を実行するための処理時間は、道
路データに対応する道路の密度に依存し、特に、読み出
された地図データに対応する地図が、市街地であった場
合など、道路の密度が大きい場合などでは、この処理時
間は、非常に大きくなる。したがって、本実施例におい
ては、図4で前述したように、表示候補点の信頼度より
所定量以上低い信頼度を有する候補点を削除することに
より、処理負担を軽減し、処理時間の増大を防止するこ
とができる。候補点の削除は信頼度に基づいて行うの
で、マップマッチングの精度を維持しながら、処理負担
の軽減を行うことができる。As easily predicted from the above description,
The processing time for executing the map matching process depends on the density of the road corresponding to the road data, and particularly when the map corresponding to the read map data is an urban area, the road density is high. In some cases, this processing time becomes very large. Therefore, in the present embodiment, as described above with reference to FIG. 4, the processing load is reduced and the processing time is increased by deleting the candidate points having the reliability lower than the reliability of the display candidate points by a predetermined amount or more. Can be prevented. Since the candidate points are deleted based on the reliability, it is possible to reduce the processing load while maintaining the accuracy of map matching.
【0060】図5のステップ427で得られた表示候補
点は、図10に示すフローチャートに基づく処理により
ディスプレイ17の画面上に表示される。The display candidate points obtained in step 427 of FIG. 5 are displayed on the screen of the display 17 by the processing based on the flowchart shown in FIG.
【0061】本処理は、1秒毎に起動され実行されるマ
イクロプロセッサ24のルーチンである。This process is a routine of the microprocessor 24 which is activated and executed every one second.
【0062】最初、スイッチ14が押圧により地図の縮
尺の変更を指示されているかを、パラレルI/O21の
内容を見て判断する(ステップ1301)。もし、押さ
れていれば(ステップ1301でYes)、それに対応
して、所定の縮尺フラグを設定する(ステップ130
2)。First, it is determined whether or not the switch 14 is instructed to change the map scale by looking at the contents of the parallel I / O 21 (step 1301). If it is pressed (Yes in step 1301), a predetermined scale flag is set correspondingly (step 130).
2).
【0063】次に、表示候補点の位置および方位を示す
データを、メモリ25のRAMの所定の領域から読み出
し(ステップ1303)、ステップ1302で切り替え
られた縮尺フラグの内容に応じた縮尺の地図をディスプ
レイ17に、例えば、図2に示すような状態で表示する
(ステップ1304)。Next, data indicating the position and direction of the display candidate point is read from a predetermined area of the RAM of the memory 25 (step 1303), and a map of a scale according to the content of the scale flag switched in step 1302 is displayed. It is displayed on the display 17, for example, in the state as shown in FIG. 2 (step 1304).
【0064】そして、地図に重畳して、表示候補点の位
置およびその方位を、たとえば、先に示した図2のよう
に、矢印記号“↑”を用いて表示する(ステップ130
5)。そして最後に、これらに重畳して、北を示す北マ
ークと、縮尺に対応した距離マークとを、図2のように
表示する(ステップ1306)。Then, the position and the direction of the display candidate point are displayed in superimposition on the map by using the arrow symbol "↑" as shown in FIG. 2 described above (step 130).
5). Finally, the north mark indicating north and the distance mark corresponding to the reduced scale are displayed as shown in FIG. 2 so as to be superimposed on them (step 1306).
【0065】なお、本実施例においては、上記のように
矢印記号を用いて車両位置および方向を示したが、車両
位置および方向の表示形態は、位置および進行方向が、
表示状態が明確に示されるものであれば、その形態は任
意でよい。また、北マーク等も同様である。In this embodiment, the vehicle position and the direction are indicated by using the arrow symbols as described above, but the display form of the vehicle position and the direction indicates that the position and the traveling direction are
The form may be arbitrary as long as the display state is clearly shown. The same applies to the north mark and the like.
【0066】本実施例によれば、各候補点の信頼度に基
づいて、候補点を削除するようにしたので、マップマッ
チング処理の信頼性を維持しながら、多大な処理時間を
要する処理を減じることができ、したがって、現在位置
の算出に要する処理時間を減少させることが可能とな
る。According to the present embodiment, the candidate points are deleted based on the reliability of each candidate point, so that the reliability of the map matching processing is maintained and the processing that requires a large processing time is reduced. Therefore, it is possible to reduce the processing time required to calculate the current position.
【0067】本明細書において、手段とは、必ずしも物
理的手段を意味するものではなく、各手段の機能が、ソ
フトウエアによって実現される場合も包含する。また、
一つの手段の機能が二以上の物理的手段により実現され
ても、二以上の手段の機能が一つの物理的手段により実
現されてもよい。In the present specification, the term "means" does not necessarily mean physical means, but also includes the case where the function of each means is realized by software. Also,
The function of one means may be realized by two or more physical means, or the functions of two or more means may be realized by one physical means.
【0068】[0068]
【発明の効果】本発明によれば、マップマッチングの精
度を損なうことなく、その処理負荷を軽減することがで
きる現在位置算出装置を提供することが可能となる。As described above, according to the present invention, it is possible to provide a current position calculation device capable of reducing the processing load of the map matching without degrading the accuracy thereof.
【図1】 図1は、本発明の実施例にかかる現在位置算
出装置の構成を示すブロックダイヤグラムである。FIG. 1 is a block diagram showing a configuration of a current position calculation device according to an embodiment of the present invention.
【図2】 図2は、本実施例にかかる地図および現在位
置の表示例を示す図である。FIG. 2 is a diagram showing a display example of a map and a current position according to the present embodiment.
【図3】 図3は、車両の進行方位および走行距離を算
出する処理を示すフローチャートである。FIG. 3 is a flowchart showing a process of calculating a traveling direction and a traveling distance of a vehicle.
【図4】 図4は、本実施例にかかる所定走行距離毎に
実行されるメイン処理を示すフローチャートである。FIG. 4 is a flowchart showing a main process executed for each predetermined traveling distance according to the present embodiment.
【図5】 図5は、図4に示した1ステップ(マップマ
ッチング処理)の詳細処理を示すフローチャートであ
る。5 is a flowchart showing detailed processing of one step (map matching processing) shown in FIG.
【図6】 図6は、本実施例にかかる道路データの一例
を説明するための図である。FIG. 6 is a diagram for explaining an example of road data according to the present embodiment.
【図7】 図7は、道路に対応する線分、仮想現在位置
および候補点を説明するための図である。FIG. 7 is a diagram for explaining a line segment corresponding to a road, a virtual current position, and a candidate point.
【図8】 図8は、道路に対応する線分、仮想現在位置
および候補点を説明するための図である。FIG. 8 is a diagram for explaining a line segment corresponding to a road, a virtual current position, and a candidate point.
【図9】 図9は、道路に対応する線分、仮想現在位置
および候補点を説明するための図である。FIG. 9 is a diagram for explaining a line segment corresponding to a road, a virtual current position, and a candidate point.
【図10】 図10は、本実施例にかかる現在位置表示
処理を示すフローチャートである。FIG. 10 is a flowchart showing a current position display process according to the present embodiment.
10 現在位置算出装置 11 角速度センサ 12 地磁気センサ 13 車速センサ 14 スイッチ 15 CD−ROM 16 CD−ROM読み取りドライバ 17 ディスプレイ 18 コントローラ 10 Current Position Calculation Device 11 Angular Velocity Sensor 12 Geomagnetic Sensor 13 Vehicle Speed Sensor 14 Switch 15 CD-ROM 16 CD-ROM Read Driver 17 Display 18 Controller
Claims (4)
する現在位置算出装置であって、 車両の進行方位を検出する方位検出手段と、 車両の走行距離を算出する距離算出手段と、 道路データを格納した道路データ格納手段と、 前記進行方位および前記走行距離に基づき得られた相対
変位に基づいて、車両の現在位置を仮想現在位置として
推定し、該仮想現在位置を前記道路データ格納手段の道
路データと照合して、道路上の現在位置の候補点をその
信憑性を示す信頼度とともに算出し、該信頼度の最も高
い候補点を現在位置と認定するマップマッチング手段と
を備え、 該マップマッチング手段は、前記信頼度の最も高い候補
点以外の候補点についても次回の仮想現在位置の推定お
よびそれに伴う候補点の算出を行い、その際、算出され
た信頼度が予め定めた程度より低い候補点を削除するこ
とを特徴とする現在位置算出装置。1. A current position calculating device mounted on a vehicle for calculating a current position of the vehicle, comprising: an azimuth detecting means for detecting a traveling azimuth of the vehicle; and a distance calculating means for calculating a traveling distance of the vehicle. Road data storage means for storing road data, and based on the relative displacement obtained based on the traveling direction and the traveling distance, the current position of the vehicle is estimated as a virtual current position, and the virtual current position is stored in the road data storage. By comparing with the road data of the means, a candidate point of the current position on the road is calculated together with the reliability indicating its credibility, and a map matching means for recognizing the candidate point with the highest reliability as the current position is provided, The map matching means also estimates the next virtual current position and calculates the candidate points associated with the candidate points other than the candidate point having the highest reliability, and at that time, the calculated candidate points are calculated. Yoriyukido current position calculating device, wherein a delete candidate point lower than degree of advance.
記最も信頼度の高い候補点の信頼度に比べて予め定めら
れた量以上低い信頼度を有する候補点である請求項1記
載の現在位置算出装置。2. A candidate point having a degree of reliability lower than a predetermined degree is a candidate point having a reliability lower than a reliability of the candidate point having the highest degree of reliability by a predetermined amount or more. Current position calculation device.
在位置の周辺の道路に対する距離、およびその道路方位
と車両方位との方位差に基づいて、当該道路上に求まる
候補点の信頼度を算出する請求項1または2記載の現在
位置算出装置。3. The map matching means calculates the reliability of a candidate point found on the road based on the distance to the road around the virtual current position and the heading difference between the road heading and the vehicle heading. The current position calculation device according to claim 1.
る仮想現在位置に対応する道路上の候補点がみつからな
いとき、当該道路外にある仮想現在位置を候補点とし、
該道路外の候補点を削除するか否かを判定する際に用い
る前記予め定められた程度を、道路上の候補点に比べて
削除され易いように設定することを特徴とする請求項
1、2または3記載の現在位置算出装置。4. The map matching means, when a candidate point on the road corresponding to the virtual current position outside the road is not found, sets the virtual current position outside the road as a candidate point,
2. The predetermined degree used when determining whether or not to delete the candidate points outside the road is set so as to be easily deleted as compared with the candidate points on the road. 2. The current position calculation device described in 2 or 3.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP13953595A JP3634005B2 (en) | 1995-06-06 | 1995-06-06 | Current position calculation device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP13953595A JP3634005B2 (en) | 1995-06-06 | 1995-06-06 | Current position calculation device |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH08334346A true JPH08334346A (en) | 1996-12-17 |
JP3634005B2 JP3634005B2 (en) | 2005-03-30 |
Family
ID=15247546
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP13953595A Expired - Lifetime JP3634005B2 (en) | 1995-06-06 | 1995-06-06 | Current position calculation device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3634005B2 (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006292502A (en) * | 2005-04-08 | 2006-10-26 | Xanavi Informatics Corp | Navigation system |
JP2008268814A (en) * | 2007-04-25 | 2008-11-06 | Hitachi Ltd | Map display device |
JP2012233801A (en) * | 2011-05-02 | 2012-11-29 | Toyota Central R&D Labs Inc | Existence probability distribution estimating device and program |
-
1995
- 1995-06-06 JP JP13953595A patent/JP3634005B2/en not_active Expired - Lifetime
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006292502A (en) * | 2005-04-08 | 2006-10-26 | Xanavi Informatics Corp | Navigation system |
JP4594785B2 (en) * | 2005-04-08 | 2010-12-08 | クラリオン株式会社 | Navigation device |
JP2008268814A (en) * | 2007-04-25 | 2008-11-06 | Hitachi Ltd | Map display device |
JP2012233801A (en) * | 2011-05-02 | 2012-11-29 | Toyota Central R&D Labs Inc | Existence probability distribution estimating device and program |
Also Published As
Publication number | Publication date |
---|---|
JP3634005B2 (en) | 2005-03-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3545839B2 (en) | Current position calculation device | |
JP3634006B2 (en) | Current position calculation device | |
JPH08334346A (en) | Present location calculating device | |
JP3679450B2 (en) | Current position calculation device and current position calculation method | |
JP3599422B2 (en) | Current position calculation device | |
JP3587904B2 (en) | Current position calculation device | |
JP3569028B2 (en) | Current position calculation device | |
JPH08334344A (en) | Present location calculating device | |
JP3596943B2 (en) | Current position calculation system and current position calculation method | |
JP3573525B2 (en) | Current position calculation device | |
JPH08334347A (en) | Present location calculating device | |
JP3660389B2 (en) | Current position calculation system and current position calculation method | |
JP3596944B2 (en) | Current position calculation system and current position calculation method | |
JP3693383B2 (en) | Current position calculation system and current position calculation method | |
JP3599421B2 (en) | Current position calculation device | |
JPH08292048A (en) | Current position calculating system and method therefor | |
JP3764508B2 (en) | Current position calculation system and current position calculation method | |
JP3660392B2 (en) | Current position calculation system and current position calculation method | |
JPH08334336A (en) | System and method for calculating present position | |
JP3682091B2 (en) | Current position calculation system and current position calculation method | |
JP3792270B2 (en) | Current position calculation system and current position calculation method | |
JP3679826B2 (en) | Current position calculation system and current position calculation method | |
JPH08334357A (en) | Present location calculating device | |
JP3660393B2 (en) | Current position calculation device | |
JPH08334353A (en) | System and method for calculating present location |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20040901 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20040907 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20041105 |
|
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: 20041214 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20041222 |
|
R150 | Certificate of patent (=grant) or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090107 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140107 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140107 Year of fee payment: 9 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313111 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140107 Year of fee payment: 9 |
|
R371 | Transfer withdrawn |
Free format text: JAPANESE INTERMEDIATE CODE: R371 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140107 Year of fee payment: 9 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313111 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140107 Year of fee payment: 9 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
EXPY | Cancellation because of completion of term |