JP4353658B2 - 経路探索方法及び経路探索装置 - Google Patents
経路探索方法及び経路探索装置 Download PDFInfo
- Publication number
- JP4353658B2 JP4353658B2 JP2001213303A JP2001213303A JP4353658B2 JP 4353658 B2 JP4353658 B2 JP 4353658B2 JP 2001213303 A JP2001213303 A JP 2001213303A JP 2001213303 A JP2001213303 A JP 2001213303A JP 4353658 B2 JP4353658 B2 JP 4353658B2
- Authority
- JP
- Japan
- Prior art keywords
- link
- class
- speed limit
- destination
- route
- 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 - Fee Related
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3446—Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Instructional Devices (AREA)
- Traffic Control Systems (AREA)
Description
【発明の属する技術分野】
本発明は経路探索方法及び経路探索装置に係わり、特に、目的地までの経路を探索するナビゲーション装置における経路探索方法及び経路探索装置に関する。
【0002】
【従来の技術】
車載用ナビゲーション装置は、車両位置を検出してDVDなどの地図記憶媒体から車両位置周辺の地図データを読み出して地図をディスプレイ画面に描画するとともに該地図上の所定箇所に車両位置マークを重ねて描画する。そして、車両が移動するに従い、車両位置マークを画面中央等の所定位置に固定すると共に地図をスクロールして、常に、車両位置周辺の地図が一目で判るようにようになっている。かかる車載用ナビゲーション装置には、出発地点から目的地点まで例えば最短時間あるいは最短距離を辿るような誘導経路を探索し、画面に該経路を表示して運転者の走行案内をする経路誘導機能が設けられている。この経路誘導機能によれば、実際の運転に際して、誘導経路を特定の色で太く表示するなど他の道路と識別可能に表示して、運転者が目的地まで容易に到着できるようになっている。車両が走行する誘導経路を道路地図データから検索する方法として、ダイクストラ法やA*アルゴリズム等が知られている。
【0003】
【発明が解決しようとする課題】
ナビゲーション装置の経路探索に際して、ユーザは生成される経路の質だけでは満足しない。その経路を探索するのに費やされる時間についても考慮する必要がある。理想的な経路探索に望まれるのは、より高速で、より質の良い解である。しかし、一般に解の質と探索時間はトレードオフの関係にあり、現実的に探索時間が短くて済む最適解に近い解の方が、長い探索時間を必要とする最適解よりも利用価値がある。ダイクストラ法やA*アルゴリズムは最適経路、すなわち、最短経路を探索できるが、探索範囲が広いため探索時間が長くなる。特に、出発地から目的地までの距離が長くなったり、道路網の密度が高くなると経路探索の対象となる交差点、リンクが多くなり、経路探索時間が増加する。
【0004】
本発明の目的は、目的地までの距離が長くなれば少々距離が長くなってもフリーウェイ等のメインの道路を選択しやすくすることである。
本発明の別の目的は、短時間で目的地までの経路を探索できるようにすることである。
本発明の別の目的は、交差点における信号待ち、一時停止待ちなど交差点通過時間を考慮した経路探索を行えるようにすることである。
【0005】
【課題を解決するための手段】
上記課題は本発明によれば、(1) リンク情報に、リンク両端のノード、リンク長、リンクの制限速度、リンクの機能的クラスを含ませて地図情報を作成すること、(2) 経路探索に際して、着目リンクのノードから目的地までの直線距離と該リンクの機能的クラスとに基づいて該リンクの制限速度を補正すること、(3) 補正制限速度とリンク長とからリンク通過時間を計算し、(4) 該リンク通過時間に基づいて目的地までの所要時間が最短となる経路を探索すること、を有する経路探索方法により達成される。なお、前記制限速度の補正に際して、上位クラスのリンクほど制限速度が大きくなるように、又、下位クラスのリンクほど制限速度が小さくなるように、かつ、目的地までの直線距離が長くなるほど補正の度合が大きくなるように該制限速度を補正する。
【0006】
又、上記課題は、本発明によれば、更に、(1) 出発地が属するリンクの機能的クラスと同一クラスのリンクを用いて上位クラスのリンクに到達するまで該出発地より目的地に向けて経路探索を行うこと、(2) 同様に目的地が属するリンクの機能的クラスと同一クラスのリンクを用いて上位クラスのリンクに到達するまで該目的地より出発地に向けて経路探索を行うこと、(3) 前記出発地より探索した上位クラスのリンクのノードを新たな出発地、前記目的地より探索した上位クラスのリンクのノードを新たな目的地とし、該クラスのリンクを用いて上記処理を繰り返すこと、(4) 2つのパスが遭遇するとき、出発地側から求めた各クラスの探索経路と目的地側から求めた各クラスの探索経路を接続して誘導経路を形成すること、を有する経路探索方法により達成される。
【0007】
又、上記課題は本発明によれば、(1) 交差する道路の機能的クラス及び自リンクの機能的クラスを考慮してノード通過時間を推定すること、(2) 該ノード通過時間を前記リンク通過時間に加算して該リンク通過時間を補正すること、を有する経路探索方法により達成される。
【0008】
【発明の実施の形態】
(a)車載ナビゲーション装置の全体構成
図1は本発明の車載ナビゲーション装置の全体構成図である。図中、11は地図データを記憶するDVD(Digital Video Disk)などの地図情報記憶部である。地図は縮尺レベルに応じて適当な大きさの経度幅、緯度幅に区切られており、道路は経緯度で表現された頂点(ノード)の座標集合で示され、各頂点(ノード)を順に直線で接続することに描画できる。2つの交差点ノードを連結した道路部分はリンクと呼ばれ、道路は多数のリンクで構成されている。
【0009】
地図データには、図2に示すように、道路リスト、各道路の道路データ、道路を構成する各リンクのリンクデータを有している。道路データは、道路名、道路を構成するリンクIDを含んでいる。例えば、道路網が図3に示すような場合、Road 2の道路データは図2に示すようになる。リンクデータLink Dataは、(1) リンク両端のノードID(NDPT11、NDPT12)、(2) リンク長DL、(3) リンクの制限速度を特定するスピードカテゴリーSC、(4) リンクの機能的クラスFC(Functional Class)、その他、(5) 一方通行情報、(6) レーン数、(7)Free Road/ Toll Roadの別などを含んでいる。スピードカテゴリーSCと制限速度Vの関係は例えば図4に示す通りであり、制限速度Vは0〜7の8段階に区分されている。又、リンクの機能的クラスFCは、リンクの幅員(又はレーン数)、制限速度、道路の種別など機能的要素を考慮して決定され、例えばFC=0〜5まで6段階に区分されている。FC=0はメインクラスで、フリーウェイ(freeway)を意味し、FC=1はファーストクラスで、有料道路/州間ハイウェイ(tollhway/interstate highway)を意味し、FC=2はセカンドクラスで一般国道を意味し、FC=3はサードクラスで県道を意味し、FC=4はフォースクラスで、県道以下の狭い道路を意味し、FC=5はフォースクラス以下のクラス(Less Than Fourth クラス)であり、細街路を意味する。
【0010】
図1に戻って、12は車両の現在位置に応じた地図画像や車両位置マーク、誘導経路等を描画するディスプレイ装置(CRT)、13は車両位置検出部であり、図示しないが、車両の進行方位を検出する振動ジャイロ等の方位センサと所定走行距離毎に1個のパルスを発生する距離センサとGPS衛星からの電波を受信して車両の絶対位置を測位するGPS受信機とを使って車両の現在位置(緯度、経度)を算出している。
14はリモコンであり、画面に表示されている各種メニューリストからメニューを選択したり、地図をスクロールする際に使用する。15はナビゲーション制御部であり、(1) 地図データを用いた車両周辺の地図画像発生処理、(2) 経路探索処理、(3) 車両位置マークや誘導経路画像の発生処理などを行う。
【0011】
ナビゲーション制御部15において、15aはリモコンの操作に応じた信号を受信して各部に指示するリモコン制御部である。15bは車両位置データに基づき、現在地周辺で画面表示範囲より広い範囲の地図データ(例えば9画面分の地図データ)を地図情報記憶部11から読み出し、該地図データに基づいてドットイメージの地図画像を発生する地図画像描画部である。15cは誘導経路探索処理により得られた出発地から目的地までの誘導経路データに基づいて誘導経路画像を発生する誘導経路描画部、15dは地図画像及び誘導経路画像を記憶するビデオRAMである。地図画像描画部15bはディスプレイ画面の表示範囲がビデオRAM 15dの画像範囲を超えないように、車両の走行に従って、随時、ビデオRAM15dを書き換え、また誘導経路描画部15cも車両の走行に応じて誘導経路画像を発生してビデオRAM 15dに記憶させるようになっている。15eは車両の現在位置がディスプレイ画面の中心に位置するようにビデオRAM 15dから1画面分の地図画像を切り出す画像切り出し制御部であり、切り出し位置は地図画像描画部15bから指示される。15fはディスプレイ画面の中心に車両位置マークを表示するための車両位置マーク発生部である。
【0012】
15gは誘導経路探索部であり、出発地(例えば車両現在位置)、目的地が入力されると地図情報に基づいて出発地から目的地までの誘導経路を探索する。誘導経路探索部15gは出発地から目的地までの交差点間のリンク旅行時間の合計が最も短くなるような経路をA*アルゴリズムにしたがって探索し、この経路に沿って経路誘導を行う。15g-1は制限速度補正値テーブルを記憶する記憶部であり、制限速度補正値テーブル15g-1は図5に示すように、目的地までの直線距離Dmgとリンクの機能的クラスFCとの組み合わせに対するリンク制限速度Vの補正値Vcを保持している。この速度補正値Vcは目的地までの距離が長くなる程上位クラスのリンク(道路)が経路として選択されやすくなるように決定されている。すなわち、
(1) 速度補正値Vcは、上位クラスほど制限速度Vが大になるように決定され(Vc>0)、又、下位クラスほど制限速度Vが小さくなるように決定され(Vc<0)、更に、
(2) 目的地までの直線距離が長くなるほど速度補正値Vcの絶対値が大きくなるように決定されている。
【0013】
15hは出発地から目的地までの誘導経路を記憶する誘導経路記憶部、15iは合成部で、ビデオRAM15d、車両位置マーク発生部15fからそれぞれ読み出された地図画像及び誘導経路画像、車両位置マーク画像を合成してディスプレイ装置12に出力し、画像表示する。
【0014】
(b)第1の経路探索処理
A*アルゴリズムは、最短経路あるいは最短時間経路を効率的に発見できるアルゴリズムである。このA*アルゴリズムは、探索段階においてh(n),g(n)の和をノードn(交通網における交差点)の評価f(n)とする。
つまり、
f(n)=g(n)+h(n) (1)
ただし、
h(n)=ノードnから目的地ノード到達までに必要と予測される
最小コスト(ヒューリスティック関数)
g(n)=出発地点ノードからノードnまでの実コスト
である。このノードの評価f(n)を最小にするノードが探索の各段階で枝を広げ、探索が進められる。なお、最短時間経路探索において、良好な結果を与えるヒューリスティック関数として、次式
h(n)=[ノードnからゴールGまでの直線距離を平均走行速度Vavrで除算した値]・・・(2)
が知られている。図6は評価関数の図解的説明図であり、Sは出発地、Gは目的地、nは着目ノードである。A*アルゴリズムの特徴として、次の2点があげられる。
【0015】
・出発地点Sから目的地点Gまでの経路があるならば、必ず経路(解)を発見することができる。
・ヒューリスティック関数h(n)が、真のコストを越えないのであれば、最短時間経路を発見することができる。
道路網における2点間の直線距離は、その2点を結ぶ最短経路の距離よりも必ず小さいので、前述の(2)式におけるヒューリスティック関数h(n)は真のコストを越えることがなく、従って、必ず最短時間経路を得ることができる。
【0016】
図7は本発明のA*アルゴリズムの処理フローである。なお、ノードnからノードmに至るリンクL(n、m)のコストをcost(n,m)、あるノードnに接続する全てのリンクを求める処理を展開するといい、前記あるノードnを親ノード、求めたリンクの他方のノードmを子ノードという。又、展開可能性のあるノードの集合を OPEN、既に展開済みのノードの集合をCLOSEDとする。
初期時、集合OPENを構成するノードを出発地Sのみとし、集合CLOSEDを空集合とする(ステップ101)。すなわち、
OPEN:(S)
CLOSED:[ ]
とする。
【0017】
ついで、集合OPENが空集合であるかチェックし(ステップ102)、空集合であれば最適経路探索は失敗と判定する(ステップ103)。しかし、空集合でなければ、集合OPENの先頭ノード(初期時には出発地S)を取り出してnとする(ステップ104)。先頭ノードを取り出すことにより該ノードを集合OPENより削除する。
ついで、ノードnが目的地Gであるかチェックし(ステップ105)、目的地であれば、経路探索が成功する(ステップ106)。したがって、後述するポインタを用いて目的地Gより出発地S方向に辿ることにより最短時間経路を得ることができる。
一方、ステップ105において、ノードnが目的地Gでなければ、該ノードnと接続する全リンクを求め、ノードnを集合CLOSEDに入れる(ステップ 107)。以後、求めた全てのリンクL(n,m)の子ノードmについて以下のステップ108a〜 108dを実行する。
【0018】
すなわち、子ノードmについて、評価値を次式
f(n,m)=g(n)+cost(n,m)+h(m) (3)
により計算する(ステップ108a)。上記(3)式中のg(n)はノードnまでの実コストで既知である。(3)式の評価値f(n,m)の計算は図8に示すフローに従って行う。 まず、リンクL(n,m)のリンク長DL、スピードカテゴリーSC及び機能的クラスFCを求める(ステップ201)。ついで、着目リンクL(n,m)の子ノードmから目的地までの直線距離Dmgを計算し(ステップ202)、平均速度Vavrを用いて次式
h(m)=Dmg/Vavr (4)
によりヒューリスティック関数h(m)を計算する(ステップ203)。
【0019】
ついで、機能的クラスFC、直線距離Dmgに基づいて補正値テーブル(図5参照)より速度補正値Vcを求める(ステップ204)。又、スピードカテゴリーSCに応じた制限速度Vを制限速度テーブル(図4参照)より求める(ステップ205)。しかる後、リンク通過時間cost(n,m)を次式
cost(n,m)=DL/(V+Vc) (5)
により計算し(ステップ206)、最後に、g(n), cost(n,m)、 h(m)を用いて(3)式により評価値f(n,m)を計算する(ステップ207)。
以上により、評価値f(n,m)が求まれば、子ノードmが集合OPENあるいは集合 CLOSEDに含まれているかチェックする。
子ノードが集合OPEN、CLOSEDのいずれにも含まれていなければ、
▲1▼子ノードmから親ノードnへのポインタを作成し、
▲2▼前記評価値f(n,m)をf(m)とし(f(n,m)→f(m))、
ポインタ及び評価値f(m)をそれぞれ子ノードmに関連付け、該子ノードmを集合OPENに入れる(ステップ 108b)。
【0020】
一方、子ノードmが集合OPENに含まれていれば、集合OPENの該ノードに関連付けられている評価値f(m)(第1の評価値)と前記計算した評価値 f(n,m)(第2の評価値)を比較する。第2の評価値が小さければ、集合OPENの前記ノードmの評価値を第2の評価値f(n,m)で更新し(f(n,m)→f(m))、かつ、該ノードmの親ノードがノードnとなるようにポインタを更新する(ステップ108c)。しかし、第2の評価値f(n,m)が第1の評価値f(m)より大きければ、ステップ 108cの処理をせず、着目している子ノードmを棄てる。
このステップ108cは、ノードmに到る既知経路より更に評価値の良い経路が発見された場合、ポインタを更新することにより評価値のよい経路を新たな既知経路とするものである。
【0021】
一方、子ノードmが集合CLOSEDに含まれていれば、集合CLOSEDの該ノードに関連付けられている評価値f(m)(第1の評価値)と前記計算した評価値f(n,m)(第2の評価値)を比較する。第2の評価値が小さければ、集合CLOSEDにおける着目ノード(子ノードm)の親ノードがノードnとなるようにポインタを更新し、かつ、該着目ノードの評価値を第2の評価値f(n,m)で更新し(f(n,m)→f(m))、該着目ノードを集合OPENに戻す(ステップ108d)。尚、第2の評価値f(n,m)が第1の評価値より大きければ、ステップ108dの処理はせず、着目している子ノードmを棄てる。
このステップ108dは、ノードmに到る既知の経路より更に評価値の良い経路が発見された場合であって、該ノードmが既に展開済みになっている場合に、ノードmのポインタを更新することにより評価値のよい経路を新たな既知経路とし、かつ、ノードmを新たな既知経路に関連して展開可能性があるものとして集合 OPENに復活するものである。
【0022】
ついで、集合OPENを構成する各ノードの評価値に基づいて評価値の小さい順に並び替える(ステップ109)。これにより、評価値が最小の、現時点では最も最適と思われるノードが集合OPENの先頭ノードになる。以後、ステップ102に戻り、目的地Gにたどり着くまで以降の処理を繰り返す。
目的地Gに到着すれば、ポインタを用いて目的地Gより出発地Sに向けて辿ることにより、出発地Sから目的地Gまでの最短時間経路を得ることができる。
以上第1の経路探索処理によれば、速度補正値Vcを上位クラスほど制限速度Vが大になるように決定し(Vc>0)、下位クラスほど制限速度Vが小さくなるように決定し(Vc<0)、又、目的地までの直線距離が長くなるほど速度補正値Vcの絶対値|Vc|が大きくなるように決定するから、目的地までの距離が長くなるほど上位クラスのリンク(道路)を経路として選択することができる。
【0023】
(c)評価値計算の別の処理
以上では、評価値f(n,m)を交差点通過時間を考慮しないで計算したが、この交差点通過時間を考慮して評価値を計算することもできる。
地図情報には、信号の有無、一時停止、信号待ち時間などの情報が含まれていない。そこで、交差点における通過時間TPSを、交差するリンクの機能的クラス及び自リンクの機能的クラスを考慮して推定し、該交差点通過時間TPSを前記リンク通過時間cost(n,m)に加算して該リンク通過時間を補正する。図9Aに示すように走行中リンク(L11、L12)の方が交差するリンク(L21、L22)より機能的クラスFCが上位であれば、交差点通過時間を小さい時間Tsとする。逆に走行中リンクの方が交差するリンクより機能的クラスFCが下位であれば、交差点通過時間を大きな時間TL(>Ts)とする。又、図9Bに示すように走行中リンク(L11、L12)と交差するリンク(L21、L22)の機能的クラスFCが同じであれば、交差点通過時間を Ts,TLの中間的な時間TM(=(Ts+TL)/2)とする。
【0024】
図10は交差点通過時間を考慮した評価値の計算処理フローであり、ステップ205までは図8の処理フローと同じである。ステップ205において、スピードカテゴリーSCに応じた制限速度Vを制限速度テーブルより求めれば、cost′(n,m)を次式
cost′(n,m)=DL/(V+Vc) (5)′
により計算する(ステップ211)。ついで、子ノードmで交差するリンクの機能的クラスFCが自リンクより上位のクラスかチェックし(ステップ212)、上位のクラスであれば交差点通過時間TPS=TLとし(ステップ213a)、下位のクラスであれば交差点通過時間TPS=TSとし(ステップ213b)、同一クラスであれば交差点通過時間 TPS=TMとする(ステップ213c)。
【0025】
ついで、リンク通過時間cost(n,m)を次式
cost(n,m)=cost′(n,m)+TPS (6)
により計算し(ステップ214)、最後に、g(n), cost(n,m)、 h(m)を用いて(3)式により評価値f(n,m)を計算する(ステップ215)。
【0026】
(d)第2の経路探索処理
図7の第1の経路探索では、全リンクを対象にA*アルゴリズムを適用した。しかし、全リンクを対象にすると探索時間が長くなる。そこで、第2の経路探索では、(1) 出発地が属するリンクの機能的クラスFCと同一クラスのリンクを用いて上位クラスのリンクに到達するまで該出発地より目的地に向けて経路探索を行い、(2) 同様に、目的地が属するリンクの機能的クラスと同一クラスのリンクを用いて上位クラスのリンクに到達するまで該目的地より出発地に向けて経路探索を行い、(3) 出発地より探索した上位クラスのリンクのノードを新たな出発地とし、又、目的地より探索した上位クラスのリンクのノードを新たな目的地とし、(4) 該上位クラスのリンクを用いて上記処理を繰り返し、(5) 所定クラスにおいて目的地に到達すれば、出発地側から求めた各クラスの探索経路と目的地側から求めた各クラスの探索経路を順番に接続して誘導経路を形成する。ただし、前記新たな出発地を1つのノードとするリンクのクラスと、前記新たな目的地を1つのノードとするリンクのクラスは同じである。
【0027】
図11は本発明の第2の経路探索処理フローである。
まず、出発地(車両現在位置)と目的地を入力し(ステップ301)、i=5(最下位の機能的クラス)とする(ステップ302)。ついで、出発地よりFC=iのリンクのみを用いて図7の第1の経路探索処理を行い(ステップ303)、目的地に到達したかチェックする(ステップ304)。目的地に到達してなければ、FC=j(>i)の上位クラス(上層)のリンクまで探索できたかチェックし(ステップ305)、「NO」であれば、ステップ303以降の処理を繰り返す。
ステップ305で、「YES」となれば、目的地よりFC=iのリンクのみを用いて図7の第1の経路探索処理を行い(ステップ306)、FC=j(>i)の上層ノードまで探索できたかチェックし(ステップ307)、「NO」であれば、ステップ306以降の処理を繰り返す。FC=j(>i)の上層ノードまで探索できれば、出発地から上層リンクまでの経路S(FC)、目的地から上層リンクまでの経路G(FC)を保存する(ステップ308)。
【0028】
ついで、j→iとし(ステップ 309)、出発地側の上層リンクのノードNsを新たな出発地、目的地側の上層リンクのノードNGを新たな目的地とし(ステップ310)、ステップ303以降の処理を繰り返す。
以後、上記処理が繰り返され、最終的にステップ304において目的地に到達すれば、保存してある出発地側から求めた各クラスの探索経路S(5),S(4),S(3),S(2),S(1),S(0)と目的地側から求めた各クラスの探索経路G(5),G(4),G(3),G(2),G(1),G(0)を順番に接続して誘導経路
S(5)→S(4)→S(3)→S(2)→S(1)→S(0)→G(0)→G(1)→G(2)→G(3)→G(4)→G(5)を形成する(ステップ311)。尚、ステップ303の経路探索処理において、評価値が等しければ、機能的クラスが上位のリンクが選ばれるように経路探索を行う。
【0029】
第2の経路探索処理によれば、各リンクに機能的クラスを割付け、出発地及び目的地がFC=iのノードであれば、FC=iのみのリンクを用いて経路探索し、上位クラスj(>i)のリンクに到達すれば、上位クラスFC=jのみのリンクを用いて経路探索し、以下同様に経路探索するから、経路探索対象のリンク数が少なくなり、短時間で目的地までの経路を探索できる。
又、第2の経路探索によれば、速度補正値Vcを上位クラスほど制限速度Vが大になるように決定し(Vc>0)、下位クラスほど制限速度Vが小さくなるように決定し(Vc<0)、又、目的地までの直線距離が長くなるほど速度補正値Vcの絶対値|Vc|が大きくなるように決定するから、素早く上位クラスのリンクに到達することができ、探索時間を短縮できる。すなわち、上位クラスほどリンク数が少なく、かつ、エリアが広くなるから、素早く上位クラスのリンクに到達することにより探索時間を短縮できる。
【0030】
以上では経路探索法としてA*アルゴリズムを用いた場合について説明したが、ダイクストラ法など別の経路探索処理を適用することもできる。
以上、本発明の実施例により説明したが、本発明は請求の範囲に記載した本発明の趣旨に従い種々の変形が可能であり、本発明はこれらを排除するものではない。
【0031】
【発明の効果】
以上本発明によれば、目的地までの距離が長くなれば少々距離が長くなってもフリーウェイ等のメインの道路を選択しやすくできる。
又、本発明によれば、短時間で目的地までの経路を探索することができる。
又、本発明によれば、交差点における信号待ち、一時停止待ちなど交差点通過時間を考慮した経路探索を行うことができる。
【図面の簡単な説明】
【図1】本発明の車載ナビゲーション装置の全体構成図である。
【図2】地図データ説明図である。
【図3】道路データ説明図である。
【図4】スピードカテゴリーと制限速度の関係図である。
【図5】制限速度補正値テーブル説明図である。
【図6】A*アルゴリズムにおける評価関数の図解的説明図である。
【図7】本発明のA*アルゴリズムによる経路探索処理フローである。
【図8】評価値の計算処理フローである。
【図9】図9A、図9Bは交差点通過時間説明図である。
【図10】交差点通過時間を考慮した評価値の計算処理フローである。
【図11】本発明の第2の経路探索処理フローである。
【符号の説明】
11 地図情報記憶部
12 ディスプレイ装置(CRT)
13 車両位置検出部
14 リモコン
15 ナビゲーション制御部
15a リモコン制御部
15b 地図画像描画部
15c 誘導経路描画部
15d ビデオRAM
15e 画像切り出し制御部
15f 車両位置マーク発生部
15g 誘導経路探索部
15h 誘導経路記憶部
15i 合成部
Claims (18)
- 目的地までの経路を探索するナビゲーション装置における経路探索方法において、
リンク情報に、リンク両端のノード、リンク長、リンクの制限速度、リンクの機能的クラスを含ませて地図情報を作成し、
経路探索に際して、目的地までの直線距離とリンクの機能的クラスとに基づいて該リンクの制限速度を補正し、
補正された制限速度とリンク長よりリンク通過時間を計算し、
該リンク通過時間に基づいて目的地までの所要時間が最短となる経路を探索し、
前記制限速度の補正に際して、上位クラスのリンクほど制限速度が大きくなるように、又、下位クラスのリンクほど制限速度が小さくなるように、かつ、目的地までの直線距離が長くなるほど補正の度合が大きくなるように該制限速度を補正する、
ことを特徴とする経路探索方法。 - 幅員、制限速度、道路の種別のうち少なくとも1つが含まれる道路の機能的要素を考慮して前記機能的クラスを決定し、
上位クラスのリンクほど制限速度が大きくなるように、又、下位クラスのリンクほど制限速度が小さくなるように補正値を決定すると共に、目的地までの直線距離が長くなるほど、絶対値が大きくなるように該補正値を決定し、該補正値を制限速度に加算して制限速度を補正する、
ことを特徴とする請求項1記載の経路探索方法。 - 目的地までの直線距離とリンクの機能的クラスとの組み合わせに対する制限速度の補正値を保持するテーブルを設け、
該テーブルより求まる補正値を用いてリンクの制限速度を補正する、
ことを特徴とする請求項1記載の経路探索方法。 - 交差する道路の機能的クラス及び自リンクの機能的クラスを考慮してノード通過時間を推定し、
該ノード通過時間を前記リンク通過時間に加算して該リンク通過時間を補正する、
ことを特徴とする請求項1記載の経路探索方法。 - 幅員、制限速度、道路の種別のうち少なくとも1つが含まれる道路の機能的要素を考慮して前記機能的クラスを決定し、
上位クラスのリンクほど制限速度が大きくなるように、又、下位クラスのリンクほど制限速度が小さくなるように補正値を決定すると共に、目的地までの直線距離が長くなるほど、絶対値が大きくなるように該補正値を決定し、該補正値を制限速度に加算して制限速度を補正する、
ことを特徴とする請求項4記載の経路探索方法。 - 目的地までの直線距離とリンクの機能的クラスとの組み合わせに対する制限速度の補正値を保持するテーブルを設け、
該テーブルより求まる補正値を用いてリンクの制限速度を補正する、
ことを特徴とする請求項5記載の経路探索方法。 - 目的地までの経路を探索するナビゲーション装置における経路探索方法において、
リンク情報に、リンク両端のノード、リンク長、リンクの制限速度、リンクの機能的クラスを含ませて地図情報を作成し、
経路探索に際して、目的地までの直線距離とリンクの機能的クラスとに基づいて該リンクの制限速度を補正し、
補正された制限速度とリンク長よりリンク通過時間を計算し、
該リンク通過時間に基づいて目的地までの所要時間が最短となる経路を探索し、
出発地が属するリンクの機能的クラスと同一クラスのリンクを用いて上位クラスのリンクに到達するまで該出発地より目的地に向けて経路探索を行い、
目的地が属するリンクの機能的クラスと同一クラスのリンクを用いて上位クラスのリンクに到達するまで該目的地より出発地に向けて経路探索を行い、
前記出発地より探索した上位クラスのリンクのノードを新たな出発地、前記目的地より探索した上位クラスのリンクのノードを新たな目的地とし、該上位クラスのリンクを用いて上記処理を繰り返し、
所定クラスにおいて目的地に到達すれば、出発地側から求めた各クラスの探索経路と目的地側から求めた各クラスの探索経路を順番に接続して誘導経路を形成し、
前記制限速度の補正に際して、上位クラスのリンクほど制限速度が大きくなるように、又、下位クラスのリンクほど制限速度が小さくなるように、かつ、目的地までの直線距離が長くなるほど補正の度合が大きくなるように該制限速度を補正する、
ことを特徴とする経路探索方法。 - 前記新たな出発地をノードとするリンクのクラスと前記新たな目的地をノードとするリンクのクラスは同じである、
ことを特徴とする請求項7記載の経路探索方法。 - 幅員、制限速度、道路の種別のうち少なくとも1つが含まれる道路の機能的要素を考慮して前記機能的クラスを決定し、
上位クラスのリンクほど制限速度が大きくなるように、又、下位クラスのリンクほど制限速度が小さくなるように補正値を決定すると共に、目的地までの直線距離が長くなるほど、絶対値が大きくなるように該補正値を決定し、該補正値を制限速度に加算して制限速度を補正する、
ことを特徴とする請求項8記載の経路探索方法。 - 目的地までの直線距離とリンクの機能的クラスとの組み合わせに対する制限速度の補正値を保持するテーブルを設け、
該テーブルより求まる補正値を用いてリンクの制限速度を補正する、
ことを特徴とする請求項9記載の経路探索方法。 - 交差する道路の機能的クラス及び自リンクの機能的クラスを考慮してノード通過時間を推定し、
該ノード通過時間を前記リンク通過時間に加算して該リンク通過時間を補正する、
ことを特徴とする請求項7記載の経路探索方法。 - 前記新たな出発地をノードとするリンクのクラスと前記新たな目的地をノードとするリンクのクラスは同じである、
ことを特徴とする請求項11記載の経路探索方法。 - 幅員、制限速度、道路の種別のうち少なくとも1つが含まれる道路の機能的要素を考慮して前記機能的クラスを決定し、
上位クラスのリンクほど制限速度が大きくなるように、又、下位クラスのリンクほど制限速度が小さくなるように補正値を決定すると共に、目的地までの直線距離が長くなるほど、絶対値が大きくなるように該補正値を決定し、該補正値を制限速度に加算して制限速度を補正する、
ことを特徴とする請求項12記載の経路探索方法。 - 目的地までの直線距離とリンクの機能的クラスとの組み合わせに対する制限速度の補正値を保持するテーブルを設け、
該テーブルより求まる補正値を用いてリンクの制限速度を補正する、
ことを特徴とする請求項13記載の経路探索方法。 - 目的地までの経路を探索する経路探索装置において、
リンク情報に、リンク両端のノード、リンク長、リンクの制限速度、リンクの機能的クラスを含ませてなる地図情報を保存する地図情報記憶部、
上位クラスのリンクほど制限速度が大きくなるように、又、下位クラスのリンクほど制限速度が小さくなるように、かつ、目的地までの直線距離が長くなるほど、絶対値が大きくなるように該制限速度の補正値を決定し、該補正値を目的地までの直線距離とリンクの機能的クラスの組み合わせに対応させて保持するテーブル、
経路探索に際して、目的地までの直線距離とリンクの機能的クラスとに応じた前記補正値を用いて該リンクの制限速度を補正し、補正された制限速度とリンク長よりリンク通過時間を計算し、該リンク通過時間に基づいて目的地までの所要時間が最短となる経路を探索する経路探索部、
を備えたことを特徴とする経路探索装置。 - 前記経理探索部は、交差する道路の機能的クラス及び自リンクの機能的クラスを考慮してノード通過時間を推定し、該ノード通過時間を前記リンク通過時間に加算して該リンク通過時間を補正する、
ことを特徴とする請求項15記載の経路探索装置。 - 目的地までの経路を探索する経路探索装置において、
リンク情報に、リンク両端のノード、リンク長、リンクの制限速度、リンクの機能的クラスを含ませてなる地図情報を保存する地図情報記憶部、
上位クラスのリンクほど制限速度が大きくなるように、又、下位クラスのリンクほど制限速度が小さくなるように、かつ、目的地までの直線距離が長くなるほど、絶対値が大きくなるように該制限速度の補正値を決定し、該補正値を目的地までの直線距離とリンクの機能的クラスの組み合わせに対応させて保持するテーブル、
経路探索に際して、目的地までの直線距離とリンクの機能的クラスとに応じた前記補正値を用いて該リンクの制限速度を補正し、補正された制限速度とリンク長よりリンク通過時間を計算し、該リンク通過時間に基づいて目的地までの所要時間が最短となる経路を探索する経路探索部、
を備え、前記経路探索部は、
出発地が属するリンクの機能的クラスと同一クラスのリンクを用いて上位クラスのリンクに到達するまで該出発地より目的地に向けて経路探索を行う手段、
目的地が属するリンクの機能的クラスと同一クラスのリンクを用いて上位クラスのリンクに到達するまで該目的地より出発地に向けて経路探索を行う手段、
前記出発地より探索した上位クラスのリンクのノードを新たな出発地、前記目的地より探索した上位クラスのリンクのノードを新たな目的地とし、該上位クラスのリンクを用いて上記処理を繰り返す手段、
所定クラスにおいて目的地に到達すれば、出発地側から求めた各クラスの探索経路と目的地側から求めた各クラスの探索経路を順番に接続して誘導経路を形成する手段、
を有することを特徴とする経路探索装置。 - 前記経理探索部は、交差する道路の機能的クラス及び自リンクの機能的クラスを考慮してノード通過時間を推定し、該ノード通過時間を前記リンク通過時間に加算して該リンク通過時間を補正する手段、
を備えることを特徴とする請求項17記載の経路探索装置。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US09/633,244 US6263277B1 (en) | 2000-08-07 | 2000-08-07 | Route searching method |
US09/633244 | 2000-08-07 |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2002098540A JP2002098540A (ja) | 2002-04-05 |
JP2002098540A5 JP2002098540A5 (ja) | 2007-06-21 |
JP4353658B2 true JP4353658B2 (ja) | 2009-10-28 |
Family
ID=24538847
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2001213303A Expired - Fee Related JP4353658B2 (ja) | 2000-08-07 | 2001-07-13 | 経路探索方法及び経路探索装置 |
Country Status (2)
Country | Link |
---|---|
US (1) | US6263277B1 (ja) |
JP (1) | JP4353658B2 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11731653B2 (en) * | 2020-08-26 | 2023-08-22 | Motional Ad Llc | Conditional motion predictions |
Families Citing this family (38)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002133351A (ja) * | 2000-10-25 | 2002-05-10 | Nec Corp | 最小コスト経路探索装置及びそれに用いる最小コスト経路探索方法 |
JP3907994B2 (ja) * | 2001-10-12 | 2007-04-18 | アルパイン株式会社 | 誘導経路探索方法及びナビゲーション装置 |
US6574554B1 (en) * | 2001-12-11 | 2003-06-03 | Garmin Ltd. | System and method for calculating a navigation route based on non-contiguous cartographic map databases |
US6704645B1 (en) | 2001-12-11 | 2004-03-09 | Garmin Ltd. | System and method for estimating impedance time through a road network |
US6581003B1 (en) * | 2001-12-20 | 2003-06-17 | Garmin Ltd. | Systems and methods for a navigational device with forced layer switching based on memory constraints |
US6975940B1 (en) | 2001-12-21 | 2005-12-13 | Garmin Ltd. | Systems, functional data, and methods for generating a route |
US6909965B1 (en) | 2001-12-28 | 2005-06-21 | Garmin Ltd. | System and method for creating and organizing node records for a cartographic data map |
JP3937939B2 (ja) * | 2002-06-14 | 2007-06-27 | アイシン・エィ・ダブリュ株式会社 | ナビゲーションシステム及び経路案内データ記録方法のプログラム |
US8649975B2 (en) * | 2002-08-29 | 2014-02-11 | Mapquest, Inc. | Automated route determination |
US7321824B1 (en) * | 2002-12-30 | 2008-01-22 | Aol Llc | Presenting a travel route using more than one presentation style |
US7474960B1 (en) | 2002-12-30 | 2009-01-06 | Mapquest, Inc. | Presenting a travel route |
US7818116B1 (en) | 2002-12-30 | 2010-10-19 | Mapquest, Inc. | Presenting a travel route in a ground-based vehicle |
JP2004286559A (ja) * | 2003-03-20 | 2004-10-14 | Mitsubishi Electric Corp | 車両用ナビゲーションシステムおよび経路案内方法 |
US7228214B2 (en) * | 2003-03-31 | 2007-06-05 | Deere & Company | Path planner and method for planning a path plan having a spiral component |
US7216033B2 (en) | 2003-03-31 | 2007-05-08 | Deere & Company | Path planner and method for planning a contour path of a vehicle |
US6934615B2 (en) * | 2003-03-31 | 2005-08-23 | Deere & Company | Method and system for determining an efficient vehicle path |
US7079943B2 (en) * | 2003-10-07 | 2006-07-18 | Deere & Company | Point-to-point path planning |
KR101128921B1 (ko) | 2004-07-09 | 2012-03-27 | 테직 커뮤니케이션 인코포레이티드 | 다의적 문자의 명확화 |
US7512485B2 (en) * | 2005-03-29 | 2009-03-31 | International Business Machines Corporation | Method for routing multiple paths through polygonal obstacles |
EP1767902B1 (de) * | 2005-09-26 | 2012-08-01 | Navigon AG | Verfahren zur Bestimmung wenigstens einer Route zwischen einem Ausgangspunkt und einem Zielpunkt anhand digitalisierter Kartendaten und dazugehöriges Navigationsgerät |
US7925320B2 (en) | 2006-03-06 | 2011-04-12 | Garmin Switzerland Gmbh | Electronic device mount |
NZ572844A (en) * | 2006-06-05 | 2011-07-29 | Sensis Pty Ltd | Enhancing road data for navigational devices using classes and rules data representing manoeuvring constraints |
US8126641B2 (en) * | 2006-06-30 | 2012-02-28 | Microsoft Corporation | Route planning with contingencies |
US8392111B2 (en) * | 2006-08-04 | 2013-03-05 | Samsung Electronics Co., Ltd. | Navigation method, medium, and system |
US10621525B2 (en) * | 2007-06-29 | 2020-04-14 | Palo Alto Research Center Incorporated | Method for solving model-based planning with goal utility dependencies |
US8005610B2 (en) * | 2007-08-10 | 2011-08-23 | Max-Planck-Gesellschaft zur Förderung der Wissenschaften e.V | Method and device for determining the length of a shortest path in a network |
US7493209B1 (en) * | 2008-04-07 | 2009-02-17 | International Business Machines Corporation | Method of calculating a route based on estimated energy consumption |
US8266092B2 (en) * | 2008-07-10 | 2012-09-11 | Palo Alto Research Center Incorporated | Methods and systems for target value path identification |
US8165705B2 (en) * | 2008-07-10 | 2012-04-24 | Palo Alto Research Center Incorporated | Methods and systems for continuously estimating persistent and intermittent failure probabilities for production resources |
US8145334B2 (en) * | 2008-07-10 | 2012-03-27 | Palo Alto Research Center Incorporated | Methods and systems for active diagnosis through logic-based planning |
US8219437B2 (en) * | 2008-07-10 | 2012-07-10 | Palo Alto Research Center Incorporated | Methods and systems for constructing production plans |
US8612050B2 (en) * | 2008-07-29 | 2013-12-17 | Palo Alto Research Center Incorporated | Intelligent product feed system and method |
US8359110B2 (en) * | 2009-03-23 | 2013-01-22 | Kuhn Lukas D | Methods and systems for fault diagnosis in observation rich systems |
CN102252687A (zh) * | 2011-07-06 | 2011-11-23 | 广东威创视讯科技股份有限公司 | 获取车辆最快行驶路径的方法与装置 |
CN104697543B (zh) * | 2015-03-17 | 2017-10-10 | 武汉中海庭数据技术有限公司 | 一种融合个性偏好因子的路径探索方法 |
KR101865729B1 (ko) * | 2016-06-23 | 2018-06-08 | 현대자동차 주식회사 | 전기자동차 경로 안내 시스템 및 그 방법 |
KR20200057507A (ko) * | 2018-11-16 | 2020-05-26 | 현대자동차주식회사 | 차량의 주행 차로 관리 장치, 그를 포함한 시스템 및 그 방법 |
CN113271546B (zh) * | 2021-04-26 | 2022-09-16 | 重庆凯瑞特种车有限公司 | 一种垃圾收运智慧管理平台 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2680318B2 (ja) | 1987-12-28 | 1997-11-19 | アイシン・エィ・ダブリュ株式会社 | ナビゲーション装置 |
US5031104A (en) | 1988-12-05 | 1991-07-09 | Sumitomo Electric Industries, Ltd. | Adaptive in-vehicle route guidance system |
US5036471A (en) * | 1989-04-18 | 1991-07-30 | Sanyo Electric Co., Ltd. | Apparatus for road path searching applicable to car navigation system and operation method thereof |
US5638280A (en) * | 1994-03-30 | 1997-06-10 | Sumitomo Electric Industries, Ltd. | Vehicle navigation apparatus and method |
KR100263982B1 (ko) * | 1996-04-28 | 2000-08-16 | 모리 하루오 | 네비게이션장치 |
JP3371768B2 (ja) * | 1997-08-29 | 2003-01-27 | 株式会社デンソー | 車両用走行経路案内装置およびその地図データ記録媒体 |
-
2000
- 2000-08-07 US US09/633,244 patent/US6263277B1/en not_active Expired - Lifetime
-
2001
- 2001-07-13 JP JP2001213303A patent/JP4353658B2/ja not_active Expired - Fee Related
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11731653B2 (en) * | 2020-08-26 | 2023-08-22 | Motional Ad Llc | Conditional motion predictions |
Also Published As
Publication number | Publication date |
---|---|
US6263277B1 (en) | 2001-07-17 |
JP2002098540A (ja) | 2002-04-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4353658B2 (ja) | 経路探索方法及び経路探索装置 | |
JP2782135B2 (ja) | 車両走行案内装置 | |
JP4133570B2 (ja) | ナビゲーション装置 | |
JPH0935183A (ja) | 動的経路探索方法およびナビゲーション装置 | |
JP3800285B2 (ja) | ナビゲーション装置及び記録媒体 | |
JP3099734B2 (ja) | 複数経路提供装置 | |
JP4155776B2 (ja) | ナビゲーション装置 | |
JP4115910B2 (ja) | ナビゲーション装置及び代替経路発生告知方法 | |
JP3566503B2 (ja) | リンク旅行時間補間方法 | |
JPH05126590A (ja) | 車両用経路探索装置 | |
JP4736590B2 (ja) | 候補経路作成装置、方法、プログラム、交通シミュレーション装置、方法及びプログラム、経路探索装置、方法、及びプログラム | |
JPH0944074A (ja) | ドライブシミュレーション装置 | |
JP3661754B2 (ja) | ナビゲーション装置及び記録媒体 | |
JP3517597B2 (ja) | 経路探索装置、経路探索方法及び経路探索用プログラムを記録した媒体 | |
JPH10267677A (ja) | ナビゲーション装置 | |
JP3022269B2 (ja) | 経路情報提供装置 | |
JP3510964B2 (ja) | 車載用ナビゲーション装置の誘導経路探索方法 | |
JP3039226B2 (ja) | 経路計算方法及び装置 | |
JP2002260145A (ja) | 交通情報管理システム、交通情報管理方法及びそのプログラム | |
JPH06186049A (ja) | 経路誘導方法 | |
JP3368722B2 (ja) | 車両用走行案内装置 | |
JP3805413B2 (ja) | 車両用走行案内装置 | |
JP3293406B2 (ja) | 車両用走行案内装置 | |
JP3773015B2 (ja) | 地図描画用データ作成方法及びナビゲーション装置 | |
JP4472641B2 (ja) | ナビゲーション装置及び誘導経路更新方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070508 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20070508 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090519 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090707 |
|
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: 20090728 |
|
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: 20090728 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4353658 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: 20120807 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120807 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130807 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130807 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140807 Year of fee payment: 5 |
|
LAPS | Cancellation because of no payment of annual fees |