(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2024-07-29
(45)【発行日】2024-08-06
(54)【発明の名称】運転支援装置及びコンピュータプログラム
(51)【国際特許分類】
G01C 21/34 20060101AFI20240730BHJP
G08G 1/16 20060101ALI20240730BHJP
B60W 30/10 20060101ALI20240730BHJP
B60W 40/02 20060101ALI20240730BHJP
【ＦＩ】
G01C21/34
G08G1/16 D
B60W30/10
B60W40/02
【請求項の数】
4
(21)【出願番号】P 2020009120
(22)【出願日】2020-01-23
(65)【公開番号】P2021117039
(43)【公開日】2021-08-10
【審査請求日】2022-11-07
(73)【特許権者】
【識別番号】000000011
【氏名又は名称】株式会社アイシン
(74)【代理人】
【識別番号】110000992
【氏名又は名称】弁理士法人ネクスト
(72)【発明者】
【氏名】二村 光宏
【審査官】武内 俊之
(56)【参考文献】
【文献】国際公開第２０１９／０３１４０７（ＷＯ，Ａ１）
【文献】特開２０１９－１５８４８２（ＪＰ，Ａ）
【文献】特開２０１６－１２２３０８（ＪＰ，Ａ）
(58)【調査した分野】(Int.Cl.，ＤＢ名)
Ｇ０１Ｃ ２１／３４
Ｇ０８Ｇ １／１６
Ｂ６０Ｗ ３０／１０
Ｂ６０Ｗ ４０／０２
(57)【特許請求の範囲】
【請求項1】
交差点に対する車両の進入位置を取得する進入位置取得手段と、前記交差点から車両が退出する退出位置を取得する退出位置取得手段と、
前記進入位置から前記退出位置までの間の少なくとも一部を曲率が連続して変化する曲線で繋ぐことによって、前記交差点に対して車両に走行が推奨される走行軌道を生成する走行軌道生成手段と、
前記走行軌道に基づいて車両の運転支援を行う運転支援手段と、
前記交差点上に配置された地物の位置及び形状を取得する地物取得手段と、
前記交差点上に配置された地物の位置及び形状に基づいて、前記交差点の進入位置から退出位置までの間において車両が通過すべき通過点を設定する通過点設定手段と、を有し、
前記走行軌道生成手段は、
進行方向に沿って隣り合う通過点の間を対象にして、手前側の通過点を開始点とした曲率が一定の割合で連続して変化する曲線であるクロソイド曲線を生成するとともに生成されたクロソイド曲線に基づいて次の通過点の位置を補正し、手前側の通過点から補正後の通過点を結ぶ前記クロソイド曲線を前記走行軌道の一部として算出することで、
前記進入位置から前記退出位置までを繋ぐ曲線を前記走行軌道として生成する運転支援装置。
【請求項2】
前記交差点上に配置された地物には、誘導線、菱形導流帯又はポールの少なくとも一以上を含み、前記通過点設定手段は、前記交差点上に配置された誘導線、菱形導流帯又はポールの位置及び形状を考慮して前記通過点を設定する請求項１に記載の運転支援装置。
【請求項3】
前記運転支援手段は、車両の自動運転支援を行う請求項１又は請求項２に記載の運転支援装置。
【請求項4】
コンピュータを、交差点に対する車両の進入位置を取得する進入位置取得手段と、
前記交差点から車両が退出する退出位置を取得する退出位置取得手段と、
前記進入位置から前記退出位置までの間の少なくとも一部を曲率が連続して変化する曲線で繋ぐことによって、前記交差点に対して車両に走行が推奨される走行軌道を生成する走行軌道生成手段と、
前記走行軌道に基づいて車両の運転支援を行う運転支援手段と、
前記交差点上に配置された地物の位置及び形状を取得する地物取得手段と、
前記交差点上に配置された地物の位置及び形状に基づいて、前記交差点の進入位置から退出位置までの間において車両が通過すべき通過点を設定する通過点設定手段と、
して機能させる為のコンピュータプログラムであって、
前記走行軌道生成手段は、
進行方向に沿って隣り合う通過点の間を対象にして、手前側の通過点を開始点とした曲率が一定の割合で連続して変化する曲線であるクロソイド曲線を生成するとともに生成されたクロソイド曲線に基づいて次の通過点の位置を補正し、手前側の通過点から補正後の通過点を結ぶ前記クロソイド曲線を前記走行軌道の一部として算出することで、
前記進入位置から前記退出位置までを繋ぐ曲線を前記走行軌道として生成するコンピュータプログラム。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、車両の運転支援を行う運転支援装置及びコンピュータプログラムに関する。
【背景技術】
【0002】
車両が交差点内を右折又は左折して通過する場合において適切な運転支援を行う為には、車両が交差点内をどのような走行軌道により走行するのが良いか、即ち推奨される走行軌道を予め特定しておくことが重要である。特に、片側複数車線の道路が交差する大型の交差点では、交差点の進入時に車両が走行する車線と交差点の退出後に走行する車線の位置関係等によって推奨される走行軌道は大きく異なるので、交差点内で適切な旋回を行わせる為には推奨される走行軌道を予め特定することが望ましい。
【0003】
そこで、交差点を通過する際の推奨される走行軌道を予め特定する手段として、特開２０１９－１２３２７０号公報には車両の現在位置と交差点を退出する際の目標点とを設定し、車両の現在位置と目標点を夫々通過する軌道を、交差点を通過する際の走行軌道として生成する技術について提案されている。
【先行技術文献】
【特許文献】
【0004】
【文献】特開２０１９－１２３２７０号公報（第１４－１８頁）
【発明の概要】
【発明が解決しようとする課題】
【0005】
ここで、上記特許文献１の技術では、走行軌道を生成する際に、車両の現在位置を通過する走路の進行方向に沿った第１直線と、目標点を通過する走路の進行方向に沿った第２直線を夫々設定し、各直線に内接する円弧と第１直線と第２直線を組み合わせた軌道を走行軌道としている。
【0006】
しかしながら、実際に車両が交差点を右左折するために旋回する際には、図２７に示すように先ず直進方向にあるステアリングを徐々に旋回させながら進み、ステアリング角を一定にする区間を必要に応じていれて、その後にステアリングを徐々に直進方向に戻しながら進むのが一般的である。即ち、交差点を通過する一般的な車両の走行軌道は、曲率が連続して変化する曲線（例えばクロソイド曲線）となる。上記特許文献１で生成される走行軌道は直線と曲率が一定の円弧形状を組み合わせた軌道であるので、車両が走行軌道に沿って走行する為には、図２７に示すように直線と円弧の接続点で一旦停止してステアリングを所定角度まで回転させた後にステアリング角度を固定して走行し、その後に再び円弧と直線の接続点で一旦停止してステアリングを直進方向に戻す必要があり、走行軌道に沿って走行することが極めて難しく、適切な運転支援を行うことができない問題がある。
【0007】
本発明は前記従来における問題点を解消するためになされたものであり、車両の運転支援を行う場合において、交差点を通過する車両にとって実現することが容易で且つ推奨される走行軌道を生成することが可能であり、運転支援を適切に実施することを可能にした運転支援装置及びコンピュータプログラムを提供することを目的とする。
【課題を解決するための手段】
【0008】
前記目的を達成するため本発明に係る運転支援装置は、交差点に対する車両の進入位置を取得する進入位置取得手段と、前記交差点から車両が退出する退出位置を取得する退出位置取得手段と、前記進入位置から前記退出位置までの間の少なくとも一部を曲率が連続して変化する曲線で繋ぐことによって、前記交差点に対して車両に走行が推奨される走行軌道を生成する走行軌道生成手段と、前記走行軌道に基づいて車両の運転支援を行う運転支援手段と、前記交差点上に配置された地物の位置及び形状を取得する地物取得手段と、前記交差点上に配置された地物の位置及び形状に基づいて、前記交差点の進入位置から退出位置までの間において車両が通過すべき通過点を設定する通過点設定手段と、を有し、前記走行軌道生成手段は、進行方向に沿って隣り合う通過点の間を対象にして、手前側の通過点を開始点とした曲率が一定の割合で連続して変化する曲線であるクロソイド曲線を生成するとともに生成されたクロソイド曲線に基づいて次の通過点の位置を補正し、手前側の通過点から補正後の通過点を結ぶ前記クロソイド曲線を前記走行軌道の一部として算出することで、前記進入位置から前記退出位置までを繋ぐ曲線を前記走行軌道として生成する。
尚、「運転支援」とは、運転者の車両操作の少なくとも一部を運転者に代わって行う又は補助する機能、或いは運転を支援する為の表示案内や音声案内を行うことをいう。
尚、「運転支援」とは、運転者の車両操作の少なくとも一部を運転者に代わって行う又は補助する機能、或いは運転を支援する為の表示案内や音声案内を行うことをいう。
【0009】
また、本発明に係るコンピュータプログラムは、車両において実施する運転支援に用いる支援情報を生成するプログラムである。具体的には、コンピュータを、交差点に対する車両の進入位置を取得する進入位置取得手段と、前記交差点から車両が退出する退出位置を取得する退出位置取得手段と、前記進入位置から前記退出位置までの間の少なくとも一部を曲率が連続して変化する曲線で繋ぐことによって、前記交差点に対して車両に走行が推奨される走行軌道を生成する走行軌道生成手段と、前記走行軌道に基づいて車両の運転支援を行う運転支援手段と、前記交差点上に配置された地物の位置及び形状を取得する地物取得手段と、前記交差点上に配置された地物の位置及び形状に基づいて、前記交差点の進入位置から退出位置までの間において車両が通過すべき通過点を設定する通過点設定手段と、して機能させる為のコンピュータプログラムであって、前記走行軌道生成手段は、進行方向に沿って隣り合う通過点の間を対象にして、手前側の通過点を開始点とした曲率が一定の割合で連続して変化する曲線であるクロソイド曲線を生成するとともに生成されたクロソイド曲線に基づいて次の通過点の位置を補正し、手前側の通過点から補正後の通過点を結ぶ前記クロソイド曲線を前記走行軌道の一部として算出することで、前記進入位置から前記退出位置までを繋ぐ曲線を前記走行軌道として生成する。
【発明の効果】
【0010】
前記構成を有する本発明に係る運転支援装置及びコンピュータプログラムによれば、車両の運転支援を行う場合において、交差点に対する車両の進入位置と交差点から車両が退出する退出位置とに基づいて、交差点を通過する車両にとって実現することが容易で且つ推奨される走行軌道を生成することが可能となる。そして、生成された走行軌道に基づいて運転支援を行うことによって、運転支援を適切に実施することを可能とする。また、交差点上に車両が交差点を通過する際に従うべき地物が存在する場合において、地物に従った走行軌道を生成することが可能となる。
【図面の簡単な説明】
【0011】
【図1】本実施形態に係る運転支援システムを示した概略構成図である
【図2】本実施形態に係る運転支援システムの構成を示したブロック図である。
【図3】本実施形態に係るナビゲーション装置を示したブロック図である。
【図4】本実施形態に係る自動運転支援プログラムのフローチャートである。
【図5】高精度地図情報の取得されるエリアを示した図である。
【図6】静的走行軌道生成処理のサブ処理プログラムのフローチャートである。
【図7】車両の走行予定経路の一例を示した図である。
【図9】車線変更の回数とレーンコストの関係を示した図である。
【図10】走行する車線とレーンコストの関係を示した図である。
【図11】車線変更を行う位置とレーンコストの関係を示した図である。
【図12】車線変更を伴う走行区間における静的走行軌道の算出方法について説明した図である。
【図13】交差点走行軌道生成処理のサブ処理プログラムのフローチャートである。
【図14】交差点上の車両が通過すべき通過点を示した図である。
【図15】通過点を通過するスプライン曲線を示した図である。
【図16】スプライン曲線を所定距離間隔でサンプリングしたサンプリング点を示した図である。
【図17】対象範囲の始点に位置するサンプリング点から描いたクロソイド曲線を示した図である。
【図18】決定パスを示した図である。
【図19】サンプリング点の修正と対象範囲の更新を示した図である。
【図20】走行軌道に含まれるクロソイド曲線と円弧の関係を示した図である。
【図21】動的走行軌道生成処理のサブ処理プログラムのフローチャートである。
【図22】動的走行軌道の一つである回避軌道の一例を示した図である。
【図23】動的走行軌道の一つである回避軌道の一例を示した図である。
【図24】動的走行軌道の一つである追従軌道の一例を示した図である。
【図25】動的走行軌道の一つである追従軌道の一例を示した図である。
【図26】走行軌道反映処理のサブ処理プログラムのフローチャートである。
【図27】従来技術の問題点を説明した図である。
【発明を実施するための形態】
【0012】
以下、本発明に係る運転支援装置をナビゲーション装置１に具体化した一実施形態について図面を参照しつつ詳細に説明する。先ず、本実施形態に係るナビゲーション装置１を含む運転支援システム２の概略構成について図１及び図２を用いて説明する。図１は本実施形態に係る運転支援システム２を示した概略構成図である。図２は本実施形態に係る運転支援システム２の構成を示したブロック図である。
【0013】
図１に示すように、本実施形態に係る運転支援システム２は、情報配信センタ３が備えるサーバ装置４と、車両５に搭載されて車両５の自動運転に関する各種支援を行うナビゲーション装置１と、を基本的に有する。また、サーバ装置４とナビゲーション装置１は通信ネットワーク網６を介して互いに電子データを送受信可能に構成されている。尚、ナビゲーション装置１の代わりに、車両５に搭載された他の車載器や車両５に関する制御を行う車両制御装置を用いても良い。
【0014】
ここで、車両５はユーザの運転操作に基づいて走行する手動運転走行に加えて、ユーザの運転操作によらず車両が予め設定された経路や道なりに沿って自動的に走行を行う自動運転支援による支援走行が可能な車両とする。
【0015】
また、自動運転支援は全ての道路区間に対して行っても良いし、特定の道路区間（例えば境界にゲート（有人無人、有料無料は問わない）が設けられた高速道路）を車両が走行する間のみ行う構成としても良い。以下の説明では車両の自動運転支援が行われる自動運転区間は、一般道や高速道路を含む全ての道路区間に加えて駐車場も含むこととし、車両が走行を開始してから走行を終了するまでの間において基本的に自動運転支援が行われるとして説明する。但し、車両が自動運転区間を走行する場合には必ず自動運転支援が行われるのではなく、ユーザにより自動運転支援を行うことが選択され（例えば自動運転開始ボタンをＯＮする）、且つ自動運転支援による走行を行わせることが可能と判定された状況でのみ行うのが望ましい。一方で、車両５は自動運転支援による支援走行のみ可能な車両としても良い。
【0016】
そして、自動運転支援における車両制御では、例えば、車両の現在位置、車両が走行する車線、周辺の障害物の位置を随時検出し、後述のようにナビゲーション装置１で生成された走行軌道に沿って、同じく生成された速度計画に従った速度で走行するようにステアリング、駆動源、ブレーキ等の車両制御が自動で行われる。尚、本実施形態の自動運転支援による支援走行では、車線変更や右左折についても上記自動運転支援による車両制御を行うことにより走行するが、車線変更や右左折等の特殊な走行については自動運転支援による走行は行わずに手動運転により行う構成としても良い。
【0017】
一方、ナビゲーション装置１は、車両５に搭載され、ナビゲーション装置１が有する地図データ或いは外部から取得した地図データに基づいて自車位置周辺の地図を表示したり、地図画像上において車両の現在位置を表示したり、設定された案内経路に沿った移動案内を行う車載機である。本実施形態では特に自動運転支援による支援走行を車両が行う場合に、自動運転支援に関する各種支援情報を生成する。支援情報としては例えば車両の走行が推奨される走行軌道（推奨される車線移動態様を含む）、走行する際の車速を示す速度計画等がある。尚、ナビゲーション装置１の詳細については後述する。
【0018】
また、サーバ装置４は、ナビゲーション装置１の要求に応じて経路探索の実行を行う。具体的には、ナビゲーション装置１において目的地が設定された場合や経路の再探索（リルート）を行う場合に、ナビゲーション装置１からサーバ装置４へと出発地や目的地等の経路探索に必要な情報が経路探索要求とともに送信される（但し、再探索の場合には目的地に関する情報は必ずしも送信する必要は無い）。そして経路探索要求を受信したサーバ装置４は、サーバ装置４の有する地図情報を用いて経路探索を行い、出発地から目的地までの推奨経路を特定する。その後、特定された推奨経路を要求元のナビゲーション装置１へと送信する。そして、ナビゲーション装置１は受信した推奨経路に関する情報をユーザに提供したり、推奨経路を案内経路に設定し、案内経路に従って自動運転支援に関する各種支援情報を生成する。それによって、経路探索時点においてナビゲーション装置１が有する地図情報が古いバージョンの地図情報であったり、ナビゲーション装置１が地図情報自体を有さない場合であっても、サーバ装置４が有する最新バージョンの地図情報に基づいて適切な目的地までの推奨経路を提供することが可能となる。
【0019】
更に、サーバ装置４は、上記経路探索に用いる通常の地図情報とは別に、より精度の高い地図情報である高精度地図情報を有している。高精度地図情報は、例えば道路のレーン形状（車線単位の道路形状や曲率、車線幅等）と道路に描かれた区画線（車道中央線、車線境界線、車道外側線、誘導線等）に関する情報が含まれる。また、その他に交差点に関する情報、駐車場に関する情報等も含まれる。そして、サーバ装置４はナビゲーション装置１からの要求に応じて高精度地図情報を配信し、ナビゲーション装置１はサーバ装置４から配信された高精度地図情報を用いて後述のように自動運転支援に関する各種支援情報を生成する。尚、高精度地図情報は基本的に道路（リンク）及びその周辺のみを対象とした地図情報であるが、道路周辺以外のエリアについても含む地図情報としても良い。
【0020】
但し、上述した経路探索処理については必ずしもサーバ装置４で行う必要は無く、地図情報を有するナビゲーション装置１であればナビゲーション装置１で行っても良い。また、高精度地図情報についてもサーバ装置４から配信されるのではなくナビゲーション装置１が予め有するようにしても良い。
【0021】
また、通信ネットワーク網６は全国各地に配置された多数の基地局と、各基地局を管理及び制御する通信会社とを含み、基地局及び通信会社を有線（光ファイバー、ＩＳＤＮ等）又は無線で互いに接続することにより構成されている。ここで、基地局はナビゲーション装置１との通信をするトランシーバー（送受信機）とアンテナを有する。そして、基地局は通信会社の間で無線通信を行う一方、通信ネットワーク網６の末端となり、基地局の電波が届く範囲（セル）にあるナビゲーション装置１の通信をサーバ装置４との間で中継する役割を持つ。
【0022】
続いて、運転支援システム２におけるサーバ装置４の構成について図２を用いてより詳細に説明する。サーバ装置４は、図２に示すようにサーバ制御ＥＣＵ１１と、サーバ制御ＥＣＵ１１に接続された情報記録手段としてのサーバ側地図ＤＢ１２と、高精度地図ＤＢ１３と、サーバ側通信装置１４とを備える。
【0023】
サーバ制御ＥＣＵ１１（エレクトロニック・コントロール・ユニット）は、サーバ装置４の全体の制御を行う電子制御ユニットであり、演算装置及び制御装置としてのＣＰＵ２１、並びにＣＰＵ２１が各種の演算処理を行うにあたってワーキングメモリとして使用されるＲＡＭ２２、制御用のプログラム等が記録されたＲＯＭ２３、ＲＯＭ２３から読み出したプログラムを記憶するフラッシュメモリ２４等の内部記憶装置を備えている。尚、サーバ制御ＥＣＵ１１は、後述のナビゲーション装置１のＥＣＵとともに処理アルゴリズムとしての各種手段を有する。
【0024】
一方、サーバ側地図ＤＢ１２は、外部からの入力データや入力操作に基づいて登録された最新のバージョンの地図情報であるサーバ側地図情報が記憶される記憶手段である。ここで、サーバ側地図情報は、道路網を始めとして経路探索、経路案内及び地図表示に必要な各種情報から構成されている。例えば、道路網を示すノード及びリンクを含むネットワークデータ、道路（リンク）に関するリンクデータ、ノード点に関するノードデータ、各交差点に関する交差点データ、施設等の地点に関する地点データ、地図を表示するための地図表示データ、経路を探索するための探索データ、地点を検索するための検索データ等からなる。
【0025】
また、高精度地図ＤＢ１３は、上記サーバ側地図情報よりも精度の高い地図情報である高精度地図情報１５が記憶される記憶手段である。高精度地図情報１５は、特に車両が走行対象となる道路や駐車場等に関してより詳細な情報を格納した地図情報であり、本実施形態では例えば道路のレーン形状（車線単位の道路形状や曲率、車線幅等）と道路に描かれた区画線（車道中央線、車線境界線、車道外側線、誘導線等）に関する情報が含まれる。また、更に高精度地図ＤＢ１３としては、道路を構成する各リンクに関してリンクの属する道路の幅員、勾（こう）配、カント、バンク、路面の状態、ノード間のリンク形状（例えばカーブ道路ではカーブの形状）を特定する為の形状補完点データ、合流区間、道路構造、道路の車線数、車線数の減少する箇所、幅員の狭くなる箇所、踏切等を表すデータが、コーナに関して、曲率半径、交差点、Ｔ字路、コーナの入口及び出口等を表すデータが、道路属性に関して、降坂路、登坂路等を表すデータが、道路種別に関して、国道、県道、細街路等の一般道のほか、高速自動車国道、都市高速道路、自動車専用道路、一般有料道路、有料橋等の有料道路を表すデータがそれぞれ記録される。特に本実施形態では、道路の車線数に加えて、車線毎の進行方向の通行区分や道路の繋がり（具体的には、交差点の通過前の道路に含まれる車線と交差点の通過後の道路に含まれる車線との対応関係）を特定する情報についても記憶されている。更に、道路に設定されている制限速度についても記憶されている。また、交差点に関しては交差点の形状や交差点上に配置された地物に関する情報についても記憶されている。尚、“交差点上に配置された地物”には、交差点の路面に描かれた路面標示や区画線、ポール等の構造物を含む。また、高精度地図情報は基本的に道路（リンク）及びその周辺のみを対象とした地図情報であるが、道路周辺以外のエリアについても含む地図情報としても良い。また、図２に示す例ではサーバ側地図ＤＢ１２に格納されるサーバ側地図情報と高精度地図情報１５とは異なる地図情報としているが、高精度地図情報１５はサーバ側地図情報の一部としても良い。
【0026】
一方、サーバ側通信装置１４は各車両５のナビゲーション装置１と通信ネットワーク網６を介して通信を行う為の通信装置である。また、ナビゲーション装置１以外にインターネット網や、交通情報センタ、例えば、ＶＩＣＳ（登録商標：Vehicle Information and Communication System）センタ等から送信された渋滞情報、規制情報、交通事故情報等の各情報から成る交通情報の受信についても可能である。
【0027】
【0028】
図３に示すように本実施形態に係るナビゲーション装置１は、ナビゲーション装置１が搭載された車両の現在位置を検出する現在位置検出部３１と、各種のデータが記録されたデータ記録部３２と、入力された情報に基づいて、各種の演算処理を行うナビゲーションＥＣＵ３３と、ユーザからの操作を受け付ける操作部３４と、ユーザに対して車両周辺の地図やナビゲーション装置１で設定されている案内経路（車両の走行予定経路）に関する情報等を表示する液晶ディスプレイ３５と、経路案内に関する音声ガイダンスを出力するスピーカ３６と、記憶媒体であるＤＶＤを読み取るＤＶＤドライブ３７と、プローブセンタやＶＩＣＳセンタ等の情報センタとの間で通信を行う通信モジュール３８と、を有する。また、ナビゲーション装置１はＣＡＮ等の車載ネットワークを介して、ナビゲーション装置１の搭載された車両に対して設置された車外カメラ３９や各種センサが接続されている。更に、ナビゲーション装置１の搭載された車両に対する各種制御を行う車両制御ＥＣＵ４０とも双方向通信可能に接続されている。
【0029】
以下に、ナビゲーション装置１が有する各構成要素について順に説明する。
現在位置検出部３１は、ＧＰＳ４１、車速センサ４２、ステアリングセンサ４３、ジャイロセンサ４４等からなり、現在の車両の位置、方位、車両の走行速度、現在時刻等を検出することが可能となっている。ここで、特に車速センサ４２は、車両の移動距離や車速を検出する為のセンサであり、車両の駆動輪の回転に応じてパルスを発生させ、パルス信号をナビゲーションＥＣＵ３３に出力する。そして、ナビゲーションＥＣＵ３３は発生するパルスを計数することにより駆動輪の回転速度や移動距離を算出する。尚、上記４種類のセンサをナビゲーション装置１が全て備える必要はなく、これらの内の１又は複数種類のセンサのみをナビゲーション装置１が備える構成としても良い。
現在位置検出部３１は、ＧＰＳ４１、車速センサ４２、ステアリングセンサ４３、ジャイロセンサ４４等からなり、現在の車両の位置、方位、車両の走行速度、現在時刻等を検出することが可能となっている。ここで、特に車速センサ４２は、車両の移動距離や車速を検出する為のセンサであり、車両の駆動輪の回転に応じてパルスを発生させ、パルス信号をナビゲーションＥＣＵ３３に出力する。そして、ナビゲーションＥＣＵ３３は発生するパルスを計数することにより駆動輪の回転速度や移動距離を算出する。尚、上記４種類のセンサをナビゲーション装置１が全て備える必要はなく、これらの内の１又は複数種類のセンサのみをナビゲーション装置１が備える構成としても良い。
【0030】
また、データ記録部３２は、外部記憶装置及び記録媒体としてのハードディスク（図示せず）と、ハードディスクに記録された地図情報ＤＢ４５やキャッシュ４６や所定のプログラム等を読み出すとともにハードディスクに所定のデータを書き込む為のドライバである記録ヘッド（図示せず）とを備えている。尚、データ記録部３２をハードディスクの代わりにフラッシュメモリやメモリーカードやＣＤやＤＶＤ等の光ディスクを有しても良い。また、本実施形態では上述したようにサーバ装置４において目的地までの経路を探索するので、地図情報ＤＢ４５については省略しても良い。
【0031】
ここで、地図情報ＤＢ４５は、例えば、道路（リンク）に関するリンクデータ、ノード点に関するノードデータ、経路の探索や変更に係る処理に用いられる探索データ、施設に関する施設データ、地図を表示するための地図表示データ、各交差点に関する交差点データ、地点を検索するための検索データ等が記憶された記憶手段である。
【0032】
一方、キャッシュ４６は、過去にサーバ装置４から配信された高精度地図情報１５が保管される記憶手段である。保管する期間は適宜設定可能であるが、例えば記憶されてから所定期間（例えば１カ月）としても良いし、車両のＡＣＣ電源(accessory power supply)がＯＦＦされるまでとしても良い。また、キャッシュ４６に格納されるデータ量が上限となった後に古いデータから順次削除するようにしても良い。そして、ナビゲーションＥＣＵ３３は、キャッシュ４６に格納された高精度地図情報１５を用いて、自動運転支援に関する各種支援情報を生成する。詳細については後述する。
【0033】
一方、ナビゲーションＥＣＵ（エレクトロニック・コントロール・ユニット）３３は、ナビゲーション装置１の全体の制御を行う電子制御ユニットであり、演算装置及び制御装置としてのＣＰＵ５１、並びにＣＰＵ５１が各種の演算処理を行うにあたってワーキングメモリとして使用されるとともに、経路が探索されたときの経路データ等が記憶されるＲＡＭ５２、制御用のプログラムのほか、後述の自動運転支援プログラム（図４参照）等が記録されたＲＯＭ５３、ＲＯＭ５３から読み出したプログラムを記憶するフラッシュメモリ５４等の内部記憶装置を備えている。尚、ナビゲーションＥＣＵ３３は、処理アルゴリズムとしての各種手段を有する。例えば、進入位置取得手段は、交差点に対する車両の進入位置を取得する。退出位置取得手段は、交差点から車両が退出する退出位置を取得する。走行軌道生成手段は、進入位置から退出位置までの間の少なくとも一部を曲率が連続して変化する曲線で繋ぐことによって、交差点に対して車両に走行が推奨される走行軌道を生成する。運転支援手段は、走行軌道に基づいて車両の運転支援を行う。
【0034】
操作部３４は、走行開始地点としての出発地及び走行終了地点としての目的地を入力する際等に操作され、各種のキー、ボタン等の複数の操作スイッチ（図示せず）を有する。そして、ナビゲーションＥＣＵ３３は、各スイッチの押下等により出力されるスイッチ信号に基づき、対応する各種の動作を実行すべく制御を行う。尚、操作部３４は液晶ディスプレイ３５の前面に設けたタッチパネルを有しても良い。また、マイクと音声認識装置を有しても良い。
【0035】
また、液晶ディスプレイ３５には、道路を含む地図画像、交通情報、操作案内、操作メニュー、キーの案内、案内経路（走行予定経路）に沿った案内情報、ニュース、天気予報、時刻、メール、テレビ番組等が表示される。尚、液晶ディスプレイ３５の代わりに、ＨＵＤやＨＭＤを用いても良い。
【0036】
また、スピーカ３６は、ナビゲーションＥＣＵ３３からの指示に基づいて案内経路（走行予定経路）に沿った走行を案内する音声ガイダンスや、交通情報の案内を出力する。
【0037】
また、ＤＶＤドライブ３７は、ＤＶＤやＣＤ等の記録媒体に記録されたデータを読み取り可能なドライブである。そして、読み取ったデータに基づいて音楽や映像の再生、地図情報ＤＢ４５の更新等が行われる。尚、ＤＶＤドライブ３７に替えてメモリーカードを読み書きする為のカードスロットを設けても良い。
【0038】
また、通信モジュール３８は、交通情報センタ、例えば、ＶＩＣＳセンタやプローブセンタ等から送信された交通情報、プローブ情報、天候情報等を受信する為の通信装置であり、例えば携帯電話機やＤＣＭが該当する。また、車車間で通信を行う車車間通信装置や路側機との間で通信を行う路車間通信装置も含む。また、サーバ装置４で探索された経路情報や高精度地図情報１５をサーバ装置４との間で送受信するのにも用いられる。
【0039】
また、車外カメラ３９は、例えばＣＣＤ等の固体撮像素子を用いたカメラにより構成され、車両のフロントバンパの上方に取り付けられるとともに光軸方向を水平より所定角度下方に向けて設置される。そして、車外カメラ３９は、車両が自動運転区間を走行する場合において、車両の進行方向前方を撮像する。また、ナビゲーションＥＣＵ３３は撮像された撮像画像に対して画像処理を行うことによって、車両が走行する道路に描かれた区画線や周辺の他車両等の障害物を検出し、検出結果に基づいて自動運転支援に関する各種支援情報を生成する。例えば、障害物を検出した場合には、障害物を回避或いは追従して走行する新たな走行軌道を生成する。尚、車外カメラ３９は車両前方以外に後方や側方に配置するように構成しても良い。また、障害物を検出する手段としてはカメラの代わりにミリ波レーダやレーザセンサ等のセンサや車車間通信や路車間通信を用いても良い。
【0040】
また、車両制御ＥＣＵ４０は、ナビゲーション装置１が搭載された車両の制御を行う電子制御ユニットである。また、車両制御ＥＣＵ４０にはステアリング、ブレーキ、アクセル等の車両の各駆動部と接続されており、本実施形態では特に車両において自動運転支援が開始された後に、各駆動部を制御することにより車両の自動運転支援を実施する。また、自動運転支援中にユーザによってオーバーライドが行われた場合には、オーバーライドが行われたことを検出する。
【0041】
ここで、ナビゲーションＥＣＵ３３は、走行開始後にＣＡＮを介して車両制御ＥＣＵ４０に対してナビゲーション装置１で生成された自動運転支援に関する各種支援情報を送信する。そして、車両制御ＥＣＵ４０は受信した各種支援情報を用いて走行開始後の自動運転支援を実施する。支援情報としては例えば車両の走行が推奨される走行軌道、走行する際の車速を示す速度計画等がある。
【0042】
続いて、上記構成を有する本実施形態に係るナビゲーション装置１においてＣＰＵ５１が実行する自動運転支援プログラムについて図４に基づき説明する。図４は本実施形態に係る自動運転支援プログラムのフローチャートである。ここで、自動運転支援プログラムは、車両のＡＣＣ電源(accessory power supply)がＯＮされた後であって自動運転支援による車両の走行が開始された場合に実行され、ナビゲーション装置１で生成された支援情報に従って自動運転支援による支援走行を実施するプログラムである。また、以下の図４、図６、図１３、図２１及び図２６にフローチャートで示されるプログラムは、ナビゲーション装置１が備えているＲＡＭ５２やＲＯＭ５３に記憶されており、ＣＰＵ５１により実行される。
【0043】
先ず、自動運転支援プログラムではステップ（以下、Ｓと略記する）１において、ＣＰＵ５１は、車両が今後走行する予定にある経路（以下、走行予定経路という）を取得する。尚、車両の走行予定経路は、ナビゲーション装置１において案内経路が設定されている場合には、ナビゲーション装置１において現在設定されている案内経路の内、車両の現在位置から目的地までの経路を走行予定経路とする。一方、ナビゲーション装置１において案内経路が設定されていない場合には、車両の現在位置から道なりに走行する経路を走行予定経路としても良い。
【0044】
また、案内経路はナビゲーション装置１によって設定された出発地から目的地までの推奨経路であり、本実施形態では特にサーバ装置４によって探索される。推奨経路の探索を行う場合には先ずＣＰＵ５１は、サーバ装置４に対して経路探索要求を送信する。尚、経路探索要求には、経路探索要求の送信元のナビゲーション装置１を特定する端末ＩＤと、出発地（例えば車両の現在位置）及び目的地を特定する情報と、が含まれている。尚、再探索時については目的地を特定する情報は必ずしも必要では無い。その後、ＣＰＵ５１は経路探索要求に応じてサーバ装置４から送信された探索経路情報を受信する。探索経路情報は、送信した経路探索要求に基づいてサーバ装置４が最新のバージョンの地図情報を用いて探索した出発地から目的地までの推奨経路（センタールート）を特定する情報（例えば推奨経路に含まれるリンク列）である。例えば公知のダイクストラ法を用いて探索される。そして、ＣＰＵ５１は、受信した推奨経路をナビゲーション装置１の案内経路として設定する。
【0045】
次に、Ｓ２においてＣＰＵ５１は、車両の現在位置から前記Ｓ１で取得された走行予定経路に沿った所定距離以内の区間を対象として高精度地図情報１５を取得する。例えば車両が現在位置する２次メッシュに含まれる走行予定経路を対象として高精度地図情報１５を取得する。但し、高精度地図情報１５を取得する対象となるエリアは適宜変更可能であり、例えば車両の現在位置から走行予定経路に沿って３ｋｍ以内のエリアの高精度地図情報１５を取得するようにしても良い。また、走行予定経路の全体を対象として高精度地図情報１５を取得しても良い。
【0046】
ここで、高精度地図情報１５は図５に示すように矩形形状（例えば５００ｍ×１ｋｍ）に区分されてサーバ装置４の高精度地図ＤＢ１３に格納されている。従って、例えば図５に示すように走行予定経路６１が取得された場合には、車両の現在位置を含む２次メッシュ内にある走行予定経路６１を含むエリア６２～６４を対象として高精度地図情報１５が取得される。高精度地図情報１５には例えば道路のレーン形状と道路に描かれた区画線（車道中央線、車線境界線、車道外側線、誘導線等）に関する情報が含まれる。また、その他に交差点に関する情報、駐車場に関する情報等も含まれる。
【0047】
また、高精度地図情報１５は基本的にサーバ装置４から取得されるが、キャッシュ４６に既に格納されているエリアの高精度地図情報１５が存在する場合には、キャッシュ４６から取得する。また、サーバ装置４から取得された高精度地図情報１５はキャッシュ４６に一旦格納される。
【0048】
その後、Ｓ３においてＣＰＵ５１は、後述の静的走行軌道生成処理（図６）を実行する。ここで、静的走行軌道生成処理は、車両の走行予定経路と前記Ｓ２で取得した高精度地図情報１５とに基づいて、走行予定経路に含まれる道路に対して車両に走行が推奨される走行軌道である静的走行軌道を生成する処理である。尚、静的走行軌道は後述のように車両の現在位置から進行方向に沿って所定距離前方までの区間（例えば車両が現在位置する２次メッシュ内、或いは目的地までの全区間）を対象として生成される。尚、所定距離については適宜変更可能であるが、少なくとも車外カメラ３９やその他のセンサによって車両周辺の道路状況を検出することが可能な範囲（検出範囲）外を含む領域を対象として静的走行軌道を生成する。
【0049】
次に、Ｓ４においてＣＰＵ５１は、前記Ｓ２で取得した高精度地図情報１５に基づいて、前記Ｓ３で生成された静的走行軌道を走行する際の車両の速度計画を生成する。例えば、制限速度情報や走行予定経路上にある速度変化地点（例えば交差点、カーブ、踏切、横断歩道など）を考慮して、静的走行軌道を走行する際に推奨される車両の走行速度を算出する。
【0050】
そして、前記Ｓ４で生成された速度計画は、自動運転支援に用いる支援情報としてフラッシュメモリ５４等に格納される。また、前記Ｓ４で生成された速度計画を実現する為に必要な車両の加減速を示す加速度の計画についても自動運転支援に用いる支援情報として生成するようにしても良い。
【0051】
続いて、Ｓ５においてＣＰＵ５１は、車外カメラ３９で撮像された撮像画像に対して画像処理を行うことによって、周辺の道路状況として、特に自車両の周辺に自車両の走行に影響が生じる要因が存在するか否かを判定する。ここで、前記Ｓ５で判定対象となる“自車両の走行に影響が生じる要因”は、リアルタイムで変化する動的な要因とし、道路構造に基づくような静的な要因は除かれる。例えば、自車両の進行方向前方を走行又は駐車する他車両、自車両の進行方向前方に位置する歩行者、自車両の進行方向前方にある工事区間等が該当する。一方で、交差点、カーブ、踏切、合流区間、車線減少区間等は除かれる。また、他車両、歩行者、工事区間が存在する場合であっても、それらが自車両の今後の走行軌道と重複する虞のない場合（例えば自車両の今後の走行軌道から離れた位置にある場合）については“自車両の走行に影響が生じる要因”からは除かれる。また、車両の走行に影響が生じる可能性のある要因を検出する手段としてはカメラの代わりにミリ波レーダやレーザセンサ等のセンサや車車間通信や路車間通信を用いても良い。
【0052】
そして、自車両の周辺に自車両の走行に影響が生じる要因が存在すると判定された場合（Ｓ５：ＹＥＳ）には、Ｓ６へと移行する。それに対して、自車両の周辺に自車両の走行に影響が生じる要因が存在しないと判定された場合（Ｓ５：ＮＯ）には、Ｓ９へと移行する。
【0053】
Ｓ６においてＣＰＵ５１は、後述の動的走行軌道生成処理（図２１）を実行する。ここで、動的走行軌道生成処理は、車両の現在位置から前記Ｓ５で検出された“自車両の走行に影響が生じる要因”を回避或いは追従して静的走行軌道に戻る為の新たな軌道を動的走行軌道として生成する。尚、動的走行軌道は後述のように“自車両の走行に影響が生じる要因”を含む区間を対象として生成される。また、区間の長さは要因の内容によって変化する。例えば、“自車両の走行に影響が生じる要因”が車両の前方を走行する他車両（前方車両）である場合には、一例として右側に車線変更して前方車両を追い越し、その後に左側に車線変更して元の車線に戻るまでの軌道が動的走行軌道として生成される。尚、動的走行軌道は、車外カメラ３９やその他のセンサで取得した車両周辺の道路状況に基づいて生成されるので、動的走行軌道が生成される対象となる領域は、少なくとも車外カメラ３９やその他のセンサによって車両周辺の道路状況を検出することが可能な範囲（検出範囲）内となる。
【0054】
続いて、Ｓ７においてＣＰＵ５１は、後述の走行軌道反映処理（図２６）を実行する。ここで、走行軌道反映処理は、前記Ｓ６で新たに生成された動的走行軌道を、前記Ｓ３で生成された静的走行軌道に反映する処理である。具体的には、車両の現在位置から“自車両の走行に影響が生じる要因”を含む区間の終端まで、静的走行軌道、及び少なくとも一以上の動的走行軌道の夫々のコストを算出し、該コストが最少となる走行軌道を選択する。結果的に、必要に応じて静的走行軌道の一部が動的走行軌道に置き換わることになる。尚、状況によっては動的走行軌道の置き換えが行われない場合、即ち動的走行軌道の反映が行われても前記Ｓ３で生成された静的走行軌道から変化しない場合もある。更に、動的走行軌道と静的走行軌道が同じ軌道である場合には、置き換えが行われても前記Ｓ３で生成された静的走行軌道から変化しない場合もある。
【0055】
次に、Ｓ８においてＣＰＵ５１は、前記Ｓ７で動的走行軌道が反映された後の静的走行軌道について、反映された動的走行軌道の内容に基づいて前記Ｓ４で生成された車両の速度計画を修正する。尚、動的走行軌道の反映が行われた結果、前記Ｓ３で生成された静的走行軌道から変化しない場合には、Ｓ８の処理については省略しても良い。
【0056】
続いて、Ｓ９においてＣＰＵ５１は、前記Ｓ３で生成された静的走行軌道（前記Ｓ７で動的走行軌道の反映が行われている場合には反映後の軌道）を前記Ｓ４で生成された速度計画（前記Ｓ８で速度計画の修正が行われている場合には修正後の計画）に従った速度で車両が走行する為の制御量を演算する。具体的には、アクセル、ブレーキ、ギヤ及びステアリングの制御量が夫々演算される。尚、Ｓ９及びＳ１０の処理についてはナビゲーション装置１ではなく車両を制御する車両制御ＥＣＵ４０が行うようにしても良い。
【0057】
その後、Ｓ１０においてＣＰＵ５１は、Ｓ９において演算された制御量を反映する。具体的には、演算された制御量を、ＣＡＮを介して車両制御ＥＣＵ４０へと送信する。車両制御ＥＣＵ４０では受信した制御量に基づいてアクセル、ブレーキ、ギヤ及びステアリングの各車両制御が行われる。その結果、前記Ｓ３で生成された静的走行軌道（前記Ｓ７で動的走行軌道の反映が行われている場合には反映後の軌道）を前記Ｓ４で生成された速度計画（前記Ｓ８で速度計画の修正が行われている場合には修正後の計画）に従った速度で走行する走行支援制御が可能となる。
【0058】
次に、Ｓ１１においてＣＰＵ５１は、前記Ｓ３で静的走行軌道の生成が行われてから車両が一定距離走行したか否かを判定する。例えば一定距離は１ｋｍとする。
【0059】
そして、前記Ｓ３で静的走行軌道の生成が行われてから車両が一定距離走行したと判定された場合（Ｓ１１：ＹＥＳ）には、Ｓ１へと戻る。その後、車両の現在位置から走行予定経路に沿った所定距離以内の区間を対象として、静的走行軌道の生成が再度行われる（Ｓ１～Ｓ４）。尚、本実施形態では車両が一定距離（例えば１ｋｍ）走行する度に、車両の現在位置から走行予定経路に沿った所定距離以内の区間を対象として、静的走行軌道の生成が繰り返し行われることとしているが、目的地までの距離が短い場合には走行開始時点において目的地までの静的走行軌道の生成を一度に行うようにしても良い。
【0060】
一方、前記Ｓ３で静的走行軌道の生成が行われてから車両が一定距離走行していないと判定された場合（Ｓ１１：ＮＯ）には、自動運転支援による支援走行を終了するか否かを判定する（Ｓ１２）。自動運転支援による支援走行を終了する場合としては、目的地に到着した場合以外に、ユーザが車両に設けられた操作パネルを操作したり、ハンドル操作やブレーキ操作などが行われることによって自動運転支援による走行を意図的に解除（オーバーライド）した場合がある。
【0061】
そして、自動運転支援による支援走行を終了すると判定された場合（Ｓ１２：ＹＥＳ）には、当該自動運転支援プログラムを終了する。それに対して自動運転支援による支援走行を継続すると判定された場合（Ｓ１２：ＮＯ）には、Ｓ５へと戻る。
【0062】
【0063】
先ず、Ｓ２１においてＣＰＵ５１は、現在位置検出部３１により検出した車両の現在位置を取得する。尚、車両の現在位置は、例えば高精度のＧＰＳ情報や高精度ロケーション技術を用いて詳細に特定することが望ましい。ここで、高精度ロケーション技術とは、車両に設置されたカメラから取り込んだ白線や路面ペイント情報を画像認識により検出し、更に、検出した白線や路面ペイント情報を例えば高精度地図情報１５と照合することにより、走行車線や高精度な車両位置を検出可能にする技術である。更に、車両が複数の車線からなる道路を走行する場合には車両の走行する車線についても特定する。
【0064】
次に、Ｓ２２においてＣＰＵ５１は、前記Ｓ２で取得した高精度地図情報１５に基づいて、車両の進行方向前方の静的走行軌道を生成する区間（例えば車両の現在位置を含む２次メッシュ内）を対象として、レーン形状、区画線情報、交差点に関する情報等を取得する。尚、前記Ｓ２２で取得されるレーン形状と区画線情報には、車線数、車線数の増減がある場合にはどの位置でどのように増減するか、車線毎の進行方向の通行区分や道路の繋がり（具体的には、交差点の通過前の道路に含まれる車線と交差点の通過後の道路に含まれる車線との対応関係）を特定する情報等を含む。また、交差点に関する情報としては、交差点の形状に加えて交差点上に配置された地物の位置や形状に関する情報を含む。更に、“交差点上に配置された地物”には、誘導線（ガイド白線）、交差点中央に配置されるひし形の導流帯（ダイヤマーク）等の路面に描かれた路面表示の他、ポール等の構造物がある。
【0065】
続いて、Ｓ２３においてＣＰＵ５１は、前記Ｓ２２で取得したレーン形状と区画線情報とに基づいて、車両の進行方向前方の静的走行軌道を生成する区間を対象としてレーンネットワークの構築を行う。ここで、レーンネットワークは車両が選択し得る車線移動を示したネットワークである。
【0066】
ここで、前記Ｓ２３におけるレーンネットワークを構築する例として、例えば図７に示す走行予定経路を車両が走行する場合を例に挙げて説明する。図７に示す走行予定経路は、車両の現在位置から直進した後に次の交差点７１で右折し、更に次の交差点７２でも右折し、次の交差点７３で左折する経路とする。図７に示す走行予定経路では、例えば交差点７１で右折する場合に右側の車線に進入することも可能であるし、左側の車線に進入することも可能である。但し、次の交差点７２で右折する必要があるので、交差点７２の進入時点では最も右側の車線に車線移動する必要がある。また、交差点７２で右折する場合においても右側の車線に進入することも可能であるし、左側の車線に進入することも可能である。但し、次の交差点７３で左折する必要があるので、交差点７３の進入時点では最も左側の車線に車線移動する必要がある。このような車線移動が可能な区間を対象として構築したレーンネットワークを図８に示す。
【0067】
図８に示すようにレーンネットワークは、車両の進行方向前方の静的走行軌道を生成する区間を複数の区画（グループ）に区分する。具体的には、交差点の進入位置、交差点の退出位置、車線が増減する位置を境界として区分する。そして、区分された各区画の境界に位置する各車線に対してノード点（以下、レーンノードという）７５が設定されている。更に、レーンノード７５間をつなぐリンク（以下、レーンリンクという）７６が設定されている。
【0068】
次に、Ｓ２４においてＣＰＵ５１は、前記Ｓ２３で構築されたレーンネットワークに対して、レーンネットワークの始点に位置するレーンノードに対して車両が移動を開始する開始レーンを設定し、レーンネットワークの終点に位置するレーンノードに対して車両が移動する目標となる目標レーンを設定する。そして、レーンネットワークを参照し、開始レーンから目標レーンまでを連続して繋ぐルートを探索する。ルートの探索には例えばダイクストラ法を用い、レーンコストの合計が最小となるルートを車両が移動する際に推奨される車両の車線移動態様として特定する。
【0069】
尚、レーンコストは、レーンリンク７６毎に付与されており、各レーンリンク７６の長さを基準値とする。そして、基準値に対して以下の（１）～（３）の条件で補正を行う。尚、基本的に同一の区画（グループ）内のレーンリンク７６は同一の長さとみなす。また、交差点内のレーンリンク７６の長さは０又は固定値とみなす。但し、開始レーンから目標レーンまでを連続して繋ぐルートを探索できるのであればダイクストラ法以外の探索手段を用いても良い。
【0070】
（１）レーンコストは、基準値に対して必要な車線変更の回数に応じた車線変更係数αを乗じる。ここで、車線変更係数は、図９に示すように必要な車線変更の回数の多いレーンリンク７６程、より大きい値となる。例えば、車線８１から車線８２へと移動するレーンリンク７６は、１回の車線変更が必要となるので、車線変更係数αとして１．２が基準値に乗じられる。また、車線８１から車線８３へと移動するレーンリンク７６は、連続した２回の車線変更が必要となるので、車線変更係数αとしてより大きい１．５が基準値に乗じられる。一方、車線８１を維持するレーンリンク７６は、車線変更が不要なので車線変更係数αを乗じない。その結果、車線変更の回数が多いルート程、より大きいレーンコストの合計値が算出されるので、推奨される車線移動態様として選択され難くなる。また、同一区間で複数の車線変更を行う（即ち車線変更が連続して行われる）ルートについては、車線変更が連続して行われないルートより大きいレーンコストの合計値が算出されるので、推奨される車線移動態様として選択され難くなる。
【0071】
（２）車線変更せずに追い越し車線（例えば左側通行では最も右側の車線）を走行するレーンリンクのレーンコストについては基準値に対して所定値を加算する。例えば図１０に示すように追い越し車線である車線８３を走行するレーンリンク７６は基準値に『５』加算される。その結果、追い越し車線を走行する距離の長いルート程、より大きいレーンコストの合計値が算出されるので、推奨される車線移動態様として選択され難くなる。
【0072】
（３）車線変更を行うレーンリンクのレーンコストについては、車線変更を行う位置の候補を複数パターン生成し、複数のパターン毎にレーンコストを算出する。具体的には、パターン毎に車線変更を行う位置を参照し、（Ａ）車線変更前又は後の追い越し車線の走行距離が閾値より長くなる場合、（Ｂ）複数回の車線変更を行う際に車線変更の間隔が閾値より短くなる（即ち連続で車線変更を行う）場合、そして（Ｃ）交差点の手前側所定距離（例えば一般道路７００ｍ、高速道路２ｋｍ）以内で車線変更を行う場合のいずれかに該当するパターンについては、車線変更を行うレーンリンクのレーンコストについて基準値に対して更に所定値を加算する。例えば図１１に示すように交差点の所定距離手前から交差点までの間で車線８１から車線８２へと移動するパターンについては、基準値に『５』加算される。そして、前記Ｓ２４では、レーンコストの合計が最小となるルート（車線移動のパターンを含む）を車両が移動する際に推奨される車両の車線移動態様として特定することによって、車線変更を行うのに推奨される区間に加えて、該区間内において車線変更を行うのに推奨される位置についても特定されることとなる。尚、車線変更が連続して行われる車線移動のパターンや、車線変更前又は後に追い越し車線を走行する距離の長い車線移動のパターンや、交差点の所定距離手前から交差点までの間で車線変更を行う車線移動のパターンについて、そのような車線変更が行われないパターンより大きいレーンコストの合計値が算出されるので、推奨される車線移動態様として選択され難くなる。
【0073】
また、上記（３）の条件では、特に複数回の車線変更を行うレーンリンクのレーンコストについても同様の処理を行う。例えば、図１２では最も左側の車線から２回の車線変更を行うレーンリンクを例に挙げて説明する。図１２に示す例では車線変更を行う位置として、できる限り車両が現在の走行車線を継続して走行し、交差点付近で２回の車線変更を行う第１のパターンと、交差点までの間において略等間隔で２回の車線変更を行う第２のパターンと、できる限り早いタイミングで車線変更を行う第３のパターンが候補として考えられる。ここで、第１のパターンは、車線変更が短い間隔で連続して行われ、且つ交差点の近くで車線変更が行われることから、高いコストが算出される。また、第３のパターンは、右側の追い越し車線の走行距離が長くなるので、同じく高いコストが算出される。それに対して第２のパターンは、車線変更が短い間隔でなく、交差点の近くで車線変更も行われず、右側の追い越し車線の走行距離も比較的短いので、他のパターンに比べて低いコストが算出される。従って、図１２に示す例では、車線変更を行う位置として第２のパターンが最もコストが小さく、推奨される車両の車線移動態様として選択され易くなる。
【0074】
次に、Ｓ２５においてＣＰＵ５１は、前記Ｓ２４で選択されたルートに従って、車両が車線移動する場合において、特に車線変更を行う区画（グループ）を対象として推奨される走行軌道を算出する。尚、前記Ｓ２４で選択されたルートが車線変更を一度も行わないルートである場合にはＳ２５の処理は省略しても良い。
【0075】
具体的にＣＰＵ５１は、前記Ｓ２４において特定された車線変更を行う位置の地図情報等を用いて走行軌道を算出する。例えば、車両の速度（その道路の制限速度とする）と車線幅から車両が車線変更を行う際に生じる横方向の加速度（横Ｇ）を算出し、横Ｇが自動運転支援に支障が生じることなく、また車両の乗員に不快感を与えない上限値（例えば０．２Ｇ）を超えないことを条件として、クロソイド曲線を用いてできる限り円滑で、且つできる限り車線変更に必要な距離が短くなる軌道を算出する。尚、クロソイド曲線は、車両が一定の走行速度で且つステアリングを一定の角速度で回した場合に車両の軌跡が描く曲線である。
【0076】
次に、Ｓ２６においてＣＰＵ５１は、後述の交差点走行軌道生成処理（図１３）を実行する。ここで、交差点走行軌道生成処理は、前記Ｓ２４で選択されたルートに従って、車両が車線移動する場合において、特に交差点内の区画（グループ）を対象として推奨される走行軌道を生成する処理である。尚、前記Ｓ２４で選択されたルートが交差点を一度も通過しないルートである場合にはＳ２６の処理は省略しても良い。
【0077】
その後、Ｓ２７においてＣＰＵ５１は、前記Ｓ２５及びＳ２６で算出された各走行軌道を繋ぐことによって、走行予定経路に含まれる道路に対して車両に走行が推奨される走行軌道である静的走行軌道を生成する。尚、車線変更を行う区画でもなく交差点内の区画でもない区画については、車線の中央を通過する軌道を車両の走行が推奨される走行軌道とする。
【0078】
そして、前記Ｓ２７で生成された静的走行軌道は、自動運転支援に用いる支援情報としてフラッシュメモリ５４等に格納される。
【0079】
【0080】
先ず、Ｓ３１においてＣＰＵ５１は、交差点を通過する車両が通過すべき位置（以下、通過点という）についてマーキングする。尚、通過点の位置の特定には、前記Ｓ２４で特定されたレーンネットワークのルート（交差点の前後で車両の走行する車線を特定する情報）に加えて、交差点の形状、交差点上に配置された地物の位置や形状を用いる。具体的には、図１４に示すように交差点への進入車線内、交差点への進入位置、交差点内の誘導線内（誘導線がある場合のみ）、交差点内のひし形の導流帯（ダイヤマーク）の内側（ダイヤマークがある場合のみ）、交差点からの退出位置、交差点からの退出車線に対して夫々通過点をマーキングする。尚、交差点への進入車線内と退出車線内の通過点のマーキングは省略しても良い。
【0081】
次に、Ｓ３２においてＣＰＵ５１は、前記Ｓ３１でマーキングされた通過点を図１５に示すように直交座標系に配置して各通過点の座標を算出し、更にスプライン補間により各通過点を通過する曲線８５を算出する。算出された曲線８５はｎ次（例えば３次）のスプライン曲線となる。
【0082】
続いて、Ｓ３３においてＣＰＵ５１は、図１６に示すように前記Ｓ３２で算出された曲線８５について始点から終点までを所定距離間隔（例えば１ｍ間隔）でサンプリングし、サンプリングされた各点（以下、サンプリング点という）の座標を取得する。尚、サンプリングする間隔は曲線８５の曲率に基づいて変更するのが好ましい。例えば、曲線８５の曲率が大きい程、サンプリングする間隔をより短くする。
【0083】
その後、Ｓ３４においてＣＰＵ５１は、走行軌道を生成する対象範囲を設定する。例えば最初は、曲線８５の始点を含めて進行方向に５つ分のサンプリング点を対象範囲に設定する。尚、Ｓ３４以降の処理は繰り返し実行され、後述のように対象範囲は徐々に進行方向側に移動して設定されることとなる。また、以下の説明では対象範囲の広さは５つ分のサンプリング点としているが、対象範囲はより狭く或いはより広く設定することも可能である。
【0084】
次に、Ｓ３５においてＣＰＵ５１は、図１７に示すように前記Ｓ３４で設定された対象範囲の始点に位置するサンプリング点から、進行方向（次のサンプリング点の方向）に延びるクロソイド曲線８６を生成する。尚、クロソイド曲線８６は、車両が一定の走行速度で且つステアリングを一定の角速度で回した場合に車両の軌跡が描く曲線、即ち曲率が一定の割合で連続して変化する曲線であり、前記Ｓ３５ではクロソイド係数を変更することによって複数本のクロソイド曲線を生成する。例えば図１７に示す例では直線（曲率０のクロソイド曲線に相当）を含めて７本のクロソイド曲線８６が生成されているが、生成されるクロソイド曲線８６の数は適宜変更可能である。尚、生成されるクロソイド曲線の数が多い程、より推奨される走行軌道が生成可能となる一方で、生成の為の処理負担は増加する。
【0085】
続いて、Ｓ３６においてＣＰＵ５１は、前記Ｓ３５で生成されたクロソイド曲線８６の内、対象範囲のサンプリング点との差が最小となるクロソイド曲線（以下、近似クロソイド曲線という）８６を選択する。尚、前記Ｓ３６で選択される曲線は、対象範囲のサンプリング点の近似曲線、即ち前記Ｓ３１でマーキングされた通過点にできる限り近接する曲線に相当する。
【0086】
その後、Ｓ３７においてＣＰＵ５１は、図１８に示すように前記Ｓ３４で設定された対象範囲の始点に相当するサンプリング点に隣接する次のサンプリング点に対応する近似クロソイド曲線８６上の点（以下、補正点８７という）を算出する。具体的には、次のサンプリング点から最も近い位置にある近似クロソイド曲線８６上の点を補正点８７として算出する。更に、前記Ｓ３４で設定された対象範囲の始点から補正点８７までの近似クロソイド曲線８６の区間を、決定パス８８としてフラッシュメモリ５４等に格納する。尚、決定パスは、交差点を通過する際の推奨される走行軌道の一部となる。
【0087】
続いて、Ｓ３８においてＣＰＵ５１は、図１９に示すように前記Ｓ３４で設定された対象範囲の始点に相当するサンプリング点に隣接する次のサンプリング点について、補正点８７へと修正（変更）する。
【0088】
その後、Ｓ３９では前記Ｓ３７で格納された決定パス８８が、前記Ｓ３２で算出された曲線８５の終点に対応するサンプリング点まで到達したか否かを判定する。そして、前記Ｓ３７で格納された決定パス８８が、前記Ｓ３２で算出された曲線８５の終点に対応するサンプリング点まで到達したと判定された場合（Ｓ３９：ＹＥＳ）には、Ｓ４０へと移行する。一方、前記Ｓ３７で格納された決定パス８８が、前記Ｓ３２で算出された曲線８５の終点に対応するサンプリング点まで到達していないと判定された場合（Ｓ３９：ＮＯ）には、Ｓ３４へと戻る。そして、Ｓ３４では図１９に示すように対象範囲を前記Ｓ３８で修正したサンプリング点を始点とした範囲へと更新し、Ｓ３５以降の処理を再度実行する。
【0089】
Ｓ４０においてＣＰＵ５１は、前記Ｓ３７でフラッシュメモリ５４に格納された全ての決定パス８８を読み出して接続する。そして、接続された決定パス８８が、前記Ｓ２４で選択されたルートに従って、車両が車線移動する場合において、特に交差点内の区画（グループ）を通過する際の推奨される走行軌道となる。尚、前記Ｓ２４で選択されたルートが複数の交差点を通過する場合には、通過対象となる交差点毎に上述した交差点走行軌道生成処理（Ｓ３１～Ｓ４０）を実行する。
【0090】
上記例では交差点に対する車両の進入位置から退出する退出位置までの間を、曲率が一定の割合で連続して変化するクロソイド曲線で繋ぐことによって走行軌道を生成しているが、特に大型の交差点では図２０に示すように曲率を固定した円弧（曲率が固定されたクロソイド曲線に相当）を間に挟んだ走行軌道とする方が好ましい。その場合には、進入位置から交差点内にある第１中間地点までの間については曲率が徐々に大きく変化する曲線で繋ぎ、第１中間地点から第２中間地点までの間を曲率が固定の曲線で繋ぎ、第２中間地点から退出位置までの間を曲率が徐々に小さく変化する曲線で繋ぐことによって走行軌道が生成される。尚、第１中間地点や第２中間地点の位置は、交差点の形状によって適宜設定される。一方で比較的小型の交差点では円弧を挟むことなく、進入位置から交差点内にある中間地点までの間については曲率が徐々に大きく変化する曲線で繋ぎ、中間地点から退出位置までの間を曲率が徐々に小さく変化する曲線で繋ぐことによって走行軌道を生成するのが望ましい。
【0091】
【0092】
先ず、Ｓ４１においてＣＰＵ５１は、現在位置検出部３１により検出した自車両の現在位置を取得する。尚、車両の現在位置は、例えば高精度のＧＰＳ情報や高精度ロケーション技術を用いて詳細に特定することが望ましい。ここで、高精度ロケーション技術とは、車両に設置されたカメラから取り込んだ白線や路面ペイント情報を画像認識により検出し、更に、検出した白線や路面ペイント情報を例えば高精度地図情報１５と照合することにより、走行車線や高精度な車両位置を検出可能にする技術である。更に、車両が複数の車線からなる道路を走行する場合には車両の走行する車線についても特定する。
【0093】
次に、Ｓ４２においてＣＰＵ５１は、前記Ｓ３で生成された静的走行軌道（即ち、自車両が今度に走行する予定の軌道）と、前記Ｓ４で生成された速度計画（即ち、自車両の今度の予定速度）を取得する。
【0094】
次に、Ｓ４３においてＣＰＵ５１は、前記Ｓ２で取得した高精度地図情報１５に基づいて、車両の進行方向前方の特に前記Ｓ５で検出された“自車両の走行に影響が生じる要因（以下、影響要因という）”の周辺を対象として、レーン形状、区画線情報等を取得する。尚、前記Ｓ４３で取得されるレーン形状と区画線情報には、車線数、車線数の増減がある場合にはどの位置でどのように増減するかを特定する情報等を含む。
【0095】
続いて、Ｓ４４においてＣＰＵ５１は、前記Ｓ５で検出された影響要因について、現時点の影響要因の位置と、影響要因が移動している場合には移動状況（移動方向、移動速度）について取得する。尚、影響要因の位置と移動状況については、例えば車外カメラ３９で車両周辺の所定の検出範囲を撮像した撮像画像に対して画像処理等を行うことによって取得する。
【0096】
その後、Ｓ４５においてＣＰＵ５１は、先ず前記Ｓ４４で取得した影響要因の現在位置及び移動状況に基づいて影響要因の今後の移動軌跡を予測する。尚、影響要因が他車両である場合には、他車両のウィンカーやブレーキランプの点灯状態について考慮して予測しても良い。更に、車車間通信などで他車両の今後の走行軌道や速度計画が取得可能であれば、それらを考慮して予測しても良い。その後、予測された影響要因の今後の移動軌跡と前記Ｓ４２で取得した自車両の静的走行軌道及び速度計画とに基づいて、影響要因が自車両の走行に影響があるか否かをより正確に判定する。具体的には自車両と影響要因が現時点又は将来において同一の車線上に位置し、その間の距離が適切な車間距離Ｄ以内に接近すると予測される場合に、影響要因が自車両の走行に影響があると判定する。尚、適切な車間距離Ｄは例えば以下の式（１）により算出する。
Ｄ＝自車両の車速×２ｓｅｃ＋自車両の制動距離－影響要因の制動距離（但し、影響要因が移動体の場合に限る）・・・・（１）
Ｄ＝自車両の車速×２ｓｅｃ＋自車両の制動距離－影響要因の制動距離（但し、影響要因が移動体の場合に限る）・・・・（１）
【0097】
そして、影響要因が自車両の走行に影響があると判定された場合（Ｓ４５：ＹＥＳ）には、Ｓ４６へと移行する。一方、影響要因が自車両の走行に影響がないと判定された場合（Ｓ４５：ＮＯ）には、動的走行軌道を生成することなくＳ９（Ｓ７、Ｓ８は省略する）へと移行する。
【0098】
Ｓ４６においてＣＰＵ５１は、自車両が影響要因を回避して静的走行軌道に戻る（即ち追い越しする）為の新たな軌道を生成することが可能か否かを判定する。具体的には、影響要因と自車両が現時点で同一車線に位置する場合には、自車両が右側に車線変更して制限速度を超えない範囲で影響要因を追い越し、その後に左側に車線変更して元の車線に戻るまでの軌道について、影響要因と適切な車間距離Ｄ以上を維持する軌道を描くことができる場合には、自車両が影響要因を回避して静的走行軌道に戻る為の新たな軌道を生成することが可能と判定される。また、影響要因と自車両が現時点で異なる車線に位置し、その後に同一車線上へと移動する場合には、自車両が制限速度を超えない範囲で影響要因を追い越し、その後に影響要因と同一車線に車線変更するまでの軌道について、影響要因と適切な車間距離Ｄ以上を維持する軌道を描くことができる場合には、自車両が影響要因を回避して静的走行軌道に戻る為の新たな軌道を生成することが可能と判定される。上記Ｓ４６の判定処理は、前記Ｓ４３で取得した車両の進行方向前方のレーン形状及び区画線情報と、車両の現在位置と、影響要因の今後の移動軌跡と、道路の制限速度とに基づいて判定される。
【0099】
そして、自車両が影響要因を回避して静的走行軌道に戻る（即ち追い越しする）為の新たな軌道を生成することが可能と判定された場合（Ｓ４６：ＹＥＳ）には、Ｓ４７へと移行する。それに対して、自車両が影響要因を回避して静的走行軌道に戻る（即ち追い越しする）為の新たな軌道を生成することができないと判定された場合（Ｓ４６：ＮＯ）には、Ｓ４８へと移行する。
【0100】
Ｓ４７においてＣＰＵ５１は、自車両が影響要因を回避して静的走行軌道に戻る（即ち追い越しする）為の軌道（以下、回避軌道という）を算出する。具体的には、自車両と影響要因が現時点で同一車線上にある場合には、図２２に示すように自車両が右側に車線変更して影響要因を追い越し、その後に左側に車線変更して元の車線に戻るまでの軌道が回避軌道に該当する。一方、自車両と影響要因が現時点で異なる車線上にあってその後に同一車線上へと移動する必要がある場合には、図２３に示すように自車両が影響要因を追い越し、その後に車線変更して影響要因と同一車線へと移動するまでの軌道が回避軌道に該当する。
【0101】
ここで、図２２は片側２車線の道路において自車両９０が左側車線を走行し、影響要因が同車線を走行する前方車両９１である場合に前記Ｓ４７で生成される回避軌道の一例を示す。
先ず、図２２に示す例では、ステアリングの旋回を開始して右側の車線へと移動し、且つステアリングの位置が直進方向に戻るのに必要な第１の軌道Ｌ１を算出する。尚、第１の軌道Ｌ１は車両の現在の車速に基づいて車線変更を行う際に生じる横方向の加速度（横Ｇ）を算出し、横Ｇが自動運転支援に支障が生じることなく、また車両の乗員に不快感を与えない上限値（例えば０．２Ｇ）を超えないことを条件として、クロソイド曲線を用いてできる限り円滑で、且つできる限り車線変更に必要な距離が短くなる軌道を算出する。また、前方車両９１との間に適切な車間距離Ｄ以上を維持することについても条件とする。
次に、右側の車線を制限速度を上限に走行して前方車両９１を追い越し、且つ前方車両９１との間を適切な車間距離Ｄ以上とするまでの第２の軌道Ｌ２を算出する。尚、第２の軌道Ｌ２は基本的に直線の軌道であり、また軌道の長さは、前方車両９１の車速と道路の制限速度に基づいて算出される。
続いて、ステアリングの旋回を開始して左側の車線へと戻り、且つステアリングの位置が直進方向に戻るのに必要な第３の軌道Ｌ３を算出する。尚、第３の軌道Ｌ３は車両の現在の車速に基づいて車線変更を行う際に生じる横方向の加速度（横Ｇ）を算出し、横Ｇが自動運転支援に支障が生じることなく、また車両の乗員に不快感を与えない上限値（例えば０．２Ｇ）を超えないことを条件として、クロソイド曲線を用いてできる限り円滑で、且つできる限り車線変更に必要な距離が短くなる軌道を算出する。また、前方車両９１との間に適切な車間距離Ｄ以上を維持することについても条件とする。
先ず、図２２に示す例では、ステアリングの旋回を開始して右側の車線へと移動し、且つステアリングの位置が直進方向に戻るのに必要な第１の軌道Ｌ１を算出する。尚、第１の軌道Ｌ１は車両の現在の車速に基づいて車線変更を行う際に生じる横方向の加速度（横Ｇ）を算出し、横Ｇが自動運転支援に支障が生じることなく、また車両の乗員に不快感を与えない上限値（例えば０．２Ｇ）を超えないことを条件として、クロソイド曲線を用いてできる限り円滑で、且つできる限り車線変更に必要な距離が短くなる軌道を算出する。また、前方車両９１との間に適切な車間距離Ｄ以上を維持することについても条件とする。
次に、右側の車線を制限速度を上限に走行して前方車両９１を追い越し、且つ前方車両９１との間を適切な車間距離Ｄ以上とするまでの第２の軌道Ｌ２を算出する。尚、第２の軌道Ｌ２は基本的に直線の軌道であり、また軌道の長さは、前方車両９１の車速と道路の制限速度に基づいて算出される。
続いて、ステアリングの旋回を開始して左側の車線へと戻り、且つステアリングの位置が直進方向に戻るのに必要な第３の軌道Ｌ３を算出する。尚、第３の軌道Ｌ３は車両の現在の車速に基づいて車線変更を行う際に生じる横方向の加速度（横Ｇ）を算出し、横Ｇが自動運転支援に支障が生じることなく、また車両の乗員に不快感を与えない上限値（例えば０．２Ｇ）を超えないことを条件として、クロソイド曲線を用いてできる限り円滑で、且つできる限り車線変更に必要な距離が短くなる軌道を算出する。また、前方車両９１との間に適切な車間距離Ｄ以上を維持することについても条件とする。
【0102】
また、図２３は片側２車線の道路において自車両９０が右側車線を走行し、左側車線へ移動する必要がある状況において、影響要因が左側車線を走行する前方車両９１である場合に前記Ｓ４７で生成される回避軌道の一例を示す。
先ず、図２３に示す例では、右側の車線を制限速度を上限に走行して前方車両９１を追い越し、且つ前方車両９１との間を適切な車間距離Ｄ以上とするまでの第１の軌道Ｌ４を算出する。尚、第１の軌道Ｌ４は基本的に直線の軌道であり、また軌道の長さは、前方車両９１の車速と道路の制限速度に基づいて算出される。
続いて、ステアリングの旋回を開始して左側の車線へと移動し、且つステアリングの位置が直進方向に戻るのに必要な第２の軌道Ｌ５を算出する。尚、第２の軌道Ｌ５は車両の現在の車速に基づいて車線変更を行う際に生じる横方向の加速度（横Ｇ）を算出し、横Ｇが自動運転支援に支障が生じることなく、また車両の乗員に不快感を与えない上限値（例えば０．２Ｇ）を超えないことを条件として、クロソイド曲線を用いてできる限り円滑で、且つできる限り車線変更に必要な距離が短くなる軌道を算出する。また、前方車両９１との間に適切な車間距離Ｄ以上を維持することについても条件とする。
先ず、図２３に示す例では、右側の車線を制限速度を上限に走行して前方車両９１を追い越し、且つ前方車両９１との間を適切な車間距離Ｄ以上とするまでの第１の軌道Ｌ４を算出する。尚、第１の軌道Ｌ４は基本的に直線の軌道であり、また軌道の長さは、前方車両９１の車速と道路の制限速度に基づいて算出される。
続いて、ステアリングの旋回を開始して左側の車線へと移動し、且つステアリングの位置が直進方向に戻るのに必要な第２の軌道Ｌ５を算出する。尚、第２の軌道Ｌ５は車両の現在の車速に基づいて車線変更を行う際に生じる横方向の加速度（横Ｇ）を算出し、横Ｇが自動運転支援に支障が生じることなく、また車両の乗員に不快感を与えない上限値（例えば０．２Ｇ）を超えないことを条件として、クロソイド曲線を用いてできる限り円滑で、且つできる限り車線変更に必要な距離が短くなる軌道を算出する。また、前方車両９１との間に適切な車間距離Ｄ以上を維持することについても条件とする。
【0103】
また、前記Ｓ４７では上記回避軌道を走行する際の自車両の推奨速度についても算出する。自車両の推奨速度については、制限速度を上限として、車線変更時において車両に生じる横方向の加速度（横Ｇ）が自動運転支援に支障が生じることなく、また車両の乗員に不快感を与えない上限値（例えば０．２Ｇ）を超えない速度を推奨速度とする。例えば回避軌道の曲率や制限速度などに基づいて算出される。
【0104】
その後、Ｓ４８においてＣＰＵ５１は、自車両が影響要因に追従（或いは並走）して走行する為の軌道（以下、追従軌道という）を算出する。具体的には、自車両と影響要因が現時点で同一車線上にある場合には、図２４に示すように自車両９０が車線変更することなく現在の車線を継続して走行し、影響要因（例えば前方車両９１）に対して追従する軌道が追従軌道に該当する。尚、追従軌道は基本的に静的走行軌道と同一の軌道となる。但し、影響要因との間の車間距離を適切に維持する必要がある為、後述のように速度計画については修正することとなる（Ｓ８）。一方、自車両と影響要因が現時点で異なる車線上にあってその後に同一車線上へと移動する必要がある場合には、図２５に示すように自車両９０が車線変更することなく現在の車線を継続して走行し、影響要因（例えば前方車両９１）と並走する軌道が追従軌道に該当する。尚、この場合には追従軌道は静的走行軌道と異なる軌道となる。
【0105】
また、前記Ｓ４８では上記追従軌道を走行する際の自車両の推奨速度についても算出する。自車両の追従速度については、制限速度を上限として、前方の影響要因との間の車間距離について適切な車間距離Ｄ以上を維持する速度を推奨速度とする。尚、適切な車間距離Ｄについては前述した式（１）に基づいて算出される。但し、図２５に示すように自車両と影響要因が異なる車線に位置する場合については必ずしも車間距離Ｄ以上を維持する必要は無いが、その後に自車両が影響要因と同一車線へ車線変更する必要があることを考えれば、車間距離Ｄ以上を維持しておくのが望ましい。
【0106】
その後、Ｓ４９においてＣＰＵ５１は、前記Ｓ４７で算出された回避軌道（回避軌道に関しては算出された場合のみ）及び前記Ｓ４８で算出された追従軌道を、周辺の道路状況を考慮した上で走行予定経路に含まれる道路に対して車両に走行が推奨される走行軌道である動的走行軌道として生成する。
【0107】
そして、前記Ｓ４９で生成された動的走行軌道は、自動運転支援に用いる支援情報としてフラッシュメモリ５４等に格納される。
【0108】
【0109】
先ず、Ｓ５１においてＣＰＵ５１は、前記Ｓ３で生成された静的走行軌道と、前記Ｓ６で生成された動的走行軌道をフラッシュメモリ５４等の記憶媒体から読み出す。
【0110】
続いて、Ｓ５２においてＣＰＵ５１は、前記Ｓ５１で読み出された各走行軌道について、走行軌道毎に車両の走行軌道としての適正度を示すパスコストを算出する。ここで、パスコストは、（ａ）走行時間（平均車速）、（ｂ）車線変更回数、（ｃ）車線変更を行う位置、（ｄ）走行車線の少なくとも一以上を考慮して算出する。具体的には、以下の条件に基づいて算出する。
【0111】
（ａ）“走行時間（平均車速）”については、走行時間が長い（即ち平均車速が遅い）走行軌道程、パスコストを高く算出する。尚、静的走行軌道の平均車速については前記Ｓ４で生成された速度計画に基づいて特定する。一方、動的走行軌道については前記Ｓ４７及びＳ４８で算出された推奨速度に基づいて特定する。
（ｂ）“車線変更回数”については、車線変更回数が多い走行軌道程、パスコストを高く算出する。
（ｃ）“車線変更を行う位置”については、複数回の車線変更を行う場合には、車線変更の間隔が短くなる走行軌道程、パスコストを高く算出する。また、交差点の手前側所定距離（例えば一般道７００ｍ、高速道路２ｋｍ）以内で車線変更を行う走行軌道については、パスコストを加算する。
（ｄ）“走行車線”については、追い越し車線の走行距離が長い走行軌道程、パスコストを高く算出する。
（ｂ）“車線変更回数”については、車線変更回数が多い走行軌道程、パスコストを高く算出する。
（ｃ）“車線変更を行う位置”については、複数回の車線変更を行う場合には、車線変更の間隔が短くなる走行軌道程、パスコストを高く算出する。また、交差点の手前側所定距離（例えば一般道７００ｍ、高速道路２ｋｍ）以内で車線変更を行う走行軌道については、パスコストを加算する。
（ｄ）“走行車線”については、追い越し車線の走行距離が長い走行軌道程、パスコストを高く算出する。
【0112】
但し、上記（ａ）～（ｄ）の条件に関わらず、自車両が前記Ｓ５で検出された影響要因と接触すると判定される走行軌道についてはコストを無限大とする。
【0113】
その後、Ｓ５３においてＣＰＵ５１は、前記Ｓ５２で算出された走行軌道毎のパスコストを比較し、最もパスコストの値が小さい走行軌道を車両の走行が推奨される走行軌道として選択する。
【0114】
次に、Ｓ５４においてＣＰＵ５１は、前記Ｓ５３において動的走行軌道である回避軌道又は追従軌道が選択されたか否かを判定する。
【0115】
そして、前記Ｓ５３において動的走行軌道である回避軌道又は追従軌道が選択されたと判定された場合（Ｓ５４：ＹＥＳ）には、Ｓ５５へと移行する。
【0116】
Ｓ５５においてＣＰＵ５１は、選択された動的走行軌道が生成された区間を対象として、静的走行軌道を動的走行軌道へと、結果として置き換えられることになる。尚、基本的に静的走行軌道を動的走行軌道へと置き換えられた場合には、動的軌道の始点及び終点は静的走行軌道と繋がることとなるが、例外的に図２５に示す追従軌道が選択された場合には、動的走行軌道の終点が静的走行軌道と繋がらない場合もある。そのような場合には、動的走行軌道の終点を始点として静的走行軌道の生成を新たに行っても良いし、静的走行軌道に繋がるまで動的走行軌道の生成を一定間隔で繰り返し行うようにしても良い。
【0117】
その後、一部が動的走行軌道に置き換えられた静的走行軌道に基づいて、自動運転支援による支援走行が行われる（Ｓ９、Ｓ１０）
【0118】
一方、前記Ｓ５３において静的走行軌道が選択されたと判定された場合（Ｓ５４：ＮＯ）には、動的走行軌道への置き換えを行うことなくＳ８へと移行する。
【0119】
以上詳細に説明した通り、本実施形態に係るナビゲーション装置１及びナビゲーション装置１で実行されるコンピュータプログラムでは、交差点に対する車両の進入位置を取得するとともに、交差点から車両が退出する退出位置を取得し（Ｓ３１）、進入位置から退出位置までの間の少なくとも一部を曲率が連続して変化する曲線で繋ぐことによって、交差点に対して車両に走行が推奨される走行軌道を生成し（Ｓ３４～Ｓ４０）、走行軌道に基づいて車両の運転支援を行う（Ｓ９、Ｓ１０）ので、車両の運転支援を行う場合において、交差点に対する車両の進入位置と交差点から車両が退出する退出位置とに基づいて、交差点を通過する車両にとって実現することが容易で且つ推奨される走行軌道を生成することが可能となる。そして、生成された走行軌道に基づいて運転支援を行うことによって、運転支援を適切に実施することを可能とする。
【0120】
尚、本発明は前記実施形態に限定されるものではなく、本発明の要旨を逸脱しない範囲内で種々の改良、変形が可能であることは勿論である。
例えば、本実施形態では、車両の走行に影響が生じる影響要因を検出した場合に、動的走行軌道として回避軌道と追従軌道を夫々生成しているが、いずれか一方のみを生成するようにしても良い。
例えば、本実施形態では、車両の走行に影響が生じる影響要因を検出した場合に、動的走行軌道として回避軌道と追従軌道を夫々生成しているが、いずれか一方のみを生成するようにしても良い。
【0121】
また、本実施形態では、サーバ装置４が有する高精度地図情報には、道路のレーン形状（車線単位の道路形状や曲率、車線幅等）と道路に描かれた区画線（車道中央線、車線境界線、車道外側線、誘導線等）に関する情報の両方を含むが、区画線に関する情報のみを含むようにしても良いし、道路のレーン形状に関する情報のみを含むようにしても良い。例えば区画線に関する情報のみを含む場合であっても、区画線に関する情報に基づいて道路のレーン形状に関する情報に相当する情報を推定することが可能である。また、道路のレーン形状に関する情報のみを含む場合であっても、道路のレーン形状に関する情報に基づいて区画線に関する情報に相当する情報を推定することが可能である。また、「区画線に関する情報」は、車線を区画する区画線自体の種類や配置を特定する情報であっても良いし、隣接する車線間で車線変更が可能か否かを特定する情報であっても良いし、車線の形状を直接または間接的に特定する情報であっても良い。
【0122】
また、本実施形態では、車両の走行に影響が生じる影響要因を検出した場合に動的走行軌道を生成するとともに、既存の静的走行軌道と新たに生成された動的走行軌道のパスコストとを比較して（Ｓ５２、Ｓ５３）、動的走行軌道の方が推奨されると判定された場合にのみ静的走行軌道を動的走行軌道に置き換えている（Ｓ５５）が、動的走行軌道が生成された場合には必ず静的走行軌道を動的走行軌道に置き換えるようにしても良い。
【0123】
また、本実施形態では、静的走行軌道に動的走行軌道を反映する手段として、静的走行軌道の一部を動的走行軌道に置き換えている（Ｓ５５）が、置き換えるのではなく静的走行軌道を動的走行軌道に近づけるように軌道の修正を行っても良い。
【0124】
また、本実施形態では、車両の操作のうち、車両の挙動に関する操作である、アクセル操作、ブレーキ操作及びハンドル操作の全てを車両制御ＥＣＵ４０が制御することをユーザの運転操作によらずに自動的に走行を行う為の自動運転支援として説明してきた。しかし、自動運転支援を、車両の操作のうち、車両の挙動に関する操作である、アクセル操作、ブレーキ操作及びハンドル操作の少なくとも一の操作を車両制御ＥＣＵ４０が制御することとしても良い。一方、ユーザの運転操作による手動運転とは車両の操作のうち、車両の挙動に関する操作である、アクセル操作、ブレーキ操作及びハンドル操作の全てをユーザが行うこととして説明する。
【0125】
また、本発明の運転支援は車両の自動運転に係る自動運転支援に限られない。例えば、静的走行軌道や動的走行軌道をナビゲーション画面に表示するとともに、音声や画面等を用いた案内（例えば車線変更の案内、推奨車速の案内等）を行うことによる運転支援も可能である。また、静的走行軌道や動的走行軌道をナビゲーション画面に表示することでユーザの運転操作を支援するようにしてもよい。
【0126】
また、本実施形態では、自動運転支援プログラム（図４）をナビゲーション装置１が実行する構成としているが、ナビゲーション装置１以外の車載器や車両制御ＥＣＵ４０が実行する構成としても良い。その場合には、車載器や車両制御ＥＣＵ４０は車両の現在位置や地図情報等をナビゲーション装置１やサーバ装置４から取得する構成とする。更に、サーバ装置４が自動運転支援プログラム（図４）のステップの一部または全部を実行するようにしても良い。その場合にはサーバ装置４が本願の運転支援装置に相当する。
【0127】
また、本発明はナビゲーション装置以外に、携帯電話機、スマートフォン、タブレット端末、パーソナルコンピュータ等（以下、携帯端末等という）に適用することも可能である。また、サーバと携帯端末等から構成されるシステムに対しても適用することが可能となる。その場合には、上述した自動運転支援プログラム（図４参照）の各ステップは、サーバと携帯端末等のいずれが実施する構成としても良い。但し、本発明を携帯端末等に適用する場合には、自動運転支援が実行可能な車両と携帯端末等が通信可能に接続（有線無線は問わない）される必要がある。
【0128】
また、本発明に係る運転支援装置を具体化した実施例について上記に説明したが、運転支援装置は以下の構成を有することも可能であり、その場合には以下の効果を奏する。
【0129】
例えば、第１の構成は以下のとおりである。
交差点に対する車両の進入位置を取得する進入位置取得手段（５１）と、前記交差点から車両が退出する退出位置を取得する退出位置取得手段（５１）と、前記進入位置から前記退出位置までの間の少なくとも一部を曲率が連続して変化する曲線で繋ぐことによって、前記交差点に対して車両に走行が推奨される走行軌道を生成する走行軌道生成手段（５１）と、前記走行軌道に基づいて車両の運転支援を行う運転支援手段（５１）と、前記交差点上に配置された地物の位置及び形状を取得する地物取得手段と、前記交差点上に配置された地物の位置及び形状に基づいて、前記交差点の進入位置から退出位置までの間において車両が通過すべき通過点を設定する通過点設定手段と、を有し、前記走行軌道生成手段は、進行方向に沿って隣り合う通過点の間を対象にして、手前側の通過点を開始点とした曲率が一定の割合で連続して変化する曲線であるクロソイド曲線を生成するとともに生成されたクロソイド曲線に基づいて次の通過点の位置を補正し、手前側の通過点から補正後の通過点を結ぶ前記クロソイド曲線を前記走行軌道の一部として算出することで、前記進入位置から前記退出位置までを繋ぐ曲線を前記走行軌道として生成する。
また、第２の構成は以下のとおりである。
前記交差点上に配置された地物には、誘導線、菱形導流帯又はポールの少なくとも一以上を含み、前記通過点設定手段は、前記交差点上に配置された誘導線、菱形導流帯又はポールの位置及び形状を考慮して前記通過点を設定する。
上記構成を有する運転支援装置によれば、車両の運転支援を行う場合において、交差点に対する車両の進入位置と交差点から車両が退出する退出位置とに基づいて、交差点を通過する車両にとって実現することが容易で且つ推奨される走行軌道を生成することが可能となる。そして、生成された走行軌道に基づいて運転支援を行うことによって、運転支援を適切に実施することを可能とする。また、交差点上に車両が交差点を通過する際に従うべき地物が存在する場合において、地物に従った走行軌道を生成することが可能となる。
交差点に対する車両の進入位置を取得する進入位置取得手段（５１）と、前記交差点から車両が退出する退出位置を取得する退出位置取得手段（５１）と、前記進入位置から前記退出位置までの間の少なくとも一部を曲率が連続して変化する曲線で繋ぐことによって、前記交差点に対して車両に走行が推奨される走行軌道を生成する走行軌道生成手段（５１）と、前記走行軌道に基づいて車両の運転支援を行う運転支援手段（５１）と、前記交差点上に配置された地物の位置及び形状を取得する地物取得手段と、前記交差点上に配置された地物の位置及び形状に基づいて、前記交差点の進入位置から退出位置までの間において車両が通過すべき通過点を設定する通過点設定手段と、を有し、前記走行軌道生成手段は、進行方向に沿って隣り合う通過点の間を対象にして、手前側の通過点を開始点とした曲率が一定の割合で連続して変化する曲線であるクロソイド曲線を生成するとともに生成されたクロソイド曲線に基づいて次の通過点の位置を補正し、手前側の通過点から補正後の通過点を結ぶ前記クロソイド曲線を前記走行軌道の一部として算出することで、前記進入位置から前記退出位置までを繋ぐ曲線を前記走行軌道として生成する。
また、第２の構成は以下のとおりである。
前記交差点上に配置された地物には、誘導線、菱形導流帯又はポールの少なくとも一以上を含み、前記通過点設定手段は、前記交差点上に配置された誘導線、菱形導流帯又はポールの位置及び形状を考慮して前記通過点を設定する。
上記構成を有する運転支援装置によれば、車両の運転支援を行う場合において、交差点に対する車両の進入位置と交差点から車両が退出する退出位置とに基づいて、交差点を通過する車両にとって実現することが容易で且つ推奨される走行軌道を生成することが可能となる。そして、生成された走行軌道に基づいて運転支援を行うことによって、運転支援を適切に実施することを可能とする。また、交差点上に車両が交差点を通過する際に従うべき地物が存在する場合において、地物に従った走行軌道を生成することが可能となる。
【0130】
また、第３の構成は以下のとおりである。
前記走行軌道生成手段（５１）は、前記進入位置から前記退出位置までの間の少なくとも一部を曲率が一定の割合で連続して変化する曲線で繋ぐことによって前記走行軌道を生成する。
上記構成を有する運転支援装置によれば、特に曲率が一定の割合で連続して変化する曲線で走行軌道を生成することによって、ステアリングを徐々に旋回させながら或いは直進方向に戻しながら進むという一般的な交差点での車両の走行態様に従った走行軌道を生成することが可能となる。
前記走行軌道生成手段（５１）は、前記進入位置から前記退出位置までの間の少なくとも一部を曲率が一定の割合で連続して変化する曲線で繋ぐことによって前記走行軌道を生成する。
上記構成を有する運転支援装置によれば、特に曲率が一定の割合で連続して変化する曲線で走行軌道を生成することによって、ステアリングを徐々に旋回させながら或いは直進方向に戻しながら進むという一般的な交差点での車両の走行態様に従った走行軌道を生成することが可能となる。
【0131】
また、第４の構成は以下のとおりである。
前記走行軌道生成手段（５１）は、前記進入位置から交差点内にある第１中間地点までの間については曲率が徐々に大きく変化する曲線で繋ぐことによって前記走行軌道を生成する。
上記構成を有する運転支援装置によれば、特に交差点の通過前半において曲率を徐々に大きくする曲線で走行軌道を生成することによって、交差点の進入後はステアリングを徐々に直進方向から旋回させながら進むという一般的な交差点での車両の走行態様に従った走行軌道を生成することが可能となる。
前記走行軌道生成手段（５１）は、前記進入位置から交差点内にある第１中間地点までの間については曲率が徐々に大きく変化する曲線で繋ぐことによって前記走行軌道を生成する。
上記構成を有する運転支援装置によれば、特に交差点の通過前半において曲率を徐々に大きくする曲線で走行軌道を生成することによって、交差点の進入後はステアリングを徐々に直進方向から旋回させながら進むという一般的な交差点での車両の走行態様に従った走行軌道を生成することが可能となる。
【0132】
また、第５の構成は以下のとおりである。
前記走行軌道生成手段（５１）は、交差点内にある第２中間地点から前記退出位置までの間については曲率が徐々に小さく変化する曲線で繋ぐことによって前記走行軌道を生成する。
上記構成を有する運転支援装置によれば、特に交差点の通過後半において曲率を徐々に小さくする曲線で走行軌道を生成することによって、交差点の退出直前はステアリングを徐々に直進方向に戻しながら進むという一般的な交差点での車両の走行態様に従った走行軌道を生成することが可能となる。
前記走行軌道生成手段（５１）は、交差点内にある第２中間地点から前記退出位置までの間については曲率が徐々に小さく変化する曲線で繋ぐことによって前記走行軌道を生成する。
上記構成を有する運転支援装置によれば、特に交差点の通過後半において曲率を徐々に小さくする曲線で走行軌道を生成することによって、交差点の退出直前はステアリングを徐々に直進方向に戻しながら進むという一般的な交差点での車両の走行態様に従った走行軌道を生成することが可能となる。
【0133】
また、第６の構成は以下のとおりである。
前記走行軌道生成手段（５１）は、前記進入位置から第１中間地点までの間を曲率が徐々に大きく変化する曲線で繋ぎ、前記第１中間地点から第２中間地点までの間を曲率が固定の曲線で繋ぎ、前記第２中間地点から前記退出位置までの間を曲率が徐々に小さく変化する曲線で繋ぐことによって前記走行軌道を生成する。
上記構成を有する運転支援装置によれば、特に大型の交差点を車両が通過する場合においては、通過前半において曲率を徐々に大きくする曲線で走行軌道を生成し、中盤では曲率を固定した曲線で走行軌道を生成し、通過後半において曲率を徐々に小さくする曲線で走行軌道を生成することによって、交差点を通過する車両にとって実現することが容易で且つ推奨される走行軌道を生成することが可能となる。
前記走行軌道生成手段（５１）は、前記進入位置から第１中間地点までの間を曲率が徐々に大きく変化する曲線で繋ぎ、前記第１中間地点から第２中間地点までの間を曲率が固定の曲線で繋ぎ、前記第２中間地点から前記退出位置までの間を曲率が徐々に小さく変化する曲線で繋ぐことによって前記走行軌道を生成する。
上記構成を有する運転支援装置によれば、特に大型の交差点を車両が通過する場合においては、通過前半において曲率を徐々に大きくする曲線で走行軌道を生成し、中盤では曲率を固定した曲線で走行軌道を生成し、通過後半において曲率を徐々に小さくする曲線で走行軌道を生成することによって、交差点を通過する車両にとって実現することが容易で且つ推奨される走行軌道を生成することが可能となる。
【0135】
また、第７の構成は以下のとおりである。
前記交差点上に配置された誘導線、菱形導流帯又はポールの位置及び形状に基づいて、前記交差点の進入位置から退出位置までの間において車両が通過すべき通過点を設定し、前記走行軌道生成手段（５１）は、前記進入位置から前記通過点にできる限り近接して前記退出位置までを繋ぐ曲線を前記走行軌道として生成する。
上記構成を有する運転支援装置によれば、交差点上に車両が交差点を通過する際に従うべき地物が存在する場合において、地物に従った走行軌道を生成することが可能となる。
前記交差点上に配置された誘導線、菱形導流帯又はポールの位置及び形状に基づいて、前記交差点の進入位置から退出位置までの間において車両が通過すべき通過点を設定し、前記走行軌道生成手段（５１）は、前記進入位置から前記通過点にできる限り近接して前記退出位置までを繋ぐ曲線を前記走行軌道として生成する。
上記構成を有する運転支援装置によれば、交差点上に車両が交差点を通過する際に従うべき地物が存在する場合において、地物に従った走行軌道を生成することが可能となる。
【0136】
また、第８の構成は以下のとおりである。
前記運転支援手段（５１）は、車両の自動運転支援を行う。
上記構成を有する運転支援装置によれば、自動運転支援による車両の走行を行う場合において、交差点を通過する車両にとって実現することが容易で且つ推奨される走行軌道を生成することが可能となる。そして、生成された走行軌道に基づいて自動運転支援を行うことによって、自動運転支援を適切に実施することを可能とする。
前記運転支援手段（５１）は、車両の自動運転支援を行う。
上記構成を有する運転支援装置によれば、自動運転支援による車両の走行を行う場合において、交差点を通過する車両にとって実現することが容易で且つ推奨される走行軌道を生成することが可能となる。そして、生成された走行軌道に基づいて自動運転支援を行うことによって、自動運転支援を適切に実施することを可能とする。
【符号の説明】
【0137】
１ ナビゲーション装置
２ 運転支援システム
３ 情報配信センタ
４ サーバ装置
５ 車両
１５ 高精度地図情報
３３ ナビゲーションＥＣＵ
３９ 車外カメラ
４０ 車両制御ＥＣＵ
５１ ＣＰＵ
５２ ＲＡＭ
５３ ＲＯＭ
５４ フラッシュメモリ
６１ 走行予定経路
７５ レーンノード
７６ レーンリンク
８６ クロソイド曲線
８７ 補正点
８８ 決定パス
２ 運転支援システム
３ 情報配信センタ
４ サーバ装置
５ 車両
１５ 高精度地図情報
３３ ナビゲーションＥＣＵ
３９ 車外カメラ
４０ 車両制御ＥＣＵ
５１ ＣＰＵ
５２ ＲＡＭ
５３ ＲＯＭ
５４ フラッシュメモリ
６１ 走行予定経路
７５ レーンノード
７６ レーンリンク
８６ クロソイド曲線
８７ 補正点
８８ 決定パス
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】
【図12】
【図13】
【図14】
【図15】
【図16】
【図17】
【図18】
【図19】
【図20】
【図21】
【図22】
【図23】
【図24】
【図25】
【図26】
【図27】
