JP6637194B2 - 車両制御装置 - Google Patents

Description

この発明は、自動運転（自動運転支援を含む）が可能な車両に適用して好適な車両制御装置に関する。

特許５３０６９３４号公報（以下、ＪＰ５３０６９３４Ｂという。）には、複数の行動目的を生成するために、演算周期の長短に応じて階層化された複数のモジュール（行動目的生成モジュールという。）を備え、該複数の行動目的生成モジュールの演算結果により制御モジュールを通じて制御対象を制御する制御システムが開示されている。この制御システムによる具体的な制御対象は、脚式ロボットである。

このＪＰ５３０６９３４Ｂは、演算周期に応じて３つの階層に分割された行動目的生成モジュールを有し、最も演算周期の長い行動目的生成モジュールが、前記ロボットを目標位置まで移動させることを担当し、演算周期が中間の行動目的生成モジュールが、前記ロボットに物体との接触を回避させることを担当し、演算周期が短い行動目的生成モジュールが、前記ロボットの姿勢を安定化させることを担当している。

この階層化された制御システムでは、演算周期が長い行動目的生成モジュールによる評価結果よりも演算周期が短い行動目的生成モジュールによる評価結果を優先的に反映させた形で前記制御対象の動作を制御するように構成されている（ＪＰ５３０６９３４Ｂの請求項１）。

ところで、自動運転（自動運転支援を含む）が可能な車両では、認識された直近の走行環境に対する適応性・応答性を満足させながら道路を走行して目標位置に到達することは勿論のこと、前記目標位置に到達するまでの乗員の快適性、乗り心地、例えば、模範的なドライバが運転するのと同様の車両の挙動変化の円滑性が重視される。

しかしながら、ＪＰ５３０６９３４Ｂでは、脚式ロボットであること等を原因として、演算周期が短い行動目的生成モジュールによる評価結果を優先的に反映させた形で前記脚式ロボットの動作を時々刻々制御し、目標位置まで到達するように構成されているので、制御対象の挙動変化の円滑性（乗員の乗り心地の快適性）を向上させる点については改良の余地がある。

この発明は上記のような課題を考慮してなされたものであり、自動運転車両（自動運転支援車両も含む。）の軌道生成処理に的確に適用し得る車両制御装置を提供することを目的とする。

この発明に係る車両制御装置は、自動運転可能な車両を制御する車両制御装置であって、外界認識情報に基づき、演算周期が相対的に長い長周期で長期軌道を生成する長期軌道生成部と、生成された前記長期軌道を考慮し前記長周期より短い短周期で短期軌道を生成する短期軌道生成部と、前記長期軌道生成部及び前記短期軌道生成部を制御する統括制御部と、を備え、前記統括制御部は、自動運転を行う際、前記長期軌道生成部及び前記短期軌道生成部に対し、軌道の生成を同時に開始させる一方、前記長期軌道が生成される前は、前記短期軌道により前記車両を制御させる。

この発明では、自動運転を行う際、統括制御部が、長期軌道生成部及び短期軌道生成部に対し、軌道の生成を同時に開始させる一方、長期軌道が生成される前は、短期軌道により車両を制御するようにしている。このように、長期軌道が生成される前は、短期軌道により車両が制御されるようにしたので、自動運転を行う際、車両を直ちに制御でき、且つ長期軌道生成部及び短期軌道生成部に対し、同時に軌道の生成を開始させるようにしたので、上位の長期軌道が考慮された下位の短期軌道が生成されるまでの時間を短くすることができる。

一般に、長期軌道では乗り心地が重視され、短期軌道では認識された外界環境に対する適応性・応答性が重視されるので、外界環境に対する適応性・応答性を確保しつつ、所定周期経過後には、より一層の乗り心地（快適性）も考慮された自動運転を行うことができる。

よって、この発明に係る車両制御装置は、自動運転（自動運転支援も含む）車両の軌道生成処理に的確に適用し得る。

この場合、前記外界認識情報は、状態が変化しない静的情報と、状態が変化する動的情報とを含み、前記長期軌道生成部は、前記静的情報を用いて前記長期軌道を生成し、前記短期軌道生成部は、前記静的情報及び前記動的情報を用いて前記短期軌道を生成するようにしている。

このように、下位の短期軌道生成部は、状態が変化しない静的情報と状態が変化する動的情報を用いて短周期で短期軌道を生成するので、車両を直ちに制御でき、また、上位の長期軌道生成部で長期軌道が生成された後は、該長期軌道を考慮して短期軌道生成部で短期軌道を生成させるようにしたので、動的情報に基づき車両を直ちに制御でき、静的情報に基づいて長期軌道が生成された後は、急峻な車両挙動の発生が抑制されたより快適性の高い自動運転を行うことができる。

すなわち、前記長期軌道は、乗り心地が重視された軌道とされ、前記短期軌道は、外界環境に対する応答性が重視された軌道とされている。

よって、長期軌道が生成された後は、環境に対する適応性・応答性を保持しつつ乗り心地（快適性）の高い自動運転を行うことができる。

また、前記短期軌道生成部は、該短期軌道生成部の他に、前記短周期より長く前記長周期より短い中周期で相対的に中期な中期軌道を生成する中期軌道生成部に分割され、前記統括制御部は、自動運転を行う際、前記長期軌道生成部、前記短期軌道生成部及び前記中期軌道生成部に対し、各軌道の生成を同時に開始させる一方、前記中期軌道が生成される前は、前記短期軌道により前記車両を制御させ、前記中期軌道が生成されたときは、該中期軌道を参照した前記短期軌道により前記車両を制御させ、前記長期軌道が生成されたときは、該長期軌道を参照して生成された前記中期軌道を参照して前記短期軌道により前記車両を制御させるようにすることが好ましい。

このように、自動運転を行う際、まず、演算周期の最も短い短期軌道生成部により生成した短期軌道で車両を制御し、次に、演算周期が次に短い中期軌道生成部により生成した中期軌道を参照した短期軌道で車両を制御し、次いで、演算周期が最も長い長期軌道生成部により生成された長期軌道を参照して生成された中期軌道を参照した短期軌道で車両を制御するようにしたので、直ちに自動運転を開始でき、且つ徐々に（段階的に）、乗り心地（快適性）等を考慮した自動運転に移行することができる。

この実施形態に係る車両制御装置が搭載された車両の概略構成ブロック図である。 図１中、要部の構成を抜き出したブロック図である。 局所環境マップの例示図である。 車両制御装置の動作説明に供されるフローチャートである。 この実施形態に係る車両制御装置の動作説明に供されるタイムチャート（１／３）である。 この実施形態に係る車両制御装置の動作説明に供されるタイムチャート（２／３）である。 この実施形態に係る車両制御装置の動作説明に供されるタイムチャート（３／３）である。 比較例に係る車両制御装置の動作説明に供されるタイムチャート（１／３）である。 比較例に係る車両制御装置の動作説明に供されるタイムチャート（２／３）である。 比較例に係る車両制御装置の動作説明に供されるタイムチャート（３／３）である。 図５〜図７のタイムチャートをまとめて描いたこの実施形態に係る車両制御装置の動作説明に供されるタイムチャートである。 図８〜図１０のタイムチャートをまとめて描いた比較例に係る車両制御装置の動作説明に供されるタイムチャートである。

以下、この発明に係る車両制御装置について、この車両制御装置が搭載された車両との関係において、好適な実施形態を挙げ添付の図面を参照しながら説明する。

［車両１０の構成］
図１は、この実施形態に係る車両制御装置１２が搭載された車両（自車又は自車両ともいう。）１０の概略構成を示すブロック図である。

車両１０は、車両制御装置１２を含み、該車両制御装置１２の他、該車両制御装置１２にそれぞれ通信線を介して接続される入力装置と出力装置とを備える。

前記入力装置として、外界センサ１４と、ナビゲーション装置１６と、車両センサ１８と、通信装置２０と、自動運転スイッチ（自動運転ＳＷ）２２と、操作デバイス２４に接続された操作検出センサ２６と、を備える。

前記出力装置として、図示しない車輪を駆動する駆動力装置２８と、前記車輪を操舵する操舵装置３０と、前記車輪を制動する制動装置３２と、を有するアクチュエータ２７を備える。なお、ナビゲーション装置１６や通信装置２０は、入出力装置（ヒューマンインタフェース、送受信機）として利用することもできる。

［車両制御装置１２に接続される入出力装置の構成］
外界センサ１４は、車両１０の外界（前方、後方、側方等の周囲３６０゜）情報を取得する複数のカメラ３３と複数のレーダ３４とを備え、取得した車両１０の外界情報を車両制御装置１２に出力する。外界センサ１４は、さらに、複数のＬＩＤＡＲ（光検出と測距）を備えてもよい。

ナビゲーション装置１６は、衛星測位装置等を用いて車両１０の現在位置を検出・特定するとともに、ユーザインタフェースとして、タッチパネル式のディスプレイ、スピーカ及びマイクを有し、現在位置又はユーザが指定した位置から指定した目的地までの経路を算出し、車両制御装置１２に出力する。ナビゲーション装置１６により算出された経路は、経路情報として記憶装置４０の経路情報記憶部４４に記憶される。

車両センサ１８は、車両１０の速度（車速）を検出する速度（車速）センサ、加速度を検出する加速度センサ、横Ｇを検出する横Ｇセンサ、車両１０の垂直軸周りの角速度を検出するヨーレートセンサ、車両１０の向きを検出する方位センサ、車両１０の勾配を検出する勾配センサ等を含め、各検出信号を車両制御装置１２に出力する。これらの検出信号は、後述する演算周期Ｔｏｃ毎に自車状態情報Ｉｖｈとして記憶装置４０の自車状態情報記憶部４６に記憶される。

通信装置２０は、路側機、他車、及びサーバ等と通信し、信号機等に係わる情報、他車に係わる情報、及びプローブ情報・更新地図情報等を受信しあるいは送信する。なお、地図情報は、ナビゲーション装置１６に記憶される他、地図情報として記憶装置４０の地図情報記憶部４２にも記憶される。

操作デバイス２４は、アクセルペダル、ステアリングホイール（ハンドル）、ブレーキペダル、シフトレバー、及び方向指示レバー等を含む。操作デバイス２４には、ドライバによる操作の有無や操作量、操作位置を検出する操作検出センサ２６が取り付けられている。

操作検出センサ２６は、検出結果としてアクセル踏込（開度）量、ハンドル操作（操舵）量、ブレーキ踏込量、シフト位置、右左折方向等を車両制御部１１０に出力する。

自動運転スイッチ（自動運転オン設定部）２２は、例えば、インストルメントパネルに設けられ、ドライバ等のユーザが、非自動運転モード（手動運転モード）と自動運転モードを切り替えるためにマニュアル（手動）操作される押しボタンスイッチである。

この実施形態では、押される度に、自動運転モードと非自動運転モードが切り替わるように設定されているが、ドライバの自動運転意思確認の確実化のために、例えば、２度押しで非自動運転モードから自動運転モードに切り替わり、１度押しで自動運転モードから非自動運転モードに切り替わるように設定することもできる。

自動運転モードは、ドライバが、アクセルペダルやステアリングホイールやブレーキペダル等の操作デバイス２４の操作を行わない状態で車両１０が車両制御装置１２の制御下に走行する運転モードであり、車両制御装置１２が、行動計画（後述する短期軌道Ｓｔ、中期軌道Ｍｔ、及び長期軌道Ｌｔ）に基づいて、駆動力装置２８、操舵装置３０、及び制動装置３２の一部又は全部を制御する運転モードである。

なお、自動運転モード中に、ドライバが、アクセルペダルやステアリングホイールやブレーキペダル等の操作デバイス２４の操作を開始した場合には、自動運転モードは自動的に解除され、非自動運転モード（手動運転モード）に切り替わる。

ここで、手動運転モードにおいても、公知のＡＣＣ（Adaptive Cruise Control）機能やＬＫＡＳ（Lane Keep Assist System）機能等、一定の運転支援機能を実施することができる。

また、前記した自動運転スイッチ２２は、タッチ式でもよく、音声入力方式等にしてもよい。

駆動力装置２８は、駆動力ＥＣＵとエンジン及び／又は駆動モータ等の車両１０の駆動源とから構成される。駆動力装置２８は、車両制御部１１０から入力される車両制御値Ｃｖｈに従って車両１０が走行するための走行駆動力（トルク）を生成し、トランスミッションを介し、あるいは直接に車輪に伝達する。

操舵装置３０は、ＥＰＳ（電動パワーステアリングシステム）ＥＣＵと、ＥＰＳ装置とから構成される。操舵装置３０は、車両制御部１１０から入力される車両制御値Ｃｖｈに従って車輪（操舵輪）の向きを変更する。

制動装置３２は、例えば、油圧式ブレーキを併用する電動サーボブレーキであって、ブレーキＥＣＵと、ブレーキアクチュエータとから構成される。

制動装置３２は、車両制御部１１０から入力される車両制御値Ｃｖｈ情報に従って車輪を制動する。

なお、車両１０の操舵は、左右車輪に対するトルク配分や制動力配分を変更することでも可能である。

［車両制御装置１２の構成］
車両制御装置１２は、１又は複数のＥＣＵ（電子制御ユニット）により構成され、各種機能実現部の他、記憶装置４０等を備える。なお、機能実現部は、この実施形態では、ＣＰＵ（中央処理ユニット）が記憶装置４０に記憶されているプログラムを実行することにより機能が実現されるソフトウエア機能部であるが、集積回路等からなるハードウエア機能部により実現することもできる。

図２は、この実施形態に係る車両制御装置１２の要部の構成を図１から抜き出して示すブロック図である。

車両制御装置１２は、記憶装置４０（図１）及び機能実現部（機能実現モジュール）としての車両制御部１１０の他に、外界認識部５１と、認識結果受信部５２と、局所環境マップ生成部５４と、長期軌道生成部７１と、中期軌道生成部７２と、短期軌道生成部７３と、これらを統括制御するとともに、タスク同期を制御する統括制御部（タスク同期モジュール）７０と、から構成される。

車両制御装置１２中、外界認識部５１は、静的な（変化しない又は動かない）外界認識情報Ｉｐｒｓと動的な（変化する又は動く可能性がある）外界認識情報Ｉｐｒｄとからなる外界認識情報Ｉｐｒを同時に生成する。

静的な外界認識情報Ｉｐｒｓを生成する際、外界認識部５１は、車両制御部１１０からの自車状態情報Ｉｖｈを参照し、さらに、外界センサ１４中、カメラ３３等からの外界情報（画像情報）に基づき、当該位置での車両１０の両側（右側と左側）のレーンマーク（白線等）を認識するとともに、交差点等の停止線までの距離（停止線まで、あと何ｍの位置にいるか。）、及び走行可能領域（レーンマークは気にせずにガードレールや縁石を除いた平面領域）等を認識し、外界認識情報Ｉｐｒｓとして生成し、認識結果受信部５２に送信（出力）する。

動的な外界認識情報Ｉｐｒｄを生成する際、外界認識部５１は、前記自車状態情報Ｉｖｈを参照し、さらに、カメラ３３等からの外界情報に基づき、障害物（駐停車車両を含む）、交通参加者（人、他車両）、及び信号機の灯色｛青（緑）、黄（オレンジ）、赤｝等を認識し、外界認識情報Ｉｐｒｄとして生成し、認識結果受信部５２に送信（出力）する。

外界認識部５１は、外界認識情報Ｉｐｒ（Ｉｐｒ＝Ｉｐｒｓ＋Ｉｐｒｄ）を演算周期Ｔｏｃ未満の時間で認識し、認識結果受信部５２に送信（出力）する。

この場合、認識結果受信部５２は、統括制御部７０からの演算指令Ａａに応答して、自己の更新カウンタ（不図示）を更新し、更新したカウント値とともに、外界認識部５１から受信している外界認識情報Ｉｐｒ（Ｉｐｒ＝Ｉｐｒｓ＋Ｉｐｒｄ）を、演算周期Ｔｏｃ内に、統括制御部７０に出力する。

統括制御部７０は、外界認識情報Ｉｐｒ（Ｉｐｒ＝Ｉｐｒｓ＋Ｉｐｒｄ）を、記憶装置４０に記憶する。

ここで、演算周期（基準周期又は基準演算周期ともいう。）Ｔｏｃは、車両制御装置１２における基準の演算周期であり、例えば、数１０ｍｓ程度の値に設定されている。

局所環境マップ生成部５４は、統括制御部７０からの演算指令Ａｂに応答して、自車状態情報Ｉｖｈ及び外界認識情報Ｉｐｒを参照（集約）し、演算周期Ｔｏｃ内に、局所環境マップ情報Ｉｅｍを生成して、更新カウンタ（不図示）のカウント値とともに、統括制御部７０に出力する。

すなわち、制御の開始時には、局所環境マップ情報Ｉｅｍが生成されるまでに、演算周期２×Ｔｏｃを要する。

局所環境マップ情報Ｉｅｍは、概ね、外界認識情報Ｉｐｒに自車状態情報Ｉｖｈを合成した情報である。局所環境マップ情報Ｉｅｍは、記憶装置４０の局所環境マップ情報記憶部４７に記憶される。

図３は、局所環境マップ情報Ｉｅｍとして記憶されている、例としての局所環境マップＬｍａｐを示している。

ここで、自車状態情報Ｉｖｈは、車両制御部１１０から得られる情報であって、基本的には、車両１０の基準点Ｂｐ、例えば後輪車軸の中点の、レーンＬ（右側レーンマークＬｍｒと左側レーンマークＬｍｌによって区画される。）の中心線（仮想線）ＣＬからのオフセット量（位置）ＯＳと、中心線ＣＬと車両１０のノーズ方向ｎｄとの間のなす角である姿勢角（方位角ともいう。）θｚと、速度ｖｓと、加速度ｖａと、走行ラインの曲率ρと、ヨーレートγと、操舵角δｓｔ等により構成される。オフセット量ＯＳは、基準位置（任意）からの座標｛ｘ（走行路の方向であって縦方向）ｙ（走行路に直交する方向であって横方向）｝としてもよい。

すなわち、自車状態情報Ｉｖｈは、次の（１）式に示すように、後述する軌道点列Ｐｊ｛（２）式参照｝の、その時点における最新の情報である。
Ｉｖｈ＝Ｉｖｈ（ｘ，ｙ，θｚ，ｖｓ，ｖａ，ρ，γ，δｓｔ）…（１）
Ｐｊ
＝Ｐｊ（ｘ，ｙ，θｚ，ｖｓ，ｖａ，ρ，γ，δｓｔ）ｔ＝１，２,…Ｔ
…（２）

なお、軌道点列Ｐｊは、後述する軌道点列候補Ｐｃｊ（ｘ，ｙ，θｚ，ｖｓ，ｖａ，ρ，γ，δｓｔ）ｔ＝１，２,…Ｔが肯定的な評価がなされるまで修正されて、出力軌道である軌道点列Ｐｊ（ｘ，ｙ，θｚ，ｖｓ，ｖａ，ρ，γ，δｓｔ）ｔ＝１，２,…Ｔとされる。ｔは、演算周期Ｔｏｃの整数分の１（速度ｖｓに応じて変更してもよい。）の時間に対応し、１は、最初の点、Ｔは、１ｓｅｃ目の点等の生成される軌道の時間長さに対応する。

図３中、レーンＬ（右側レーンマークＬｍｒと左側レーンマークＬｍｌ）は、カメラ３３からの画像情報から外界認識部５１で認識（公知のレーンマーク検出、鳥瞰変換、及び曲線近似処理）された外界認識情報Ｉｐｒである。

このように、局所環境マップ情報Ｉｅｍ（局所環境マップＬｍａｐ）は、自車状態情報Ｉｖｈと外界認識情報Ｉｐｒとを併合して生成された、自車１０が走行している方向の自車位置を基準として道路（レーンマークＬｍ）等の周辺状況（自車周辺状況）を示す情報である。

なお、局所環境マップ生成部５４にて、例えば、レーン中心線ＣＬは、直線レーンである場合の最適走行ラインとして生成され、カーブレーンであれば、レーン中心線ＣＬに対する、いわゆるアウト−イン−アウト走行ラインが最適走行ラインとして生成される。この最適走行ラインは、局所環境マップ情報Ｉｅｍ（局所環境マップＬｍａｐ）に含まれている。

図２にもどり、長期軌道生成部７１は、統括制御部７０からの演算指令Ａｃに応答して、動的な外界認識情報Ｉｐｒｄを除いた静的な外界認識情報Ｉｐｒｓを含む局所環境マップ情報Ｉｅｍ、自車状態情報Ｉｖｈ、及び地図情報記憶部４２に記憶されている道路地図（カーブの曲率等）を参照して、例えば、演算周期９×Ｔｏｃで長期軌道Ｌｔを生成し、生成した長期軌道Ｌｔを更新カウンタのカウント値とともに、統括制御部７０に出力する。長期軌道Ｌｔは、軌道情報Ｉｔとして記憶装置４０の軌道情報記憶部４８に記憶される。

つまり、長期軌道生成部７１は、車両１０の乗り心地・快適性（急ハンドル、急加減速を行わない。）を重視した車両制御を行うための軌道、例えば、運転に習熟した模範ドライバが運転する軌道に対応した軌道であり、動的な外界認識情報Ｉｐｒｄを使用しないで静的な外界認識情報Ｉｐｒｓを使用し、演算周期が、相対的に長い周期、例えば数百ｍｓ程度の長周期Ｔｌ（Ｔｌ＝９×Ｔｏｃ）で、相対的に長い時間（長い距離）、例えば１０秒間程度の走行時間に対応する長期軌道（１０ｓｅｃ軌道ともいう。）Ｌｔを生成する。

中期軌道生成部７２は、統括制御部７０からの演算指令Ａｄに応答して、局所環境マップ情報Ｉｅｍ（動的な外界認識情報Ｉｐｒｄと静的な外界認識情報Ｉｐｒｓを含む。）、自車状態情報Ｉｖｈ、及び長期軌道Ｌｔを参照して、演算周期３×Ｔｏｃで中期軌道Ｍｔを生成し、生成した中期軌道Ｍｔを更新カウンタのカウント値とともに、統括制御部７０に出力する。中期軌道Ｍｔは、軌道情報Ｉｔとして、軌道情報記憶部４８に記憶される。

中期軌道生成部７２は、例えば、外界認識部５１がレーンＬの前方に駐車車両等の障害物（動的な外界認識情報Ｉｐｒｄに含まれる。）を発見した場合に、前記駐車車両等を迂回させる軌道（片側複数レーンがある場合には、必要に応じてレーン変更を含む軌道）であり、演算周期が、長周期Ｔｌより相対的に短い周期、例えば百数十ｍｓ程度の中周期Ｔｍ（Ｔｍ＝３×Ｔｏｃ）で、相対的に短い時間（短い距離）、例えば数秒間程度の走行時間に対応する中期軌道（５ｓｅｃ軌道ともいう。）Ｍｔを生成する。

中期軌道Ｍｔを生成する際に、局所環境マップ情報Ｉｅｍ中に、動的な外界認識情報Ｉｐｒｄが含まれていない場合、結果として、中期軌道Ｍｔは、長期軌道Ｌｔに概ね一致する。

短期軌道生成部７３は、統括制御部７０からの演算指令Ａｅに応答して、局所環境マップ情報Ｉｅｍ（動的な外界認識情報Ｉｐｒｄ及び静的な外界認識情報Ｉｐｒｓを含む。）、自車状態情報Ｉｖｈ、及び長期軌道Ｌｔを参照して生成された中期軌道Ｍｔを参照し、３つの軌道生成部中、最も短い演算周期Ｔｏｃで自車両１０の車両ダイナミクスに対応した短期軌道Ｓｔを生成し、生成した短期軌道Ｓｔを更新カウンタのカウント値とともに、統括制御部７０に出力し、同時に車両制御部１１０に出力する。

車両制御部１１０は、短期軌道Ｓｔに基づき、アクチュエータ２７を制御する。短期軌道Ｓｔは、軌道情報Ｉｔとして軌道情報記憶部４８に記憶される。

短期軌道Ｓｔを生成する際に、局所環境マップ情報Ｉｅｍ中に、動的な外界認識情報Ｉｐｒｄが含まれていない場合、結果として、短期軌道Ｓｔは、長期軌道Ｌｔを参照して生成された中期軌道Ｍｔに概ね一致する。

このようにして、短期軌道生成部７３は、演算周期が、長周期Ｔｌ及び中周期Ｔｍより相対的に短い周期、例えば数十ｍｓ程度の短周期Ｔｓ（Ｔｓ＝Ｔｏｃ）で、これから走行する相対的に短い時間（短い距離）、例えば１秒間程度の走行時間に対応する短期軌道（１ｓｅｃ軌道という。）Ｓｔを生成する。

短期軌道Ｓｔとしては、短周期Ｔｓ毎に、概ねレーンマークの中心線ＣＬに沿う縦方向の位置ｘ、横方向の位置ｙ、姿勢角θｚ、速度ｖｓ、加速度ｖａ、操舵角δｓｔ（車両１０の舵角δは、ステアリングホイールの操舵角δｓｔにギア比を考慮して算出することができる。）等に基づき、車両指令値としての軌道点列Ｐｊ（ｘ，ｙ，θｚ，ｖｓ，ｖａ，δｓｔ）｛上記（２）式参照。｝が生成される。

実際上、最終的な軌道点列Ｐｊが生成される前に、短期軌道生成部７３により短周期Ｔｓ（Ｔｓ＝Ｔｏｃ）毎に複数の軌道点列候補Ｐｃｊ（演算周期：Ｔｏｃ／５程度）が生成される。生成された軌道点列候補Ｐｃｊは、後述するように、同一短周期Ｔｓ内で、さらに、短期軌道生成部７３により車両ダイナミクス等に基づき軌道が評価された後、評価結果に応じて必要があれば修正されて短期軌道Ｓｔ分の出力軌道としての前記軌道点列Ｐｊが生成される。

車両制御部１１０は、入力された短期軌道Ｓｔ、すなわち、演算周期Ｔｏｃ／５程度で生成され入力された軌道点列Ｐｊに沿って車両１０が走行するように、軌道点列Ｐｊを車両制御値Ｃｖｈに変換して駆動力装置２８、操舵装置３０、及び制動装置３２に出力する。

なお、短期軌道Ｓｔ、中期軌道Ｍｔ、長期軌道Ｌｔの設定時間長さ（時間軌道ともいう。）は、速度ｖｓ、操舵角δｓｔ、走行ラインの曲率ρ、及び道路勾配等に応じて、例えば、短期軌道Ｓｔが０．２［ｓ］〜２［ｓ］、中期軌道Ｍｔが２［ｓ］から７［ｓ］、及び長期軌道Ｌｔが７［ｓ］から１５［ｓ］程度の範囲で変更してもよい。

［実施形態の動作説明］
［フローチャートによる説明］
基本的には以上のように構成される車両制御装置１２の動作について、図４のフローチャートを参照して詳細に説明する。なお、フローチャートに係るプログラムの実行主体は、車両制御装置１２の統括制御部７０である。

ステップＳ１にて、統括制御部７０は、認識結果受信部５２に対し、外界認識情報Ｉｐｒの受信を要求する演算指令Ａａを送出する。

この場合、外界認識部５１は、演算周期Ｔｏｃ未満の時間で、外界センサ１４中、カメラ３３からの外界情報（画像情報）に基づき、車両１０の両側（右側と左側）のレーンマークＬｍ（Ｌｍｒ、Ｌｍｌ）を認識するとともに、交差点等の停止線までの位置、及び走行可能領域（ガードレールや縁石を除いた領域）等の静的な外界認識情報Ｉｐｒｓを生成し、認識結果受信部５２に送信している。

同時に、外界認識部５１は、カメラ３３、レーダ３４及び図示しないＬＩＤＡＲ等からの外界情報に基づき、障害物（駐停車車両を含む）、交通参加者（人、他車両）、及び信号機の灯色等の動的な外界認識情報Ｉｐｒｄを生成し、認識結果受信部５２に送信している。

そのため、ステップＳ２にて、静的な外界認識情報Ｉｐｒｓ（例えば、主に、レーンマーク、停止線、縁石等道路区画線）と動的な外界認識情報Ｉｐｒｄ（例えば、主に、信号機灯色、交通参加者）は、外界認識情報Ｉｐｒとして、演算指令Ａａに同期して、更新カウンタのカウント値とともに認識結果受信部５２を通じて統括制御部７０により取得され、且つ記憶装置４０に記憶される。

ステップＳ３にて、統括制御部７０は、次の演算周期Ｔｏｃに同期して、局所環境マップ生成部５４に対し、外界認識情報Ｉｐｒ及び自車状態情報Ｉｖｈを送出するとともに、局所環境マップ情報Ｉｅｍの生成を要求する演算指令Ａｂを送出する。

この演算指令Ａｂに同期して、局所環境マップ生成部５４は、演算周期Ｔｏｃ内に外界認識情報Ｉｐｒに自車状態情報Ｉｖｈを併合（マージ）して、図３に示した局所環境マップＬｍａｐを含む局所環境マップ情報Ｉｅｍを生成し、更新した更新カウンタのカウント値とともに統括制御部７０に送出する。

これによりステップＳ４にて、統括制御部７０では、局所環境マップ情報Ｉｅｍを取得し、且つ記憶装置４０に記憶する。

次いで、ステップＳ５にて、統括制御部７０は、その次の演算周期Ｔｏｃに同期して、短期軌道生成部７３に対し、外界認識情報Ｉｐｒ、自車状態情報Ｉｖｈ、及び局所環境マップ情報Ｉｅｍを送出するとともに、短期軌道Ｓｔの生成を要求する演算指令Ａｅを送出する。

この演算指令Ａｅに同期して、短期軌道生成部７３は、前回出力した短期軌道Ｓｔを初期値（初期位置）に設定し、その初期値（初期位置）を基準に、自車状態情報Ｉｖｈ及び局所環境マップ情報Ｉｅｍを参照して演算周期Ｔｏｃの１／５毎の（演算周期Ｔｏｃを５分周した）ノーズ方向（縦方向ｘ）ｎｄとノーズ方向ｎｄに直交する方向（横方向ｙ）の、車両１０の基準点Ｂｐ（図３）の位置座標（ｘ，ｙ）を含む複数の軌道点列候補Ｐｃｊを生成する。

短期軌道生成部７３は、生成した軌道点列候補Ｐｃｊの軌道が、局所環境マップ情報Ｉｅｍに照らして、車両ダイナミクスを考慮しつつ、例えば、信号機の灯色が青色である場合に交差点を通過できるか、信号機の灯色が赤色である場合に交差点の手前の停止線で停止できるか等の評価をし、評価結果が、肯定的な評価となるまで、軌道点列候補Ｐｃｊを修正し、出力軌道である軌道点列Ｐｊを生成する。生成された軌道点列Ｐｊは、統括制御部７０及び車両制御部１１０に送出される。

車両制御部１１０は、軌道点列Ｐｊを車両制御値Ｃｖｈに変換してアクチュエータ２７（駆動力装置２８、操舵装置３０、及び制動装置３２）に送出する。

ステップＳ６にて、この軌道点列Ｐｊからなる短期軌道Ｓｔ及び更新された更新カウンタのカウント値が統括制御部７０に取得され、且つ軌道情報Ｉｔとして軌道情報記憶部４８に記憶されるとともにカウント値が更新カウンタ記憶部４９に記憶される。

次いで、ステップＳ７にて、統括制御部７０は、自動運転スイッチ２２がオン状態の自動運転モードに設定されているか否かを判定する。

自動運転スイッチ２２がオフ状態の非自動運転モードに設定されている（ステップＳ７：ＮＯ）場合、ステップＳ１以降の短期軌道Ｓｔの生成処理が繰り返される。

自動運転スイッチ２２がオン状態の自動運転モードに設定されている（ステップＳ７：ＹＥＳ）場合、ステップＳ８にて、各更新カウンタのカウント値が更新されているか否かを確認し、更新されていない場合（時刻がずれている場合）には、ステップＳ１に戻り、更新されている場合には、ステップＳ９にて、自動運転モードに瞬時に切り替えられる｛非自動運転モードから自動運転モードに遷移（移行）されるともいう。｝。

［タイムチャートによる説明］
次に、図５（１／３）、図６（２／３）、及び図７（３／３）のタイムチャートを参照して、非自動運転モードから自動運転モードへの遷移動作、及び自動運転モードでの車両制御装置１２の動作を説明する。

図５中、時点ｔ０にて、ドライバ等による自動運転スイッチ２２の操作により手動運転モード（自動運転 オフ状態）から自動運転モード（自動運転 オン状態）に切り替えられる。

時点ｔ０より前の時点ｔ−２（図５中、最左端の時点）にて、統括制御部７０は、演算周期Ｔｏｃに対応する処理Ｐｒｏ１の開始近傍にて、認識結果受信部５２（図１、図２）に外界認識情報Ｉｐｒの受信を要求する演算指令Ａａ（図５には不図示）及び局所環境マップ生成部５４に局所環境マップ情報Ｉｅｍの生成を要求する演算指令Ａｂを同時に送出する（ステップＳ３対応）とともに、短期軌道生成部７３に対し短期軌道Ｓｔの生成を要求する演算指令Ａｅを同時に送出する（ステップＳ５対応）。

演算指令Ａｅに応答して、短期軌道生成部７３は、演算周期Ｔｏｃ内の時間にて短期軌道Ｓｔ１を生成して統括制御部７０及び車両制御部１１０に出力する。

また、局所環境マップ生成部５４は、時点ｔ−２の演算指令Ａｂに応答して略演算周期Ｔｏｃの時間にて局所環境マップ情報Ｉｅｍ１を生成して統括制御部７０に出力する。

なお、局所環境マップ情報Ｉｅｍ１は、外界認識情報Ｉｐｒと自車状態情報Ｉｖｈの合成情報であるので、局所環境マップ情報Ｉｅｍを生成する処理Ｐｒｏ１の終了前に、演算指令Ａａに応答して、外界認識部５１から受信している外界認識情報Ｉｐｒが認識結果受信部５２から統括制御部７０を経由して局所環境マップ生成部５４に送出されているが、紙面の都合上、演算指令Ａａ、及び外界認識情報Ｉｐｒの処理は、省略している。

実際上、時点ｔ−２では、自車状態情報Ｉｖｈ１が存在しないので、局所環境マップ生成部５４の時点ｔ−１の処理Ｐｒｏ２で、自車状態情報Ｉｖｈ１を考慮した局所環境マップ情報Ｉｅｍ２が生成される。時点ｔ−１以降、局所環境マップ情報Ｉｅｍが連続的に生成される。

車両制御部１１０は、統括制御部７０の処理Ｐｒｏ１の終点の時点ｔ−１にて、短期軌道生成部７３の処理Ｐｒｏ１の終点で受信した短期軌道Ｓｔ１に対応する自車状態情報Ｉｖｈ１を統括制御部７０に送出する。

次の演算周期Ｔｏｃに対応する処理Ｐｒｏ２で、上述したように、演算指令Ａｂ、Ａｅに応答して、短期軌道Ｓｔ２、局所環境マップ情報Ｉｅｍ２、及び自車状態情報Ｉｖｈ２が生成される。

統括制御部７０の処理Ｐｒｏ２が終了する時点ｔ１の前の時点ｔ０にて、自動運転スイッチ２２がオン状態に操作された（ステップＳ７：ＹＥＳ）ものとしている。

この場合、次の演算周期Ｔｏｃの処理Ｐｒｏ３の開始時点ｔ１には、車両制御部１１０により、短期軌道Ｓｔ２のみで生成された車両制御値Ｃｖｈに基づいてアクチュエータ２７（駆動力装置２８、操舵装置３０及び制動装置３２）が制御されて自動運転が実施される。

そして、自動運転スイッチ２２がオン状態に操作されたことに応答して、統括制御部７０により処理Ｐｒｏ３の開始時点近傍にて、統括制御部７０から短期軌道生成部７３、中期軌道生成部７２及び長期軌道生成部７１に対して、それぞれ、短期軌道Ｓｔ３、中期軌道Ｍｔ１及び長期軌道Ｌｔ１（図６参照）の生成を要求する演算指令Ａｅ、Ａｄ、Ａｃが送出される。

なお、統括制御部７０の処理Ｐｒｏ３の開始時点近傍にて、統括制御部７０から短期軌道生成部７３に対する短期軌道Ｓｔの生成を要求する演算指令Ａｅは、継続（連続）して送出されている点、すなわち、自動運転開始前から連続して短期軌道Ｓｔが生成されている点に留意する。

そうすると、演算周期Ｔｏｃの略３倍経過時の処理Ｐｒｏ５（統括制御部７０）中に、処理Ｐｒｏ１（中期軌道生成部７２）での中期軌道Ｍｔ１が生成され、統括制御部７０を介して短期軌道生成部７３に送出される。

この場合、その次の演算周期Ｔｏｃ中の処理Ｐｒｏ６（統括制御部７０）で、５ｓｅｃ軌道の中期軌道Ｍｔ１を考慮した、通常の場合には、車両１０の走行ラインがより滑らかになる短期軌道Ｓｔ６が生成される。

なお、中期軌道Ｍｔ１を考慮したとは、短期軌道生成部７３が短期軌道Ｓｔ４を生成する際に、自車両１０の現在位置の速度ｖｓ、加速度ｖａ、ヨーレートγ、及び操舵角δｓｔに基づき周辺環境に考慮し自車両１０の現在位置（始点）から１［ｓｅｃ］後の目標点（終点）に至るまでの短期軌道Ｓｔ６選定用の複数の軌道点列候補Ｐｃｊが生成される。

そして、生成された短期軌道Ｓｔ６の各軌道点列候補Ｐｃｊが、中期軌道Ｍｔ１の軌道点列Ｐｊに対し後述する評価関数に基づき評価されるとともに、処理Ｐｒｏ５（局所環境マップ生成部５４）で生成されている局所環境マップ情報Ｉｅｍ５の局所環境マップＬｍａｐに対し後述する他の評価関数に基づき評価されて、評価の高い軌道点列候補Ｐｃｊが選択され、選択された軌道点列候補Ｐｃｊが軌道点列Ｐｊとされた短期軌道Ｓｔ６が生成される、という意味である。

短期軌道Ｓｔ６の軌道点列Ｐｊが車両制御部１１０を通じて演算周期Ｔｏｃ÷５の周期で車両制御値Ｃｖｈに変換され、アクチュエータ２７に出力されることで自動運転が行われる（図５中、「Ｓｔ＋Ｍｔで自動運転」と付記された期間）。

この場合、中期軌道Ｍｔ１の軌道点列Ｐｊとの評価関数は、中期軌道Ｍｔ１の軌道点列Ｐｊと短期軌道Ｓｔ６の各軌道点列候補Ｐｃｊの対応する点での各要素（位置ｘ，ｙ、速度ｖｓ、操舵角δｓｔ等）の偏差（車両制御値Ｃｖｈに係わる偏差）が小さい程、評価が高くなるように設定され、局所環境マップＬｍａｐ（自車状態情報Ｉｖｈと外界認識情報Ｉｐｒから生成されたレーンＬや自車両１０の最適走行ライン、例えば、直線レーンであればレーン中心線ＣＬ、カーブレーンであればアウト−イン−アウト走行ライン。）に対する評価関数は、短期軌道Ｓｔ６の各軌道点列候補Ｐｃｊの位置ｘ，ｙと局所環境マップＬｍａｐの最適走行ライン等との偏差（レーンＬに係わる位置偏差）等が小さい程、評価が高くなるように設定されている。両評価関数の評価値の重み付け合計値が最も高い軌道点列候補Ｐｃｊが短期軌道Ｓｔ６の軌道点列Ｐｊに設定される。

次いで、自動運転の開始時点ｔ１から演算周期Ｔｏｃの略９倍経過時の統括制御部７０による処理Ｐｒｏ１１中に、長期軌道生成部７１の処理Ｐｒｏ１で長期軌道Ｌｔ１が生成され、演算周期Ｔｏｃ中の処理Ｐｒｏ１５（統括制御部７０）で、１０ｓｅｃ軌道の長期軌道Ｌｔ１、及び５ｓｅｃ軌道の中期軌道Ｍｔ３を考慮した、車両１０の短期軌道Ｓｔ１５が、短期軌道生成部７３の処理Ｐｒｏ１５で生成される。

なお、短期軌道Ｓｔ１５が長期軌道Ｌｔ１及び中期軌道Ｍｔ３を考慮した、とは、中期軌道生成部７２が、例えば、中期軌道Ｍｔ４を処理Ｐｒｏ４で生成する際に、短期軌道Ｓｔ４の生成処理で説明したのと同様に、複数の軌道点列候補Ｐｃｊからなる複数の中期軌道Ｍｔ４の候補が生成され、生成された各軌道点列候補Ｐｃｊが、処理Ｐｒｏ１（長期軌道生成部７１）で生成されている長期軌道Ｌｔ１の軌道点列Ｐｊ及び処理Ｐｒｏ１１（局所環境マップ生成部５４）で生成された局所環境マップ情報Ｉｅｍの局所環境マップＬｍａｐと評価関数に基づき評価されて、評価の高い軌道点列候補Ｐｃｊが中期軌道Ｍｔ４の軌道点列Ｐｊとされる（図６参照）。

さらに、このようにして長期軌道Ｌｔ１が参照されて生成された中期軌道Ｍｔ４と、短期軌道Ｓｔ１５の複数の候補が上記したように評価関数により評価されることで、長期軌道Ｌｔ１を参照して生成された中期軌道Ｍｔ４が参照された短期軌道Ｓｔ１５が生成される（図７参照）、という意味である。

図７中の時点ｔ３以降、「Ｓｔ＋Ｍｔ＋Ｌｔで自動運転」と付記された期間では、ドライバの運転感覚に近く乗り心地が十分に考慮された自動運転が実行される。

［比較例のタイムチャート］
図８（１／３）、図９（２／３）、及び図１０（３／３）のタイムチャートは、比較例に係る、非自動運転モードから自動運転モードへの遷移動作、及び自動運転モードでの車両制御装置１２の動作を説明している。

図８〜図１０のタイムチャート中に記載した時点、符号、表現は、図５〜図７のタイムチャートの中に記載した時点、符号、表現と同様であるのでその詳細な説明は省略する。

この比較例に係る動作では、自動運転スイッチ２２がオン状態の自動運転モードにされた時点ｔ０での演算指令Ａｃによる長期軌道Ｌｔの生成要求に基づき、処理Ｐｒｏ１（長期軌道生成部７１）で長期軌道Ｌｔ１（図９）が生成される。その後、処理Ｐｒｏ１（中期軌道生成部７２）で中期軌道Ｍｔ４（図９、図１０）が生成される。

その後、時点ｔ３（図１０）にて、「Ｓｔ＋Ｍｔ＋ＬＴで自動運転」が開始される。

［実施形態及び比較例の縮尺版のタイムチャートによる説明］
図１１は、図５〜図７をまとめて描いた実施形態に係るタイムチャートを示し、図１２は、図８〜図１０をまとめて描いた比較例に係るタイムチャートを示す。

この実施形態に係る車両１０では、自動運転スイッチ２２が時点ｔ０にてオン状態にされてから演算周期Ｔｏｃ未満の直後の時点ｔ１にて車両制御部１１０により車両制御値Ｃｖｈが生成されるので、その時点ｔ１から自動運転を開始することができるが、比較例に係る車両１０では、自動運転スイッチ２２が時点ｔ０にてオン状態にされた直後の時点ｔ１から時間（遅延時間）Ｔγ（Ｔγ≒Ｔｏｃ×１５、図１２参照）後に自動運転が開始するので、自動運転が開始するまでに時間がかかる。

このように比較例に係る車両１０では、時点ｔ１から、車両制御部１１０から車両制御値Ｃｖｈが送出されるまでの遅延時間Ｔγが、この実施形態に比較して、概ね演算周期Ｔｏｃ×１３（遅延時間）分、遅延して自動運転が開始される。

これに対して、この実施形態に係る車両１０では、自動運転スイッチ２２がオン状態にされた時点ｔ０から直ちに、最大でも自動運転スイッチ２２がオン状態にされた時点ｔ０から演算周期Ｔｏｃ以内に自動運転が開始される。

［まとめ］
以上説明したように、上述した実施形態によれば、自動運転可能な車両１０を制御する車両制御装置１２が、外界認識情報Ｉｐｒに基づき、演算周期が相対的に長い長周期Ｔｌ（Ｔｌ＝Ｔｏｃ×９）で（相対的に長期の）長期軌道Ｌｔを生成する長期軌道生成部７１と、生成された長期軌道Ｌｔを考慮して前記長周期Ｔｌ（Ｔｌ＝Ｔｏｃ×９）より短い短周期Ｔｓ（Ｔｓ＝Ｔｏｃ）で相対的に短期の短期軌道Ｓｔを生成する短期軌道生成部７３と、自動運転をオン状態に設定する自動運転オン設定部としての自動運転スイッチ２２と、これらを制御する統括制御部７０とを備える。

この場合において、統括制御部７０は、自動運転スイッチ２２により自動運転がオン状態（自動運転モード）に設定されたとき、長期軌道生成部７１及び短期軌道生成部７３に対し、軌道の生成を同時に開始させる（時点ｔ１）一方、長期軌道Ｌｔが生成される前（時点ｔ１〜時点ｔ３より前の期間）は、少なくとも短期軌道Ｓｔにより車両１０を制御している。

このように、自動運転がオン状態に設定されたとき、長期軌道Ｌｔが生成される前は、少なくとも短期軌道Ｓｔにより車両１０が制御されるようにしたので、自動運転スイッチ２２がオン状態にされたとき、車両１０を直ちに自動運転制御でき、且つ長期軌道生成部７１及び短期軌道生成部７３に対し、同時に軌道の生成を開始させるようにしたので、上位の長期軌道Ｌｔが考慮された下位の短期軌道Ｓｔが生成されるまでの時間が長くなることはない。

一般に、長期軌道Ｌｔでは乗り心地が重視され、短期軌道Ｓｔでは環境に対する適応性・応答性が重視される。

この実施形態による車両制御装置１２が搭載された車両１０では、自動運転がオン状態に設定されたとき、信号機の灯色や交通参加者等の環境状況に対する応答性が確保された自動運転を直ぐに開始しつつ、所定周期経過後には、より一層の乗り心地が考慮された自動運転を行うことができる。

この場合、外界認識情報Ｉｐｒは、状態が変化しない静的な外界認識情報Ｉｐｒｓと、状態が変化する動的な外界認識情報Ｉｐｒｄとを含み、長期軌道生成部７１は、静的な外界認識情報Ｉｐｒｓを用いて長期軌道Ｌｔを生成し、短期軌道生成部７３は、静的な外界認識情報Ｉｐｒｓ及び動的な外界認識情報Ｉｐｒｄを用いて短期軌道Ｓｔを生成するようにしている。

このように、下位の短期軌道生成部７３は、状態が変化しない静的な外界認識情報Ｉｐｒｓと状態が変化する動的な外界認識情報Ｉｐｒｄを用いて短期軌道Ｓｔを生成するので、適応性・応答性を考慮しつつ車両１０を直ちに自動運転できる。

そして、状態が変化しない静的な外界認識情報Ｉｐｒｓと地図情報記憶部４２に記憶されている道路地図（外界センサ１４から取得できない車両１０前方のカーブ等も含まれる。）等を参照して上位の長期軌道生成部７１で長期軌道Ｌｔが生成された後は、該長期軌道Ｌｔを考慮して短期軌道生成部７３で短期軌道Ｓｔを生成させるようにしている。

このため、動的な外界認識情報Ｉｐｒｄに基づき車両１０を短期軌道Ｓｔに基づき直ちに制御でき、静的な外界認識情報Ｉｐｒｓに基づいて長期軌道Ｌｔが生成された後は、急峻な車両挙動の発生が抑制され、且つ乗り心地・快適性も考慮された自動運転を行うことができる。

なお、統括制御部７０は、短期軌道生成部７３に対し、長期軌道Ｌｔが生成された後は、最終的な短期軌道Ｓｔを生成する際、長期軌道Ｌｔを参照して生成された中期軌道Ｍｔと短期軌道Ｓｔの複数の候補とを比較評価し、評価の高い候補を最終的な短期軌道Ｓｔとするように制御することで、長期軌道Ｌｔが生成された後は、環境に対する応答性の他に乗り心地が考慮された自動運転を行うことができる。

上述した実施形態では、短期軌道生成部７３の他に、短周期Ｔｓ（Ｔｓ＝Ｔｏｃ）より長く長周期Ｔｌ（Ｔｌ＝Ｔｏｃ×９）より短い中周期Ｔｍ（Ｔｍ＝Ｔｏｃ×３）で相対的に中期な中期軌道を生成する中期軌道生成部７２を設けている。

そして、統括制御部７０は、自動運転がオン状態に設定されたとき、長期軌道生成部７１、短期軌道生成部７３及び中期軌道生成部７２に対し、各軌道の生成を同時に開始させる一方、中期軌道Ｍｔが生成される前は、短期軌道Ｓｔにより車両１０を制御し、中期軌道Ｍｔが生成されたときは、該中期軌道Ｍｔを考慮した短期軌道Ｓｔにより車両１０を制御し、中期軌道Ｍｔが生成されたときは、該中期軌道Ｍｔを考慮して短期軌道Ｓｔを生成し、長期軌道Ｌｔが生成されたときは、該長期軌道Ｌｔ及び前記中期軌道Ｍｔを考慮して短期軌道Ｓｔを生成して、車両１０を制御するようにしている。

このように、自動運転がオン状態とされたとき、まず、演算周期の最も短い演算周期Ｔｏｃで短期軌道生成部７３により生成した短期軌道Ｓｔで車両１０を制御し、次に、演算周期が次に短い演算周期３×Ｔｏｃで中期軌道生成部７２により生成した中期軌道Ｍｔを考慮した短期軌道Ｓｔで車両１０を制御し、次いで、演算周期が最も長い演算周期９×Ｔｏｃで長期軌道生成部７１により生成した長期軌道Ｌｔ及び中期軌道Ｍｔを考慮して生成された短期軌道Ｓｔで車両１０を制御するようにしたので、直ちに自動運転を開始でき、且つ徐々に段階的に、乗り心地・快適性を考慮した自動運転に移行することができる。

［変形例］
なお、この発明は、上記実施形態に限らず、この明細書の記載内容に基づき、種々の構成を採り得ることはもちろんである。

変形例１：例えば、比較例での処理と実施形態での処理を切り替えるボタン等の切替操作部を設け、ドライバ等のユーザが選択できるようにしてもよい。

変形例２：また、車両制御装置１２と同一構成の車両制御装置を外部のサーバ（外部車両制御装置）にも設け、通信装置２０を通じて、車両１０の車両制御装置１２のデータを吸い上げ、車両１０を制御するようにしてもよい。この場合、車両１０には、車両制御装置１２中、車両制御部１１０のみを設けてもよく（サーバからの短期軌道Ｓｔが車両制御部１１０に送出される。）、設けなくともよい（サーバから車両制御値Ｃｖｈが駆動力装置２８等に送出される。）。なお、車両１０から車両制御装置１２を削除し、外部のサーバに車両制御装置１２として設け、該サーバをミラー構成（記憶装置４０に記憶される情報が同一となるように常時更新。）とし車両１０の車両制御装置１２をバックアップするようにしてもよい。

Claims (3)

1. 自動運転可能な車両（１０）を制御する車両制御装置（１２）であって、
   外界認識情報に基づき、演算周期が相対的に長い長周期で長期軌道（Ｌｔ）を生成する長期軌道生成部（７１）と、生成された前記長期軌道（Ｌｔ）を考慮し前記長周期より短い短周期で短期軌道（Ｓｔ）を生成する短期軌道生成部（７３）と、
   前記長期軌道生成部（７１）及び前記短期軌道生成部（７３）を制御する統括制御部（７０）と、
   を備え、
   前記短期軌道生成部（７３）は、該短期軌道生成部（７３）の他に、前記短周期より長く前記長周期より短い中周期で相対的に中期な中期軌道（Ｍｔ）を生成する中期軌道生成部（７２）に分割され、
   前記統括制御部（７０）は、
   自動運転を行う際、前記長期軌道生成部（７１）、前記短期軌道生成部（７３）及び前記中期軌道生成部（７２）に対し、各軌道の生成を同時に開始させる一方、前記中期軌道（Ｍｔ）が生成される前は、前記短期軌道（Ｓｔ）により前記車両（１０）を制御させ、前記中期軌道（Ｍｔ）が生成されたときは、該中期軌道（Ｍｔ）を参照した前記短期軌道（Ｓｔ）により前記車両（１０）を制御させ、前記長期軌道（Ｌｔ）が生成されたときは、該長期軌道（Ｌｔ）を参照して生成された前記中期軌道（Ｍｔ）を参照した前記短期軌道（Ｓｔ）を生成させ、該短期軌道（Ｓｔ）により前記車両（１０）を制御させる
   ことを特徴とする車両制御装置（１２）。
2. 請求項１に記載の車両制御装置（１２）において、
   前記外界認識情報は、状態が変化しない静的情報と、状態が変化する動的情報とを含み、
   前記長期軌道生成部（７１）は、前記静的情報を用いて前記長期軌道（Ｌｔ）を生成し、
   前記中期軌道生成部（７２）及び前記短期軌道生成部（７３）は、前記静的情報及び前記動的情報を用いて前記短期軌道（Ｓｔ）を生成する
   ことを特徴とする車両制御装置（１２）。
3. 請求項１又は２に記載の車両制御装置（１２）において、
   前記長期軌道（Ｌｔ）は、乗り心地が重視された軌道とされ、前記短期軌道（Ｓｔ）は、外界環境に対する応答性が重視された軌道とされている
   ことを特徴とする車両制御装置（１２）。

Images