(57)【特許請求の範囲】
【請求項１】
白線情報を用いて検出または推定された道路曲率に応じた車両の目標横位置を算出する目標軌道算出手段と、
白線情報を用いて検出または推定された車両の横位置，横速度，ヨーレート，レーンに対するヨー角，操舵角，操舵角速度等を要素とするベクトルに比例フィードバックゲインを乗じた比例フィードバック電流を演算する比例フィードバック部と、
検出された車両横変位と目標軌道算出手段からの目標横変位との目標偏差の積分値に所定の積分フィードバックゲインを乗じた積分フィードバック電流を演算する積分フィードバック部と、
前記比例フィードバック電流と積分フィードバック電流を加算する電流加算手段と、
ドライバーの任意な操舵介入を可能にする予め設定された指令電流制限値、もしくは、ドライバーの任意な操舵介入を可能にする旋回加速度等に応じて算出された指令電流制限値により前記電流加算値の出力電流制限を行うことにより操舵アクチュエータへの指令電流を得る指令電流制限手段と、
を備えたレーンキープアシスト制御装置において、
前記指令電流制限手段からの指令電流が指令電流制限値と等しくなる飽和状態である場合、積分フィードバック部にて指令電流を減少させる方向への積分演算のみを行い、指令電流を増加させるような積分演算を行わずにその時の積分値を保持する積分演算停止判断手段を設けたことを特徴とするレーンキープアシスト制御装置。
【請求項２】
白線情報を用いて検出または推定された道路曲率に応じた車両の目標横位置を算出する目標軌道算出手段と、
白線情報を用いて検出または推定された車両の横位置，横速度，ヨーレート，レーンに対するヨー角，操舵角，操舵角速度等を要素とするベクトルに比例フィードバックゲインを乗じた比例フィードバック電流を演算する比例フィードバック部と、
検出された車両横変位と目標軌道算出手段からの目標横変位との目標偏差の積分値に所定の積分フィードバックゲインを乗じた積分フィードバック電流を演算する積分フィードバック部と、
前記比例フィードバック電流と積分フィードバック電流を加算する電流加算手段と、
ドライバーの任意な操舵介入を可能にする予め設定された指令電流制限値、もしくは、ドライバーの任意な操舵介入を可能にする旋回加速度等に応じて算出された指令電流制限値により前記電流加算値の出力電流制限を行うことにより操舵アクチュエータへの指令電流を得る指令電流制限手段と、
を備えたレーンキープアシスト制御装置において、
前記指令電流制限手段からの指令電流が指令電流制限値と等しくなる飽和状態であると判断され、且つ、時間と共に指令電流制限値が減少してゆく場合、指令電流と比例フィードバック電流との差に応じた積分リミット値を算出し、積分フィードバック部の積分値をリセットする積分リミット値算出手段を設けたことを特徴とするレーンキープアシスト制御装置。
【請求項３】
白線情報を用いて検出または推定された道路曲率に応じた車両の目標横位置を算出する目標軌道算出手段と、
白線情報を用いて検出または推定された車両の横位置，横速度，ヨーレート，レーンに対するヨー角，操舵角，操舵角速度等を要素とするベクトルに比例フィードバックゲインを乗じた比例フィードバック電流を演算する比例フィードバック部と、
検出された車両横変位と目標軌道算出手段からの目標横変位との目標偏差の積分値に所定の積分フィードバックゲインを乗じた積分フィードバック電流を演算する積分フィードバック部と、
前記比例フィードバック電流と積分フィードバック電流を加算する電流加算手段と、
ドライバーの任意な操舵介入を可能にする予め設定された指令電流制限値、もしくは、ドライバーの任意な操舵介入を可能にする旋回加速度等に応じて算出された指令電流制限値により前記電流加算値の出力電流制限を行うことにより操舵アクチュエータへの指令電流を得る指令電流制限手段と、
を備えたレーンキープアシスト制御装置において、
前記積分フィードバック部にて指令電流を減少させる方向への積分演算のみを行い、指令電流を増加させるような積分演算を行わずにその時の積分値を保持する積分演算停止判断手段と、指令電流と比例フィードバック電流との差に応じた積分リミット値を算出し、積分フィードバック部の積分値をリセットする積分リミット値算出手段を共に設け、
指令電流制限手段からの指令電流が指令電流制限値と等しくなる飽和状態である場合、白線情報により検出または推定される車両横位置と道路曲率の相対関係が、車両がレーン中央から離れてゆく関係の時には前記積分値の保持を選択し、車両がレーン中央に寄ってゆく関係の時には前記積分値のリセットを選択するというように、積分値の蓄積を抑える処理を切り換える積分値抑制切換手段を設けたことを特徴とするレーンキープアシスト制御装置。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明は、走行時に白線情報を取り込み、操舵トルクを操舵力伝達系に与えることで車両がレーン中央に向かう方向に制御する、もしくは、操舵反力トルクを操舵力伝達系に与えることで車両がレーン中央に向かう方向に制御するレーンキープアシスト制御装置の技術分野に属する。
【０００２】
【従来の技術】
高速道路等で車線中央位置を走行するように車両の操舵系を制御するレーンキープアシスト制御装置（Lane Keeping Assistance System）は、ステアリングコラムにギヤを介して取り付けられた操舵アクチュエータと、白線情報を入力情報とするレーンキープアシスト制御手段により算出された指令電流で操舵アクチュエータを駆動するアクチュエータ駆動手段を備える。
【０００３】
前記レーンキープアシスト制御手段は、図９に示すように、車両がレーン中央に向かう方向へ制御するために、白線情報を用いて検出または推定された道路曲率に応じた車両の目標横位置を算出する目標軌道算出部と、白線情報を用いて検出または推定された車両の横位置，横速度，ヨーレート，ヨー角，操舵角，操舵角速度等に比例ＦＢゲインを乗じた比例ＦＢ電流を算出する比例ＦＢ部と、横風，路面片勾配，アライメントのズレ等による目標横位置（またはレーン中央）からの定常的なオフセットを防止するために、車両位置検出部からの車両横変位と目標軌道算出部からの目標横変位との目標偏差の積分値に所定の積分ＦＢゲインを乗じた積分ＦＢ電流を算出する積分ＦＢ部と、予め積分ＦＢ電流の積分リミット値を設定している積分リミット値設定部と、比例ＦＢ電流と積分ＦＢ電流（積分リミット値を超える場合は積分ＦＢ電流＝積分リミット値）を加算する加算部と、加算した電流値を指令電流制限値により出力電流制限することで操舵アクチュエータへの指令電流を得る指令電流制限部とを備えて構成されている。なお、ＦＢという表記はフィードバックを表す。
【０００４】
前記出力電流制限は、図１０に示すように、横軸を旋回加速度、縦軸を電流制限値とするアクチュエータ出力電流制限マップを用いて行われ、これにより、ドライバーの任意な操舵介入を可能にしている。以下、出力電流制限について詳しく説明する。
【０００５】
スラローム走行時（比較的短時間に左右への操舵を繰り返す）の操舵トルクと車両旋回加速度の関係を図１１に示す。操舵角と操舵トルクとの関係（ドライバー操舵時も自動操舵運転時も同じ）は、車速変化に伴って変化する。すなわち、等しい操舵角であっても車速が上がれば、旋回加速度も大きくなり、その結果、ハンドルへの反力トルクも大きくなる。一方、操舵トルクと車両の旋回加速度の関係は、車速によらずほぼ一定であるので、アシスト操舵トルクの上限値を旋回加速度に対して設定すれば車速が変化した場合であっても、レーンキープアシスト制御は常に余分な操舵トルクを発生しなくなる。
【０００６】
操舵系のフリクション等の影響によるヒステリシス特性とパワーステアリングの特性による非線型性（低旋回加速度域と高旋回加速度域の間の折れ線状の特性）を有しているが、レーンキープ走行をアシストするという観点からは、スラローム走行に比べて比較的ゆっくりした操舵で良いため、図１１の網掛け部の操舵トルクを発生すれば概ね良好なレーンキープ性能が得られる。
【０００７】
ドライバーがハンドルに加えるトルクをＴｄ、レーンキープアシスト制御によるアシスト操舵トルクをＴassistとすると、任意の旋回加速度を発生させるためのステアリング操作をするトルクＴｓは、次のようになる。
【０００８】
Ｔｓ＝Ｔｄ＋Ｔassist
これにより、図１２に示すように、電流制限値が一定値の場合、次のことが言える。
（ａ）ドライバーとレーンキープ制御が協調して走行している時（車両の旋回方向と同じ方向へ操舵した時）は、ＴｄとＴassistの方向が一致し、｜Ｔｓ｜＞｜Ｔｄ｜となるため、ドライバーの負担はレーンキープ制御無しの場合より減らすことができる。Ｔｓは操舵時のハンドル戻りトルクであり、ハンドル戻りトルクからアシストトルクを引いたトルクＴｓ−Ｔｄをドライバーがハンドルに加えれば良い。
（ｂ）緊急回避等のためレーンキープ制御と反対の方向へドライバーが操舵した時（車両の旋回方向と反対側に操舵した時）は、ＴｄとＴassistの方向が逆になり、｜Ｔｓ｜＜｜Ｔｄ｜となるため、ドライバーの負担はレーンキープ制御無しの場合より増加する。
したがって、図１２中の矢印に示すように、通常時（レーンキープ制御無し）より非常に大きな操舵トルクを加えないとハンドル操作することができなくなる場合があり得る。特に、ドライバーがさらにハンドルを切り増そうとした場合、レーンキープ制御はハンドルを戻す方向にトルクを発生させることになるので、ドライバーがハンドルを動かすためには、ハンドル戻りトルクと制御トルクを加えたトルクで操舵しなければならなくなる。
【０００９】
本システムでは、図１０に示すように、車両の旋回加速に応じた電流制限マップを設定することにより、図１３に示すように、ドライバーの意図とは逆方向への制御トルクを小さくしたため、レーンキープ制御と反対の方向へドライバーが操舵した時（車両の旋回方向と反対側に操舵した時）に必要なドライバーの介入トルク（図１３の矢印）を図１２の場合よりも極力抑えることができるようになり、特別にトルクセンサを設けることなく、ドライバーの任意の操舵介入を容易にすることができる。
ここで利用した旋回加速度は、加速度センサーで直接検出した値でも良いし、車速や操舵角等を用いて推定した値でも良い。また、旋回加速度の代わりにヨーレートを利用しても同様な結果を得ることができる。
【００１０】
【発明が解決しようとする課題】
しかしながら、上記従来のレーンキープアシスト制御装置にあっては、レーンキープ制御中のドライバーの任意な操舵介入を容易にするようなアクチュエータ電流制限を行うようにしているため、通常の走行状態であっても、指令電流が指令電流制限値と等しくなる指令電流の飽和が容易に発生する。そして、指令電流が飽和し電流制限値に達した状態では、目標とする横位置と車両の横位置の偏差が減らないため、徐々にレーンから逸脱、または、オフセット走行するという問題がある。
【００１１】
すなわち、指令電流が飽和していると、外乱（横風、路面勾配、カーブ、ドライバー操舵介入等）分の補償電流は、電流制限値以上の電流になり、操舵アクチュエータへ出力できないため、徐々にレーンから逸脱、または、オフセット走行する。
【００１２】
このような場合、目標位置と車両位置の偏差の積分値は予め設定した積分リミット値まで増加し、その後、横風の方向変化、路面勾配変化、カーブの方向変化、またはドライバーの操舵介入等によりレーン中央または目標軌道に沿った走行状態に変化した場合であっても、蓄積した積分値が速やかに減少せず、余分な操舵トルクが発生するため車両が蛇行し易い。
【００１３】
また、このような蛇行を避けるために積分ＦＢゲインを小さく設定したり、予め設定する積分リミット値を小さく設定すると、必要な操舵トルクを発生させることができなくなるため、横風、路面片勾配に対するオフセット走行が残る。
【００１４】
上記指令電流の飽和について詳細に説明すると、ここでは比例ＦＢ電流と積分ＦＢ電流の和が予め設定、または、旋回加速度等に応じて算出された指令電流制限値を超えた状態になることにより、指令電流値（指令電流値を超えないようにリミッタを設ける）が指令電流制限値と等しくなるような場合を指令電流が飽和状態と呼ぶ。この状態では比例ＦＢ電流や積分ＦＢ電流が変化したとしても、その和が制限値を下回らない限り指令電流は一定値（指令電流制限値）にとどまりそれ以上の値にならないが、積分している偏差の発生が継続すると、偏差の積分値はどこまでも増加を続けてしまう。
【００１５】
指令電流の飽和状態が発生する原因は、制御の目標値にステップ状入力を与えることにより大きな変化速度が要求される場合、あるいは、路面片勾配、風、ドライバー介入の影響が大きく、これによる外乱トルク分を打ち消すために大きな制御電流が算出されることによる。
【００１６】
本来のレーンキープ走行に必要ないという判断により電流が制限されるため、指令電流が飽和すると、外乱分を打ち消すために必要な操舵トルクを出力できなくなり、目標偏差を小さくする方向に車両が移動しなくなるため、徐々にレーンから逸脱、またはオフセット走行する。
【００１７】
操舵トルク外乱（風、路面片勾配、ドライバー介入による）をＴｄ、レーンキープアシスト制御によるアシスト操舵トルクをＴassist、任意の旋回加速度を発生させるためにステアリング操作するトルクをＴｓとすると、
Ｔｓ＝Ｔｄ＋Ｔassist
⇔Ｔassist＝Ｔｓ−Ｔｄ
である。アシスト操舵方向とドライバー介入操舵方向が反対の場合、ＴｓとＴｄの符号が逆になるので、
｜Ｔassist｜＝｜Ｔｓ−Ｔｄ｜＞｜Ｔｓ｜
したがって、ドライバーの介入性向上のためにトルク制限値ＴlmtをＴｓに近い値にすると、
｜Ｔassist｜＞｜Ｔlmt｜＞｜Ｔｓ｜
（Ｔlmt：制限トルク＝制限電流値×トルク定数）
が発生し易くなる。
【００１８】
逆に、Ｔlmt≫Ｔｓ（ＴlmtがＴｓよりも十分大きく）と設定すれば、
｜Ｔlmt｜＞｜Ｔassist｜＞｜Ｔｓ｜
となることにより、指令電流はほとんど飽和しなくなるが、ドライバーの操舵介入は難しくなる。
【００１９】
本発明は、上記問題点に着目してなされたもので、その目的とするところは、積分値の蓄積による過剰な操舵トルクの発生を抑えることにより、指令電流飽和回復後の車両挙動を安定させ、直進性の向上を図ることができるレーンキープアシスト制御装置を提供することにある。
【００２０】
【課題を解決するための手段】
上記目的を達成するため、請求項１記載の発明では、白線情報を用いて検出または推定された道路曲率に応じた車両の目標横位置を算出する目標軌道算出手段と、
白線情報を用いて検出または推定された車両の横位置，横速度，ヨーレート，レーンに対するヨー角，操舵角，操舵角速度等を要素とするベクトルに比例フィードバックゲインを乗じた比例フィードバック電流を演算する比例フィードバック部と、
検出された車両横変位と目標軌道算出手段からの目標横変位との目標偏差の積分値に所定の積分フィードバックゲインを乗じた積分フィードバック電流を演算する積分フィードバック部と、
前記比例フィードバック電流と積分フィードバック電流を加算する電流加算手段と、
ドライバーの任意な操舵介入を可能にする予め設定された指令電流制限値、もしくは、ドライバーの任意な操舵介入を可能にする旋回加速度等に応じて算出された指令電流制限値により前記電流加算値の出力電流制限を行うことにより操舵アクチュエータへの指令電流を得る指令電流制限手段と、
を備えたレーンキープアシスト制御装置において、
前記指令電流制限手段からの指令電流が指令電流制限値と等しくなる飽和状態である場合、積分フィードバック部にて指令電流を減少させる方向への積分演算のみを行い、指令電流を増加させるような積分演算を行わずにその時の積分値を保持する積分演算停止判断手段を設けたことを特徴とする。
【００２１】
請求項２記載の発明では、白線情報を用いて検出または推定された道路曲率に応じた車両の目標横位置を算出する目標軌道算出手段と、
白線情報を用いて検出または推定された車両の横位置，横速度，ヨーレート，レーンに対するヨー角，操舵角，操舵角速度等を要素とするベクトルに比例フィードバックゲインを乗じた比例フィードバック電流を演算する比例フィードバック部と、
検出された車両横変位と目標軌道算出手段からの目標横変位との目標偏差の積分値に所定の積分フィードバックゲインを乗じた積分フィードバック電流を演算する積分フィードバック部と、
前記比例フィードバック電流と積分フィードバック電流を加算する電流加算手段と、
ドライバーの任意な操舵介入を可能にする予め設定された指令電流制限値、もしくは、ドライバーの任意な操舵介入を可能にする旋回加速度等に応じて算出された指令電流制限値により前記電流加算値の出力電流制限を行うことにより操舵アクチュエータへの指令電流を得る指令電流制限手段と、
を備えたレーンキープアシスト制御装置において、
前記指令電流制限手段からの指令電流が指令電流制限値と等しくなる飽和状態であると判断され、且つ、時間と共に指令電流制限値が減少してゆく場合、指令電流と比例フィードバック電流との差に応じた積分リミット値を算出し、積分フィードバック部の積分値をリセットする積分リミット値算出手段を設けたことを特徴とする。
【００２２】
請求項３記載の発明では、白線情報を用いて検出または推定された道路曲率に応じた車両の目標横位置を算出する目標軌道算出手段と、
白線情報を用いて検出または推定された車両の横位置，横速度，ヨーレート，レーンに対するヨー角，操舵角，操舵角速度等を要素とするベクトルに比例フィードバックゲインを乗じた比例フィードバック電流を演算する比例フィードバック部と、
検出された車両横変位と目標軌道算出手段からの目標横変位との目標偏差の積分値に所定の積分フィードバックゲインを乗じた積分フィードバック電流を演算する積分フィードバック部と、
前記比例フィードバック電流と積分フィードバック電流を加算する電流加算手段と、
ドライバーの任意な操舵介入を可能にする予め設定された指令電流制限値、もしくは、ドライバーの任意な操舵介入を可能にする旋回加速度等に応じて算出された指令電流制限値により前記電流加算値の出力電流制限を行うことにより操舵アクチュエータへの指令電流を得る指令電流制限手段と、
を備えたレーンキープアシスト制御装置において、
前記積分フィードバック部にて指令電流を減少させる方向への積分演算のみを行い、指令電流を増加させるような積分演算を行わずにその時の積分値を保持する積分演算停止判断手段と、指令電流と比例フィードバック電流との差に応じた積分リミット値を算出し、積分フィードバック部の積分値をリセットする積分リミット値算出手段を共に設け、
指令電流制限手段からの指令電流が指令電流制限値と等しくなる飽和状態である場合、白線情報により検出または推定される車両横位置と道路曲率の相対関係が、車両がレーン中央から離れてゆく関係の時には前記積分値の保持を選択し、車両がレーン中央に寄ってゆく関係の時には前記積分値のリセットを選択するというように、積分値の蓄積を抑える処理を切り換える積分値抑制切換手段を設けたことを特徴とする。
【００２３】
【発明の作用および効果】
請求項１記載の発明にあっては、目標軌道算出手段において、白線情報を用いて検出または推定された道路曲率に応じた車両の目標横位置が算出される。そして、比例フィードバック部において、白線情報を用いて検出または推定された車両の横位置，横速度，ヨーレート，レーンに対するヨー角，操舵角，操舵角速度等を要素とするベクトルに比例フィードバックゲインを乗じた比例フィードバック電流が演算され、積分フィードバック部において、検出された車両横変位と目標軌道算出手段からの目標横変位との目標偏差の積分値に所定の積分フィードバックゲインを乗じた積分フィードバック電流が演算され、電流加算手段において、比例フィードバック電流と積分フィードバック電流が加算され、指令電流制限手段において、ドライバーの任意な操舵介入を可能にする予め設定された指令電流制限値、もしくは、ドライバーの任意な操舵介入を可能にする旋回加速度等に応じて算出された指令電流制限値により電流加算値の出力電流制限を行うことにより操舵アクチュエータへの指令電流が得られる。
一方、指令電流制限手段からの指令電流が指令電流制限値と等しくなる飽和状態である場合、積分演算停止判断手段において、積分フィードバック部にて指令電流を減少させる方向への積分演算のみが行われ、指令電流を増加させるような積分演算を行わずにその時の積分値が保持される。
すなわち、積分演算停止判断手段を行わない場合、車両に横変位が発生すると、指令電流が指令電流制限値に達しない不飽和状態における積分フィードバック電流は、予め設定された積分リミット値まで増加し続け、その結果、操舵アクチュエータへの指令電流も増加し続ける。その後、指令電流が飽和しても、予め設定された積分リミット値まで増加させる方向の積分演算が行われるため、車両の横変位が減少を始め、比例フィードバック電流が減少しても、しばらくの間は指令電流の飽和状態が維持される。
このため、出力する電流制限による最大操舵トルクとドライバーの操舵トルクがほぼ同じ値のシステムにおいては、一旦、指令電流の飽和が発生すると過剰な横変位積分値が蓄積し、レーン中央または目標軌道に沿った走行状態に戻ってもしばらくは余分な操舵トルクが発生するため、車両が蛇行し易い。また、このような蛇行を防止するために、積分フィードバックゲインや予め設定する積分リミット値を小さく設定した場合には、積分フィードバック電流そのものが小さくなるため、オフセット走行が残る恐れがある。
これに対し、請求項１記載の発明では、制限値で飽和している間は、指令電流を減少させる方向へのみ積分演算を行い、指令電流を増加させる方向へは積分演算を行わずに積分値を保持することにより、積分フィードバック電流の余分な増加を抑えることができるので、車両の横変位が減少を始めて比例フィードバック電流が減少した場合には、速やかに操舵アクチュエータへの指令電流を減少させることができる。
よって、積分演算停止判断手段の採用によって、積分値の蓄積による過剰な操舵トルクの発生を抑えることにより、指令電流飽和回復後の車両挙動を安定させ、直進性の向上を図ることができる。
【００２４】
請求項２記載の発明の操舵アクチュエータへの指令電流を得る作用は、請求項１記載の発明と同様である。
一方、指令電流制限手段からの指令電流が指令電流制限値と等しくなる飽和状態であると判断され、且つ、時間と共に指令電流制限値が減少してゆく場合、積分リミット値算出手段において、指令電流と比例フィードバック電流との差に応じた積分リミット値が算出され、積分フィードバック部の積分値が積分リミット値によりリセットされる。
すなわち、指令電流と比例フィードバック電流との差に応じて算出される積分リミット値は、比例フィードバック電流と積分フィードバック電流の和が、電流制限後の操舵アクチュエータへの指令電流に一致するようにして求めた積分値である。したがって、指令電流の飽和中において、時間と共に電流制限値が減少する場合（例えば、旋回加速度に応じた電流制限を行うことにより、ドライバーの操舵による旋回加速度の増加と共に電流制限値が減少する場合）、電流制限値の減少に比例して積分値も減少し、電流制限値の回復後は直ちに指令電流の飽和が解消され、過剰な積分値が発生しなくなるため、車両の挙動が安定し、蛇行の防止に効果がある。
同様に、指令電流の飽和中において、白線情報を用いて検出または推定された車両の横位置，横速度，ヨーレート，レーンに対するヨー角，操舵角，操舵角速度等が増加することで比例フィードバック電流が増加する場合、比例フィードバック電流の増加に比例して積分値が減少し、比例フィードバック電流の回復後は直ちに指令電流の飽和が解消され、過剰な積分値が発生しなくなるため、車両の挙動が安定し、蛇行の防止に効果がある。
【００２５】
請求項３記載の発明の操舵アクチュエータへの指令電流を得る作用は、請求項１記載の発明と同様である。
一方、指令電流制限手段からの指令電流が指令電流制限値と等しくなる飽和状態である場合、積分値抑制切換手段において、白線情報により検出または推定される車両横位置と道路曲率の相対関係が、車両がレーン中央から離れてゆく関係の時には積分演算停止判断手段による積分値の保持が選択され、また、白線情報により検出または推定される車両横位置と道路曲率の相対関係が、車両がレーン中央に寄ってゆく関係の時には積分リミット値算出手段による積分値のリセットが選択されるというように、積分値の蓄積を抑える処理が切り換えられる。
すなわち、積分値の保持は、積分フィードバック電流が過大になる傾向があり、また、積分値を減少させるリセットは、積分フィードバック電流が不足する傾向がある。
そこで、例えば、右カーブを走行中に車両が道路右側に寄っている場合、車両が直進しても、次第にレーン中央に近づいていくため、前記積分値のリセットを行うことにより、安定した車両挙動が確保される。
また、例えば、右カーブを走行中に車両が道路左側に寄っている場合、車両が直進した場合には、次第にレーン中央から離れてゆくため、前記積分値の保持を行うことにより、レーン追従性が確保される。
このように、車両横位置と道路曲率（旋回半径）の相対関係によって、車両がレーン中央から離れてゆく関係の時には積分値の保持を選択し、車両がレーン中央に寄ってゆく関係の時には積分値のリセットを選択することで、指令電流の飽和が解消した後の積分フィードバック電流を適切な値にすることができるため、安定した車両挙動とレーン追従性を常に両立させることができる。
【００２６】
【発明の実施の形態】
（実施の形態１）
まず、構成を説明する。
【００２７】
図１は実施の形態１のレーンキープアシスト制御装置が適用された自動車用操舵系を示す全体システム図であり、ステアリングコラム１にはコラムシャフト２が内挿支持され、前記コラムシャフト２の上端部にはステアリングホイール３が設けられ、前記コラムシャフト２の下端部には左右の車輪４，５を転舵する油圧パワーステアリング機構６が連結され、前記コラムシャフト２の途中位置には補助操舵トルクを付与するアシストアクチュエータ７（操舵アクチュエータ）が設けられている。
【００２８】
前記アシストアクチュエータ７は、モーター８と、モータ軸に設けられた電磁クラッチ９と、該電磁クラッチ９を介してモーター８により回転駆動される駆動歯車１０と、該駆動歯車１０に噛み合う被駆動歯車１１によるウォーム＆ホイール減速機構を有して構成されている。
【００２９】
前記コラムシャフト２のステアリングホイール３に近い位置には、コラムシャフト２の回転角度を検出する操舵角センサー１３が設けられ、また、前記駆動歯車１０の電磁クラッチ９とは反対側の歯車軸端部には、駆動歯車１０の回転角度を検出するエンコーダー１４が設けられ、操舵角センサー１３及びエンコーダー１４からのセンサ信号は、レーンキープコントロールユニット１５に入力される。
【００３０】
前記レーンキープコントロールユニット１５には、操舵角センサー１３及びエンコーダー１４からのセンサ信号以外に、進行方向の前方道路を撮影するＣＣＤカメラと画像処理回路を一体に持つカメラ＆画像処理装置１６からの自車走行状態情報と、車速センサー等からの車両系各種信号が入力され、レーンキープコントロールユニット１５からは、モーター８に対しモーター駆動する制御電流が出力されると共に、電磁クラッチ９に対し断接指令が出力される。
【００３１】
前記カメラ＆画像処理装置１６では、ＣＣＤカメラからの信号に基づく前方道路映像を画像処理し、白線あるいはセンターラインなどの前方車線の境界線が抽出識別され、自車走行位置と車線中央位置との横変位を含む自車走行状態情報が作成される。
【００３２】
図２はレーンキープアシスト制御系を示すブロック図であり、前記レーンキープコントロールユニット１５には、操舵角センサー１３からのセンサー信号に基づいて舵角を検出する舵角検出部１５ａと、カメラ＆画像処理装置１６からの入力情報に基づいて走行している道路の白線を認識する白線認識部１５ｂと、白線情報を用いて検出または推定された道路曲率に応じた車両の目標横位置ｙｒを算出する目標軌道算出部１５ｃ（目標軌道算出手段）と、白線情報を用いて車両横位置ｙを検出する車両位置検出部１５ｄと、白線情報を用いて検出または推定された車両の横位置，横速度，ヨーレート，レーンに対するヨー角，操舵角，操舵角速度等を要素とするベクトルｘに比例ＦＢゲインＫｐを乗じた比例フィードバック電流Ｉｐを演算する比例ＦＢ部１５ｅ（比例フィードバック部）と、検出された車両横変位ｙと目標軌道算出部１５ｃからの目標横変位ｙｒとの差である目標偏差ｙ−ｙｒを算出する目標偏差算出部１５ｆと、目標偏差ｙ−ｙｒの積分値Ｓに所定の積分ＦＢゲインＫｉを乗じた積分ＦＢ電流Ｉｉを演算する積分ＦＢ部１５ｇ（積分フィードバック部）と、比例ＦＢ電流Ｉｐと積分ＦＢ電流Ｉｉを加算する電流加算部１５ｈ（電流加算手段）と、旋回加速度に応じて算出された指令電流制限値Ｉlmt+，Ｉlmt-により電流加算値Ｉｓの出力電流制限を行うことによりアシストアクチュエータ７への指令電流Ｉrefを得る指令電流制限部１５ｉ（指令電流制限手段）と、指令電流制限部１５ｉからの指令電流Ｉrefが指令電流制限値Ｉlmt+，Ｉlmt-と等しくなる飽和状態である場合、積分ＦＢ部１５ｇにて指令電流Ｉrefを減少させる方向への積分演算のみを行い、指令電流Ｉrefを増加させるような積分演算を行わずにその時の積分値Ｓを保持する積分演算停止判断部１５ｊ（積分演算停止判断手段）を有して構成されている。
【００３３】
次に、作用を説明する。
【００３４】
［アクチュエータ駆動電流算出処理］
図３は実施の形態１のレーンキープコントロールユニット１５で行われるアクチュエータ駆動電流算出処理の流れを示すフローチャートで、以下、各ステップについて説明する。
【００３５】
ステップ３０では、操舵角センサー１３による操舵角データの取得と、カメラ＆画像処理装置１６からの入力情報に基づいて、道路の曲率、車両の白線に対する走行位置、白線に対するヨー角等の車両走行状態データ取得を行う。
【００３６】
ステップ３１では、前記道路曲率データと車両走行状態データを用いて目標走行軌道である車両の目標横位置ｙｒを算出する。例えば、目標横位置ｙｒを０に固定するとレーン中央を走行する目的でレーンキープ制御を行う。さらに、白線のつながりが不連続な場合や局部的に曲がっているような場合にも車両の挙動がスムーズとなるように目標横位置ｙｒを補間する。
【００３７】
ステップ３２では、道路曲率データや車両走行状態データや操舵角データを用いて、直線，曲線を問わず、常にレーン中央に向かう方向に比例ＦＢ電流Ｉｐ（＝−Ｋｐ・ｘ）を算出する。ここで、車両の横変位だけに比例ＦＢゲインＫｐを乗じて比例ＦＢ電流Ｉｐを算出しても良いし、車両の横変位，横速度，ヨーレート，レーンに対するヨー角，操舵角速度等の推定値を算出し、これを要素とする各ベクトルｘ１，ｘ２…に、各推定値毎に設計した比例ＦＢゲインＫｐ１，Ｋｐ２…を乗じた値の総和を比例フィードバック電流Ｉｐとして算出しても良い。
【００３８】
ステップ３３では、１制御周期前の指令電流Ｉrefが旋回加速度に応じて算出した指令電流制限値Ｉlmt+，Ｉlmt-（図１０）と等しくなる飽和状態である場合、さらに指令電流Ｉrefの飽和を進める方向への積分を行わないための判断を行う。すなわち、指令電流Ｉrefを減少させる方向（左操舵時の電流飽和時に車両が目標軌道より左にある場合、右操舵時の電流飽和時に車両が目標軌道より右にある場合）への積分演算のみを行い、指令電流Ｉrefを増加させる方向（左操舵時の電流飽和時に車両が目標軌道より右にある場合、右操舵時の電流飽和時に車両が目標軌道より左にある場合）の積分演算を行わずにその時の積分値を保持する。
【００３９】
ステップ３４では、目標軌道算出部１５ｃにて算出された目標横変位ｙｒの位置に車両を走行させるために、車両横変位ｙと目標横変位ｙｒとの差である目標偏差ｙ−ｙｒを積分した積分値Ｓに積分ＦＢゲインＫｉを乗じて積分ＦＢ電流Ｉｉ（＝−Ｋｉ・Ｓ）を算出する。
【００４０】
ステップ３５では、比例ＦＢ電流Ｉｐと積分ＦＢ電流Ｉｉを加算して電流加算値Ｉｓを得る。
【００４１】
ステップ３６では、電流加算値Ｉｓが指令電流制限値Ｉlmt+（上限値）未満かどうかが判断され、ステップ３７では、電流加算値Ｉｓが指令電流制限値Ｉlmt-（下限値）を超えているかどうかが判断され、ステップ３６でＮＯと判断された場合には、ステップ３８へ進み、指令電流制限値Ｉlmt+が指令電流Ｉrefとされ、ステップ３６でＹＥＳと判断されステップ３７でＮＯと判断された場合には、ステップ３９へ進み、指令電流制限値Ｉlmt-が指令電流Ｉrefとされ、ステップ３６でＹＥＳと判断されステップ３７でＹＥＳと判断された場合には、ステップ４０へ進み、電流加算値Ｉｓが指令電流Ｉrefとされる。つまり、旋回加速度に応じて算出された指令電流制限値Ｉlmt+，Ｉlmt-（図１０，図１３）により電流加算値Ｉｓの出力電流制限処理が行われる。
【００４２】
ステップ４１では、ステップ３８またはステップ３９またはステップ４０で設定された指令電流Ｉrefに応じて実アクチュエータ電流をフィードバックすることによりＰＷＭ（パルス変調）駆動回路へ入力するデューティ比を得る。
【００４３】
［アクチュエータ駆動電流算出作用］
まず、指令電流Ｉrefが飽和状態でない場合には、図３にフローチャートにおいて、ステップ３０→ステップ３１→ステップ３２→ステップ３３→ステップ３４→ステップ３５→ステップ３６→ステップ３７→ステップ４０へと進む流れとなり、ステップ４０では、比例ＦＢ電流Ｉｐと積分ＦＢ電流Ｉｉを加算して得られた電流加算値Ｉｓが指令電流Ｉrefとされる。
【００４４】
一方、指令電流Ｉrefが指令電流制限値Ｉlmt+，Ｉlmt-と等しくなる飽和状態である場合には、図３にフローチャートにおいて、ステップ３０→ステップ３１→ステップ３２→ステップ３３へと進む流れとなり、ステップ３３において、指令電流Ｉrefを減少させるとの判断時にのみステップ３４へ進んで積分演算を行い、指令電流Ｉrefを増加させるとの判断時にはステップ３５へ進んで積分演算を行わず、その時の積分値が保持される。
すなわち、図４に示すように、右操舵時に電流飽和した場合、さらに右側へ操舵トルクを増加させる方向への積分演算は行わず、また、左操舵時に電流飽和した場合、さらに左側へ操舵トルクを増加させる方向への積分演算は行わない。
【００４５】
そして、ステップ３５からステップ３６→ステップ３８、もしくは、ステップ３６→ステップ３７→ステップ３９へと進む流れとなり、ステップ３８では指令電流Ｉrefが指令電流制限値Ｉlmt+とされ、ステップ３９では指令電流Ｉrefが指令電流制限値Ｉlmt-とされる出力電流制限が行われる。
【００４６】
［飽和時の積分停止判断作用］
図５の（ａ）に示すように、ドライバーの操舵等の影響により車両が０．５ｍ左へ変位した状態が時間ｔ０から時間ｔ１までしばらく続くような典型的な例に基づいて、飽和時の積分停止判断作用について説明する。
【００４７】
まず、積分停止判断を行わない場合には、図５の（ｂ−１）に示すように、車両に横変位が発生すると、指令電流Ｉrefが指令電流制限値Ｉlmt+，Ｉlmt-に達しない不飽和状態における積分ＦＢ電流Ｉｉは、予め設定された積分リミット値まで増加し続け、その結果、操舵アクチュエータへの指令電流Ｉrefも増加し続ける（領域▲１▼）。その後、指令電流Ｉrefが飽和しても、予め設定された積分リミット値まで増加させる方向の積分演算が行われるため（領域▲２▼）、車両の横変位が減少を始め、比例ＦＢ電流Ｉｐが減少しても、しばらくの間は指令電流Ｉrefの飽和状態が維持される（領域▲３▼）。なお、積分リミット値とは、積分演算の特性からＣＰＵ内の変数のオーバフローを防止するために必要な積分値の上限値ことを表していて、図５では予め設定した積分リミット値に達していないため図示していない。
【００４８】
このため、出力する電流制限による最大操舵トルクとドライバーの操舵トルクがほぼ同じ値のシステムにおいては、一旦、指令電流の飽和が発生すると過剰な横変位積分値が蓄積し、レーン中央または目標軌道に沿った走行状態に戻ってもしばらくは余分な操舵トルクが発生するため、車両が蛇行し易い。また、このような蛇行を防止するために、積分ＦＢゲインや予め設定する積分リミット値を小さく設定した場合には、積分ＦＢ電流そのものが小さくなるため、オフセット走行が残る恐れがある。
【００４９】
これに対し、実施の形態１のように積分停止判断を行う場合には、図５の（ｂ−２）に示すように、指令電流Ｉrefが図１０に示すような指令電流制限値Ｉlmt+，Ｉlmt-で飽和している間は、指令電流Ｉrefを減少させる方向へのみ積分演算を行い、指令電流Ｉrefを増加させる方向へは積分演算を行わずに積分値Ｓを保持することにより、積分ＦＢ電流Ｉｉの余分な増加を抑えることができるので（領域▲２▼）、車両の横変位が減少を始めて比例ＦＢ電流Ｉｐが減少した場合には、速やかにアシストアクチュエータ７への指令電流Ｉrefを減少させることができ（領域▲３▼）、早期に指令電流Ｉrefの飽和状態から解放される。
【００５０】
次に、効果を説明する。
【００５１】
実施の形態１のレーンキープアシスト制御装置にあっては、指令電流制限部１５ｉからの指令電流Ｉrefが図１０に示すような指令電流制限値Ｉlmt+，Ｉlmt-と等しくなる飽和状態である場合、積分ＦＢ部１５ｇにて指令電流Ｉrefを減少させる方向への積分演算のみを行い、指令電流Ｉrefを増加させるような積分演算を行わずにその時の積分値Ｓを保持する積分演算停止判断部１５ｊを設けたため、積分値の蓄積による過剰な操舵トルクの発生を抑えることにより、指令電流飽和回復後の車両挙動を安定させ、直進性の向上を図ることができる。
【００５２】
（実施の形態２）
まず、構成を説明すると、図６は実施の形態２におけるレーンキープアシスト制御装置の制御系を示すブロック図であり、レーンキープコントロールユニット１５には、実施の形態１の積分演算停止判断部１５ｊに代え、積分リミット値算出部１５ｋ（積分リミット値算出手段）が設けられている。尚、他の構成は図２に示す実施の形態１と同様であるので説明を省略する。
【００５３】
前記積分リミット値算出部１５ｋは、指令電流制限部１５ｉからの指令電流Ｉrefが図１０に示すような指令電流制限値Ｉlmt+，Ｉlmt-と等しくなる飽和状態であると判断され、且つ、時間と共に指令電流制限値Ｉlmt+，Ｉlmt-が減少（例えば、図１０の様な電流制限を行うことにより、ドライバーの操舵による旋回加速度の増加と共に指令電流制限値Ｉlmt+，Ｉlmt-が減少する場合）していく場合、
Ｓｒ＝｜（Ｉref−Ｉｐ）／Ｋｉ｜
（Ｉｐ：比例ＦＢ電流、Ｋｉ：積分ＦＢゲイン）
とする積分リミット値Ｓｒを算出し、求めた積分リミット値Ｓｒで積分値Ｓをリセットする。
【００５４】
次に、作用を説明する。
【００５５】
［アクチュエータ駆動電流算出処理］
図７は実施の形態２のレーンキープコントロールユニット１５で行われるアクチュエータ駆動電流算出処理の流れを示すフローチャートで、以下、各ステップについて説明する。なお、ステップ７０，７１，７２，７４，７５，７６，７７，７８，７９，８０，８１は、図３のステップ３０，３１，３２，３４，３５，３６，３７，３８，３９，４０，４１と同じであるので説明を省略する。
【００５６】
ステップ８２では、ステップ７８において、指令電流Ｉrefが図１０で示す指令電流制限値Ｉlmt+により制限された飽和状態である場合、上記式により積分リミット値Ｓｒ（≧０）を算出し、この求めた積分リミット値Ｓｒで積分値Ｓをリセットする積分リセット処理が行われる。
【００５７】
ステップ８３では、ステップ７９において、指令電流Ｉrefが図１０で示す指令電流制限値Ｉlmt-により制限された飽和状態である場合、上記式により積分リミット値Ｓｒ（≦０）を算出し、この求めた積分リミット値Ｓｒで積分値Ｓをリセットする積分リセット処理が行われる。
【００５８】
［飽和時の積分値リセット作用］
｜（Ｉref−Ｉｐ）／Ｋｉ｜により算出される積分リミット値Ｓｒは、比例ＦＢ電流Ｉｐと積分ＦＢ電流Ｉｉの和が、電流制限後のアシストアクチュエータ７への指令電流Ｉrefに一致するようにして求めた積分値である。
【００５９】
したがって、指令電流Ｉrefの飽和中において、時間と共に電流制限値が減少する場合（例えば、図１０のような電流制限を行うことにより、ドライバーの操舵による旋回加速度の増加と共に電流制限値Ｉlmt+，Ｉlmt-が減少する場合）、電流制限値Ｉlmt+，Ｉlmt-の減少に比例して積分値Ｓも減少し、電流制限値Ｉlmt+，Ｉlmt-の回復後は直ちに指令電流Ｉrefの飽和が解消され、過剰な積分値Ｓが発生しなくなるため、車両の挙動が安定し、蛇行の防止に効果がある。
【００６０】
同様に、指令電流Ｉrefの飽和中において、白線情報を用いて検出または推定された車両の横位置，横速度，ヨーレート，レーンに対するヨー角，操舵角，操舵角速度等が増加することで比例ＦＢ電流Ｉｐが増加する場合、比例ＦＢ電流Ｉｐの増加に比例して積分値Ｓが減少し、比例ＦＢ電流Ｉｐの回復後は直ちに指令電流Ｉrefの飽和が解消され、過剰な積分値Ｓが発生しなくなるため、車両の挙動が安定し、蛇行の防止に効果がある。
【００６１】
次に、効果を説明する。
【００６２】
実施の形態２のレーンキープアシスト制御装置にあっては、指令電流制限部１５ｉからの指令電流Ｉrefが図１０に示すような指令電流制限値Ｉlmt+，Ｉlmt-と等しくなる飽和状態であると判断され、且つ、時間と共に指令電流制限値Ｉlmt+，Ｉlmt-が減少していく場合、｜（Ｉref−Ｉｐ）／Ｋｉ｜の式により積分リミット値Ｓｒを算出し、求めた積分リミット値Ｓｒで積分値Ｓをリセットする積分リミット値算出部１５ｋを設けたため、電流制限値Ｉlmt+，Ｉlmt-や比例ＦＢ電流Ｉｐの回復後は直ちに指令電流Ｉrefの飽和が解消されると共に、積分値Ｓの蓄積による過剰な操舵トルクの発生を抑えることにより、指令電流飽和回復後の車両挙動を安定させ、直進性の向上を図ることができる。
【００６３】
（実施の形態３）
この実施の形態３の制御系には、実施形態１の積分演算停止判断部１５ｊと実施の形態２の積分リミット値算出部１５ｋとを共に備え、且つ、図８に示すように、車両横位置ｙと道路曲率に基づく旋回半径Ｒの相対関係が、車両がレーン中央から離れてゆく関係の時には積分演算停止判断部１５ｊによる積分値Ｓの保持を選択し、また、車両横位置ｙと道路曲率に基づく旋回半径Ｒの相対関係が、車両がレーン中央に寄ってゆく関係の時には積分リミット値算出部１５ｋによる積分値Ｓのリセットを選択し、車両横位置ｙがレーン中央にある時には旋回半径Ｒの方向及び大きさにかかわらず積分クリア（０リセット）を選択するというように、積分値Ｓの蓄積を抑える処理が切り換えられる図外の積分値抑制切換部（積分値抑制切換手段）を設けた例である。
【００６４】
次に、作用を説明する。
【００６５】
積分値抑制切換部で選択される積分値Ｓの保持は、積分ＦＢ電流Ｉｉが過大になる傾向があり、また、積分値抑制切換部で選択される積分値Ｓのリセットは、積分値Ｓの減少により積分ＦＢ電流Ｉｉが不足する傾向がある。
【００６６】
そこで、例えば、右カーブを走行中に車両が道路右側に寄っている場合、車両が直進しても、次第にレーン中央に近づいていくため、積分値Ｓのリセットを行うことにより、安定した車両挙動が確保される。なお、左カーブを走行中に車両が道路左側に寄っている場合も同様である。
【００６７】
また、例えば、右カーブを走行中に車両が道路左側に寄っている場合、車両が直進した場合には、次第にレーン中央から離れてゆくため、積分値Ｓの保持を行うことにより、レーン追従性が確保される。なお、左カーブを走行中に車両が道路右側に寄っている場合も同様である。
【００６８】
このように、車両横位置ｙと旋回半径Ｒ（または道路曲率）の相対関係によって、車両がレーン中央から離れてゆく関係の時には積分値Ｓの保持を選択し、車両がレーン中央に寄ってゆく関係の時には積分値Ｓのリセットを選択することで、指令電流Ｉrefの飽和が解消した後の積分ＦＢ電流Ｉｉを適切な値にすることができる。
【００６９】
次に、効果を説明する。
【００７０】
実施の形態３のレーンキープアシスト制御装置にあっては、車両横位置ｙと旋回半径Ｒの相対関係が、車両がレーン中央から離れてゆく関係の時には積分演算停止判断部１５ｊによる積分値Ｓの保持を選択し、また、車両横位置ｙと旋回半径Ｒの相対関係が、車両がレーン中央に寄ってゆく関係の時には積分リミット値算出部１５ｋによる積分値Ｓのリセットを選択するというように、積分値Ｓの蓄積を抑える処理を切り換える積分値抑制切換部を設けたため、様々な旋回走行状況に対応し、安定した車両挙動とレーン追従性を常に両立させることができる。
【００７１】
（他の実施の形態）
本発明を実施の形態１，２，３により説明してきたが、具体的な構成については、この実施の形態１，２，３に限定されるものではない。
【００７２】
例えば、実施の形態１，２，３では、図１０に示す電流制限マップを用いてドライバーの任意な操舵介入を可能にする出力電流制限を行う例を示したが、指令電流制限値（上限値及び下限値）を一定値により設定したものにも適用することができる。
【図面の簡単な説明】
【図１】実施の形態１のレーンキープアシスト制御装置が適用された自動車用ステアリング系を示す全体システム図である。
【図２】実施の形態１のレーンキープアシスト制御装置における制御系を示すブロック図である。
【図３】実施の形態１におけるレーンキープコントロールユニットで行われるアクチュエータ駆動電流算出処理の流れを示すフローチャートである。
【図４】実施の形態１における積分演算停止判断の説明図である。
【図５】車両横変位が生じた場合、積分停止判断を行わない従来の電流特性と、積分停止判断を行う実施の形態１における電流特性を示す比較特性図である。
【図６】実施の形態２のレーンキープアシスト制御装置における制御系を示すブロック図である。
【図７】実施の形態２におけるレーンキープコントロールユニットで行われるアクチュエータ駆動電流算出処理の流れを示すフローチャートである。
【図８】実施の形態３での積分値抑制切換部で電流飽和時に車両横位置と旋回半径の相対関係に基づく積分保持，積分リセット，積分クリアの選択マップを示す図である。
【図９】従来のレーンキープアシスト制御装置における制御系を示すブロック図である。
【図１０】レーンキープアシスト時の電流制限マップを示す図である。
【図１１】スラローム走行時の車両旋回加速度−操舵トルク特性図である。
【図１２】電流制限値が一定値の場合の操舵介入トルク特性図である。
【図１３】本システムの電流制限時の操舵介入トルク特性図である。
【符号の説明】
１  ステアリングコラム
２  コラムシャフト
３  ステアリングホイール
４，５  左右の車輪
６  油圧パワーステアリング機構
７  アシストアクチュエータ（操舵アクチュエータ）
８  モーター
９  電磁クラッチ
１０  駆動歯車
１１  被駆動歯車
１３  操舵角センサー
１４  エンコーダー
１５  レーンキープコントロールユニット
１６  カメラ＆画像処理装置
【図１】
0003649110.tif 000002
【図２】
0003649110.tif 000003
【図３】
0003649110.tif 000004
【図４】
0003649110.tif 000005
【図５】
0003649110.tif 000006
【図６】
0003649110.tif 000007
【図７】
0003649110.tif 000008
【図８】
0003649110.tif 000009
【図９】
0003649110.tif 000010
【図１０】
0003649110.tif 000011
【図１１】
0003649110.tif 000012
【図１２】
0003649110.tif 000013
【図１３】
0003649110.tif 000014