JP4525670B2 - 走行制御計画生成システム - Google Patents

Description

本発明は、自動運転車両の走行制御計画を生成する走行制御計画生成システムに関する。

車両の自動運転を制御する装置として、例えば特許文献１に開示されたものがある。この装置では、前方障害物に対する自車の相対速度及び相対距離に基づいて目標減速度を決定し、実際の減速度が目標減速度になるように制動力を自動制御している。
特開２００４−１８２１４９号公報

しかしながら、上記した従来の装置では、周辺車両との相対速度や相対距離というある瞬間の車両状態量から自車の制御方針を決定するため、周辺車両の状況（加減速度、横位置等）が実際に変化した後でなければ、自車は対応できず、いわゆる成り行きの制御となっていた。従って、余裕を持って状況変化に対応することが難しく対応が限られてしまい、対応によっては快適性や燃費性といった自車の走行方針に反する制御となるおそれがあった。

本発明は、上記した事情に鑑みて為されたものであり、自車両の走行方針を満足しつつ、周辺環境の状況変化に柔軟に対応することを可能とする走行制御計画生成システムを提供することを目的とする。

本発明に係る走行制御計画生成システムは、一の車両の走行方針に沿う上位計画を生成する上位計画生成手段と、前記上位計画を達成する計画であって、少なくとも走行軌跡を含む下位計画を生成する下位計画生成手段と、前記一の車両の周辺車両の少なくとも走行軌跡を含む下位計画を取得する下位計画取得手段と、前記周辺車両の下位計画を考慮して、前記一の車両の下位計画を所定の指標により評価する評価手段と、前記評価手段による評価に基づいて、前記一の車両が実行する下位計画を選定する下位計画選定手段と、を備え、前記下位計画取得手段は、前記周辺車両の挙動に基づいて前記周辺車両の下位計画を推測する推測手段を有し、前記推測手段による推測により前記周辺車両の下位計画を取得すると共に、前記周辺車両と通信する通信手段を有し、前記通信手段による通信により前記周辺車両の下位計画を取得し、前記評価手段は、前記周辺車両の下位計画の信頼度を考慮して、前記一の車両の下位計画を評価する、ことを特徴とする。

このシステムでは、一の車両の走行方針に沿う上位計画を生成し、これを達成する下位計画を生成することができる。下位計画は、少なくとも走行軌跡を含み、周辺車両の下位計画を考慮して、この一の車両の下位計画を評価し、その評価により実行する下位計画を選定することができる。このように、走行制御の計画を上位計画と下位計画とに階層化することで、上位計画により走行方針を満たしつつ、下位計画により周辺環境の状況変化に柔軟に対応することができる。また、所定の指標（例えば、安全性、快適性、環境性（燃費性などに基づく）など）による評価に基づいて下位計画を選定できるため、所定の条件に沿う適切な計画に基づいて一の車両を制御することができる。

前記下位計画取得手段は、前記周辺車両の挙動に基づいて、前記周辺車両の下位計画を推測する推測手段を有し、前記推測手段による推測により前記周辺車両の下位計画を取得する。この構成により、通信手段を有しない周辺車両や走行制御計画を有しない周辺車両（例えば、手動運転車両）の下位計画を取得することができる。

前記下位計画取得手段は、前記周辺車両と通信する通信手段を有し、前記通信手段による通信により前記周辺車両の下位計画を取得する。この構成により、周辺車両として走行制御計画を有する自動運転車両の下位計画や、更にはその自動運転車両において推測したその周辺車両の下位計画を、通信により取得することができる。

前記評価手段は、前記周辺車両の下位計画の信頼度を考慮して、前記一の車両の下位計画を評価する。周辺車両の下位計画は、自動運転車両が生成したものと手動運転車両について推測したものとで、その信頼度が異なる。従って、この信頼度を考慮して一の車両の下位計画を評価することで、より適切な計画に基づいて一の車両を走行制御することができる。

前記推定手段から取得される下位計画の信頼度は、前記通信手段から取得される自動運転車両の下位計画の信頼度よりも低いことを特徴としてもよい。このようにすれば、手動運転車両と自動運転車両とが混在する交通環境下において、より適切な計画に基づいて一の車両を走行制御することができる。

前記下位計画は、前記一の車両の速度パターンを含むことを特徴としてもよい。このようにすれば、走行軌跡による横方向の制御だけでなく、速度パターンによる縦方向の制御についても、制御の目標にすることができる。

本発明によれば、自車両の走行方針を満足しつつ、周辺環境の状況変化に柔軟に対応することを可能とする走行制御計画生成システムを提供することができる。

以下、添付図面を参照して本発明の実施形態について説明する。なお、図面の説明において同一の要素には同一の符号を付し、重複する説明を省略する。

本実施形態に係る走行制御計画生成システム（以下、単に「生成システム」ともいう）は、ＥＣＵ（Electric Control Unit）等のマイクロコンピュータのハードウェアおよびソフトウェアを利用して構成され、自動運転制御車両Ａに搭載されている。この生成システム１は、図1に示すように、周辺車認識部１２、自車状態量推定部１４、周辺車行動予測部（下位計画取得手段、推測手段）１６、車群全車行動予測修正部１８、条件設定入力部２０、走行制御計画生成部（上位計画生成手段、下位計画生成手段）２２、評価部（評価手段）２４、下位計画選定部（下位計画選定手段）２６、送信部２８、及び受信部（下位計画取得手段、通信手段）３０を備えている。

周辺車認識部１２は、ミリ波レーダ、画像センサ、レーザレーダ、超音波センサなどの周辺を監視する周辺センサ３２と接続されている。この周辺車認識部１２は、周辺センサ３２からの検出値（例えば、周辺車両等の物体からの反射情報など）に基づいて、車両Ａ（自車両ともいう）の周辺に存在する周辺車両Ｃ（ここでは、手動運転で通信機能を有さない非通信車両Ｃ）を認識し、自車両Ａからの相対的な距離、角度、速度などの周辺車情報を算出する。

自車状態量推定部１４は、自車状態量を検出する自車センサ３４と接続されている。自車センサ３４は、例えばヨーレートセンサ、車速センサ、加速度センサ、操舵角センサ、白線検知センサ、GPSなどである。自車状態量推定部１４は、自車センサ３４からの検出値に基づいて、ソフトウェアに組み込まれた車両モデルから、その時点の車両Ａの状態量推定値（ヨーレート、レーン内の横位置、横速度、道路線形に対するヨー角、自車位置など）を算出する。

周辺車行動予測部１６は、周辺車認識部１２で算出した周辺車情報と、自車状態量推定部１４で算出した車両Ａの状態量推定値を取得する。そして、取得した情報から車両Ａの位置情報履歴、周辺車両Ｃの相対位置情報履歴、相対速度などを算出し、更にこれらの情報から、周辺車両Ｃの位置情報履歴、現状状態（速度、加速度、道路線形に対するヨー角など）を推定する。これにより、周辺車両Ｃの位置関係や周辺車両Ｃの傾向（車間、車速、加減速、レーンチェンジ抵抗感などのドライバ嗜好）が推定できる。また、周辺車行動予測部１６は、ナビゲーションシステムやインフラ設備等から、走行している道路情報（車線増減、合流、分岐、線形、カーブなど）を取得する。そして、周辺車両Ｃの位置情報履歴、現状状態と道路情報に基づいて、周辺車両Ｃの傾向から、予め生成されているドライバモデルに当てはめて、周辺車両Ｃの下位計画として今後（例えば、数百ｍ程度）の行動（走行軌跡や速度パターンを含む）を仮予測する。

受信部３０は、２．４ＧＨｚなどの電波を利用した車車間通信により、他の自動運転車両Ｂで生成された車両Ｂの走行制御計画を取得する。この走行制御計画には、車両Ａと同様の後述する上位計画と、走行軌跡や速度パターンを含む下位計画とが含まれる。

車群全車行動予測修正部１８は、下位計画選定部２６から選定されたＡ車の下位計画を取得すると共に、受信部３０からＢ車の下位計画、及び周辺車行動予測部１６から車両Ｃの行動予測（下位計画）を取得する。そして、これらを時間軸上に重ね合わせることにより、不整合のある点（２台が重なる場合など）をなくすように、各車両の下位計画に対して修正を行う。

条件設定入力部２０は、ドライバが指定した目的地までの走行全体の条件の入力を受け付ける。例えば、目的地、希望旅行時間、燃費優先度合い、休憩計画などの指定を受け付ける。

走行制御計画生成部２２は、上位計画生成部（上位計画生成手段）２２ａと下位計画生成部（下位計画生成手段）２２ｂとを有している。上位計画生成部２２ａは、ドライバが指定した目的地までの数百ｋｍ、数時間単位の走行全体の条件や、ナビ情報、インフラ情報などの走行環境条件などを考慮しながら、各インターチェンジＩＣやサービスエリアパーキングエリアＳＡＰＡ間の数十ｋｍ、数十分単位の走行計画を動的に生成する。この走行計画は、旅行時間、走行計画方針（休憩頻度、燃費性、他車優先度合いなど）、車群編成などである。

具体的には、目的地までのルート探索を行い、複数の候補ルートを選定する。そして、交通情報、希望旅行時間、走行計画方針を満たす最適ルートを選択する。そして、全体ルートを各ＩＣやＳＡＰＡ間という単位で区切り、その区間ごとの走行計画を決定する。また、必要に応じて走行計画として車群編成方針計画も決定する。車群編成方針計画は、例えば渋滞追従走行時に無駄発進停止を繰り返すことが減るように、複数の自動運転車両を車群として塊を編成し、まとめて発進停止を行うものである。

さらに、上位計画生成部２２ａは、上記のように生成した走行計画、周辺状況認識（周辺センサ３２やインフラ監視情報などに基づく）などに基づいて、各時点から数百ｍ、数十秒単位でイベント遷移計画を動的に生成する。このイベント遷移計画は、レーンチェンジ（完了目標地点、希望レーンチェンジ時間（急度合い）、許容最短レーンチェンジ時間（緊急回避時など）、必須レーンチェンジであるか、緊急回避であるか、元レーンへの復帰確率、など）、上限速度変更（新規上限速度、完了目標地点、希望加速Ｇ、希望減速Ｇ、希望ジャーク、許容ジャーク、必須速度達成であるか、など）、車間距離、合流（希望流入地点、希望流入時速度、希望流入動作時間（急度合い）など）、分流（合流と同様）、隊列編成、隊列離脱などである。なお、括弧内は下位計画生成部２２ｂに指示を出すときに付属する設定条件である。例えば、走行計画で渋滞追従車群制御の指示と共に周辺の強調すべき各車両が指示されると、それを達成するためのレーンチェンジや上限速度変更などのイベント遷移を計画する。

下位計画生成部２２ｂは、上位計画生成部２２ａで生成されたイベント遷移計画を達成するように、道路情報に基づいて、各時点から数ｃｍ、数十ミリ秒単位で、目標となる走行軌跡及び速度パターンを含む下位計画を、数百ｍに亘って動的に生成する。

図２を参照して説明すると、このように下位計画生成部２２ｂで生成された下位計画は、上位計画生成部２２ａで生成されたより上位のイベント遷移計画を達成するものであり、またイベント遷移計画は、より上位の走行計画を達成するものである。そして、走行計画はドライバが指定した走行方針に沿うものである。このように、走行制御計画の生成は、上位計画と下位計画に多層化され、更に上位計画は走行計画とイベント遷移計画とに多層化されている。そして、下位の計画ほど、上位の計画と比べて時間スケールが小さい。このように走行制御計画の生成が多層化されているため、下位計画生成部２２ｂで下位計画が生成できない場合には、イベント遷移計画の見直しを要求し、上位計画を再生成する。

なお、走行制御計画生成部２２においては、車群全車行動予測修正部１８から修正された車両Ｂ及び車両Ａの下位計画、車両Ｃの行動予測が入力され、これを前提に下位計画が生成される。このとき、走行制御計画生成部２２において、車群全車行動予測修正部１８から車両Ｂの上位計画である走行計画、イベント遷移計画をも取得し、これを前提に自車両Ａの走行計画、イベント遷移計画を生成するようにしてもよい。

評価部２４は、車群全車行動予測修正部１８から取得した周辺車両Ｃの行動予測及び自動運転車両Ｂの下位計画を加味し、仮生成された車両Ａの複数の下位計画を、所定の指標（例えば、安全性、快適性、環境性（燃費性などに基づく）など）に基づいて、それぞれ評価する。安全性については、車間距離や操舵の急度合いなどから評価することができる。快適性は、最大横Ｇや平均横Ｇ、ヨーレートなどから評価することができる。環境性は、予想燃料消費量から燃費性を評価することができ、他車優先度から他車に対する優しさを評価することができる。なお、評価部２４における評価により安全が確保されていないなど問題がある場合は、走行制御計画生成部２２において問題部分を修正し、評価部２４において再度評価し直す。問題部分を修正できない場合は、イベント遷移計画の見直しを要求し、上位計画を再生成する。

評価部２４での評価においては、下位計画の信頼度を考慮する。例えば、自動運転車両Ｂが生成した下位計画と手動運転車両Ｃについて推測した下位計画とでは、その信頼度が異なるため、この信頼度を考慮して下位計画を評価するのである。具体的には、周辺車行動予測部１６において予測することで取得される下位計画の信頼度を、受信部３０で受信することで取得される自動運転車両Ｂの下位計画の信頼度よりも低くする。これにより、例えば、自動運転車両Ｂについては手動運転車両Ｃよりも車間を詰めることができる。

下位計画選定部２６は、評価部２４で評価された評価結果に基づいて、複数の下位計画から評価の優れたものを実行する走行制御計画として選定する。例えば、安全重視であれば、安全性のより高いものを実行する走行制御計画として選定する。なお、上記した場合では、評価部２４での評価において信頼度を考慮したが、下位計画選定部２６での選定時に信頼度を考慮してもよい。すなわち、評価部２４で出された評価点に信頼度を積算して修正し、修正後の評価点に基づいて選定してもよい。

運動制御部３６は、自車状態量の推定値を加味しながら、選定された下位計画（走行軌跡、速度パターンを含む）に基づいて、各時刻における位置と速度を忠実に再現できるように、アクチュエータ３８に対する指示値を生成する。

アクチュエータ３８は、エンジン、ブレーキ、電動パワーステアリングなどのアクチュエータ及びそれらを制御するＥＣＵであり、運動制御部３６からのスロットル開度指示値、ブレーキ圧指示値、ステアリングトルク指示値などを受けて、これらを駆動制御する。

送信部２８は、２．４ＧＨｚなどの電波を利用した車車間通信により、下位計画選定部２６において選定した車両Ａの下位計画を、他の自動運転車両Ｂに送信する。このとき、車両Ａの上位計画をも併せて送信するようにしてもよい。

次に、上記した走行制御計画生成システム１を搭載した自動運転車両Ａの運転制御について説明する。ここでは、図３に示すように、手動運転車両Ｃと自動運転車両Ｂとが周辺車両として存在する交通環境下において、自動運転車両Ａを運転制御する場合について説明する。

まず、周辺車認識部１２において、周辺センサ３２からの検出値に基づいて、自車両Ａの周辺に存在する周辺車両Ｃを認識し、自車両Ａからの相対的な距離、角度、速度などの周辺車情報を算出する。また、自車状態量推定部１４において、自車センサ３４からの検出値に基づいて、その時点の自車両Ａの状態量推定値（自車位置、ヨーレート、レーン内の横位置、横速度、道路線形に対するヨー角など）を算出する。

次に、周辺車行動予測部１６において、周辺車認識部１２で算出した周辺車情報と、自車状態量推定部１４で算出した車両Ａの状態量推定値を取得する。そして、取得した情報から車両Ａの位置情報履歴、周辺車両Ｃの相対位置情報履歴、相対速度などを算出し、更にこれらの情報から、周辺車両Ｃの位置情報履歴、現状状態（速度、加速度、道路線形に対するヨー角など）を推定する。これにより、周辺車両Ｃの位置関係や周辺車両Ｃの傾向（車間、車速、加減速、レーンチェンジ抵抗感などのドライバ嗜好）が推定できる。また、周辺車行動予測部１６は、ナビゲーションシステムやインフラ設備等から、走行している道路情報（車線増減、合流、分岐、線形、カーブなど）を取得する。そして、周辺車両Ｃの位置情報履歴、現状状態と道路情報に基づいて、周辺車両Ｃの傾向から、予め生成されているドライバモデルに当てはめて、周辺車両Ｃの今後（例えば、数百ｍ程度）の行動（走行軌跡や速度パターンを含む）を仮予測する。このとき、周辺車両Ｃの行動予測は、信頼度とともに生成される。この信頼度は、自動運転車両Ｂの下位計画よりも信頼度が低い所定の値に設定される。

次に、車群全車行動予測修正部１８において、下位計画選定部２６から選定された車両Ａの下位計画を取得すると共に、受信部３０から車両Ｂの下位計画、及び周辺車行動予測部１６から車両Ｃの行動予測を取得する。そして、これらを時間軸上に重ね合わせることにより、不整合のある点（２台が重なる場合など）をなくすように、各車両の下位計画に対して修正を行う。

このようにして、図４に示すように、周辺車両として車両Ｂと車両Ｃの下位計画が取得できる。ここで、Ｃ’、Ｃ’’は、例えばそれぞれ数十ミリ秒ごとの車両Ｃの位置を示している（車両Ｂについても同様である）。

一方、条件設定入力部２０において、ドライバが指定した目的地までの走行全体の条件の入力を受け付ける。例えば、目的地、希望旅行時間、燃費優先度合い、休憩計画などの指定を受け付ける。

次に、上位計画生成部２２ａにおいて、ドライバが指定した目的地までの数百ｋｍ、数時間単位の走行全体の条件や、ナビ情報、インフラ情報などの走行環境条件などを考慮しながら、各インターチェンジＩＣやサービスエリアパーキングエリアＳＡＰＡ間の数十ｋｍ、数十分単位の走行計画を動的に生成する。

具体的には、目的地までのルート探索を行い、複数の候補ルートを選定する。そして、交通情報、希望旅行時間、走行計画方針を満たす最適ルートを選択する。そして、全体ルートを各ＩＣやＳＡＰＡ間という単位で区切り、その区間ごとの走行計画を決定する。また、必要に応じて走行計画として車群編成方針計画も決定する。

さらに、上位計画生成部２２ａにおいて、上記のように生成した走行計画、周辺状況認識などに基づいて、各時点から数百ｍ、数十秒単位でイベント遷移計画を動的に生成する。

次に、下位計画生成部２２ｂにおいて、上位計画生成部２２ａで生成されたイベント遷移計画を達成するように、道路情報に基づいて、各時点から数ｃｍ、数十ミリ秒単位で、目標となる走行軌跡及び速度パターンを含む下位計画を、数百ｍに亘って動的に生成する。このとき、同一の軌跡生成法で複数の下位計画を生成してもよいし、軌跡生成法を変えて複数の下位計画を生成してもよい。また、そのイベント遷移が必須でないなら、そのイベントを行う場合と行わない場合とで複数の下位計画を生成してもよい。

下位計画生成部２２ｂで下位計画が生成できない場合には、イベント遷移計画の見直しを要求し、上位計画を再生成する。そして、新たな上位計画を達成する下位計画を生成する。

具体的には、図５に示すように、上位計画で例えばレーンチェンジが計画されると、下位計画生成部２２ｂにおいて、まず緊急回避か否かを判定する（ステップＳ４０１）。そして、緊急回避であれば急ハンドルを許可するなど緊急回避用の設定を行い、ステップＳ４０３に進む。一方、緊急回避でなければ、車線が減少するか否か判定する（ステップＳ４０４）。そして、車線が減少するなら通常操舵で元レーンへの復帰の不可設定を行い（ステップＳ４０５）、ステップＳ４０３に進む。一方、車線が減少しないなら前半緩めの操舵で元レーンへの復帰の可設定を行い（ステップＳ４０６）、ステップＳ４０３に進む。

ステップＳ４０３では、レーンチェンジの完了目標地点設定を行い、次にステップＳ４０７においてレーンチェンジに費やす時間を設定する。そして、設定した情報に基づいて、レーンチェンジの軌跡を仮生成する（ステップＳ４０８）。次に、レーンチェンジに時間が不足するか否か判定し（ステップＳ４０９）、時間が足りるならステップＳ４１０に進む。一方、時間が不足すれば、許容された最短時間であるか判定し（ステップＳ４１１）、最短でなく余裕があればレーンチェンジの時間を短縮し（ステップＳ４１２）、ステップＳ４０８に戻る。一方、許容された最短時間であるならば、ステップＳ４１３でそのレーンチェンジが必須であるか判定し、必須であればステップＳ４１０に進む。レーンチェンジが必須でなければ、ステップＳ４１４でレーンチェンジ中止を決定し、ステップＳ４１０に進む。ステップＳ４１０では、決定した内容を上位層に伝達する。従って、時間不足でなく生成された軌跡でレーンチェンジを行うか、時間不足で許容最短の時間であるが必須であるためその軌跡でレーンチェンジを行うか、時間不足で許容最短の時間であるが必須でないためレーンチェンジを中止するかが、上位層に伝達される。レーンチェンジを中止する場合は、新たにレーンチェンジなしのイベント遷移計画が生成され、これを満たす下位計画が生成される。

次に、評価部２４において、車群全車行動予測修正部１８から取得した周辺車両Ｃの行動予測及び自動運転車両Ｂの下位計画を加味し、仮生成された車両Ａの複数の下位計画を、所定の指標（例えば、安全性、快適性、環境性（燃費性などに基づく）など）に基づいて、それぞれ評価する。なお、評価部２４における評価により安全が確保されていないなど問題がある場合は、走行制御計画生成部２２において問題部分を修正し、評価部２４において再度評価し直す。問題部分を修正できない場合は、イベント遷移計画の見直しを要求し、上位計画を再生成する。

評価部２４での評価においては、下位計画の信頼度を考慮する。例えば、自動運転車両Ｂが生成した下位計画と手動運転車両Ｃについて推測した下位計画とでは、その信頼度が異なるため、この信頼度を考慮して下位計画を評価するのである。具体的には、周辺車行動予測部１６において予測することで取得される下位計画の信頼度を、受信部３０で受信することで取得される自動運転車両Ｂの下位計画の信頼度よりも低くする。これにより、例えば、自動運転車両Ｂに対しては手動運転車両Ｃよりも車間を詰めることができる。

下位計画選定部２６は、評価部２４で評価された評価結果に基づいて、複数の下位計画から評価の優れたものを実行する走行制御計画として選定する。例えば、安全重視であれば、安全性のより高いものを実行する走行制御計画として選定する。

図６は、車両Ａの下位計画の評価、選定について説明する図である。図６に示すように、上位計画でレーンチェンジが計画され、下位計画としてルートＩとルートＩＩとが生成されたとする。このとき、自動運転車両Ｂの下位計画と手動運転車両Ｃの下位計画とでは、信頼度が前者の方が高いため、ルートＩＩの方が安全性が高いと評価される。従って、下位計画選定部２６は、安全性重視であれば、より安全性の高いルートＩＩを車両Ａの下位計画として選定することになる。

次に、運動制御部３６において、自車状態量の推定値を加味しながら、選定された下位計画（走行軌跡、速度パターンを含む）に基づいて、各時刻における位置と速度を忠実に再現できるように、アクチュエータ３８に対する指示値を生成する。

そして、アクチュエータ３８により、運動制御部３６からのスロットル開度指示値、ブレーキ圧指示値、ステアリングトルク指示値などを受けて、エンジン、ブレーキ、ステアリングなどを駆動制御し、車両Ａを自動運転制御する。

一方で、送信部２８から、下位計画選定部２６において選定した車両Ａの下位計画を、他の自動運転車両Ｂに送信する。このとき、車両Ａの上位計画をも併せて送信するようにしてもよい。

このように、本実施形態に係る走行制御計画生成システム１では、車両Ａの走行方針に沿う上位計画を生成し、これを達成する下位計画を生成することができる。そして、下位の計画ほど、上位の計画と比べて時間スケールが小さい。下位計画は、少なくとも走行軌跡を含み、周辺車両Ｂ，Ｃの下位計画を考慮して、車両Ａの下位計画を評価し、その評価により実行する下位計画を選定することができる。このように、走行制御の計画を上位計画と下位計画とに階層化することで、上位計画により走行方針を満たしつつ、下位計画により周辺環境の状況変化に柔軟に対応することができる。また、所定の指標（例えば、安全性、快適性、環境性（燃費性などに基づく）など）による評価に基づいて下位計画を選定できるため、ドライバが指定する条件に沿う適切な計画に基づいて車両Ａを制御することができる。すなわち、上位計画をより小さな時間スケールにブレイクダウンした下位計画の評価・選定を行うことで、上位計画達成と周辺環境への柔軟な対応の両立を好適に実現することができる。

すなわち、本実施形態の車両制御は、ＩＭＴＳ（専用道走行）のように、複数車両で一つの計画を共有するものではない。専用道では走行路が決まっているため、予め全ての計画を調整して最適な計画を生成しておくことができる。しかしながら、一般道では、走行路が多岐に亘り、周辺車両が未知であることに加え、各車がそれぞれの計画で走行しているため、各車が協調するためには周辺車両の計画をも考慮した計画を立案する必要があり、予め最適な計画を立てて走行することは実質的に不可能であり、周辺車両との計画の調整を動的に行う必要がある。本実施形態では、走行制御計画の生成が多層化されているため、絶対的な上位計画を達成しつつも、周辺車両に対応して柔軟に下位計画を生成することができ、最適な車両制御が可能になる。

また、車両Ａの複数の下位計画を生成し、評価部２４による評価に基づいて、複数の下位計画の中から実行する下位計画を選定するため、ドライバが指定する条件に沿うより適切な計画に基づいて車両Ａを制御することができる。

また、下位計画が生成できない場合に、上位計画を再生成し、或いは、評価部２４による評価に応じて、上位計画を再生成するため、下位計画を生成できない場合やドライバが指定する所定の指標を十分に満足できない場合において、上位計画の見直しを行うことができる。

また、周辺車行動予測部１６は、周辺車両の挙動に基づいて、周辺車両の下位計画を推測するため、通信手段を有しない周辺車両や走行制御計画を有しない周辺車両（例えば、手動運転車両）Ｃの下位計画を取得することができる。また、受信部３０により周辺車両の下位計画を取得できるため、周辺車両として走行制御計画を有する自動運転車両Ｂの下位計画や、更にはその自動運転車両Ｂにおいて推測したその周辺車両の下位計画を、通信により取得することができる。従って、手動運転車両と自動運転車両とが混在する交通環境下において、より適切な計画に基づいて車両Ａを走行制御することができる。

また、評価部２４は、周辺車両の下位計画の信頼度を考慮して、車両Ａの下位計画を評価する。ここで、周辺車両の下位計画は、自動運転車両Ｂが生成したものと手動運転車両Ｃについて推測したものとで、その信頼度が異なる。従って、この信頼度を考慮して車両Ａの下位計画を評価することで、より適切な計画に基づいて車両Ａを走行制御することができる。

また、周辺車行動予測部１６で予測して取得される下位計画の信頼度は、通信部３０で受信して取得される自動運転車両Ｂの下位計画の信頼度よりも低いため、この信頼度に基づいて評価することで、手動運転車両Ｃと自動運転車両Ｂとが混在する交通環境下において、より適切な計画に基づいて車両Ａを走行制御することができる。

また、下位計画は、車両Ａの走行軌跡の他に速度パターンを含むため、走行軌跡による横方向の制御だけでなく、速度パターンによる縦方向の制御についても、制御の目標にすることができる。

なお、本発明は上記した実施形態に限定されることなく、種々の変形が可能である。例えば、上記した実施形態では、自動運転車両Ａの周辺車両として、自動運転車両Ｂと手動運転非通信車両Ｃとが混在する交通環境下について説明したが、他の自動運転車両や手動運転非通信車両が更に存在してもよい。

また、図７に示すように、周辺車両として手動運転車両ではあるが通信可能な車両Ｄが存在してもよい。図７に示すように、車両Ｄは運転支援制御装置１００を備えている。運転支援制御装置１００は、行動予測部１１６、行動提案部１１８、表示部１２０、ＡＣＣ・ＬＫＡ補正部１２２、受信部１３０、及び送信部１３２を備えている。

受信部１３０は、車両Ａ，Ｂの下位計画、車両Ａ内で予測された車両Ｃの行動予測を受信する。行動予測部１１６は、車両Ｄの車速センサ、アクセルペダルセンサ、ブレーキセンサ、舵角センサなどの車載センサ情報と、受信部１３０を介して取得した車両Ａによる車両Ｃの行動予測結果と、車両Ａ，Ｂの下位計画とから車両Ｄの行動を予測する。このとき、車両Ａの走行制御計画生成部２２における下位計画の生成に供するよう、車両Ｄの行動予測（下位計画）の信頼度を設定する。この手動運転通信車両Ｄは、手動運転非通信車両Ｃよりも信頼度を高く、自動運転車両Ｂよりも信頼度を低く設定する。

送信部１３２は、車両Ｄの行動予測（下位計画）を車両Ａに送信する。行動提案部１１８は、自動運転ではない車両Ｄに表示部１２０やＡＣＣ（アダプティブクルーズコントロール）やＬＫＡ（レーンキープアシスト）などの運転支援装置が存在する場合に、ドライバや運転支援装置に望ましい行動を生成する。表示部１２０は、手動運転を行っているドライバに望ましい運転方法を表示して提案する。ＡＣＣ・ＬＫＡ補正部１２２は、ＡＣＣ・ＬＫＡなどの運転支援装置に対して望ましい運転方法に合わせた目標速度修正や操舵支援トルクを発生させる。

このように、通信可能な手動運転車両Ｄが存在する場合、これと連携することで、自車両Ａに影響を及ぼすおそれがある周辺車両Ｄについても、精度よく行動予測することができ、自動運転車両と手動運転車両とが混在する交通環境下においても、自動運転車両Ａの走行制御計画を適切に生成することができる。また、車両Ｄに対して、望ましい運転方向を提案したり、運転を支援したりすることができる。

また、上記した実施形態では、自動運転車両Ａの周辺車両として、自動運転車両Ｂと手動運転非通信車両Ｃとが混在する交通環境下、更に手動運転通信車両Ｄが混在する交通環境下について説明したが、図８に示すように、複数の自動運転車両α、β、γが存在する環境下で合流を考えたときにおいても、全ての車両の最適な下位計画を生成することができる。すなわち、図８（ａ）に示すように、車両βが一定速で、車両αがレーンチェンジをするように下位計画が生成されていた場合、下位計画を車両α、β、γ間で共有することで、図８（ｂ）に示すように、まず本線車両α、βに対して合流車両γの最も安全な下位計画を生成し、図８（ｃ）に示すように、これに基づいて車両βを減速すると共に車両αのレーンチェンジを中止するなどして、全体として最適な車両制御を行うことができる。この場合に、手動運転車両が含まれていても、その行動を予測することができるため、最適な車両制御を行えることに変わりはない。

また上記した実施形態では、走行制御計画生成システム１が自動運転車両Ａに搭載されている場合について説明したが、このシステム１はインフラ設備の側に設けられていてもよい。

実施形態に係る走行制御計画生成システムが搭載された自動運転車両Ａの構成を示すブロック図である。 多層化された走行制御計画生成の流れを示す図である。 車両Ａと周辺車両Ｂ，Ｃとの位置関係を示す図である。 周辺車両Ｂの下位計画と車両Ｃの行動予測（下位計画）を示す図である。 レーンチェンジが計画されたときの下位計画生成のフローチャートである。 車両Ａの下位計画の評価及び選定を説明するための図である。 走行制御計画生成システムが搭載された自動運転車両Ａの構成の変形例を示すブロック図である。 車両合流時の最適制御を説明するための図である。

符号の説明

１…走行制御計画生成システム、１６…周辺車行動予測部、２２…走行制御計画生成部、２２ａ…上位計画生成部、２２ｂ…下位計画生成部、２４…評価部、２６…下位計画選定部、３０…受信部。

Claims (3)

1. 一の車両の走行方針に沿う上位計画を生成する上位計画生成手段と、
   前記上位計画を達成する計画であって、少なくとも走行軌跡を含む下位計画を生成する下位計画生成手段と、
   前記一の車両の周辺車両の少なくとも走行軌跡を含む下位計画を取得する下位計画取得手段と、
   前記周辺車両の下位計画を考慮して、前記一の車両の下位計画を所定の指標により評価する評価手段と、
   前記評価手段による評価に基づいて、前記一の車両が実行する下位計画を選定する下位計画選定手段と、
   を備え、
   前記下位計画取得手段は、前記周辺車両の挙動に基づいて前記周辺車両の下位計画を推測する推測手段を有し、前記推測手段による推測により前記周辺車両の下位計画を取得すると共に、前記周辺車両と通信する通信手段を有し、前記通信手段による通信により前記周辺車両の下位計画を取得し、
   前記評価手段は、前記周辺車両の下位計画の信頼度を考慮して、前記一の車両の下位計画を評価する、ことを特徴とする走行制御計画生成システム。
2. 前記推定手段から取得される下位計画の信頼度は、前記通信手段から取得される自動運転車両の下位計画の信頼度よりも低いことを特徴とする請求項１に記載の走行制御計画生成システム。
3. 前記下位計画は、前記一の車両の速度パターンを含むことを特徴とする請求項１又は２に記載の走行制御計画生成システム。
   

Images