JP3698002B2 - Vehicle position detection device - Google Patents
Vehicle position detection device Download PDFInfo
- Publication number
- JP3698002B2 JP3698002B2 JP2000076199A JP2000076199A JP3698002B2 JP 3698002 B2 JP3698002 B2 JP 3698002B2 JP 2000076199 A JP2000076199 A JP 2000076199A JP 2000076199 A JP2000076199 A JP 2000076199A JP 3698002 B2 JP3698002 B2 JP 3698002B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- road
- current position
- contact information
- storage means
- 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)
- Position Fixing By Use Of Radio Waves (AREA)
- Instructional Devices (AREA)
- Navigation (AREA)
Description
【0001】
【発明の属する技術分野】
本発明は、主に駐車場等の道路外や地図データに記録されていない道路を走行する際においても現在位置を精度良く求めるために利用される車両位置検出装置に関するものである。
【0002】
【従来の技術】
従来の車両位置検出装置として、例えば特開平2−198317号公報に示されているものがある。この車両位置検出装置は、GPS(Global Positioning System)から得られる絶対位置・絶対方位を基準に車速センサから算出した移動距離、およびジャイロ等の方位センサから算出した方位変化量を用いて推定される車両の推測現在位置を、地図データに記憶された道路データ上に修正することにより、車両の道路上の位置を算出するものである。
【0003】
また、駐車場内での車両位置を算出するものとして、例えば特開平10−197268号公報に示されているものがある。この車両位置検出装置は地図データに駐車場入口ノードと駐車場出口ノードを予め記憶しておき、車両の走行状態として、
(a)車両の速度が進入時に一定速度以下、脱出時に一定速度以上、
(b)車両位置が進入時に入口、脱出時に出口から一定の範囲以内、
(c)右折又は左折、
の条件を満たすときに駐車場に進入、あるいは脱出したと判断するものであり、車両が駐車場に進入してから脱出するまで、すなわち駐車場内を走行中には道路上に車両位置を算出する処理を行わないようにし、道路の存在しない領域において車両現在位置が道路上に誤って修正されることを防止するものである。
【0004】
【発明が解決しようとする課題】
このような従来の技術による車両位置検出装置においては、車両が道路上を走行している場合にはその現在位置を精度良く求めることができる。しかしながら、駐車場や地図データに記録されていない道路を走行した場合には、車両の現在位置が地図データに記憶されている道路上に修正されてしまうため、現在位置が誤った位置として検出される場合がある。
【0005】
また、地図データに駐車場入口ノードと駐車場出口ノードを予め記憶しておく場合においても、地図データを更新しなければ新たな駐車場や新設道路に対応させることができないという課題がある。
【0006】
また、道路外の走行区間を、道路外区間手前から走行方向にパターンマッチング等を用いて入口出口を抽出しようとしても、センサの誤差等で出口をうまく抽出できない場合が多いという課題もある。
【0007】
【課題を解決するための手段】
上記の課題を解決するために、本願の請求項1記載の発明は、車両の進行方位を検出する方位センサと、車両の走行距離を検出する距離センサと、前記方位センサで検出した進行方位と前記距離センサで検出した走行距離を用いて車両の走行軌跡および車両の推測現在位置を算出する現在位置推測手段と、道路データを記憶する地図記憶手段と、現在位置推測手段によって算出された車両の走行軌跡および車両の推測現在位置と前記地図記憶手段に記憶された道路データの整合性を判定することによって地図記憶手段に記憶されている道路データ上を走行中か否かを判断する道路外走行判定手段と、道路外走行判定手段によって車両が道路データ外を走行していると判断された場合には現在位置推測手段で算出された推測現在位置を車両現在位置として出力し、道路データ上を走行していると判断された場合には前記現在位置推測手段により算出された走行軌跡および推測現在位置を用いて前記地図記憶手段に記憶された道路データ上に車両現在位置を算出した結果を車両現在位置として出力する現在位置算出手段と、地図記憶手段に記憶されている道路データと道路データとして記録されていない領域を接続するための接点情報を記憶する接点情報記憶手段と、地図記憶手段に道路データとして記憶されていない領域を車両が走行した場合に接点情報を自動的に生成する接点情報自動生成手段を備え、道路外走行判定手段が接点情報記憶手段に記憶された接点情報を利用して道路データに記憶されていない領域の走行を判断するとともに、接点情報自動生成手段によって生成された接点情報を接点情報記憶手段に記憶することを特徴とするものである。
【0013】
本願の請求項2記載の発明は、接点情報自動生成手段が道路外走行判定手段によって算出される地図記憶手段に記憶されている道路データと現在位置推測手段によって算出された車両の走行軌跡および車両の推測現在位置との整合度合いから前記地図記憶手段に記憶されている道路データと道路データとして記憶されていない領域の接点を抽出することを特徴とするものである。
【0014】
本願の請求項3記載の発明は、道路外走行判定手段によって算出される車両が地図記憶手段に道路データとして記憶されていない領域に入る前の道路データと車両走行軌跡の整合関係を用いて接点情報自動生成手段が前記地図記憶手段に道路データとして記憶されていない領域への進入点を求め、接点情報とすることを特徴とするものである。
【0015】
本願の請求項4記載の発明は、道路外走行判定手段によって算出される車両が地図記憶手段に道路データとして記憶されていない領域を脱出後の前記地図記憶手段に記憶されている道路データと車両走行軌跡の整合関係を用いて接点情報自動生成手段が前記地図記憶手段に道路データとして記憶されていない領域からの脱出点を求め、接点情報とすることを特徴とするものである。
【0016】
本願の請求項5記載の発明は、前記地図記憶手段に記憶されている道路データと車両走行軌跡の整合度の高い領域を基準にして、前記地図記憶手段に記憶されている道路データと車両走行軌跡の整合関係を調べることを特徴とするものである。
【0019】
【発明の実施の形態】
以下、本発明の実施の形態における車両位置検出装置について、図面を参照しながら説明する。
【0020】
図1は、本発明の実施の形態における車両位置検出装置の基本構成を示すブロック構成図である。本図において、101は振動ジャイロ等に代表される方位検出手段であり、102は車速センサ等に代表される距離検出手段である。103は現在位置推測手段であり、方位検出手段101および距離検出手段102から得られる情報を基に、車両の走行軌跡および推測現在位置を算出する。ここで現在位置推測手段103への入力として、更にGPS等の絶対位置や方位の検出手段を加えることもできる。104は地図記憶手段であり、CD−ROMやDVD、ハードディスク等のメディアに道路データを含む地図データを記憶させたものである。105は道路外走行判定手段であり、現在位置推測手段103で算出される車両の走行軌跡および推測現在位置と、地図記憶手段104に記憶された道路データとの整合性から車両が道路外を走行しているかどうかを判断する。また道路外走行判定手段105は後述する接点情報記憶手段107に記憶された接点情報も利用する。106は地図記憶手段104に記憶されている道路データと道路外領域の接続地点に関する接点情報を生成する接点情報自動生成手段であり、生成された接点情報は接点情報記憶手段107に記憶される。ここで、接点情報記憶手段107には、大きな駐車場の出入り口等、予め代表的な接点情報を記憶させておくこともできる。108は現在位置算出手段であり、現在位置推測手段103で算出される車両の走行軌跡および推測現在位置と地図記憶手段104に記憶された道路データから道路上の車両現在位置を算出するとともに、道路外走行判定手段105で道路外走行と判定されている場合においては現在位置推測手段103で算出される車両の推測現在位置を車両の現在位置として出力するものである。
【0021】
上述した構成による本実施形態の車両位置検出装置の動作について、図2に示すフローチャートを用いて説明する。
【0022】
まず、当該車両位置検出装置が起動されると前回の使用で最後に出力された現在位置が車両現在位置の初期値としてセットされる。ここで、GPS等の絶対位置取得手段を利用することにより初期値となる車両現在位置を補正する、あるいはユーザにリモコン等からの位置補正の手段を与えて初期値を補正させるようにしても良い。また、前回、検出装置が停止された際に車両の走行軌跡等が保存されている場合にはそのデータも読み出しておく。
【0023】
次にステップ201において走行ベクトル検出処理が行われる。この処理では、振動ジャイロ等の方位検出手段101から得られる車両の進行方位および車速センサ等の距離検出手段102から得られる車両の移動距離を用い、車両現在位置の移動量が求められる。
【0024】
次にステップ202に進み、現在位置推測手段103における走行軌跡・推測現在位置算出処理が行われる。この処理では、ステップ201で検出された車両の走行ベクトルを用いて車両の走行軌跡および車両の推測現在位置が算出される。図3に走行ベクトル、および走行ベクトルを用いて算出される車両の推測現在位置の例を示す。図3において、P(0)は1つ前の車両推測現在位置であり、V(0,1)は方位検出手段101で得られた方位と距離検出手段102で得られた距離を持つ走行ベクトルである。この例の場合、P(0)からV(0,1)移動した先のP(1)が新しい車両推測現在位置となり、V(0,1)自体もこの間における車両走行軌跡となる。
【0025】
次にステップ203に進み、車両が道路外走行中かどうかが判断され、道路外走行中でなければステップ204に進み、道路外走行中であればステップ206に進む。
【0026】
ステップ204および206では道路外走行判定手段105による道路外走行判定処理が行われる。この道路外走行の判定は地図記憶手段104から読み出された道路データとステップ202で算出される車両走行軌跡の整合性を用いて行われる。これについて、図4に示した車両走行軌跡と道路データの関係を用いて両者の整合性を求める処理について説明する。
【0027】
図4においてP(0)からP(18)は現在位置推測手段103によって算出された一連の推測現在位置であり、V(0,1)からV(17,18)はその間の走行ベクトルすなわち走行軌跡を表している。また、R1およびR2は地図記憶手段104から読み出された周辺の道路データ、M(0)からM(18)は本装置から出力される車両現在位置である。ここで、整合性を判定する相関係数Sは、道路Raの方位をθ(Ra)、V(a,b)の方位をθ(a,b)、V(a,b)から道路Raまでの距離をL(Ra,a,b)とすると、
S(Ra,a,b)=A・|θ(Ra)−θ(a,b)| + B・L(Ra,a,b) …(式1)
として定義することができる。AおよびBは任意に設定された定数である。なお、この相関係数は道路データと走行軌跡の方位差および距離を考慮した他の関係式で表現することも可能である。ここで、相関係数に対して本装置に好ましい動作を実行させる任意の閾値Sthを設定することにより、
S(Ra,a,b)< Sth …(式2)
の条件を満たす場合に道路データと車両走行軌跡に整合性ありと判定させることが可能である。図4に示した例においては、V(0,1)からV(3,4)およびV(5,6)とV(13,14)からV(17,18)が道路データと走行軌跡に整合性がある区間となる。ここで車両の走行状態として、V(0,1)からV(3,4)およびV(13,14)からV(17,18)のように連続して整合性がある区間の走行状態を安定整合状態、V(4,5)からV(6,7)のように整合性判定が一定でない区間の走行状態を不安定整合状態、V(7,8)からV(12,13)のように連続して整合性が無い区間の走行状態を非整合状態と定義すると、車両の走行状態が非整合状態にある場合を道路外走行、安定整合状態にある場合を道路上走行と判定させることが可能である。また、周辺に予め接点情報記憶手段107に記憶された接点情報が存在する場合には、車両の推測現在位置あるいは装置から出力される車両の現在位置と車両の進行方向を接点情報と比較することで、上記のような相関係数を求めることなく道路外走行への移行または道路外走行からの脱出を判定させることもできる。
【0028】
次に、ステップ204からはステップ205に、ステップ206からはステップ207に進み、ステップ205で道路外走行中の場合にはステップ208に、道路外走行中でない場合にはステップ211に、ステップ207で道路外走行中の場合にはステップ212に、道路外走行中でない場合にはステップ208に各々進む。
【0029】
ステップ208では、今回の走行における道路外走行移行および道路外走行脱出に関する接点情報が既に接点情報記憶手段107に記憶されているかどうかが判断され、接点情報が存在しない場合にはステップ209に進み、存在する場合にはステップ210に進む。
【0030】
ステップ209では、接点情報自動生成手段106による接点情報生成記憶処理が行われる。図5および図6に道路外走行移行時における接点情報生成の説明図、図7および図8に道路外走行脱出時における接点情報生成の説明図を示す。各図において、R1、R2は地図記憶手段104から読み出された周辺の道路データ、P(0)からP(11)は車両の推測現在位置、V(0,1)からV(10,11)は車両の走行ベクトルすなわち走行軌跡を示している。
【0031】
まず、図5および図6を用いて道路外走行移行時における接点情報生成処理について説明する。図5において、走行軌跡V(1,2)からV(7,8)まではステップ204において安定整合状態、V(8,9)からV(10,11)までは同様に非整合状態と判断される。この例の場合、V(0,1)からV(3,4)までは道路データR1と整合し、V(4,5)からV(7,8)までは道路データR2と整合している。そこで、各々の走行軌跡列を整合する道路データ上に重ねるように全体の走行軌跡列を移動させる。重ね合わせる時の基準点は安定整合状態である走行軌跡V(1,2)からV(7,8)までの各走行ベクトルで最も相関性Sの高い、すなわち整合性が良い走行ベクトルの位置とする。本実施例ではV(1,2)が最も整合性が良いベクトルと仮定としP(1)を基準点とする。
【0032】
走行軌跡列移動後の結果を示したものが図6である。この例の場合、P’(8)が安定整合状態から非整合状態への移行点となるため、P’(8)が接点位置、V(8,9)の方位が道路データと道路外領域の関係、すなわち道路上から道路外への進入方位を表す情報となる。この例ではP’(8)が道路データR2上から離れた走行ベクトル上にある場合を想定しているが、走行軌跡列移動後の安定整合状態から非整合状態への移行点となる推測現在位置が道路データ上から外れている場合には、この例のように近似位置として道路外の移行点位置を接点位置としても良いし、走行軌跡列が整合している道路データ上で移行点からの距離が最も近い点を接点位置とすることもできる。また、方位は道路データに対して、どちらの方向に道路外領域が存在するかを知る情報となる。このように生成された接点位置と進入方位から成る情報は接点情報として接点情報記憶手段107に記憶される。
【0033】
次に図7および図8を用いて道路外走行脱出時の接点情報生成処理について説明する。この場合も道路外走行移行時と同様、車両の走行軌跡列のうちで安定整合状態になっている部分に基準点を設定し、整合する道路データ上に重なるように全体の走行軌跡列を移動させる。図7のP(10)を基準点と仮定した場合、走行軌跡列を整合する道路データ上に移動させたものが図8である。ここで道路外走行移行時と異なるのは、道路外走行移行時には道路外走行前の走行軌跡列が安定整合状態となり、道路データと整合するのに対し、道路外走行脱出時には道路外走行後の走行軌跡列が安定整合状態となることである。またこの例では、P’(4)が非整合状態から安定整合状態への移行点となるため、P’(4)が接点位置、V(3,4)の逆方位が道路データと道路外領域の関係、すなわち道路外からの脱出逆方位となる。ここでは同じ地点での進入と脱出を一つのデータで表現できるように走行ベクトルの逆方位を用いたが、脱出専用情報として脱出時の方位をそのまま用いることも可能である。またこの例においては移行点となる推測現在位置が道路データ上にある場合を示したが、移行点に対応する推測現在位置が道路データ上にない場合に関しても道路外走行移行時と同様の扱いが可能である。このように生成された接点位置と脱出逆方位から成る情報はまた、上記と同様に接点情報として接点情報記憶手段107に記憶される。
【0034】
次にステップ210に進み、道路外走行中でない場合にはステップ211、道路外走行中の場合にはステップ212に進む。このステップ210での道路外走行か否かの判定は、上記道路データと車両走行軌跡の整合性による判定に加えて、接点情報が存在しそれを利用して道路外走行を行っている場合、車両が道路を跨いだか否かの判定も加わる。
【0035】
図12に道路を跨いだ状態の時の例を示す。図12中のR2が道路データであり、現在位置がP(n)からP(n+1)に移動したときの走行ベクトルV(n,n+1)で表されており、R2とV(n,n+1)の関係から跨いだか否かの判断を行う。接点情報について道路外走行進入時と脱出時が対応して記憶されているとすれば、道路外走行中に脱出地点となる接点の位置がわかり、道路を跨いだ場合は、図13に示すように現在位置から道路外走行時の接点を結ぶ方位と、進行方位がセンサの特性から見積もられる方位誤差範囲内におさまっている場合を除いて、道路外から脱出したすなわち道路外走行でないとみなす。
【0036】
図13では、地図に記録されていない新設道路nR1を道路外走行移行時の接点Ex1から脱出時の接点Ex2に向かって走行している場合を例にあげており、現在位置P(n)がR2を跨いだ時、進行方位を軸とした方位誤差範囲Errdir1以内にEx2が存在する場合を示している。図14は道路を跨いだと判断される場合の例を示しており、現在位置P(n)がR2を跨いだ時、進行方位を軸とした方位誤差範囲Errdir1以内にEx2が存在しない場合を示している。
【0037】
図15はセンサの誤差により走行軌跡が歪んだ時の道路外走行の例を示している。図15に示すように、道路R1上に存在する接点Ex1(道路外走行移行点)から道路外走行を行い接点Ex2(道路外走行脱出点)から道路上に戻るような走行軌跡r1が、センサの誤差等でLc1のような走行軌跡に歪んだ時も、R2上を現在位置が跨ぐことにより道路外走行を中止することができるので、センサの誤差等で現在位置がずれた時に道路と走行軌跡の整合性だけでは道路外走行から脱出できなくなる状態を防ぐことができる。
【0038】
ステップ211では現在位置算出手段108による道路上位置算出処理が行われる。この処理は、現在の推測現在位置から対応する道路上の最も近い位置を求め、その点を道路上の車両現在位置とすることで実現できる。また、一般的なカーナビゲーションシステムで用いられているような道路データと走行軌跡および推測現在位置等の関係から動的に道路上の車両位置を求めるマップマッチングと呼ばれる手法を利用して道路上の車両現在位置を算出することもできる。
【0039】
最後にステップ212では、現在位置算出手段108が道路上走行時にはステップ211で算出された道路上の車両現在位置、道路外走行時にはステップ202で算出された車両の推測現在位置を現在の車両現在位置として出力し、ステップ201に戻り一連の処理を繰り返す。図4に示した例の場合、P(0)からP(7)およびP(14)からP(18)が道路上走行と判定される区間であり、各々に対応してステップ211で算出される道路上現在位置がM(0)からM(7)およびM(14)からM(18)、P(8)からP(13)が道路外走行と判定される区間であり、M(8)からM(13)がステップ202で算出された推測現在位置となり、M(0)からM(18)が車両現在位置として出力される。
【0040】
本実施の形態では、非整合状態の区間の両端を示す各接続点情報を道路外走行移行時と道路外走行脱出時に分けて生成する方法を例にあげた。図9はジャイロセンサ等の方位誤差、車速センサの距離誤差がなかった場合の理想的な道路上および道路外の走行例を示している。このような理想的な走行が実現されると、例えばP(0)の位置を基準として走行軌跡と道路の整合性をP(12)の位置まで調べることにより、一度にP(4)とP(9)の位置に接点情報を求めることができる。しかし、実際には図10に示すようにジャイロセンサ等の方位誤差、車速センサの距離誤差が必ず生じ、道路外領域の区間では走行軌跡が歪むことが多い。道路外領域で歪みが多いというのは、道路上の走行中も当然センサ自体の出力に誤差は生じているが、通常道路上では走行ベクトルを道路方位に補正するような処理を一般に行い、歪みが補正されているためこのような表現をしている。従って、実際には図10に示すような走行軌跡では、道路外走行脱出地点である接点P(9)の抽出は困難である。
【0041】
そこで本実施の形態では、図10に示すように、道路外走行時に例えばP(0)を基準点として道路と走行軌跡の整合性を調べ、道路外走行移行時の接点P(4)を抽出し、その後、図11に示すように道路外走行が終了された時に、例えばP(12)を基準点として走行ベクトルの方向とは逆方向に道路と走行軌跡の整合性を調べて、道路外走行脱出時の接点P(9)を抽出出来るようにしてセンサの誤差による走行軌跡の歪みに対する問題を解決していることが特徴である。
【0042】
【発明の効果】
以上の説明より明らかなように、本願請求項1記載の発明によれば、道路外走行時には道路上への車両現在位置の移動を行わないことにより、駐車場や新設道路等の道路データ外の領域を走行した場合においても正確な車両現在位置を算出することが可能となる。
【0043】
また本願請求項2記載の発明によれば、記憶された接点情報を利用して道路外走行の判定を行うことができるため、容易に道路外走行の判定を行い、正確な車両現在位置を算出することができる。
【0044】
また本願請求項3記載の発明によれば、予め一般的な接点情報を持たせておくことにより、新規に装置を用いた場合においても正確な車両現在位置を算出することができる。
【0045】
また本願請求項4記載の発明によれば、予め記憶されていない接点情報を追加して利用することができるため、正確な車両現在位置を算出することができる。
【0046】
また本願請求項5および請求項6記載の発明によれば、接点情報として位置や方位を用いることにより、車両の走行状態から容易に道路外走行を判定することができるため、正確な車両現在位置を算出することができる。
【0047】
また本願請求項7〜10記載の発明によれば、車両の走行軌跡と道路データの整合性を利用して接点情報を生成するため、精度良く接点情報を生成することができ、それを利用して正確な車両現在位置を算出することができる。
【0048】
また本願請求項11記載の発明によれば、道路データと走行軌跡の整合性を用いて道路外走行から道路データ上の走行への移行を判定するため、安定した判定を行うことが可能であり、正確な車両現在位置を算出することができる。
【0049】
また本願請求項12記載の発明によれば、走行軌跡が道路データを跨いだことによって道路外走行から道路データ上の走行への移行を判定するため、道路外走行から曲折することなく道路データ上に復帰した場合においても正確な車両現在位置を算出することができる。
【図面の簡単な説明】
【図1】本発明の実施の形態における車両位置検出装置の基本構成を示すブロック図
【図2】本実施の形態における車両位置検出装置の動作を示すフローチャート
【図3】走行ベクトルおよび走行ベクトルを用いて算出された車両の推測現在位置を示す図
【図4】車両の走行軌跡と道路データの関係を用いてそれらの整合性を求める処理について説明する図
【図5】道路外走行移行時における接点情報生成を説明する図
【図6】道路外走行移行時における接点情報生成を説明する図
【図7】道路外走行脱出時における接点情報生成を説明する図
【図8】道路外走行脱出時における接点情報生成を説明する図
【図9】センサ誤差のない理想的な走行軌跡の場合における接点情報生成を説明する図
【図10】センサ誤差等により歪んだ走行軌跡の場合における接点情報生成を説明する図
【図11】センサ誤差等により歪んだ走行軌跡の場合における道路外走行脱出時の接点情報生成を説明する図
【図12】走行ベクトルが道路データを跨いだ状態を説明する図
【図13】道路を跨いだ時の道路外走行か否かの判断を説明する図
【図14】道路を跨いだ時の道路外走行か否かの判断を説明する図
【図15】センサ誤差等により走行軌跡が歪んだ場合の道路外走行状態を説明する図
【符号の説明】
101 方位検出手段
102 距離検出手段
103 現在位置推測手段
104 地図記憶手段
105 道路外走行判定手段
106 接点情報自動生成手段
107 接点情報記憶手段
108 現在位置算出手段[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a vehicle position detection device that is used to obtain a current position with high accuracy even when traveling outside a road such as a parking lot or on a road that is not recorded in map data.
[0002]
[Prior art]
As a conventional vehicle position detection device, for example, there is one disclosed in Japanese Patent Laid-Open No. 2-198317. This vehicle position detection apparatus is estimated using a moving distance calculated from a vehicle speed sensor based on an absolute position and an absolute direction obtained from GPS (Global Positioning System), and a direction change amount calculated from a direction sensor such as a gyro. The position of the vehicle on the road is calculated by correcting the estimated current position of the vehicle on the road data stored in the map data.
[0003]
Moreover, as what calculates the vehicle position in a parking lot, there exist some which are shown by Unexamined-Japanese-Patent No. 10-197268, for example. This vehicle position detection device stores a parking lot entrance node and a parking lot exit node in advance in the map data, and as a running state of the vehicle,
(A) Vehicle speed is below a certain speed when entering, above a certain speed when exiting,
(B) The vehicle position is within a certain range from the entrance when entering and from the exit when exiting,
(C) Turn right or left,
It is determined that the vehicle has entered or exited the parking lot when the condition is satisfied, and the vehicle position is calculated on the road until the vehicle exits after entering the parking lot, that is, while traveling in the parking lot. The processing is not performed, and the vehicle current position is prevented from being erroneously corrected on the road in an area where no road exists.
[0004]
[Problems to be solved by the invention]
In such a conventional vehicle position detection device, when the vehicle is traveling on a road, the current position can be obtained with high accuracy. However, when driving on a road that is not recorded in the parking lot or the map data, the current position of the vehicle is corrected on the road stored in the map data, so the current position is detected as an incorrect position. There is a case.
[0005]
Further, even when the parking lot entrance node and the parking lot exit node are stored in advance in the map data, there is a problem that it is not possible to correspond to a new parking lot or a new road unless the map data is updated.
[0006]
In addition, there is also a problem that there are many cases where the exit cannot be successfully extracted due to a sensor error or the like even when trying to extract the entrance and exit of the traveling section outside the road by using pattern matching or the like in the traveling direction from before the section outside the road.
[0007]
[Means for Solving the Problems]
In order to solve the above-mentioned problem, the invention according to
[0013]
In the invention according to
[0014]
The invention according to
[0015]
In the invention according to
[0016]
The invention according to
[0019]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, a vehicle position detection apparatus according to an embodiment of the present invention will be described with reference to the drawings.
[0020]
FIG. 1 is a block configuration diagram showing a basic configuration of a vehicle position detection apparatus according to an embodiment of the present invention. In this figure, 101 is an azimuth detecting means represented by a vibrating gyroscope and the like, and 102 is a distance detecting means represented by a vehicle speed sensor and the like.
[0021]
The operation of the vehicle position detection apparatus of the present embodiment having the above-described configuration will be described using the flowchart shown in FIG.
[0022]
First, when the vehicle position detection device is activated, the current position output last in the previous use is set as the initial value of the vehicle current position. Here, the current vehicle position that is an initial value may be corrected by using an absolute position acquisition unit such as GPS, or the initial value may be corrected by providing the user with a position correction unit from a remote controller or the like. . In addition, when the travel locus of the vehicle is stored when the detection device is stopped last time, the data is also read out.
[0023]
Next, in
[0024]
Next, the process proceeds to step 202, where a running locus / estimated current position calculation process in the current position estimating means 103 is performed. In this process, the travel locus of the vehicle and the estimated current position of the vehicle are calculated using the travel vector of the vehicle detected in
[0025]
Next, the routine proceeds to step 203, where it is determined whether or not the vehicle is traveling outside the road. If it is not traveling outside the road, the routine proceeds to step 204. If it is traveling outside the road, the routine proceeds to step 206.
[0026]
In
[0027]
In FIG. 4, P (0) to P (18) are a series of estimated current positions calculated by the current position estimating means 103, and V (0,1) to V (17,18) are traveling vectors, that is, traveling. It represents a trajectory. Further, R1 and R2 are the surrounding road data read from the map storage means 104, and M (0) to M (18) are the current vehicle positions output from this apparatus. Here, the correlation coefficient S for determining the consistency is that the direction of the road Ra is θ (Ra), the direction of V (a, b) is θ (a, b), and V (a, b) to the road Ra. Let L (Ra, a, b) be the distance of
S (Ra, a, b) = A · | θ (Ra) −θ (a, b) | + B · L (Ra, a, b) (Formula 1)
Can be defined as A and B are arbitrarily set constants. This correlation coefficient can also be expressed by another relational expression that takes into account the azimuth difference and distance between the road data and the travel locus. Here, by setting an arbitrary threshold value Sth that causes the apparatus to execute a preferable operation on the correlation coefficient,
S (Ra, a, b) <Sth (Formula 2)
When the above condition is satisfied, it is possible to determine that the road data and the vehicle travel locus are consistent. In the example shown in FIG. 4, V (0,1) to V (3,4) and V (5,6) and V (13,14) to V (17,18) are the road data and the traveling locus. This is a consistent section. Here, as the running state of the vehicle, the running state of a continuously consistent section, such as V (0,1) to V (3,4) and V (13,14) to V (17,18), is used. A stable matching state, a running state in a section where consistency judgment is not constant, such as V (4,5) to V (6,7), is an unstable matching state, and V (7,8) to V (12,13). In this way, when the running state of a section having no consistency is defined as an inconsistent state, it is determined that the vehicle traveling state is in an inconsistent state when the vehicle is in an out-of-road state, and the stable traveling state is determined as in-road traveling. It is possible. If contact information stored in the contact information storage means 107 is present in the vicinity, the current estimated position of the vehicle or the current position of the vehicle output from the device and the traveling direction of the vehicle are compared with the contact information. Thus, it is possible to determine the transition to the off-road driving or the escape from the off-road driving without obtaining the correlation coefficient as described above.
[0028]
Next, the process proceeds from
[0029]
In
[0030]
In
[0031]
First, the contact point information generation process at the time of traveling off-road will be described with reference to FIGS. 5 and 6. In FIG. 5, it is determined in
[0032]
FIG. 6 shows the result after the travel locus train is moved. In this example, since P ′ (8) is a transition point from the stable alignment state to the non-alignment state, P ′ (8) is the contact position, and the direction of V (8,9) is the road data and the outside road area. Information, that is, information indicating the approach direction from the road to the outside of the road. In this example, it is assumed that P ′ (8) is on a travel vector that is distant from the road data R2, but the estimated current point that is a transition point from the stable alignment state to the non-alignment state after the travel locus sequence is moved. If the position deviates from the road data, the transition position outside the road may be used as the contact position as an approximate position as in this example, or from the transition point on the road data where the traveling locus sequence matches. The point with the shortest distance can be the contact position. The direction is information for knowing in which direction the area outside the road exists with respect to the road data. Information including the contact position and the approach direction generated as described above is stored in the contact information storage means 107 as contact information.
[0033]
Next, the contact information generation process at the time of exiting from the road traveling will be described with reference to FIGS. In this case as well, as in the case of transition to off-road driving, a reference point is set in a portion of the vehicle travel trajectory that is in a stable alignment state, and the entire travel trajectory train is moved so as to overlap the road data to be matched. Let Assuming that P (10) in FIG. 7 is a reference point, FIG. 8 shows a case where the traveling locus sequence is moved onto the matching road data. Here, the difference from when traveling outside the road is that when traveling outside the road, the trajectory sequence before traveling outside the road is in a stable and consistent state, and is consistent with the road data. That is, the traveling locus train is in a stable alignment state. In this example, P ′ (4) is a transition point from the non-alignment state to the stable alignment state. Therefore, P ′ (4) is the contact position, and the reverse direction of V (3,4) is the road data and the road outside. It is the relationship between areas, that is, the reverse direction of escape from the road. Here, the reverse direction of the travel vector is used so that the entry and exit at the same point can be expressed by one data, but it is also possible to use the direction at the time of exiting as the exit-only information. Also, in this example, the case where the estimated current position serving as the transition point is on the road data is shown, but the case where the estimated current position corresponding to the transition point is not present on the road data is handled in the same way as when traveling outside the road. Is possible. The information including the contact position and the escape reverse direction generated in this way is also stored in the contact information storage means 107 as contact information in the same manner as described above.
[0034]
Next, the process proceeds to step 210. If the vehicle is not traveling on the road, the process proceeds to step 211. If the vehicle is traveling on the road, the process proceeds to step 212. In the determination of whether or not the vehicle is traveling outside the road in
[0035]
FIG. 12 shows an example when the vehicle straddles a road. R2 in FIG. 12 is road data, which is represented by a travel vector V (n, n + 1) when the current position moves from P (n) to P (n + 1), and R2 and V (n, It is determined whether or not it is straddled from the relationship of (n + 1). If contact information is stored corresponding to the time when the vehicle enters and exits from the road, the position of the contact point that becomes the escape point during driving outside the road is known, and when crossing the road, as shown in FIG. In other words, it is assumed that the vehicle has escaped from outside the road, that is, the vehicle is not traveling outside the road, unless the direction connecting the contact point when traveling off the road from the current position and the traveling direction are within the azimuth error range estimated from the sensor characteristics.
[0036]
In FIG. 13, the case where the new road nR1 not recorded on the map is traveling from the contact point Ex1 at the time of the off-road travel toward the contact point Ex2 at the time of exit is taken as an example, and the current position P (n) is When R2 is straddled, Ex2 is present within the azimuth error range Errdir1 with the traveling azimuth as an axis. FIG. 14 shows an example of a case where it is determined that the vehicle has crossed the road. When the current position P (n) crosses R2, the case where Ex2 does not exist within the azimuth error range Errdir1 with the traveling direction as an axis is shown. Show.
[0037]
FIG. 15 shows an example of off-road travel when the travel locus is distorted due to a sensor error. As shown in FIG. 15, a travel locus r1 that travels outside the road from a contact point Ex1 (external road transition point) on the road R1 and returns to the road from a contact point Ex2 (extra road exit point) is a sensor. Even when the travel path is distorted like Lc1 due to an error in the vehicle, it is possible to stop driving off the road by straddling the current position on R2, so when the current position shifts due to a sensor error, etc. It is possible to prevent a situation where it is impossible to escape from off-road driving only by the consistency of the trajectory.
[0038]
In
[0039]
Finally, in
[0040]
In the present embodiment, an example is given of a method of generating each connection point information indicating both ends of a section in an inconsistent state separately when traveling outside the road and when exiting the road traveling. FIG. 9 shows an example of traveling on the ideal road and off the road when there is no azimuth error of the gyro sensor or the like and no distance error of the vehicle speed sensor. When such ideal travel is realized, for example, by checking the consistency between the travel locus and the road to the position P (12) with reference to the position P (0), P (4) and P Contact information can be obtained at the position (9). However, in practice, as shown in FIG. 10, an orientation error of a gyro sensor or the like and a distance error of a vehicle speed sensor always occur, and the traveling locus is often distorted in an area outside the road. The fact that there is a lot of distortion in the area outside the road is that there is naturally an error in the output of the sensor itself while driving on the road, but on normal roads, processing such as correcting the driving vector to the road direction is generally performed and the distortion is This is because it is corrected. Therefore, in practice, it is difficult to extract the contact point P (9) that is the off-road traveling escape point on the traveling locus as shown in FIG.
[0041]
Therefore, in the present embodiment, as shown in FIG. 10, when the vehicle travels outside the road, for example, P (0) is used as a reference point to check the consistency between the road and the travel trajectory, and the contact point P (4) at the time of traveling outside the road is extracted. Then, when the off-road driving is terminated as shown in FIG. 11, for example, the consistency between the road and the driving trajectory is checked in the direction opposite to the direction of the driving vector with reference to P (12), for example. It is characterized in that the problem with respect to the distortion of the traveling locus due to the sensor error is solved by extracting the contact point P (9) at the time of traveling escape.
[0042]
【The invention's effect】
As is clear from the above explanation, according to the invention described in
[0043]
In addition, according to the second aspect of the present invention, since it is possible to determine the off-road driving using the stored contact information, it is possible to easily determine the off-road driving and calculate the accurate current vehicle position. can do.
[0044]
Further, according to the third aspect of the present invention, by providing general contact information in advance, an accurate vehicle current position can be calculated even when a new device is used.
[0045]
According to the invention of
[0046]
According to the inventions of
[0047]
In addition, according to the invention described in
[0048]
In addition, according to the invention of
[0049]
According to the invention described in
[Brief description of the drawings]
FIG. 1 is a block diagram showing a basic configuration of a vehicle position detection apparatus according to an embodiment of the present invention. FIG. 2 is a flowchart showing an operation of the vehicle position detection apparatus according to the present embodiment. FIG. 4 is a diagram illustrating the estimated current position of the vehicle calculated using FIG. 4. FIG. 5 is a diagram illustrating a process for obtaining consistency between the vehicle travel locus and road data. FIG. Fig. 6 illustrates contact information generation. Fig. 6 illustrates contact information generation at the time of off-road travel transition. Fig. 7 illustrates contact information generation upon exit from the road. FIG. 9 is a diagram for explaining contact information generation in FIG. 9. FIG. 9 is a diagram for explaining contact information generation in the case of an ideal travel locus without sensor error. FIG. 11 is a diagram for explaining contact information generation in a case where the vehicle travels distorted due to a sensor error or the like. FIG. 12 is a diagram for explaining contact information generation at the time of exit from the road. FIG. 13 is a diagram for explaining whether or not the vehicle is traveling outside the road when straddling the road. FIG. 14 is a diagram for explaining the judgment of whether or not the vehicle is traveling outside the road when straddling the road. 15] A diagram explaining the off-road driving condition when the driving trajectory is distorted due to sensor error, etc.
101 Direction detection means 102 Distance detection means 103 Current position estimation means 104 Map storage means 105 Road driving judgment means 106 Contact information automatic generation means 107 Contact information storage means 108 Current position calculation means
Claims (5)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000076199A JP3698002B2 (en) | 2000-03-17 | 2000-03-17 | Vehicle position detection device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000076199A JP3698002B2 (en) | 2000-03-17 | 2000-03-17 | Vehicle position detection device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2001264092A JP2001264092A (en) | 2001-09-26 |
JP3698002B2 true JP3698002B2 (en) | 2005-09-21 |
Family
ID=18593973
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2000076199A Expired - Lifetime JP3698002B2 (en) | 2000-03-17 | 2000-03-17 | Vehicle position detection device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3698002B2 (en) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4693626B2 (en) * | 2005-12-27 | 2011-06-01 | アルパイン株式会社 | Own vehicle position determination device |
JP4795206B2 (en) | 2006-03-10 | 2011-10-19 | 三菱電機株式会社 | Navigation device |
JP5133432B2 (en) * | 2006-03-10 | 2013-01-30 | 三菱電機株式会社 | Navigation device |
JP2008170277A (en) * | 2007-01-11 | 2008-07-24 | Nec Computertechno Ltd | Road map information correcting system, road map information correction method, and road map information correction program |
US8086364B2 (en) * | 2009-03-11 | 2011-12-27 | General Electric Company | System and method for operation of electric and hybrid vehicles |
JP5335853B2 (en) * | 2011-05-02 | 2013-11-06 | 三菱電機株式会社 | Map information processing device |
JP6427908B2 (en) | 2014-03-24 | 2018-11-28 | アイシン・エィ・ダブリュ株式会社 | Map information generation system, method and program |
JP6680319B2 (en) * | 2018-08-24 | 2020-04-15 | アイシン・エィ・ダブリュ株式会社 | Map information generation system, method and program |
CN113470350B (en) * | 2021-06-16 | 2023-02-28 | 中铁大桥局集团有限公司 | Traffic scheduling method for sidewalk |
-
2000
- 2000-03-17 JP JP2000076199A patent/JP3698002B2/en not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JP2001264092A (en) | 2001-09-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8825364B2 (en) | Vehicle position recognition device and vehicle position recognition program | |
JP4417583B2 (en) | Navigation device | |
US11193782B2 (en) | Vehicle position estimation apparatus | |
JP5747787B2 (en) | Lane recognition device | |
US20070078594A1 (en) | Navigation system and vehicle position estimating method | |
JP2009008590A (en) | Vehicle-position-recognition apparatus and vehicle-position-recognition program | |
JP4748264B2 (en) | Navigation device | |
JP4878256B2 (en) | Branch line recognition device and car navigation system | |
CN102620741B (en) | Route guiding system, course guiding method and route guidance program | |
JP2003532097A (en) | Position determination method and navigation device | |
JP2009115588A (en) | In-vehicle apparatus for detecting running route | |
JP3698002B2 (en) | Vehicle position detection device | |
JP2012215564A (en) | Operation support device and operation support method | |
JP2827618B2 (en) | Vehicle position detection device | |
JP4110742B2 (en) | Navigation device | |
JP2012137361A (en) | Locus information correcting device, method and program | |
JP4440027B2 (en) | U-turn detection device and U-turn detection method | |
JP4111015B2 (en) | Road shape recognition device | |
JP4093135B2 (en) | Car navigation system | |
JP6955464B2 (en) | Vehicle position determination device | |
JP3572828B2 (en) | Navigation device | |
JP5120034B2 (en) | Vehicle traveling direction estimation device | |
JPH11304512A (en) | Navigation system | |
JP2007278976A (en) | Navigation device | |
JPH1164020A (en) | Traveling lane estimation equipment for vehicle, traveling control equipment for vehicle, traveling lane estimation method for vehicle, and medium-storing program for estimating traveling lane for vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20041207 |
|
A871 | Explanation of circumstances concerning accelerated examination |
Free format text: JAPANESE INTERMEDIATE CODE: A871 Effective date: 20041207 |
|
A975 | Report on accelerated examination |
Free format text: JAPANESE INTERMEDIATE CODE: A971005 Effective date: 20050106 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20050208 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20050407 |
|
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: 20050627 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 4 Free format text: PAYMENT UNTIL: 20090715 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Year of fee payment: 4 Free format text: PAYMENT UNTIL: 20090715 |
|
FPAY | Renewal fee payment (prs date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100715 Year of fee payment: 5 |