JP7186952B2

JP7186952B2 - 車両制御装置

Info

Publication number: JP7186952B2
Application number: JP2020022285A
Authority: JP
Inventors: 多加志後藤; 章博元谷; 龍介野見山; 康弘川原; 隆幸松島; 博志大村
Original assignee: Mazda Motor Corp
Current assignee: Mazda Motor Corp
Priority date: 2020-02-13
Filing date: 2020-02-13
Publication date: 2022-12-12
Anticipated expiration: 2040-02-13
Also published as: JP2021126981A

Description

本発明は、車両制御装置に係り、特に、運転者による車両の運転を支援する車両制御装置に関する。

従来、複数の評価ファクタを含む評価関数に基づいて、車両走行経路を計算する技術が提案されている（例えば、特許文献１参照）。特許文献１に記載された車両制御装置では、複数の運転支援モードにおいてそれぞれ異なる評価関数が設定されている。すなわち、運転支援モード毎に、複数の評価ファクタの重み係数が異なって設定されている。

したがって、特許文献１に記載の車両制御装置では、運転支援モードの切替わりにより評価関数が変更される。これにより、特許文献１では、車両は、選択されている運転支援モードに適した車両走行経路を走行することができる。

特開２０１９－４３１９２号公報

しかしながら、引用文献１に記載の車両制御装置では、運転支援モードの切替え時に評価関数が変更されると、算出される車両走行経路も変更される。このため、運転支援モードの切替わり直後に車両挙動が急に変化するおそれがあった。具体的には、自動的な車両制御により急操舵や急加減速が実行されるおそれがあった。これは、乗員に不快感を与え得る。

本発明は、このような問題を解決するためになされたものであり、複数の運転支援モードを備える車両制御装置において、運転支援モードの切替わり直後の車両挙動を安定させることが可能な車両制御装置を提供することを目的としている。

上述した課題を解決するために、本発明は、車両の運転を支援するための複数の運転支援モードを備えた車両制御装置であって、車両制御装置は、車両の目標走行経路を算出し、補正走行経路を評価するための評価関数を用いて所定の制約条件下で目標走行経路に基づいて補正走行経路を算出すると共に、車両が補正走行経路を走行するための車両の制御目標値を算出するように構成されており、車両制御装置は、複数の運転支援モードの各々に対して異なって設定された複数の評価関数を有し、選択されている運転支援モードに対応する評価関数を用いるように構成されており、車両制御装置は、運転支援モードの変更時に用いるための、複数の評価関数とは異なる過渡評価関数を更に有し、運転支援モードの変更後の所定期間において、評価関数に代えて過渡評価関数を用い、評価関数は、重み係数により重み付けされた、車両の横方向の挙動を表す物理量に関する評価ファクタを含み、重み係数は、運転支援モードに応じて異なるように設定されており、過渡評価関数は、過渡重み係数により重み付けされた評価ファクタを含み、評価ファクタの過渡重み係数は、運転支援モードの変更後の所定期間において時間経過と共に初期値から変化するように設定され、所定期間の経過後に変更後の運転支援モードの評価関数の評価ファクタの重み係数の値と一致し、運転支援モードの変更前に対する変更後の車両の目標走行経路が車両の横方向にシフトする場合において、初期値は、運転支援モードの変更時における車両の横方向の挙動変化を抑制するように、変更前の運転支援モードの評価関数の評価ファクタの重み係数よりも大きな値又は小さな値に設定されることを特徴としている。

このように構成された本発明によれば、運転支援モードの変更時に、補正走行経路を算出するために用いられる評価関数が、運転支援モードの変更に併せて急に切り替えられるのではなく、運転支援モードの変更後の所定期間の間だけ過度評価関数が代わりに用いられる。そして、所定期間の経過後に、変更された運転支援モードのための評価関数が用いられる。したがって、本発明では、運転支援モードの変更直後に車両挙動を急激に変化させるような補正走行経路が算出されることを抑制することができる。
また、このように構成された本発明によれば、運転支援モードの変更後の所定期間において、過渡重み係数の値を変更後の運転支援モードの重み係数の値に徐々に近づけることができる。これにより、本発明では、運転支援モードの変更後に、車両の挙動を変更後の運転支援モードの車両挙動に滑らかに近づけることができる。

本発明において、好ましくは、過渡評価関数は、変更前の運転支援モードと変更後の運転支援モードの組合せに応じて、異なるように設定される。このように構成された本発明によれば、変更の前後の運転支援モードの組合せに応じて、運転支援モードの変更直後の車両挙動を安定させるような適切な過渡評価関数を設定することができる。

本発明において、好ましくは、車両制御装置は、評価関数又は過渡評価関数を用いて、複数の候補補正走行経路についての評価値を算出し、評価値の最も良い候補補正走行経路を補正走行経路として算出する。

本発明において、好ましくは、評価関数は、各々重み係数により重み付けされた複数の評価ファクタの総和を含み、重み係数は、運転支援モードに応じて異なるように設定されており、過渡評価関数は、各々過渡重み係数により重み付けされた複数の評価ファクタの総和を含み、過渡重み係数は、運転支援モードの変更前と変更後の運転支援モードの組合せに応じて設定されている。

このように構成された本発明によれば、変更の前後の運転支援モードの組合せに応じて過渡重み係数を設定することにより、運転支援モードの変更直後の車両挙動を安定させるような適切な過渡評価関数を設定することができる。

本発明において、好ましくは、過渡重み係数は、変更後の運転支援モードの重み係数よりも、車両の横方向の位置に関する評価ファクタについての重み付けを小さくするように設定され、及び／又は、車両の舵角速度に関する評価ファクタについての重み付けを大きくするように設定されている。

このように構成された本発明によれば、運転支援モードの変更によって、目標走行経路が車両の現在位置より横方向にシフトした場合であっても、急操舵が必要となるような補正走行経路が算出されることを抑制することができる。例えば、車両の横方向の位置に関する評価ファクタは、目標走行経路と補正走行経路の横方向の位置の差分を最小化するための評価ファクタであり、車両の舵角速度に関する評価ファクタは、補正走行経路での車両の舵角速度を最小化するための評価ファクタである。

本発明において、好ましくは、過渡重み係数は、変更後の運転支援モードの重み係数よりも、車両の速度に関する評価ファクタについての重み付けを小さくするか、車両の前後方向のジャークに関する評価ファクタについての重み付けを大きくするか、又は、車両の前後方向の加速度に関する評価ファクタについての重み付けを大きくするように設定されている。

このように構成された本発明によれば、運転支援モードの変更によって、車両の現在車速と目標走行経路による目標速度との間に差が生じた場合であっても、急加減速が必要となるような補正走行経路が算出されることを抑制することができる。例えば、車両の速度に関する評価ファクタは、目標走行経路での目標速度と補正走行経路での車速の差分を最小化するための評価ファクタであり、車両の前後方向のジャークに関する評価ファクタは、補正走行経路での車両の前後方向のジャークを最小化するための評価ファクタであり、車両の前後方向の加速度に関する評価ファクタは、補正走行経路での車両１の前後方向の加速度を最小化するための評価ファクタである。

本発明の車両制御装置によれば、運転支援モードの切替わり直後の車両挙動を安定させることができる。

本発明の実施形態による車両制御装置の構成図である。本発明の実施形態による車両制御装置の運転者操作部の詳細を示す図である。本発明の実施形態による車両制御装置の制御ブロック図である。本発明の実施形態による車両制御装置により計算される第１走行経路の説明図である。本発明の実施形態による車両制御装置により計算される第２走行経路の説明図である。本発明の実施形態による車両制御装置により計算される第３走行経路の説明図である。本発明の実施形態による車両制御装置における制御目標算出処理の説明図である。本発明の実施形態による車両制御装置における補正走行経路の説明図である。本発明の実施形態による車両制御装置における車両モデルの説明図である。本発明の実施形態による車両制御装置における目標走行経路の補正による障害物回避の説明図である。本発明の実施形態による車両制御装置において障害物を回避する際の障害物と車両との間のすれ違い速度の許容上限値とクリアランスとの関係を示す説明図である。本発明の実施形態による車両制御装置における運転支援制御の処理フローである。本発明の実施形態による車両制御装置における運転支援モードの切替わり時の補正走行経路の変化を示す説明図である。本発明の実施形態による車両制御装置における運転支援モードの切替わり時の評価関数の重み係数の変化を示す説明図である。本発明の実施形態による車両制御装置における運転支援モードの切替え例の説明図である。

以下、添付図面を参照して、本発明の実施形態による車両制御装置について説明する。
まず、図１及び図２を参照して、車両制御装置の構成について説明する。図１Ａは車両制御装置の構成図、図１Ｂは運転者操作部の詳細を示す図、図２は車両制御装置の制御ブロック図である。

本実施形態の車両制御装置１００は、これを搭載した車両１（図３等参照）に対して複数の運転支援モードにより、それぞれ異なる運転支援制御を提供するように構成されている。運転者は、複数の運転支援モードから所望の運転支援モードを選択可能である。

図１Ａに示すように、車両制御装置１００は、車両１に搭載されており、車両制御演算部（ＥＣＵ）１０と、複数のセンサ及びスイッチと、複数の制御システムと、運転支援モードについてのユーザ入力を行うための運転者操作部３５を備えている。複数のセンサ及びスイッチには、車載カメラ２１，ミリ波レーダ２２，車両の挙動を検出する複数の挙動センサ（車速センサ２３，加速度センサ２４，ヨーレートセンサ２５，舵角センサ２６，アクセルセンサ２７，ブレーキセンサ２８），測位システム２９，ナビゲーションシステム３０が含まれる。また、複数の制御システムには、エンジン制御システム３１，ブレーキ制御システム３２，ステアリング制御システム３３が含まれる。

図１Ｂに示すように、運転者操作部３５は、運転者が操作可能なように車両１の車室内に設けられており、複数の運転支援モードから所望の運転支援モードを選択するためのモード設定操作部として機能する。運転者操作部３５には、速度制限モードを設定するためのＩＳＡスイッチ３６ａと、先行車追従モードを設定するためのＴＪＡスイッチ３６ｂと、自動速度制御モードを設定するためのＡＣＣスイッチ３６ｃと、レーンキープ制御モードを設定するためのＬＡＳスイッチ３６ｄが設けられている。さらに、運転者操作部３５には、先行車追従モードにおける車間距離を設定するための距離設定スイッチ３７ａと、自動速度制御モード等における車速を設定するための車速設定スイッチ３７ｂと、を備えている。

図１Ａに示すＥＣＵ１０は、プロセッサ，各種プログラムを記憶するメモリ，入出力装置等を備えたコンピュータにより構成される。ＥＣＵ１０は、運転者操作部３５から受け取った運転支援モード選択信号や設定車速信号、及び、複数のセンサ及びスイッチから受け取った信号に基づき、エンジン制御システム３１，ブレーキ制御システム３２，ステアリング制御システム３３に対して、それぞれエンジンシステム，ブレーキシステム，ステアリングシステムを適宜に作動させるための要求信号を出力可能に構成されている。

車載カメラ２１は、車両１の周囲を撮像し、撮像した画像データを出力する。ＥＣＵ１０は、画像データに基づいて対象物（例えば、車両、歩行者、道路、区画線（車線境界線、白線、黄線）、交通信号、交通標識、停止線、交差点、障害物等）を特定する。さらに、本実施形態においては、車載カメラ２１として、車両を運転中の運転者を撮像する車室内カメラも備えている。なお、ＥＣＵ１０は、交通インフラや車々間通信等によって、車載通信機器を介して外部から対象物の情報を取得してもよい。

ミリ波レーダ２２は、対象物（特に、先行車、駐車車両、歩行者、障害物等）の位置及び速度を測定する測定装置であり、車両１の前方へ向けて電波（送信波）を送信し、対象物により送信波が反射されて生じた反射波を受信する。そして、ミリ波レーダ２２は、送信波と受信波に基づいて、車両１と対象物との間の距離（例えば、車間距離）や車両１に対する対象物の相対速度を測定する。なお、本実施形態において、ミリ波レーダ２２に代えて、レーザレーダや超音波センサ等を用いて対象物との距離や相対速度を測定するように構成してもよい。また、複数のセンサを用いて、位置及び速度測定装置を構成してもよい。

車速センサ２３は、車両１の絶対速度を検出する。
加速度センサ２４は、車両１の加速度（前後方向の縦加速度、横方向の横加速度）を検出する。なお、加速度は、増速側（正）及び減速側（負）を含む。
ヨーレートセンサ２５は、車両１のヨーレートを検出する。
舵角センサ２６は、車両１のステアリングホイールの回転角度（舵角）を検出する。
アクセルセンサ２７は、アクセルペダルの踏み込み量を検出する。
ブレーキセンサ２８は、ブレーキペダルの踏み込み量を検出する。

測位システム２９は、全球測位衛星システム（ＧＮＳＳ）及び／又はジャイロシステムであり、車両１の位置（現在車両位置情報）を検出する。また、測位システム２９は、デッドレコニングや路車間通信（Ｗｉ－Ｆｉ等を用いる）による位置情報取得手段を含んでもよい。

ナビゲーションシステム３０は、内部に地図情報を格納しており、ＥＣＵ１０へ地図情報を提供することができる。ＥＣＵ１０は、地図情報及び現在車両位置情報に基づいて、車両１の周囲（特に、進行方向前方）に存在する道路、交差点、交通信号、建造物等を特定する。地図情報は、ＥＣＵ１０内に格納されていてもよい。

エンジン制御システム３１は、車両１のエンジンを制御するコントローラである。ＥＣＵ１０は、車両１を加速又は減速させる必要がある場合に、エンジン制御システム３１に対して、エンジン出力の変更を要求するエンジン出力変更要求信号を出力する。

ブレーキ制御システム３２は、車両１のブレーキ装置を制御するためのコントローラである。ＥＣＵ１０は、車両１を減速させる必要がある場合に、ブレーキ制御システム３２に対して、車両１への制動力の発生を要求するブレーキ要求信号を出力する。

ステアリング制御システム３３は、車両１のステアリング装置を制御するコントローラである。ＥＣＵ１０は、車両１の進行方向を変更する必要がある場合に、ステアリング制御システム３３に対して、操舵方向の変更を要求する操舵方向変更要求信号を出力する。

図２に示すように、ＥＣＵ１０は、入力処理部１０ａ、周辺物標検出部１０ｂ、目標走行経路算出部１０ｃ、運転操作判断部１０ｅ、及び制御目標算出部１０ｆとして機能する単一のＣＰＵ又はプロセッサを備えている。なお、本実施形態では、単一のＣＰＵが複数の上記機能を実行するように構成されているが、これに限らず、複数のＣＰＵがこれら機能を実行するように構成することができる。

入力処理部１０ａは、車載カメラ２１を含む種々のセンサ／スイッチ群、及び運転者操作部３５から入力された入力情報を処理するように構成されている。この入力処理部１０ａは、走行路面を撮像したカメラ２１の画像を解析し、車両１が走行している走行車線（車線の両側の区画線）を検出する画像解析部として機能する。

周辺物標検出部１０ｂは、ミリ波レーダ２２、カメラ２１等からの入力情報に基づいて周辺物標を検出するように構成されている。
目標走行経路算出部１０ｃは、ミリ波レーダ２２、車載カメラ２１、センサ群等からの入力情報に基づいて車両の目標走行経路を算出するように構成されている。

運転操作判断部１０ｅは、運転支援制御として自動速度制御及び／又は自動操舵制御が実行されているときに、乗員がアクセルペダル，ブレーキペダル，又はステアリングホイールを操作した場合、乗員による操作を優先して、乗員による操作に応じた要求信号を制御システム３１～３３へ出力するように構成されている。すなわち、運転操作判断部１０ｅにより、乗員は、自動的な運転支援制御をオーバーライドして、自らが運転操作を行うことが可能である。

制御目標算出部１０ｆは、目標走行経路算出部１０ｃによって算出された目標走行経路を補正して、補正走行経路を算出し、この補正走行経路に基づいて制御システム３１～３３へ要求信号を出力するように構成されている。

例えば、制御目標算出部１０ｆは、周辺物標検出部１０ｂによって回避すべき周辺物標が検出された場合に、目標走行経路を補正して補正走行経路を算出する。また、制御目標算出部１０ｆは、運転支援モードの変更によって目標走行経路自体が変更になった場合にも、新たな目標走行経路を補正して補正走行経路を算出する。車両１は、この補正走行経路を走行することにより、新たな目標走行経路へ合流する。すなわち、この場合の補正走行経路は、現在の車両挙動（舵角，加速度等）を新たな目標走行経路における車両挙動に適合させるための遷移的な経路である。

制御目標算出部１０ｆは、補正走行経路を算出するため、所定の評価関数を用いる。制御目標算出部１０ｆは、目標走行経路を基準として評価関数を用いて複数の候補走行経路を評価し、所定の制約条件（又は、拘束条件）を満足するように最適化された１つの補正走行経路を算出する。また、本実施形態においては、評価関数及び制約条件は、選択されている運転支援モードや周辺物標等に基づいて、適宜設定される。

ＥＣＵ１０は、制御目標算出部１０ｆによって決定された最適な補正走行経路を走行すべく、少なくともエンジン制御システム３１，ブレーキ制御システム３２，又はステアリング制御システム３３のいずれか１つ又は複数に対する要求信号を生成し、出力する。

次に、本実施形態による車両制御装置１００が備える運転支援モードについて説明する。本実施形態では、運転支援モードとして、５つのモード（レーンキープ制御モード、先行車追従モード、自動速度制御モード、速度制限モード、基本制御モード）が備えられている。

＜レーンキープ制御モード＞
レーンキープ制御モードは、車両１が車線の中央付近を走行するようにステアリング制御するモードであり、車両制御装置１００による自動的なステアリング制御、速度制御（エンジン制御、ブレーキ制御）を伴う。

本実施形態では、レーンキープ制御モードの選択時（すなわち、ＬＡＳスイッチ３６ｄが操作又は押下されている状態）において、走行車線の車線両端部の検出の可否に応じて、異なる制御が行われる。すなわち、車線両端部の検出中、ＥＣＵ１０は、車両１が走行車線の中央付近を走行するようにステアリング制御及び速度制御を行う。しかしながら、車線両端部が検出されない場合、運転支援モードは、基本制御モード（オフモード）に切り替えられる。基本制御モードでは、運転者がステアリング操作，アクセル操作及びブレーキ操作を行う。

なお、車線両端部とは、車両１が走行する車線の両端部（白線等の区画線，道路端，縁石，中央分離帯，ガードレール等）であり、隣接する車線や歩道等との境界である。ＥＣＵ１０は、この車線両端部を車載カメラ２１より撮像された画像データから検出する。また、ナビゲーションシステム３０の地図情報から車線両端部を検出してもよい。

＜先行車追従モード＞
先行車追従モードは、基本的に、車両１と先行車との間に車速に応じた所定の車間距離を維持しつつ、先行車の走行軌跡を車両１に追従走行させるモードであり、車両制御装置１００による自動的なステアリング制御，速度制御（エンジン制御，ブレーキ制御）を伴う。

本実施形態では、ＥＣＵ１０は、車載カメラ２１による画像データ及びミリ波レーダ２２による測定データにより、先行車を検出する。具体的には、車載カメラ２１による画像データにより前方を走行する他車両を走行車として検出する。更に、本実施形態では、ミリ波レーダ２２による測定データにより、車両１と他車両との車間距離が所定距離（例えば、４００～５００ｍ）以下である場合に、当該他車両が先行車として検出される。なお、代替的に、車載カメラ２１及び／又はミリ波レーダ２２が先行車を検出して、先行車の位置等の先行車情報をＥＣＵ１０へ出力してもよい。

本実施形態では、先行車追従モードの選択時（すなわち、ＴＪＡスイッチ３６ｂが操作又は押下されている状態）において、先行車の検出の可否に応じて、異なる制御が行われる。すなわち、先行車の検出中は、ＥＣＵ１０は、車両１が先行車を追従走行するようにステアリング制御及び速度制御を行う。しかしながら、先行車が検出されない間は、運転支援モードは、基本制御モード（オフモード）に切り替えられる。または、代替的に、先行車が検出されない間は、ＥＣＵ１０は、車両１が設定車速で走行するように速度制御を行い、運転者がステアリング操作を行う。なお、設定車速は、例えば、車速設定スイッチ３７ｂによって設定することができる。

また、代替的な先行車追従モードにおいて、車線両端部及び先行車の検出の可否に応じて、異なる制御が行われるように構成してもよい。例えば、代替的な先行車追従モードでは、車線両端部及び先行車が検出されている場合、ＥＣＵ１０は、車両１が先行車の走行軌跡を追従するのではなく、先行車との所定の車間距離を維持しながら、車両１が走行車線の中央付近を走行するようにステアリング制御及び速度制御を行う。一方、先行車は検出されているが、車線両端部は検出されていない場合は、ＥＣＵ１０は、車両１が先行車の走行軌跡を追従走行するようにステアリング制御及び速度制御を行う。さらに、車線両端部は検出されているが、先行車は検出されていない場合、ＥＣＵ１０は、車両１が走行車線の中央付近を設定車速で走行するようにステアリング制御及び速度制御を行う。さらに、先行車も車線両端部も検出されていない場合、ＥＣＵ１０は、車両１は設定車速で走行するように速度制御を行い、運転者がステアリング操作を行う。

＜自動速度制御モード＞
また、自動速度制御モードは、車速設定スイッチ３７ｂを使用して運転者によって予め設定された所定の設定車速（一定速度）を維持するように速度制御するモードであり、車両制御装置１００による自動的な速度制御（エンジン制御，ブレーキ制御）を伴うが、ステアリング制御は行われない。この自動速度制御モードでは、車両１は、設定車速を維持するように走行するが、運転者によるアクセルペダルの踏み込みにより設定車速を超えて増速され得る。また、運転者がブレーキ操作を行った場合には、運転者の意思が優先され、設定車速から減速される。また、先行車に追いついた場合には、車速に応じた車間距離を維持しながら先行車に追従するように速度制御され、先行車が存在しなくなると、再び設定車速に復帰するように速度制御される。

＜速度制限モード＞
また、速度制限モードは、車両１の車速が速度標識による制限速度又は運転者によって設定された設定速度を超えないように速度制御するモードであり、車両制御装置１００による自動的な速度制御（エンジン制御）を伴うが、ステアリング制御は行われない。制限速度は、車載カメラ２１により撮像された速度標識や路面上の速度表示の画像データをＥＣＵ１０が画像認識処理することにより特定してもよいし、外部からの無線通信により受信してもよい。速度制限モードでは、運転者が制限速度を超えるようにアクセルペダルを踏み込んだ場合であっても、車両１は制限速度までしか増速されない。

＜基本制御モード＞
基本制御モードは、運転者操作部３５により、何れの運転支援モードも選択されていないときのモード（オフモード）であり、車両制御装置１００による自動的なステアリング制御及び速度制御は行われない。

次に、図３～図５を参照して、本実施形態による車両制御装置１００により計算される目標走行経路について説明する。図３～図５は、それぞれ第１走行経路～第３走行経路の説明図である。本実施形態では、ＥＣＵ１０に備えられた目標走行経路算出部１０ｃが、以下の第１走行経路Ｒ１～第３走行経路Ｒ３を時間的に繰返し計算するように構成されている（例えば、０．１秒毎）。本実施形態では、ＥＣＵ１０は、センサ等の情報に基づいて、現時点から所定期間（例えば、３秒）が経過するまでの間の走行経路を計算する。走行経路Ｒｘ（ｘ＝１，２，３）は、所定時間毎（例えば、０．３秒毎）に設定される走行経路上の車両１の目標位置（Ｐｘ_ｋ）及び目標速度（Ｖｘ_ｋ）により特定される（ｋ＝０，１，２，・・・，ｎ）。更に、各目標位置において、目標速度以外に複数の変数（加速度、ジャーク、ヨーレート、舵角、車両角度等）について目標値が特定される。

なお、図３～図５における走行経路（第１走行経路～第３走行経路）は、車両１が走行する走行路上又は走行路周辺の物標（駐車車両、歩行者等の障害物）に関する周辺物標の検出情報を考慮せずに、走行路の形状，先行車の走行軌跡，車両１の走行挙動，及び設定車速に基づいて計算される。このように、本実施形態では、周辺物標の情報が計算に考慮されないので、これら複数の走行経路の全体的な計算負荷を低く抑えることができる。

以下では、理解の容易のため、車両１が直線区間５ａ，カーブ区間５ｂ，直線区間５ｃからなる道路５を走行する場合において計算される各走行経路について説明する。道路５は、左右の車線５_L，５_Rからなる。現時点において、車両１は、直線区間５ａの車線５_L上を走行しているものとする。

（第１走行経路）
図３に示すように、第１走行経路Ｒ１は、道路５の形状に即して車両１に走行路である車線５_L内の走行を維持させるように所定期間分だけ設定される。詳しくは、第１走行経路Ｒ１は、直線区間５ａ，５ｃでは車両１が車線５_Lの中央付近の走行を維持するように設定され、カーブ区間５ｂでは車両１が車線５_Lの幅方向中央よりも内側又はイン側（カーブ区間の曲率半径Ｌの中心Ｏ側）を走行するように設定される。

目標走行経路算出部１０ｃは、車載カメラ２１により撮像された車両１の周囲の画像データの画像認識処理を実行し、車線両端部６_L，６_Rを検出する。車線両端部は、上述のように、区画線（白線等）や路肩等である。更に、目標走行経路算出部１０ｃは、検出した車線両端部６_L，６_Rに基づいて、車線５_Lの車線幅Ｗ及びカーブ区間５ｂの曲率半径Ｌを算出する。また、ナビゲーションシステム３０の地図情報から車線幅Ｗ及び曲率半径Ｌを取得してもよい。更に、目標走行経路算出部１０ｃは、画像データから速度標識Ｓや路面上に表示された制限速度を読み取る。なお、上述のように、制限速度を外部からの無線通信により取得してもよい。

目標走行経路算出部１０ｃは、直線区間５ａ，５ｃでは、車線両端部６_L，６_Rの幅方向の中央部を車両１の幅方向中央部（例えば、重心位置）が通過するように、第１走行経路Ｒ１の複数の目標位置Ｐ１_ｋを設定する。

一方、目標走行経路算出部１０ｃは、カーブ区間５ｂでは、カーブ区間５ｂの長手方向の中央位置Ｐ１_ｃにおいて、車線５_Lの幅方向中央位置からイン側への変位量Ｗｓを最大に設定する。この変位量Ｗｓは、曲率半径Ｌ，車線幅Ｗ，車両１の幅寸法Ｄ（ＥＣＵ１０のメモリに格納された規定値）に基づいて計算される。そして、目標走行経路算出部１０ｃは、カーブ区間５ｂの中央位置Ｐ１_ｃと直線区間５ａ，５ｃの幅方向中央位置とを滑らかにつなぐように第１走行経路Ｒ１の複数の目標位置Ｐ１_ｋを設定する。なお、カーブ区間５ｂへの進入前後においても、直線区間５ａ，５ｃのイン側に第１走行経路Ｒ１を設定してもよい。

第１走行経路Ｒ１の各目標位置Ｐ１_ｋにおける目標速度Ｖ１_ｋは、原則的に、運転者が運転者操作部３５の車速設定スイッチ３７ｂによって設定した速度、又は車両制御装置１００によって予め設定された所定の設定車速（一定速度）に設定される。しかしながら、この設定車速が、速度標識Ｓ等から取得された制限速度、又は、カーブ区間５ｂの曲率半径Ｌに応じて規定される制限速度を超える場合、走行経路上の各目標位置Ｐ１_ｋの目標速度Ｖ１_ｋは、２つの制限速度のうち、より低速な制限速度に制限される。さらに、目標走行経路算出部１０ｃは、車両１の現在の挙動状態（即ち、車速，加速度，ヨーレート，舵角，横加速度等）に応じて、目標位置Ｐ１_ｋ，目標速度Ｖ１_ｋを適宜に補正する。例えば、現車速が設定車速から大きく異なっている場合は、車速を設定車速に近づけるように目標速度が補正される。

（第２走行経路）
また、図４に示すように、第２走行経路Ｒ２は、先行車３の走行軌跡を追従するように所定期間分だけ設定される。目標走行経路算出部１０ｃは、車載カメラ２１による画像データ，ミリ波レーダ２２による測定データ，車速センサ２３による車両１の車速に基づいて、車両１の走行する車線５_L上の先行車３の位置及び速度を継続的に計算して、これらを先行車軌跡情報として記憶し、この先行車軌跡情報に基づいて、先行車３の走行軌跡を第２走行経路Ｒ２（目標位置Ｐ２_ｋ、目標速度Ｖ２_ｋ）として設定する。

（第３走行経路）
また、図５に示すように、第３走行経路Ｒ３は、運転者による車両１の現在の運転状態に基づいて所定期間分だけ設定される。即ち、第３走行経路Ｒ３は、車両１の現在の走行挙動から推定される位置及び速度に基づいて設定される。

目標走行経路算出部１０ｃは、車両１の舵角，ヨーレート，横加速度に基づいて、所定期間分の第３走行経路Ｒ３の目標位置Ｐ３_ｋを計算する。ただし、目標走行経路算出部１０ｃは、車線両端部が検出される場合、計算された第３走行経路Ｒ３が車線端部に近接又は交差しないように、目標位置Ｐ３_ｋを補正する。

また、目標走行経路算出部１０ｃは、車両１の現在の車速，加速度に基づいて、所定期間分の第３走行経路Ｒ３の目標速度Ｖ３_ｋを計算する。なお、目標速度Ｖ３_ｋが速度標識Ｓ等から取得された制限速度を超えてしまう場合は、制限速度を超えないように目標速度Ｖ３_ｋを補正してもよい。

次に、本実施形態による車両制御装置１００における運転支援モードと走行経路との関係について説明する。本実施形態では、運転者が運転者操作部３５を操作して１つの運転支援モードを選択すると、選択された運転支援モードに応じて第１～第３走行経路のうちの１つが目標走行経路として選択されるように構成されている。

レーンキープ制御モードの選択時には、車線両端部が検出されていると、第１走行経路が選択される。この場合、車速設定スイッチ３７ｂによって設定された設定車速が目標速度となる。
また、先行車追従モードの選択時には、先行車が検出された場合、第２走行経路が選択される。この場合、目標速度は、先行車の車速に応じて設定される。また、先行車追従モードの選択時において、先行車が検出されない場合、第３走行経路が選択される。

また、自動速度制御モードの選択時には、第３走行経路が選択される。自動速度制御モードは、上述のように速度制御を自動的に実行するモードであり、設定車速入力部３７によって設定された設定車速が目標速度となる。また、運転者によるステアリングホイールの操作に基づいてステアリング制御が実行される。

また、速度制限モードの選択時にも第３走行経路が選択される。速度制限モードも、上述のように速度制御を自動的に実行するモードであり、目標速度は、制限速度以下の範囲で、運転者によるアクセルペダルの踏み込み量に応じて設定される。また、運転者によるステアリングホイールの操作に基づいてステアリング制御が実行される。

また、基本制御モード（オフモード）の選択時には、第３走行経路が選択される。基本制御モードは、基本的に、速度制限モードにおいて制限速度が設定されない状態と同様である。

次に、図６～図８を参照して、本実施形態によるＥＣＵ１０の制御目標算出部１０ｆにおいて実行される制御目標算出処理について説明する。図６は制御目標算出処理の説明図、図７は補正走行経路の説明図、図８は車両モデルの説明図である。本実施形態において、制御目標算出処理には、走行経路補正処理が含まれる。

図６及び図７に示すように、制御目標算出部１０ｆは、目標走行経路Ｒを外部環境（障害物３等）や運転支援モードの変更に応じて補正して、補正走行経路Ｒｃを算出する。そして、制御目標算出部１０ｆは、車両１がこの補正走行経路Ｒｃを走行するための所定の制御量の制御目標値（加速度目標、舵角目標）を計算し、制御目標に基づいて車両１の制御システムへ要求信号を出力する。なお、図７には、所定期間（例えば、３秒）にわたる例示的な目標走行経路Ｒ，補正走行経路Ｒｃが示されている。各経路Ｒ，Ｒｃには、それぞれ所定時間毎（例えば、０．３秒毎）の目標位置Ｐ，補正目標位置Ｐｃが示されている。

具体的には、制御目標算出部１０ｆは、センサ／スイッチ群から各種情報を受け取り、目標走行経路算出部１０ｃから目標走行経路Ｒを受け取り、周辺物標検出部１０ｂから周辺物標に関する情報を受け取る。制御目標算出部１０ｆは、これらの情報に基づいて、制約条件（周辺物標との衝突回避等）を満足しつつ、目標走行経路Ｒからの逸脱量が小さくなるように最適化された補正走行経路Ｒｃを計算する。すなわち、本実施形態では、制御目標算出部１０ｆは、制約条件下で（又は拘束条件下で）所定の評価関数Ｊの評価値を最小にするという最適化問題を解くように構成されたソルバーを含む。このため、制御目標算出部１０ｆは、最適化計算部１１ａとモデル予測部１１ｂを備えている。

本実施形態では、概略的には、最適化計算部１１ａは、車両１の現在の挙動（速度、位置、加速度、舵角等）に基づいて、制約条件（障害物等）を回避するような候補補正走行経路を設定し、候補補正走行経路上の各候補目標位置での物理量（加速度、舵角）を入力値としてモデル予測部１１ｂへ与える。モデル予測部１１ｂは、入力値を車両モデルに適用することにより、候補補正走行経路上での車両１の挙動を計算し、車両挙動に基づく種々の物理量を最適化計算部１１ａへフィードバックする。

車両モデルは、車両１の物理的な運動を規定するものであり、以下の運動方程式で記述される。この車両モデルは、本例では図８に示す２輪モデルである。車両モデルにより車両１の物理的な運動が規定される。

図８及び式（１）、（２）中、ｍは車両１の質量、Ｉは車両１のヨーイング慣性モーメント、ｌはホイールベース、ｌ_fは車両重心点と前車軸間の距離、ｌ_rは車両重心点と後車軸間の距離、Ｋ_fは前輪１輪あたりのタイヤコーナリングパワー、Ｋ_rは後輪１輪あたりのタイヤコーナリングパワー、Ｖは車両１の車速、δは前輪の実舵角、βは車両重心点の横すべり角、ｒは車両１のヨー角速度、θは車両１のヨー角、ｙは絶対空間に対する車両１の横変位、ｔは時間である。

最適化計算部１１ａは、候補補正走行経路上での車両１の挙動を表すフィードバックに基づいて評価関数Ｊを用いて、候補補正走行経路を評価する。本実施形態では、評価関数Ｊは、補正走行経路の評価に関する評価項ＪＥと、制約条件に関する制約項ＪＣとを含む。評価項ＪＥは、複数の評価ファクタを有する。また、制約項ＪＣは複数の制約ファクタを有する。制御目標算出部１０ｆは、実行中の運転支援モード及びセンサ情報等に応じて異なるように評価関数Ｊを設定する。

複数の評価ファクタは、目標位置Ｐでの車両１の挙動を表す複数の物理量（例えば、速度（縦方向及び横方向）、加速度（縦方向及び横方向）、ジャーク（縦方向及び横方向）、ヨーレート、車線中心に対する横位置、車両角度、舵角、舵角速度、その他ソフト制約）にそれぞれ対応して設定されている。評価ファクタには、目標走行経路と補正走行経路の物理量の差が小さいほど評価が高くなる第１評価ファクタと、物理量自体の大きさが小さいほど評価が高くなる第２評価ファクタが含まれる。本実施形態では、評価値が小さな値となるほど、評価が高くなる。

第１評価ファクタは、目標走行経路と補正走行経路の差を最小化するための評価ファクタであり、第１評価ファクタの物理量は、例えば、速度（縦方向及び横方向）、横位置等である。一方、第２評価ファクタは、所定の物理量を最小化するための評価ファクタであり、第２評価ファクタの物理量は、例えば、加速度（縦方向及び横方向）、ジャーク（縦方向及び横方向）、舵角、舵角速度等である。

また、複数の制約ファクタは、複数の物理量にそれぞれ対応して設定されている。制約ファクタは、対応する物理量に対して規定された制限範囲（下限値～上限値）をその物理量が超えた量に応じて、ペナルティ値として見積もられる。よって、超過量が大きいほど、ペナルティ値は大きくなる（すなわち、結果的に、評価値は大きくなる）。

例えば、速度（縦方向及び横方向）、加速度（縦方向及び横方向）、ジャーク（縦方向及び横方向）、舵角、舵角速度、ヨーレートを含む複数の物理量には、それぞれ原則的に固定された制限範囲が規定されている。しかしながら、固定の制限範囲よりも狭い範囲に制限範囲が変更される場合がある。例えば、下記で説明する速度分布領域（図９参照）が適用される場合には、車両１の位置に応じて物標３に対する速度の制限範囲が変更される。

評価関数Ｊ（＝ＪＥ＋ＪＣ）は、以下の式で記述される。

評価項ＪＥについて、式中、Ｗｋ（Ｘｋ－Ｘｒｅｆｋ）²は評価ファクタ、Ｘｋは候補補正走行経路の物理量、Ｘｒｅｆｋは目標走行経路の物理量又は０（ゼロ値）、Ｗｋは評価ファクタの重み係数（例えば、０≦Ｗｋ≦１）である（但し、ｋ＝１～ｎ）。したがって、本実施形態の評価項ＪＥは、ｎ個の評価ファクタの物理量について、候補補正走行経路の物理量から目標走行経路の物理量（目標走行経路との差を最小化する評価ファクタの場合）又はゼロ値（物理量自体を最小化する評価ファクタの場合）を差し引いた差分の２乗の和を重み付けして、所定期間（例えば、Ｎ＝３秒）の走行経路長にわたって合計した値に相当する。なお、重み係数Ｗｋは、各運転支援モードに応じて異なって設定される。

一方、制約項ＪＣは、複数の物理量の制限範囲からの超過量に応じた評価値の合計値を、所定期間（例えば、Ｎ＝３秒）の走行経路長にわたって合計した値に相当する。各評価値は、例えば、超過量を２乗した値に所定の重み係数Ｗを乗じた値とすることができる。なお、所定の物理量の制限範囲は、周辺物標等に応じて変動し得る。

本実施形態では、評価関数Ｊは、制約項ＪＣが組み込まれたラグランジュ関数である。よって、最適化計算部１１ａは、無制約の最適化問題を解くように構成されており、良好な収束性で最適解を導出可能である。仮に評価関数Ｊが制約項ＪＣを含まない場合、モデル予測部１１ｂからのフィードバックが制約条件を満足しないと、そのフィードバックは最適化問題の収束性に何ら寄与しない。この場合、最適解が所定計算時間内に得られないおそれがある。

さらに、本実施形態では、フィードバックが制約条件を完全には満足しない場合であっても、最適化計算部１１ａは、その候補補正走行経路を、制約条件を考慮して評価関数Ｊにより評価することができる。これにより、本実施形態では、収束性を向上させることができる。例えば、センサ情報等のノイズ誤差や、道路環境の評価に対する誤差や、モデル関数に起因する誤差等により、制約条件をわずかに超えるような候補補正走行経路を確実に評価することができる。ただし、本実施形態では、制約項ＪＣの重み係数を大きな値に設定することにより、制約項ＪＣを制約条件として確実に機能させることができる。

本実施形態では、最適化計算部１１ａは、モデル予測部１１ｂからのフィードバックに基づいて、評価関数Ｊを用いて候補補正走行経路についての評価値を算出する。最適化計算部１１ａは、評価値に応じて、新たな候補目標走行経路を設定し、この新たな候補補正走行経路に基づいて、修正した入力値をモデル予測部１１ｂへ与える。本実施形態では、このような最適化計算部１１ａとモデル予測部１１ｂとの間でのフィードバックが複数回繰り返されることにより、評価関数Ｊの評価値が最小化（又は、最適化）された補正走行経路Ｒｃが算出される。なお、フィードバックの最大繰り返し回数は、所定回数に制限されてもよい。

次に、図９～図１０を参照して、本実施形態による障害物回避処理について説明する。図９は目標走行経路の補正による障害物回避の説明図、図１０は障害物を回避する際の障害物と車両との間のすれ違い速度の許容上限値とクリアランスとの関係を示す説明図である。図９では、車両１は走行路（車線）７上を走行しており、走行中又は停車中の車両３とすれ違って、車両３を追い抜こうとしている。

一般に、道路上又は道路付近の障害物（例えば、先行車、駐車車両、歩行者等）とすれ違うとき（又は追い抜くとき）、車両１の運転者は、進行方向に対して直交する横方向において、車両１と障害物との間に所定のクリアランス又は間隔（横方向距離）を保ち、且つ、車両１の運転者が安全と感じる速度に減速する。具体的には、先行車が急に進路変更したり、障害物の死角から歩行者が出てきたり、駐車車両のドアが開いたりするといった危険を回避するため、クリアランスが小さいほど、障害物に対する相対速度は小さくされる。

また、一般に、後方から先行車に近づいているとき、車両１の運転者は、進行方向に沿った車間距離（縦方向距離）に応じて速度（相対速度）を調整する。具体的には、車間距離が大きいときは、接近速度（相対速度）が大きく維持されるが、車間距離が小さくなると、接近速度は低速にされる。そして、所定の車間距離で両車両の間の相対速度はゼロとなる。これは、先行車が駐車車両であっても同様である。

このように、運転者は、障害物と車両１との間の距離（横方向距離及び縦方向距離を含む）と相対速度との関係を考慮しながら、危険がないように車両１を運転している。

そこで、本実施形態では、図９に示すように、車両１は、車両１から検知される障害物（例えば、駐車車両３）に対して、障害物の周囲に（横方向領域、後方領域、及び前方領域にわたって）又は少なくとも障害物と車両１との間に、車両１の進行方向における相対速度についての許容上限値を規定する２次元分布（速度分布領域４０）を設定するように構成されている。速度分布領域４０では、障害物の周囲の各点において、相対速度の許容上限値Ｖ_limが設定されている。

図９から分かるように、速度分布領域４０は、原則的に、障害物からの横方向距離及び縦方向距離が小さくなるほど（障害物に近づくほど）、相対速度の許容上限値が小さくなるように設定される。また、図９では、理解の容易のため、同じ許容上限値を有する点を連結した等相対速度線が示されている。等相対速度線ａ，ｂ，ｃ，ｄは、それぞれ許容上限値Ｖ_limが０ｋｍ／ｈ，２０ｋｍ／ｈ，４０ｋｍ／ｈ，６０ｋｍ／ｈに相当する。本例では、各等相対速度領域は、略矩形に設定されている。

本実施形態では、すべての運転支援モードにおいて、障害物に対する車両１の相対速度が速度分布領域４０内の許容上限値Ｖ_limを超えることがないように目標走行経路の補正が実施される。すなわち、速度分布領域４０が、車両１の速度に対する制約条件となる。具体的には、制御目標算出部１０ｆは、周辺物標検出部１０ｂによって回避すべき障害物（周辺物標）が検出されると、障害物に対して速度分布領域４０を設定する。そして、制御目標算出部１０ｆは、速度分布領域４０により規定される許容上限値Ｖ_limを超えることがないように、目標走行経路算出部１０ｃによって算出された目標走行経路Ｒを補正して、補正走行経路Ｒｃを算出する。図９には、例示的な補正走行経路Ｒｃ１，Ｒｃ２，Ｒｃ３が示されている。

なお、速度分布領域４０は、必ずしも障害物の全周にわたって設定されなくてもよく、少なくとも障害物の後方、及び、車両１が存在する障害物の横方向の一方側（図９では、車両３の右側領域）に設定されればよい。

図１０に示すように、車両１がある絶対速度で走行するときにおいて、障害物の横方向に設定される許容上限値Ｖ_limは、クリアランスＸがＤ₀（安全距離）までは０（ゼロ）ｋｍ／ｈであり、Ｄ₀以上で２次関数的に増加する（Ｖ_lim＝ｋ（Ｘ－Ｄ₀）²。ただし、Ｘ≧Ｄ₀）。即ち、安全確保のため、クリアランスＸがＤ₀以下では車両１は相対速度がゼロとなる。一方、クリアランスＸがＤ₀以上では、クリアランスが大きくなるほど、車両１は大きな相対速度ですれ違うことが許容される。

図１０の例では、障害物の横方向における許容上限値は、Ｖ_lim＝ｆ（Ｘ）＝ｋ（Ｘ－Ｄ₀）²で定義されている。なお、ｋは、Ｘに対するＶ_limの変化度合いに関連するゲイン係数であり、障害物の種類等に依存して設定される。また、Ｄ₀も障害物の種類等に依存して設定される。

なお、本実施形態では、Ｖ_limがＸの２次関数となるように定義されているが、これに限らず、他の関数（例えば、一次関数等）で定義されてもよい。また、図７を参照して、障害物の横方向の許容上限値Ｖ_limについて説明したが、障害物の縦方向を含むすべての径方向について同様に設定することができる。その際、係数ｋ、安全距離Ｄ₀は、障害物からの方向に応じて設定することができる。

なお、速度分布領域４０は、種々のパラメータに基づいて設定することが可能である。パラメータとして、例えば、車両１と障害物の相対速度、障害物の種類、車両１の進行方向、障害物の移動方向及び移動速度、障害物の長さ、車両１の絶対速度等を考慮することができる。即ち、これらのパラメータに基づいて、係数ｋ及び安全距離Ｄ₀を選択することができる。

また、本実施形態において、障害物は、車両，歩行者，自転車，崖，溝，穴，落下物等を含む。更に、車両は、自動車，トラック，自動二輪で区別可能である。歩行者は、大人，子供，集団で区別可能である。

図９に示すように、車両１が走行路７上を走行しているとき、車両１のＥＣＵ１０に内蔵された周辺物標検出部１０ｂは、車載カメラ２１から画像データに基づいて障害物（車両３）を検出する。このとき、障害物の種類（この場合は、車両、歩行者）が特定される。

また、周辺物標検出部１０ｂは、ミリ波レーダ２２の測定データ及び車速センサ２３の車速データに基づいて、車両１に対する障害物（車両３）の位置及び相対速度並びに絶対速度を算出する。なお、障害物の位置は、車両１の進行方向に沿ったｘ方向位置（縦方向距離）と、進行方向と直交する横方向に沿ったｙ方向位置（横方向距離）が含まれる。

制御目標算出部１０ｆは、検知したすべての障害物（図９の場合、車両３）について、それぞれ速度分布領域４０を設定する。そして、制御目標算出部１０ｆは、車両１の速度が速度分布領域４０の許容上限値Ｖ_limを超えないように目標走行経路Ｒの補正を行う。

即ち、目標走行経路Ｒを車両１が走行すると、ある目標位置において目標速度が速度分布領域４０によって規定された許容上限値を超えてしまう場合には、目標位置を変更することなく目標速度を低下させるか（図９の経路Ｒｃ１）、目標速度を変更することなく目標速度が許容上限値を超えないように迂回経路上に目標位置を変更するか（図９の経路Ｒｃ３）、目標位置及び目標速度の両方が変更される（図９の経路Ｒｃ２）。

なお、一般的に、評価関数Ｊにおいて、舵角速度を最小化するための評価ファクタの重み係数が大きい場合に補正走行経路Ｒｃ１が算出され、前後方向の加速度を最小化するための評価ファクタの重み係数が大きい場合に補正走行経路Ｒｃ３が算出される。

例えば、図９は、計算されていた目標走行経路Ｒが、走行路７の幅方向の中央位置（目標位置）を６０ｋｍ／ｈ（目標速度）で走行する経路であった場合を示している。この場合、前方に駐車車両３が障害物として存在するが、上述のように、目標走行経路Ｒの計算段階においては、計算負荷の低減のため、この障害物は考慮されていない。

目標走行経路Ｒを走行すると、車両１は、速度分布領域４０の等相対速度線ｄ，ｃ，ｃ，ｄを順に横切ることになる。即ち、６０ｋｍ／ｈで走行する車両１が等相対速度線ｄ（許容上限値Ｖ_lim＝６０ｋｍ／ｈ）の内側の領域に進入することになる。したがって、制御目標算出部１０ｆは、目標走行経路Ｒの各目標位置における目標速度を許容上限値Ｖ_lim以下に制限するように目標走行経路Ｒを補正して、補正走行経路Ｒｃ１を生成する。即ち、補正走行経路Ｒｃ１では、各目標位置において目標速度が許容上限値Ｖ_lim以下となるように、車両３に接近するに連れて目標速度が徐々に４０ｋｍ／ｈ未満に低下し、その後、車両３から遠ざかるに連れて目標速度が元の６０ｋｍ／ｈまで徐々に増加される。

また、補正走行経路Ｒｃ３は、目標走行経路Ｒの目標速度（６０ｋｍ／ｈ）を変更せず、このため等相対速度線ｄ（相対速度６０ｋｍ／ｈに相当）の外側を走行するように設定された経路である。制御目標算出部１０ｆは、目標走行経路Ｒの目標速度を維持するため、目標位置が等相対速度線ｄ上又はその外側に位置するように目標位置を変更するように目標走行経路Ｒを補正して、補正走行経路Ｒｃ３を生成する。したがって、補正走行経路Ｒｃ３の目標速度は、目標走行経路Ｒの目標速度であった６０ｋｍ／ｈに維持される。

また、補正走行経路Ｒｃ２は、目標走行経路Ｒの目標位置及び目標速度の両方が変更された経路である。補正走行経路Ｒｃ２では、目標速度は、６０ｋｍ／ｈには維持されず、車両３に接近するに連れて徐々に低下し、その後、車両３から遠ざかるに連れて元の６０ｋｍ／ｈまで徐々に増加される。

補正走行経路Ｒｃ１のように、目標走行経路Ｒの目標位置を変更せず、目標速度のみを変更する補正は、速度制御を伴うが、ステアリング制御を伴わない運転支援モードに適用することができる（例えば、自動速度制御モード、速度制限モード、基本制御モード）。
また、補正走行経路Ｒｃ３のように、目標走行経路Ｒの目標速度を変更せず、目標位置のみを変更する補正は、ステアリング制御を伴う運転支援モードに適用することができる（例えば、先行車追従モード）。
また、補正走行経路Ｒｃ２のように、目標走行経路Ｒの目標位置及び目標速度を共に変更する補正は、速度制御及びステアリング制御を伴う運転支援モードに適用することができる（例えば、先行車追従モード）。

次に、図１１を参照して、本実施形態の車両制御装置１００における運転支援制御の処理フローを説明する。図１１は運転支援制御の処理フローである。
ＥＣＵ１０は、図１１の処理フローを所定時間（例えば、０．１秒）ごとに繰り返して実行している。まず、ＥＣＵ１０（入力処理部１０ａ）は、情報取得処理を実行する（Ｓ１１）。情報取得処理において、ＥＣＵ１０は、測位システム２９及びナビゲーションシステム３０から、現在車両位置情報及び地図情報を取得し（Ｓ１１ａ）、車載カメラ２１，ミリ波レーダ２２，車速センサ２３，加速度センサ２４，ヨーレートセンサ２５，運転者操作部３５等からセンサ情報を取得し（Ｓ１１ｂ）、舵角センサ２６，アクセルセンサ２７，ブレーキセンサ２８等からスイッチ情報を取得する（Ｓ１１ｃ）。

次に、ＥＣＵ１０（入力処理部１０ａ，周辺物標検出部１０ｂ）は、情報取得処理（Ｓ１１）において取得した各種の情報を用いて所定の情報検出処理を実行する（Ｓ１２）。情報検出処理において、ＥＣＵ１０は、現在車両位置情報及び地図情報並びにセンサ情報から、車両１の周囲及び前方エリアにおける走行路形状に関する走行路情報（直線区間及びカーブ区間の有無，各区間長さ，カーブ区間の曲率半径，車線幅，車線両端部位置，車線数，交差点の有無，カーブ曲率で規定される制限速度等）、走行規制情報（制限速度、赤信号等）、先行車軌跡情報（先行車の位置及び速度），周辺物標情報を検出する（Ｓ１２ａ）。

また、ＥＣＵ１０は、スイッチ情報から、運転者による車両操作に関する車両操作情報（舵角，アクセルペダル踏み込み量，ブレーキペダル踏み込み量等）を検出し（Ｓ１２ｂ）、更に、スイッチ情報及びセンサ情報から、車両１の挙動に関する走行挙動情報（車速、縦加速度、横加速度、ヨーレート等）を検出する（Ｓ１２ｃ）。

次に、ＥＣＵ１０（目標走行経路算出部１０ｃ）は、計算により得られた情報に基づいて、目標走行経路算出処理を実行する（Ｓ１３）。目標走行経路算出処理では、上述のように、第１走行経路Ｒ１，第２走行経路Ｒ２，及び第３走行経路Ｒ３が計算され、これらの中から、選択されている運転支援モードとセンサ情報（先行車、車線両端部等）に応じて、目標走行経路Ｒが選択される。

次に、ＥＣＵ１０（制御目標算出部１０ｆ）は、目標走行経路Ｒ、周辺物標情報、各種のセンサ情報等に基づいて、制御目標算出処理を実行する（Ｓ１４）。制御目標算出処理では、上述のように、補正走行経路Ｒｃが算出され、この補正走行経路Ｒｃ上の各補正目標位置Ｐｃにおける所定の制御量の制御目標（加速度目標、舵角目標）が生成される。

最後に、ＥＣＵ１０（制御目標算出部１０ｆ）は、生成した補正走行経路Ｒｃにおける制御目標に基づいて、システム制御処理を実行して（Ｓ１５）、処理を終了する。システム制御処理では、補正走行経路Ｒｃにおける制御目標に応じて、要求信号（エンジン要求信号，ブレーキ要求信号，ステアリング要求信号）が生成され、生成された要求信号が車両１の制御システム３１～３３へ出力される。

次に、図１２～図１４を参照して、本実施形態の過渡評価関数について説明する。図１２は運転支援モードの切替わり時の補正走行経路の変化を示す説明図、図１３は運転支援モードの切替わり時の評価関数の重み係数の変化を示す説明図、図１４は運転支援モードの切替え例の説明図である。本実施形態では、運転支援モードの切替わり直後に、補正走行経路を算出するために過渡評価関数Ｊｔが用いられる。

図１２（Ａ）では、車両１及び先行車３が走行路７上を走行している。車両１では先行車追従モードが選択されているので、車両１は、先行車３の走行軌跡に沿った目標走行経路Ｒ上を走行している。このとき、先行車３は、走行路７の中央よりも右寄りを走行している。

図１２（Ｂ）は、図１２（Ａ）の状態において、運転支援モードがレーンキープ制御モードに切り替えられた状態を示している（運転者がＬＡＳスイッチ３６ｄを操作した）。このとき、目標走行経路Ｒは、走行路７の車線中央を設定速度で走行するように生成される。車両１では、新たな目標走行経路Ｒに最適化するように補正走行経路Ｒｃが計算される。

運転支援モードの切替え時において（図１２（Ｂ）参照）、車両１は目標走行経路Ｒから横方向にシフトしている。したがって、評価関数Ｊを用いると、補正走行経路Ｒｃは、車両１の速度を設定速度まで素早く増速（又は減速）させると共に、車両１を横方向（左方向）へ素早く移動させるような走行経路となる。

しかしながら、このとき、車両１の挙動変化が大きいと、乗員に不快感を与えるおそれがある。このため、本実施形態では、運転支援モードの切替え時に車両１の急な挙動変化を抑制するため、通常時に用いられる評価関数Ｊに代えて過渡評価関数Ｊｔが用いられる。

過渡評価関数Ｊｔは、評価関数Ｊの複数の重み係数のうち、少なくとも１つの重み係数の値が異なって設定されている点において、評価関数Ｊと異なる。しかしながら、この点を除いて、過渡評価関数Ｊｔは、評価関数Ｊと同様の構成を有する。すなわち、過渡評価関数Ｊｔは、過渡評価項ＪＥｔと過渡制約項ＪＣｔからなる。また、過渡評価項ＪＥｔ，過渡制約項ＪＣｔは、それぞれ評価項ＪＥ，制約項ＪＣと同じ複数の評価ファクタ，複数の制約ファクタからなる。

例えば、図１３は、第２評価ファクタに含まれる舵角速度（ｒａｄ／ｓ）を最小化するための評価ファクタの重み係数Ｗの時間変化を示す。図１３では、運転支援モードが時間ｔ０に先行車追従モードからレーンキープ制御モードに切り替わっている。時間ｔ０までは先行車追従モードのための評価関数Ｊが用いられ、時間ｔ１からレーンキープ制御モードのための評価関数Ｊが用いられる。しかしながら、時間ｔ０から時間ｔ１までの所定期間Ｔは、過渡評価関数Ｊｔが用いられる。

先行車追従モードでの重み係数Ｗは固定値ｗ２であり、レーンキープ制御モードでの重み係数Ｗは固定値ｗ１（ｗ１＜ｗ２）である。すなわち、レーンキープ制御モードでは、車両１を車線の中央に維持するため、舵角速度の評価ファクタの重み係数Ｗは、先行車追従モードでの重み係数Ｗよりも小さく設定されている。すなわち、レーンキープ制御モードでは、先行車追従モードよりも大きな舵角速度が許容され得る。

図１３における過渡評価関数Ｊｔにおける舵角速度の評価ファクタの過渡重み係数Ｗｔは、時間ｔ０に固定値ｗ２よりも大きな値ｗ３（ｗ３＞ｗ２）に設定され、一定の変化率で減少し、所定期間Ｔ後に固定値ｗ１に達する。すなわち、運転支援モードの変更直後は、過渡評価関数Ｊｔにおいて過渡重み係数Ｗｔの値が大きくなるので、舵角速度を大きく設定するような候補補正走行経路の評価が低くなり（評価値が大きな値となる）、そのような候補補正走行経路が補正走行経路Ｒｃとして算出されなくなる。これにより、本実施形態では、運転支援モードの変更直後に、少なくとも横方向へ急激な挙動変化を抑制することができる。

また、図１３の例において、目標走行経路からの横位置の差分を最小化するための評価ファクタの重み係数Ｗを一時的に小さくしてもよい。これにより、横位置の差分を小さくするために急操舵を要するような補正走行経路Ｒｃが算出されなくなる。

なお、本実施形態では、所定期間Ｔにおいて過渡重み係数Ｗｔが線形に変化しているが、これに限らず、曲線的に又は段階的に変化してもよい。

図１４は、変更前の運転支援モードと変更後の運転支援モードの組合せに応じて、重み係数を一時的に大きくする評価ファクタと、重み係数を一時的に小さくする評価ファクタの例を示す。図１２及び図１３は、図１４の「Ａ」の一時的に重み係数を大きくする評価ファクタの例である。

概略的には、図１４のＡ～Ｃは、急操舵を抑制するため、舵角速度を最小化するための評価ファクタの重み係数を一時的に大きく設定すると共に、目標走行経路に対する横位置の差分を最小化するための評価ファクタの重み係数を一時的に小さく設定する例を示している。また、図１４のＤ及びＥは、急加減速を抑制するため、縦方向のジャーク（ｍ／ｓ³）を最小化するための評価ファクタの重み係数を一時的に大きく設定すると共に、目標速度に対する速度の差分を最小化するための評価ファクタの重み係数を一時的に小さく設定する例を示している。

次に、本発明の実施形態による車両制御装置１００の作用について説明する。
本発明の実施形態の車両１の運転を支援するための複数の運転支援モードを備えた車両制御装置１００は、車両１の目標走行経路Ｒを算出し（Ｓ１３）、補正走行経路Ｒｃを評価するための評価関数Ｊを用いて所定の制約条件で目標走行経路Ｒに基づいて補正走行経路Ｒｃを算出すると共に、車両１が補正走行経路Ｒｃを走行するための車両１の制御目標値を算出する（Ｓ１４）ように構成されており、車両制御装置１００は、複数の運転支援モードの各々に対して異なって設定された複数の評価関数Ｊを有し、選択されている運転支援モードに対応する評価関数Ｊを用いるように構成されており、車両制御装置１００は、運転支援モードの変更時に用いるための、複数の評価関数Ｊとは異なる過渡評価関数Ｊｔを更に有し、運転支援モードの変更後の所定期間Ｔにおいて、評価関数Ｊに代えて過渡評価関数Ｊｔを用いることを特徴としている。

このように構成された本実施形態では、運転支援モードの変更時に、補正走行経路Ｒｃを算出するために用いられる評価関数Ｊが、運転支援モードの変更に併せて急に切り替えられるのではなく、運転支援モードの変更後の所定期間Ｔの間だけ過渡評価関数Ｊｔが代わりに用いられる。そして、所定期間Ｔの経過後に、変更された運転支援モードのための評価関数Ｊが用いられる。したがって、本実施形態では、運転支援モードの変更直後に車両挙動を急激に変化させるような補正走行経路Ｒｃが算出されることを抑制することができる。

また、本実施形態では、過渡評価関数Ｊｔは、変更前の運転支援モードと変更後の運転支援モードの組合せに応じて、異なるように設定される。このように構成された本実施形態では、変更の前後の運転支援モードの組合せに応じて、運転支援モードの変更直後の車両挙動を安定させるような適切な過渡評価関数Ｊｔを設定することができる。

また、本実施形態では、車両制御装置１００は、評価関数Ｊ又は過渡評価関数Ｊｔを用いて、複数の候補補正走行経路についての評価値を算出し、評価値の最も良い候補補正走行経路を補正走行経路Ｒｃとして算出する。

また、本実施形態では、評価関数Ｊは、各々重み係数Ｗにより重み付けされた複数の評価ファクタの総和を含み、重み係数Ｗは、運転支援モードに応じて異なるように設定されており、過渡評価関数Ｊｔは、各々過渡重み係数Ｗｔにより重み付けされた複数の評価ファクタの総和を含み、過渡重み係数Ｗｔは、運転支援モードの変更前と変更後の運転支援モードの組合せに応じて設定されている。

このように構成された本実施形態では、運転支援モードの組合せに応じて過渡重み係数Ｗｔを設定することにより、運転支援モードの変更直後の車両挙動を安定させるような適切な過渡評価関数Ｊｔを設定することができる。

また、本実施形態では、少なくとも１つの評価ファクタの過渡重み係数Ｗｔは、運転支援モードの変更後の所定期間Ｔにおいて時間経過と共に初期値ｗ３から変化するように設定され、所定期間Ｔの経過後に変更後の運転支援モードの評価関数Ｊの少なくとも１つの評価ファクタの重み係数Ｗの値ｗ１と一致する。

このように構成された本実施形態では、運転支援モードの変更後の所定期間Ｔにおいて、過渡重み係数Ｗｔの値を変更後の運転支援モードの重み係数Ｗの値に徐々に近づけることができる。これにより、本実施形態では、運転支援モードの変更後に、車両１の挙動を変更後の運転支援モードの車両挙動に滑らかに近づけることができる。

また、本実施形態では、過渡重み係数Ｗｔは、変更後の運転支援モードの重み係数Ｗよりも、車両１の横方向の位置に関する評価ファクタについての重み付けを小さくするように設定され（図１４のＡ～Ｃ）、及び／又は、車両１の舵角速度に関する評価ファクタについての重み付けを大きくするように設定されている（図１４のＡ～Ｃ）。

このように構成された本実施形態では、運転支援モードの変更によって、目標走行経路が車両１の現在位置より横方向にシフトした場合であっても、急操舵が必要となるような補正走行経路Ｒｃが算出されることを抑制することができる。例えば、車両１の横方向の位置に関する評価ファクタは、目標走行経路と補正走行経路の横方向の位置の差分を最小化するための評価ファクタであり、車両１の舵角速度に関する評価ファクタは、補正走行経路での車両１の舵角速度を最小化するための評価ファクタである。

また、本実施形態では、過渡重み係数Ｗｔは、変更後の運転支援モードの重み係数Ｗよりも、車両１の速度に関する評価ファクタについての重み付けを小さくするか（図１４のＤ，Ｅ）、車両１の前後方向のジャークに関する評価ファクタについての重み付けを大きくするか（図１４のＤ，Ｅ）、又は、車両１の前後方向の加速度に関する評価ファクタについての重み付けを大きくするように設定されている（図１４のＤ，Ｅ）。

このように構成された本実施形態では、運転支援モードの変更によって、車両１の現在車速と目標走行経路上での目標速度との間に差が生じた場合であっても、急加減速が必要となるような補正走行経路Ｒｃが算出されることを抑制することができる。例えば、車両１の速度に関する評価ファクタは、目標走行経路での目標速度と補正走行経路での車速の差分を最小化するための評価ファクタであり、車両１の前後方向のジャークに関する評価ファクタは、補正走行経路での車両１の前後方向のジャークを最小化するための評価ファクタであり、車両１の前後方向の加速度に関する評価ファクタは、補正走行経路での車両１の前後方向の加速度を最小化するための評価ファクタである。

１車両
３物標（障害物，先行車）
５道路
５Ｌ，５Ｒ車線
７走行路
１０ＥＣＵ
１０ａ入力処理部
１０ｂ周辺物標検出部
１０ｃ目標走行経路算出部
１０ｅ運転操作判断部
１０ｆ制御目標算出部
１１ａ最適化計算部
１１ｂモデル予測部
４０速度分布領域
１００車両制御装置
Ｊ評価関数
Ｊｔ過渡評価関数
Ｐ目標位置
Ｐｃ補正目標位置
Ｒ目標走行経路
Ｒ１－Ｒ３第１－第３走行経路
Ｒｃ補正走行経路
Ｗ重み係数
Ｗｔ過渡重み係数

Claims

車両の運転を支援するための複数の運転支援モードを備えた車両制御装置であって、前記車両制御装置は、
前記車両の目標走行経路を算出し、
補正走行経路を評価するための評価関数を用いて所定の制約条件下で前記目標走行経路に基づいて前記補正走行経路を算出すると共に、前記車両が前記補正走行経路を走行するための前記車両の制御目標値を算出するように構成されており、
前記車両制御装置は、前記複数の運転支援モードの各々に対して異なって設定された複数の評価関数を有し、選択されている運転支援モードに対応する評価関数を用いるように構成されており、
前記車両制御装置は、前記運転支援モードの変更時に用いるための、前記複数の評価関数とは異なる過渡評価関数を更に有し、前記運転支援モードの変更後の所定期間において、前記評価関数に代えて前記過渡評価関数を用い、
前記評価関数は、重み係数により重み付けされた、前記車両の横方向の挙動を表す物理量に関する評価ファクタを含み、前記重み係数は、前記運転支援モードに応じて異なるように設定されており、
前記過渡評価関数は、過渡重み係数により重み付けされた前記評価ファクタを含み、
前記評価ファクタの前記過渡重み係数は、前記運転支援モードの変更後の所定期間において時間経過と共に初期値から変化するように設定され、前記所定期間の経過後に変更後の運転支援モードの前記評価関数の前記評価ファクタの重み係数の値と一致し、前記運転支援モードの変更前に対する変更後の前記車両の目標走行経路が前記車両の横方向にシフトする場合において、前記初期値は、前記運転支援モードの変更時における前記車両の横方向の挙動変化を抑制するように、変更前の運転支援モードの前記評価関数の前記評価ファクタの重み係数よりも大きな値又は小さな値に設定される、車両制御装置。
前記評価関数は、各々重み係数により重み付けされた複数の評価ファクタの総和を含み、前記重み係数は、前記運転支援モードに応じて異なるように設定されており、
前記過渡評価関数は、各々過渡重み係数により重み付けされた前記複数の評価ファクタの総和を含み、
前記過渡重み係数は、前記運転支援モードの変更前と変更後の運転支援モードの組合せに応じて設定されている、請求項１に記載の車両制御装置。
前記過渡重み係数は、変更後の運転支援モードの重み係数よりも、前記車両の横方向の位置に関する評価ファクタについての重み付けを小さくするように設定され、及び／又は、前記車両の舵角速度に関する評価ファクタについての重み付けを大きくするように設定されている、請求項１又は２に記載の車両制御装置。
前記過渡重み係数は、変更後の運転支援モードの重み係数よりも、前記車両の速度に関する評価ファクタについての重み付けを小さくするか、前記車両の前後方向のジャークに関する評価ファクタについての重み付けを大きくするか、又は、前記車両の前後方向の加速度に関する評価ファクタについての重み付けを大きくするように設定されている、請求項１又は２に記載の車両制御装置。