JP3679449B2 - Method for correcting display position of current position in current position calculation device and current position calculation device - Google Patents

Method for correcting display position of current position in current position calculation device and current position calculation device Download PDF

Info

Publication number
JP3679449B2
JP3679449B2 JP09719895A JP9719895A JP3679449B2 JP 3679449 B2 JP3679449 B2 JP 3679449B2 JP 09719895 A JP09719895 A JP 09719895A JP 9719895 A JP9719895 A JP 9719895A JP 3679449 B2 JP3679449 B2 JP 3679449B2
Authority
JP
Japan
Prior art keywords
distance
current position
vehicle
calculated
travel
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
Application number
JP09719895A
Other languages
Japanese (ja)
Other versions
JPH08292041A (en
Inventor
裕幸 佐藤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Xanavi Informatics Corp
Original Assignee
Xanavi Informatics Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Xanavi Informatics Corp filed Critical Xanavi Informatics Corp
Priority to JP09719895A priority Critical patent/JP3679449B2/en
Publication of JPH08292041A publication Critical patent/JPH08292041A/en
Application granted granted Critical
Publication of JP3679449B2 publication Critical patent/JP3679449B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Images

Landscapes

  • Traffic Control Systems (AREA)
  • Instructional Devices (AREA)
  • Navigation (AREA)
  • Processing Or Creating Images (AREA)
  • Information Retrieval, Db Structures And Fs Structures Therefor (AREA)

Description

【0001】
【産業上の利用分野】
本発明は、車両等の移動体に搭載され、走行距離や進行方位等を測定して、これらより当該車両の現在位置を算出して、現在位置周辺の道路地図と共に表示する現在位置算出装置に関するものであり、特に、算出した現在位置が誤っていた場合に、地図上の現在位置の表示位置を修正する技術に関するものである。
【0002】
【従来の技術】
従来、ジャイロ等の方位センサにより測定した車両の進行方向と、車速センサまたは距離センサにより測定した車両の走行距離に基づいて、車両の現在位置を逐次算出し、算出した現在位置に対応する位置に、表示装置に表示した道路地図上の現在位置を更新する。このような技術によれば、車両の移動に伴い、現在位置の表示が地図上を滑らかに移動するので、運転者は、この表示より、車両の現在位置や地図上の進行方向や走行状況等を直ちに把握することができる。
【0003】
また、車両の走行距離は、一般的には、トランスミッションの出力軸、または、タイヤの回転数を計測して、その回転数に、タイヤ1回転あたりに車両が進む距離である距離係数を乗ずることにより求められている。
【0004】
また、このように車両の進行方向と走行距離から求めた現在位置の誤差を補正するために、特公平6−13972号記載の技術のように、道路データに整合するように、求められた車両の現在位置を修正する、いわゆる、マップマッチングの技術が知られている。このマップマッチングの技術によれば、位置算出の精度を高めることができる。
【0005】
ところで、走行時には、タイヤの磨耗や、温度変化による膨張等により、タイヤの直径、すなわち、距離係数が時事刻々と変化する。このため、走行距離の算出において誤差が発生し、現在位置の算出が高精度に行えなくなる。たとえば、タイヤ1回転あたりの走行距離係数に、1%の誤差が存在すると、100km走行した場合、1kmの誤差が発生してしまう。
【0006】
このような走行距離の測定誤差は、通常の道路を走行している場合は、前述したマップマッチングの技術により、ある程度修正できる。しかし、高速道路等の道路を走行する際には、マップマッチングで利用できるカーブや交差点等の特徴が道路にないため、充分に誤差を修正することができなくなる。
【0007】
さらに、一旦、測定した現在位置と真の現在位置との間に1km程度の誤差が発生してしまうと、マップマッチングの技術によっては、正しい位置に補正することが困難になる。
【0008】
そこで、走行距離の測定の誤差を無くすために、従来は、(1)交差点を曲がった時(始点)から、次の交差点を曲がる(終点)までの道路データと、計測した回転数より得られる走行距離とを比較することにより、タイヤ1回転あたりの距離係数を補正することが行われていた。また、(2)特公平6−27652号公報に記載のように、2つのビーコンの間の地図上の距離と、走行して計測した距離を比較することにより、前述した距離係数を補正する技術も知られている。
【0009】
【発明が解決しようとする課題】
さて、このように、距離係数は常に正しい走行距離を算出できる値を持つとは限らないので、実際の現在位置より進んだ位置もしくは遅れた位置が現在位置として誤って算出され、地図上に表示されていることがある。
【0010】
このような場合に、地図上の現在位置の表示を正しい位置に一度に修正すると、地図上において現在位置が不連続に移動したり、進行方向と逆方向に移動したりする等、現在位置が、運転者の運転とは異なる不自然、不可解な挙動をすることになり、運転者に混乱をもたらす。
【0011】
そこで、本発明は、表示装置上に表わされた地図上の現在位置の表示を修正を、利用者が、より自然に感じられるように行うことを目的とする。
【0012】
【課題を解決するための手段】
前記目的達成のために、本発明は、逐次、検出された車輪の回転速度と、設定された距離係数に応じて車両の走行距離を算出し、検出された車両の走行距離と検出された車両の進行方位に応じて、車両が存在する現在位置を算出し、算出した現在位置を当該現在位置周辺の道路地図と共に表示する、車輪の回転に伴い移動する車両に搭載された現在位置算出装置において、算出された現在位置が誤っていた場合に、現在位置の前記道路地図上の表示位置を修正する方法であって、算出された現在位置が誤っていた場合に、前記走行距離算出手段に設定された距離係数を、一定の走行距離を走行するまでの間、当該間に算出される現在位置が漸次正しい位置に近づくように補正することにより、前記現在位置の前記道路地図上の表示位置を前記間に漸次修正することを特徴とする現在位置算出装置における現在位置の表示位置の修正方法を提供する。
【0013】
【作用】
本発明に係る現在位置算出装置における現在位置の表示位置の修正方法によれば、現在位置が誤っていた場合に直に、現在位置の表示位置を修正するのではなく、算出された現在位置が実際の現在位置より遅れている場合には、一定の走行距離を走行するまでの間、前記走行距離算出手段に設定された距離係数を、より大きな値に補正し、算出された現在位置が誤っていた場合であって、算出された現在位置が実際の現在位置より進んでいる場合には、前記一定の走行距離を走行するまでの間、前記走行距離算出手段に設定された距離係数を、より小さな値に補正することにより、前記現在位置の前記道路地図上の表示位置が前記間に漸次修正されるようにする。
【0014】
したがい、地図上において現在位置を正しい位置に修正するのに際し、この現在位置が地図上において不連続に移動したり、進行方向と逆方向に移動したりする等、現在位置が、運転者の運転とは異なる不自然、不可解な挙動をすることを防ぐことができる。
【0015】
【実施例】
以下、本発明に係る現在位置算出装置の一実施例について説明する。
【0016】
図1に本実施例に係る現在位置算出装置の構成について説明する。
【0017】
すなわち、本実施例に係る現在位置算出装置は、車両のヨーレイトを検出することで進行方位変化を検出する角速度センサ201と、地磁気を検出することで車両の進行方位を検出する地磁気センサ等の方位センサ202と、車両のトランスミッションの出力軸の回転速度に比例した時間間隔でパルスを出力する車速センサ203を備えている。
【0018】
また、現在位置周辺の地図や現在位置を示すマーク等を表示するディスプレイ207と、ディスプレイ207に表示する地図の縮尺切り替えの指令をユーザに(運転者)から受け付けるスイッチ204と、デジタル地図データを記憶しておくCD−ROM205と、そのCD−ROM205から地図データを読みだすためのドライバ206とを備えている。また、以上に示した各周辺装置の動作の制御を行うコントローラ208を備えている。
【0019】
次に、コントローラ208は、角速度センサ201の信号(アナログ)をデジタル信号に変換するA/D変換器209と、方位センサ202の信号(アナログ)をデジタル信号に変換するA/D変換器210と、車速センサ203から出力されるパルス数を0.1秒毎にカウントするカウンタ216と、スイッチ204の押圧の有無を入力するパラレルI/O211と、CD−ROM205から読みだされた地図データを転送するDMA(Direct Memory Access)コントローラ212と、ディスプレイ207に地図画像を表示する表示プロセッサ213とを有する。
【0020】
また、コントローラ208は、さらに、マイクロプロセッサ214と、メモリ215とを有する。マイクロプロセッサ214は、A/D変換器209を介して得た角速度センサ201の信号、A/D変換器210を介して得た方位センサ202の信号、カウンタ216がカウントした車速センサ203の出力パルス数、パラレルI/O211を介して入力するスイッチ204の押圧の有無、DMAコントロ−ラ212を介して得たCD−ROM205からの地図データを受け入れて、それら信号に基づいて処理を行い、車両の現在位置を算出して、それを表示プロセッサ213を介してディスプレイ207に表示させる。この車両位置の表示は、図2に示すように、すでにディスプレイ207に表示している地図上に矢印マ−ク等を重畳して表示することにより行う。これにより、ユーザは、地図上で車両の現在位置を知ることができる。メモリ215は、このような動作を実現するための処理(後述)の内容を規定するプログラムや、後述する各種テ−ブル等を格納したROMと、マイクロプロセッサ214が処理を行う場合にワ−クエリアとして使用するRAMとを含んでいる。
【0021】
以下、本実施例に係る現在位置算出装置の動作について説明する。
【0022】
まず、車両の進行方位及び走行距離を算出する処理、算出された進行方位及び距離から車両の現在位置を決定する処理、得られた車両位置および方位を表示する処理の三つの処理について説明する。
【0023】
図3に、車両の進行方位及び走行距離を算出する処理の流れを説明する。
【0024】
この処理は、一定周期、たとえば100mS毎に起動され実行されるマイクロプロセッサ214のルーチンである。
【0025】
このルーチンでは、最初、A/D変換器209から角速度センサ201の出力値を読み込む(ステップ401)。この角速度センサ201の出力値には、方位変化が出力されるので、車両の進行方向の相対的な値しか検出できない。このため、次に、A/D変換器210から方位センサ202の出力値を読み込み(ステップ402)、この方位センサ202の出力値により算出された絶対方位と角速度センサ201から出力される方位変化(角速度出力)とを用いて、車両の推定方位を決定する(ステップ403)。
【0026】
この方位の決定は、たとえば、長い時間、車速が低い時には、角速度センサ201の誤差が大きいので、一定時間以上車速が低い場合には、方位センサ202の出力する方位のみを利用するという方法により行う。
【0027】
次に、車速センサ203の出力するパルス数を、0.1秒毎に、カウンタ216で計数して、その計数値を読み込む(ステップ404)。この読み込んだ値に、距離係数Rを乗算することで、0.1秒間に進んだ距離を求める(ステップ405)。この距離係数Rの求め方については後述する。
【0028】
次に、このようにして求められた0.1秒間あたりの走行距離値を、前回得られた値に積算して、車両の走行距離が20mとなったかどうかを調べ(ステップ406)、20mに満たない場合(ステップ406でNo)、今回の処理を終了して、新たな処理を開始する。
【0029】
走行距離算出処理の結果、積算された走行距離が一定距離、例えば20mとなった場合(ステップ406でYes)、その時点での進行方向と走行距離(20m)とを出力する(ステップ407)。ステップ407では、さらに、積算距離を初期化して、新たに走行距離の積算を開始する。
【0030】
次に、算出された進行方位および走行距離に基づいて、車両の現在位置を求める処理について説明する。
【0031】
図4に、この処理の流れを示す。
【0032】
本処理は、図3からの進行方位および走行距離が出力されるのを受けて起動され、実行されるマイクロプロセッサ214のルーチンである。すなわち、本処理は、車両が20m進む毎に起動される。
【0033】
さて、この処理では、まず、ステップ407で出力された進行方位と走行距離とを読み込む(ステップ501)。次に、それらの値に基づいて、車両の移動量を緯度経度方向、別々に、それぞれ求める。さらに、これらの各方向における移動量を、前回の処理で求められた車両の現在位置に加算して、現在位置(A)を求める(ステップ502)。
【0034】
もし、装置の始動直後など、前回求められた位置がない場合には、別途設定された位置を前回求められた位置として用いて現在位置(A)を求める。
【0035】
次に、求めた現在位置(A)の周辺の地図を、CD−ROM205から、ドライバ206およびDMAコントローラ213を介して、読み出し、現在位置(A)を中心とする予め設定された距離D内にある道路データ(線分)を抜き出す(ステップ503)。
【0036】
なお、道路データとしては、たとえば、図6に示すように、2点間を結ぶ複数の線分81〜85で近似し、それら線分を、その始点と終点の座標によって表したもの等を用いることができる。たとえば、線分83は、その始点(x3、y3)と終点(x4、y4)によって表現するようにする。
【0037】
次に、ステップ503で抜き出された線分の中から、その線分の方位が、求められている進行方向と、所定値以内にある線分だけを抜き出す(ステップ504)。さらに、抜き出されたすべての線分に対し、現在位置(A)から垂線をおろし、その垂線の長さを求める(ステップ505)。
【0038】
次に、それら垂線の長さを用いて、ステップ504で抜き出されたすべての線分に対して、以下に定義されるエラーコスト値を算出する。
【0039】
エラーコスト=α×|進行方向−線分方位|+β|垂線の長さ|
ここで、α、βは、重み係数である。これら係数の値は、進行方向と道路の方位のずれと現在位置と道路のずれのどちらを、現在位置が、その上にある道路を選択する上で重視するかによって変化させてよい。たとえば、進行方向と方位が近い道路を重視する場合は、αを大きくするようにする。
【0040】
そして、各線分のエラーコストが算出されたならば、エラーコストが算出された線分のうち、エラーコスト値が最も小さい線分を選び(ステップ506)、その選択された線分と垂線との交差する点(線分の垂線のあし)を、修正された現在位置(B)とする(ステップ507)。
【0041】
ところで、前述したステップ503では、現在位置(A)を中心とする予め設定された距離D内にある道路データ(線分)を抜き出したが、この距離Dは、前回行ったステップ506で選択した道路のエラーコストの値に基づいて決定する値でもよい。
【0042】
ここで、エラーコストに基づいて、検索範囲を求める理由は、エラーコストのが大きい場合は、前回求めた現在位置(B)の精度に対する信憑性が低いと考えられるので、より広い範囲を検索して道路を探す方が、正しい現在位置を求める上で適当であるからである。
【0043】
次に、得られた車両位置および方位を表示する処理について説明する。
【0044】
図5に、この処理の流れを示す。
【0045】
本処理は、1秒毎に起動され実行されるマイクロプロセッサ214のルーチンである。
【0046】
最初、スイッチ204が押圧により地図の縮尺の変更を指示されているかを、パラレルI/O211の内容を見て判断する(ステップ601)。もし、押されていれば(ステップ601でYes)、それに対応して、所定の縮尺フラグを設定する(ステップ602)。
【0047】
次に、図4の処理で求められた現在位置(B)を読み出し(ステップ603)、ステップ602で切り替えられた縮尺フラグの内容に応じた縮尺の地図をディスプレイ207に、例えば、図2に示すような状態で表示する(ステップ604)。
【0048】
そして、地図に重畳して、車両の現在位置(B)と車両の進行方位を、たとえば、先に示した図2のように、矢印記号“↑”を用いて表示する(ステップ605)。そして最後に、これらに重畳して、北を示す北マークと、縮尺に対応した距離マークとを、図2のように表示する(ステップ606)。
【0049】
なお、本実施例においては、上記のように矢印記号を用いて車両位置および方向を示したが、車両位置および方向の表示形態は、位置および進行方向が、表示状態が明確に示されるものであれば、その形態は任意でよい。また、北マーク等も同様である。
【0050】
以下、現在位置が誤っていた場合に、本実施例においてどのように、現在位置の表示(図2の矢印)の表示位置が修正されるのかを説明する。
【0051】
さて、前述したように車両の走行距離は、車速センサ203の出力するパルス数に距離係数Rを乗じて求める。しかし、タイヤの摩耗等によりタイヤ1回転あたりの車両の進行距離は変化するので、距離係数Rは常に走行距離を正しく算出できる正しい値を持つとは限らない。そして、距離係数Rによって、正しい走行距離を算出できなかった場合には、実際の位置より進んだ位置か遅れた位置が、現在位置として算出され、表示されることになる。
【0052】
したがい、表示されている現在位置が正しいものであるか否かを判定し、誤っていた場合には、算出、表示される現在位置が正しい位置になるように修正するする必要がある。
【0053】
本実施例では、表示されている現在位置が正しいものであるか否かを次のように判定する。
【0054】
いま、図4のステップ508で出力された現在位置(B)が、図7の道路Aを進行するものであったとする。一方、たとえば、逐次出力される現在位置(B)のうちの、走行上カ−ブ開始点oより所定距離だけ前のa点を基準に、車両の進行方位の走行距離から求めた車両の現在位置の軌跡が、図中に破線で示したようにo点をオ−バした地点から曲がり始めた軌跡であったとする。
【0055】
この場合には、距離係数Rが真の値より大きかったものと推定することができる。なぜならば、車両がカ−ブに達したと距離係数Rを用いて推定された時点では、車両は曲がり始めていないので実際には車両はカ−ブに達していないと考えられるからである。また、距離係数Rが真の値より大きい度合いは、車両が実際に曲がり始めた地点とカ−ブ開始点oとの距離を表す図中の距離dより推定することができる。
【0056】
また、逆に、車両の進行方位の走行距離から求めた車両の現在位置の軌跡が、交叉点oに到る前に曲がり始めた軌跡である場合には、距離係数Rが真の値より小さかったものと推定することができる。なぜならば、車両がカ−ブoに達したと距離係数Rを用いて推定される前に、車両は曲がり始めているので実際には車両は既にカ−ブoに達していると考えられるからである。また、この場合も、距離係数Rが真の値より小さい度合いは、車両が実際に曲がり始めた地点とカ−ブoとの距離を表す図中の距離誤差dより推定することができる。
【0057】
したがい、図中のdより距離係数Rの真値よりのずれの方向と、その度合いを判定することができる。そして、距離係数Rの真値よりのずれの方向と、その度合いが分かれば、これより、現在位置として算出されている位置が、実際の位置より遅れた位置なのか、進んだ位置なのかを、その度合いと共に推定することができる。たとえば、距離係数Rが真の値より小さければ、算出、表示されている現在位置は実際の位置より遅れた位置であると推定できるし、距離係数Rが真の値より大きければ、算出、表示されている現在位置は実際の位置より進んだ位置であると推定できる。また、遅れ進みの程度は、距離係数Rの真の値よりのずれ量に比例する傾向を持つと期待することができる。すなわち、算出されている現在位置の遅れ進みの度合いは、距離誤差dに応じた値となると期待できる。
【0058】
そこで、本実施例では、このようにして距離誤差dが検出された場合に、距離誤差dの値に応じて、表示されている現在位置が実際の位置より進んだ位置であるか遅れた位置であるかをを判定する。また、さらに、補正変数Rshを導入し距離係数をR=R0×(1+Rsh)により定義する。そして、距離誤差dが算出されたら、その後300m間だけ、距離誤差dに応じた値をRshとし、その後は次に距離誤差dが算出されるまでRsh=0とすることにより、距離誤差dが算出された後の300mの間に、算出、表示される現在位置が漸次正しい位置になるようにする。なお、R0は距離係数の初期値であってもよいし、前述した従来の技術によって補正される距離係数であってもよい。なお、このR0は、逐次、距離誤差dに応じて補正するようにしてもよい。前述したように、距離誤差dより、距離係数Rの真値よりのずれの方向と、その度合いを判定することができるからである。
【0059】
なお、車両方位と道路の方位差から、車両がカ−ブoに達したと距離係数Rを用いて推定されるより前に、車両が曲がり始めたか、車両がカ−ブoに達したと距離係数Rを用いて推定された時点より後に車両が曲がり始めたかを判定するようにしてもよい。また、この場合には、車両方位と道路の方位差の積分値より、距離係数Rが真の値よりずれている度合いを求めることができる。したがい、この場合は、車両方位と道路の方位差の積分値より、補正変数Rshを求めることができる。
【0060】
以下、上述したように現在位置の表示位置の実際の位置よりのずれを修正するために、マイクロプロセッサ214によって実行される処理の詳細について説明する。
【0061】
まず、本装置が起動されると、まず、図8に示すように、以降の処理で使用する各種パラメ−タを初期化する。すなわち、距離誤差dを0に、補正変数Rshを0に、補正実施距離lを0にセットする。
【0062】
これ以降は、図9に示す処理が、車両が20m走行する度に実行される。
【0063】
図9の処理では、まず、各センサに201、202、203を用いて算出した走行距離や進行方位をセンサデータとして読み込む(ステップ701)。そして次に、CD−ROM205からドライバ206に読み出された地図データを読み込む(ステップ702)。
【0064】
次に、図7に示した距離誤差dを、ステップ701で読み込んだセンサデータと、ステップ702で読み込んだ地図データを用いて求め(ステップ703)、求めた距離誤差dが0か否かを判定し(ステップ704)、0であれば処理を終了する。一方、dが0でなければ、補正変数Rshの設定処理を行い(ステップ705)処理を終了する。
【0065】
以下、各ステップの処理の詳細について説明する。
【0066】
まず、ステップ703の距離誤差dの算出処理について説明する。
【0067】
図10に、この処理の手順を示す。
【0068】
図示するように、この処理では、まず、補正変数Rshが0か否かを判定する(ステップ801)。
【0069】
そして、0でなければ、前回求めたRshが、まだ有効であるので(前回距離誤差およびRshを算出してから300m走行していないので)、新たな補正変数Rshを求めるための距離誤差dの算出は行わずに処理を終了する。したがい、前回補正変数Rshを求めるために用いた距離誤差が、距離誤差dとして維持され続けることになる。したがい、この場合には、図9のステップ704の判定ステップによってyesと判定され、ステップ705のRsh設定処理が実行されることになる。
【0070】
一方、もし0である場合には、まず、車両が右左折したか否かを判定し(ステップ802)、距離誤差が存在するか否かを判定し(ステップ803)、距離誤差があれば、先に説明した距離誤差dを算出する(ステップ804)。ただし、このとき、車両がカ−ブを内回りしたときに距離誤差dの符号は負とし、車両がカ−ブを外回りしたときに距離誤差dの符号は正とする。
【0071】
一方、車両が右左折していない場合、または、距離誤差が存在しない場合には、そのまま処理を終了する。
【0072】
次に、図9のステップ705の補正変数Rshの設定処理について説明する。
【0073】
図11に、この補正変数Rshの設定処理の処理手順を示す。
【0074】
この処理では、まず、距離補正変数Rshが0か否かを判定する(ステップ1101)。そして、0であれば、前回求めた補正変数Rshは既にリセットされているので、距離誤差dに応じた新たな補正変数Rshを求める(ステップ1102)。
【0075】
すなわち、補正変数Rshの正負を図12に示す対応によって定め、補正変数Rshの絶対値を距離誤差dの絶対値に、予め定めた係数jを乗じて求める。
【0076】
そして、最後に補正実施距離lを0に初期化し(ステップ1103)処理を終了する。
【0077】
この後、この補正実施距離lは、ステップ1103で初期化された後の走行距離を、ステップ1103で初期化された後車両が300m走行するまで表すこことになる。
【0078】
ステップ1101において、一方、距離補正変数Rshが0でないと判定されたならば、まだ、前回求めた補正変数Rshが有効であるので、補正実施距離lが300m以下であるか否かを判断し(ステップ1404)、300m以下であれば補正実施距離lの値を、ステップ1103で初期化された後の走行距離を表すように更新する(ステップ1105)。
【0079】
一方、300mを超えている場合には、補正変数Rshを0に、補正実施距離lを0に、距離誤差dを0にリセットする(ステップ1106)。
【0080】
以上説明した処理によって、距離誤差dが検出された場合に距離誤差dの値に応じて補正変数Rshを求め、その後300m間だけ、求めた補正変数Rshによって距離係数Rを補正し、その後Rshを0にリセットする。また、この300mの間は、新たに補正変数Rshが求まってしまうことを防ぐ。
【0081】
すなわち、図9の処理において、補正変数Rshがリセットされているときには、ステップ703(図10)において距離誤差dが求められる。そして、求めた距離誤差dが0でなければ、ステップ705(図11)で補正変数Rshが求められる。しかし、補正変数Rshがリセットされていないときには、図9ステップ703の距離誤差dの算出処理において新たな距離誤差dは求められず(図10ステップ801参照)、前回Rshを求めるのに用いた距離誤差dが維持され続ける。したがい、補正変数Rshがリセットされていないときには、図9ステップ704でyesと判定され、ステップ705(図11)において、補正実施距離lが300mに達するまでは補正実施距離lの更新のみが行われる。そして、300mに達すると同ステップにおいて補正変数Rsh、補正実施距離ののリセットが行われる。なお、この補正実施距離lの更新や、補正変数Rsh、補正実施距離のリセットは、既にRshがリセットされている場合には行われない。
【0082】
このように、補正変数Rshを用いて距離係数Rを補正することにより、前述した各処理(図3〜図5)によって、ディスプレイ207に表示される地図上の現在位置の表示が、前述した300mの間に漸次少しづつ正しい位置に近づくようになる。したがい、現在位置表示の不連続な飛びや、逆戻りは生じない。
【0083】
【発明の効果】
以上のように、本発明によれば、表示装置上に表わされた地図上の現在位置の表示を修正を、利用者が、より自然に感じられるように行うことのできる現在位置算出装置を提供することができる。
【図面の簡単な説明】
【図1】本発明の一実施例に係る現在位置算出装置の構成を示すブロック図である。
【図2】本発明の一実施例において行う地図および現在位置の表示例を示す図である。
【図3】本発明の一実施例において行う進行方位および距離の算出処理の手順を示すフローチャートである。
【図4】本発明の一実施例において行う現在位置の算出処理の手順を示すフローチャートである。
【図5】本発明の一実施例において行う現在位置表示処理の手順を示すフローチャートである。
【図6】本発明の一実施例において用いる地図データにおける道路の表現形式を示す図である。
【図7】本発明の一実施例において用いる距離誤差dを示す図である。
【図8】本発明の一実施例において行う距離係数を補正する処理の手順を示す第1のフロチャ−トである。
【図9】本発明の一実施例において行う距離係数を補正する処理の手順を示す第2のフロチャ−トである。
【図10】本発明の一実施例において行う距離係数を補正する処理の手順を示す第3のフロチャ−トである。
【図11】本発明の一実施例において行う距離係数を補正する処理の手順を示す第4のフロチャ−トである。
【図12】本発明の一実施例において用いる距離誤差dと補正変数Rshの正負の関係を示した図である。
【符号の説明】
201 角速度センサ
202 方位センサ
203 車速センサ
204 スイッチ
205 CD−ROM
206 CD−ROMドライバ
207 ディスプレイ
208 DMAコントローラ
214 マイクロプロセッサ
215 メモリ
[0001]
[Industrial application fields]
The present invention relates to a current position calculation device that is mounted on a moving body such as a vehicle, measures a travel distance, a traveling direction, and the like, calculates a current position of the vehicle from these, and displays it together with a road map around the current position. In particular, the present invention relates to a technique for correcting the display position of the current position on a map when the calculated current position is incorrect.
[0002]
[Prior art]
Conventionally, the current position of the vehicle is sequentially calculated based on the traveling direction of the vehicle measured by an orientation sensor such as a gyro and the travel distance of the vehicle measured by a vehicle speed sensor or a distance sensor, and the position corresponding to the calculated current position is obtained. The current position on the road map displayed on the display device is updated. According to such a technique, as the vehicle moves, the current position display moves smoothly on the map. From this display, the driver can determine the current position of the vehicle, the traveling direction on the map, the driving situation, etc. Can be grasped immediately.
[0003]
The vehicle travel distance is generally measured by measuring the output shaft of the transmission or the rotation speed of the tire, and multiplying the rotation speed by the distance coefficient that is the distance the vehicle travels per rotation of the tire. It is demanded by.
[0004]
Further, in order to correct the error of the current position obtained from the traveling direction and the travel distance of the vehicle in this way, the vehicle that is obtained so as to be consistent with the road data as in the technique described in Japanese Patent Publication No. 6-13972. A so-called map matching technique for correcting the current position of the image is known. According to this map matching technique, the accuracy of position calculation can be increased.
[0005]
By the way, during running, the tire diameter, that is, the distance coefficient changes every moment due to tire wear, expansion due to temperature change, and the like. For this reason, an error occurs in the calculation of the travel distance, and the current position cannot be calculated with high accuracy. For example, if there is an error of 1% in the travel distance coefficient per one rotation of the tire, an error of 1 km occurs when the vehicle travels 100 km.
[0006]
Such a measurement error of the travel distance can be corrected to some extent by the above-described map matching technique when traveling on a normal road. However, when driving on a road such as an expressway, since the road does not have features such as curves and intersections that can be used for map matching, the error cannot be corrected sufficiently.
[0007]
Furthermore, once an error of about 1 km occurs between the measured current position and the true current position, it is difficult to correct the position correctly depending on the map matching technique.
[0008]
Therefore, in order to eliminate the measurement error of the travel distance, conventionally, it is obtained from (1) road data from the time when the intersection is turned (start point) to the next intersection (end point) and the measured rotation speed. The distance coefficient per one rotation of the tire has been corrected by comparing with the travel distance. Also, as described in (2) JP-B-6-27652, a technique for correcting the above-described distance coefficient by comparing the distance on the map between the two beacons and the distance measured by running. Is also known.
[0009]
[Problems to be solved by the invention]
Now, because the distance coefficient does not always have a value that can calculate the correct travel distance, a position that is advanced or delayed from the actual current position is erroneously calculated as the current position and displayed on the map. Have been.
[0010]
In such a case, if the display of the current position on the map is corrected to the correct position at once, the current position may be moved discontinuously on the map or moved in the direction opposite to the traveling direction. This will cause unnatural and mysterious behavior that is different from the driving of the driver, causing confusion to the driver.
[0011]
Therefore, an object of the present invention is to correct the display of the current position on the map represented on the display device so that the user can feel it more naturally.
[0012]
[Means for Solving the Problems]
In order to achieve the above object, the present invention sequentially calculates the travel distance of the vehicle according to the detected wheel rotation speed and the set distance coefficient, and detects the detected travel distance of the vehicle. In a current position calculation device mounted on a vehicle that moves as the wheels rotate, the current position where the vehicle exists is calculated according to the traveling direction of the vehicle, and the calculated current position is displayed together with a road map around the current position. A method of correcting the display position of the current position on the road map when the calculated current position is incorrect, and is set in the travel distance calculating means when the calculated current position is incorrect The displayed position of the current position on the road map is corrected by correcting the calculated distance coefficient so that the current position calculated during the period until the vehicle travels a certain distance is gradually closer to the correct position. Above Provides a method of correcting the display position of the current position at the current position calculating device, characterized in that the modified progressively to.
[0013]
[Action]
According to the correction method of the display position of the current position in the current position calculation apparatus according to the present invention, instead of correcting the display position of the current position immediately when the current position is incorrect, the calculated current position is If it is behind the actual current position, the distance coefficient set in the travel distance calculation means is corrected to a larger value until the vehicle travels a certain travel distance, and the calculated current position is incorrect. If the calculated current position is ahead of the actual current position, the distance coefficient set in the travel distance calculation means until the travel of the fixed travel distance, By correcting to a smaller value, the display position of the current position on the road map is gradually corrected during the time.
[0014]
Therefore, when the current position on the map is corrected to the correct position, the current position may move discontinuously on the map, or move in the direction opposite to the traveling direction. It is possible to prevent unnatural and mysterious behavior different from
[0015]
【Example】
Hereinafter, an embodiment of a current position calculation apparatus according to the present invention will be described.
[0016]
FIG. 1 illustrates the configuration of the current position calculation apparatus according to the present embodiment.
[0017]
That is, the current position calculation device according to the present embodiment includes an angular velocity sensor 201 that detects a change in traveling azimuth by detecting the yaw rate of the vehicle, and an azimuth such as a geomagnetic sensor that detects the traveling azimuth of the vehicle by detecting geomagnetism. A sensor 202 and a vehicle speed sensor 203 that outputs pulses at time intervals proportional to the rotational speed of the output shaft of the vehicle transmission are provided.
[0018]
Further, a display 207 that displays a map around the current position, a mark indicating the current position, and the like, a switch 204 that receives a command to switch the scale of the map displayed on the display 207 from the driver, and stores digital map data A CD-ROM 205 and a driver 206 for reading map data from the CD-ROM 205. Further, a controller 208 that controls the operation of each peripheral device described above is provided.
[0019]
Next, the controller 208 includes an A / D converter 209 that converts the signal (analog) of the angular velocity sensor 201 into a digital signal, and an A / D converter 210 that converts the signal (analog) of the azimuth sensor 202 into a digital signal. The counter 216 that counts the number of pulses output from the vehicle speed sensor 203 every 0.1 second, the parallel I / O 211 that inputs whether or not the switch 204 is pressed, and the map data read from the CD-ROM 205 are transferred. A direct memory access (DMA) controller 212 and a display processor 213 for displaying a map image on the display 207.
[0020]
The controller 208 further includes a microprocessor 214 and a memory 215. The microprocessor 214 outputs signals from the angular velocity sensor 201 obtained through the A / D converter 209, signals from the direction sensor 202 obtained through the A / D converter 210, and output pulses from the vehicle speed sensor 203 counted by the counter 216. Number, whether or not the switch 204 is input via the parallel I / O 211, the map data from the CD-ROM 205 obtained via the DMA controller 212 is received, and processing based on these signals is performed. The current position is calculated and displayed on the display 207 via the display processor 213. The vehicle position is displayed by superimposing an arrow mark or the like on the map already displayed on the display 207, as shown in FIG. Thereby, the user can know the current position of the vehicle on the map. The memory 215 includes a program that defines the contents of processing (to be described later) for realizing such operations, a ROM that stores various tables to be described later, and a work area when the microprocessor 214 performs processing. RAM to be used.
[0021]
Hereinafter, the operation of the current position calculation apparatus according to the present embodiment will be described.
[0022]
First, three processes will be described: a process for calculating the traveling direction and travel distance of the vehicle, a process for determining the current position of the vehicle from the calculated traveling direction and distance, and a process for displaying the obtained vehicle position and direction.
[0023]
FIG. 3 illustrates the flow of processing for calculating the traveling direction and travel distance of the vehicle.
[0024]
This process is a routine of the microprocessor 214 that is activated and executed at a constant cycle, for example, every 100 ms.
[0025]
In this routine, first, the output value of the angular velocity sensor 201 is read from the A / D converter 209 (step 401). Since a change in direction is output as the output value of the angular velocity sensor 201, only a relative value in the traveling direction of the vehicle can be detected. Therefore, next, the output value of the azimuth sensor 202 is read from the A / D converter 210 (step 402), and the absolute azimuth calculated based on the output value of the azimuth sensor 202 and the azimuth change output from the angular velocity sensor 201 ( The estimated azimuth of the vehicle is determined using (angular velocity output) (step 403).
[0026]
For example, when the vehicle speed is low for a long time, the angular velocity sensor 201 has a large error. Therefore, when the vehicle speed is low for a certain time or more, only the direction output by the direction sensor 202 is used. .
[0027]
Next, the number of pulses output from the vehicle speed sensor 203 is counted by the counter 216 every 0.1 second, and the counted value is read (step 404). By multiplying the read value by a distance coefficient R, a distance advanced in 0.1 seconds is obtained (step 405). A method for obtaining the distance coefficient R will be described later.
[0028]
Next, the travel distance value per 0.1 second obtained in this way is added to the previously obtained value to check whether the travel distance of the vehicle has reached 20 m (step 406). If not (No in step 406), the current process is terminated and a new process is started.
[0029]
As a result of the travel distance calculation process, when the accumulated travel distance becomes a certain distance, for example, 20 m (Yes in Step 406), the traveling direction and the travel distance (20 m) at that time are output (Step 407). In step 407, the accumulated distance is further initialized, and accumulation of the travel distance is newly started.
[0030]
Next, processing for obtaining the current position of the vehicle based on the calculated traveling direction and travel distance will be described.
[0031]
FIG. 4 shows the flow of this process.
[0032]
This processing is a routine of the microprocessor 214 that is activated and executed in response to the output of the traveling direction and travel distance from FIG. That is, this process is started every time the vehicle travels 20 meters.
[0033]
In this process, first, the traveling direction and the travel distance output in step 407 are read (step 501). Next, based on these values, the movement amount of the vehicle is obtained separately in the latitude and longitude directions. Further, the movement amount in each direction is added to the current position of the vehicle obtained in the previous process to obtain the current position (A) (step 502).
[0034]
If there is no previously obtained position, such as immediately after the start of the device, the current position (A) is obtained using the separately set position as the previously obtained position.
[0035]
Next, a map around the obtained current position (A) is read from the CD-ROM 205 via the driver 206 and the DMA controller 213, and within a preset distance D centered on the current position (A). Some road data (line segment) is extracted (step 503).
[0036]
As the road data, for example, as shown in FIG. 6, a plurality of line segments 81 to 85 that connect two points are approximated, and those line segments are expressed by the coordinates of the start point and the end point. be able to. For example, the line segment 83 is expressed by its start point (x3, y3) and end point (x4, y4).
[0037]
Next, from the line segments extracted in step 503, only those line segments whose azimuth is within the predetermined traveling direction and predetermined value are extracted (step 504). Further, a perpendicular is drawn from the current position (A) for all the extracted line segments, and the length of the perpendicular is obtained (step 505).
[0038]
Next, the error cost value defined below is calculated for all the line segments extracted in step 504 using the lengths of the perpendicular lines.
[0039]
Error cost = α × | Advance direction−Line segment direction | + β | Length of perpendicular |
Here, α and β are weighting factors. The values of these coefficients may be changed depending on whether the current position is important in selecting the road on which the current position or the road is shifted, or the current position or the road is shifted. For example, when importance is attached to a road whose direction is close to the traveling direction, α is increased.
[0040]
When the error cost of each line segment is calculated, the line segment with the smallest error cost value is selected from the line segments for which the error cost has been calculated (step 506), and the line segment and the perpendicular line are selected. The intersecting point (the bottom of the vertical line) is set as the corrected current position (B) (step 507).
[0041]
Incidentally, in step 503 described above, road data (line segment) within a preset distance D centered on the current position (A) is extracted. This distance D was selected in the previous step 506. It may be a value determined based on the value of the road error cost.
[0042]
Here, the reason for obtaining the search range based on the error cost is that if the error cost is large, the reliability of the accuracy of the current position (B) obtained last time is considered to be low. This is because searching for a road is more appropriate for finding the correct current position.
[0043]
Next, processing for displaying the obtained vehicle position and direction will be described.
[0044]
FIG. 5 shows the flow of this process.
[0045]
This process is a routine of the microprocessor 214 that is activated and executed every second.
[0046]
First, it is determined by checking the contents of the parallel I / O 211 whether the switch 204 is instructed to change the scale of the map (step 601). If it has been pressed (Yes in step 601), a predetermined scale flag is set correspondingly (step 602).
[0047]
Next, the current position (B) obtained in the process of FIG. 4 is read (step 603), and a map of a scale corresponding to the contents of the scale flag switched in step 602 is displayed on the display 207, for example, FIG. The screen is displayed in such a state (step 604).
[0048]
Then, the current position (B) of the vehicle and the traveling direction of the vehicle are displayed using, for example, the arrow symbol “↑” as shown in FIG. 2 (step 605). Finally, a north mark indicating north and a distance mark corresponding to the scale are displayed as shown in FIG. 2 so as to be superimposed on these (step 606).
[0049]
In the present embodiment, the vehicle position and direction are indicated by using the arrow symbols as described above. However, in the display form of the vehicle position and direction, the display state is clearly shown for the position and the traveling direction. If it exists, the form may be arbitrary. The same applies to the north mark and the like.
[0050]
Hereinafter, how the display position of the display of the current position (arrow in FIG. 2) is corrected in the present embodiment when the current position is incorrect will be described.
[0051]
As described above, the travel distance of the vehicle is obtained by multiplying the number of pulses output from the vehicle speed sensor 203 by the distance coefficient R. However, since the travel distance of the vehicle per one rotation of the tire changes due to tire wear or the like, the distance coefficient R does not always have a correct value for correctly calculating the travel distance. If the correct travel distance cannot be calculated by the distance coefficient R, a position advanced or delayed from the actual position is calculated and displayed as the current position.
[0052]
Therefore, it is determined whether or not the displayed current position is correct. If the current position is incorrect, it is necessary to correct the calculated and displayed current position so that it is correct.
[0053]
In this embodiment, it is determined as follows whether or not the displayed current position is correct.
[0054]
Now, it is assumed that the current position (B) output at step 508 in FIG. 4 travels on the road A in FIG. On the other hand, for example, the current vehicle position obtained from the traveling distance of the traveling direction of the vehicle on the basis of the point a of the current position (B) that is sequentially output, a predetermined distance before the starting point o of the traveling curve. Assume that the position trajectory is a trajectory that starts to bend from a point where the point o is over, as indicated by a broken line in the figure.
[0055]
In this case, it can be estimated that the distance coefficient R is larger than the true value. This is because at the time when it is estimated using the distance coefficient R that the vehicle has reached the curve, it is considered that the vehicle has not reached the curve because the vehicle has not started to turn. Further, the degree that the distance coefficient R is larger than the true value can be estimated from the distance d in the figure that represents the distance between the point where the vehicle actually starts to turn and the curve start point o.
[0056]
Conversely, when the trajectory of the current position of the vehicle obtained from the travel distance in the traveling direction of the vehicle is a trajectory that starts to bend before reaching the intersection point o, the distance coefficient R is smaller than the true value. Can be estimated. This is because it is considered that the vehicle has already reached the curve o because the vehicle has started to bend before it is estimated using the distance coefficient R that the vehicle has reached the curve o. is there. Also in this case, the degree to which the distance coefficient R is smaller than the true value can be estimated from the distance error d in the figure representing the distance between the point where the vehicle actually starts to turn and the curve o.
[0057]
Accordingly, it is possible to determine the direction and degree of deviation from the true value of the distance coefficient R from d in the figure. Then, if the direction of deviation from the true value of the distance coefficient R and the degree thereof are known, it is determined whether the position calculated as the current position is a position delayed from the actual position or an advanced position. Can be estimated together with its degree. For example, if the distance coefficient R is smaller than a true value, the current position calculated and displayed can be estimated as a position delayed from the actual position, and if the distance coefficient R is larger than a true value, the calculated and displayed It can be estimated that the current position being advanced is a position advanced from the actual position. Further, it can be expected that the degree of delay advancement tends to be proportional to the amount of deviation from the true value of the distance coefficient R. That is, the calculated degree of delay advancement of the current position can be expected to be a value corresponding to the distance error d.
[0058]
Therefore, in the present embodiment, when the distance error d is detected in this way, the displayed current position is a position advanced or delayed from the actual position according to the value of the distance error d. It is determined whether it is. Further, a correction variable Rsh is introduced and a distance coefficient is defined by R = R0 × (1 + Rsh). Then, when the distance error d is calculated, the value corresponding to the distance error d is set to Rsh only for 300 m thereafter, and then Rsh = 0 until the distance error d is calculated next. The calculated and displayed current position is gradually adjusted to the correct position within 300 m after the calculation. Note that R0 may be an initial value of the distance coefficient, or may be a distance coefficient corrected by the above-described conventional technique. Note that R0 may be sequentially corrected according to the distance error d. This is because, as described above, the direction of the deviation from the true value of the distance coefficient R and its degree can be determined from the distance error d.
[0059]
In addition, from the difference between the direction of the vehicle and the road, it is assumed that the vehicle has started to bend before the vehicle has reached the curve o, or that the vehicle has reached the curve o before being estimated using the distance coefficient R. You may make it determine whether the vehicle started to bend after the time estimated using the distance coefficient R. In this case, the degree by which the distance coefficient R deviates from the true value can be obtained from the integrated value of the difference between the vehicle direction and the road direction. Therefore, in this case, the correction variable Rsh can be obtained from the integrated value of the difference between the vehicle direction and the road direction.
[0060]
The details of the process executed by the microprocessor 214 in order to correct the deviation of the display position of the current position from the actual position as described above will be described below.
[0061]
First, when the present apparatus is activated, first, as shown in FIG. 8, various parameters used in the subsequent processing are initialized. That is, the distance error d is set to 0, the correction variable Rsh is set to 0, and the correction execution distance l is set to 0.
[0062]
Thereafter, the process shown in FIG. 9 is executed every time the vehicle travels 20 m.
[0063]
In the process of FIG. 9, first, the travel distance and traveling direction calculated using 201, 202, and 203 are read into each sensor as sensor data (step 701). Next, the map data read from the CD-ROM 205 to the driver 206 is read (step 702).
[0064]
Next, the distance error d shown in FIG. 7 is obtained using the sensor data read in step 701 and the map data read in step 702 (step 703), and it is determined whether or not the obtained distance error d is zero. (Step 704), if it is 0, the process is terminated. On the other hand, if d is not 0, the correction variable Rsh is set (step 705) and the process is terminated.
[0065]
Hereinafter, the details of the processing of each step will be described.
[0066]
First, the process for calculating the distance error d in step 703 will be described.
[0067]
FIG. 10 shows the procedure of this process.
[0068]
As shown in the figure, in this process, first, it is determined whether or not the correction variable Rsh is 0 (step 801).
[0069]
If it is not 0, the previously obtained Rsh is still effective (since it has not traveled 300 m after calculating the previous distance error and Rsh), the distance error d for obtaining a new correction variable Rsh The process ends without performing the calculation. Accordingly, the distance error used for obtaining the correction variable Rsh last time is continuously maintained as the distance error d. Therefore, in this case, it is determined to be “yes” by the determination step of Step 704 in FIG. 9, and the Rsh setting process of Step 705 is executed.
[0070]
On the other hand, if it is 0, it is first determined whether or not the vehicle has turned left or right (step 802), whether or not a distance error exists (step 803), and if there is a distance error, The distance error d described above is calculated (step 804). However, at this time, the sign of the distance error d is negative when the vehicle goes around the curve, and the sign of the distance error d is positive when the vehicle goes around the curve.
[0071]
On the other hand, if the vehicle is not turning right or left, or if there is no distance error, the process is terminated.
[0072]
Next, the process for setting the correction variable Rsh in step 705 of FIG. 9 will be described.
[0073]
FIG. 11 shows a processing procedure for setting the correction variable Rsh.
[0074]
In this process, first, it is determined whether or not the distance correction variable Rsh is 0 (step 1101). If it is 0, since the previously obtained correction variable Rsh has already been reset, a new correction variable Rsh corresponding to the distance error d is obtained (step 1102).
[0075]
That is, the sign of the correction variable Rsh is determined according to the correspondence shown in FIG. 12, and the absolute value of the correction variable Rsh is obtained by multiplying the absolute value of the distance error d by a predetermined coefficient j.
[0076]
Finally, the correction execution distance l is initialized to 0 (step 1103), and the process ends.
[0077]
After this, the corrected execution distance l is the value that represents the travel distance after being initialized at step 1103 until the vehicle travels 300 m after being initialized at step 1103.
[0078]
On the other hand, if it is determined in step 1101 that the distance correction variable Rsh is not 0, the correction variable Rsh obtained last time is still valid, so it is determined whether or not the correction execution distance l is 300 m or less ( In step 1404), if it is 300 m or less, the value of the corrected execution distance l is updated to represent the travel distance after being initialized in step 1103 (step 1105).
[0079]
On the other hand, if it exceeds 300 m, the correction variable Rsh is reset to 0, the correction execution distance l is reset to 0, and the distance error d is reset to 0 (step 1106).
[0080]
When the distance error d is detected by the processing described above, the correction variable Rsh is obtained according to the value of the distance error d, and thereafter, the distance coefficient R is corrected by the obtained correction variable Rsh only for 300 m, and then Rsh is calculated. Reset to zero. Further, it is possible to prevent a new correction variable Rsh from being obtained during this 300 m.
[0081]
That is, when the correction variable Rsh is reset in the process of FIG. 9, the distance error d is obtained in step 703 (FIG. 10). If the obtained distance error d is not 0, a correction variable Rsh is obtained in step 705 (FIG. 11). However, when the correction variable Rsh has not been reset, a new distance error d is not obtained in the distance error d calculation process in step 703 in FIG. 9 (see step 801 in FIG. 10), and the distance used to obtain the previous Rsh. The error d continues to be maintained. Accordingly, when the correction variable Rsh is not reset, it is determined as yes in step 704 in FIG. 9, and only the correction execution distance l is updated in step 705 (FIG. 11) until the correction execution distance l reaches 300 m. . When 300 m is reached, the correction variable Rsh and the correction execution distance are reset in the same step. The update of the correction execution distance l and the correction variable Rsh and the correction execution distance are not reset when Rsh has already been reset.
[0082]
In this way, by correcting the distance coefficient R using the correction variable Rsh, the display of the current position on the map displayed on the display 207 by the above-described processing (FIGS. 3 to 5) is 300 m as described above. In the meantime, it gradually approaches the correct position little by little. Therefore, discontinuous jumping of the current position display and reverse return do not occur.
[0083]
【The invention's effect】
As described above, according to the present invention, there is provided a current position calculation device capable of correcting the display of the current position on the map represented on the display device so that the user can feel it more naturally. Can be provided.
[Brief description of the drawings]
FIG. 1 is a block diagram showing a configuration of a current position calculation apparatus according to an embodiment of the present invention.
FIG. 2 is a diagram showing a display example of a map and a current position performed in one embodiment of the present invention.
FIG. 3 is a flowchart showing a procedure for calculating a traveling direction and a distance performed in an embodiment of the present invention.
FIG. 4 is a flowchart showing a procedure of a current position calculation process performed in an embodiment of the present invention.
FIG. 5 is a flowchart showing a procedure of a current position display process performed in an embodiment of the present invention.
FIG. 6 is a diagram showing a road expression format in map data used in an embodiment of the present invention.
FIG. 7 is a diagram showing a distance error d used in one embodiment of the present invention.
FIG. 8 is a first flowchart showing a processing procedure for correcting a distance coefficient performed in an embodiment of the present invention.
FIG. 9 is a second flowchart showing a processing procedure for correcting a distance coefficient performed in an embodiment of the present invention.
FIG. 10 is a third flowchart showing a processing procedure for correcting a distance coefficient performed in an embodiment of the present invention.
FIG. 11 is a fourth flowchart showing a processing procedure for correcting a distance coefficient performed in an embodiment of the present invention.
FIG. 12 is a diagram showing a positive / negative relationship between a distance error d and a correction variable Rsh used in one embodiment of the present invention.
[Explanation of symbols]
201 Angular velocity sensor 202 Direction sensor 203 Vehicle speed sensor 204 Switch 205 CD-ROM
206 CD-ROM driver 207 Display 208 DMA controller 214 Microprocessor 215 Memory

Claims (3)

道路地図を表す地図データを記憶する地図データ記憶手段と、  Map data storage means for storing map data representing a road map;
所定期間毎に、距離係数を用いて車輪の回転数から前記車両の走行距離を算出する走行距離算出手段と、  Travel distance calculating means for calculating the travel distance of the vehicle from the number of rotations of the wheels using a distance coefficient for each predetermined period;
前記所定期間毎に、前記車両の進行方位を検出する進行方位検出手段と、  Traveling direction detecting means for detecting the traveling direction of the vehicle for each predetermined period;
前記走行距離算出手段により算出された走行距離、前記進行方位検出手段により検出された進行方位、および、前記地図データ記憶手段に記憶されている地図データを用いて、当該地図データが表す道路地図上における前記車両の現在位置を逐次算出する現在位置算出手段と、  On the road map represented by the map data using the travel distance calculated by the travel distance calculation means, the travel direction detected by the travel direction detection means, and the map data stored in the map data storage means Current position calculating means for sequentially calculating the current position of the vehicle at
前記現在位置算出手段により算出された現在位置が前記地図データが表す道路地図上に表した画像を表示する表示手段と、  Display means for displaying an image representing the current position calculated by the current position calculating means on the road map represented by the map data;
前記進行方位検出手段が検出する進行方位から前記車両の右左折を検出する右左折検出手段と、  A right / left turn detection means for detecting a right / left turn of the vehicle from a travel direction detected by the travel direction detection means;
前記地図データ記憶手段に記憶されている地図データを用いて、前記右左折検出手段により検出された右左折に対応する道路地図上の地点と、前記現在位置算出手段が算出した現在位置とのずれを表す距離誤差を算出する距離誤差算出手段と、  Using the map data stored in the map data storage means, the difference between the point on the road map corresponding to the right / left turn detected by the right / left turn detection means and the current position calculated by the current position calculation means Distance error calculating means for calculating a distance error representing
前記距離誤差算出手段で算出された距離誤差に応じた補正係数を算出する補正係数算出手段と、を有し、  Correction coefficient calculation means for calculating a correction coefficient according to the distance error calculated by the distance error calculation means,
前記走行距離算出手段は、  The travel distance calculating means includes
前記右左折検出手段により右左折が検出されてから前記走行距離算出手段が所定距離を算出するまでの間、前記距離係数および前記補正係数算出手段で算出した補正係数を用いて、車輪の回転数から前記車両の走行距離を算出し、  The number of rotations of the wheel using the distance coefficient and the correction coefficient calculated by the correction coefficient calculation means from when the right / left turn detection means is detected until the travel distance calculation means calculates a predetermined distance. To calculate the mileage of the vehicle from
前記走行距離算出手段が前記所定距離を算出してから前記右左折検出手段により右左折が新たに検出されるまでの間、前記距離係数を用いて、車輪の回転数から前記車両の走行距離を算出すること  From the time when the travel distance calculating means calculates the predetermined distance to the time when the right / left turn detection means newly detects a right / left turn, the travel distance of the vehicle is calculated from the rotational speed of the wheel using the distance coefficient. To calculate
を特徴とする現在位置算出装置。  A current position calculation device characterized by the above.
請求項1に記載の現在位置算出装置であって、  The current position calculation device according to claim 1,
前記距離係数は、固定値であること  The distance coefficient is a fixed value
を特徴とする現在位置算出装置。  A current position calculation device characterized by the above.
請求項1に記載の現在位置算出装置であって、  The current position calculation device according to claim 1,
前記距離係数は、前記距離誤差算出手段で算出された距離誤差に応じた値であること  The distance coefficient is a value corresponding to the distance error calculated by the distance error calculation means.
を特徴とする現在位置算出装置。  A current position calculation device characterized by the above.
JP09719895A 1995-04-21 1995-04-21 Method for correcting display position of current position in current position calculation device and current position calculation device Expired - Lifetime JP3679449B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP09719895A JP3679449B2 (en) 1995-04-21 1995-04-21 Method for correcting display position of current position in current position calculation device and current position calculation device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP09719895A JP3679449B2 (en) 1995-04-21 1995-04-21 Method for correcting display position of current position in current position calculation device and current position calculation device

Publications (2)

Publication Number Publication Date
JPH08292041A JPH08292041A (en) 1996-11-05
JP3679449B2 true JP3679449B2 (en) 2005-08-03

Family

ID=14185908

Family Applications (1)

Application Number Title Priority Date Filing Date
JP09719895A Expired - Lifetime JP3679449B2 (en) 1995-04-21 1995-04-21 Method for correcting display position of current position in current position calculation device and current position calculation device

Country Status (1)

Country Link
JP (1) JP3679449B2 (en)

Also Published As

Publication number Publication date
JPH08292041A (en) 1996-11-05

Similar Documents

Publication Publication Date Title
JP3578512B2 (en) Current position calculating device and distance coefficient correcting method thereof
JP3578511B2 (en) Current position calculation device
JP3545839B2 (en) Current position calculation device
JP3634006B2 (en) Current position calculation device
JP3679449B2 (en) Method for correcting display position of current position in current position calculation device and current position calculation device
JP3596939B2 (en) Current position calculation device
JP3679456B2 (en) Current position calculation device
JP3545838B2 (en) Current position calculation device
JP3596943B2 (en) Current position calculation system and current position calculation method
JP3599420B2 (en) Current position calculation device
JP3545798B2 (en) Current position calculation device
JP3732548B2 (en) Current position calculation device and distance coefficient correction method thereof
JP3545837B2 (en) Current position calculation device
JP3656662B2 (en) Current position calculation device
JP3679451B2 (en) Current position calculation device
JP3672351B2 (en) Current position calculation device and distance coefficient correction method thereof
JP3569028B2 (en) Current position calculation device
JP3596941B2 (en) Current position calculation device
JP3587904B2 (en) Current position calculation device
JP3599421B2 (en) Current position calculation device
JP3764508B2 (en) Current position calculation system and current position calculation method
JP3573526B2 (en) Current position calculation device
JP3596944B2 (en) Current position calculation system and current position calculation method
JP3599423B2 (en) Current position calculation device
JP3660392B2 (en) Current position calculation system and current position calculation method

Legal Events

Date Code Title Description
A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20040531

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20040706

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20040824

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20050105

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20050119

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20050513

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090520

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130520

Year of fee payment: 8

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130520

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 (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130520

Year of fee payment: 8

R371 Transfer withdrawn

Free format text: JAPANESE INTERMEDIATE CODE: R371

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130520

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 (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130520

Year of fee payment: 8

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140520

Year of fee payment: 9

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

EXPY Cancellation because of completion of term