JP3693383B2 - 現在位置算出システムおよび現在位置算出方法 - Google Patents
現在位置算出システムおよび現在位置算出方法 Download PDFInfo
- Publication number
- JP3693383B2 JP3693383B2 JP14082395A JP14082395A JP3693383B2 JP 3693383 B2 JP3693383 B2 JP 3693383B2 JP 14082395 A JP14082395 A JP 14082395A JP 14082395 A JP14082395 A JP 14082395A JP 3693383 B2 JP3693383 B2 JP 3693383B2
- Authority
- JP
- Japan
- Prior art keywords
- candidate point
- line segment
- current position
- candidate
- vehicle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Lifetime
Links
Images
Landscapes
- Traffic Control Systems (AREA)
- Instructional Devices (AREA)
- Navigation (AREA)
Description
【産業上の利用分野】
本発明は、車両等の移動体に搭載され、該移動体の進行距離、進行方位などを測定して、これにより、当該移動体の現在位置を算出する現在位置算出システムに関するものであり、より詳細には、該移動体が道路上に存在すると判断された場合に、処理時間を増大させることなく、より正確に移動体の現在位置を算出する現在位置算出システムに関するものである。
【0002】
【従来技術】
従来より、道路上を走行する車両の現在位置を算出する現在位置算出システムにおいて、該車両の現在位置は、ジャイロ等の方位センサにより測定した車両の進行方向と、車速センサまたは距離センサにより測定した車両の進行距離とに基づいて算出されている。
【0003】
また、車両の進行距離は、一般的には、トランスミッションの出力軸、または、タイヤの回転数を計測して、その回転数に、タイヤ1回転あたりに車両が進む距離である距離係数を乗ずることにより求められている。
【0004】
さらに、特開昭61−56910号公報に記載されたように、車両の進行方向と進行距離から求めた現在位置に基づき、CD−ROMなどに記憶された地図データに含まれる所定の線分を取り出し、求められた現在位置から、該線分に垂線をおろし、垂線と線分との交点を表示装置に表示すべき位置とする、いわゆるマップマッチングの技術が知られており、このマップマッチングにより、表示装置上に、所定の道路と整合する車両の現在位置を示すシンボルを表わすことができる。
【0005】
【発明が解決しようとする課題】
しかしながら、上述した従来のマップマッチングの技術においては、求められた現在位置と線分との垂線の足に対応する位置を、表示すべき車両の位置と推定するため、実際に道路に沿って車両が走行した後の車両の位置と、表示すべき車両の位置との間の誤差が生じ、車両が走行するのにしたがってこの誤差が累積され、その結果、車両が実際に走行している位置と、算出された車両の現在位置との間に数百メートル程度の誤差が生じる可能性もあるという問題点があった。
【0006】
本発明は、車両の現在位置を、より少ない処理時間で、かつ、より正確に算出する現在位置算出システムを提供することを目的とする。
【0007】
【課題を解決する手段】
本発明の目的は、車両に搭載され、該車両の現在位置を算出する現在位置算出システムであって、車両の進行方位を検出する方位検出手段と、車両の走行距離を算出する距離算出手段と、前記進行方位および前記走行距離に基づき得られた相対変位と、車両が何れかの道路上に位置する状態、或いは、車両が道路上に位置しない状態を示す候補点とに基づき、車両の現在位置であると予想される仮想現在位置を生成する仮想現在位置生成手段と、前記道路上に位置する状態を示す候補点に関連して、前記候補点が位置する道路或いはこれに接続された道路を検索する道路検索手段と、前記道路検索手段により検索された道路に沿って、前記候補点から、車両の走行距離だけ進められた位置を算出する位置算出手段とを備え、前記位置算出手段により得られた位置に対応する点を新たな候補点とするように構成された現在位置算出システムにより達成される。
【0008】
本発明の好ましい実施態様においては、前記道路検索手段が、前記候補点が位置する道路或いはこれに接続された道路であって、その方位と前記進行方位との間の方位差が所定の範囲内である道路を選択するように構成されている。
【0009】
本発明のさらに好ましい実施態様においては、前記道路検索手段が、前記候補点が位置する道路或いはこれに接続された道路であって、前記仮想現在位置からの距離が所定の範囲内である道路を選択するように構成されている。
【0010】
本発明のさらに好ましい実施態様においては、さらに、前記道路上に位置しない状態を示す候補点に関連して、前記候補点から所定の範囲内に存在する道路を検索する第2の道路検索手段と、前記道路上に存在しない状態を示す候補点に関連する仮想現在位置から、前記第2の道路検索手段により検索された道路への垂線の交点を算出する第2の位置算出手段とを備え、前記第2の算出手段により得られた位置に対応する点を、他の新たな候補点とするように構成されている。
【0011】
本発明のさらに好ましい実施態様においては、さらに、前記新たな候補点が車両の現在位置であることの信憑性を示す信頼度を算出する信頼度算出手段と、前記新たな候補点に関連する信頼度を比較し、最も信頼度の値が大きな候補点の位置を、車両の現在位置とする判断手段とを備えている。
【0012】
本発明のさらに好ましい実施態様においては、前記道路検索手段が、前記候補点が位置する点から前記車両が位置する線分の車両の進行方向に存する端部までの距離を算出する残り距離算出手段と、前記算出された距離が、車両の進行距離よりも小さい場合に、前記端部に接続された線分を検索する接続線分検索手段とを備えている。
【0013】
【作用】
本発明によれば、候補点が位置する道路およびこれに接続された道路を検索し、検索された道路に、新たな候補点を生成するため、処理時間を要することなく、より正確な車両の現在位置を求めることが可能となる。
【0014】
また、本発明によれば、候補点から、車両の走行距離だけ進められた位置に対応する点を新たな候補点とするため、算出された新たな候補点の位置と、車両の現実の位置との間の誤差をより少なくすることが可能となる。
【0015】
本実施例の好ましい実施態様によれば、さらに、その方位と車両の進行方位との間の方位差が所定の範囲内である道路が選択され、選択された道路に関連して新たな候補点が得られるため、無駄な処理を経ることなく、正確な車両の現在位置を算出することが可能となる。
【0016】
本実施例の好ましい実施態様によれば、さらに、仮想現在位置からの距離が所定の範囲内である道路が選択され、選択された道路に関して新たな候補点が得られるため、無駄な処理を経ることなく、正確な車両の現在位置を算出することが可能となる。
【0017】
【実施例】
以下、添付図面に基づいて、本発明の実施例につき詳細に説明を加える。
【0018】
図1は、本発明の実施例にかかる現在位置算出装置の構成を示すブロックダイヤグラムである。図1に示すように、この現在位置算出装置10は、車両のヨーレイトを検出することで進行方位変化を検出する角速度センサ11と、地磁気を検出することで車両の進行方位を検出する地磁気センサ12と、車両のトランスミッションの出力軸の回転に比例した時間間隔でパルスを出力する車速センサ13を備えている。
【0019】
また、現在位置周辺の地図や現在位置を示すマーク等を表示するディスプレイ17と、ディスプレイ17に表示する地図の縮尺切り替えの指令をユーザに(運転者)から受け付けるスイッチ14と、デジタル地図データを記憶しておくCD−ROM15と、そのCD−ROM15から地図データを読みだすためのドライバ16とを備えている。また、以上に示した各周辺装置の動作の制御を行うコントローラ18を備えている。本実施例において、上述したディジタル地図データには、複数の線分の端部を示す座標から構成される道路データ、或いは、該道路の道幅を示す道路幅データ、道路が高速道路或いは一般道路であるかを示す高速道路フラグなどが含まれる。
【0020】
コントローラ18は、角速度センサ11の信号(アナログ)をデジタル信号に変換するA/D変換器19と、地磁気センサ12の信号(アナログ)をデジタル信号に変換するA/D変換器20と、車速センサ13から出力されるパルス数を0.1秒毎にカウントするカウンタ26と、スイッチ14の押圧の有無を入力するパラレルI/O21と、CD−ROM15から読みだされた地図データを転送するDMA(Direct Memory Access)コントローラ22と、ディスプレイ17に地図画像を表示する表示プロセッサ23とを有する。
【0021】
また、コントローラ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とを含んでいる。
【0022】
以下、このように構成された現在位置算出装置10の動作について説明する。
【0023】
装置10の動作は、全般的に、車両の進行方位及び進行距離を算出する処理と、算出された進行方位及び距離から車両の現在位置を決定する処理と、得られた車両位置および方位を表示する処理との三つの処理に分けることができるため、これらについて順次説明する。
【0024】
図3に、車両の進行方位及び進行距離を算出する処理の流れを説明する。
【0025】
この処理は、一定周期、たとえば100mS毎に起動され実行されるマイクロプロセッサ24のルーチンである。
【0026】
このルーチンでは、最初、A/D変換器19から角速度センサ11の出力値を読み込む(ステップ301)。この角速度センサ11の出力値には、方位変化が出力されるので、車両の進行方向の相対的な値しか検出できない。このため、次に、A/D変換器20から地磁気センサ12の出力値を読み込み(ステップ302)、この地磁気センサ12の出力値により算出された絶対方位とジャイロ11から出力される方位変化(角速度出力)とを用いて、車両の推定方位を決定する(ステップ303)。
【0027】
この方位の決定は、たとえば、長い時間、車速が低い時には、角速度センサの誤差が大きいので、一定時間以上車速が低い場合には、地磁気センサ方位のみを利用するという方法により行う。
【0028】
次に、車速センサ13の出力するパルス数を、0.1秒毎に、カウンタ26で計数して、その計数値を読み込む(ステップ304)。この読み込んだ値に、距離係数を乗算することで、0.1秒間に進んだ距離を求める(ステップ305)。
【0029】
次に、このようにして求められた0.1秒間あたりの進行距離値を、前回得られた値に積算して、車両の進行距離が20mとなったかどうかを調べ(ステップ306)、20mに満たない場合(ステップ306でノー(No))、今回の処理を終了して、新たな処理を開始する。
【0030】
進行距離算出処理の結果、積算された進行距離が一定距離、例えば20mとなった場合(ステップ306でイエス(Yes))、その時点での進行方向と進行距離R(本実施例においては20m)とを出力する(ステップ307)。ステップ307では、さらに、積算距離を初期化して、新たに進行距離の積算を開始する。
【0031】
次に、算出された進行方位および進行距離に基づいて、車両の仮想現在位置を算出し、算出された仮想現在位置に基づき、車両の候補点を求める処理について説明する。
【0032】
図4に、この処理の流れを示す。
【0033】
本処理は、図3からの進行方位および進行距離が出力されるのを受けて起動され、実行されるマイクロプロセッサ24のルーチンである。すなわち、本実施例において、本処理は、車両が20m進む毎に起動される。
【0034】
さて、この処理では、まず、ステップ407で出力された進行方位と進行距離とを読み込む(ステップ401)。次に、それらの値に基づいて、車両の移動量を緯度経度方向、別々に、それぞれ求める。さらに、これらの各方向における移動量を、前回の車両の候補点を求める処理で得られた車両の候補点の位置に加算して、現在車両が存在すると推定される位置である仮想現在位置(A)を求める(ステップ402)。
【0035】
もし、装置の始動直後など、前回の車両の候補点を求める処理で得られた候補点が存在しない場合には、別途設定された位置を、前回得られた候補点の位置として用いて仮想現在位置(A)を求める。
【0036】
ここに、候補点につき説明を加える。装置の始動直後など、初期的な状態においては、仮想現在位置(A)は、ユーザ(運転者)がスイッチ14を用いて所定の情報を入力することなどにより、一意的に定まり、かつ、これは道路に対応する線分上に位置する。しかしながら、車両が走行した後には、ジャイロなどの方位センサの誤差などにより、仮想現在位置(A)が、道路に対応する線分上に存在しなくなる場合がある。その結果、たとえば、図5に示すように、道路が分岐している場合、すなわち、道路に対応する線分61の節点すなわち端部68から、二つの線分64および65があらわれる場合に、いずれの線分に対応する道路上に車両が存在するかが、明確にすることができない場合が多い。
【0037】
したがって、このような場合に、本実施例においては、後述する処理により得られた線分(図5に示す例では二つの線分)上に存在する点を、所定の条件の下で候補点として設定し、これらの現在位置、エラーコスト、後述する累算エラーコストなどを、それぞれ、メモリ25のRAMの所定の領域に記憶するように構成されている。なお、説明を容易にするため、以下の説明においては、特に複数の候補点であることを明示しない限り、単一の候補点から、新たな一以上の候補点を生成することとする。
【0038】
次いで、前回の車両の候補点を求める処理で得られたマッチング状態の候補点のみに関して、道路とのマッチングを行うための第1の道路検索処理が実行される(ステップ403)。なお、本実施例において、マッチング状態とは、ある仮想現在位置に関連して、該仮想現在位置との距離、或いは、その方位と車両の進行方位との間の方位差が、所定の範囲内であるような道路が存在し、その結果、仮想現在位置に基づき、道路上の所定の位置に候補点が得られた状態を称する。これに対して、ある仮想現在位置に関連して、上述した距離および方位差が、所定の範囲内であるような道路が存在しない場合が考えられる。本実施例においては、このような場合に、仮想現在位置Aに対応する点自体が候補点となり、このようにして得られた候補点を、フリー状態の候補点と称している。
【0039】
ここに、図6および図7は、本実施例にかかる第1の道路検索処理を詳細に示すフローチャートである。
【0040】
図6に示すように、この道路検索処理においては、まず、CD−ROM15から、ドライバ16およびDMAコントローラ23を介して、所定の道路データを読み出す(ステップ601)。本実施例においては、道路データとして、図8に示すように、2点間を結ぶ複数の線分51ないし55で近似し、それら線分を、その始点と終点の座標によって表したものなどを用いている。たとえば、線分53は、その始点(x3、y3)と終点(x4、y4)によって表現される。したがって、このステップ601においては、前回の処理により得られたマッチング状態の候補点が位置する線分が選択されて、これに関するデータが読み出される。
【0041】
次に、ステップ601において選択された線分の座標に基づき、候補点の位置から線分の車両の進行方向の端部までの長さが、20mに対応する長さ以下であるかどうかを判断する(ステップ602)。このステップ602においてNo(ノー)と判断された場合には、当該線分が、一次候補線分として一時的に記憶される(ステップ603)。これに対して、ステップ602においてYes(イエス)と判断された場合には、この線分の車両の進行方向の端部に接続されている線分が存在するか否かを判断する(ステップ604)。
【0042】
線分の端部に、他の線分が接続されている場合には、この接続されている線分を、一次候補線分として一時的に記憶される(ステップ605)。ここで、線分の端部に複数の線分が接続されている場合には、これら複数の線分のそれぞれが、一次候補線分として一時的に記憶される。その一方、このステップ604においてNo(ノー)と判断された場合には、ステップ606に進む。
【0043】
次いで、車両の進行方位と、線分の方位との間の角度を比較する角度比較処理が実行される(ステップ607)。図9は、本実施例にかかる角度比較処理を示すフローチャートである。図9に示すように、この処理においては、車両の進行方位と線分の方位との方位差θdを算出し(ステップ901)、この方位差θdの絶対値が、所定のしきい値θthよりも大きいか否かを判断する(ステップ902)。本実施例において、このしきい値θthは、30°に設定されている。ステップ902においてノー(No)と判断された場合には、処理を終了し、その一方、イエス(Yes)と判断された場合には、この道路を一次候補線分としない旨の判断がなされ、一時的に記憶されたこの一次候補線分に対応するデータが削除される(ステップ903)。
【0044】
図6のステップ607に示す角度比較処理が終了すると、ステップ608において複数の一次候補線分が記憶された場合には、他の一次候補線分についても角度比較処理が実行され(ステップ607、608)、全ての一次候補線分につき、角度比較処理が実行されると、ステップ609に進む。このようにして、前回の処理において得られた候補点が位置する線分、或いは、これに接続する線分のうち、その方位と車両の方位との間の方位差が、しきい値θth以下であるような線分が、一次候補線分として記憶される。
【0045】
ステップ609は、一時的に記憶された一次候補線分が、少なくとも一つ以上存在するかどうかを判断する。このステップ609においてノー(No)と判断された場合には、ステップ606に進む。その一方、ステップ609においてイエス(Yes)と判断された場合には、前回の処理において得られた候補点から、1或いは2の線分に沿って、車両の進行した距離R、本実施例では20mに対応する長さだけ進められた位置が、一次候補線分上にないか否かを判断する(ステップ610)。例えば、前述したステップ602でノー(No)と判断された結果得られた一次候補線分に関しては、このステップ610においてノー(No)と判断される。また、前述したステップ602でイエス(Yes)と判断された場合に得られた一次候補線分であっても、前回の処理で得られた候補点の位置から、この点が位置する線分の端部までの長さと、得られた一次候補線分の長さとの和が、距離R、すなわち、本実施例では20mに対応する長さより以上である場合には、このステップ610において、ノー(No)と判断される。換言すれば、このステップ610において、イエス(Yes)と判断される場合は、前回の処理で得られた候補点の位置から、この点が位置する線分の端部までの長さと、得られた一次候補線分の長さとの和が、距離R、すなわち、本実施例においては20mに対応する長さに満たない場合に限られる。
【0046】
さて、ステップ610においてノー(No)と判断された場合には、垂線距離比較処理が実行される(ステップ611)。ここに、図10は、本実施例にかかる垂線距離比較処理を示すフローチャートである。図10に示すように、この処理においては、仮想現在位置から一次候補線分に向けて垂線をひき、この垂線の長さLを求める(ステップ1001)。次いで、この垂線の長さLが、予め定められたしきい値Lth以下であるか否かを判断する(ステップ1002)。すなわち、一次候補線分が仮想現在位置から、しきい値Lthの範囲に存在しているかどうかを判断する。このステップ1002においてイエスと判断された場合には、この一次候補線分が、二次候補線分として記憶されるとともに、前回の処理で得られた候補点から、所定の線分に沿って、距離Rだけ離間した位置の座標データが、当該二次候補線分に対応する位置データとして記憶される。
【0047】
その一方、ステップ1002においてノー(No)と判断された場合には、この一次候補線分は消去され、その結果、二次候補線分は生成されない(ステップ1004)。
【0048】
このように、垂線距離比較処理611が終了すると、全ての一次候補線分につき、処理が終了しているか否かが判断される(ステップ612)。
【0049】
これに対して、前述したステップ610においてイエス(Yes)と判断された場合には、さらに、一次候補線分の車両の進行方向の端部に接続された線分が無いか否かが判断される(ステップ613)。このステップにおいてイエス(Yes)と判断された場合、すなわち、接続された線分が存在しないと判断された場合には、この一次候補線分は消去され、その結果、二次候補線分は生成されず(ステップ614)。ステップ612に進む。その一方、ステップ613においてノー(No)と判断された場合には、この接続された線分を、一次候補線分として一時的に記憶し(ステップ615)、さらに、角度比較処理が実行される(ステップ616)。
【0050】
ステップ610ないしステップ616の処理を繰り返すことにより、前回の処理により得られた候補点が位置する線分から、車両の進行方向に、該線分或いはこれに接続された線分に沿って、所定の距離Rだけ離間した点が存在し、その方位と車両の進行方位との間の方位差が、所定のしきい値θth以下であり、かつ、仮想現在位置との間の距離が、所定のしきい値Lth以下であるような二次候補線分を得ることができる。さらに、得られた二次線分に対応する位置データとして、前回の処理で得られた候補点から、所定の線分に沿って、距離Rだけ離間した位置の座標データを得ることができる。この座標データが、後述する候補点を示すデータに対応する。
【0051】
一次候補線分に関して、ステップ610ないしステップ616の処理が終了すると、これらステップを経た結果、二次候補線分が得られているか否かを判断する(ステップ617)。このステップ617において、ノー(No)と判断された場合には、ステップ606に進み、その一方、イエス(Yes)と判断された場合には、処理を終了する。
【0052】
たとえば、図5において、線分61上に存在したある候補点62に対して、仮想現在位置Aが、点63に示す位置に表わされるとする。このような場合に、まず、候補点62が位置する線分61を選択し(ステップ601)、この線分上の候補点62から、車両の進行方向の端部68までの距離を判断する(ステップ602)。図5の例の場合には、この線分に接続されている道路があるため、線分64、65が、それぞれ、一次候補線分として一時的に記憶され、それぞれに関連して、角度比較処理(ステップ607)が実行される。ここに、図5の例において、|θ(1)−θcar|<θth、かつ、|θ(2)−θcar|<θthであると仮定すると、ステップ610、611および612からなる処理ループが二回繰り返され、線分64、65のそれぞれに関連して、垂線距離比較処理(ステップ611)が実行される。
【0053】
さらに、図5の例において、L(1)<Lth、かつ、L(2)<Lthであったとすると、線分64、65が二次候補線分として記憶され、さらに、候補点62から、線分61および64、或いは、線分61および65に沿って、進行距離R(本実施例では20m)に対応する長さだけ進められた点が候補点66、67として設定され、この点の座標データ、仮想現在位置から線分までの距離L(1)、L(2)に対応するデータ、および、線分の角度θ(1)、θ(2)に対応するデータが記憶される。
【0054】
また、図11に示すように、線分64上の候補点66に対して、新たな仮想現在位置Aが、点71に示す位置に表わされ、その一方、線分65上の候補点67に対して、新たな現在位置A‘が、点72に示す位置に表わされるとする。この場合にも、候補点66に関連して、線分73、74が、一次候補線分として一時的に記憶されるとともに、候補点67に関連して、線分75が、一次候補線分として一時的に記憶される。さらに、これらに一次候補線分に関連して、角度比較処理、一定の条件を満たしている場合には、さらに垂線距離比較処理が実行される。図11に示す例において、線分73ないし75が、二次候補線分となり得るものであったとすると、図12に示すように、候補点66から、線分64および73、或いは、線分64および74に沿って、若しくは、候補点67から、線分65および75に沿って、車両の走行距離R(本実施例では20m)に対応する長さだけ進められた点が、候補点81、82、83として設定され、これらの座標データが記憶されるとともに、これら候補点に対応して、仮想現在位置Aから、線分73、74までのそれぞれの距離L1(1)、L1(2)に対応するデータ、および、仮想現在位置A’から、線分75までの距離L2(1)に対応するデータと、線分73、74の角度θ1(1)、θ1(2)に対応するデータ、および、線分75の角度θ2(1)に対応するデータとが記憶される。
【0055】
再度、図6および図7の第1の道路検索処理に戻る。ここで、ステップ604においてノー(No)と判断された場合、すなわち、前回の処理において得られた候補点が位置する線分の車両の進行方向の端部に接続している線分が存在しない場合、ステップ607ないし608において、一次候補線分が得られなかった場合(ステップ609でノー(No))、或いは、ステップ610ないしステップ616において、二次候補線分が得られなかった場合(ステップ617でノー(No))には、仮想現在位置を示す座標データが、候補点を示すデータとなる。
【0056】
このようにステップ403の第1の道路検索処理が終了すると、前回の車両の候補点を求める処理で得られたフリー状態の候補点に関して、道路とのマッチングを行うための第2の道路検索処理が実行される(ステップ404)。図13は、本実施例にかかる第2の道路検索処理を示すフローチャートである。
【0057】
図13に示すように、この処理(ステップ1301ないし1304)は、図5に示すマッチング状態の候補点に対する第1の道路検索処理(図4のステップ403)に類似している。これら二つの処理の間の相違は以下の点にある。すなわち、第1の道路検索処理においては、前回の車両の候補点を求める処理で得られた候補点が位置する線分、あるいは、これに接続する線分を、一次候補線分として一時的に記憶し、これら一次候補線分から、さらに、その方位と車両方位との方位差が所定のしきい値θth以下であって、かつ、仮想現在位置からの距離に対応する長さが所定のしきい値Lth以内の線分を、二次候補線分として選択している。これに対して、第2の道路検索処理においては、仮想現在位置(A)を中心とする予め設定された距離D内にある線分をすべて抽出し(ステップ1301)、これら線分から、その方位と車両方位との方位差が所定のしきい値θth以下の線分を選択し(ステップ1302)、さらに、選択された線分と仮想現在位置との間の距離を求め、この距離に対応する長さが所定のしきい値Lth以内の線分を選択している(ステップ1303)。換言すれば、第1の道路選択処理においては、候補点が位置している線分、或いは、当該線分の分岐点から延びる幾つかの線分などが選択されるが、図13のステップ1302の処理においては、読み出された地図データに対応する地図中の道路データから、抽出すべき線分が決定される。したがって、ステップ1301ないし1303を実行するための処理時間は、道路データに対応する道路の密度に依存し、特に、読み出された地図データに対応する地図が、市街地であった場合など、道路の密度が大きい場合などでは、この処理時間は、第1の道路検索処理における対応する処理を実行するのに必要な時間と比較すると大きい。
【0058】
この第2の道路検索処理において、ステップ1303が終了すると、ステップ1302およびステップ1303により取り出された線分、すなわち、その方位と車両方位との間の方位差が、しきい値θth以下であり、かつ、仮想現在位置からの距離に対応する長さがしきい値Lth以下であるような線分が二次候補線分として選択されるとともに、仮想現在位置から当該線分におろした垂線の足、すなわち、この垂線と線分との交点が、候補点として設定され、この座標データが記憶される(ステップ1304)。また、設定された候補点に対応して、仮想現在位置から線分までの距離を示すデータ、および、線分の方位と車両方位との間の方位差を示すデータが、記憶される。なお、第2の道路検索処理においては、仮想現在位置から線分おろした垂線と線分との交点が候補点となるが、これは、前回の処理により得られた候補点が、フリー状態であり、したがって、たどるべき線分が存在しないためである。
【0059】
なお、この第2の道路検索処理において、仮想現在位置から所定の範囲D内に線分が存在しない場合、その方位と車両の進行方位との方位差がしきい値θth以下の線分が存在しない場合、或いは、仮想現在位置からの距離に対応する長さがしきい値Lth以下であるような線分が存在しない場合には、仮想現在位置に対応する点が候補点となる。
【0060】
上述したように、ステップ404の第2の道路探索処理が終了すると、第1の道路検索処理および第2の道路検索処理により得られたn個の候補点に関連する垂線の長さL(i)(1≦i≦n)と、候補点が位置する二次候補線分の方位と車両の方位との間の方位差θd(i)とに基づき、以下の式により定義されるエラーコストec(i)が算出される(ステップ404)。
【0061】
ec(i)=α×|θd(i)|+β×L(i)
ここに、αおよびβは、重み係数である。これら重み係数の値は、車両の進行方位と線分の方位との間のずれと、仮想現在位置と線分との間のずれとの何れを、道路が選択される上で重視するかにしたがって決定される。たとえば、進行方位とその方位と方位が近い道路を選択することを重視する場合は、αを大きくするようにする。
【0062】
ついで、算出されたエラーコストec(i)と、前回の処理で得られた候補点に関連する累算エラーコストesとにしたがって、下記の式により定義される、今回の処理における累算エラーコストesを算出する(ステップ405)。
【0063】
es(i)=(1−k)×es+k×ec(i)
ここに、kは、0より大きく1より小さな重み係数である。この累算エラーコストes(i)は、前回以前の処理において算出されたエラーコストを、今回の処理において算出されるエラーコストにどのくらい反映させるかを表わしている。
【0064】
さらに、算出された累算エラーコストes(i)に基づき、下記の式に定義される信頼度trst(i)を算出する(ステップ406)。
【0065】
trst(i)=100/(1+es(i))
上記式から明らかなように、累算エラーコストec(i)が大きくなるのにしたがって、信頼度trst(i)は減少し、0(ゼロ)に近づく。その一方、これが小さくなるのにしたがって、信頼度trst(i)は増大し、その値は、100に近づく。
【0066】
このような処理をすることにより、ある候補点に対応して得られたn個の二次候補線分に関連する信頼度trst(i)が求められる。候補点が複数存在する場合には、それぞれの候補点に対応して得られた複数の二次候補線分に関連する信頼度trstを算出すればよい。
【0067】
なお、フリー状態の候補点に関連して、ステップ405で算出すべきエラーコストec(n)には、マッチング状態である場合に得られるエラーコストの値よりも大きな一定の値が与えられる。
【0068】
次いで、このように得られた候補点の各々に対応する信頼度trstの値にしたがって、これら新たな候補点をソートし(ステップ408)、最も信頼度の値の大きな候補点Cを、表示候補点CD、すなわち、ディスプレイ17上に表示するための候補点として、その位置、累算エラーコスト、信頼度、マッチング状態であるかフリー状態であるかを示す状態フラグなどを、メモリ25のRAMの所定の領域に記憶するとともに、表示候補点以外の他の候補点の位置、累算エラーコスト、信頼度、状態フラグなども、RAMの所定の領域に記憶する(ステップ409)。なお、本実施例においては、7個の候補点に関連するデータを記憶可能に構成されている。したがって、図4のステップ401ないし408の処理を実行した結果、8個以上の候補点が算出された場合には、これらのうち、信頼度trstの値が大きい順に7個の候補点に関連する種々のデータが、メモリ25のRAMの所定の領域に記憶されることになる。
【0069】
最後に、表示候補点に関連するデータが出力され(ステップ410)、処理を終了する。
【0070】
図4のステップ401ないし410を実行することにより得られた表示候補点は、図14に示すフローチャートに基づく処理によりディスプレイ17の画面上に表示される。
【0071】
本処理は、1秒毎に起動され実行されるマイクロプロセッサ24のルーチンである。
【0072】
最初、スイッチ14が押圧により地図の縮尺の変更を指示されているかを、パラレルI/O21の内容を見て判断する(ステップ1401)。もし、押されていれば(ステップ1401でイエス(Yes))、それに対応して、所定の縮尺フラグを設定する(ステップ1402)。
【0073】
次に、図4の処理を実行することにより得られた表示候補点の位置および方位を示すデータを、メモリ25のRAMの所定の領域から読み出し(ステップ1403)、ステップ1402で切り替えられた縮尺フラグの内容に応じた縮尺の地図をディスプレイ17に、例えば、図2に示すような状態で表示する(ステップ1404)。
【0074】
そして、地図に重畳して、表示候補点の位置およびその方位を、たとえば、先に示した図2のように、矢印記号“↑”を用いて表示する(ステップ1405)。そして最後に、これらに重畳して、北を示す北マークと、縮尺に対応した距離マークとを、図2のように表示する(ステップ1406)。
【0075】
なお、本実施例においては、上記のように矢印記号を用いて車両位置および方向を示したが、車両位置および方向の表示形態は、位置および進行方向が、表示状態が明確に示されるものであれば、その形態は任意でよい。また、北マーク等も同様である。
【0076】
本実施例によれば、マッチング状態の候補点から得られた仮想現在位置に関連して、当該候補点が位置する線分、或いは、これに接続された線分を検索するため、仮想現在位置の周辺に存在する全ての道路を検索する場合と比較すると、より短時間で、所望の線分を検索することが可能となる。
【0077】
また、本実施例によれば、マッチング状態の候補点の位置する線分および/または該候補点の位置する線分に接続された線分に沿って、車両の進行距離に対応する長さだけ、前記候補点から進められた位置を候補点とするため、算出された車両の現在位置と実際の車両の現在位置との間の誤差をより小さくすることが可能となる。
【0078】
本発明は、以上の実施例に限定されることなく、特許請求の範囲に記載された発明の範囲内で、種々の変更が可能であり、それらも本発明の範囲内に包含されるものであることは言うまでもない。
【0079】
たとえば、前記実施例においては、第1の道路検索処理において、マッチング状態の候補点の位置する線分或いはこれに接続された線分を一次候補線分として一時的に記憶し、これに関して角度比較処理を実行し、さらに、角度比較処理により方位差が所定の範囲内である一次候補線分が、所定の長さに満たない場合には、さらに、これに接続された線分を検索している。これは、本実施例においては、第1の道路検索処理が、車両の走行距離20mごとに実行されるため、候補点が位置している線分およびこれに接続する線分に対応する道路上に、車両が実際に位置している信憑性が高いからである。
【0080】
しかしながら、本発明は、このようなアルゴリズムに限定されるものではない。すなわち、候補点が位置する線分から、車両の走行距離だけ、線分に沿って進められた点を含む線分を、まず、すべて検索し、検索されたすべての線分に関して、角度比較処理を実行するように構成しても良い。
【0081】
また、本実施例において用いられたパラメータは、例示のために与えられたものに過ぎず、したがって、これらパラメータは、装置の処理速度、車両が走行する道路の種別(例えば、一般道路、高速道路など)にしたがって変更可能であることを理解すべきである。
【0082】
さらに、本明細書において、手段とは、必ずしも物理的手段を意味するものではなく、各手段の機能が、ソフトウエアによって実現される場合も包含する。また、一つの手段の機能が二以上の物理的手段により実現されても、二以上の手段の機能が一つの物理的手段により実現されてもよい。
【0083】
【発明の効果】
本発明によれば、車両の現在位置を、より少ない処理時間で、かつ、より正確に算出する現在位置算出システムを提供することが可能となる。
【図面の簡単な説明】
【図1】 図1は、本発明の実施例にかかる現在位置算出装置の構成を示すブロックダイヤグラムである。
【図2】 図2は、本実施例にかかる地図および現在位置の表示例を示す図である。
【図3】 図3は、本実施例にかかる車両の進行方位および進行距離を算出する処理を示すフローチャートである。
【図4】 図4は、本実施例にかかる車両の候補点を算出する処理を示すフローチャートである。
【図5】 図5は、道路に対応する線分、仮想現在位置および候補点を説明するための図である。
【図6】 図6は、本実施例にかかる第1の道路検索処理を示すフローチャートである。
【図7】 図7は、本実施例にかかる第1の道路検索処理を示すフローチャートである。
【図8】 図8は、本実施例にかかる道路データの一例を説明するための図である。
【図9】 図9は、本実施例にかかる角度比較処理を示すフローチャートである。
【図10】 図10は、本実施例にかかる垂線距離比較処理を示すフローチャートである。
【図11】 図11は、道路に対応する線分、仮想現在位置および候補点を説明するための図である。
【図12】 図12は、道路に対応する線分、仮想現在位置および候補点を説明するための図である。
【図13】 図13は、本実施例にかかる第2の道路検索処理を示すフローチャートである。
【図14】 図14は、本実施例にかかる現在位置表示処理を示すフローチャートである。
【符号の説明】
10 現在位置算出装置
11 角速度センサ
12 方位センサ
13 車速センサ
14 スイッチ
15 CD−ROM
16 CD−ROM読み取りドライバ
17 ディスプレイ
18 コントローラ
Claims (5)
- 車両に搭載され、前記車両の現在位置を算出する現在位置算出システムであって、
複数の線分からなる道路地図を記憶した記憶手段と、
前記車両の進行方位を検出する方位検出手段と、
前記車両の走行距離を測定する距離測定手段と、
前記車両の現在位置を算出する現在位置算出手段と
を備え、
前記現在位置算出手段は、
前回算出された候補点毎に、当該候補点と、前記進行方位および前記走行距離から得られる当該候補点が算出されてからの相対変位とに基づいて、前記車両の仮想現在位置を算出する仮想現在位置算出手段と、
前記前回算出された候補点毎に、当該候補点が位置する線分を前記記憶手段から読み出し、前記前回算出された候補点から当該読み出した線分における前記車両の進行方位側の端部までの残り距離が、前記前回算出された候補点が算出されてから前記距離測定手段によって測定された前記車両の走行距離である進行距離未満の場合に、当該読み出した線分に接続された線分を前記記憶手段から検索し、当該検索した線分を候補線分として選択する道路選択手段と、
前記前回算出された候補点毎に、前記残り距離が前記進行距離未満の場合に、前記前回算出された候補点が位置する線分および前記道路選択手段によって選択された候補線分に沿って、前記前回算出された候補点から前記進行距離だけ進めた位置を今回の候補点として算出し、前記残り距離が前記進行距離以上の場合に、前記前回算出された候補点が位置する線分に沿って、前記前回算出された候補点から前記進行距離だけ進めた位置を今回の候補点として算出する候補点算出手段と、
前記仮想現在位置算出手段によって算出された前記車両の仮想現在位置から前記候補点算出手段によって算出された今回の候補点が位置する線分までの距離、および前記車両の進行方位と前記今回の候補点が位置する線分の方位との方位差に基づいて、前記今回の候補点の信頼度を算出する信頼度算出手段と、
前記信頼度算出手段によって算出された信頼度に基づいて、前記今回の候補点の中から前記車両の現在位置を決定する現在位置決定手段と
を有することを特徴とする現在位置算出システム。 - 前記道路選択手段は、
検索した線分のうち、前記仮想現在位置の車両の進行方位との方位差が所定範囲内の線分を前記候補線分として選択し、
前記候補点算出手段は、
前記残り距離が前記進行距離未満の場合、前記前回算出された候補点が位置する線分および前記道路選択手段によって選択された候補線分に沿って、前記前回算出された候補点から前記進行距離だけ進めた位置を今回の候補点として算出し、
前記残り距離が前記進行距離以上の場合であって、かつ前記前回算出された候補点が位置する線分の方位と前記仮想現在位置の車両の進行方位との方位差が所定範囲内の場合には、前記前回算出された候補点が位置する線分に沿って、前記前回算出された候補点から前記進行距離だけ進めた位置を今回の候補点として算出することを特徴とする請求項1に記載の現在位置算出システム。 - 前記道路選択手段は、
検索した線分のうち、前記仮想現在位置から所定距離以内にある線分を前記候補線分として選択し、
前記候補点算出手段は、
前記残り距離が前記進行距離未満の場合、前記前回算出された候補点が位置する線分および前記道路選択手段によって選択された候補線分に沿って、前記前回算出された候補点から前記進行距離だけ進めた位置を今回の候補点として算出し、
前記残り距離が前記進行距離以上の場合であって、かつ前記前回算出された候補点が位置する線分が前記仮想現在位置から所定距離以内にある場合には、前記前回算出された候補点が位置する線分に沿って、前記前回算出された候補点から前記進行距離だけ進めた位置を今回の候補点として算出することを特徴とする請求項1または2に記載の現在位置算出システム。 - 前記候補点算出手段は、
前記残り距離が前記進行距離未満であって、かつ前記前回算出された候補点が位置する線分に接続された線分が前記記憶手段内に存在しない場合に、前記仮想現在位置を今回の候補点であるフリーの候補点としてさらに算出し、
前記前回算出された候補点が前記フリーの候補点である場合に、前記フリーの候補点に基づいて算出された前記仮想現在位置から所定距離以内に存在する線分を検索し、前記フリーの候補点に基づいて算出され前記仮想現在位置から当該検索した線分への垂線の交点を今回の候補点として算出することを特徴とする請求項1から3のいずれかに記載の現在位置算出システム。 - 車両に搭載され、当該車両の現在位置を算出する現在位置算出システムにおける現在位置算出方法であって、
現在位置算出システムは、
複数の線分からなる道路地図を記憶手段に記憶する記憶ステップと、
前記車両の進行方位を検出する方位検出ステップと、
前記車両の走行距離を測定する距離測定ステップと、
前記車両の現在位置を算出する現在位置算出ステップと
を行い、
前記現在位置算出ステップは、
前回算出された候補点毎に、当該候補点と、前記進行方位および前記走行距離から得られる当該候補点が算出されてからの相対変位とに基づいて、前記車両の仮想現在位置を算出する仮想現在位置算出ステップと、
前記前回算出された候補点毎に、当該候補点が位置する線分を前記記憶手段から読み出し、前記前回算出された候補点から当該読み出した線分における前記車両の進行方位側の端部までの残り距離が、前記前回算出された候補点が算出されてから前記距離測定ステップにおいて測定した前記車両の走行距離である進行距離未満の場合に、当該読み出した線分に接続された線分を前記記憶手段から検索し、当該検索した線分を候補線分として選択する道路選択ステップと、
前記前回算出された候補点毎に、前記残り距離が前記進行距離未満の場合に、前記前回算出された候補点が位置する線分および前記道路選択ステップにおいて選択した候補線分に沿って、前記前回算出された候補点から前記進行距離だけ進めた位置を今回の候補点として算出し、前記残り距離が前記進行距離以上の場合に、前記前回算出された候補点が位置する線分に沿って、前記前回算出された候補点から前記進行距離だけ進めた位置を今回の候補点として算出する候補点算出ステップと、
前記仮想現在位置算出ステップにおいて算出した前記車両の仮想現在位置から前記候補点算出ステップにおいて算出した今回の候補点が位置する線分までの距離、および前記車両の進行方位と前記今回の候補点が位置する線分の方位との方位差に基づいて、前記今回の候補点の信頼度を算出する信頼度算出ステップと、
前記信頼度算出ステップにおいて算出した信頼度に基づいて、前記今回の候補点の中から前記車両の現在位置を決定する現在位置決定ステップと
を含むことを特徴とする現在位置算出方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP14082395A JP3693383B2 (ja) | 1995-06-07 | 1995-06-07 | 現在位置算出システムおよび現在位置算出方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP14082395A JP3693383B2 (ja) | 1995-06-07 | 1995-06-07 | 現在位置算出システムおよび現在位置算出方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH08334350A JPH08334350A (ja) | 1996-12-17 |
JP3693383B2 true JP3693383B2 (ja) | 2005-09-07 |
Family
ID=15277557
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP14082395A Expired - Lifetime JP3693383B2 (ja) | 1995-06-07 | 1995-06-07 | 現在位置算出システムおよび現在位置算出方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3693383B2 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006163916A (ja) * | 2004-12-08 | 2006-06-22 | Nippon Telegr & Teleph Corp <Ntt> | 直線パターン識別方法及び装置及びプログラム |
-
1995
- 1995-06-07 JP JP14082395A patent/JP3693383B2/ja not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JPH08334350A (ja) | 1996-12-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3545839B2 (ja) | 現在位置算出装置 | |
JP3634006B2 (ja) | 現在位置算出装置 | |
JP3693383B2 (ja) | 現在位置算出システムおよび現在位置算出方法 | |
JP3596943B2 (ja) | 現在位置算出システムおよび現在位置算出方法 | |
JP3679450B2 (ja) | 現在位置算出装置および現在位置算出方法 | |
JP3634005B2 (ja) | 現在位置算出装置 | |
JP3660389B2 (ja) | 現在位置算出システムおよび現在位置算出方法 | |
JP3660392B2 (ja) | 現在位置算出システムおよび現在位置算出方法 | |
JP3758710B2 (ja) | 現在位置算出システムおよび現在位置算出方法 | |
JP3599420B2 (ja) | 現在位置算出装置 | |
JP3682091B2 (ja) | 現在位置算出システムおよび現在位置算出方法 | |
JP3764508B2 (ja) | 現在位置算出システムおよび現在位置算出方法 | |
JP3545838B2 (ja) | 現在位置算出装置 | |
JP3798444B2 (ja) | 現在位置算出システムおよび現在位置算出方法 | |
JP3596944B2 (ja) | 現在位置算出システムおよび現在位置算出方法 | |
JP3599422B2 (ja) | 現在位置算出装置 | |
JP3792270B2 (ja) | 現在位置算出システムおよび現在位置算出方法 | |
JP3569028B2 (ja) | 現在位置算出装置 | |
JP3545837B2 (ja) | 現在位置算出装置 | |
JP3587904B2 (ja) | 現在位置算出装置 | |
JP3679826B2 (ja) | 現在位置算出システムおよび現在位置算出方法 | |
JP3596941B2 (ja) | 現在位置算出装置 | |
JP3859743B2 (ja) | 現在位置算出装置 | |
JP3656661B2 (ja) | 現在位置算出システムおよび現在位置算出方法 | |
JP3599421B2 (ja) | 現在位置算出装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20040701 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20040727 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20040908 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050125 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050216 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050405 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050517 |
|
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: 20050614 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20050621 |
|
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: 20080701 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130701 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130701 Year of fee payment: 8 |
|
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: 20130701 Year of fee payment: 8 |
|
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: 20130701 Year of fee payment: 8 |
|
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: 20130701 Year of fee payment: 8 |
|
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 |