JP5294055B2 - 走行制御装置 - Google Patents

Description

本発明は、自動操舵制御とパワーアシスト制御とを実行する車両の制御装置に関する。

自動操舵制御とパワーアシスト制御とを実行する制御装置を備えた車両が知られている。

特開２００５−６７３２２号公報には、車両の走行制御装置が記載されている。

走行制御装置は、自車両の走行すべき目標進行路を設定する目標進行路設定手段と、自車位置を演算する自車位置演算手段と、自車進行路を推定する自車進行路推定手段と、自車位置と自車進行路と目標進行路とに応じて自車量の自動操舵制御を実行させる走行制御手段とを備える。走行制御手段は、前方における自車進行路の目標進行路からの距離の時間微分が増加傾向で、且つ、操舵トルクが予め設定した値を超えている場合、自車両の走行制御を中止する。

また、特開２００８−６８６７７号公報には、車両のステアリングアクチュエータを駆動するアクチュエータ駆動電流を算出する自動操舵装置が記載されている。

自動操舵装置は、自動操舵制御電流に第１補正係数を乗算したものと、パワーステアリング制御電流に第２補正係数を乗算したものとを合算することによりアクチュエータ駆動電流を算出する。運転者が入力する操舵トルクの絶対値が第１閾値未満の領域では、第１補正係数を１００％に設定し、第２補正係数を０％に設定する。操舵トルクの絶対値が第１閾値以上第２閾値未満の領域では第１補正係数を１００％から０％にリニアに減少させ、第２補正係数を０％から１００％にリニアに増加させる。操舵トルクの絶対値が第２閾値以上の領域では、第１補正係数を０％に設定し、第２補正係数を１００％に設定する。

特開２００５−６７３２２号公報 特開２００８−６８６７７号公報

上記特開２００５−６７３２２号公報や特開２００８−６８６７７号公報の構成では、自動操舵制御中において、所定のパラメータが閾値以上となった場合に自動操舵制御を中止してパワーステアリング制御に切り替える。このため、自動操舵制御が中止された後に再び自動操舵制御により車両を走行させるためには、その都度、自動操舵制御を開始させるスイッチを運転者が入力する必要があり、運転者の運転操作を煩雑にしてしまうおそれがあった。

本発明は、上述の課題に鑑みてなされたものであり、自動操舵制御中における運転者による操舵入力のフィーリングを向上させることが可能な走行制御装置の提供を目的とする。

上記目的を達成すべく、本発明の走行制御装置は、車両位置検知手段と目標操舵角演算手段と自動操舵電流演算手段と操舵トルク検知手段とアシストトルク演算手段と補助操舵電流演算手段と要求度判定手段と出力割合設定手段と駆動電流出力手段とを備える。

車両位置検知手段は、車両の現在位置を検知する。目標操舵角演算手段は、所定の目標進路と車両位置検知手段が検知した現在位置とに基づいて、車両を目標進路に従って走行させるための操舵角を目標操舵角として算出する。自動操舵電流演算手段は、目標操舵角演算手段が算出した目標操舵角に基づいて自動操舵電流を算出する。操舵トルク検知手段は、運転者によりステアリングホイールに入力された操舵トルクを検知する。アシストトルク演算手段は、操舵トルク検知手段が検知した操舵トルクに基づいてアシストトルクを算出する。補助操舵電流演算手段は、アシストトルク演算手段が算出したアシストトルクに基づいて補助操舵電流を算出する。要求度判定手段は、目標進路からの運転者の離脱要求の度合いを、当該運転者によるステアリングホイールへの操舵入力に基づいて判定する。出力割合設定手段は、要求度判定手段が判定した運転者の離脱要求の度合いの高低に応じて増減する第１の出力割合と、当該第１の出力割合の増減に応じて減増する第２の出力割合とを設定する。駆動電流出力手段は、出力割合設定手段が設定した第１の出力割合を補助操舵電流に乗じて出力補助操舵電流を算出し、出力割合設定手段が設定した第２の出力割合を自動操舵電流に乗じて出力自動操舵電流を算出し、出力自動操舵電流及び出力補助操舵電流を合算した駆動電流を、ステアリングアクチュエータへ出力する。

出力割合設定手段は、運転者の離脱要求の度合いが最も高いと要求度判定手段が判定した場合、第１の出力割合を上限の割合に設定してもよい。また、出力割合設定手段は、第１の出力割合を上限の割合に設定している状態で、運転者の離脱要求の度合いが低下したと要求度判定手段が判定した場合、第１の出力割合を当該上限の割合よりも低い割合に設定してもよい。

自動操舵電流とは、車両を目標進路に沿って走行させるためにステアリングアクチュエータを駆動する電流である。

補助操舵電流とは、運転者のステアリング操作を補助（アシスト）するためにステアリングアクチュエータを駆動する電流である。

運転者が目標進路から離脱する方向へステアリングホイールを操作した場合、車両を目標進路へ戻す方向へステアリングアクチュエータを駆動させる自動操舵電流を自動操舵電流演算手段が算出し、車両を目標進路から離脱させる方向へステアリングアクチュエータを駆動させる補助操舵電流を補助操舵電流演算手段が算出する。従って、自動操舵電流の値と補助操舵電流の値とは、その一方が正の値となり他方が負の値となる。このため、運転者が目標進路から離脱する方向へステアリングホイールを操作する場合、出力自動操舵電流は運転者がステアリングホイールを操作する際の抵抗力を発生させ、出力補助操舵電流はこの抵抗力に対向するアシスト力を発生させることになる。

上記構成では、運転者の離脱要求の度合いが低い場合、補助操舵電流の出力割合である第１の割合が低くなり、自動操舵電流の出力割合である第２の割合が高くなる。

例えば、運転者がステアリングホイールへの操舵入力を行っていない（例えば、操舵トルクが発生していない）場合、要求度判定手段が運転者の離脱要求の度合いが最も低いと判定し、出力割合設定手段が第１の出力割合をゼロパーセントに第２の出力割合を１００パーセントにそれぞれ設定し、駆動電流出力手段がゼロパーセントの補助操舵電流と１００パーセントの自動操舵電流とを合算した駆動電流を（実質的に自動操舵電流演算手段が算出した自動操舵電流をそのまま）出力する。従って、車両が目標進路に沿って走行する。

運転者の離脱要求の度合いが高くなると、第１の割合が増加し、第２の割合が減少する。

例えば、運転者がステアリングホイールへの操舵入力を行わず、１００パーセントの自動操舵電流（駆動電流）によってステアリングアクチュエータが駆動され、車両が目標進路に沿って自動操舵走行している状態で、運転者が目標進路に障害物を発見して、運転者が目標進路から離脱しようとステアリングホイールへの操舵入力を行った場合、出力自動操舵電流が運転者のステアリングホイールへの操舵入力に対する抵抗力として作用する。また、運転者がステアリングホイールへ操舵入力を開始した（例えば、発生していなかった操舵トルクが発生した）ことに基づいて、要求度判定手段が運転者の離脱要求の度合いが高いと判定し、出力割合設定手段が第１の出力割合をゼロパーセントから増加させるとともに第２の出力割合を１００パーセントから減少させる。従って、操舵トルクの発生に応じて、出力自動操舵電流による抵抗力が減少し、ステアリングホイールを操作するために必要な力が低減され、運転者は、障害物を回避するための操舵を容易に行うことができる。また、運転者がステアリングホイールへ強く操舵入力を行った（例えば、短時間に操舵トルクが急増した）ことに基づいて、出力割合設定手段が第１の出力割合を急激に増大させるとともに第２の出力割合を急激に減少させる。従って、操舵トルクの急増に応じて、出力自動操舵電流による抵抗力が急激に減少し、出力補助操舵電流によるアシスト力が急激に増大するため、運転者は、障害物を回避するための操舵を早期かつ容易に行うことができる。

また、運転者の離脱要求の度合いが低下することに応じて、第１の割合が減少し、第２の割合が増加する。

例えば、運転者がステアリングホイールへの操舵入力を弱くした（例えば、操舵トルクが小さくなった）場合、要求度判定手段が運転者の離脱要求の度合いが減少していると判定し、出力割合設定手段が第１の出力割合を減少させて第２の出力割合を増加させる。

また、運転者の離脱要求の度合いが最も高いと判定して第１の出力割合を上限の割合に設定している状態で、運転者の離脱要求の度合いが低下したと判定した場合、第１の出力割合を当該上限の割合よりも低い割合に設定する。すなわち、出力割合設定手段は、第１の出力割合を上限の割合に設定する場合であっても、出力自動操舵電流を解除しない。

例えば、運転者の離脱要求の度合いが最も高いと要求度判定手段が判定した場合、出力割合設定手段が第１の出力割合を１００パーセントに設定して第２の出力割合をゼロパーセントに設定し、駆動電流出力手段が１００パーセントの補助操舵電流とゼロパーセントの自動操舵電流とを合算した駆動電流を出力する。また、例えば、運転者がステアリングホイールへ所定値以上の操舵入力を行っている（例えば、操舵トルクが所定値以上の大きさである）場合に、運転者の離脱要求の度合いが最も高いと要求度判定手段が判定する。第１の出力割合が上限の割合に設定された状態であっても、運転者がステアリングホイールへの操舵入力を止めることにより、車両が自動操舵走行して目標進路へ戻る。従って、運転者が自動操舵制御を開始させるスイッチへの入力など煩雑な操作をすることなく、運転者がステアリングホイールへの操舵入力という通常の運転操作をすることによって、１００パーセントの補助操舵電流（駆動電流）によって車両が走行する状態から、１００パーセントの自動操舵電流（駆動電流）によって車両が自動操舵走行する状態まで、運転者の離脱要求の度合いに応じて車両が走行するため、運転者の操舵フィーリングを向上させることができる。

また、要求度判定手段は、目標操舵角加速度演算手段と操舵角加速度検知手段と角加速度差分演算手段とを有してもよい。

目標操舵角加速度演算手段は、目標操舵角演算手段が算出した目標操舵角に基づいて目標操舵角加速度を算出する。操舵角加速度検知手段は、ステアリングホイールに入力する操舵角加速度を検知する。角加速度差分演算手段は、目標操舵角加速度演算手段が算出した目標操舵角加速度と操舵角加速度検知手段が検知した操舵角加速度との差分を角加速度差分として算出する。要求度判定手段は、角加速度差分演算手段が算出した角加速度差分に基づいて、運転者の離脱要求の度合いを判定する。

上記構成では、運転者及び出力自動操舵電流によってステアリングホイールへ入力される操舵角加速度と、目標操舵角に基づいた目標操舵角加速度との差分である角加速度差分に基づいて、運転者の離脱要求の度合いを判定する。すなわち、ステアリングホイールに入力する操舵角加速度のうち、出力自動操舵電流が作用する操舵角加速度を、目標操舵角加速度により除いた値に基づいて運転者の離脱要求の度合いを判定する。このため、例えば、ステアリングホイールに入力する操舵角加速度のみに基づいて運転者の離脱要求の度合いを判定する場合と比べて、運転者が実際にステアリングホイールへ入力した操舵角加速度に近い値に基づいて、運転者の離脱要求の度合いを判定することができる。また、例えば、ステアリングホイールに入力する操舵角速度と目標操舵角に基づいた目標操舵角速度との差分に基づいて、運転者の離脱要求の度合いを判定する場合と比べて、判定をする単位時間前の値との相対的な変化量を求めることができるため、運転者がステアリングホイールへ短時間に速く操舵入力をした場合に、角加速度差分が増大し、急激に高くなる運転者の離脱要求の度合いを要求度判定手段が判定することができる。従って、例えば、車両が目標進路に沿って自動操舵走行している状態において、危険回避などの目的で緊急に目標進路から離脱しようとする運転者の離脱要求の度合いを、補助操舵電流の出力割合に早期にかつ的確に反映させることができる。

また、要求度判定手段は、偏差演算手段と偏差微分演算手段と操舵トルク微分演算手段とをさらに有してもよい。

偏差演算手段は、目標進路に対する車両位置検知手段が検知した現在位置の偏差を算出する。偏差微分演算手段は、偏差演算手段が算出した偏差を時間微分することにより偏差微分を算出する。操舵トルク微分演算手段は、操舵トルク検知手段が検知した操舵トルクを時間微分することにより操舵トルク微分を算出する。要求度判定手段は、偏差微分演算手段が算出した偏差微分と、操舵トルク微分演算手段が算出した操舵トルク微分と、角加速度差分演算手段が算出した角加速度差分とに基づいて、運転者の離脱要求の度合いを判定する。

上記構成では、操舵トルクの時間微分である操舵トルク微分に基づいて運転者の離脱要求の度合いを判定する。このため、例えば、操舵トルクに基づいて運転者の離脱要求の度合いを判定する場合と比べて、判定をする単位時間前の値との相対的な変化量を求めることができるため、運転者が短時間に強く操舵入力をした場合に、操舵トルク微分が増大し、急激に高くなる運転者の離脱要求の度合いを要求度判定手段が判定することができる。従って、例えば、車両が目標進路に沿って自動操舵走行している状態において、危険回避などの目的で緊急に目標進路から離脱しようとする運転者の離脱要求の度合いを、補助操舵電流の出力割合に早期にかつ的確に反映させることができる。

また、目標進路に対する現在位置の偏差の時間微分である偏差微分に基づいて運転者の離脱要求の度合いを判定する。つまり、運転者によるステアリングホイールへの操舵入力に加えて、車両の状態によっても運転者の離脱要求の度合いを判定する。偏差微分は、短時間に大きく目標進路から現在位置が外れた場合に増大する値であり、例えば、角加速度差分や操舵トルク微分に基づいて運転者の離脱要求の度合いが高いと判定したことに応じて第１の割合を増大して車両が走行した結果として増大する値である。また、偏差微分に基づいて、運転者の離脱要求の度合いを判定することにより、例えば、目標進路に対する現在位置の偏差に基づいて運転者の離脱要求の度合いを判定する場合と比べて、判定を実行する単位時間前の値との相対的な変化量を求めることができる。このため、例えば、車両が目標進路に沿って自動操舵走行している状態において、危険回避などの目的で緊急に目標進路から離脱しようとする運転者の離脱要求の度合いを、補助操舵電流の出力割合に早期にかつ的確に反映させることができる。

また、偏差微分と操舵トルク微分と角加速度差分とに基づいて運転者の離脱要求の度合いを判定するため、それぞれ単一の値に基づいて判定する場合に比べて、運転者の離脱要求の度合いの判定の正確性を向上させることができる。

また、要求度判定手段は、重み付け設定手段と要求度演算手段とをさらに有してもよい。

重み付け設定手段は、偏差微分演算手段が算出した偏差微分と、操舵トルク微分演算手段が算出した操舵トルク微分と、角加速度差分演算手段が算出した角加速度差分とにそれぞれ重み付けを設定する。要求度演算手段は、重み付け手段がそれぞれに重み付けを設定した偏差微分と操舵トルク微分と角加速度差分とを合算して運転者の離脱要求の度合いを算出する。重み付け設定手段は、角加速度差分には偏差微分よりも大きい重み付けを設定する。
上記構成では、例えば、車両が目標進路に沿って自動操舵走行している状態において、危険回避などの目的で運転者がステアリングホイールへ操舵入力した場合に、角加速度差分は、偏差微分よりも早期に値が変化する。また、例えば、角加速度差分は、偏差微分よりも車両に対する風などの外乱で変化し難い。このため、角加速度差分には偏差微分よりも大きい重み付けを設定することにより、運転者による離脱要求の度合いの判定の正確性を向上させることができ、運転者による操舵入力のフィーリングを向上させることができる。

本発明によれば、自動操舵制御中における運転者による操舵入力のフィーリングを向上させることができる。

以下、本発明の実施形態を図１〜図６に基づいて説明する。

図１は本発明の実施形態に係る走行制御装置を備えた車両の模式図であり、図２は図１の走行制御装置のブロック構成図であり、図３は車速と操舵力補助係数との関係を示すマップの例であり、図４は自動操舵電流演算処理のフローチャートであり、図５は補助操舵電流演算処理のフローチャートであり、図６は出力割合設定処理のフローチャートである。

図１に示すように、本実施形態に係る車両１は、ステアリングホイール２と、センサ部３と、コントローラ４と、駆動電流出力部５と、ステアリングアクチュエータ６とを備える。センサ部３とコントローラ４と駆動電流出力部５とは、走行制御装置を構成する。

ステアリングホイール２は、車両１の運転室内に設けられ、運転者が操舵入力を行う。

図２に示すように、センサ部３は、カメラ３１と、トルクセンサ３２と、ヨーレートセンサ３３と、ハンドル角度センサ３４と、車速センサ３５と、自動操舵スイッチ３６とを備える。

カメラ３１は、ＣＣＤカメラであり、車両１の進行方向の路面を撮像し、撮像した撮像信号をコントローラ４へ出力する。

本実施形態では、車両１の進行路の両側に形成された白線の間の目標進路を自動操舵により走行するため、カメラ３１は、進行方向の路面に形成された白線を撮像する。

トルクセンサ３２は、操舵トルク検知手段を構成し、運転者によりステアリングホイール２に入力された操舵トルクＴｈを検出し、検出した操舵トルクＴｈをコントローラ４へ出力する。

ヨーレートセンサ３３は、旋回走行時に車両１に発生するヨーレートφ’（回転角速度：rad/s）を（左回転を正方向として）検出し、検出したヨーレートφ’をコントローラ４へ出力する。

ハンドル角度センサ３４は、ステアリングホイール２に入力する操舵角θ（rad）を検出し、検出した操舵角θをコントローラ４へ出力する。

車速センサ３５は、車両１の車速Ｖ（m/s）を検出し、検出した車速Ｖをコントローラ４へ出力する。

自動操舵スイッチ３６は、車両１の運転室内に設けられ、オン信号とオフ信号とをコントローラ４へ出力する。自動操舵スイッチ３６は、電源投入による初期設定時にはオフが設定され、運転者によってオンに設定される。自動操舵スイッチ３６がオフである場合、補助操舵電流i_assが常時、１００パーセントの出力割合でステアリングアクチュエータ６へ出力する。また、自動操舵スイッチ３６が運転者によってオンに設定された場合、自動操舵電流i_autoと補助操舵電流i_assとが算出され、それぞれの出力割合が設定される。以下、本実施形態では、自動操舵スイッチ３６がオンに設定されている状態を説明する。

図２に示すように、コントローラ４は、目標進路検知部４１と車両位置検知部４２と目標操舵角演算部４３と自動操舵電流演算部４４とアシストトルク演算部４５と補助操舵電流演算部４６とヨーレート演算部４７と要求度判定部７と出力割合設定部８とを有するＣＰＵ（Central Processing Unit）と、ＲＯＭ（Read Only Memory）と、ＲＡＭ（Random Access Memory）とを備える。コントローラ４には、センサ部３から各種信号が逐次入力する。

目標進路検知部４１は、路面の目標進路を検知する。目標進路とは、車両１が自動操舵によって走行する走行進路のことであり、路面には、目標進路の両側にそれぞれ沿って白線が付されている。目標進路検知部４１は、カメラ３１が撮像した撮像信号を解析して路面の白線を検出し、検出した白線に基づいて、進行方向の白線と白線との間の中央の位置（進路）を目標進路として検知する。

車両位置検知部４２は、車両位置検知手段を構成し、車両１の現在位置を検知する。車両位置検知部４２は、目標進路検知部４１が検知した目標進路に対する相対的な車両１の現在の位置を現在位置として判定する。

なお、本実施形態では、目標進路と現在位置とを検知するために、カメラ３１が撮像した撮像信号を使用するが、目標進路と現在位置とを検知するためには、カメラ３１の撮像信号に限らず、位置を特定できる他の情報を使用してもよい。例えば、ＧＰＳによって検知された情報を受信して、受信した情報に基づいて目標進路と現在位置とを検知してもよい。また、路面に目標進路に沿って予め情報発生装置を設け、当該情報発生装置から目標進路の位置情報を取得して目標進路と現在位置とを検知してもよい。

目標操舵角演算部４３は、目標操舵角演算手段を構成し、目標進路検知部４１が検知した目標進路と車両位置検知部４２が検知した現在位置とに基づいて、車両１を目標進路に従って走行させるための操舵角を目標操舵角δとして算出する。具体的には、目標操舵角演算部４３は、目標進路のうち車両１前方の所定距離の位置と車両１の中心を結ぶ第１のラインを算出するとともに、車両１の車幅方向中心から車両１前方へ延ばした第２のラインを算出し、第１のラインと第２のラインとの水平面における角度を算出し、算出した角度と車速センサ３５が検出する速度Ｖに基づいて、目標操舵角δを算出する。

ヨーレート演算部４７は、ヨーレートセンサ３３から入力したヨーレートφ’を所定時間毎に積分してヨーレート積分φを算出する。また、ヨーレート演算部４７は、ヨーレートセンサ３３から入力したヨーレートφ’を所定時間毎に微分してヨーレート微分φ’’を算出する。ヨーレート演算部４７は、ヨーレート積分φとヨーレート微分φ’’とを自動操舵電流演算部４４へ出力する。

自動操舵電流演算部４４は、自動操舵電流演算手段を構成し、自動操舵電流i_autoを算出する。具体的には、目標操舵角演算部４３が算出した目標操舵角δと、車速センサ３５が検出した車速Ｖと、ヨーレートセンサ３３が検出したヨーレートφ’と、ヨーレート演算部４７が算出したヨーレート積分φ及びヨーレート微分φ’’と、後述する偏差演算部７４が算出した道路偏差ｙと、後述する偏差微分演算部７５が算出した偏差微分ｙ’及び偏差二回微分ｙ’’とに基づいて自動操舵電流i_autoを算出する。自動操舵電流演算部４４は、目標操舵角δにステアリングホイール２を駆動するために、ステアリングアクチュエータ６に対して、左右どちらの方向にどれくらいの電流の量が必要であるか算出する。自動操舵電流i_autoとは、車両１を目標進路に沿って走行させるためにステアリングアクチュエータ６を駆動する電流である。自動操舵電流演算部４４が算出した自動操舵電流i_autoが駆動電流出力部５に入力する。

アシストトルク演算部４５は、アシストトルク演算手段を構成し、トルクセンサ３２が検知した操舵トルクＴｈに基づいてアシストトルクＴａを算出する。具体的には、アシストトルク演算部４５は、ＲＯＭに記憶されたマップ（図３に示す）に基づいて、車速センサ３５から入力する車速Ｖに対応した操舵力補助係数ｋを求める。ここで、アシストトルクＴａと操舵トルクＴｈと操舵力補助係数ｋとにＴａ＝ｋ×Ｔｈの関係があるため、アシストトルク演算部４５は、この数式に基づいて、アシストトルクＴａを算出する。

補助操舵電流演算部４６は、補助操舵電流演算手段を構成し、アシストトルク演算部４５が算出したアシストトルクＴａに基づいて補助操舵電流i_assを算出する。具体的には、補助操舵電流演算部４６は、ステアリングホイール２を駆動してアシストトルクＴａを発生させるために、左右どちらの方向にどれくらいの電流の量が必要であるか算出する。補助操舵電流i_assとは、運転者のステアリング操作を補助（アシスト）するためにステアリングアクチュエータ６を駆動する電流である。補助操舵電流演算部４６が算出した補助操舵電流i_assが、駆動電流出力部５に入力する。

要求度判定部７は、要求度判定手段を構成し、目標進路からの運転者の離脱要求の度合いを、運転者によるステアリングホイール２への操舵入力に基づいて判定する。

要求度判定部７は、目標操舵角加速度演算部７１と、操舵角加速度演算部７２と、角加速度差分演算部７３と、偏差演算部７４と、偏差微分演算部７５と、操舵トルク微分演算部７６と、重み付け設定部７７と、要求度演算部７８と、離脱要求判定部７９とを有する。

目標操舵角加速度演算部７１は、目標操舵角加速度演算手段を構成し、目標操舵角演算部４３が算出した目標操舵角δに基づいて目標操舵角加速度δ’’を算出する。具体的には、目標操舵角加速度演算部７１は、所定時間毎に、目標操舵角δを時間微分して目標操舵角速度δ’を算出し、また、目標操舵角速度δ’を時間微分して目標操舵角加速度δ’’を算出する。

操舵角加速度演算部７２は、ハンドル角度センサ３４とともに操舵角加速度検知手段を構成し、ハンドル角度センサ３４から入力した操舵角θに基づいてステアリングホイール２に入力する操舵角加速度θ’’を算出する。具体的には、操舵角加速度演算部７２は、所定時間毎に、操舵角θを時間微分して操舵角速度θ’を算出するとともに、操舵角速度θ’を時間微分して操舵角加速度θ’’を算出する。

角加速度差分演算部７３は、角加速度差分演算手段を構成し、目標操舵角加速度演算部７１が算出した目標操舵角加速度δ’’と、操舵角加速度演算部７２が算出した操舵角加速度θ’’との差分を角加速度差分として算出する。

偏差演算部７４は、偏差演算手段を構成し、目標進路検知部４１が検知した目標進路に対する、車両位置検知部４２が検知した現在位置の道路偏差ｙを算出する。道路偏差ｙは、目標進路のうち現在位置に近い位置とから外れている割合であり、車両１の車幅方向両側方の路面の白線と車両１の現在位置とに基づいて算出する。具体的には、目標進路と現在位置とが重なった場合にゼロパーセントの道路偏差ｙであると算出し、進行方向左側の白線以上左方向へずれた場合に左側１００パーセントの道路偏差ｙであると算出し、進行方向右側の白線以上右方向へずれた場合に右側１００パーセントの道路偏差ｙである算出する。なお、本実施形態では、道路偏差ｙを外れている割合で算出するが、目標進路に対する距離に基づいて道路偏差ｙを算出してもよい。

偏差微分演算部７５は、偏差微分演算手段を構成し、偏差演算部７４が算出した道路偏差ｙを所定時間毎に時間微分することにより偏差微分ｙ’を算出する。また、偏差微分演算部は、偏差微分ｙ’を所定時間毎に時間微分することにより偏差二回微分ｙ’’を算出する。

操舵トルク微分演算部７６は、操舵トルク微分演算手段を構成し、トルクセンサ３２が検知した操舵トルクＴｈを、所定時間毎に時間微分することにより操舵トルク微分Ｔｈ’を算出する。

重み付け設定部７７は、重み付け設定手段を構成し、角加速度差分演算部７３が算出した角加速度差分と、偏差微分演算部７５が算出した偏差微分ｙ’と、操舵トルク微分演算部７６が算出した操舵トルク微分Ｔｈ’とにそれぞれ重み付けを設定する。具体的には、それぞれに対して重み付けの値を乗算する。重み付けの値は予めＲＯＭに記憶されている。

ＲＯＭに記憶されている重み付けの値は、偏差微分ｙ’に設定するものよりも、角速度差分に設定するものが大きく、重み付け設定部７７は、角加速度差分には偏差微分ｙ’よりも大きい重み付けを設定する。具体的には、偏差微分ｙ’に設定する重み付けが操舵トルク微分Ｔｈ’に設定する重み付けよりも小さく設定され、角加速度差分に設定する重み付けが操舵トルク微分Ｔｈ’に設定する重み付けよりも大きく設定する。

なお、本実施形態では、重み付け設定部７７が偏差微分ｙ’と操舵トルク微分Ｔｈ’と角加速度差分とに重み付けを設定するが、重み付けを設定しなくてもよい。また、重み付け設定部７７が設定する重み付けの値は、定数に限らず、車両１の状態に応じて変化させてもよい。

要求度演算部７８は、要求度演算手段を構成し、重み付け設定部７７がそれぞれに重み付けを設定した偏差微分ｙ’と操舵トルク微分Ｔｈ’と角加速度差分とを合算して運転者の離脱要求の度合いを算出する。

これらにより、重み付け設定部７７と要求度演算部７８とは、具体的には、式（１）において、ｈ_１に偏差微分ｙ’を代入し、ｈ_２に操舵トルク微分Ｔｈ’を代入し、ｈ_３に角加速度微分を代入し、ｅ_１に偏差微分ｙ’の重み付けを代入し、ｅ_２に操舵トルク微分Ｔｈ’の重み付けを代入し、ｅ_３に角加速度微分の重み付けを代入することによって、運転者の離脱要求の度合いＥを算出する。

なお、ｅ_１とｅ_２とｅ_３とは、ｅ_１＜ｅ_２＜ｅ_３の関係を有する。

離脱要求判定部７９は、要求度演算部７８が算出した値に基づいて、目標進路からの運転者の離脱要求の度合いを判定する。離脱要求判定部７９は、運転者の離脱要求の度合いを、最も低い度合いから最も高い度合いまで、複数段階で判定する。本実施形態では、要求度演算部７８が算出する値と、運転者の離脱要求の度合いとの関係が、予めＲＯＭに記憶されている。なお、離脱要求判定部７９が判定する運転者の離脱要求の度合いは、これに限らず、要求度演算部７８が算出した値に基づいた段階的な度合いや、ＲＯＭに記憶されたテーブルに基づいた線形な度合いや、ファジィ理論に基づいた度合いなど、様々な方法で判定することができる。また、本実施形態では、運転者によるステアリングホイール２への操舵入力である操舵トルク微分Ｔｈ’と角加速度差分とを使用するとともに、車両１の状態である偏差微分を使用することによって、運転者によるステアリングホイール２への操舵入力と、車両１の状態とに基づいて運転者の離脱要求の度合いを判定する。なお、本実施形態では、離脱要求判定部７９は、偏差微分ｙ’と操舵トルク微分Ｔｈ’と角加速度差分とに基づいて、目標進路からの運転者の離脱要求の度合いを判定するが、これに限らず、例えば、角加速度差分のみに基づいて、簡易的に運転者の離脱要求の度合いを判定してもよい。

出力割合設定部８は、出力割合設定手段を構成し、離脱要求判定部７９が判定した運転者の離脱要求の度合いの高低に応じて増減する第１の出力割合と、当該第１の出力割合の増減に応じて減増する第２の出力割合とを設定する。

本実施形態では、離脱要求判定部７９が判定した運転者の離脱要求の度合いに対する第１の出力割合の関係がＲＯＭに記憶されており、出力割合設定部８は、ＲＯＭに記憶されている運転者の離脱要求の度合いと第１の出力割合との関係に基づいて、第１の割合を設定する。第１の割合は、ゼロから１までの値（ゼロパーセントから１００パーセントの値）である。

これらにより、運転者の離脱要求の度合いを要求度演算部７８が算出し、当該運転者の離脱要求の度合いを離脱要求判定部７９が判定し、離脱要求判定部７９の判定に基づいて、出力割合設定部８が第１の出力割合を設定する。具体的には、ＲＯＭに記憶されている運転者の離脱要求の度合いと第１の出力割合との関係は、複数段階で記憶される。要求度演算部７８が算出した運転者の離脱要求の度合いが第１の閾値以上の場合、離脱要求判定部７９が運転者の離脱要求が最も高いと判定し、出力割合設定部８が第１の出力割合を上限の割合に設定する。例えば、偏差微分ｙ’の大きさにかかわらず、角加速度差分が大きく、操舵トルク微分Ｔｈ’が大きい場合に運転者の離脱要求の度合いが第１の閾値以上となる。また、要求度演算部７８が算出した運転者の離脱要求の度合いが高い場合、離脱要求判定部７９が運転者の離脱要求が高いと判定し、出力割合設定部８が第１の出力割合を高く設定する。また、要求度演算部７８が算出した運転者の離脱要求の度合いが中程度の場合、離脱要求判定部７９が運転者の離脱要求が中程度であると判定し、出力割合設定部８が第１の出力割合を５０パーセントに設定する。また、要求度演算部７８が算出した運転者の離脱要求の度合いが低い場合、離脱要求判定部７９が運転者の離脱要求が低いと判定し、出力割合設定部８が第１の出力割合を低く設定する。また、要求度演算部７８が算出した運転者の離脱要求の度合いが最も低い（要求度演算部７８が算出した算出値が第２の閾値以下である）場合、離脱要求判定部７９が運転者の離脱要求が最も低いと判定し、出力割合設定部８が第１の出力割合をゼロパーセントに設定する。例えば、偏差微分ｙ’が所定の値以下であり、角加速度差分がゼロであり、操舵トルク微分Ｔｈ’がゼロである場合に運転者の離脱要求の度合いが第２の閾値以下となる。

また、出力割合設定部８は、第２の割合を、１マイナス第１の割合によって、ゼロから１までの割合（ゼロパーセントから１００パーセントの値）に設定する。

また、出力割合設定部８は、第１の出力割合を上限の割合に設定している状態で、運転者の離脱要求の度合いが低下したと離脱要求判定部７９が判定した場合、第１の出力割合を当該上限の割合よりも低い割合に設定する。すなわち、出力割合設定部８は、運転者の離脱要求の度合いが最も高いと離脱要求判定部７９が判定した場合、単に、最も高い運転者の離脱要求に応じて第１の出力割合を上限の割合に設定するだけであり、その他、特別な状態への切り換え（例えば、その後に第１の出力割合を上限の割合に設定し続けること）はしない。

なお、本実施形態では、出力割合設定部８は、第１の出力割合と第２の出力割合とを、ゼロパーセントから１００パーセントの値に設定するが、これに限らず、第１の出力割合と第２の出力割合とを、例えば、ゼロパーセントより大きく１００パーセント未満の値に設定してゼロパーセントと１００パーセントの値にならない構成であってもよい。また、本実施形態では、第１の出力割合と第２の出力割合とを足すと１００パーセントになるが、これに限らず、１００パーセント以外になってもよい。

駆動電流出力部５には、自動操舵電流演算部４４が算出した自動操舵電流i_autoと、補助操舵電流演算部４６が算出した補助操舵電流i_assとがそれぞれ別々に入力する。駆動電流出力部５は、入力する補助操舵電流i_assに出力割合設定部８が設定した第１の出力割合を乗じた出力補助操舵電流と、入力する自動操舵電流i_autoに出力割合設定部８が設定した第２の出力割合を乗じた出力自動操舵電流とを合算した駆動電流i_acを、ステアリングアクチュエータ６へ出力する。なお、本実施形態では、駆動電流出力部５に自動操舵電流i_autoと補助操舵電流i_assとが入力するが、これに限らず、自動操舵電流演算部４４が算出した計算値と補助操舵電流演算部４６が算出した計算値とに基づいて駆動電流i_acの計算値を算出し、算出した駆動電流i_acの計算値に基づいた電流をステアリングアクチュエータ６へ出力してもよい。

ステアリングアクチュエータ６は、駆動電流出力部５から入力した駆動電流i_acによって駆動する。また、ステアリングアクチュエータ６が駆動すると、ステアリングホイール２が連動する。

次に、本実施形態の走行制御装置による走行制御処理について説明する。

走行制御処理では、自動操舵電流演算処理と、補助操舵電流演算処理と、出力割合設定処理とを実行する。

まず、自動操舵電流i_autoを算出する自動操舵電流演算処理について、図４に示すフローチャートに基づいて説明する。

以下の説明において使用する記号の定義は以下の通りである。
Ｉ：車両１の慣性モーメント（kg・m²）
Ｍ：車両１の質量（kg）
Ｋ_ｆ：前輪コーナリングパワー（N/rad）
Ｋ_ｒ：後輪コーナリングパワー（N/rad）
ｌ_ｆ：車両重心点から前輪軸までの距離（m）
ｌ_ｒ：車両重心点から後輪軸までの距離（m）
まず、ステップＳ１１では、コントローラ４が必要なパラメータを読み込む。

コントローラ４は、カメラ３１、トルクセンサ３２、ヨーレートセンサ３３、車速センサ３５などから各種信号を読み込む。また、読み込んだパラメータに基づいて、時間微分や積分などの必要な演算を行う。

次に、ステップＳ１２では、目標進路検知部４１が目標進路を検知する。

次に、ステップＳ１３では、車両位置検知部４２が現在位置を検知する。

次に、ステップＳ１４では、目標操舵角演算部４３が目標操舵角δを算出する。

ここで、操舵系の状態方程式として、式（２）が導出されている。

また、車線追従規則として、式（３）の評価関数が得られている。

式（３）の評価関数Ｊを最小化するレギュレータへの最適な目標操舵角δ入力は、式４
で表わされる。

Ｋはゲインを示す定数である。

次に、ステップＳ１５では、自動操舵電流演算部４４が、自動操舵電流i_autoを算出する。

ここで、目標操舵角δには、式（５）に示すように、ステアリングアクチュエータ６への自動操舵電流i_aoutoと２次遅れ系の関係がある。

自動操舵電流演算部４４は、式（５）に基づいて、自動操舵電流i_autoを算出する。

次にステップＳ１６では、自動操舵電流演算部４４が、自動操舵電流i_autoを駆動電流出力部５へ出力し、本処理を終了する。

次に、補助操舵電流ｉ_assを算出する補助操舵電流演算処理について、図５に示すフローチャートに基づいて説明する。

先ず、ステップＳ２１では、アシストトルク演算部４５が、ＲＯＭに記憶されたマップ（図３に示す）に基づいて車速センサ３５から入力する車速Ｖに対応した操舵力補助係数ｋを求める。

次に、ステップＳ２２では、アシストトルク演算部４５が、トルクセンサ３２から入力する操舵トルクＴｈを取得する。

次に、ステップＳ２３では、アシストトルク演算部４５が、アシストトルクＴａを算出する。アシストトルクＴａと操舵トルクＴｈと操舵力補助係数ｋとには、Ｔａ＝ｋ×Ｔｈの関係があるため、かかる数式に基づいて、アシストトルクＴａを算出する。

なお、路面から操舵系への反力によるトルクをＴとすると、操舵トルクＴｈとアシストトルクＴａとの関係から、Ｔ＝Ｔｈ+Ｔａ＝（１+ｋ）Ｔｈの関係となっている。

次に、ステップＳ２４では、補助操舵電流演算部４６が、補助操舵電流ｉ_assを算出する。ここで、補助トルクＴａは、補助操舵電流i_assに対して、式（６）に示す１次遅れの関数によって表される。

なお、Ｋ_Ｔはゲインであり、Ｔ_Ｓは応答時間である。

補助操舵電流演算部４６は、数式６に基づいて、補助操舵電流i_assを算出する。

次に、ステップＳ２５では、算出した補助操舵電流i_assを、駆動電流出力部５へ出力して本処理を終了する。

次に、第１の出力割合と第２の出力割合と設定する出力割合設定処理について、図６に示すフローチャートに基づいて説明する。

まず、ステップＳ３１では、目標操舵角加速度演算部７１が、目標操舵角加速度δ’’を算出する。

次に、ステップＳ３２では、操舵角加速度演算部７２が、操舵角加速度θ’’を算出する。

次に、ステップＳ３３では、角加速度差分演算部７３が、ステップＳ３１で算出した目標操舵角加速度δ’’と、ステップＳ３２で算出した操舵角加速度θ’’との差分である角加速度差分を算出する。

次に、ステップＳ３４では、操舵トルク微分演算部７６が、操舵トルク微分Ｔｈ’を算出する。

次に、ステップＳ３５では、偏差演算部７４が、道路偏差ｙを算出する。

次に、ステップＳ３６では、偏差微分演算部７５が、偏差微分ｙ’を算出する。

次に、ステップＳ３７では、重み付け設定部７７が、ステップＳ３３で算出した角加速度差分と、ステップＳ３４で算出した操舵トルク微分Ｔｈ’と、ステップＳ３６で算出した偏差微分ｙ’とにそれぞれ、ＲＯＭに記憶されている重み付けを設定する。

次に、ステップＳ３８では、要求度演算部７８が、ステップＳ３７で重み付けが設定された角加速度差分と操舵トルク微分Ｔｈ’と偏差微分ｙ’とを合算して、目標進路に対する運転者の離脱要求の度合いを算出する。

次に、ステップＳ３９では、離脱要求判定部７９が、ステップＳ３８で要求度演算部７８が算出した値に基づいて、運転者の離脱要求の度合いを判定する。

次に、ステップＳ４０では、出力割合設定部８が、ステップＳ３９で離脱要求判定部７９が判定した運転者の離脱要求の度合いに応じて、第１の割合を求める。これにより、第１の出力割合が、最小の割合であるゼロパーセントから最大の割合である１００パーセントまでの変化範囲で設定される。

次に、ステップＳ４１では、出力割合設定部８が、１マイナス第１の割合により、第２の割合を求める。

次に、ステップＳ４２では、駆動電流出力部５が、駆動電流i_acを、ステアリングアクチュエータ６へ出力する。駆動電流出力部５は、ステップＳ４０で求めた第１の出力割合を補助操舵電流i_assに乗じて出力補助操舵電流を算出し、ステップＳ４１で求めた第２の出力割合を自動操舵電流i_autoに乗じて出力自動操舵電流を算出し、出力自動操舵電流及び出力補助操舵電流を合算した駆動電流i_acを、ステアリングアクチュエータ６へ出力する。

本実施形態では、運転者が目標進路から離脱する方向へステアリングホイール２を操作した場合、車両１を目標進路へ戻す方向へステアリングアクチュエータ６を駆動させる自動操舵電流i_autoを自動操舵電流演算部４４が算出し、車両１を目標進路から離脱させる方向へステアリングアクチュエータ６を駆動させる補助操舵電流i_assを補助操舵電流演算部４６が算出する。従って、自動操舵電流i_autoの値と補助操舵電流i_assの値とは、その一方が正の値となり他方が負の値となる。このため、運転者が目標進路から離脱する方向へステアリングホイール２を操作する場合、出力自動操舵電流は運転者がステアリングホイール２を操作する際の抵抗力を発生させ、出力補助操舵電流はこの抵抗力に対向するアシスト力を発生させることになる。

また、運転者が目標進路から離脱する方向へステアリングホイール２を操作した状態において、出力自動操舵電流の絶対値が出力補助操舵電流の絶対値よりも大きい場合、ステアリングアクチュエータ６が車両１を目標進路へ戻す方向へ駆動し、出力自動操舵電流の絶対値が出力補助操舵電流の絶対値よりも小さい場合、ステアリングアクチュエータ６が車両１を目標進路から離脱する方向へ駆動する。

運転者の離脱要求の度合いが低い場合、補助操舵電流i_assの出力割合である第１の割合が低くなり、自動操舵電流i_autoの出力割合である第２の割合が高くなる。

運転者がステアリングホイール２への操舵入力を行っていない場合（偏差微分が所定の値以下であり、角加速度差分がゼロであり、操舵トルク微分Ｔｈ’がゼロである場合）、要求度演算部７８が算出した運転者の離脱要求の度合いが第２の閾値以下であり、離脱要求判定部７９が運転者の離脱要求の度合いが最も低いと判定し、出力割合設定部８が第１の出力割合をゼロパーセントに第２の出力割合を１００パーセントにそれぞれ設定し、駆動電流出力部５がゼロパーセントの補助操舵電流i_assと１００パーセントの自動操舵電流i_autoとを合算した駆動電流i_acを（実質的に自動操舵電流演算部４４が算出した自動操舵電流i_autoをそのまま）ステアリングアクチュエータ６へ出力する。従って、車両１が目標進路に沿って自動操舵走行する。

運転者の離脱要求の度合いが高くなると、第１の割合が増加し、第２の割合が減少する。

運転者がステアリングホイール２への操舵入力を行わず、１００パーセントの自動操舵電流i_auto（駆動電流i_ac）によって車両１が目標進路に沿って自動操舵走行している状態で、運転者が目標進路に障害物を発見して、運転者が目標進路から離脱しようとステアリングホイール２への操舵入力を行った場合、出力自動操舵電流が運転者のステアリングホイール２への操舵入力に対する抵抗力として作用する。また、運転者がステアリングホイール２へ操舵入力を開始した（例えば、角加速度差分がゼロより大きくなり、操舵トルク微分Ｔｈ’がゼロより大きくなった）ことに基づいて、離脱要求判定部７９が運転者の離脱要求の度合いが高いと判定し、出力割合設定部８が第１の出力割合をゼロパーセントから増加させるとともに第２の出力割合を１００パーセントから減少させる。従って、角加速度差分や操舵トルク微分Ｔｈ’の発生に応じて、出力自動操舵電流による抵抗力が減少し、ステアリングホイール２を操作するために必要な力が低減され、運転者は、障害物を回避するための操舵を容易に行うことができる。また、運転者がステアリングホイール２へ強く操舵入力を行った（例えば、短時間に角加速度差分と操舵トルク微分Ｔｈ’とが急増した）ことに基づいて、出力割合設定部８が第１の出力割合を急激に増大させるとともに第２の出力割合を急激に減少させる。従って、操舵トルクの急増に応じて、出力自動操舵電流による抵抗力が急激に減少し、出力補助操舵電流によるアシスト力が急激に増大するため、運転者は、障害物を回避するための操舵を早期にかつ容易に行うことができる。

また、運転者の離脱要求の度合いが低下することに応じて、第１の割合が減少し、第２の割合が増加する。

運転者がステアリングホイール２への操舵入力を弱くした（角加速度差分が小さくなり、操舵トルク微分Ｔｈ’が小さくなった）場合、離脱要求判定部７９が運転者の離脱要求の度合いが減少していると判定し、出力割合設定部８が第１の出力割合を減少させて第２の出力割合を増加させる。

また、運転者の離脱要求の度合いが最も高いと判定して第１の出力割合を上限の割合に設定している状態で、運転者の離脱要求の度合いが低下したと判定した場合、第１の出力割合を当該上限の割合よりも低い割合に設定する。すなわち、出力割合設定部８は、第１の出力割合を上限の割合に設定する場合であっても、出力自動操舵電流を解除しない。

運転者の離脱要求の度合いが最も高いと離脱要求判定部７９が判定した場合、出力割合設定部８が第１の出力割合を１００パーセントに設定して第２の出力割合をゼロパーセントに設定し、駆動電流出力部５が１００パーセントの補助操舵電流i_assとゼロパーセントの自動操舵電流i_autoとを合算した駆動電流i_acを出力する。また、運転者がステアリングホイール２へ所定値以上の操舵入力を行っている場合（偏差微分の大きさにかかわらず、角加速度差分が大きく、操舵トルク微分Ｔｈ’が大きい場合）に、運転者の離脱要求の度合いが最も高いと離脱要求判定部７９が判定する。第１の出力割合が上限の割合に設定された状態であっても、運転者がステアリングホイール２への操舵入力を止めることにより、車両１が自動操舵走行して目標進路へ戻る。従って、運転者が自動操舵制御を開始させるスイッチへの入力など煩雑な操作をすることなく、運転者がステアリングホイール２への操舵入力という通常の運転操作をすることによって、１００パーセントの補助操舵電流i_ass（駆動電流i_ac）によって車両１が走行する状態から、１００パーセントの自動操舵電流i_auto（駆動電流i_ac）によって車両１が自動操舵走行する状態まで、運転者の離脱要求の度合いに応じて車両１が走行するため、運転者の操舵フィーリングを向上させることができる。

また、運転者及び出力自動操舵電流によってステアリングホイール２へ入力される操舵角加速度と、目標操舵角に基づいた目標操舵角加速度との差分である角加速度差分に基づいて、運転者の離脱要求の度合いを判定する。すなわち、ステアリングホイール２に入力する操舵角加速度のうち、出力自動操舵電流が作用する操舵角加速度を、目標操舵角加速度により除いた値に基づいて運転者の離脱要求の度合いを判定する。このため、例えば、ステアリングホイール２に入力する操舵角加速度のみに基づいて運転者の離脱要求の度合いを判定する場合と比べて、運転者が実際にステアリングホイール２へ入力した操舵角加速度に近い値に基づいて、運転者の離脱要求の度合いを判定することができる。また、例えば、ステアリングホイール２に入力される操舵角速度と目標操舵角に基づいた目標操舵角速度との差分に基づいて、運転者の離脱要求の度合いを判定する場合と比べて、判定をする単位時間前の値との相対的な変化量を求めることができるため、運転者がステアリングホイール２へ短時間に速く操舵入力をした場合に、角加速度差分が増大し、急激に高くなる運転者の離脱要求の度合いを離脱要求判定部７９が判定することができる。従って、例えば、車両１が目標進路に沿って自動操舵走行している状態において、危険回避などの目的で緊急に目標進路から離脱しようとする運転者の離脱要求の度合いを、補助操舵電流i_assの出力割合に早期にかつ的確に反映させることができる。

また、操舵トルクの時間微分である操舵トルク微分Ｔｈ’に基づいて運転者の離脱要求の度合いを判定する。このため、例えば、操舵トルクＴｈに基づいて運転者の離脱要求の度合いを判定する場合と比べて、判定をする単位時間前の値との相対的な変化量を求めることができるため、運転者が短時間に強く操舵入力をした場合に、操舵トルク微分Ｔｈ’が増大し、急激に高くなる運転者の離脱要求の度合いを離脱要求判定部７９が判定することができる。従って、例えば、車両１が目標進路に沿って自動操舵走行している状態において、危険回避などの目的で緊急に目標進路から離脱しようとする運転者の離脱要求の度合いを、補助操舵電流i_assの出力割合に早期にかつ的確に反映させることができる。

また、目標進路に対する現在位置の偏差の時間微分である偏差微分に基づいて運転者の離脱要求の度合いを判定する。つまり、運転者によるステアリングホイール２への操舵入力に加えて、車両１の状態によっても運転者の離脱要求の度合いを判定する。偏差微分は、短時間に大きく目標進路から現在位置が外れた場合に増大する値であり、例えば、角加速度差分や操舵トルク微分Ｔｈ’に基づいて運転者の離脱要求の度合いが高いと判定したことに応じて第１の割合を増大して車両１が走行した結果として増大する値である。また、偏差微分に基づいて、運転者の離脱要求の度合いを判定することにより、例えば、目標進路に対する現在位置の偏差に基づいて運転者の離脱要求の度合いを判定する場合と比べて、判定を実行する単位時間前の値との相対的な変化量を求めることができる。このため、例えば、車両１が目標進路に沿って自動操舵走行している状態において、危険回避などの目的で緊急に目標進路から離脱しようとする運転者の離脱要求の度合いを、補助操舵電流i_assの出力割合に早期にかつ的確に反映させることができる。

また、偏差微分と操舵トルク微分Ｔｈ’と角加速度差分とに基づいて運転者の離脱要求の度合いを判定するため、それぞれ単一の値に基づいて判定する場合に比べて、運転者の離脱要求の度合いの判定の正確性を向上させることができる。

また、例えば、車両１が目標進路に沿って自動操舵走行している状態において、危険回避などの目的で運転者がステアリングホイール２へ操舵入力した場合に、角加速度差分は、偏差微分よりも早期に値が変化する。また、例えば、角加速度差分は、偏差微分よりも車両１に対する風などの外乱で変化し難い。このため、角加速度差分には偏差微分よりも大きい重み付けを設定することにより、運転者による離脱要求の度合いの判定の正確性を向上させることができ、運転者による操舵入力のフィーリングを向上させることができる。

以上、本発明者によってなされた発明を適用した実施形態について説明したが、この実施形態による本発明の開示の一部をなす論述及び図面により本発明は限定されることはない。すなわち、この実施形態に基づいて当業者等によりなされる他の実施形態、実施例及び運用技術等は全て本発明の範疇に含まれることは勿論であることを付け加えておく。

本発明の実施形態に係る走行制御装置を備えた車両の模式図である。 図１の走行制御装置のブロック構成図である。 車速と操舵力補助係数との関係を示すマップの例である。 自動操舵電流演算処理のフローチャートである。 補助操舵電流演算処理のフローチャートである。 出力割合設定処理のフローチャートである。

符号の説明

１：車両
２：ステアリングホイール
６：ステアリングアクチュエータ
７：要求度判定部（要求度判定手段）
３２：トルクセンサ（操舵トルク検知手段）
３４：ハンドル角度センサ（操舵角加速度検知手段）
４２：車両位置検知部（車両位置検知手段）
４３：目標操舵角演算部（目標操舵角演算手段）
４４：自動操舵電流演算部（自動操舵電流演算手段）
４５：アシストトルク演算部（アシストトルク演算手段）
４６：補助操舵電流演算部（補助操舵電流演算手段）
７１：目標操舵角加速度演算部（目標操舵角加速度演算手段）
７２：操舵角加速度演算部（操舵角加速度検知手段）
７３：角加速度差分演算部（角加速度差分演算手段）
７４：偏差演算部（偏差演算手段）
７５：偏差微分演算部（偏差微分演算手段）
７６：操舵トルク微分演算部（操舵トルク微分演算手段）
７７：重み付け設定部（重み付け設定手段）
７８：要求度演算部（要求度演算手段）

Claims (2)

1. 車両の現在位置を検知する車両位置検知手段と、
   所定の目標進路と前記車両位置検知手段が検知した現在位置とに基づいて、前記車両を前記目標進路に従って走行させるための操舵角を目標操舵角として算出する目標操舵角演算手段と、
   前記目標操舵角演算手段が算出した目標操舵角に基づいて自動操舵電流を算出する自動操舵電流演算手段と、
   運転者によりステアリングホイールに入力された操舵トルクを検知する操舵トルク検知手段と、
   前記操舵トルク検知手段が検知した操舵トルクに基づいてアシストトルクを算出するアシストトルク演算手段と、
   前記アシストトルク演算手段が算出したアシストトルクに基づいて補助操舵電流を算出する補助操舵電流演算手段と、
   前記目標進路からの運転者の離脱要求の度合いを、当該運転者による前記ステアリングホイールへの操舵入力に基づいて判定する要求度判定手段と、
   前記要求度判定手段が判定した運転者の離脱要求の度合いの高低に応じて増減する第１の出力割合と、当該第１の出力割合の増減に応じて減増する第２の出力割合とを設定する出力割合設定手段と、
   前記出力割合設定手段が設定した第１の出力割合を前記補助操舵電流に乗じて出力補助操舵電流を算出し、前記出力割合設定手段が設定した第２の出力割合を前記自動操舵電流に乗じて出力自動操舵電流を算出し、当該出力自動操舵電流及び当該出力補助操舵電流を合算した駆動電流を、ステアリングアクチュエータへ出力する駆動電流出力手段と、を備え、
   前記要求度判定手段は、
   前記目標操舵角演算手段が算出した目標操舵角に基づいて目標操舵角加速度を算出する目標操舵角加速度演算手段と、
   前記ステアリングホイールに入力する操舵角加速度を検知する操舵角加速度検知手段と、
   前記目標操舵角加速度演算手段が算出した目標操舵角加速度と前記操舵角加速度検知手段が検知した操舵角加速度との差分を角加速度差分として算出する角加速度差分演算手段と、
   前記目標進路に対する前記車両位置検知手段が検知した現在位置の偏差を算出する偏差演算手段と、
   前記偏差演算手段が算出した偏差を時間微分することにより偏差微分を算出する偏差微分演算手段と、
   前記操舵トルク検知手段が検知した操舵トルクを時間微分することにより操舵トルク微分を算出する操舵トルク微分演算手段と、を有し、
   前記偏差微分演算手段が算出した偏差微分と、前記操舵トルク微分演算手段が算出した操舵トルク微分と、前記角加速度差分演算手段が算出した角加速度差分とに基づいて、運転者の離脱要求の度合いを判定し、
   前記要求度判定手段は、
   前記偏差微分演算手段が算出した偏差微分と、前記操舵トルク微分演算手段が算出した操舵トルク微分と、前記角加速度差分演算手段が算出した角加速度差分とにそれぞれ重み付けを設定する重み付け設定手段と、
   前記重み付け手段がそれぞれに重み付けを設定した前記偏差微分と前記操舵トルク微分と前記角加速度差分とを合算して運転者の離脱要求の度合いを算出する要求度演算手段と、をさらに有し、
   前記重み付け設定手段は、前記角加速度差分には前記偏差微分よりも大きい重み付けを設定し、
   前記出力割合設定手段は、
   運転者の離脱要求の度合いが最も高いと前記要求度判定手段が判定した場合、第１の出力割合を上限の割合に設定し、
   第１の出力割合を前記上限の割合に設定している状態で、運転者の離脱要求の度合いが低下したと前記要求度判定手段が判定した場合、第１の出力割合を当該上限の割合よりも低い割合に設定する
   ことを特徴とする走行制御装置。
2. 車両の現在位置を検知する車両位置検知手段と、
   所定の目標進路と前記車両位置検知手段が検知した現在位置とに基づいて、前記車両を前記目標進路に従って走行させるための操舵角を目標操舵角として算出する目標操舵角演算手段と、
   前記目標操舵角演算手段が算出した目標操舵角に基づいて自動操舵電流を算出する自動操舵電流演算手段と、
   運転者によりステアリングホイールに入力された操舵トルクを検知する操舵トルク検知手段と、
   前記操舵トルク検知手段が検知した操舵トルクに基づいてアシストトルクを算出するアシストトルク演算手段と、
   前記アシストトルク演算手段が算出したアシストトルクに基づいて補助操舵電流を算出する補助操舵電流演算手段と、
   前記目標進路からの運転者の離脱要求の度合いを、当該運転者による前記ステアリングホイールへの操舵入力に基づいて判定する要求度判定手段と、
   前記要求度判定手段が判定した運転者の離脱要求の度合いの高低に応じて増減する第１の出力割合と、当該第１の出力割合の増減に応じて減増する第２の出力割合とを設定する出力割合設定手段と、
   前記出力割合設定手段が設定した第１の出力割合を前記補助操舵電流に乗じて出力補助操舵電流を算出し、前記出力割合設定手段が設定した第２の出力割合を前記自動操舵電流に乗じて出力自動操舵電流を算出し、当該出力自動操舵電流及び当該出力補助操舵電流を合算した駆動電流を、ステアリングアクチュエータへ出力する駆動電流出力手段と、を備え、
   前記要求度判定手段は、
   前記目標操舵角演算手段が算出した目標操舵角に基づいて目標操舵角加速度を算出する目標操舵角加速度演算手段と、
   前記ステアリングホイールに入力する操舵角加速度を検知する操舵角加速度検知手段と、
   前記目標操舵角加速度演算手段が算出した目標操舵角加速度と前記操舵角加速度検知手段が検知した操舵角加速度との差分を角加速度差分として算出する角加速度差分演算手段と、
   前記目標進路に対する前記車両位置検知手段が検知した現在位置の偏差を算出する偏差演算手段と、
   前記偏差演算手段が算出した偏差を時間微分することにより偏差微分を算出する偏差微分演算手段と、
   前記操舵トルク検知手段が検知した操舵トルクを時間微分することにより操舵トルク微分を算出する操舵トルク微分演算手段と、を有し、
   前記偏差微分演算手段が算出した偏差微分と、前記操舵トルク微分演算手段が算出した操舵トルク微分と、前記角加速度差分演算手段が算出した角加速度差分とに基づいて、運転者の離脱要求の度合いを判定し、
   前記要求度判定手段は、
   前記偏差微分演算手段が算出した偏差微分と、前記操舵トルク微分演算手段が算出した操舵トルク微分と、前記角加速度差分演算手段が算出した角加速度差分とにそれぞれ重み付けを設定する重み付け設定手段と、
   前記重み付け手段がそれぞれに重み付けを設定した前記偏差微分と前記操舵トルク微分と前記角加速度差分とを合算して運転者の離脱要求の度合いを算出する要求度演算手段と、をさらに有し、
   前記重み付け設定手段は、前記角加速度差分には前記偏差微分よりも大きい重み付けを設定する
   ことを特徴とする走行制御装置。

Images