JP4914192B2 - 現在位置算出装置 - Google Patents
現在位置算出装置 Download PDFInfo
- Publication number
- JP4914192B2 JP4914192B2 JP2006325634A JP2006325634A JP4914192B2 JP 4914192 B2 JP4914192 B2 JP 4914192B2 JP 2006325634 A JP2006325634 A JP 2006325634A JP 2006325634 A JP2006325634 A JP 2006325634A JP 4914192 B2 JP4914192 B2 JP 4914192B2
- Authority
- JP
- Japan
- Prior art keywords
- link
- road
- current position
- azimuth
- 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.)
- Active
Links
Images
Landscapes
- Instructional Devices (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Description
(2) 請求項2の発明は、請求項1に記載の現在位置算出装置において、道路データ格納手段は、道路のデータをリンクデータとして格納し、方位差算出手段は、方位検出手段で検出した進行方位と、道路データ格納手段に格納されたリンクの延在方位との差を方位差として算出し、判断手段は、分岐部の先方では道路が互いに略平行に延在するか否かをリンクの方位から判断し、低減手段は、判断手段で、走行する道路が分岐部を有し、分岐部の先方では道路が互いに略平行に延在すると判断されると、現在位置推定手段で現在位置を推定する際に、分岐部に対応するリンクに関する方位差が及ぼす影響を低減させることを特徴とする。
道路地図データは、地図に関する情報であり、地図表示用データ、経路探索用データ、誘導データ(交差点名称・道路名称・方面名称・方向ガイド施設情報など)などから成る。地図表示用データは道路や道路地図の背景を表示するためのデータである。経路探索用データは、道路形状とは直接関係しない分岐情報などから成るデータであり、主に推奨経路を演算(経路探索)する際に用いられる。誘導データは、交差点の名称などから成るデータであり、演算された推奨経路に基づき運転者等に推奨経路を誘導する際に用いられる。
表示モニタ14に表示された現在位置近辺の道路地図に車両の現在位置を重畳的に表示するため、本実施の形態のカーナビゲーション装置1では、以下のような処理によって現在位置を算出している。図3は、現在位置算出処理の動作を示したフローチャートである。車両の不図示のイグニッションキーによりアクセサリーON(ACC ON)になると、カーナビゲーション装置1の電源が入り、図3に示す処理を行うプログラムが定期的に起動される。
(a) 推定現在位置の算出に際して算出された車両の進行方位と道路データのリンクの方位(リンク方位)との差が所定値以下である。
(b) 上述した推定現在位置からリンクに対して垂直に降ろした線分の長さが所定値以下である。
信頼度trstは、算出された車両の進行方位と道路データのリンク方位との差の絶対値(方位差)△θ、および、推定現在位置と表示候補点との距離、すなわち推定現在位置から候補リンクに対して垂直に降ろした線分の長さ(垂線距離)Lに基づいて算出される。具体的には次のようにして算出される。なお、リンク方位は、図2(b)に示す道路データのリンク列データの記憶領域402から当該リンクの両端に位置するノードの位置座標を読み込んで算出される。
ec=α×△θ+β×L ・・・(1)
(1)式において、αおよびβは係数である。
es=(1−k)×esn−1+k×ec ・・・(2)
ここで、kは重み係数である。累積エラーコストesは、前回の処理で算出されたエラーコストを、今回の処理で算出されたエラーコストにどのくらい反映させるかを表している。
trst=100/(1+es) ・・・(3)
これにより、実際の車両位置としての信憑性が高くなるほど信頼度trstの値は100に近づき、実際の車両位置としての信憑性が低くなるほど信頼度trstの値は0に近づくこととなる。
このように信頼度trstは、車両が走行することで算出される車両の進行方位および走行距離と、道路データとに基づいて算出される。そのため、実際の道路の形状と道路データとの間に差があると、すなわち、道路データが実際の道路の形状を正しく反映していないと、信頼度trstの算出に悪影響を及ぼす。たとえば、図4(a)において図示左側から右側に向かって走行する場合のように、1車線の本線からなだらかに側道が分岐し、側道が本線と略平行となる道路がある。このような道路は高速道路の出口付近でよく見られる。これとは逆に、図4(a)において図示右側から左側に向かって走行する場合のように、本線と略平行な側道がなだらかに本線に合流する道路がある。このような道路は高速道路の入口付近でよく見られる。
ec(CAND(P4a2))=α×△θ(P4a2)+β×L2 ・・・(4)
ec(CAND(P4a4))=α×△θ(P4a4)+β×L4 ・・・(5)
△θ(P4a2)は、車両の進行方位と候補リンクa2のリンク方位との差であり、△θ(P4a4)は、車両の進行方位と候補リンクa4のリンク方位との差である。L2は、推定現在位置EST(P4)から候補リンクa2へ降ろした垂線の長さであり、L4は、推定現在位置EST(P4)から候補リンクa4へ降ろした垂線の長さである。
そこで、本実施の形態のカーナビゲーション装置1では、たとえば図4(a)〜(c)に示すように、分岐後の道路が互いに略平行に延在するような道路に関して、分岐部分に相当する分岐リンクに属する表示候補点のエラーコスト値ecの算出時に係数αの値を低減させる。これにより、方位差△θについての項の値を小さくして、方位差△θがエラーコスト値ec、累積エラーコストes、および信頼度trstに与える影響を低減させる。
(1) 分岐後の道路が互いに略平行に延在するような道路に関して、分岐部分に相当する分岐リンクについては、この分岐リンクに属する表示候補点のエラーコスト値ecの算出時に係数αの値を低減させるように構成した。したがって、エラーコスト値ecの方位差△θの項の値が小さくなるので、方位差△θがエラーコスト値ecの与える影響を低減できる。これにより、分岐/合流部分の実際の車線の角度と、分岐リンクのリンク方位とが大きく異なる場合であっても、信頼度trstの値が不当に低くなるのを防止できるので、誤った表示候補点を車両の現在位置として誤判定してしまうことを抑止して、正しい車両の現在位置を算出できる。
(1) 上述の説明では、分岐後の道路が互いに略平行に延在するような道路に関して、分岐部分に相当する分岐リンクに属する表示候補点のエラーコスト値ecの算出時に係数αの値を所定割合だけ低減させているが、本発明はこれに限定されない。たとえば、方位差△θの値そのものを小さくすることで(1)式における方位差△θの項の値を小さくしてもよい。
(6) 上述した各実施の形態および変形例は、それぞれ組み合わせてもよい。
100 制御装置 101 CPU
109 地図記憶装置
Claims (2)
- 進行方位を検出する方位検出手段と、
少なくとも道路の延在方位を含む道路のデータを格納する道路データ格納手段と、
前記方位検出手段で検出した前記進行方位と、前記道路データ格納手段に格納された前記道路の延在方位との差である方位差を算出する方位差算出手段と、
少なくとも前記方位差算出手段で算出した前記方位差に基づいて、複数の候補の中から現在位置を推定する現在位置推定手段と、
走行する道路が分岐部を有し、前記分岐部の先方では道路が互いに略平行に延在するか否かを判断する判断手段と、
前記判断手段で、走行する道路が分岐部を有し、前記分岐部の先方では道路が互いに略平行に延在すると判断されると、前記現在位置推定手段で現在位置を推定する際に、前記分岐部における前記方位差が及ぼす影響を低減させる低減手段とを備えることを特徴とする現在位置算出装置。 - 請求項1に記載の現在位置算出装置において、
前記道路データ格納手段は、前記道路のデータをリンクデータとして格納し、
前記方位差算出手段は、前記方位検出手段で検出した前記進行方位と、前記道路データ格納手段に格納されたリンクの延在方位との差を方位差として算出し、
前記判断手段は、前記分岐部の先方では道路が互いに略平行に延在するか否かをリンクの方位から判断し、
前記低減手段は、前記判断手段で、走行する道路が分岐部を有し、前記分岐部の先方では道路が互いに略平行に延在すると判断されると、前記現在位置推定手段で現在位置を推定する際に、前記分岐部に対応するリンクに関する前記方位差が及ぼす影響を低減させることを特徴とする現在位置算出装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006325634A JP4914192B2 (ja) | 2006-12-01 | 2006-12-01 | 現在位置算出装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006325634A JP4914192B2 (ja) | 2006-12-01 | 2006-12-01 | 現在位置算出装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2008139153A JP2008139153A (ja) | 2008-06-19 |
JP4914192B2 true JP4914192B2 (ja) | 2012-04-11 |
Family
ID=39600782
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2006325634A Active JP4914192B2 (ja) | 2006-12-01 | 2006-12-01 | 現在位置算出装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4914192B2 (ja) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4713627B2 (ja) * | 2008-11-13 | 2011-06-29 | 財団法人日本デジタル道路地図協会 | 道路網データのデータ構造、道路網データ生成装置、道路網データ生成用プログラム、および、経路案内装置 |
JP5051550B2 (ja) * | 2009-02-26 | 2012-10-17 | アイシン・エィ・ダブリュ株式会社 | ナビゲーション装置及びナビゲーション用プログラム |
JP5810939B2 (ja) * | 2012-01-26 | 2015-11-11 | トヨタ自動車株式会社 | 車両走行道路特定装置 |
JP5831308B2 (ja) * | 2012-03-13 | 2015-12-09 | アイシン・エィ・ダブリュ株式会社 | 移動体位置検出システム、移動体位置検出装置、移動体位置検出方法及びコンピュータプログラム |
US9587957B2 (en) | 2013-03-01 | 2017-03-07 | Mitsubishi Electric Corporation | Vehicle position display controller and vehicle position specifying method |
CN115307652B (zh) * | 2022-10-11 | 2023-01-24 | 小米汽车科技有限公司 | 车辆位姿确定方法、装置、设备及介质 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4279587B2 (ja) * | 2003-04-18 | 2009-06-17 | トヨタ自動車株式会社 | 車載ナビゲーション装置及びナビゲーション方法 |
JP2005114632A (ja) * | 2003-10-09 | 2005-04-28 | Alpine Electronics Inc | ナビゲーション装置、車両位置表示方法およびプログラム |
JP2005292082A (ja) * | 2004-04-05 | 2005-10-20 | Denso Corp | 衛星航法用制御装置 |
-
2006
- 2006-12-01 JP JP2006325634A patent/JP4914192B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2008139153A (ja) | 2008-06-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2009400B1 (en) | Vehicle position recognition device, navigation device, vehicle position recognition method | |
JP4861850B2 (ja) | レーン判定装置及びレーン判定方法 | |
US6453235B1 (en) | Vehicle navigation apparatus providing proper guidance for off-road net conditions | |
US5410486A (en) | Navigation system for guiding vehicle by voice | |
JP4446204B2 (ja) | 車両用ナビゲーション装置及び車両用ナビゲーションプログラム | |
EP2065835A2 (en) | Image recognition apparatus and image recognition program | |
JP2005315851A (ja) | カーナビゲーション装置 | |
JP2008101972A (ja) | ナビゲーション装置 | |
US20080033643A1 (en) | Route retrieval apparatus | |
JP4914192B2 (ja) | 現在位置算出装置 | |
JPH09178498A (ja) | 車両位置修正方法 | |
JP2008070149A (ja) | カーナビゲーション装置 | |
US9927251B2 (en) | Method and apparatus for detecting and correcting freeway-ramp-freeway situation in calculated route | |
JP4875509B2 (ja) | ナビゲーション装置及びナビゲーション方法 | |
US7483785B2 (en) | Navigation apparatus | |
JP5393785B2 (ja) | ルート周辺施設検索装置 | |
JP4890214B2 (ja) | 車載用ナビゲーション装置 | |
JP5276922B2 (ja) | 現在位置算出装置 | |
JP2000337896A (ja) | ナビゲーション装置 | |
JPH1172341A (ja) | 経路誘導装置 | |
JP5007207B2 (ja) | ナビゲーション装置および角速度検出信号補正値算出方法 | |
JP2544855B2 (ja) | 車両誘導装置 | |
JP4604655B2 (ja) | 車載用ナビゲーション装置 | |
JP2008202941A (ja) | ナビゲーション装置 | |
JP2007040809A (ja) | 経路案内装置および経路案内方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A711 Effective date: 20080417 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20080417 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20091130 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20110601 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110607 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110804 |
|
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: 20111227 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120120 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4914192 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150127 Year of fee payment: 3 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313117 |
|
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 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |