(57)【特許請求の範囲】
【請求項１】
車両の現在位置を算出する現在位置算出システムであって、
車両の進行方位を検出する方位検出手段と、
車両の走行距離を算出する距離算出手段と、
前記進行方位および前記走行距離に基づき得られた相対変位と、車両が何れかの道路上に位置する状態、或いは、車両が道路上に位置しない状態を示す候補点とに基づき、車両の現在位置であると予想される仮想現在位置を生成する仮想現在位置生成手段と、
前記仮想現在位置と、地図データに含まれる道路データに含まれる道路方位を示すデータとに基づき、当該道路データに対応する道路上に車両が存在することを示す候補点を生成する候補点生成手段と、
前記候補点に対応する道路上の位置に、車両が存在する信憑性を示す信頼度を算出する信頼度算出手段と、
前記候補点の信頼度を比較し、該比較した候補点の中から1つの候補点を、車両の現在位置を示す表示候補点と決定する決定手段とを備え、
前記決定手段は、
車両が分岐点を通過した後、所定の距離を走行する間、
前記表示候補点に基づき得られた候補点を第１候補点とし、当該第１候補点以外の候補点であって、かつ前記分岐点を持つ道路上の候補点に基づき得られた候補点を第２候補点とし、当該第１候補点以外の候補点であって、かつ前記第２候補点以外の候補点を第３候補点とし、
当該第１候補点および当該第２候補点の信頼度を比較する場合、前記第１候補点の信頼度に所定の第１のバイアス値を加算した値と、当該第２候補点の信頼度の値とを比較し、当該第１候補点および第２候補点のうち値が最も大きな候補点を次回の表示候補点と決定し、
前記第１候補点の信頼度と、前記第３候補点の信頼度とを比較する場合、前記第１候補点の信頼度に前記第１のバイアス値より大きい第２のバイアス値を加算した値と、当該第３候補点の信頼度の値とを比較し、当該第１候補点および第３候補点のうち値が最も大きな候補点を次回の表示候補点と決定すること
を特徴とする現在位置算出システム。
【請求項２】
請求項１に記載の現在位置算出システムであって、
前記決定手段は、
前記第１候補点以外の候補点の信頼度を比較して、その信頼度の値が最も大きな候補点を特定する第１の比較手段と、
第１の比較手段により得られた、その信頼度の値が最も大きな候補点の信頼度と、前記第１候補点の信頼度に前記第１のバイアス値或いは第２のバイアス値が加算された値とを比較する第２の比較手段とを有すること
を特徴とする現在位置算出システム。
【請求項３】
さらに、車両が高速道路上を走行している場合には、前記所定の距離に、第１の距離を与え、その一方、車両が一般道路上を走行している場合には、前記第１の距離より小さな第２の距離を与える距離付与手段を備えたこと
を特徴とする請求項１または２に記載の現在位置算出システム。
【請求項４】
車両の現在位置を算出する現在位置算出システムが行なう現在位置算出方法であって、
前記現在位置算出システムは、
車両の進行方位を検出するステップと、
車両の走行距離を算出するステップと、
前記進行方位および前記走行距離に基づき得られた相対変位と、車両が何れかの道路上に位置する状態、或いは、車両が道路上に位置しない状態を示す候補点とに基づき、車両の現在位置であると予想される仮想現在位置を生成するステップと、
前記仮想現在位置と、地図データに含まれる道路データに含まれる道路方位を示すデータとに基づき、当該道路データに対応する道路上に車両が存在することを示す候補点を生成するステップと、
前記候補点に対応する道路上の位置に、車両が存在する信憑性を示す信頼度を算出するステップと、
前記候補点の信頼度を比較し、該比較した候補点の中から1つの候補点を、車両の現在位置を示す表示候補点と決定するステップとを行い、
前記決定するステップは、
車両が分岐点を通過した後、所定の距離を走行する間、
前記表示候補点に基づき得られた候補点を第１候補点とし、当該第１候補点以外の候補点であって、かつ前記分岐点を持つ道路上の候補点に基づき得られた候補点を第２候補点とし、当該第１候補点以外の候補点であって、かつ前記第２候補点以外の候補点を第３候補点とし、
当該第１候補点および当該第２候補点の信頼度を比較する場合、前記第１候補点の信頼度に所定の第１のバイアス値を加算した値と、当該第２候補点の信頼度の値とを比較し、当該第１候補点および第２候補点のうち値が最も大きな候補点を次回の表示候補点と決定し、
前記第１候補点の信頼度と、前記第３候補点の信頼度とを比較する場合、前記第１候補点の信頼度に前記第１のバイアス値より大きい第２のバイアス値を加算した値と、当該第３候補点の信頼度の値とを比較し、当該第１候補点および第３候補点のうち値が最も大きな候補点を次回の表示候補点と決定すること
を特徴とする現在位置算出方法。
【請求項５】
車両の現在位置を算出する現在位置算出システムであって、
車両の進行方位を検出する手段と、
車両の走行距離を算出する手段と、
前記進行方位および前記走行距離に基づき得られた相対変位と、車両が何れかの道路上に位置する状態、或いは、車両が道路上に位置しない状態を示す候補点とに基づき、車両の現在位置であると予想される仮想現在位置を生成する手段と、
前記仮想現在位置と、地図データに含まれる道路データに含まれる道路方位を示すデータとに基づき、当該道路データに対応する道路上に車両が存在することを示す候補点を生成する手段と、
前記候補点に対応する道路上の位置に、車両が存在する信憑性を示す信頼度を算出する手段と、
前記候補点の信頼度を比較し、該比較した候補点の中から1つの候補点を、車両の現在位置を示す表示候補点と決定する決定手段とを有し、
前記決定する手段は、
前記表示候補点に基づき得られた候補点の信頼度に所定のバイアス値を加算した値と、当該表示候補点に基づき得られた候補点以外の候補点の信頼度とを比較し、値が最も大きい候補点を次回の表示候補点に決定すること
を特徴とする現在位置算出システム。
【発明の詳細な説明】
【０００１】
【産業上の利用分野】
本発明は、車両等の移動体に搭載され、該移動体の進行距離、進行方位などを測定して、これにより、当該移動体の現在位置を算出する現在位置算出システムに関するものである。
【０００２】
【従来技術】
従来より、道路上を走行する車両の現在位置を算出する現在位置算出システムにおいて、該車両の現在位置は、ジャイロ等の方位センサにより測定した車両の進行方向と、車速センサまたは距離センサにより測定した車両の進行距離とに基づいて算出されている。
【０００３】
また、車両の進行距離は、一般的には、トランスミッションの出力軸、または、タイヤの回転数を計測して、その回転数に、タイヤ１回転あたりに車両が進む距離である距離係数を乗ずることにより求められている。
【０００４】
さらに、このように車両の進行方向と進行距離から求めた現在位置の誤差を補正するために、特開昭６３−１４８１１５号公報に記載のように、走行距離および方位変化量に基づき定まる車両の推定位置と、道路地図の誤差に基いて誤差量を得て、推定位置を中心とする誤差量の範囲内に位置するすべての道路上に対応させて、推定位置を自己位置として登録し、これら登録された推定位置の各道路に対する相関係数を算出して、道路に対する誤差が最も少ないことを示す相関係数に関連する推定位置を現在位置とする技術が開示されている。この公報に記載されたように、道路に整合するように、求められた車両の現在位置を修正する、いわゆる、マップマッチングの技術が知られており、このマップマッチングの技術により、現在位置算出の精度を高めることができる。
【０００５】
【発明が解決しようとする課題】
上述したような技術を用いてマップマッチングを実行する現在位置算出システムにおいては、特に、車両が分岐点を通過すると、複数の道路にそれぞれ位置する複数の推定位置が算出され、さらに車両が走行するのにしたがって、それぞれの相関係数が変化し、道路に対する誤差が最も少ないことを示す相関係数に関連する推定位置の存在する道路が、相関係数を算出するたびに変化するという場合がある。このような場合には、現在位置算出システムに設けられた表示装置に表示される現在位置が、車両が分岐点を通過した後に、ある時には、分岐点に接続されたある道路上に現われ、その一方、他のある時には、他の道路上に現れ、その結果、現在位置が不自然な動きをするという問題点が生じるおそれがあった。
【０００６】
その一方、車両が分岐点を通過した後、しばらくの間（たとえば、分岐点に接続された複数の道路の形状に明確な相違が現れるまでの間）は、車両が何れの道路上を走行しているのかを判断することが困難な場合が多い。
【０００７】
本発明は、表示装置に表示される車両の現在位置の不自然な動きを少なくしつつ、より正確な車両の現在位置を算出する現在位置算出システムを提供することを目的とする。
【０００８】
【課題を解決する手段】
本発明の目的は、車両に搭載され、該車両の現在位置を算出する現在位置算出システムであって、車両の進行方位を検出する方位検出手段と、車両の走行距離を算出する距離算出手段と、前記進行方位および前記走行距離に基づき得られた相対変位と、車両が何れかの道路上に位置する状態、或いは、車両が道路上に位置しない状態を示す候補点とに基づき、車両の現在位置であると予想される仮想現在位置を生成する仮想現在位置生成手段と、前記仮想現在位置と、地図データに含まれる道路データに含まれる道路方位示すデータとに基づき、当該道路データに対応する道路上に車両が存在することを示す候補点を生成する候補点生成手段と、前記候補点に対応する道路上の位置に、車両が存在する信憑性を示す信頼度を算出する信頼度算出手段と、前記候補点の信頼度を比較し、その値が最も大きな候補点を、車両の現在位置を示す表示候補点と決定する決定手段とを備え、
前記信頼度算出手段が、前記表示候補点に基づき得られた候補点の信頼度の値に所定の第１のバイアス値を与える第１のバイアス値加算手段と、車両が分岐点を通過した後、所定の距離を走行する間、前記表示候補点に基づき得られた候補点の信頼度に、前記第１のバイアス値よりも小さな所定の第２のバイアス値を与える第２のバイアス値加算手段とを有し、前記決定手段が、車両が分岐点を通過したときに表示候補点から得られた候補点であって、新たに得られる表示候補点以外の第１の分岐候補点と、車両が前記所定の距離を走行する間に、当該第１の分岐候補点に基づき得られた１以上の第２の分岐候補点の信頼度と、その値に第２のバイアス値が加えられた前記表示候補点に基づき得られた候補点の信頼度とを比較するとともに、前記第１の分岐候補点および第２の分岐候補点以外の候補点の信頼度と、その値に第１のバイアス値が加えられた前記表示候補点に基づき得られた候補点の信頼度とを比較するように構成された現在位置算出システムにより達成される。
【０００９】
本発明の好ましい実施態様においては、前記決定手段が、前記第１の分岐候補点および前記第２の分岐候補点の何れかの候補点の信頼度と、前記分岐候補点以外の候補点の信頼度とを比較する第１の比較手段と、前記第１の比較手段により得られた、その信頼度の値が最も大きな候補点の信頼度と、当該候補点にしたがって、第１のバイアス値或いは第２のバイアス値が加算された表示候補点に基づき得られた候補点の信頼度とを比較する第２の比較手段とを有している。
【００１０】
本発明のさらに好ましい実施態様においては、さらに、車両が高速道路上を走行している場合には、前記所定の距離に、第１の距離を与え、その一方、車両が一般道路上を走行している場合には、前記第１の距離より小さな第２の距離を与える距離付与手段を備えている。
【００１１】
【作用】
本発明によれば、表示候補点の信頼度に、バイアス値が加算されるため、表示候補点に基づき得られた候補点以外の候補点が、新たな候補点として決定される可能性をバイアス値に対応する割合だけ小さくするため、算出された車両の現在位置が、車両の走行にしたがって、不自然な動きをするおそれを小さくすることができる。
【００１２】
また、本発明によれば、車両が分岐点を通過してから所定の距離を走行するあいだ、表示候補点に基づき得られた候補点の信頼度に第１のバイアス値よりも小さな第２のバイアス値を加算したものと、分岐候補点の信頼度とが比較されるため、分岐候補点以外の候補点が、新たな表示候補点として決定される可能性よりも、分岐候補点が新たな表示候補点として決定される可能性の方をより大きくすることができる。すなわち、車両が分岐点を通過してから所定の距離を走行する間は、当該分岐点を通過したことにより生成された表示候補点以外の候補点が、新たな表示候補点として決定される可能性が、比較的大きくなり、その結果、車両が分岐点を通過したときに得られた表示候補点が、車両の走行する道路以外の道路に対応するものであっても、より迅速に、適切な道路上の位置に、表示候補点を得ることが可能となる。
【００１３】
本発明の好ましい実施態様によれば、第１の比較手段により分岐候補点の信頼度と、それ以外の候補点の信頼度とが比較され、第２の比較手段により、第１の比較手段により得られた候補点の信頼度と、バイアス値を含む表示候補点の信頼度とが比較される。したがって、複雑な処理を必要とすることなく、適切な表示候補点を決定することが可能となる。
【００１４】
【実施例】
以下、添付図面に基づいて、本発明の実施例につき詳細に説明を加える。
【００１５】
図１は、本発明の実施例にかかる現在位置算出装置の構成を示すブロックダイヤグラムである。図１に示すように、この現在位置算出装置１０は、車両のヨーレイトを検出することで進行方位変化を検出する角速度センサ１１と、地磁気を検出することで車両の進行方位を検出する方位センサ１２と、車両のトランスミッションの出力軸の回転に比例した時間間隔でパルスを出力する車速センサ１３を備えている。
【００１６】
また、現在位置周辺の地図や現在位置を示すマーク等を表示するディスプレイ１７と、ディスプレイ１７に表示する地図の縮尺切り替えの指令をユーザ（運転者）から受け付けるスイッチ１４と、デジタル地図データを記憶しておくＣＤ−ＲＯＭ１５と、そのＣＤ−ＲＯＭ１５から地図データを読みだすためのドライバ１６とを備えている。また、以上に示した各周辺装置の動作の制御を行うコントローラ１８を備えている。本実施例において、上述したディジタル地図データには、複数の線分の端部を示す座標から構成される道路データ、或いは、該道路の道幅を示す道路幅データ、道路が高速道路或いは一般道路であるかを示す高速道路フラグなどが含まれる。
【００１７】
コントローラ１８は、角速度センサ１１の信号（アナログ）をデジタル信号に変換するＡ／Ｄ変換器１９と、方位センサ１２の信号（アナログ）をデジタル信号に変換するＡ／Ｄ変換器２０と、車速センサ１３から出力されるパルス数を０．１秒毎にカウントするカウンタ２６と、スイッチ１４の押圧の有無を入力するパラレルＩ／Ｏ２１と、ＣＤ−ＲＯＭ１５から読みだされた地図データを転送するＤＭＡ（Direct Memory Access）コントローラ２２と、ディスプレイ１７に地図画像を表示する表示プロセッサ２３とを有する。
【００１８】
また、コントローラ１８は、さらに、マイクロプロセッサ２４と、メモリ２５とを有する。マイクロプロセッサ２４は、Ａ／Ｄ変換器１９を介して得た角速度センサ１１の信号、Ａ／Ｄ変換器２０を介して得た方位センサ１２の信号、カウンタ２６がカウントした車速センサ１３の出力パルス数、パラレルＩ／Ｏ２１を介して入力するスイッチ１４の押圧の有無、ＤＭＡコントロ−ラ２２を介して得たＣＤ−ＲＯＭ１５からの地図データを受け入れて、それら信号に基づいて処理を行い、車両の現在位置を算出して、それを表示プロセッサ２３を介してディスプレイ１７に表示させる。この車両位置の表示は、図２に示すように、すでにディスプレイ１７に表示している地図上に矢印マ−ク等を重畳して表示することにより行う。これにより、ユーザは、地図上で車両の現在位置を知ることができる。メモリ２５は、このような動作を実現するための処理（後述）の内容を規定するプログラムなどを格納したＲＯＭと、マイクロプロセッサ２４が処理を行う場合にワ−クエリアとして使用するＲＡＭとを含んでいる。
【００１９】
以下、このように構成された現在位置算出装置１０の動作について説明する。
【００２０】
装置１０の動作は、全般的に、車両の進行方位及び進行距離を算出する処理と、算出された進行方位及び距離から車両の現在位置を決定する処理と、得られた車両位置および方位を表示する処理との三つの処理に分けることができるため、これらについて順次説明する。
【００２１】
図３に、車両の進行方位及び進行距離を算出する処理の流れを説明する。
【００２２】
この処理は、一定周期、たとえば１００ｍＳ毎に起動され実行されるマイクロプロセッサ２４のルーチンである。
【００２３】
このルーチンでは、最初、Ａ／Ｄ変換器１９から角速度センサ１１の出力値を読み込む（ステップ３０１）。この角速度センサ１１の出力値には、方位変化が出力されるので、車両の進行方向の相対的な値しか検出できない。このため、次に、Ａ／Ｄ変換器２０から、地磁気センサからなる方位センサ１２の出力値を読み込み（ステップ３０２）、この方位センサ１２の出力値により算出された絶対方位と角速度センサ１１から出力される方位変化（角速度出力）とを用いて、車両の推定方位を決定する（ステップ３０３）。
【００２４】
この方位の決定は、たとえば、長い時間、車速が低い時には、角速度センサの誤差が大きいので、一定時間以上車速が低い場合には、方位センサの方位のみを利用するという方法により行う。
【００２５】
次に、車速センサ１３の出力するパルス数を、０．１秒毎に、カウンタ２６で計数して、その計数値を読み込む（ステップ３０４）。この読み込んだ値に、距離係数を乗算することで、０．１秒間に進んだ距離を求める（ステップ３０５）。
【００２６】
次に、このようにして求められた０．１秒間あたりの進行距離値を、前回得られた値に積算して、車両の進行距離が２０ｍとなったかどうかを調べ（ステップ３０６）、２０ｍに満たない場合（ステップ３０６でノー（Ｎｏ））、今回の処理を終了して、新たな処理を開始する。
【００２７】
進行距離算出処理の結果、積算された進行距離が一定距離、例えば２０ｍとなった場合（ステップ３０６でイエス（Ｙｅｓ））、その時点での進行方向と進行距離Ｒ（本実施例においては２０ｍ）とを出力する（ステップ３０７）。ステップ３０７では、さらに、積算距離を初期化して、新たに進行距離の積算を開始する。
【００２８】
次に、算出された進行方位および進行距離に基づいて、車両の仮想現在位置を算出し、算出された仮想現在位置に基づき、車両の候補点を求める処理について説明する。
【００２９】
図４に、この処理の流れを示す。
【００３０】
本処理は、図３からの進行方位および進行距離が出力されるのを受けて起動され、実行されるマイクロプロセッサ２４のルーチンである。すなわち、本実施例において、本処理は、車両が２０ｍ進む毎に起動される。
【００３１】
さて、この処理では、まず、ステップ３０７で出力された進行方位と進行距離とを読み込む（ステップ４０１）。次に、それらの値に基づいて、車両の移動量を緯度経度方向、別々に、それぞれ求める。さらに、これらの各方向における移動量を、前回の車両の候補点を求める処理で得られた車両の候補点の位置に加算して、現在車両が存在すると推定される位置である仮想現在位置（Ａ）を求める（ステップ４０２）。
【００３２】
もし、装置の始動直後など、前回の車両の候補点を求める処理で得られた候補点が存在しない場合には、別途設定された位置を、前回得られた候補点の位置として用いて仮想現在位置（Ａ）を求める。
【００３３】
ここに、候補点につき説明を加える。装置の始動直後など、初期的な状態においては、仮想現在位置（Ａ）は、ユーザ（運転者）がスイッチ１４を用いて所定の情報を入力することなどにより、一意的に定まり、かつ、これは道路に対応する線分上に位置する。しかしながら、車両が走行した後には、方位センサなどの誤差などにより、仮想現在位置（Ａ）が、道路に対応する線分上に存在しなくなる場合がある。その結果、たとえば、図５に示すように、道路が分岐している場合、すなわち、道路に対応する線分６１の節点すなわち端部６８から、二つの線分６４および６５があらわれる場合に、いずれの線分に対応する道路上に車両が存在するかが、明確にすることができない場合が多い。
【００３４】
したがって、このような場合に、本実施例においては、後述する処理により得られた線分（図５に示す例では二つの線分）上に存在する点を、所定の条件の下で候補点として設定し、これらの現在位置、エラーコスト、後述する累算エラーコストなどを、それぞれ、メモリ２５のＲＡＭの所定の領域に記憶するように構成されている。なお、説明を容易にするため、以下の説明においては、特に複数の候補点であることを明示しない限り、単一の候補点から、新たな一以上の候補点を生成することとする。
【００３５】
次いで、前回の車両の候補点を求める処理で得られたマッチング状態の候補点のみに関して、道路とのマッチングを行うための第１の道路検索処理が実行される（ステップ４０３）。なお、本実施例において、マッチング状態とは、ある仮想現在位置に関連して、該仮想現在位置との距離、或いは、その方位と車両の進行方位との間の方位差が、所定の範囲内であるような道路が存在し、その結果、仮想現在位置に基づき、道路上の所定の位置に候補点が得られた状態を称する。これに対して、ある仮想現在位置に関連して、上述した距離および方位差が、所定の範囲内であるような道路が存在しない場合が考えられる。本実施例においては、このような場合に、仮想現在位置Ａに対応する点自体が候補点となり、このようにして得られた候補点を、フリー状態の候補点と称している。
【００３６】
ここに、図６は、本実施例にかかる第１の道路検索処理を示すフローチャートである。
【００３７】
図６に示すように、この道路検索処理においては、まず、ＣＤ−ＲＯＭ１５から、ドライバ１６およびＤＭＡコントローラ２３を介して、所定の道路データを読み出す（ステップ６０１）。本実施例においては、道路データとして、図７に示すように、２点間を結ぶ複数の線分５１ないし５５で近似し、それら線分を、その始点と終点の座標によって表したものなどを用いている。たとえば、線分５３は、その始点（ｘ３、ｙ３）と終点（ｘ４、ｙ４）によって表現される。したがって、このステップ６０１においては、前回の処理により得られたマッチング状態の候補点が位置する線分が選択されて、これに関するデータが読み出される。
【００３８】
次に、ステップ６０１において選択された線分の座標に基づき、候補点の位置から車両の進行方向に沿って、２０ｍに対応する長さだけ進められた位置を含む線分を検索し、この線分に関する座標データなどを一次候補線分を示すデータとして一時的に記憶する（ステップ６０２）。より詳細には、候補点が位置する線分の車両の進行方向の端部までの長さが、２０ｍに対応する長さより大きければ、当該線分を一次候補線分として、その座標データなどを記憶する。また、候補点が位置する線分の車両の進行方向の端部までの長さが、２０ｍに対応する長さ以下であれば、当該線分に接続する線分を検索する。
【００３９】
次いで、ステップ６０２において少なくとも一つの一次候補線分が見つけられたか否かを判断し（ステップ６０３）、ノー（Ｎｏ）と判断された場合には、ステップ６０４に進む。
【００４０】
これに対して、ステップ６０３においてイエス（Ｙｅｓ）と判断された場合には、車両の進行方位と、一次候補線分の方位との間の角度を比較する角度比較処理が実行される（ステップ６０５）。図８は、本実施例にかかる角度比較処理を示すフローチャートである。図８に示すように、この処理においては、車両の進行方位と線分の方位との方位差θｄを算出し（ステップ９０１）、この方位差θｄの絶対値が、所定のしきい値θthよりも大きいか否かを判断する（ステップ９０２）。本実施例において、このしきい値θthは、３０°に設定されている。ステップ９０２においてノー（Ｎｏ）と判断された場合には、処理を終了し、その一方、イエス（Ｙｅｓ）と判断された場合には、この道路を一次候補線分としない旨の判断がなされ、一時的に記憶されたこの一次候補線分に対応するデータが削除される（ステップ９０３）。
【００４１】
図６のステップ６０５に示す角度比較処理が終了すると、ステップ６０２において複数の一次候補線分が記憶された場合には、他の一次候補線分についても角度比較処理が実行され（ステップ６０５、６０６）、全ての一次候補線分につき、角度比較処理が実行されると、ステップ６０７に進む。このようにして、前回の処理において得られた候補点が位置する線分、或いは、これに接続する線分のうち、その方位と車両の方位との間の方位差が、しきい値θth以下であるような線分に関連するデータが、一次候補線分を示すデータとして記憶される。
【００４２】
ステップ６０７は、一時的に記憶された一次候補線分が、少なくとも一つ以上存在するかどうかを判断する。このステップ６０７においてノー（Ｎｏ）と判断された場合には、ステップ６０４に進む。これに対して、ステップ６０７においてイエス（Ｙｅｓ）と判断された場合には、垂線距離比較処理が実行される（ステップ６０８）。ここに、図９は、本実施例にかかる垂線距離比較処理を示すフローチャートである。図９に示すように、この処理においては、仮想現在位置から一次候補線分に向けて垂線をひき、この垂線の長さＬを求める（ステップ１００１）。次いで、この垂線の長さＬが、予め定められたしきい値Ｌth以下であるか否かを判断する（ステップ１００２）。すなわち、一次候補線分が仮想現在位置から、しきい値Ｌthの範囲に存在しているかどうかを判断する。このステップ１００２においてイエスと判断された場合には、この一次候補線分に関連する種々のデータが、二次候補線分を示すデータとして記憶されるとともに、前回の処理で得られた候補点から、所定の線分に沿って、距離Ｒだけ離間した位置の座標データが、当該二次候補線分に対応する位置データとして記憶される。
【００４３】
その一方、ステップ１００２においてノー（Ｎｏ）と判断された場合には、この一次候補線分に関連するデータは消去され、その結果、二次候補線分は生成されない（ステップ１００４）。
【００４４】
このように、垂線距離比較処理６０８が終了すると、全ての一次候補線分につき、処理が終了しているか否かが判断される（ステップ６０９）。
【００４５】
ステップ６０８およびステップ６０９を繰り返すことにより、前回の処理により得られた候補点が位置する線分から、車両の進行方向に、該線分或いはこれに接続された線分に沿って、所定の距離Ｒだけ離間した点が存在し、その方位と車両の進行方位との間の方位差が、所定のしきい値θth以下であり、かつ、仮想現在位置との間の距離が、所定のしきい値Ｌth以下であるような二次候補線分を得ることができる。さらに、得られた二次線分に対応する位置データとして、前回の処理で得られた候補点から、所定の線分に沿って、距離Ｒだけ離間した位置の座標データを得ることができる。この座標データが、後述する候補点を示すデータに対応する。
【００４６】
一次候補線分に関して、ステップ６０８および６０９の処理が終了すると、これらステップを経た結果、二次候補線分が得られているか否かを判断する（ステップ６１０）。このステップ６１０において、ノー（Ｎｏ）と判断された場合には、ステップ６０４に進み、その一方、イエス（Ｙｅｓ）と判断された場合には、処理を終了する。
【００４７】
たとえば、図５において、線分６１上に存在したある候補点６２に対して、仮想現在位置Ａが、点６３に示す位置に表わされるとする。このような場合に、まず、候補点６２が位置する線分６１を選択し（ステップ６０１）、この線分上の候補点６２から、車両の進行方向の端部６８までの距離を判断する。図５の例の場合には、この線分に接続されている道路があるため、線分６４、６５に関連するデータが、それぞれ、一次候補線分を示すデータとして一時的に記憶され、それぞれに関連して、角度比較処理（ステップ６０５）が実行される。ここに、図５の例において、｜θ(１)−θcar｜＜θth、かつ、｜θ(２)−θcar｜＜θthであると仮定すると、ステップ６０５および６０６からなる処理ループが二回繰り返され、線分６４、６５のそれぞれに関連して、垂線距離比較処理（ステップ６０８）が実行される。
【００４８】
さらに、図５の例において、Ｌ(１)＜Ｌth、かつ、Ｌ(２)＜Ｌthであったとすると、線分６４、６５に関連するデータが二次候補線分として記憶され、さらに、候補点６２から、線分６１および６４、或いは、線分６１および６５に沿って、進行距離Ｒ（本実施例では２０ｍ）に対応する長さだけ進められた点が候補点６６、６７として設定され、この点の座標データ、仮想現在位置から線分までの距離Ｌ（１）、Ｌ（２）に対応するデータ、および、線分の角度θ（１）、θ（２）に対応するデータが記憶される。
【００４９】
再度、図６の第１の道路検索処理の説明に戻る。ここで、ステップ６０３においてノー（Ｎｏ）と判断された場合、ステップ６０５の角度比較処理において、全ての一次候補線分が削除された場合（ステップ６０７でノー（Ｎｏ））、或いは、ステップ６０８の垂線距離比較処理において、二次候補線分が得られなかった場合（ステップ６１０でノー（Ｎｏ））には、仮想現在位置を示す座標データが、候補点を示すデータとなる。
【００５０】
このようにステップ４０３の第１の道路検索処理が終了すると、前回の車両の候補点を求める処理で得られたフリー状態の候補点のみに関して、道路とのマッチングを行うための第２の道路検索処理が実行される（ステップ４０４）。第１の道路検索処理（ステップ４０３）および第２の道路検索処理（ステップ４０４）を実行することにより、前回の処理により得られた全ての候補点に関する新たな候補点を求めることが可能となる。図１０は、本実施例にかかる第２の道路検索処理を示すフローチャートである。
【００５１】
図１０に示すように、この処理（ステップ１３０１ないし１３０４）は、図６に示すマッチング状態の候補点に対する第１の道路検索処理（図４のステップ４０３）に類似している。これら二つの処理の間の相違は以下の点にある。すなわち、第１の道路検索処理においては、前回の車両の候補点を求める処理で得られた候補点が位置する線分、あるいは、これに接続する線分を、一次候補線分として一時的に記憶し、これら一次候補線分から、さらに、その方位と車両方位との方位差が所定のしきい値θth以下であって、かつ、仮想現在位置からの距離に対応する長さが所定のしきい値Ｌth以内の線分を、二次候補線分として選択している。
【００５２】
これに対して、第２の道路検索処理においては、仮想現在位置（Ａ）を中心とする予め設定された距離Ｄ内にある線分をすべて抽出し（ステップ１３０１）、これら線分から、その方位と車両方位との方位差が所定のしきい値θth以下の線分を選択し（ステップ１３０２）、さらに、選択された線分と仮想現在位置との間の距離を求め、この距離に対応する長さが所定のしきい値Ｌth以内の線分を二次候補線分として選択している（ステップ１３０３）。換言すれば、第１の道路選択処理のステップ６０２においては、候補点が位置する線分、或いは、当該線分の分岐点から延びる幾つかの線分などが選択されるが、図１０のステップ１３０２においては、読み出された地図データに含まれる道路データに基づき、抽出すべき線分が決定される。したがって、ステップ１３０１ないし１３０３を実行するための処理時間は、道路データに対応する道路の密度に依存し、特に、読み出された地図データに対応する地図が、市街地であった場合など、道路の密度が大きい場合に、この処理時間は、第１の道路検索処理における対応する処理を実行するのに必要な時間と比較すると大きい。
【００５３】
この第２の道路検索処理において、ステップ１３０３が終了すると、ステップ１３０２およびステップ１３０３により取り出された線分、すなわち、その方位と車両方位との間の方位差が、しきい値θth以下であり、かつ、仮想現在位置からの距離に対応する長さがしきい値Ｌth以下であるような線分が、二次候補線分として選択され、該線分に関連する種々のデータが、二次候補線分を示すデータとして記憶される。また、現在地現在位置の存在する点、および、仮想現在位置から当該線分におろした垂線の足、すなわち、この垂線と線分との交点が、候補点と決定され、これら候補点の座標データが記憶される（ステップ１３０４）。なお、第２の道路検索処理においては、仮想現在位置から線分へおろした垂線と線分との交点が候補点となるが、これは、前回の処理により得られた候補点が、フリー状態であり、したがって、たどるべき線分が存在しないためである。
【００５４】
なお、この第２の道路検索処理において、仮想現在位置から所定の範囲Ｄ内に線分が存在しない場合、その方位と車両の進行方位との方位差がしきい値θth以下の線分が存在しない場合、或いは、仮想現在位置からの距離に対応する長さがしきい値Ｌth以下であるような線分が存在しない場合には、仮想現在位置に対応する点が、唯一の候補点となる。
【００５５】
上述したように、ステップ４０４の第２の道路探索処理が終了すると、第１の道路検索処理および第２の道路検索処理により得られたｎ個の候補点に関連する垂線の長さＬ（ｉ）（１≦ｉ≦ｎ）と、候補点が位置する二次候補線分の方位と車両の方位との間の方位差θd（ｉ）とに基づき、以下の式により定義されるエラーコストｅｃ（ｉ）が算出される（ステップ４０４）。
【００５６】
ｅｃ（ｉ）＝α×｜θd（ｉ）｜＋β×Ｌ（ｉ）
ここに、αおよびβは、重み係数である。これら重み係数の値は、車両の進行方位と線分の方位との間のずれと、仮想現在位置と線分との間のずれとの何れを、道路が選択される上で重視するかにしたがって決定される。たとえば、進行方位とその方位と方位が近い道路を選択することを重視する場合は、αを大きくするようにする。
【００５７】
次いで、算出されたエラーコストｅｃ（ｉ）と、前回の処理で得られた候補点に関連する累算エラーコストｅｓとにしたがって、下記の式により定義される、今回の処理における累算エラーコストｅｓを算出する（ステップ４０５）。
【００５８】
ｅｓ（ｉ）＝（１−ｋ）×ｅｓ＋ｋ×ｅｃ（ｉ）
ここに、ｋは、０より大きく１より小さな重み係数である。この累算エラーコストｅｓ（ｉ）は、前回以前の処理において算出されたエラーコストを、今回の処理において算出されるエラーコストにどのくらい反映させるかを表わしている。
【００５９】
さらに、算出された累算エラーコストｅｓ（ｉ）に基づき、下記の式に定義される信頼度ｔｒｓｔ（ｉ）を算出する（ステップ４０６）。
【００６０】
ｔｒｓｔ（ｉ）＝１００／（１＋ｅｓ（ｉ））
上記式から明らかなように、累算エラーコストｅｃ（ｉ）が大きくなるのにしたがって、信頼度ｔｒｓｔ（ｉ）は減少し、０（ゼロ）に近づく。その一方、これが小さくなるのにしたがって、信頼度ｔｒｓｔ（ｉ）は増大し、その値は、１００に近づく。
【００６１】
このような処理をすることにより、ある候補点に対応して得られたｎ個の二次候補線分に関連する信頼度ｔｒｓｔ（ｉ）が求められる。候補点が複数存在する場合には、それぞれの候補点に対応して得られた複数の二次候補線分に関連する信頼度ｔｒｓｔを算出すればよい。
【００６２】
なお、フリー状態の候補点に関連して、ステップ４０５で算出すべきエラーコストｅｃ（ｎ）には、マッチング状態である場合に得られるエラーコストの値よりも大きな一定の値が与えられる。
【００６３】
次いで、このように得られた候補点の各々に対応する信頼度ｔｒｓｔの値にしたがって、これら新たな候補点をソートし（ステップ４０８）、その後、ステップ４０３およびステップ４０４において得られた候補点から、ディスプレイ１７上に表示するための候補点である表示候補点を決定する表示候補点決定処理が実行される（ステップ４０９）。
【００６４】
図１１は、本実施例にかかる表示候補点決定処理を示す図である。図１１に示すように、まず、後述するように、車両が分岐点を通過した後に１にセットされる分岐点通過フラグflagが０（ゼロ）であるか否かを判断する（ステップ１１０１）、この分岐点通過フラグは、本処理において１にセットされ、或いは、０（ゼロ）にリセットされるほか、装置を起動した際に実行される初期化処理において、０（ゼロ）にリセットされている。
【００６５】
このステップ１１０１においてイエス（Ｙｅｓ）と判断された場合には、表示候補点が分岐点を通過したか否かが判断される（ステップ１１０２）。より詳細には、前回の処理により得られた表示候補点に基づき、複数のマッチング状態の候補点が生成されている場合に、表示候補点が分岐点を通過したと判断される。
【００６６】
このステップ１１０２でノー（Ｎｏ）と判断されると、前回の処理により得られた表示候補点に基づき生成された候補点の信頼度に加算すべきバイアス値ＨＹＳが、ＨＹＳhighに設定される（ステップ１１０３）。次いで、前回の処理により得られた表示候補点に基づき得られた候補点の信頼度ｔｒｓｔに、先のステップで得られたＨＹＳを加え（ステップ１１０４）、その後、全ての候補点の信頼度を比較し、その値が最も大きなものを表示候補点と決定する（ステップ１１０５）。
【００６７】
このように、表示候補点から得られた候補点に所定のバイアス値ＨＹＳを加えるのは以下の理由による。すなわち、表示候補点は、最もその信頼度の高い候補点、すなわち、現実の車両の位置とする信憑性の高い候補点である。したがって、これから得られた候補点の信頼度に、微小な値ＨＹＳを加算することにより、表示装置上に車両の現在位置として表示される印（たとえば、図２に示す矢印）が、道路間を移動したり、道路上の前後方向に著しく大きく変化することを防止している。
【００６８】
その一方、あまり大きなＨＹＳを与えると、表示候補点の位置が、現実の車両の位置から逸脱している場合には、より好ましい位置に表示候補点を得るまでに時間がかかる可能性がある。したがって、このＨＹＳの値は、方位センサ、道路データの精度などにしたがって調整されている。
【００６９】
なお、ステップ１１０５において、その信頼度を比較すべき候補点が３つ以上存在する場合には、表示候補点に基づき得られた候補点以外の候補点のうち、その信頼度の値が最も大きい候補点を決定し、この候補点の信頼度と、表示候補点に基づき得られた１または複数の候補点の信頼度とが比較される。
【００７０】
さて、ステップ１１０２においてイエス（Ｙｅｓ）と判断された場合には、分岐点通過フラグflag＝１にセットされるとともに、後述するステップ１１１１における処理を実行すべき期間を示す分岐有効距離カウンタＬＣ＝０にリセットされる（ステップ１１０６）。さらに、前回の処理で得られた表示候補点が高速道路に対応する線分上にない場合には、有効距離しきい値ＬＣth＝Ｌgnに設定され（ステップ１１０７、１１０８）、その一方、表示候補点が高速道路に対応する線分上にある場合には、ＬＣth＝Ｌhwに設定される（ステップ１１０７、１１０９）。本実施例においては、Ｌgnは、５００ｍに対応する値、また、Ｌhwは、２ｋｍに対応する値に予め定められている。ステップ１１０８或いはステップ１１０９を経た場合にも、前回の処理により得られた表示候補点の信頼度が、ｔｒｓｔ＝ｔｒｓｔ＋ＨＹＳにされ（ステップ１１０４）、信頼度を比較することにより表示候補点が決定される（ステップ１１０５）。
【００７１】
このように、ステップ１１０６を経ることにより、分岐点通過フラグflag＝１にセットされると、ステップ１１０１においてノー（Ｎｏ）と判断される。この場合には、車両の走行距離Ｒ（本実施例においては２０ｍ）に対応する値だけ、分岐有効距離カウンタＬＣの値がインクリメントされ（ステップ１１１０）、次いで、ＬＣの値がＬＣthよりも大きいか否かが判断される（ステップ１１１１）。このステップ１１１１でノー（Ｎｏ）と判断された場合には、ステップ１１１２に進む。
【００７２】
ステップ１１１２においては、バイアス値ＨＹＳを、以下の値に設定する。すなわち、表示候補点に基づき得られた候補点以外の候補点のうち、前述したステップ１１０２において分岐点を通過したと判断されたときに得られた候補点に基づき得られた１または複数の候補点である分岐候補点に対するバイアス値ＨＹＳを、ステップ１１０３において設定されたＨＹＳhighよりも幾分小さなＨＹＳlowに設定するとともに、分岐候補点以外の候補点に対するバイアス値ＨＹＳを、ＨＹＳhighに設定する（ステップ１１１１）。
【００７３】
たとえば、図１２に示すように、道路に対応する線分１２０およびこれに接続された線分１２１、１２２など、並びに、線分１２４およびこれに接続された線分１２５を考え、かつ、あるときに図４のステップ４０１ないし後述するステップ４０８が実行され、線分１２１上の点１３０および線分１２５上の点１３１が、候補点として決定されたと考える。ここに、候補点１３０が、前回の処理により得られた表示候補点に基づき生成された点とする。この場合には、図１１に示す表示候補点決定処理において、ステップ１１０１ないし１１０５の処理が順次実行され、その結果、候補点１３０に関する信頼度ｔｒｓｔは、当該候補点１３０自体の信頼度ｔｒｓｔにＨＹＳhighが加算されたものとなる（ステップ１１０４）。すなわち、ステップ１１０５において、候補点１３０および１３１のうちの何れを表示候補点とするかを決定する際に、候補点１３０に関連する信頼度ｔｒｓｔ＋ＨＹＳhighと、候補点１３１に関連する信頼度ｔｒｓｔとが比較される。すなわち、バイアス値ＨＹＳhighの分だけ、表示候補点に基づき得られた候補点以外の候補点が、新たな表示候補点として決定される可能性が少なくなる。
【００７４】
ここに、これら候補点のうち点１３０が、表示候補点として決定されたと考える。車両が、さらに距離Ｒ（本実施例では２０ｍ）だけ進行することにより、ステップ４０１ないし４０８の処理が実行され、候補点１３２ないし１３４が得られたものと考える。この場合には、図１１に示す表示候補点決定処理において、ステップ１１０１、１１０２、１１０６、１１０７、１１０８または１１０９、１１０４および１１０５の処理が順次実行され、その結果、候補点１３２および１３３に関するそれぞれの信頼度ｔｒｓｔは、当該候補点１３２および１３３自体の信頼度ｔｒｓｔにＨＹＳhighが加算されたものとなる（ステップ１１０４）。すなわち、ステップ１１０５において、候補点１３２ないし１３３のうちの何れを表示候補点とするかを決定する際に、候補点１３２に関連する信頼度ｔｒｓｔ＋ＨＹＳhighと、候補点１３３に関連する信頼度ｔｒｓｔ＋ＨＹＳhighと、候補点１３４に関連する信頼度ｔｒｓｔとが比較される。
【００７５】
さらに、これら候補点のうち点１３２が、表示候補点として決定されたと仮定し、車両が、さらに距離Ｒ（本実施例では２０ｍ）だけ進行することにより、ステップ４０１ないし４０８の処理が実行され、候補点１３５ないし１３７が得られたものと考える。この場合には、図１１に示す表示候補点決定処理において、ステップ１１０１、１１１０ないし１１１２、１１０４および１１０５の処理が順次実行され、その結果、候補点１３５に関する信頼度ｔｒｓｔのうち、分岐候補点である候補点１３６に対する信頼度は、候補点１３５自体の信頼度ｔｒｓｔにＨＹＳlowを加算したものとなり、その一方、候補点１３７に対する信頼度は、候補点１３５自体の信頼度ｔｒｓｔに、ＨＹＳhighを加算したものとなる（ステップ１１０４）。すなわち、ステップ１１０５において、候補点１３５ないし１３７のうちの何れを表示候補点とするかを決定する際に、候補点１３６に関連する信頼度ｔｒｓｔと候補点１３７に関連する信頼度ｔｒｓｔとが比較され、候補点１３６に関連する信頼度の方が、候補点１３７に関連するものよりも大きい場合には、候補点１３５に関連する信頼度ｔｒｓｔ＋ＨＹＳlowと、候補点１３６に関連する信頼度ｔｒｓｔとが比較される。その一方、候補点１３６に関連する信頼度の方が、候補点１３７に関連するものよりも小さい場合には、候補点１３５に関連する信頼度ｔｒｓｔ＋ＨＹＳhighと、候補点１３７に関連する信頼度ｔｒｓｔとが比較される。
【００７６】
すなわち、バイアス値ＨＹＳlowの分だけ、表示候補点から得られた候補点以外の候補点のうち、分岐候補点が、新たな候補点として決定される可能性が少なくなり、バイアス値ＨＹＳhighの分だけ、表示候補点から得られた候補点以外の候補点のうち、分岐候補点以外の候補点が、新たな候補点として決定される可能性が少なくなる。また、前述したように、バイアス値ＨＹＳlow＜ＨＹＳhighであるため、分岐候補点の方が、それ以外の候補点よりも、新たな候補点として決定される可能性は大きい。
【００７７】
なお、車両がさらに進行することにより、分岐有効距離カウンタＬＣの値が、設定されたＬＣthの値を超えた場合には、分岐点通過フラグflag＝０となる（ステップ１１１０、１１１３）。すなわち、ステップ１１１２の処理を経ることができるのは、分岐点を通過した旨の判断がなされた後、車両が、ＬＣthに対応する距離だけ走行する間である。
【００７８】
このように、図４のステップ４０９の表示候補点決定処理が終了すると、この処理において決定された表示候補点、すなわち、ディスプレイ１７上に表示するための候補点の位置、累算エラーコスト、信頼度、マッチング状態であるかフリー状態であるかを示す状態フラグなどが、メモリ２５のＲＡＭの所定の領域に記憶するとともに、表示候補点以外の他の候補点の位置、累算エラーコスト、信頼度、状態フラグなども、ＲＡＭの所定の領域に記憶される（ステップ４１０）。なお、本実施例においては、７個の候補点に関連するデータを記憶可能に構成されている。したがって、図４のステップ４０１ないし４０８の処理を実行した結果、８個以上の候補点が算出された場合には、これらのうち、信頼度ｔｒｓｔの値が大きい順に７個の候補点に関連する種々のデータが、メモリ２５のＲＡＭの所定の領域に記憶されることになる。
【００７９】
最後に、表示候補点に関連するデータが出力され（ステップ４１１）、処理を終了する。
【００８０】
図４のステップ４０１ないし４１０を実行することにより得られた表示候補点は、図１３に示すフローチャートに基づく処理によりディスプレイ１７の画面上に表示される。
【００８１】
本処理は、１秒毎に起動され実行されるマイクロプロセッサ２４のルーチンである。
【００８２】
最初、スイッチ１４が押圧により地図の縮尺の変更を指示されているかを、パラレルＩ／Ｏ２１の内容を見て判断する（ステップ１４０１）。もし、押されていれば（ステップ１４０１でイエス（Ｙｅｓ））、それに対応して、所定の縮尺フラグを設定する（ステップ１４０２）。
【００８３】
次に、図４の処理を実行することにより得られた表示候補点の位置および方位を示すデータを、メモリ２５のＲＡＭの所定の領域から読み出し（ステップ１４０３）、ステップ１４０２で切り替えられた縮尺フラグの内容に応じた縮尺の地図をディスプレイ１７に、例えば、図２に示すような状態で表示する（ステップ１４０４）。
【００８４】
そして、地図に重畳して、表示候補点の位置およびその方位を、たとえば、先に示した図２のように、矢印記号“↑”を用いて表示する（ステップ１４０５）。そして最後に、これらに重畳して、北を示す北マークと、縮尺に対応した距離マークとを、図２のように表示する（ステップ１４０６）。
【００８５】
なお、本実施例においては、上記のように矢印記号を用いて車両位置および方向を示したが、車両位置および方向の表示形態は、位置および進行方向が、表示状態が明確に示されるものであれば、その形態は任意でよい。また、北マーク等も同様である。
【００８６】
本実施例によれば、表示候補点に基づき得られた候補点の信頼度に、バイアス値ＨＹＳを加算し、このバイアス値が加算された信頼度と、他の候補点の信頼度とが比較されて表示候補点が決定されるため、信頼度の微小な変化に基づき、表示候補点が位置する線分が変化し、その結果、ディスプレイに表示される車両の現在位置が、不自然な動きをするおそれを少なくすることが可能となる。
【００８７】
また、本実施例によれば、表示候補点に基づき得られた候補点以外の候補点のうち、分岐候補点に該当する候補点の信頼度と、表示候補点に基づき得られた候補点の信頼度を比較する場合には、その信頼度に、他の候補点と比較する際に用いるバイアス値ＨＹＳhighよりも、幾分小さいバイアス値ＨＹＳlowを加算する。したがって、車両が分岐点を通過した後、何れの道路に車両が位置するかが明らかでないときには、前回の表示候補点が位置する線分以外の線分であって、分岐候補点が位置する線分上に、新たな表示候補点を生成する可能性が大きくなるため、より正確な車両の現在位置を表示することが可能となる。
【００８８】
さらに、本実施例によれば、マッチング状態の候補点から得られた仮想現在位置に関連して、当該候補点が位置する線分、或いは、これに接続された線分を検索するため、仮想現在位置の周辺に存在する全ての道路を検索する場合と比較すると、より短時間で、所望の線分を検索することが可能となる。
【００８９】
また、本実施例によれば、マッチング状態の候補点の位置する線分および／または該候補点の位置する線分に接続された線分に沿って、車両の進行距離に対応する長さだけ、前記候補点から進められた位置を候補点とするため、算出された車両の現在位置と実際の車両の現在位置との間の誤差をより小さくすることが可能となる。
【００９０】
本発明は、以上の実施例に限定されることなく、特許請求の範囲に記載された発明の範囲内で、種々の変更が可能であり、それらも本発明の範囲内に包含されるものであることは言うまでもない。
【００９１】
たとえば、前記実施例の表示候補点決定処理においては、分岐有効距離カウンタと比較すべきしきい値ＬＣthの値を、車両が高速道路上を走行している場合には、Ｌhw（２ｋｍに対応する値）、また、車両が一般道路上を走行している場合には、Ｌgn（５００ｍに対応する値）に設定している。この値、分岐候補点に対するバイアス値ＨＹＳlowおよびそれ以外の候補点に対するバイアス値ＨＹＳhighを、表示候補点に基づき得られた候補点の信頼度に与える処理を実行することができる期間を規定している。このように、車両が一般道路を走行している場合と、高速道路を走行している場合とで、しきい値を変更しているのは、分岐点から延びる複数の道路の間に、明確な形状（道路に対応する線分の形状）の相違が現れる距離が、高速道路の方が大きいことに起因している。しかしながら、このようなしきい値に限定されるものではなく、車両が高速道路上を走行する場合に設定されるしきい値と、一般道路上を走行する場合に設定されるしきい値とを同一にしても良いことは明らかである。
【００９２】
また、前記実施例においては、図４のステップ４０９の表示候補点決定処理において、前回の処理で得られた表示候補点に基づき得られた候補点の信頼度ｔｒｓｔに、バイアス値ＨＹＳを加算しておき、また、表示候補点に基づき得られた候補点以外に、複数の候補点が存在する場合には、当該複数の候補点のうち、最も信頼度の値が大きい候補点を決定し、当該候補点の信頼度と、バイアス値ＨＹＳが加算された信頼度とを比較することにより、表示候補点が決定されている（図１１のステップ１１０４および１１０５）。
【００９３】
しかしながら、これに限定されるものではなく、たとえば、図４のステップ４０８で信頼度の値の順にソートされた候補点を参照し、その値の最も大きな候補点が、表示候補点に基づき得られた候補点でない場合に、当該候補点の信頼度と、所定のバイアス値ＨＹＳが加算された、表示候補点に基づき得られた候補点の信頼度とを比較することにより、表示候補点を決定するように構成してもよい。
【００９４】
さらに、本実施例において用いられたパラメータは、例示のために与えられたものに過ぎず、したがって、これらパラメータは、装置の処理速度、車両が走行する道路の種別（例えば、一般道路、高速道路など）にしたがって変更可能であることを理解すべきである。
【００９５】
また、本明細書において、手段とは、必ずしも物理的手段を意味するものではなく、各手段の機能が、ソフトウエアによって実現される場合も包含する。また、一つの手段の機能が二以上の物理的手段により実現されても、二以上の手段の機能が一つの物理的手段により実現されてもよい。
【００９６】
【発明の効果】
本発明によれば、表示装置に表示される車両の現在位置の不自然な動きを少なくしつつ、より正確な車両の現在位置を算出する現在位置算出システムを提供することが可能となる。
【図面の簡単な説明】
【図１】  図１は、本発明の実施例にかかる現在位置算出装置の構成を示すブロックダイヤグラムである。
【図２】  図２は、本実施例にかかる地図および現在位置の表示例を示す図である。
【図３】  図３は、本実施例にかかる車両の進行方位および進行距離を算出する処理を示すフローチャートである。
【図４】  図４は、本実施例にかかる車両の候補点を算出する処理を示すフローチャートである。
【図５】  図５は、道路に対応する線分、仮想現在位置および候補点を説明するための図である。
【図６】  図６は、本実施例にかかる第１の道路検索処理を示すフローチャートである。
【図７】  図７は、本実施例にかかる道路データの一例を説明するための図である。
【図８】  図８は、本実施例にかかる角度比較処理を示すフローチャートである。
【図９】  図９は、本実施例にかかる垂線距離比較処理を示すフローチャートである。
【図１０】  図１０は、本実施例にかかる第２の道路検索処理を示すフローチャートである。
【図１１】  図１１は、本実施例にかかる表示候補点決定処理を示すフローチャートである。
【図１２】  図１２は、本実施例にかかる表示候補点決定処理において候補点の信頼度に加算されるバイアス値を説明するための図である。
【図１３】  図１３は、本実施例にかかる現在位置表示処理を示すフローチャートである。
【符号の説明】
１０      現在位置算出装置
１１      角速度センサ
１２      方位センサ
１３      車速センサ
１４      スイッチ
１５      ＣＤ−ＲＯＭ
１６      ＣＤ−ＲＯＭ読み取りドライバ
１７      ディスプレイ
１８      コントローラ
【図１】
0003660392.tif 000002
【図２】
0003660392.tif 000003
【図３】
0003660392.tif 000004
【図４】
0003660392.tif 000005
【図５】
0003660392.tif 000006
【図６】
0003660392.tif 000007
【図７】
0003660392.tif 000008
【図８】
0003660392.tif 000009
【図９】
0003660392.tif 000010
【図１０】
0003660392.tif 000011
【図１１】
0003660392.tif 000012
【図１２】
0003660392.tif 000013
【図１３】
0003660392.tif 000014