JP5590162B2 - 逸脱抑制装置および逸脱抑制プログラム - Google Patents

Description

本発明は、車両が走行領域を逸脱することを抑制する逸脱抑制装置および逸脱抑制プログラムに関する。

上記の逸脱抑制装置として、車両が走行領域を逸脱する際に、車両が走行領域に戻る方向に操舵し、その後、その反対方向に操舵することで、ドライバが操舵することなく自車両を走行領域が延びる方向（走行車線の方向）に向ける制御をするものが知られている（例えば、特許文献１参照）。

特許第３８０００８７号公報

しかしながら、上記逸脱抑制装置では、走行領域の逸脱を抑制する際には、逸脱を早期に抑制するために比較的大きな目標ヨーモーメントを設定し、またその後、反対方向に操舵する際にも、同様の比較的大きな目標モーメントを設定するものと思われる。したがって、逸脱を防止する制御が開始されると、制御が終了するまで車両が横方向に大きく振られることになるため車両の乗員の乗り心地が悪くなるという問題点があった。

そこでこのような問題点を鑑み、車両が走行領域を逸脱することを抑制する逸脱抑制装置において、より乗り心地よく車両の進行方向を適切な方向に制御できるようにすることを本発明の目的とする。

かかる目的を達成するためになされた第１の構成の逸脱抑制装置において、抑制角度取得手段は、自車両が走行領域を逸脱しようとする際における、自車両の進行方向と目標とする自車両の進行方向とのなす角を表す抑制角度を取得し、第１変位出力手段は、抑制角度の分だけ自車両の進行方向を走行領域の中心側に変位させるための出力を行う。また、最終角度取得手段は、第１変位出力手段により自車両の進行方向を走行領域の中心側に変位させた後において、走行領域内において境界線と平行な仮想線と自車両の進行方向とのなす角を表す最終角度を取得し、第２変位出力手段は、最終角度の分だけ自車両の進行方向を仮想線に対して平行に変位させるための出力を行う。

特に、第１変位出力手段は、自車両の旋回時角速度を増加または減少させる際に、自車両の旋回時角速度の変化率が一定となるような目標値を出力し、第２変位出力手段は、自車両の旋回時角速度を増加または減少させる際に、自車両の旋回時角速度の変化率が一定となるような目標値を出力する。そして、第２変位出力手段による旋回時角速度の変化率は、第１変位出力手段による旋回時角速度の変化率よりも小さな値に設定されている。

このような逸脱抑制装置によれば、第１変位出力手段による制御中には、より早期に自車両を走行領域の中心側に向けるために旋回時角速度の変化率を比較的大きな値としてもよいが、第２変位出力手段による制御中には、第１変位出力手段による制御中と比較して早期に制御を完了させる必要がないので、旋回角速度の変化率をより小さくしている。この結果、ドライバへの身体への負担を軽減することができ、より乗り心地よく車両の進行方向を適切な方向に制御することができる。

なお、本発明において「変化率が一定」とは、自車両の旋回時角速度を変化させる１または複数の区間（複数の時間の範囲内）のそれぞれにおいて、変化率が一定であればよい。つまり、前述の各区間において旋回時角速度の変化率が一定であれば、他の区間における旋回時角速度の変化率とは異なる値であってもよい。

また、上記発明において、
ところで、上記逸脱抑制装置においては、第２の構成のように、第１変位出力手段は、旋回時角速度が、予め設定された第１上限角速度を超えることがないようにするとともに、第２変位出力手段は、旋回時角速度が、第１上限角速度以下の値に設定された第２上限角速度を超えることがないようにしてもよい。

このような逸脱抑制装置によれば、第１変位出力手段は、旋回時角速度が、予め設定された第１上限角速度を超えることがないようにするので、過度な旋回が実施されることを抑制することができる。また、第２変位出力手段による制御中には旋回角速度をより小さくすることでドライバへの身体への負担を軽減することができる。このため、より乗り心地よく車両の進行方向を適切な方向に制御することができる。

さらに、上記逸脱抑制装置においては、第３の構成のように、抑制角度取得手段は、自車両が走行領域を逸脱しようとする際における、走行領域の内外を区分する境界線と自車両の進行方向とのなす角を表す逸脱角度と、自車両を境界線よりも走行領域の中心側に戻す際において、境界線と目標とする自車両の進行方向とのなす角を表す支援角度とを取得し、逸脱角度と支援角度との和を抑制角度としてもよい。

このような逸脱抑制装置によれば、逸脱角度を取得してこの逸脱角度に応じて支援角度を決定し、逸脱角度と支援角度との和（抑制角度）に応じて旋回時角速度を指定する目標値を出力すればよいので、抑制角度を簡素な処理で決定することができる。

また、上記逸脱抑制装置においては、自車両の進行方向を制御する構成は本発明の装置の外部に備えられていてもよいが、第４の構成のように、第１変位出力手段および第２変位出力手段のうちの少なくとも第１変位出力手段による出力に応じて自車両の進行方向を制御する車両制御手段、を備えていてもよい。

このような逸脱抑制装置によれば、自車両の進行方向を逸脱角度と支援角度の和の分だけ適切に制御することができる。
さらに、上記逸脱抑制装置においては、第５の構成のように、自車両が境界線より逸脱しそうである場合に、自車両のヨーレートの現在値を取得するヨーレート取得手段と、現在値から、境界線の曲率に従って自車両が走行するためのカーブヨーレートを減算した値であるヨーレートオフセットを算出し、時間を第１座標軸、自車両を操舵する際のヨーレートの目標値を第２座標軸とする直交座標系において下記条件（１）〜（３）の全てを満たす波形を作成する波形作成手段と、を備えていてもよい。

条件（１）：自車両の進行方向を変位させる出力を開始するときにヨーレートオフセットを表す第１のポイントがヨーレートの目標値となること。
条件（２）：自車両の進行方向を変位させる出力を終了する予定のときに、カーブヨーレートを表す第２のポイントがヨーレートの目標値となること。

条件（３）：前記第１のポイントから前記第２のポイントまでヨーレートの目標値を変化させ、かつカーブヨーレートを基準として前記第１のポイントから前記第２のポイントまでヨーレートの目標値を時間で積分した積分値が逸脱角度と支援角度の和になること。

この構成において、第１変位出力手段は、逸脱角度と前記支援角度との和の分だけ自車両の進行方向を前記走行領域の中心側に変位させるための出力として、自車両のヨーレートが前記波形に沿って決定されるヨーレートの目標値になるように自車両を操舵するための出力を行う。

このような逸脱抑制装置によれば、ヨーレートの目標値を徐々に変更し、カーブヨーレートと一致するときに出力を終了するので、急激にヨーレートが変更されることがない。したがって、制御の前後における運転者への負担を軽減させることができる。なお、このような制御を行う際には、カーブヨーレートが基準（ゼロ点）となるため、ヨーレートの目標値がカーブヨーレート未満の場合は、上記積分値は負の値となる。

加えて、上記の逸脱抑制装置において、波形作成手段は、第７の構成のように、条件（４）「第１のポイントから第２のポイントまで複数の線分で接続すること」も満たす波形を作成するとよい。特に、カーブヨーレートを示す直線と、ヨーレートの目標値を示す複数の線分とが、三角形や台形を形成するとよい。

このような逸脱抑制装置によれば、積分値が逸脱角度と支援角度との和となるようにする際の演算を容易に行うことができる。
次に、第８の構成は、コンピュータを、上記逸脱抑制装置を構成する各手段として機能させるための逸脱抑制プログラムであることを特徴としている。

このような逸脱抑制プログラムによれば、上記逸脱抑制装置と同様の効果を享受することができる。
また、各請求項の記載は、可能な限りにおいて任意に組み合わせることができる。この際、発明の目的を達成できる範囲内において一部構成を除外してもよい。

逸脱抑制システム１の概略構成を示すブロック図（ａ）、および本発明の概要を示す鳥瞰図（ｂ）である。 時間と目標ヨーレートとの関係を示すグラフである。 逸脱抑制処理を示すフローチャートである。 逸脱角度αと支援角度βとの関係を示すグラフである。 時間と目標ヨーレートとの関係（三角波の頂点を求めるとき）を示すグラフである。 時間と目標ヨーレートとの関係（三角波の場合）を示すグラフである。 時間と目標ヨーレートとの関係（台形波の場合）を示すグラフである。 カーブを走行するためのヨーレートの概念図である。 変形例のパラメータ定義を示す鳥瞰図である。 変形例の逸脱抑制処理を示すフローチャートである。 変形例において時刻と目標ヨーレートとの関係を示す説明図である。 時刻に対する、横方向加速度、横方向速度、横位置の関係を示すグラフである。

以下に本発明にかかる実施の形態を図面と共に説明する。
［本実施形態の構成］
図１（ａ）は本発明が適用された逸脱抑制システム１の概略構成を示すブロック図である。逸脱抑制システム１は、例えば、乗用車等の車両に搭載され、自車両（逸脱抑制システム１が搭載された車両）が左右の白線（実車線）内の領域である走行領域を逸脱することを抑制する制御を行うシステムである。

詳細には、逸脱抑制システム１は、図１（ａ）に示すように、演算部１０と、カメラ２０と、車速センサ２１と、ヨーレートセンサ２２と、舵角センサ２３と、パワステ制御部３０と、ステアリングアクチュエータ４０とを備えている。

演算部１０は、ＣＰＵ、ＲＯＭ、ＲＡＭ等を備えた周知のマイコンとして構成されており、ＲＯＭに格納されたプログラム（逸脱抑制プログラムを含む）等に従って、後述する逸脱抑制処理等の各種処理を実行する。また、演算部１０は、カメラ２０による撮像情報を取得し、旋回方向への回転角速度（旋回角速度）の目標値である目標ヨーレートを演算し、出力する。

カメラ２０は、自車両の進行方向の路面を撮像し、周知の白線認識の技術を用いて、白線と自車両の進行方向とのなす角を表す逸脱角度（白線から走行領域の内側に一定距離（例えば１ｍ）の位置にある仮想車線とのなす角を表す最終角度を含む）、白線までの距離、カーブ半径等を検出し、これらの情報を撮像情報として演算部１０に送る。なお、カメラ２０が撮像画像を得る機能のみを備えている場合には、演算部１０が撮像画像に基づいて撮像情報を演算するようにしてもよい。

車速センサ２１は、自車両の走行速度を検出する周知の車速センサとして構成されており、走行速度の検出結果を演算部１０に送る。また、ヨーレートセンサ２２は、自車両の旋回方向への回転角速度（YrSensor）を検出する周知のヨーレートセンサとして構成されており、ヨーレートの検出結果を演算部１０に送る。また、舵角センサ２３は、車両の舵角を検出する周知の舵角センサとして構成されており、舵角の検出結果を演算部１０に送る。

パワステ制御部３０は、目標ヨーレートに基づき目標ヨーレートを満たすための舵角を演算する演算装置としての機能と、車両の舵角を制御するステアリングアクチュエータ４０に対して舵角（制御トルク）の指令を送る制御装置としての機能とを備えている。演算装置としての機能では、目標ヨーレートを入力すると対応する舵角が出力されるよう設定され、かつＲＯＭ等のメモリに予め記録されたマップを用いて、入力された目標ヨーレートに対応する舵角を求める。そして、制御装置としての機能では、この舵角になるようにステアリングアクチュエータ４０を制御する。

なお、目標ヨーレートに対する舵角を求める際には、等価２輪モデル等の車両モデルに目標ヨーレートを当てはめることで舵角または舵角を求めるためのパラメータを演算するようにしてもよい。また、ステアリングアクチュエータ４０に換えて、右車輪または左車輪だけに制動を掛けることによって車両の進行方向を変更させるブレーキ機構を採用してもよい。つまり、ステアリングアクチュエータ４０に換えて、車両の進行方向を変更させる機能を有するアクチュエータを採用することができる。

［本実施形態の処理］
次に、図１（ｂ）は、本実施形態での制御の概要を示す鳥瞰図である。また、図２は、時間と目標ヨーレートとの関係を示すグラフである。上記のような逸脱抑制システム１においては、図１（ｂ）に示すように、自車両が実車線（左側の白線）に接近すると、実車線と自車両の進行方向とのなす角を表す逸脱角度αと、自車両を実車線よりも走行領域の中心側に戻す際において、実車線と目標とする自車両の進行方向とのなす角を表す支援角度βとの和である抑制角度（α＋β）分だけ自車両の進行方向を自車両の進行方向を走行領域の中心側に変位させる。

その後、反対側の実車線（右側の白線）よりも走行領域の内側（左側）に位置する仮想車線とのなす角である最終角度γの分だけ自車両の進行方向を仮想車線よりも手前側に戻すことで、仮想車線に沿って自車両を走行させる。ここで、走行領域の中心側とは、走行領域逸脱前において、実車線よりも手前側或いは実車線よりも反対側の実車線側を示し、走行領域の中心の位置を直接求める必要はない。

なお、仮想車線は、反対側の実車線から所定距離の位置に設定され、反対側の実車線までの距離をカメラ２０によって検出することで仮想車線までの距離が検出される。このような処理を実施すると、例えば図２に示すような目標ヨーレートが出力される。

このような目標ヨーレートを出力する際の詳細処理について、図３以下の図面を用いて説明する。図３は、演算部１０が実行する逸脱抑制処理を示すフローチャートである。
逸脱抑制処理は、例えば逸脱抑制システム１の電源が投入されると開始され、その後、一定時間毎（例えば５０ｍｓ毎）に繰り返し実行される処理である。この処理では、まず、撮像情報をカメラ２０から取得するとともに、自車両の走行速度、およびヨーレートを車速センサ２１、ヨーレートセンサ２２から取得するとともに、予め設定されたヨーレート変化率を取得する（Ｓ１１０）。

ここで、ヨーレート変化率としては、目標ヨーレートを増減させる際の変化率を示し、逸脱回避時（後述する逸脱フラグがセットされている際）に使用される、逸脱時増加変化率および逸脱時減少変化率、仮想車線に沿って自車両を走行させるとき（逸脱フラグが解除されている際）に使用される平行時増加変化率および平行時減少変化率が個別に設定されている。なお、各増加変化率は、ヨーレートを増加させる際に利用する変化率であり、各減少変化率は、ヨーレートを減少させる際に利用する変化率である。これらの変化率は、後述する時間と目標ヨーレートとの関係を示す各グラフにおいて、線分の傾きの大きさに相当する。

本実施形態においては、平行時減少変化率は平行時増加変化率以下の値に設定されており、平行時増加変化率は逸脱時減少変化率以下の値に設定されている。また、逸脱時減少変化率は逸脱時増加変化率以下の値に設定されている。

続いて、ドライバによる操作があるか否かを判定する（Ｓ１２０）。ここで、ドライバによる操作とは、ステアリングを接近している実車線から遠ざかる方向に変更する操作を示し、舵角センサ２３による検出結果を繰り返し監視することでこの操作の有無を検出する。

ドライバによる操作があれば（Ｓ１２０：ＮＯ）、車両が車線を逸脱する虞がある旨を示す逸脱フラグ、舵角の制御中である旨を示す制御フラグがセットされている場合にこれらを解除し（Ｓ１３０）、Ｓ１１０の処理に戻る。Ｓ１３０の処理は、ドライバによる操作がある場合には、ドライバによる操作を本処理による舵角の制御よりも優先して受け入れることを意味する。

また、ドライバによる操作がなければ（Ｓ１２０：ＹＥＳ）、基準となる時間（例えば２秒間）以内に車両が車線（走行領域）を逸脱するか否かを判定する（Ｓ１４０）。この処理では、撮像情報として得られた逸脱角度α、実車線までの距離、および自車両の走行速度に基づいて、自車両が実車線に到達するまでの時間を演算し、この時間が基準となる時間以内となるか否かを判定する。

基準となる時間以内に車両が車線を逸脱しなければ（Ｓ１４０：ＮＯ）、逸脱の虞はないものとして逸脱フラグがセットされている場合にこれを解除し（Ｓ１５０）、制御フラグがセットされており、かつ仮想車線に接近しているか否かを判定する（Ｓ１６０）。ここで、仮想車線に接近しているか否かについては、Ｓ１４０の処理と同様に、基準となる時間（例えば１．５秒間）以内に、自車両が仮想車線に到達するか否かによって判定する。

制御フラグが解除されている場合、または仮想車線に接近していない場合には（Ｓ１６０：ＮＯ）、Ｓ１１０の処理に戻る。また、制御フラグがセットされており、かつ仮想車線に接近している場合には（Ｓ１６０：ＹＥＳ）、後述するＳ１８０の処理に移行する。

また、Ｓ１４０の処理にて、車両が逸脱する場合には（Ｓ１４０：ＹＥＳ）、制御フラグおよび逸脱フラグをセットし（Ｓ１７０）、支援角度βを演算するとともに最大制御Ｇの設定を行う（Ｓ１８０）。ここで、最大制御Ｇは、目標ヨーレートの上限cntYrMax（例えば図６参照）に対応する横加速度を示す。なお、目標ヨーレートの上限cntYrMaxは、最大制御Ｇを自車両の走行速度Ｖで除すことで求められる。また、支援角度βを演算する処理については、図４を用いて説明する。

図４は、逸脱角度αと支援角度βとの関係を示すグラフである。支援角度βの設定には、種々の方法が考えられる。例えば、図４の（１）の破線に示すように、支援角度βを逸脱角度α以下の値に設定してもよい。このようにすれば、逸脱速度が遅いにも関わらず走行領域内に戻す際の速度が非常に速いという不自然な制御を抑制することができる。

また、図４の（２）の一点鎖線に示すように、支援角度βを一定の値に設定してもよい。この場合、支援角度βを求めるための処理を省くことができる。
さらに、図４の（３）の実線に示すように、支援角度βの上限値を設定しておき、支援角度βの上限値に到達するまでは逸脱角度αに応じた一次関数によって支援角度βを求めるようにしてもよい。この場合、白線付近に減衰しながら反射させるダンパがあるイメージとなるので、制御イメージがドライバに分かりやすく制御に対する安心感を与えることができる。

また、図４の（４）の実線に示すように、走行領域外への逸脱距離が大きくなる場合には、より支援角度βを大きくするようにしてもよい。ここで、逸脱距離とは、図１（ｂ）に示すように、現在位置での自車両（外側の前輪等の基準位置）と最大に逸脱した場合に予想される自車両（前述の基準位置）との距離を表す。このようにすると、早期に車両を走行領域内に戻すことができるので、ドライバに安心感を与えることができる。

なお、上記の逸脱抑制処理において、抑制角度（α＋β）だけ自車両の進行方向を変更した後において、逸脱フラグが解除された場合（Ｓ１５０の処理が実施された場合）には、逸脱角度αを最終角度γ（図１（ｂ）参照）に置換して設定するとともに、支援角度βを０とする。

つまり、最終角度γ（図１（ｂ）参照）が目標制御量（抑制角度）として設定される。なお、図１（ｂ）に示すように道路が直線である例においては、最終角度γは支援角度βと一致するため以前に求めた支援角度βを最終角度γとして設定すればよい。また、道路路が曲線である場合には、以前に求めた支援角度βに対して道路の曲率を加味して最終角度γとして設定すればよい。

また、最大制御Ｇは、走行領域が直線である場合（例えば、カーブ半径が３０００ｍ以上である場合）と曲線である場合とで異なる値を採用してもよい。例えば、走行領域が直線である場合には、最大制御Ｇを０．１Ｇに設定し、走行領域が曲線である場合には、車両の挙動を大きく変更する必要がある場合があるため、走行領域が直線である場合よりも大きな最大制御Ｇである０．１５Ｇに設定する。

さらに、最大制御Ｇは、自車両を仮想車線に対して平行に変位させる場合（逸脱フラグが解除されている場合）よりも、自車両の進行方向を走行領域の中心側に変位させる場合（逸脱フラグがセットされている場合）のほうが小さな値に設定される。自車両を仮想車線に対して平行に変位させる場合には、例えば、最大制御Ｇは、自車両の進行方向を走行領域の中心側に変位させる場合の半分程度の値に設定される。

続いて、三角波要求値を演算する（Ｓ１９０）。この処理については、図５を用いて説明する。図５は時間と目標ヨーレートとの関係を示すグラフである。
この処理では、図５（ａ）および図５（ｂ）に示すように、逸脱角度αに基づいて、自車両の進行方向を支援角度βに変更する際の最大ヨーレートを演算する。本処理では、制御時間を極力短く、かつ逸脱距離を極力小さくするために、時間と目標ヨーレートとの関係を示すグラフにおいて三角波となるように設定する。

つまり、目標ヨーレートが最大ヨーレートになるまでの時間については連続的に自車両のヨーレートの変化率が一定となるように増加させ（図５に示す直線３００参照）、その後、ヨーレートがＲ＿Ｙｒになるまでの時間については連続的に自車両のヨーレートの変化率が一定となるように減少させる（図５に示す直線４００参照）。この際、目標ヨーレートと制御継続時間との積分値（図５に示す面積Ｓ＿ｒｉｓｉｎｇと面積Ｓ＿ｆａｌｌｉｎｇとの和）が抑制角度（α＋β）となるようにしている。

また、自車両のヨーレートの変化率が一定となる抑制角度の分だけ自車両の進行方向を走行領域の中心側に変位させたときに自車両のヨーレートがＲ＿Ｙｒになるようにしている。なお、Ｒ＿Ｙｒは、図８に示すように、自車両がカーブを走行している場合において、このカーブの形状に沿って自車両を走行させる際に必要となるヨーレートである必要ヨーレートを表し、カーブ半径と自車両の走行速度とに基づいて本処理において算出される。

ここで、制御開始時のヨーレートが、Ｒ＿Ｙｒを基準として正の値（Ｒ＿Ｙｒよりも大きい）であるか負の値（Ｒ＿Ｙｒよりも小さい）であるか（ここでは右旋回時のヨーレートを正とする）によって、最大ヨーレート（ＹｒＭａｘ）の算出方法は異なる（図５（ａ）および図５（ｂ）参照）。

上記式［１］または式［２］によって三角波の頂点（最大ヨーレート）が求められる。なお、上記式［２］を採用する場合には、図５（ｂ）に示すように、目標ヨーレートがＲ＿Ｙｒになるまで時間ｘの間は逸脱角度αが増加し、さらに時間ｘが経過後に制御開始時の逸脱角度αになる。このため、図５（ｂ）では、制御開始後、時間２ｘが経過したときを基準に面積Ｓ＿ｒｉｓｉｎｇを図示している。

続いて、求めた三角波の頂点が上限ヨーレートに対応する上限ヨーレート（ｃｎｔＹｒＭａｘ）を超えるか否かを判定する（Ｓ２１０）。求めた三角波の頂点が上限ヨーレートを超えない場合には（Ｓ２１０：ＮＯ）、三角波として各要求時間を演算する（Ｓ２３０）。詳細には、図６に示すように、目標ヨーレートを増加させる際の目標ヨーレートの変化率をｒｅｑＹｒＪｅｒｋｒｉｓｉｎｇ、目標ヨーレートを減少させる際の目標ヨーレートの変化率をｒｅｑＹｒＪｅｒｋｆａｉｌｉｎｇとすると、目標ヨーレートを増加させる際の制御継続時間ｔ＿ｒｉｓｉｎｇ、および目標ヨーレートを減少させる際の制御継続時間ｔ＿ｆａｉｌｉｎｇは、次式で求めることができる。

ところで、Ｓ２１０の処理において、三角波の頂点が上限ヨーレートを超える場合には（Ｓ２１０：ＹＥＳ）、上限ヨーレートを超える部分ついては最大値を上限ヨーレートとする台形波とし、各要求時間を演算する（Ｓ２２０）。

具体的には、図７に示すように、三角波のうちの上限ヨーレート（ｃｎｔＹｒＭａｘ）を超える部分の三角形１００をこの三角形１００を除去した台形部分のうちの目標ヨーレートが上限ヨーレートで一定になる部分に長方形２００の領域として加え、このときの制御継続時間をそれぞれ求める。なお、ｔ＿ｃｏｎｓｔは、上限ヨーレートの状態での制御継続時間を示す。

Ｓ２２０の処理またはＳ２３０の処理が終了すると、各要求時間に応じて目標ヨーレートを生成し、この目標ヨーレートを出力する（Ｓ２４０）。このような処理が終了すると、逸脱抑制処理を終了する。

なお、逸脱抑制処理では、逸脱フラグ解除時において制御終了時（ｔ＿ｆａｉｌｉｎｇの経過時）または車両が実車線と平行（例えば、±０．５ｄｅｇ以内）になったときに制御フラグを解除する。また、このような処理が実施されると、パワステ制御部３０では、目標ヨーレートに応じて舵角を設定し、舵角に応じたパワーステアリングのアシストトルクを出力することで、目標ヨーレートに応じた車両制御が実現される。

［本実施形態による効果］
以上のように詳述した逸脱抑制システム１において、演算部１０は、自車両が走行領域を逸脱しようとする際における、自車両の進行方向と目標とする自車両の進行方向とのなす角を表す抑制角度を取得し、抑制角度の分だけ自車両の進行方向を走行領域の中心側に変位させるための出力を行う。演算部１０は、自車両の旋回時角速度を変化させる際に、自車両の旋回時角速度の変化率が一定となるような目標値を繰り返し出力する。

このような逸脱抑制システム１によれば、抑制角度を取得してこの抑制角度に応じて旋回時角速度を指定する目標値を出力すればよいので、ヨーモーメント等を演算により求める構成と比較して、より簡素な処理で走行領域の逸脱を抑制することができる。特に、本発明の逸脱抑制システム１によれば、自車両の旋回時角速度を変化させる際に、自車両の旋回時角速度の変化率を一定とするので、目標値の出力の際の演算を容易にすることができる。

また、演算部１０は、自車両が走行領域を逸脱しようとする際における、走行領域の内外を区分する境界線と自車両の進行方向とのなす角を表す逸脱角度と、自車両を境界線よりも走行領域の中心側に戻す際において、境界線と目標とする自車両の進行方向とのなす角を表す支援角度とを取得し、逸脱角度と支援角度との和を抑制角度とする。

このようにすると、支援角度を任意の値（固定値や逸脱角度等に応じた値）にする場合、逸脱角度だけを検出すれば抑制角度を設定することができる。よって、目標値の出力の際の演算をより簡素にすることができる。

また、上記の逸脱抑制システム１において演算部１０は、抑制角度の分だけ自車両の進行方向を走行領域の中心側に変位させたときに自車両の旋回時角速度が０になるようにする。

このような逸脱抑制システム１によれば、旋回時角速度を０にしてからドライバによる操作に移行することができる。よって、ドライバによる操作に移行する際のドライバの身体への負担を軽減することができる。

また、上記逸脱抑制システム１においては、演算部１０は、旋回時角速度を一定時間連続的に増加させ、その後、一定時間連続的に減少させ、この際、旋回時角速度と制御継続時間との積分値が抑制角度となるようにする。

このような逸脱抑制システム１によれば、時間と旋回時角速度との関係をグラフ化した時に、三角波となるように旋回時角速度を設定することになる。したがって、旋回時角速度の変化率が一定となるような目標値を容易に設定することができる。

加えて、上記逸脱抑制システム１において演算部１０は、旋回時角速度が、予め設定された第１上限角速度を超えることがないようにする。この場合、目標値は第１上限角速度で維持させればよい。このようにする場合、時間と旋回時角速度との関係をグラフ化した時に、台形波となるように旋回時角速度を設定することになる。

このような逸脱抑制システム１によれば、過度な旋回が実施されることを抑制することができる。よって、ドライバに制御時の恐怖感を与え難くすることができる。
また、上記逸脱抑制システム１において演算部１０は、現在の旋回時角速度を基準とした目標値を出力する。

このような逸脱抑制システム１によれば、制御の開始時等に、現在の旋回時角速度とかけ離れた目標値が設定されることがないので、自車両を滑らかに制御することができる。この結果、乗員の乗り心地を向上させることができる。

さらに、上記逸脱抑制システム１において演算部１０は、自車両の進行方向を走行領域の中心側に変位させた後において、走行領域内において境界線と平行な仮想車線と自車両の進行方向とのなす角を表す最終角度を取得し、最終角度の分だけ自車両の進行方向を仮想車線に対して平行に変位させるための出力を行う。

このような逸脱抑制システム１によれば、自車両を走行領域内において境界線と平行に戻すことができる。
また、上記逸脱抑制システム１において演算部１０は、最終角度の分だけ自車両の進行方向を仮想車線に対して平行に変位させるための出力を行う際に、旋回時角速度が、第１上限角速度以下の値に設定された第２上限角速度を超えることがないようにする。

このような逸脱抑制システム１によれば、最終角度の分だけ自車両の進行方向を仮想車線に対して平行に変位させる制御中には旋回角速度をより小さくすることでドライバへの身体への負担を軽減することができる。このため、ドライバによる操作に移行し易くすることができる。

また、上記逸脱抑制システム１において演算部１０は、支援角度を逸脱角度に応じて設定する。
このような逸脱抑制システム１によれば、逸脱角度を取得してこの逸脱角度に応じて支援角度を決定し、逸脱角度と支援角度との和に応じて旋回時角速度を指定する目標値を出力すればよいので、ヨーモーメント等を演算により求める構成と比較して、より簡素な処理で走行領域の逸脱を抑制することができる。

また、上記逸脱抑制装置において演算部１０は、支援角度を逸脱角度以下の大きさに設定する。
このような逸脱抑制装置よれば、自車両の進行方向が走行領域の中心側に過度に向けられることを抑制することができる。

さらに、上記逸脱抑制システム１において演算部１０は、逸脱角度が大きくなるにつれて支援角度を大きく設定する。
このような逸脱抑制システム１によれば、自車両が走行領域をより大きく逸脱する虞がある場合に、より早期に走行領域内に戻れるように支援角度を大きくする。よって、自車両に対する安全性を向上させることができる。

また、上記逸脱抑制システム１において演算部１０は、自車両の旋回時角速度を変化させる際に、自車両の旋回時角速度の変化率が一定となるような目標値を繰り返し出力し、自車両を仮想車線に対して平行に変位させる際の旋回時角速度の変化率は、自車両の進行方向を走行領域の中心側に変位させる際の旋回時角速度の変化率よりも小さな値に設定されている。

すなわち、自車両の進行方向を走行領域の中心側に変位させる制御中には、より早期に自車両を走行領域の中心側に向けるために旋回時角速度の変化率を比較的大きな値としてもよいが、自車両を仮想車線に対して平行に変位させる制御中には、早期に制御を完了させる必要がないので、旋回角速度の変化率をより小さくしている。このような逸脱抑制システム１によれば、ドライバへの身体への負担を軽減することができ、より乗り心地よく車両の進行方向を適切な方向に制御することができる。

［その他の実施形態］
本発明の実施の形態は、上記の実施形態に何ら限定されることはなく、本発明の技術的範囲に属する限り種々の形態を採りうる。

例えば、上記実施形態においては、ヨーレート（旋回時角速度）の目標値を出力するようにしたが、舵角等のヨーレートに対応する値を出力するようにしてもよい。
また、上記実施形態において、逸脱角度と支援角度との関係は、例えば一次関数や指数関数等、逸脱角度が大きくなると支援角度も単調に増加する関数を用いて表現することができる。

また、上記実施形態において、自車両を仮想車線と平行にする際には、反対側（図１（ｂ）では右側）の実車線が確認できない場合を考慮して、以下のようにしてもよい。まず、図９に示すように、各パラメータを定義する。

すなわち、図９において左側の境界線から右側の仮想車線までの距離をParaOffsetとし、左前輪の外側から右前輪の外側までの距離をTreadとしている。また、自車両の速度をV、境界線側の前輪と境界線との車幅方向の距離をDTLB、仮想車線側の前輪と仮想車線との車幅方向の距離をVirtDTLBとしている。

すると、仮想車線までの距離（ＶｉｒｔＤＴＬＢ）は、左側の実車線を基準として、以下のように求めることができる。

すると、仮想車線までの到達時間ＴＴＬＣは、以下のように求めることができる。

したがって、仮想車線の位置にて自車両を仮想車線と平行にする際の目標ヨーレート（Ｒｅｑ＿Ｙｒ）は、以下のように求めることができる。

このような目標ヨーレートを用いる場合、最終角度γが±０．５ｄｅｇ以内になった場合や、ＶｅｒｔＤＴＬＢが０未満になった場合に、制御を終了するようにすればよい。
このようにしても、車両の進行方向を実車線と平行に制御することができる。

また、Ｓ１８０の処理において、支援角度βを演算する際には、実車線から仮想車線に向かう際の横方向（実車線と直交する方向）への速度（Ｖｘ）が一定（例えば、０．３ｍ／ｓ）となるようにしてもよい。車両の走行速度Ｖとすると支援角度βは下記式［１１］から式［１２］として求めることができる。

このような逸脱抑制システムによれば、速度（Ｖｘ）（境界線との相対速度）が一定になるように自車両を制御するので、乗員が安心できる制御とすることができる。
詳細には、図１０に示す変形例の逸脱抑制処理を実施すればよい。なお、図１０に示すフローチャートでは、図３の逸脱抑制処理でいうＳ１９０〜Ｓ２３０の処理を波形演算処理と表示している。

変形例の逸脱抑制処理では、図１０に示すように、波形演算処理（Ｓ３１０）の終了後（つまり、Ｓ２２０またはＳ２３０の処理の終了後）、波形演算処理の通りに自車両の進行方向を変更した場合の逸脱距離Ｘｍａｘを演算する（Ｓ３２０）。なお、逸脱距離Ｘｍａｘの演算方法については後述する。

続いて、波形演算処理の通りに自車両の進行方向を変更した場合に自車両が走行領域を逸脱するか否かを判定する（Ｓ３３０）。この処理では、逸脱距離Ｘｍａｘと現時点での実車線または仮想車線までの距離とを比較することで判定することができる。

自車両が走行領域を逸脱しない場合には（Ｓ３３０：ＮＯ）、Ｓ２４０の処理に移行する。また、自車両が走行領域を逸脱する場合には（Ｓ３３０：ＹＥＳ）、支援角度βの補正を行う（Ｓ３４０）。

ここで、補正係数Ｋ（Ｋ＞０）とすると、補正後の支援角度β’は、下記式［１３］で求めることができる。

このような処理が終了すると、補正後の支援角度β’について波形演算処理を実施し（Ｓ３５０）、その後、Ｓ２４０の処理に移行する。
次に、逸脱距離Ｘｍａｘの演算方法について説明する。ここで、以下の説明では、自車両の走行速度Ｖ［ｍ／ｓ］、横方向の上限加速度Ｇ［ｍ／ｓ2］、ヨーレート変化率Ａ［ｒ
ａｄ／ｓ2］とする。また、図１１は、時刻と目標ヨーレート（要求ヨーレート）との関
係を示すグラフであり、図１１（ａ）は目標ヨーレートが上限加速度Ｇに対応するヨーレートを超えない場合を示し、図１１（ｂ）は目標ヨーレートが上限加速度Ｇに対応するヨーレートを超える場合を示す。

図１１（ａ）に示す例では、時刻０から時刻Ｔまでヨーレート変化率Ａに沿って目標ヨーレートを増加させ、時刻Ｔから時刻２Ｔまでヨーレート変化率−Ａに沿って目標ヨーレートを減少させている。また、図１１（ｂ）に示す例では、時刻０から時刻Ｔ１までヨーレート変化率Ａに沿って目標ヨーレートを増加させ、時刻Ｔ１から時刻Ｔ２まで目標ヨーレートをＧ／Ｖで一定とし、時刻Ｔ２から時刻Ｔ３までヨーレート変化率−Ａに沿って目標ヨーレートを減少させている。

なお、逸脱距離Ｘｍａｘの演算方法を示す際には、説明を簡単にするため、ヨーレート変化率の絶対値をＡとして図１１（ａ）に対応する例のみを説明するが、ヨーレート変化率の絶対値が、目標ヨーレートを増加させる場合と減少させる場合とで異なる場合や、図１１（ｂ）に対応する場合についても、当業者であれば以下に述べる例を応用することで逸脱距離Ｘｍａｘを求めることができる。

図１１（ａ）に示す例では、下記式［１４］、式［１５］が成立することから、式［１６］、式［１７］を得ることができる。なお、下記式では、目標ヨーレートをＹｒと表記している。また、経過時間（図１１での横軸Ｔｉｍｅ）をｔ、図１１（ａ）の例においてＹｒがＹｒＭａｘになるときの経過時間をＴとしている。

ここで、逸脱角度αが十分小さいことを想定しており、この場合、横方向の加速度ｇｘは、ｇｘ＝ｇ・ｃｏｓα＝ｇであるので、

となる。このとき、横方向の速度ｖｘは、

と表現できる。
したがって、横方向の位置ｘは、

となる。そして、ｖｘ＝０となる時刻Ｔａは、

となる。
最後に、Ｘｍａｘは次式で求めることができる。

上記のような制御を実施すると、車両の走行速度Ｖが１００ｋｍ／ｈ、逸脱角度αが１ｄｅｇの場合、図１２に示すような、横方向加速度（図１２（ａ））、横方向速度（図１２（ｂ））、横位置（図１２（ｃ））が得られる。より詳細には、図１２（ａ）は、この条件において式［１８］によって得られる値を時系列に従ってプロットしたものを示し、図１２（ｂ）は、式［１９］によって得られる値を時系列に従ってプロットしたものを示す。

そして、図１２（ｃ）は、式［２０］によって得られる値を時系列に従ってプロットしたものを示す。ここで、式［２５］［２６］にてＸｍａｘを求めることは、図１２（ｃ）にて示す曲線の極値を求めることに相当する。

以上のように詳述した逸脱抑制システムによれば、逸脱距離が大きい場合に、補正後の支援角度β’を大きくすることができるので、自車両を速やかに走行領域に戻すことができる。

［本発明の各手段と実施形態の構成との関係］
本実施形態においてパワステ制御部３０は、本発明でいう車両制御手段に相当する。また、本実施形態の逸脱抑制処理において、Ｓ１１０の処理は本発明でいう逸脱角度取得手段、最終角度取得手段、走行速度取得手段、およびヨーレート取得手段に相当し、Ｓ１１０およびＳ１８０の処理は本発明でいう抑制角度取得手段に相当する。

また、Ｓ１８０の処理は本発明でいう支援角度設定手段および支援角度取得手段に相当する。さらに、Ｓ１９０，Ｓ２１０〜Ｓ２４０の処理は本発明でいう第２変位出力手段および第１変位出力手段に相当する。

また、Ｓ３２０の処理は、本発明でいう逸脱距離取得手段に相当し、Ｓ３４０の処理は本発明でいう支援補正手段に相当する。さらに、Ｓ１９０、Ｓ３５０の処理は、本発明でいう波形作成手段に相当する。

１…逸脱抑制システム、１０…演算部、２０…カメラ、２１…車速センサ、２２…ヨーレートセンサ、２３…舵角センサ、３０…パワステ制御部、４０…ステアリングアクチュエータ。

Claims (6)

1. 車両に搭載され、自車両が走行領域を逸脱することを抑制する逸脱抑制装置（１）であって、
   自車両が走行領域を逸脱しようとする際における、自車両の進行方向と目標とする自車両の進行方向とのなす角を表す抑制角度を取得する抑制角度取得手段（Ｓ１１０、Ｓ１８０）と、
   前記抑制角度の分だけ自車両の進行方向を前記走行領域の中心側に変位させるための出力を行う第１変位出力手段（Ｓ１９０、Ｓ２１０〜Ｓ２４０）と、
   前記第１変位出力手段により自車両の進行方向を前記走行領域の中心側に変位させた後において、前記走行領域内において前記境界線と平行な仮想線と自車両の進行方向とのなす角を表す最終角度を取得する最終角度取得手段（Ｓ１１０）と、
   前記最終角度の分だけ自車両の進行方向を前記仮想線に対して平行に変位させるための出力を行う第２変位出力手段（Ｓ１９０、Ｓ２１０〜Ｓ２４０）と、
   自車両が境界線より逸脱しそうである場合に、自車両のヨーレートの現在値を取得するヨーレート取得手段（Ｓ１１０）と、
   前記現在値から、前記境界線の曲率に従って自車両が走行するためのカーブヨーレートを減算した値であるヨーレートオフセットを算出し、時間を第１座標軸、自車両を操舵する際のヨーレートの目標値を第２座標軸とする直交座標における下記条件（１）〜（３）の全てを満たす波形を作成する波形作成手段（Ｓ１９０、Ｓ３５０）と、
   を備え、
   前記第１変位出力手段は、前記自車両の旋回時角速度を増加または減少させる際に、自車両の旋回時角速度の変化率が一定となるような目標値を出力し、かつ前記抑制角度の分だけ自車両の進行方向を前記走行領域の中心側に変位させるための出力として、自車両のヨーレートが前記波形に沿って決定されるヨーレートの目標値になるように自車両を操舵するための出力を行い、
   前記第２変位出力手段は、前記自車両の旋回時角速度を増加または減少させる際に、自車両の旋回時角速度の変化率が一定となるような目標値を出力し、
   前記第２変位出力手段による旋回時角速度の変化率は、前記第１変位出力手段による旋回時角速度の変化率よりも小さな値に設定されていること
   を特徴とする逸脱抑制装置。
   条件（１）：自車両の進行方向を変位させる出力を開始するときにヨーレートオフセットを表す第１のポイントがヨーレートの目標値となること
   条件（２）：自車両の進行方向を変位させる出力を終了する予定のときに、カーブヨーレートを表す第２のポイントがヨーレートの目標値となること
   条件（３）：前記第１のポイントから前記第２のポイントまでヨーレートの目標値を変化させ、かつカーブヨーレートを基準として前記第１のポイントから前記第２のポイントまでヨーレートの目標値を時間で積分した積分値が前記抑制角度になること
2. 請求項１に記載の逸脱抑制装置において、
   前記第１変位出力手段は、前記旋回時角速度が、予め設定された第１上限角速度を超えることがないようにするとともに、
   前記第２変位出力手段は、前記旋回時角速度が、前記第１上限角速度以下の値に設定された第２上限角速度を超えることがないようにすること
   を特徴とする逸脱抑制装置。
3. 請求項１に記載の逸脱抑制装置において、
   前記抑制角度取得手段は、自車両が走行領域を逸脱しようとする際における、走行領域の内外を区分する境界線と自車両の進行方向とのなす角を表す逸脱角度と、前記自車両を前記境界線よりも前記走行領域の中心側に戻す際において、前記境界線と目標とする自車両の進行方向とのなす角を表す支援角度とを取得し、前記逸脱角度と前記支援角度との和を前記抑制角度とすること
   を特徴とする逸脱抑制装置。
4. 請求項１〜請求項３の何れか１項に記載の逸脱抑制装置において、
   前記第１変位出力手段および前記第２変位出力手段のうちの少なくとも前記第１変位出力手段による出力に応じて自車両の進行方向を制御する車両制御手段（３０）、
   を備えたことを特徴とする逸脱抑制装置。
5. 請求項１〜請求項４の何れか１項に記載の逸脱抑制装置において、
   前記波形作成手段は、下記条件（４）も満たす波形を作成すること
   を特徴とする逸脱抑制装置。
   条件（４）：前記第１のポイントから前記第２のポイントまで複数の線分で接続すること
6. コンピュータを、請求項１〜請求項５の何れか１項に記載の逸脱抑制装置を構成する各手段として機能させるための逸脱抑制プログラム。