〔発明が解決しようとする課題〕
上記特許文献1に記載された車線追従装置によれば、車両が目標軌跡に沿って走行するよう操舵トルクの制御によって運転者の操舵操作を促したり操舵輪の舵角を修正したりすることができる。
しかし上記特許文献1に記載された車線追従装置に於いては、車両の目標軌跡を設定するための車両前方の道路の車線情報及び車両の実軌跡に対応する車両の前方注視点の情報を取得するカメラの如き車外情報取得手段が必須である。また目標軌跡は基本的には車線情報に基づいて決定されるため、車両の目標軌跡を必ずしも運転者の希望に則した軌跡に設定することができない。更に車両前方の道路の車線情報がない状況や車線情報を取得できない状況に於いては、目標軌跡を設定することができないため、車両を目標軌跡に沿って走行させることができない。
尚、上記特許文献2には、操舵角及び車速に基づいて車両の目標軌跡を設定し、目標軌跡と車両の実軌跡との偏差が減少するよう操舵伝達比可変装置を制御する操舵制御装置が記載されている。この特許文献2に記載された操舵制御装置によれば、車両が目標軌跡に沿って走行するよう操舵輪の舵角を制御することができる。
しかし特許文献2に記載された操舵制御装置に於いては、車両の実軌跡を求めるためのGPSの如き車外情報取得手段が必要である。また目標軌跡と実軌跡との偏差に基づいて操舵輪の舵角がフィードバック制御されるので、実軌跡が求められた後でなければ舵角を制御することができず、そのため制御の遅れに起因して車両を好ましく目標軌跡に沿って走行させることができない。
上記問題を解消すべく、例えば運転者の操舵操作量及び車速に基づいて車両が目標進行方向にて目標到達位置に到達するに必要な目標軌跡に沿って車両を走行させるための操舵輪の目標舵角を演算し、目標舵角に基づいて操舵輪の舵角を制御することが考えられる。かかる操舵輪の舵角の制御によれば、車両の目標軌跡や実軌跡を求めるための車外情報の取得を要することなく、車両の軌跡が運転者の希望に則した軌跡になるよう操舵輪の舵角を遅れなく制御することができる。
操舵輪は一般に前輪であり、車速が一定であれば、車両のヨーレートや車両のロール角の如き車両の旋回状態量は前輪の舵角によって一義的に決定される。そのため前輪の舵角が車両の目標軌跡を達成するための目標舵角に制御されると、車両の旋回状態量が過大になる場合がある。
車両を目標軌跡に沿って走行させるためのヨーモーメントは前輪のコーナリングフォースによるヨーモーメントに限定されず、後輪の舵角を制御することにより後輪によってもコーナリングフォースによるヨーモーメントを発生させることができる。また前輪及び後輪の両方の舵角を制御することにより、車両の目標軌跡を達成するために必要な車両全体のコーナリングフォースを確保しつつ、車両の旋回状態量を前輪の舵角のみが制御される場合とは異なる値に制御することができる。
よって車両の旋回状態量が過大になる虞れの有無を判定し、該虞れがあるときには、前輪に加えて後輪の舵角を制御することにより、車両の旋回状態量が過大になることを防止しつつ車両を目標軌跡に沿って走行させることが好ましい。
本発明は、車両が目標軌跡に沿って走行するよう車両の軌跡を制御する従来の走行制御装置に於ける上述の如き問題に鑑みてなされたものである。そして本発明の主要な課題は、車両の旋回状態量が過大になることを防止しつつ、車両の軌跡が運転者の希望に則した目標軌跡になるよう前輪及び後輪の舵角を制御することである。
〔課題を解決するための手段及び発明の効果〕
上述の主要な課題は、本発明によれば、運転者の操舵操作量に対する前輪の舵角の関係を変更する前輪舵角制御手段と、前輪とは独立に後輪の舵角を変更する後輪舵角制御手段とを備えた車両の走行制御装置に於いて、車両の軌跡の制御について予め設定された開始条件又は更新条件が成立したと判定したときには、その時点に於ける運転者の操舵操作量に基づいて目標進行方向を決定すると共に、前記時点に於ける運転者の操舵操作量に基づいて決定される角度を基準角度として、前記時点に於ける車両の位置より車両の前後方向に対し前記基準角度傾斜した方向に引いた直線上に存在し且つ前記時点に於ける車両の位置から車速に依存する距離の位置に目標到達位置を決定し、前記時点に於ける運転者の操舵操作量及び車速に基づいて車両が目標進行方向にて目標到達位置に到達するに必要な目標軌跡に沿って車両を走行させるための前輪の暫定の目標舵角を演算し、前記暫定の目標舵角に基づいて車両が目標進行方向にて目標到達位置に到達するまでの車両の旋回状態量を推定し、前記旋回状態量の大きさが基準値以下であるときには前記暫定の目標舵角に基づいて前記前輪舵角制御手段により前輪の舵角を制御し、前記旋回状態量の大きさが前記基準値を越えるときには前記旋回状態量の大きさが前記基準値を越えないよう補正された車両の旋回状態量に基づいて前記目標軌跡に沿って車両を走行させるための前輪及び後輪の目標舵角を演算し、前記前輪の目標舵角に基づいて前記前輪舵角制御手段により前輪の舵角を制御すると共に前記後輪の目標舵角に基づいて前記後輪舵角制御手段により後輪の舵角を制御することを特徴とする車両の走行制御装置(請求項1の構成)によって達成される。
後に詳細に説明する如く、運転者の操舵操作量は車両の現在の進行方向を基準に見て車両の現在位置から目標到達位置までの方向に関係し、車速は車両の現在位置から目標到達位置までの距離に関係している。また運転者の操舵操作量は車両が目標到達位置に到達する際の目標進行方向にも関係している。
車両の軌跡の制御について予め設定された開始条件又は更新条件が成立したと判定した時点を基準時点と呼ぶこととする。上記請求項1の構成によれば、基準時点の運転者の操舵操作量及び車速に基づいて車両が目標進行方向にて目標到達位置に到達するための目標軌跡に沿って車両が走行するための操舵輪の目標舵角が演算され、目標舵角に基づいて操舵輪の舵角が制御される。特に、目標進行方向は、基準時点に於ける運転者の操舵操作量に基づいて決定され、目標到達位置は、基準時点に於ける運転者の操舵操作量に基づいて決定される角度を基準角度として、基準時点に於ける車両の位置より車両の前後方向に対し基準角度傾斜した方向に引いた直線上に存在し且つ基準時点に於ける車両の位置から車速に依存する距離の位置に決定される。
そして旋回状態量の大きさが基準値以下であるときには暫定の目標舵角に基づいて前輪舵角制御手段により前輪の舵角が制御される。これに対し旋回状態量の大きさが基準値を越えるときには旋回状態量の大きさが基準値を越えないよう補正された車両の旋回状態量に基づいて目標軌跡に沿って車両を走行させるための前輪及び後輪の目標舵角が演算される。更に前輪の目標舵角に基づいて前輪の舵角が制御されると共に後輪の目標舵角に基づいて後輪の舵角が制御される。
従って車両の目標軌跡や実軌跡を求めるための車外情報の取得は不要であり、また車外情報に基づいて実際の軌跡を求めることも、目標軌跡と実際の軌跡との偏差に基づいて車両の軌跡をフィードバック制御することも必要でない。よって車両の軌跡が運転者の希望に則した軌跡になるよう操舵輪の舵角を遅れなく制御し、車両を運転者が希望する目標軌跡に沿って走行させることができる。
特に、基準時点に於ける運転者の操舵操作量及び車速に基づいて目標到達位置を決定し、基準時点に於ける運転者の操舵操作量に基づいて目標進行方向を決定することができる。また、基準時点に於ける運転者の操舵操作量に基づいて決定される角度を基準角度とし、基準時点に於ける車両の位置より車両の前後方向に対し基準角度傾斜した方向に引いた直線上に位置し且つ基準時点に於ける車両の位置から車速に依存する距離の位置として目標到達位置を決定することができる。よって、基準時点に於ける運転者の操舵操作量及び車速に基づいて車両が目標進行方向にて目標到達位置に到達するための車両の目標軌跡を求めることができる。
また請求項1の構成によれば、前輪のみの舵角制御では旋回状態量の大きさが基準値を越えるときには旋回状態量の大きさが基準値を越えないよう補正され、補正後の車両の旋回状態量に基づいて前輪及び後輪の目標舵角が演算される。よって旋回状態量の大きさが過大になることを確実に防止しつつ、車両を目標軌跡に沿って車両を走行させることができる。
また請求項1の構成によれば、前輪のみの舵角制御でも旋回状態量の大きさが基準値を越えないときには、暫定の目標舵角に基づいて前輪の舵角が制御され、後輪の舵角は制御されない。よって旋回状態量の大きさが基準値を越えるか否かに関係なく前輪及び後輪の舵角が制御される場合に比して、車両の軌跡の制御を単純化することができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項1の構成に於いて、前記補正された車両の旋回状態量は、前記旋回状態量の大きさが前記基準値を越える領域については前記旋回状態量の大きさを前記基準値に低減補正し、前記旋回状態量の大きさが前記基準値を越えていない領域については前記旋回状態量の大きさが前記基準値を越えないよう前記旋回状態量の大きさを増大補正することにより求められるよう構成される(請求項2の構成)。
上記請求項2の構成によれば、旋回状態量の大きさが基準値を越える領域については旋回状態量の大きさが基準値に低減補正され、補正された車両の旋回状態量に基づいて前輪及び後輪の目標舵角が演算される。従って旋回状態量の大きさが基準値を越えることを防止しつつ車両が目標軌跡に沿って車両を走行するよう前輪及び後輪の舵角を制御することができる。
また上記請求項2の構成によれば、旋回状態量の大きさが基準値を越えていない領域については旋回状態量の大きさが基準値を越えないよう旋回状態量の大きさが増大補正され、補正された車両の旋回状態量に基づいて前輪及び後輪の目標舵角が演算される。従って旋回状態量の大きさが基準値を越えていない領域について旋回状態量の大きさが増大補正されない場合に比して、車両が目標到達位置に到達するまでの車両の旋回状態量の総量が不足する虞れを低減することができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項1の構成に於いて、前記補正された車両の旋回状態量は、前記旋回状態量の大きさが前記基準値よりも小さい補正判定値を越える領域については前記旋回状態量の大きさを前記基準値以下に低減補正し、前記旋回状態量の大きさが前記補正判定値を越えていない領域については前記旋回状態量の大きさが前記補正判定値を越えないよう前記旋回状態量の大きさを増大補正することにより求められるよう構成される(請求項3の構成)。
上記請求項3の構成によれば、旋回状態量の大きさが基準値よりも小さい補正判定値を越える領域については旋回状態量の大きさが基準値以下に低減補正され、補正された車両の旋回状態量に基づいて前輪及び後輪の目標舵角が演算される。従って旋回状態量の大きさが基準値を越えることを防止しつつ車両が目標軌跡に沿って車両を走行するよう前輪及び後輪の舵角を制御することができる。
また上記請求項3の構成によれば、旋回状態量の大きさが補正判定値を越えていない領域については旋回状態量の大きさが補正判定値を越えないよう旋回状態量の大きさが増大補正され、補正された車両の旋回状態量に基づいて前輪及び後輪の目標舵角が演算される。従って旋回状態量の大きさが補正判定値を越えていない領域について旋回状態量の大きさが増大補正されない場合に比して、車両が目標到達位置に到達するまでの車両の旋回状態量の総量が不足する虞れを低減することができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項2又は3の構成に於いて、前記旋回状態量の大きさの低減補正量の積分値及び前記旋回状態量の大きさの増大補正量の積分値は実質的に互いに等しいよう構成される(請求項4の構成)。
上記請求項4の構成によれば、旋回状態量の大きさの低減補正量の積分値及び旋回状態量の大きさの増大補正量の積分値は実質的に互いに等しい。よって旋回状態量の大きさの補正に起因して車両が目標到達位置に到達するまでの車両の旋回状態量の総量に過不足が生じることを防止することができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項1乃至3の何れか一つの構成に於いて、前記車両の旋回状態量は車両のヨーレート及びロール角の何れか一方であるよう構成される(請求項5の構成)。
上記請求項5の構成によれば、車両の旋回状態量がヨーレートであるときにはヨーレートの大きさが過大になることを防止することができ、また車両の旋回状態量がロール角であるときにはロール角の大きさが過大になることを防止することができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項1乃至3の何れか一つの構成に於いて、前記目標軌跡は、前記目標進行方向を示す直線を時間の座標軸とし、前記時点に於ける車両の位置より前記時間の座標軸に下した垂線を距離の座標軸とする仮想の直交座標に於いて、前記時点からの経過時間を指数の変数とする指数関数の曲線であるよう構成される(請求項6の構成)。
上記請求項6の構成によれば、目標進行方向を示す直線を時間の座標軸とし、基準時点に於ける車両の位置より時間の座標軸に下した垂線を距離の座標軸とする仮想の直交座標に於いて、基準時点からの経過時間を指数の変数とする指数関数の曲線として目標軌跡を求めることができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項1乃至3の何れか一つの構成に於いて、前記時点に於ける前輪の舵角と前記目標舵角との偏差の大きさが小さくなるよう前輪の舵角を修正するよう構成される(請求項7の構成)。
上記請求項7の構成によれば、基準時点に於ける前輪の舵角と目標舵角との偏差の大きさが小さくなるよう前輪の舵角を修正される。よって前輪の舵角が目標舵角になるよう前輪の舵角をフィードフォワード式に効率的に制御することができ、また運転者の操舵操作を要することなく前輪の舵角を目標舵角にすることができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項1乃至3の何れか一つの構成に於いて、前輪の実際の舵角と前記目標舵角との偏差の大きさが小さくなるよう前輪の舵角を修正するよう構成される(請求項8の構成)。
上記請求項8の構成によれば、前輪の実際の舵角と目標舵角との偏差の大きさが小さくなるよう前輪の舵角が修正される。よって前輪の舵角が目標舵角になるよう前輪の舵角をフィードバック式に正確に制御することができ、また運転者によって操舵操作が行われても前輪の舵角を目標舵角にすることができる。
尚フィードバックの制御は前輪の舵角について行われるので、フィードバックの制御が車両の軌跡について行われる従来の車両の走行制御装置の場合に比して、前輪の舵角の制御の遅れは遥かに小さい。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項1乃至8の何れか一つの構成に於いて、前記時点に於ける車両の位置と前記目標到達位置とを結ぶ直線を方向の基準線として、前記目標進行方向は前記目標到達位置に於いて前記方向の基準線に対し前記基準角度傾斜した方向に決定されるよう構成される(請求項9の構成)。
上記請求項9の構成によれば、基準時点に於ける車両の位置と目標到達位置とを結ぶ直線を方向の基準線として、目標到達位置に於いて方向の基準線に対し基準角度傾斜した方向を目標進行方向に決定することができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項1乃至3の何れか一つの構成に於いて、前記軌跡の制御を行っていない状況に於いて、運転者の操舵操作量の変化率の大きさが開始条件を判定するための第一の基準値よりも大きくなった後に運転者の操舵操作量の変化率の大きさが開始条件を判定するための第二の基準値よりも小さくなったときに前記軌跡の制御の開始条件が成立したと判定するよう構成される(請求項10の構成)。
一般に、運転者が車両の進路を変更する場合には、まず比較的速く操舵操作量を変化させ、しかる後操舵操作量の変化を穏やかにする。従って運転者の操舵操作量の変化率の大きさの推移に基づいて車両の軌跡の制御の開始又は更新の必要性を判定することができる。
上記請求項10の構成によれば、軌跡の制御が行われていない状況に於いて、運転者の操舵操作量の変化率の大きさが開始条件を判定するための第一の基準値よりも大きくなった後に開始条件を判定するための第二の基準値よりも小さくなったときには、その判定により軌跡の制御の開始条件が成立したと判定することができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項1乃至3の何れか一つの構成に於いて、前記軌跡の制御を行っている状況に於いて、運転者の操舵操作量の変化率の大きさが更新条件を判定するための第一の基準値よりも大きくなった後に運転者の操舵操作量の変化率の大きさが更新条件を判定するための第二の基準値よりも小さくなったときに前記軌跡の制御の更新条件が成立したと判定するよう構成される(請求項11の構成)。
上記請求項11の構成によれば、軌跡の制御が行われている状況に於いて、運転者の操舵操作量の変化率の大きさが更新条件を判定するための第一の基準値よりも大きくなった後に更新条件を判定するための第二の基準値よりも小さくなったときには、その判定により軌跡の制御の更新条件が成立したと判定することができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項6の構成に於いて、前記時点に於ける車両から前記時間の座標軸までの距離を基準距離として、前記基準距離と前記時点からの経過時間を指数の変数とする自然指数関数との積として目標距離が求められ、前記目標軌跡は前記時間の座標軸から前記目標距離の位置を結ぶ線として求められるよう構成される(請求項12の構成)。
上記請求項12の構成によれば、基準距離と基準時点からの経過時間を指数の変数とする自然指数関数との積として目標距離を求め、時間の座標軸から目標距離の位置を結ぶ線として目標軌跡求めることができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項12の構成に於いて、操舵操作の必要性に関連する車外の視覚情報の変化が発生してから人が当該視覚情報の変化を知覚するまでに要する一般的な時間をΔTとし、ウェバー比を−kとし、前記時点からの経過時間をtとして、前記自然指数関数の指数は−(k/ΔT)tであるよう構成される(請求項13の構成)。
上記請求項13の構成によれば、自然指数関数の指数は−(k/ΔT)tであるので、人の知覚特性に合った車両の目標距離を求め、これにより人の知覚特性に合った車両の目標軌跡を求めることができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項1乃至13の何れか一つの構成に於いて、前記舵角制御手段は、運転者により操作される操舵入力手段に対し相対的に操舵輪を駆動することにより操舵伝達比を変化させる操舵伝達比可変手段と、前記操舵伝達比可変手段を制御する制御手段とを有するセミバイワイヤ式の舵角制御手段であるよう構成される(請求項14の構成)。
上記請求項14の構成によれば、操舵伝達比可変手段を有するセミバイワイヤ式の舵角制御手段を備えた車両に於いて、操舵伝達比可変手段により操舵伝達比を変化させることにより操舵輪の舵角を制御することができる。
また本発明によれば、上述の主要な課題を効果的に達成すべく、上記請求項1乃至13の何れか一つの構成に於いて、前記舵角制御手段は、操舵輪の舵角を変化させる転舵手段と、前記操舵入力手段に対する運転者の操舵操作量を検出する手段と、通常時には運転者の操舵操作量に基づいて前記転舵手段を制御し、必要に応じて運転者の操舵操作に依存せずに前記転舵手段を制御する制御手段とを有するバイワイヤ式の舵角制御手段であるよう構成される(請求項15の構成)。
上記請求項15の構成によれば、バイワイヤ式の舵角制御手段を備えた車両に於いて、転舵手段を制御することにより運転者の操舵操作に依存せずに操舵輪の舵角を制御することができる。
本発明の一つの好ましい態様によれば、上記請求項1乃至3の何れか一つの構成に於いて、走行制御装置は旋回状態量の大きさが基準値以下であるときには、後輪の舵角を0に維持するよう構成される(好ましい態様1)。
本発明の他の一つの好ましい態様によれば、上記請求項1乃至3の何れか一つの構成に於いて、走行制御装置は運転者の操舵操作量及び車速と前輪の暫定の目標舵角との関係を記憶しており、車両の軌跡の制御について予め設定された開始条件又は更新条件が成立したと判定した時点に於ける運転者の操舵操作量及び車速に基づいて前記関係より暫定の目標舵角を演算するよう構成される(好ましい態様2)。
本発明の他の一つの好ましい態様によれば、上記請求項1乃至3の何れか一つの構成に於いて、走行制御装置は補正された車両の旋回状態量、目標軌跡に沿って車両を走行させるための車両の横加速度、車速に基づいて前輪及び後輪の目標舵角を演算するよう構成される(好ましい態様3)。
本発明の他の一つの好ましい態様によれば、上記請求項1乃至3の何れか一つの構成に於いて、走行制御装置は予め設定された軌跡の制御の終了条件が成立するまで車輪の舵角を制御するよう構成される(好ましい態様4)。
本発明の他の一つの好ましい態様によれば、上記請求項1乃至3の何れか一つの構成に於いて、走行制御装置は車両の軌跡の制御について予め設定された開始条件又は更新条件が成立していないと判定したときには、予め設定された操舵伝達比が達成されるよう前輪の舵角を制御するよう構成される(好ましい態様5)。
本発明の他の一つの好ましい態様によれば、上記請求項2の構成に於いて、走行制御装置は旋回状態量の大きさが基準値を越えていない領域の一部の範囲について旋回状態量の大きさが基準値を越えないよう旋回状態量の大きさを増大補正するよう構成される(好ましい態様6)。
本発明の他の一つの好ましい態様によれば、上記請求項2の構成に於いて、走行制御装置は旋回状態量の大きさが基準値を越えていない領域の全範囲について旋回状態量の大きさが基準値を越えないよう旋回状態量の大きさを増大補正するよう構成される(好ましい態様7)。
本発明の他の一つの好ましい態様によれば、上記請求項3の構成に於いて、走行制御装置は旋回状態量の大きさが補正判定値を越えていない領域の一部の範囲について旋回状態量の大きさが補正判定値を越えないよう旋回状態量の大きさを増大補正するよう構成される(好ましい態様8)。
本発明の他の一つの好ましい態様によれば、上記請求項3の構成に於いて、走行制御装置は旋回状態量の大きさが補正判定値を越えていない領域の全範囲について旋回状態量の大きさが補正判定値を越えないよう旋回状態量の大きさを増大補正するよう構成される(好ましい態様9)。
本発明の他の一つの好ましい態様によれば、上記請求項3の構成に於いて、走行制御装置は旋回状態量の大きさが補正判定値を越える領域については旋回状態量の大きさと補正判定値との差が大きいほど低減補正量が大きくなるよう旋回状態量の大きさを基準値以下に低減補正するよう構成される(好ましい態様10)。
本発明の他の一つの好ましい態様によれば、上記請求項4の構成に於いて、旋回状態量の大きさの増大補正量の積分値は旋回状態量の大きさの低減補正量の積分値の90%以上で100%以下であるよう構成される(好ましい態様11)。
本発明の他の一つの好ましい態様によれば、上記請求項6の構成に於いて、走行制御装置は車両の軌跡の制御について予め設定された開始条件又は更新条件が成立したと判定した時点からの経過時間と運転者の操舵操作量及び車速と前輪の暫定の目標舵角との関係を記憶しており、開始条件又は更新条件が成立したと判定した時点からの経過時間と開始条件又は更新条件が成立したと判定した時点に於ける運転者の操舵操作量及び車速とに基づいて前記関係より前輪の暫定の目標舵角を演算するよう構成される(好ましい態様12)。
実施形態の総括説明
具体的な実施形態の説明に先立ち、各実施形態に共通の技術的事項について総括的に説明する。
1)案内棒モデル
車両の軌跡に関する運転者の意図は、運転者の操舵操作量に反映されていると考えられるので、操舵輪である前輪の向き、即ち前輪の舵角が運転者の前方注視方向であると考えられてよい。そこで前輪に仮想の案内棒が設置された仮想の車両を定義し、運転者は案内棒の先端が希望の軌跡に沿って移動するように車両を運転していると仮定する。その場合前方注視距離、即ち車両から運転者が注視する位置までの距離は案内棒の長さに対応し、車速に応じて変化すると考えられる。
本明細書に於いては、上述の仮想の案内棒を備えた車両のモデルを「案内棒モデル」と呼ぶこととする。案内棒モデルによれば、運転者が車両の進路を変更しようとしたときの運転者の操舵操作量及び車速に基づいて、案内棒の先端を通る軌跡として車両の好ましい目標軌跡を設定することができる。
従って設定された目標軌跡に沿って車両が走行するよう前輪の舵角を制御することにより、車両周囲の情報を撮影や車外よりの通信等によって周囲の情報を取得することを要することなく、車両を好ましい目標軌跡に沿って走行させることができる。
案内棒モデルに基づく車両の軌跡制御の理解が容易になるよう、図18に示されている如く、車両は前輪100及び後輪102を備えた2輪モデルの車両104であるとする。そして車両104がその前後方向を示す線106に対し角度φ傾斜した目標進路108へ進路を変更する場合について考える。尚角度の単位はradである。
図示の如く、前輪100の中心Oから目標進路108上の点Pまで前輪の前後方向に沿って車両の前方へ仮想の案内棒110が突き出ているものとし、車両の前後方向に対する案内棒110の傾斜角をβとする。そして案内棒110の長さ、即ち線分OPの長さをAとし、目標進路108と案内棒110とがなす角度をαとする。また前輪100の中心Oから目標進路108までの距離をxとし、前輪100の舵角をδとする(δ=β)。更に車両104のホイールベースをWBとし、車速をVとする。尚長さの単位はmであり、時間の単位はsecである。
舵角δ及び車速Vが変化せずに微小時間dtが経過することにより、車両104が実線にて示された位置より破線にて示された位置へ移動し、これに伴う角度φ及び距離xの変化をそれぞれdφ及び距離dxとすると、下記の式1〜式4が成立する。尚微小時間dtは非常に小さいので、図示の如く前輪100は案内棒110上の点に移動し、後輪102は移動前の車両の前後方向を示す線106上の点に移動すると考えられてよい。
β=φ−α ……(1)
x=A*sinα ……(2)
−WBdφ=Vdt*sinβ ……(3)
−dx=Vdt*sinα ……(4)
上記式2をαで微分すると、下記の式5が得られるので、dxは下記の式6により表される。
dx/dα=A*cosα ……(5)
dx=A*cosα*dα ……(6)
上記式4に式6を代入すると、下記の式7が得られるので、案内棒の長さAは下記の式8により表される。
−A*cosα*dα=Vdt*sinα ……(7)
A=−(Vdt*sinα)/(cosα*dα)
=−(Vdt*tanα)/dα
=−Vdt*{1/(cosα)2} ……(8)
また上記式3をVdtについて解くと、下記の式9が得られ、式9を式8に代入すると下記の式10が得られる。
Vdt=(−WBdφ)/sinβ ……(9)
A=−(−WBdφ)/sinβ*{1/(cosα)2} ……(10)
旋回の如き車両の非直進走行は定常円走行の組合せと考えることができ、軌跡が円弧である場合には角度α及びβは互いに同一である。またβは前輪の舵角δと同一である。よって式10の角度α及びβを舵角δに書き換えることにより、案内棒の長さAを式11にて表すことができる。
A=(WBdφ)/sinδ*{1/(cosδ)2} ……(11)
式11のdφは車両のヨーレートYRであり、ヨーレートYRは下記の式12により表される。
YR=V/WB*δ ……(12)
よって式11のdφに式12を代入することにより、案内棒の長さAを式13にて表すことができる。
A=WB(V/WB*δ)/sinδ*{1/(cosδ)2}
=(V*δ)/sinδ*{1/(cosδ)2} ……(13)
尚車両の旋回方向が左旋回か右旋回かによって舵角δの符号が異なる場合には、車両の旋回方向が逆になることによって舵角δの符号が逆になると、sinδの符号も同様に逆になるので、案内棒の長さAは常に正の値である。
以上の説明に於いては、案内棒110は前輪100の中心Oを基準位置とし該基準位置から前輪の前後方向に沿って車両の前方へ突き出ているものとして案内棒モデルを説明した。しかし車両の軌跡は車両の重心の軌跡と考える方が好ましいので、これ以降の説明に於いては、案内棒は車両の重心を基準位置とし該基準位置から前輪の前後方向に沿って車両の前方へ突き出ているものとする。
2)円弧状の軌跡
次に図19に示されている如く、前輪の舵角δ及び車速Vがそれぞれ一定の値に設定されて車両104が定常円旋回し、位置P0より位置P1まで円弧状の軌跡Tcを描いて走行する場合について考える。この場合車両104の重心が位置P0にあるときの案内棒に対応する線分は、基準点P0より先端P1まで延在している。
車両104の運動は定常円旋回運動であるので、車両のヨーレートYRは上記式12により表され、車両の横加速度LAは下記の式14により表される。
LA=YR*V ……(14)
よって円弧状の軌跡Tcの半径Rは下記の式15により表される。
R=V2/LA
=V2/(YR*V)
=V/YR
=V/(V/WB*δ)
=WB/δ ……(15)
また図19に示されている如く、車両104の前後方向を示す線106及び目標進路を示す線108はそれぞれ位置P0及びP1に於いて円弧状の軌跡Tcに接する接線である。線106及び108の交点をQ1とし、円弧状の軌跡Tcの中心Ocより案内棒110に下した垂線の足をQ2とする。三角形P0OcP1は中心Ocを頂点とする二等辺三角形であるので、角度P0OcQ2及び角度P1OcQ2は互いに等しく、これらをγとする。また角度OcP0Q2及び角度OcP1Q2も互いに等しく、これらをλとする。
図19より解る如く、下記の式16及び17が成立する。よって角度γは角度α及びδと同一である。
α+λ=δ+λ=π/2 ……(16)
γ+λ=π/2 ……(17)
また図19より解る如く、案内棒に対応する線分の長さA0は線分P0Q2の2倍であり、線分P0Q2の長さはR*sinγ=R*sinδである。よって案内棒に対応する線分の長さA0は式18にて表わされる。
A0=2R*sinδ
=2(WB/δ)*sinδ ……(18)
式18により表される案内棒に対応する線分の長さA0は車速Vを含んでおらず、車速Vに依存しない。この線分の長さA0と式13により表される案内棒の長さAとの比較より、前輪の舵角δを修正しなければ、案内棒110の先端を通る円弧状の軌跡に沿って車両を走行させることができないことが解る。換言すれば、線分の長さA0を式13により表される案内棒の長さAと同一の値にするためには、運転者の操舵操作量及びステアリングギヤ比により定まる舵角(「本来の舵角」という)δとは異なる値に前輪の舵角を修正しなければならない。
図20に示されている如く、前輪の舵角が本来の舵角δから修正後の舵角δ′に修正されると、車両104が案内棒110の先端P1′を通る円弧状の軌跡Tc′に沿って走行することができるとする。また円弧状の軌跡Tc′の中心及び半径はそれぞれOc′、R′であるとする。
半径R′は上記式15に対応する下記の式19により表される。
R′=WB/δ′ ……(19)
三角形P0P1Oc及び三角形P0P1′Oc′は相似形であるので、下記の式20が成立する。
R/R′=A0/A ……(20)
この式20にδがδ′に書き換えられた上記式13及び上記式15、18、19を代入すると、下記の式21が得られる。
δ′/δ=2WB*sinδ′*sinδ*(cosδ′)2/(V*δ′*δ)
……(21)
前輪の舵角δ及び修正後の舵角δ′が小さい値であるときには、sinδ及びsinδ′はそれぞれδ及びδ′であると看做されてよく、cosδ′は1であると看做されてよい。よって修正後の舵角δ′は上記式21が変形された下記の式22により表される。
δ′=(2WB/V)*δ ……(22)
運転者の操舵操作量としての操舵角をθとし、ステアリングギヤ比をNとすると、前輪の本来の舵角δは下記の式23により表される。尚ステアリングギヤ比Nは一定であってもよく、また例えば車速Vに応じて可変設定される値であってもよい。
δ=θ/N ……(23)
よって修正後の舵角δ′は下記の式24により表される。
δ′=(2WB/V)*θ/N ……(24)
また前輪の舵角及び車速がそれぞれ一定のδ′及びVに維持された状態で車両が位置P0より位置P1′まで円弧状の軌跡Tc′に沿って走行するに要する時間をTaとする。時間Taは中心角θが2γ=2δで半径がR′の扇形の円弧に沿って式25により表されるヨーレートYRにて円弧運動するに必要な時間である。よって時間Taは式26により表される通り、1[sec]であり、車速Vに依存しない。
YR=V/WB*δ′ ……(25)
Ta =2δ/YR
=2WB*δ/(V*δ′)
=2WB*δ/{V*(2WB/V)*δ}
=1 ……(26)
従って前輪の本来の舵角がδである状況に於いて、車速Vを一定の値に維持し前輪の舵角を修正後の舵角δ′になるよう制御することにより、案内棒110の先端P1′を通る円弧状の軌跡Tc′に沿って車両を走行させることができる。そして車速Vの値に関係なく車両は時間Ta=1[sec]が経過するときに位置P1′を通過する。
3)指数関数の軌跡
上記式2より下記の式27が成立する。但し式1よりα=φ−βである。
x′=−V*sinα ……(27)
上記式2及び27より下記の式28が成立し、式28は距離xがウェバー則に則して変化する変数であることを示している。
x′=−(V/A)x ……(28)
式28を解くと式29が得られる。よって距離xが式29に則して変化するよう制御することにより、距離xをウェバー則に則して制御することができる。尚x0は時間tが0であるときの距離xの値である。
x=x0*exp{−(V/A)*t} ……(29)
次に上記式29に基づく距離xの制御を人間の知覚特性に適合させることを考える。図21に示されている如く、距離xの2回微分値である車両の水平加速度x″が増加する場合に於いて、人が水平加速度x″の変化を知覚できる最小量をΔx″とする。そして人が水平加速度x″の変化Δx″を知覚するに要する最小時間をΔTとする。水平加速度x″の変化率をx″′として最小量Δx″は下記の式30により表される。
Δx″=x″′*ΔT ……(30)
図21より解る如く、水平加速度x″の変化率x″′は下記の式31により表される。
x″′={(x″+Δx″)−x″}/{(T+ΔT)−T}
=Δx″/ΔT ……(31)
上記式28を2回微分すると下記の式32が得られるので、下記の式33が成立する。
x″′=−(V/A)*x″ ……(32)
x″′/x″=−(V/A) ……(33)
上記式33に上記式31を代入して変形することにより、下記の式34が得られる。
Δx″/x″=−(V/A)*ΔT ……(34)
上記式34はウェバー比の形をなす式であるので、ウェバー比を−kとして上記式34を下記の式35の通りに書き換えることができる。但しkは式36により表される正の値である。
Δx″/x″=−k ……(35)
k=(V/A)*ΔT ……(36)
尚最小時間ΔTは個人差のある値であるが、最小時間ΔTを平均的な一定の値とし、ウェバー比−kも一定の値であるとする。
上記式35を下記の式37の通り変形し、式37を上記式30に代入して変形することにより、下記の式38が得られる。そして下記の式38を解くことにより、下記の式39が得られる。
Δx″=−k*x″ ……(37)
x″′*ΔT=−k*x″ ……(38)
x=x0*exp{−(k/ΔT)*t} ……(39)
上記式29及び39は何れも距離xが時間tの指数関数であることを示しているが、式39によれば距離x、従って車両の好ましい指数関数の軌跡を車速Vに依存しないウェバー比−k及び最小時間ΔTにて表すことができる。
よって上記式39を使用して車両の軌跡を制御することにより、車速Vに依存する上記式29を使用して車両の軌跡を制御する場合に比して、下記の利点がられる。
(1)上記式39は車速Vを含んでいないので、演算量を少なくし、制御を単純化することができる。
(2)車両の軌跡を人の知覚特性に適合した好ましい指数関数の軌跡に制御することができる。
以上の説明より解る如く、式39に従って距離xを制御することによって車両の軌跡を制御することにより、車両の軌跡を円弧状の軌跡よりも人の知覚特性にとって好ましい指数関数の軌跡にすることができる。
しかし車両の軌跡が上記式39に従って指数関数の軌跡に設定されても、車両が位置P1′に到達するに要する時間Tbが車両の軌跡が円弧状の軌跡である場合の時間Taと同一になるとは限らない。
そこで時間Tbを時間Taと同一の値にするための補正係数をDとして上記式39を下記の式40の通りに書き換える。
x=x0*exp{−(k/ΔT)D*t} ……(40)
車両が位置P1′に到達するに要する時間Tbを時間Taとするためには、xbを0に近い正の定数として、式40に於いて時間tがTaであるときに距離xがxbになればよく、従って下記の式41が成立すればよい。Taは1[sec]であるので、補正係数Dについて式41を解くと、式42が得られる。
xb=x0*exp{−(k/ΔT)D*Ta} ……(41)
D=−(logexb−logex0)*ΔT/(k*Ta)
=−(logexb−logex0)*ΔT/k ……(42)
図22に示されている如く、距離xが上記式40に則して変化するよう前輪の舵角δが制御されることにより、案内棒の基準位置P0より案内棒の先端位置P1′まで指数関数の軌跡Teを描いて走行する場合について考える。
案内棒の基準位置P0より目標進路を示す線108に下した垂線の足を交点Q3とする。上記式40により表される指数関数は、目標進路を示す線108を時間に関する座標軸とし、車両104の前後方向を示す線106を距離xに関する座標軸とし、交点Q3を原点とする直交座標に於ける関数である。
位置P1と交点Q3との間の距離及び位置P0と位置交点Q3との間の距離をそれぞれB及びCとすると、距離B及びCはそれぞれ下記の式43及び44により表される。
B=A*cosδ ……(43)
C=A*sinδ
=2R*sinδ*sinδ
=2(WB/δ′)*(sinδ)2 ……(44)
舵角δが小さいときにはsinδはδに等しいと看做されてよいので、上記式44に上記式22を代入すると共にsinδ=δとすることにより、距離Cは下記の式45により表される。また距離Cは時間tが0であるときの距離xの値x0であり、正の値である。よって式45に対応する下記の式46により距離x0を求めることができる。
C=(V/δ)*δ2
=V*δ ……(45)
x0=V*|δ| ……(46)
従って補正係数D及び距離x0をそれぞれ式42及び46により求め、式40に従って距離xを制御することにより、時間Ta=1[sec]が経過するときに車両が実質的に位置P1′に到達するよう、車両を指数関数の軌跡Teに沿って走行させることができる。
次に距離xを上記式40、42及び46に則して変化させることにより、車両の軌跡を好ましい指数関数の軌跡Teに制御するための前輪の舵角の制御について説明する。
まず前輪の舵角δ及び車速Vがそれぞれ一定のδ′及び一定の値に設定されて、車両が案内棒の基準位置P0より案内棒の先端位置P1′まで円弧状の軌跡Tc′を描いて走行する場合の車両の横加速度LAaについて考える。車両のスリップ角が0であるとすると、車両の横加速度LAaは式25により表されるヨーレートYRと車速Vとの積に等しいので、下記の式47により求められる値である。
LAa=YR*V
=V/WB*δ′*V
=V2/WB*δ′
=V2/WB*(2WB/V)*θ/N
=2V*θ/N ……(47)
また車速Vが一定の値に設定され、前輪の舵角δがδbに可変制御されることにより、車両が案内棒の基準位置P0より案内棒の先端位置P1′まで上記式40により表される指数関数の軌跡Teを描いて走行する場合の車両の横加速度LAbについて考える。
図23及び図24に示されている如く、車両が基準位置P0と先端位置P1′との間の位置P3へ移動した状況について、車速Vを距離xに関する座標軸に平行な成分Vxと時間に関する座標軸に平行な成分Vyとに分解すると、式48が成立する。
V=(Vx2+Vy2)1/2 ……(48)
距離xに関する座標軸に平行な成分Vxは式40により表される距離の変化率に等しいので、下記の式49により成分Vxを求めることができる。
Vx=dx/dt
=|d[x0*exp{−(k/ΔT)D*t}]/dt
=|−V*δ*(k/ΔT*D)*exp{−(k/ΔT)D*t}| ……(49)
式48及び式49より、時間に関する座標軸に平行な成分Vyを下記の式50により求めることができることが解る。
Vy=(V2−Vx2)1/2 ……(50)
図24に示されている如く、車両の前後方向を示す線106が距離xに関する座標軸に平行な線112に対しなす角度、即ち距離xに関する座標軸に平行な成分Vxが車速Vに対しなす角度をσとする。車両のスリップ角が0であるとすると、下記の式51が成立する。よって角度σは下記の式52により表される。
tanσ=Vy/Vx ……(51)
σ=tan−1(Vy/Vx) ……(52)
距離xに関する座標軸に平行な成分Vxの車両の横方向の成分をVxxとし、時間に関する座標軸に平行な成分Vyの車両の横方向の成分をVyxとする。車両の横方向の成分Vxx及びVyxはそれぞれ式53及び54により表される。
Vxx=Vx*sinσ ……(53)
Vyx=Vy*cosσ ……(54)
従って車両が指数関数の軌跡Teを描いて走行する場合の車両の横方向の速度Vzは下記の式55により表され、車両の横加速度LAbは下記の式56により表される。
Vz=Vyx−Vxx
=Vy*cosσ−Vx*sinσ ……(55)
LAb=d(Vz)/dt ……(56)
車両が指数関数の軌跡Teを描いて走行する場合の車両の横加速度LAbと車両が円弧状の軌跡Tcを描いて走行する場合の車両の横加速度LAaとの偏差ΔLAは式57により表される。
ΔLA=LAb−LAa ……(57)
車両のヨーレートYRは式25に於けるδ′をδbに置き換えた値であると共に、車両の横加速度LAbを車速Vにて除算した値であるので、式58が成立する。
V/WB*δb=LAb/V ……(58)
よって指数関数の軌跡Teを描くよう車両を走行させるための前輪の舵角δbは下記の式59により求められる。
δb=(LAb/V)/(V/WB)
=(WB/V2)*LAb ……(59)
円弧状の軌跡Tc′を描くよう車両を走行させるための前輪の舵角δa(目標舵角δat=δ′)を基準にして、指数関数の軌跡Teを描くよう車両を走行させるために必要な前輪の舵角の修正量をΔδbとする。前輪の舵角の修正量Δδbは、左旋回時を正とすると、左旋回時については下記の式60により求められ、右旋回時については下記の式61により求められる。
Δδb=(WB/V2)*ΔLA ……(60)
Δδb=−(WB/V2)*ΔLA ……(61)
円弧状の軌跡Tc′を描くよう車両を走行させるための前輪の舵角δaは式24により表される修正後の舵角δ′である。従って指数関数の軌跡Teを描くよう車両を走行させるための前輪の目標舵角δ(暫定の目標舵角)btは、左旋回時については下記の式62により求められ、右旋回時については下記の式63により求められる。
δbt=δ′+Δδb
=(2WB/V)*θ/N+(WB/V2)*ΔLA ……(62)
δbt=δ′+Δδb
=(2WB/V)*θ/N−(WB/V2)*ΔLA ……(63)
4)前輪及び後輪の舵角の制御
以上の説明は、前輪の舵角を制御することにより、目標軌跡に沿って車両を走行させるものである。前輪の舵角の制御による車両の軌跡制御は後輪操舵装置を必要とせず、また前輪及び後輪の舵角の制御による車両の軌跡制御よりも容易である。
しかし上記式12により解る如く、車両のヨーレートYRは車速Vが一定であれば前輪の舵角δによって一義的に定まる。また車両のロール角も車両のヨーレートYRによって一義的に定まる。そのため目標軌跡によっては車両の旋回状態量であるヨーレートYRやロール角が過大になることがある。
前輪及び後輪の舵角の制御によれば、軌跡制御に必要な車両の横加速度を確保しつつ車両のヨーレートYRを前輪のみが舵角制御される場合とは異なる値に制御することができる。よって前輪しか舵角制御されない場合には車両のヨーレートやロール角が過大になる虞れがある状況に於いて、前輪の舵角δf及び後輪の舵角δrの両方を制御することにより、ヨーレートやロール角が過大になることを防止することが考えられる。但しその場合には車両に後輪操舵装置が搭載されている必要がある。
車両のスリップ角Saの微分値、即ちスリップ角速度をSadとすると、車両の横加速度LAは下記の式64により表される。
LA=V(Sad+YR) ……(64)
上記式64のスリップ角速度Sad及びヨーレートYRは下記の式65及び66より演算可能である。尚Mは車両の質量であり、Lf及びLrはそれぞれ前輪車軸及び後輪車軸と車両の重心との間の車両前後方向の距離である。またIは車両のヨー慣性モーメントであり、Cf及びCrはそれぞれ前輪及び後輪のコーナリングパワーである。更にYRdはヨーレートYRの微分値であり、sはラプラス演算子である。
また各係数a11、a12、b11、b12、a21、a22、b21、b22は下記の通りである。
よってラプラス演算子sの項を無視すると、スリップ角速度Sad及びヨーレートYRは下記の式67及び68により表される。但し係数Ca〜Cdは上記式65及び66をスリップ角速度Sad及びヨーレートYRについて解くことにより求まる一定の係数である。
Sad=Ca*δf+Cb*δr ……(67)
YR=Cc*δf+Cd*δr ……(68)
上記式64及び67より、下記の式69が成立する。
LA/V−YR=Sad
=Ca*δf+Cb*δr ……(69)
従って前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるときには、上記各式のヨーレートYRを制限することにより、ヨーレートYRが過大になることを防止しつつ車両の横加速度LAを目標軌跡の達成に必要な値にすることができる。即ち上記式68及び69に於けるヨーレートYRを前輪のみの舵角制御の場合の値よりも大きさが小さい値に設定することにより、ヨーレートが過大になることを防止しつつ目標軌跡を達成するに必要な前輪の舵角δf及び後輪の舵角δrを演算することができる。
また車両の重心高さをHとし、車両のロール剛性をKrとし、重力加速度をgとすると、定常的な車両のロール角Rvは下記の式70により表される。
Rv=M*H*V*YR/(Kr−Mg*H) ……(70)
よって上記式70のヨーレートYRに上記式68及び69のYRを代入することにより、Ce〜Chを一定の係数として、車両のロール角Rvは下記の式71及び72により表される。
Rv=Ce*δf+Cf*δr ……(71)
Rv=Kg*V*LA−(Cg*δf+Ch*δr)V ……(72)
但し係数Kg、Cg及びChはそれぞれ下記の式にて表される定数である。
Kg=M*H*/(Kr−Mg*H)
Cg=Kg*Ca
Ch=Kg*Cb
従って前輪のみの舵角制御ではロール角Rvが過大になる虞れがあるときには、上記二つの式のロール角Rvを制限することにより、ロール角Rvが過大になることを防止しつつ車両の横加速度LAを目標軌跡の達成に必要な値にすることができる。即ち上記式71及び72に於いてロール角Rvを前輪のみの舵角制御の場合の値よりも大きさが小さい値に設定することにより、ロール角Rvが過大になることを防止しつつ目標軌跡を達成するに必要な前輪の舵角δf及び後輪の舵角δrを演算することができる。
5)旋回状態量の制限方法
以上の説明より解る如く、車両の旋回状態量であるヨーレートやロール角が過大になる虞れがあるときには、前輪の舵角δf及び後輪の舵角δrの両方を適宜に制御することにより、ヨーレートやロール角が過大になることを防止することができる。
前述の如く指数関数の軌跡Teを描くよう車両を走行させるための前輪の暫定の目標舵角δbtを上記式62又は63により求めることができる。また上記式12より解る如く、車速Vが一定であれば前輪の舵角δと車両のヨーレートYRとの間には一義的な関係がある。よって前輪の目標舵角δbtが求められれば、車両が目標軌跡の終点である目標到達位置に到達するまでのヨーレートYRやロール角Rvを前輪の目標舵角δbtに基づいて上記式12及び70により予め推定することができる。
よって推定されるヨーレート及びロール角をそれぞれYRa、Rvaとして、推定されるヨーレートYRaやロール角Rvaの大きさの最大値が基準値を越えるか否かの判定により、ヨーレートやロール角が過大になる虞れがあるか否かを判定することができる。またヨーレートやロール角が過大になる虞れがあるときには、下記の何れかの方法によって前輪のみの舵角制御から前後輪の舵角の制御へ切り替えることにより、ヨーレートやロール角が過大になることを防止することができる。
図24に於いて破線にて示されている如く、推定されるヨーレートYRaの大きさが時点tc1からtc2までの区間に於いて基準値YRrefを越える場合について、旋回状態量の二つの制限方法を説明する。
尚基準値YRrefは定数であってもよいが、車速Vが高いほど許容される車両のヨーレートの大きさは小さくなる。よって図31に示されている如く、基準値YRrefは車速Vが高いときには車速Vが低いときに比して小さくなるよう、車速Vに応じて可変設定されることが好ましい。
5−1)旋回状態量の上限値による制限
旋回状態量であるヨーレートを上限値によって制限するものであり、制限による影響を低減する方法によって、片側部分領域補正、両側部分領域補正、片側全領域補正、両側全領域補正に分類される。
5−1−1)片側部分領域補正
時点tc1からtc2までの区間に於いては、推定ヨーレートYRaが基準値YRrefに補正される。そして補正後の推定ヨーレートYRaaに基づいて上記式68及び69に対応する下記の式73及び74に従ってそれぞれ前輪の目標舵角δft及び後輪の目標舵角δrtが演算される。よって時点tc1からtc2までの区間に於いては、ヨーレートYRは図24に於いて実線にて示されている如く基準値YRrefを上限値として制限されるので、基準値YRrefを越えることはない。
YRaa=Cc*δft+Cd*δrt ……(73)
LA/V−YRaa=Ca*δft+Cb*δrt ……(74)
かくしてヨーレートYRが制限されると、軌跡制御の開始又は更新の時点t0から軌跡制御が終了する時点teまでに於けるヨーレートYRの積分値YRintが、ヨーレートYRの制限が行われない場合のヨーレートYRの積分値Rint0よりも小さい値になる。換言すれば軌跡制御が終了する時点に於ける車両の向きが本来あるべき向きとは異なることになる。
よって時点tc2から時点teまでの区間の少なくとも何れかの領域に於いて、推定ヨーレートYRaが増大補正され、積分値YRintが積分値Rint0に近付けられることが好ましい。そして前輪の目標舵角δft及び後輪の目標舵角δrtは補正後の推定ヨーレートYRaaに基づいて上記式73及び74に従って演算されることが好ましい。
この場合図24に於いて実線にて示されている如く、時点tc1からtc2までの区間に於ける推定ヨーレートYRaと基準値YRrefとの偏差ΔYRaがそのまま時点tc2以降の推定ヨーレートYRaに加算されてよい。
例えば時点tc1から時点tc2までの制御サイクルがiサイクルあるとし、iは1〜n(正の整数)とする。時点tc1から時点tc2までの各サイクルの偏差ΔYRaiが演算され、時点tc2から時点tc3までの各サイクルの推定ヨーレートYRaiに偏差ΔYRaiが順次加算されることにより各サイクルの補正後の推定ヨーレートYRaaが演算される。
また一般的には時点tc3から制御が終了する時点teまでの時間は時点tc1からtc2までの時間よりも長く、時点tc3から時点teまでの区間に於いては推定ヨーレートの補正は不要である。よって時点tc1から時点tc3までの区間に於いて推定ヨーレートが補正され、前輪及び後輪の両方の舵角の制御により軌跡制御が行われる。しかし時点t0から時点tc1まで及び時点tc3から時点teまでの区間に於いては推定ヨーレートは補正されず、暫定の目標舵角δbtに基づく前輪のみの舵角制御により軌跡制御が行われる。
5−1−2)両側部分領域補正
また図25に於いて実線にて示されている如く、偏差ΔYRaが前半の補正量ΔYRaf及び後半の補正量ΔYRarに分割されてよい。そして前半の補正量ΔYRafが時点tc1より前の一部の領域の推定ヨーレートYRaに加算され、後半の補正量ΔYRarが時点tc2以降の一部の領域の推定ヨーレートYRaに加算されてよい。この両側部分域補正によれば、片側部分領域補正の場合に比して加算補正に起因してヨーレートが不自然に変化する虞れを低減することができる。
尚補正量ΔYRaf及びΔYRarは偏差ΔYRaの2分の1であってもよく、また例えば時点t0からtc1までの時間と時点tc2から制時点teまでの時間との比に比例して偏差ΔYRaが配分された値であってもよい。
5−1−3)片側全領域補正
また図26に於いて実線にて示されている如く、時点tc2から時点teまでの区間の全領域に於いて、ヨーレートの加算補正が行われてもよい。そしてその補正後の推定ヨーレートYRaaに基づいて上記式73及び74に従って目標舵角δft及びδrtが演算される。この片側全領域補正によれば、片側部分領域補正の場合に比して加算補正に起因してヨーレートが不自然に変化する虞れを低減することができる。
尚片側全領域補正に於いては、図32に示されている如く、偏差ΔYRaの変化時間が時点tc1から時点tc2までの時間より時点tc2から時点teまでの時間に修正されることにより、時点tc2から時点teまでの各サイクルの補正量ΔYRaiが演算される。そして時点tc2から時点teまでの各サイクルの推定ヨーレートYRaiに補正量ΔYRaiが順次加算されることにより各サイクルの補正後の推定ヨーレートYRaaが演算されてよい。
また片側全領域補正の場合には、時点tc2から時点teまでの区間の全領域に於いて推定ヨーレートの加算補正が行われるので、時点tc2から時点teまでの区間に於いて前輪及び後輪の両方の舵角の制御により軌跡制御が行われる。
5−1−4)両側全領域補正
また図27に於いて実線にて示されている如く、前半の補正量ΔYRafが時点tc1より前の全領域の推定ヨーレートYRaに加算され、後半の補正量ΔYRarが時点tc2以降の全領域の推定ヨーレートYRaに加算されてよい。この両側全領域補正によれば、両側部分領域補正の場合に比して加算補正に起因してヨーレートが不自然に変化する虞れを低減することができる。
尚両側全領域補正に於いても図33に示されている如く片側全領域補正の場合と同様の変化時間の修正が行われる。また補正量ΔYRaf及びΔYRarは偏差ΔYRaの2分の1であってもよく、また例えば時点t0からtc1までの時間と時点tc2から制時点teまでの時間との比に比例して偏差ΔYRaが配分された値であってもよい。
また図24〜27に於いて二点鎖線にて示されている如く、ヨーレートYRは基準値YRrefよりも所定値ΔYRlim小さい制限値YRlimに制限されてもよい。またこの場合には制限は時点tc1よりも早い時点tc1′から時点tc2よりも遅い時点tc2′までの区間に於いて行われる。また所定値ΔYRlimは正の定数であってもよいが、例えば車速Vが高いほど大きくなるよう車速Vに応じて可変設定されてもよい。
また上述の推定ヨーレートの各補正に於いては、推定ヨーレートYRaの増大補正の積分値は推定ヨーレートYRaの制限による低減補正の積分値と同一であるが、増大補正の積分値は低減補正の積分値よりも小さくてもよい。但し軌跡制御が終了する時点に於ける車両の向きが本来あるべき向きとは異なる度合を低減するためには、増大補正の積分値は低減補正の積分値の90%以上で100%以下、特に95%以上で100%以下であることが好ましい。また低減補正の積分値に対する増大補正の積分値の比は車速Vが高いときには車速Vが低いときに比して高いことが好ましい。尚このことは後述の「旋回状態量のピーク低減による制限」についても同様である。
5−2)旋回状態量のピーク低減による制限
また図28に示されている如く、推定ヨーレートYRaの大きさの最大値YRamaxが基準値YRrefを越える場合には、まず基準値YRrefよりも所定値ΔYRdec小さい補正判定値YRdecが設定される。そして推定ヨーレートYRaが補正判定値YRdecになる時点tp1及びtp2が決定される。尚所定値ΔYRdecは正の定数であってもよいが、例えば車速Vが高いほど大きくなるよう車速Vに応じて可変設定されてもよい。
図34乃至図36の破線はピーク低減による制限に使用されるゲインGpを示している。ゲインGpは、1より増大した後1に減少する第一の増大補正区間と、1より減少した後1に増大する減少補正区間と、1より増大した後1に減少する第二の増大補正区間とを有している。尚第一及び第二の増大補正区間の「Gp−1」の積分値の和は減少補正区間の「1−Gp」の積分値に等しい。
次に最大値YRamaxの大きさと基準値YRrefとの偏差ΔYRamaxが演算されると共に、偏差ΔYRamaxに基づいてゲインGpに対する正の補正係数Kpが演算される。この場合補正係数Kpは偏差ΔYRamaxが大きいときには偏差ΔYRamaxが小さいときに比して大きくなるよう演算される。
またゲインGpに補正係数Kpが乗算されることによる大きさの補正が行われると共に、時間の補正が行われることにより、ゲインの適合化が行われる。時間の補正に於いては、時点tg0及びtgeがそれぞれ時点t0及びteと一致し、第一の増大補正区間と減少補正区間との間の時点tg1及び減少補正区間と第二の増大補正区間との間の時点tg2がそれぞれ時点tp1及びtp2と一致するよう時間が調整される。両側全領域補正によるゲインGpの適合化の一例が図34に示されている。また前側の片側全領域補正によるゲインGpの適合化の一例が図35に示されている。更に後側の片側全領域補正によるゲインGpの適合化の一例が図36に示されている。
次いで各サイクルについて推定ヨーレートYRaに適合化後のゲインGpaが乗算されることにより補正後の推定ヨーレートYRaaが演算される。更に補正後の推定ヨーレートYRaaに基づいて上記式73及び74に従って前輪の目標舵角δft及び後輪の目標舵角δrtが演算される。
補正後の推定ヨーレートYRaaの例が両側全領域補正、前側の片側全領域補正、後側の片側全領域補正についてそれぞれ図28乃至図30に於いて実線にて示されている。これらの図より解る如く、ピーク低減による制限によれば、補正後の推定ヨーレートYRaaは基準値YRrefを越えないので、車両のヨーレートYRが基準値YRrefを越えることはない。また「旋回状態量の上限値による制限」の場合に比して、補正後の推定ヨーレートYRaa及びヨーレートYRを推定ヨーレートYRaの変化に近い態様にて変化させることができる。
図28に於いては、時点tg0が時点t0と一致し、時点tgeが時点teと一致しているが、時点tg0は時点t0と時点tp1との間に設定され、時点tgeは時点tp2と時点teとの間に設定されてもよい(両側部分領域補正)。また図29に於いては、時点tg0が時点t0と一致しているが、時点tg0は時点t0と時点tp1との間に設定されてもよい(前側の片側部分領域補正)。また図30に於いては、時点tgeが時点teと一致しているが、時点tgeは時点tp2と時点teとの間に設定されてもよい(後側の片側部分領域補正)。
尚軌跡制御の開始又は更新より終了に至るまでの過程で推定ヨーレートYRaが2以上の領域に於いて基準値YRrefを越えることはまれである。しかしそのような場合には、旋回状態量の上限値による制限又はピーク低減による制限が各領域について行われてよい。但し相前後する二つの制限の増減補正の領域が重複する場合には、それらの領域が重複しないよう境界の時点が適宜に設定される。
また前述の如く車両のヨーレートの制限によってロール角Rvの大きさを低減することができる。よって推定されるロール角Rvaの大きさが基準値Rvrefを越える場合にも、ヨーレートの上限値による制限又はヨーレートのピーク低減による制限により、車両のロール角Rvが過大になることを防止することができる。
この場合基準値Rvrefは正の定数であってよいが、車速Vが高いほど許容される車両のロール角の大きさは小さくなる。よって図37に示されている如く、基準値Rvrefも車速Vが高いときには車速Vが低いときに比して小さくなるよう、車速Vに応じて可変設定されることが好ましい。
6)舵角の制御方法
以上の説明より解る如く、式24により表される舵角δ′を目標舵角として前輪の舵角δを制御することにより、円弧状の軌跡Tc′を描くよう車両を走行させることができる。また式62又は63により求められる目標舵角δbtになるよう前輪の舵角δを制御することにより、車両を指数関数の軌跡に沿って走行させることができる。更に式67及び69により求められる舵角δf及びδrをそれぞれ前輪の目標舵角δft及び後輪の目標舵角δrtとして前後輪の舵角を制御することにより、車両のヨーレートやロール角を抑制しつつ車両を指数関数の軌跡に沿って走行させることができる。
前輪及び後輪の何れの場合にも、舵角を目標舵角に制御する方法として、フィードフォワード制御及びフィードバック制御の何れも可能であり、それぞれに利点がある。
フィードフォワード制御は、軌跡の制御を開始すべきと判定したとき(制御開始時)に目標舵角を演算すると共に、制御開始後に車輪の舵角が運転者の操舵操作によって大きく変更されることがないことを前提に、車輪の舵角を目標舵角に制御するものである。
フィードフォワード制御の場合には、運転者が操舵操作をしなくても車両の軌跡を目標の軌跡にすることができるので、この制御は車両運転の習熟度が高い運転者よりも車両運転の習熟度が低い運転者に適した制御である。
これに対しフィードバック制御は、制御開始時に目標舵角を演算すると共に、車輪の舵角が制御開始後に操舵操作によって変更される場合があることを前提に、実際の舵角と目標舵角との偏差を低減することにより車輪の舵角を目標舵角に制御するものである。
フィードバック制御の場合には、運転者が操舵操作をしても車両の軌跡を目標の軌跡にすることができるので、この制御は車両運転の習熟度が低い運転者よりも車両運転の習熟度が高い運転者に適した制御である。
尚、車輪の舵角を目標舵角に制御する方法がフィードフォワード制御及びフィードバック制御の何れである場合にも、予め設定された軌跡制御の更新条件が成立すると、目標軌跡が更新されることにより軌跡制御が更新される。
7)前輪の舵角の制御装置
車両の軌跡を目標の軌跡に制御するためには、運転者の操舵操作とは独立に車輪を転舵することによって車輪の舵角を修正し目標舵角に制御することができる舵角制御装置が必要である。
前輪のための舵角制御装置として、ステアリングホイールの如き操舵入力手段と操舵輪である前輪とが機械的に連結された機械的舵角制御装置と、操舵入力手段と前輪とが機械的に連結されていない非機械的舵角制御装置とがある。
機械的舵角制御装置はアクチュエータによって操舵入力手段に対し相対的に前輪を転舵駆動するものであり、例えばステアリングギヤ比可変装置(VGRS)を備えたセミステアバイワイヤ式の操舵装置がこれに属する。
非機械的舵角制御装置は操舵入力手段と前輪を転舵駆動する駆動手段とが相互に独立し、両者が制御装置を介して電気的に接続されたものであり、例えばステアバイワイヤ式の操舵装置がこれに属する。
尚後輪のための舵角制御装置は、一般に操舵入力手段と後輪とが機械的に連結されていない非機械的舵角制御装置である。
8)軌跡の制御の分類と実施形態
以上の説明より解る如く、旋回状態量の制限方法が上限値による制限であるか否かによって、また舵角の制御がフィードフォワード(FF)制御であるかフィードバック(FB)制御であるかによって、本発明による軌跡の制御を分類分けすることができる。また舵角制御装置が機械的舵角制御装置であるか否かによって、本発明による軌跡の制御を更に分類分けすることができる。
後述の第一乃至第八の実施形態は、上記分類項目に従ってそれぞれ下記の表1及び表2の通り分類されるものである。尚表1及び表2はそれぞれ舵角制御装置が機械的舵角制御装置である場合及び非機械的舵角制御装置である場合を示している。
尚後述の第一乃至第八の何れの実施形態に於いても、アンチスキッド制御等の他の車両の走行制御が実行されているときには、軌跡制御は開始されない。また軌跡制御が実行されている状況に於いてアンチスキッド制御等の他の車両の走行制御の開始条件が成立したときには、軌跡制御は終了され、当該他の車両の走行制御が開始される。
9)機械的舵角制御装置の場合の操舵反力の制御
車両が定常円旋回する場合の旋回半径Rは上記式15により表される。また車両の軌跡の曲率をρとすると、旋回半径Rは下記の式75により表される。
R=1/ρ ……(75)
よって前輪の舵角δは下記の式76により表される。
δ=WB/R
=ρ*WB ……(76)
前輪のキャスタートレールとニューマチックトレールとの和をLt[m]とし、前輪のコーナリングパワーをKf[Nm/rad]とすると、舵角がδ[rad]である前輪のキングピン軸周りのトルクTsは下記の式77により表される。
Ts =−2Lt*Kf*δ ……(77)
操舵入力手段としてのステアリングホイールに於けるトルク、即ち操舵トルクをThとすると、前輪のキングピン軸周りのトルクTsは、ステアリングギヤ比N(上記式23参照)を使用して下記の式78により表される。
Ts =Th*N ……(78)
上記式77及び78より下記の式79が成立する。よって操舵トルクThは下記の式80により表される。
Th*N=−2Lt*Kf*δ ……(79)
Th=−2Lt*Kf*δ/N ……(80)
式80はパワーアシストによって操舵トルクが軽減されない場合に於ける前輪の舵角δと操舵トルクThとの関係を示している。よって式80に式23を代入することにより得られる下記の式81により表されるThtは、前輪の舵角が本来の舵角δであるときの操舵トルク、即ち軌跡制御による前輪の舵角の修正が行われない場合の操舵トルクである。
Tht=−2Lt*Kf*θ/N2 ……(81)
前述の如く、目標軌跡が指数関数である場合には、前輪の舵角は本来の舵角δであるべき状況に於いて式62又は63の目標舵角δbtに制御される。従って前輪の舵角が目標舵角δbtであるときの操舵トルクThbtは下記の式82により表される。
Thbt=−2Lt*Kf*δbt/N
=−2Lt*Kf*(δ′+Δδb)/N ……(82)
よって軌跡制御に伴う前輪の舵角の制御による操舵トルクの変動量ΔThbtは、式82により表される操舵トルクThbtと式81により表される操舵トルクThとの偏差であるので、下記の式83により表される。
ΔThbt=Thbt−Th
=−2Lt*Kf*(δ′+Δδb)/N+2Lt*Kf*δ/N
=−2Lt*Kf*{(2WB/V)δ+Δδb}/N+2Lt*Kf*δ/N
=−2Lt*Kf*{(2WB/V+1)δ+Δδb}/N ……(83)
下記の式84に従ってトルクセンサにより検出される操舵トルクThdから操舵トルクの変動量ΔThbtを減算することにより求められる補正後の検出操舵トルクThdbは、前輪の舵角の制御による操舵トルクの変動分が排除された操舵トルクである。
Thdb=Thd−ΔThbt
=Thd+2Lt*Kf*{(2WB/V+1)δ+Δδb}/N ……(84)
従って補正後の検出操舵トルクThdbに基づいて運転者の操舵負担軽減トルクTpadを演算することにより、前輪の舵角の修正に起因する操舵トルクの変動の影響を排除することができる。そして運転者の操舵負担軽減トルクTpadと操舵トルクの変動量ΔThbtとの和を目標アシストトルクTpatとすることにより、前輪の舵角の修正に起因する操舵トルクの変動の影響を排除しつつ運転者の操舵負担を軽減することができる。尚操舵負担軽減トルクTpadは、補正後の検出操舵トルクThdbの大きさが大きいほど大きくなり、車速Vが高いほど小さくなるよう、補正後の検出操舵トルクThdb及び車速Vに基づいて演算されてよい。
上述の操舵反力の制御によれば、操舵トルクThdを検出する必要はあるが、操舵操作以外の要因による操舵トルクの変動を反映させることができる。よって舵角制御装置が機械的舵角制御装置である後述の第一及び第二の実施形態に於いては、上述の手順に従って目標アシストトルクTpatが演算され、アシストトルクが目標アシストトルクTpatになるよう制御される。
尚舵角制御装置が機械的舵角制御装置である場合には、軌跡制御が行われない状況に於いては、運転者の操舵負担軽減トルクTpadは検出される操舵トルクThdに基づいて演算される。
10)非機械的舵角制御装置の場合の操舵反力の制御
上記式870により表される操舵トルクThtを基準トルクとし、例えばトルクセンサにより検出される操舵トルクをThdとすると、下記の式85により表される操舵トルクの偏差ΔThは前輪の舵角の修正に起因する操舵トルクの変動分を表す。
ΔTh=Thd−Tht ……(85)
よって検出される操舵トルクThdから前輪の舵角の修正に起因する操舵トルクの変動分ΔThが除去された操舵トルク、即ち前輪の舵角の修正に起因する操舵トルクの変動分を含まない操舵トルクTh0は下記の式86により表される。
Th0=Thd−ΔTh
=Tht
=−2Lt*Kf*θ/N2 ……(86)
上記式85により表される補正後の検出操舵トルクTh0は、舵角制御装置が機械的舵角制御装置であり操舵角がθである場合に於いて前輪の舵角の修正に起因する操舵トルクの変動分を含まない操舵トルクである。よって補正後の検出操舵トルクTh0から操舵負担軽減トルクTpadを減算した値は、舵角制御装置が機械的舵角制御装置である場合に於いて運転者にとって好ましい操舵トルクである。尚この場合の操舵負担軽減トルクTpadは、補正後の検出操舵トルクTh0の大きさが大きいほど大きくなり、車速Vが高いほど小さくなるよう、補正後の検出操舵トルクTh0及び車速Vに基づいて演算されてよい。
従って舵角制御装置が非機械的舵角制御装置である場合に於いて好ましい操舵トルクThbtは下記の式87により演算される値である。この操舵トルクThbtがステアリングホイールに与えられれば、前輪の舵角の修正に起因する操舵トルクの変動の影響がなく且つ運転者が適度の操舵負担を感じる操舵反力トルクを実現することができる。
Thbt=Th0−Tpad ……(87)
よって舵角制御装置が非機械的舵角制御装置である後述の第三及び第四の実施形態に於いては、目標操舵トルクTpbtが上記式87に従って演算され、操舵トルクが目標操舵トルクTpbtになるよう制御される。
尚舵角制御装置が非機械的舵角制御装置である場合には、軌跡制御が行われない状況に於ける操舵反力の制御は軌跡制御が行われる状況に於ける上記操舵反力の制御と同一である。換言すれば、軌跡制御が行われているか否かに関係なく操舵トルクは目標操舵トルクTpbtになるよう制御される。
次に添付の図を参照しつつ、本発明を第一乃至第八の実施形態について順次説明する。
第一の実施形態
この第一の実施形態は上記表1に示されている如く以下の特徴を有する。
舵角制御装置:セミバイワイヤ式
目標軌跡:指数関数
前輪舵角の制御:フィードフォワード
旋回状態量の制限方法:ヨーレートの上限値による制限
図1は舵角可変装置、後輪操舵装置及び電動式パワーステアリング装置が搭載された車両に適用された本発明による車両の走行制御装置の第一の実施形態を示す概略構成図である。
図1に於いて、符号10は本発明の第一の実施形態の走行制御装置を全体的に示している。走行制御装置10は車両12に搭載され、舵角可変装置14及びこれを制御する電子制御装置16を含んでいる。また図1に於いて、18FL及び18FRはそれぞれ車両12の左右の前輪を示し、18RL及び18RRはそれぞれ左右の後輪を示している。左右の前輪18FL及び18FRは操舵輪であり、運転者によるステアリングホイール20の操舵操作に応答して駆動されるラック・アンド・ピニオン型の電動式パワーステアリング装置22によりラックバー24及びタイロッド26L及び26Rを介して転舵される。
ステアリングホイール20は操舵入力手段として機能し、アッパステアリングシャフト28、舵角可変装置14、ロアステアリングシャフト30、ユニバーサルジョイント32を介してパワーステアリング装置22のピニオンシャフト34に駆動接続されている。図示の実施形態に於いては、舵角可変装置14はハウジング14Aの側にてアッパステアリングシャフト28の下端に連結され、回転子14Bの側にてロアステアリングシャフト30の上端に連結された補助転舵駆動用の電動機36を含んでいる。
かくして舵角可変装置14はアッパステアリングシャフト28に対し相対的にロアステアリングシャフト30を回転駆動することにより、左右の前輪18FL及び18FRをステアリングホイール20に対し相対的に補助転舵駆動する。よって舵角可変装置14は運転者の操舵操作に依存せずに左右の前輪の舵角を修正する手段として機能し、電子制御装置16の舵角制御部により制御される。
図示の実施形態に於いては、電動式パワーステアリング装置22はラック同軸型の電動式パワーステアリング装置であり、電動機38と、電動機38の回転トルクをラックバー24の往復動方向の力に変換する例えばボールねじ式の変換機構40とを有する。電動式パワーステアリング装置22は電子制御装置16の電動式パワーステアリング装置(EPS)制御部によって制御される。そして電動式パワーステアリング装置22はハウジング42に対し相対的にラックバー24を駆動する補助操舵力を発生することにより、運転者の操舵負担を軽減する補助操舵力発生装置として機能する。尚補助操舵力発生装置は当技術分野に於いて公知の任意の構成のものであってよい。
図示の実施形態に於いては、アッパステアリングシャフト28には該アッパステアリングシャフトの回転角度を操舵角θとして検出する操舵角センサ50及び操舵トルクThdを検出する操舵トルクセンサ52が設けられており、操舵角θ及び操舵トルクThdを示す信号は電子制御装置16へ入力される。電子制御装置16には回転角度センサ54により検出された舵角可変装置14の相対回転角度θre、即ちアッパステアリングシャフト28に対するロアステアリングシャフト30の相対回転角度を示す信号、車速センサ56により検出された車速Vを示す信号が入力される。
更に図示の実施形態に於いては、左右の後輪18RL及び18RRは、運転者による左右の前輪18FL及び18FRの操舵とは無関係に、後輪操舵装置60の電動式のステアリング装置62によりタイロッド64L及び64Rを介して操舵可能である。後輪操舵装置60は後に詳細に説明する如く電子制御装置16の後輪操舵制御部により制御される。電子制御装置16の後輪操舵制御部には舵角センサ66により検出された後輪の舵角δrを示す信号が入力される。
尚電子制御装置16の各制御部はそれぞれCPUとROMとRAMと入出力ポート装置とを有し、これらが双方向性のコモンバスにより互いに接続されたマイクロコンピュータを含むものであってよい。また操舵角センサ50、操舵トルクセンサ52、回転角度センサ54、舵角センサ66はそれぞれ車両の左旋回方向への操舵又は転舵の場合を正として操舵角θ、操舵トルクThd、相対回転角度θre、後輪の舵角δrを検出する。
後に詳細に説明する如く、電子制御装置16は図2乃至図5に示されたフローチャートに従って舵角可変装置14、後輪操舵装置60及び電動式パワーステアリング装置22を制御する。特に電子制御装置16は、操舵角θ及び車速Vに基づき車両の軌跡制御の必要性を判定する。そして電子制御装置16は、軌跡制御が不要であると判定したときには、車速Vが高いほど大きくなるよう、車速Vに基づき所定の操舵特性を達成するための目標ステアリングギヤ比Ntを演算する。
また電子制御装置16は、目標ステアリングギヤ比Ntとギヤ比係数Ks(正の定数)との積にて操舵角θを除算した値を目標ピニオン角θptとして演算する。更に電子制御装置16は、目標ピニオン角θptと操舵角θとの偏差として舵角可変装置14の目標相対回転角度θretを演算し、舵角可変装置14の相対回転角度θreが目標相対回転角度θretになるよう舵角可変装置14を制御する。
また電子制御装置16は、軌跡制御が不要であると判定したときには、後輪の舵角δrが0でない場合には0になるよう、また後輪の舵角δrが0である場合にはその舵角が維持されるよう、後輪操舵装置60を制御する。
また電子制御装置16は、軌跡制御が必要であると判定したときには、そのときの操舵角θ及び車速Vに基づき車両を指数関数の目標軌跡に沿って走行させるための前輪の目標舵角δbtを上記式62又は64に従って演算する。
また電子制御装置16は上記式12に対応する下記の式88に従って前輪の目標舵角δbtに基づいて推定ヨーレートYRaを演算する。そして電子制御装置16は、推定ヨーレートYRaの大きさの最大値YRamaxが基準値YRrefを越えるか否かの判別により、前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるか否かを判定する。
YRa=V/WB*δbt ……(88)
電子制御装置16はヨーレートYRが過大になる虞れがないと判定したときには、前輪の目標舵角δftを前輪の目標舵角δbtに設定し、左右前輪の舵角が目標舵角δftになるよう舵角可変装置14をフィードフォワード式に制御する。また電子制御装置16は後輪の舵角δrを0に維持する。
これに対し電子制御装置16は、ヨーレートYRが過大になる虞れがあると判定したときには、推定ヨーレートYRaが補正されるべき領域については上記「旋回状態量の上限値による制限」の何れかの方法により補正後の推定ヨーレートYRaaを演算する。そして電子制御装置16は、上記式73及び74に従って前輪の目標舵角δft及び後輪の目標舵角δrtを演算し、それぞれ前輪の目標舵角δft及び後輪の目標舵角δrtに基づいて舵角可変装置14及び後輪操舵装置60を制御する。
尚ヨーレートYRが過大になる虞れがあると判定した場合であっても、推定ヨーレートYRaが補正される必要がない領域については、電子制御装置16は前輪の目標舵角δbtを前輪の目標舵角δftに設定する。そして電子制御装置16は左右前輪の舵角が目標舵角δftになるよう舵角可変装置14を制御し、後輪の舵角δrを0に維持する。
また電子制御装置16は、軌跡制御の実行中には上記式84に従って補正後の検出操舵トルクThdbを演算し、補正後の検出操舵トルクThdbに基づいて運転者の操舵負担軽減トルクTpadを演算する。また電子制御装置16は、上記式83に従って操舵トルクの変動量ΔThbtを演算し、運転者の操舵負担軽減トルクTpadと操舵トルクの変動量ΔThbtとの和を目標アシストトルクTpbtとする。更に電子制御装置16は、アシストトルクが目標アシストトルクTpbtになるよう電動式パワーステアリング装置22を制御し、これにより運転者の操舵負担を軽減すると共に舵角の修正に起因する操舵トルクの変動を低減する。
尚、軌跡制御が不要であるときのステアリングギヤ比の制御、後輪の舵角の制御、アシストトルクの制御自体は本発明の要旨をなすものではなく、これらの制御は当技術分野に於いて公知の任意の要領にて実行されてよい。このことは後述の他の実施形態についても同様である。
次に図2乃至図5に示されたフローチャートを参照して第一の実施形態に於ける車両の走行制御について説明する。尚図2に示されたフローチャートによる走行制御は、図には示されていないイグニッションスイッチの閉成により開始され、所定の時間毎に繰返し実行される。
まずステップ50に於いては車両の軌跡制御が実行されているか否かを示すフラグFcが1であるか否かの判別により、軌跡制御の実行中であるか否かの判別が行われる。軌跡制御が実行されていないと判別されたときには制御はステップ350へ進み、軌跡制御が実行されていると判別されたときには制御はステップ200へ進む。尚フラグFc及び後述のフラグFsは図2に示されたフローチャートによる走行制御の開始に先立ってそれぞれ0にリセットされる。
ステップ200に於いては車両の走行制御のうち軌跡制御の終了条件が成立しているか否かの判別が行われる。そして肯定判別が行われたときには制御はステップ250へ進み、否定判別が行われたときには制御はステップ450へ進む。尚この場合下記の(1)乃至(4)の何れかが成立するときに軌跡制御の終了条件が成立していると判定されてよい。
(1)軌跡制御の開始条件又は更新条件(これらについては後述する)が成立した時点より車両が目標到達地点に到達するに要する時間Ta=1[sec]以上が経過している。
(2)開始条件又は更新条件が成立した時点に於ける車速Vと現在の車速Vとの偏差ΔVの絶対値が基準値Ve(正の値)よりも大きい。
(3)開始条件又は更新条件が成立した時点に於ける操舵角θと現在の操舵角θとの偏差Δθの絶対値が基準値θe(正の値)よりも大きい。
(4)操舵角速度の絶対値、即ち操舵角θの変化率θdの絶対値が基準値θde(正の値)よりも大きい。
尚基準値θe及びθdeは定数であってもよいが、例えば開始条件又は更新条件が成立した時点に於ける車速Vが高いほど小さくなるよう車速Vに応じて可変設定されてもよい。
ステップ250に於いては舵角可変装置14によって前輪の舵角δfを目標舵角δftにすると共に後輪操舵装置60によって後輪の舵角δrを目標舵角δrtにする制御が終了されることにより軌跡制御が終了される。また軌跡制御が実行されているか否かを示すフラグFcが0にリセットされ、しかる後制御はステップ700へ進む。
ステップ350に於いては図3に示されたフローチャートに従って軌跡制御の開始条件が成立しているか否かの判別が行われる。そして肯定判別が行われたときには制御はステップ500へ進み、否定判別が行われたときには制御はステップ700へ進む。
ステップ450に於いては図4に示されたフローチャートに従って軌跡制御の更新条件が成立しているか否かの判別が行われる。そして肯定判別が行われたときには制御はステップ500へ進み、否定判別が行われたときには制御はステップ600へ進む。
ステップ500に於いては図5に示されたフローチャートに従って前輪の目標舵角δbtが演算され、また目標舵角δbtに基づいて車両の推定ヨーレートYRaが演算される。また推定ヨーレートYRaに基づいてヨーレートが過大になる虞れがあるか否かが判定され、その判定結果に応じて前輪の目標舵角δft及び後輪の目標舵角δrtが演算される。
ステップ600に於いては前輪の舵角δfが目標舵角δftになるよう舵角可変装置14がフィードフォワード式に制御されると共に、後輪の舵角δrが目標舵角δrtになるよう後輪操舵装置60がフィードフォワード式に制御される。
尚この場合、前輪及び後輪の舵角の変化が急激にならないよう、前輪及び後輪の舵角はそれぞれ予め設定された制限値以下の変化率にて目標舵角へ変化される。このことは後述の他の実施形態に於いても同様である。
ステップ700に於いては軌跡制御が実行されないときのステアリングギヤ比の制御が行われる。即ち車速Vに基づいて図6に示されたグラフに対応するマップより目標ステアリングギヤ比Ntが演算される。尚図6に於いて、N0は標準のステアリングギヤ比、即ちアッパステアリングシャフト28に対するロアステアリングシャフト30の相対回転角度が0であるときのステアリングギヤ比を示している。
また操舵角θとギヤ比係数Ks(左右前輪の舵角の変化量に対するピニオン34の回転角度の比に対応する正の定数)との積を目標ステアリングギヤ比Ntにて除算した値が目標ピニオン角θptとして演算される。更に目標ピニオン角θptと操舵角θとの偏差として舵角可変装置14の目標相対回転角度θretが演算され、舵角可変装置14の相対回転角度θreが目標相対回転角度θretになるよう舵角可変装置14が制御される。
尚軌跡制御が終了し、ステップ700によるステアリングギヤ比の制御へ移行するときには、前輪の舵角の急激な変化を防止すべく目標ステアリングギヤ比Ntへのステアリングギヤ比の変化が急激にならないよう舵角可変装置14が制御される。このことは後述の他の実施形態に於いても同様である。
ステップ750に於いては後輪の舵角δrが0でない場合には0になるよう、また後輪の舵角δrが0である場合にはその舵角が維持されるよう、後輪操舵装置60が制御される。
ステップ800に於いては軌跡制御が実行されないときのアシストトルクの制御が行われる。即ち検出された操舵トルクThdに基づき図7に示されたグラフに対応するマップより基本アシストトルクTpabが演算され、車速Vに基づき図8に示されたグラフに対応するマップより車速係数Kvが演算される。また車速係数Kvと基本アシストトルクTpabとの積として目標アシストトルクTpatが演算され、アシストトルクが目標アシストトルクTpatになるよう電動式パワーステアリング装置22が制御される。
尚基本アシストトルクTpabは操舵トルクThd及び車速Vに基づき図9に示されたグラフに対応するマップより演算されてもよい。
ステップ900に於いては上記式84に従って補正後の検出操舵トルクThdbが演算され、補正後の検出操舵トルクThdbに基づき図7に示されたグラフに対応するマップより基本アシストトルクTpabが演算される。また車速Vに基づき図8に示されたグラフに対応するマップより車速係数Kvが演算され、車速係数Kvと基本アシストトルクTpabとの積が操舵負担軽減トルクTpadとして演算される。そして上記式83に従って操舵トルクの変動量ΔThbtが演算され、目標アシストトルクTpatが運転者の操舵負担軽減トルクTpadと操舵トルクの変動量ΔThatとの和に演算される。更にアシストトルクが目標アシストトルクTpatになるよう電動式パワーステアリング装置22が制御される。
次に図3に示されたフローチャートを参照して上記ステップ350に於いて実行される軌跡制御の開始条件の成立判定ルーチンについて詳細に説明する。
まずステップ355に於いては操舵角θがローパスフィルタ処理されることによりローパスフィルタ処理後の操舵角θlfが演算される。そしてローパスフィルタ処理後の操舵角θlfの絶対値が制御開始判定の基準値θs0(正の値)よりも大きいか否かの判別が行われる。否定判別が行われたときには制御はステップ390へ進み、肯定判別が行われたときには制御はステップ360へ進む。
ステップ360に於いては操舵角θの微分値として操舵角速度θdが演算されると共に、操舵角速度θdがローパスフィルタ処理されることによりローパスフィルタ処理後の操舵角速度θdlfが演算される。
ステップ365に於いてはローパスフィルタ処理後の操舵角速度θdlfの絶対値が制御開始判定の第一の基準値θds1(正の値)よりも大きいか否かの判別が行われる。否定判別が行われたときには制御はステップ375へ進み、肯定判別が行われたときにはステップ370に於いてフラグFsが開始条件の判定中であることを示すよう1にセットされた後制御はステップ375へ進む。
ステップ375に於いてはフラグFsが1であるか否かの判別、即ち開始条件の判定中であるか否かの判別が行われる。そして否定判別が行われたときには制御はステップ390へ進み、肯定判別が行われたときには制御はステップ380へ進む。
ステップ380に於いてはローパスフィルタ処理後の操舵角速度θdlfの絶対値が制御開始判定の第二の基準値θds2(θds1以下の正の値)よりも小さいか否かの判別が行われる。そして否定判別が行われたときには制御はステップ390へ進み、肯定判別が行われたときには制御はステップ385へ進む。
ステップ385に於いてはフラグFsが開始条件の判定が行われていないことを示すよう0にリセットされると共に、フラグFcが軌跡制御の実行中であることを示すよう1にセットされ、しかる後制御はステップ500へ進む。
ステップ390に於いてはフラグFsが開始条件の判定が行われていないことを示すよう0にリセットされると共に、フラグFcが軌跡制御が行われていないことを示すよう0にリセットされ、しかる後制御はステップ700へ進む。
尚基準値θs0、θds1、θds2は定数であってもよいが、これらの基準値も例えば車速Vが高いほど小さくなるよう車速Vに応じて可変設定されてもよい。
図4に示された軌跡制御の更新条件の成立判定ルーチンのステップ455〜490は基本的には上述の軌跡制御の開始条件の成立判定ルーチンのステップ355〜390とそれぞれ同様に実行される。
但しステップ455に於ける判定の基準値は制御更新判定の基準値θr0(正の値)である。ステップ465に於ける判定の基準値は制御更新判定の第一の基準値θdr1(正の値)であり、ステップ480に於ける判定の基準値は制御更新判定の第二の基準値θdr2(θdr1以下の正の値)である。尚基準値θr0、θdr1、θdr2は定数であってもよいが、これらの基準値も例えば車速Vが高いほど小さくなるよう車速Vに応じて可変設定されてもよい。
またステップ470、475、485、490に於いては、フラグFsは更新判定が行われているか否かを示すフラグFrに置き換えられている。更にステップ485が完了すると制御はステップ600へ進み、ステップ490が完了すると制御はステップ500へ進む。
次に図5に示されたフローチャートを参照して上記ステップ500に於いて実行される前輪及び後輪の目標舵角演算ルーチンについて詳細に説明する。
まずステップ505に於いては操舵角θ及び相対回転角度θreに基づいて前輪の舵角δfが求められ、前輪の舵角δf及び車速Vに基づいて上記式46に従って距離x0が演算される。またステップ505に於いては最小時間ΔT及びウェバー比のkをそれぞれ一般的な運転者について予め設定された正の定数として、上記式42に従って補正係数Dが演算される。
ステップ510に於いては軌跡制御が開始又は更新されるときの操舵角θ及び車速Vに基づいて上記式47に従って車両の横加速度LAaが演算される。
ステップ515に於いては軌跡制御が開始又は更新されるときの前輪の舵角δf及び車速Vに基づいて上記式49に従って車速Vの成分の一つとして距離xに関する座標軸に平行な成分Vxが演算される。
ステップ520に於いては上記式50に従って車速Vの成分の一つとして時間に関する座標軸に平行な成分Vyが演算されると共に、上記式52に従って成分Vxが車速Vに対しなす角度σが演算される。
ステップ525に於いてはそれぞれ上記式53及び54に従って車両の横方向の成分Vxx及びVyxが演算されると共に、上記式55及び56に従って車両の横加速度LAbが演算される。
ステップ530に於いては車両が指数関数の軌跡Teを描いて走行する場合の車両の横加速度LAbと車両が円弧状の軌跡Tcを描いて走行する場合の車両の横加速度LAaとの偏差ΔLAが上記式57に従って演算される。
ステップ535に於いては軌跡制御が開始又は更新されるときの操舵角θ、車速V、横加速度の偏差ΔLAに基づいて、左旋回時には上記式62に従って、右旋回時には上記式63に従って、前輪の目標舵角δbtが演算される。
ステップ540に於いては前輪の目標舵角δbtに基づいて上記式88に従って車両の推定ヨーレートYRaが演算される。
ステップ545に於いては車速Vが高いほど基準値YRrefが小さい値になるよう、車速Vに基づいて図31に示されたグラフに対応するマップより基準値YRrefが演算される。
ステップ550に於いては推定ヨーレートYRaの大きさの最大値YRamaxが基準値YRrefを越えるか否かの判別、即ち前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるか否かの判別が行われる。肯定判別が行われたときには制御はステップ560へ進み、否定判別が行われたときにはステップ555に於いて前輪の目標舵角δftが目標舵角δbtに設定されると共に、後輪の目標舵角δrtが0に設定される。
ステップ560に於いては推定ヨーレートYRaが低減補正されるべき時間的領域について、推定ヨーレートYRaの大きさと基準値YRrefとの偏差ΔYRa(各サイクルの偏差ΔYRai)が演算される。
ステップ565に於いてはsign(YRa)を推定ヨーレートYRaの符号として、推定ヨーレートYRaが低減補正されるべき時間的領域について、補正後の推定ヨーレートYRaaがsign(YRa)*YRrefに設定される。また推定ヨーレートYRaが増大補正されるべき時間的領域について、サイクル毎に推定ヨーレートYRaにsign(YRa)*ΔYRaに基づく補正量が加算されることにより、補正後の推定ヨーレートYRaaが演算される。この推定ヨーレートYRaの増大補正は上記「旋回状態量の上限値による制限」の何れの方法により行われてもよい。
ステップ585に於いては推定ヨーレートYRaが補正(低減補正及び増大補正)されるべき時間的領域について、補正後の推定ヨーレートYRaaに基づいて上記式73及び74に従って前輪の目標舵角δft及び後輪の目標舵角δrtが演算される。
ステップ590に於いては推定ヨーレートYRaが補正されない時間的領域について、上記ステップ555の場合と同様に前輪の目標舵角δftが前輪の目標舵角δbtに設定されると共に、後輪の目標舵角δrtが0に設定される。
この第一の実施形態に於いて、軌跡制御が実行されていない状況に於いて軌跡制御の開始条件が成立すると、ステップ50に於いて否定判別が行われ、ステップ350に於いて肯定判別が行われる。そしてステップ500に於いて車両を指数関数の目標軌跡に沿って走行させるための前輪の目標舵角δbt及びこれに基づく推定ヨーレートYRaが演算され、これらに基づいて前輪の目標舵角δft及び後輪の目標舵角δrtが演算される。そしてステップ600に於いて前輪の舵角がフィードフォワード制御によって目標舵角δftに制御されると共に、後輪の舵角がフィードフォワード制御によって目標舵角δrtに制御される。
また軌跡制御が実行されている状況に於いて軌跡制御の更新条件が成立すると、ステップ50及び450に於いて肯定判別が行われる。そしてステップ500及び600が実行される。
従って第一の実施形態によれば、軌跡制御が実行されるべき状況に於いては、前輪及び後輪の舵角を目標舵角に制御し、これにより運転者の操舵操作を要することなく車両が指数関数の目標軌跡に沿って走行するよう車両の走行軌跡を制御することができる。このことは後述の他の実施形態についても同様である。
特に第一の実施形態によれば、前輪のみの舵角制御では車両のヨーレートYRが過大になる虞れがあるときには、ステップ550に於いて肯定判別が行われる。そしてステップ560乃至590によりヨーレートYRが過大になることを防止しつつ車両を指数関数の目標軌跡に沿って走行させるための前輪の目標舵角δft及び後輪の目標舵角δrtが演算される。
尚、前輪のみの舵角制御でも車両のヨーレートYRが過大になる虞れがないときには、ステップ550に於いて否定判別が行われる。そしてステップ555に於いて前輪の目標舵角δftが目標舵角δbtに設定されると共に、後輪の目標舵角δrtが0に設定される。よって後輪の舵角を0以外の目標舵角に制御する必要がないので、常に前輪及び後輪の両方の舵角が変化する目標舵角に制御される場合に比して車両の走行制御を単純化することができる。このことも後述の他の実施形態についても同様である。
また第一の実施形態によれば、前輪及び後輪の舵角の制御は軌跡制御が開始又は更新されるときの前輪及び後輪の舵角に基づいて行われるフィードフォワード制御である。よって後述の第二の実施形態の場合の如く、前輪及び後輪の舵角の制御がフィードバック制御である場合に比して、指数関数の軌跡を目標軌跡とする軌跡制御を単純に実行することができる。尚この作用効果は後述の第三、第五、第七の実施形態に於いても同様に得られる。
第二の実施形態
この第二の実施形態は上記表1に示されている如く以下の特徴を有する。
舵角制御装置:セミバイワイヤ式
目標軌跡:指数関数
前輪舵角の制御:フィードバック
旋回状態量の制限方法:ヨーレートの上限値による制限
この第二の実施形態に於ける車両の走行制御は基本的には上述の第一の実施形態と同様に実行されるが、ステップ600に於ける舵角制御に於いては前輪及び後輪の舵角がフィードバック制御される。
即ちサイクル毎に操舵角θ及び相対回転角度θreに基づいて前輪の現在の舵角δfが求められ、前輪の目標舵角δftと現在の舵角δfとの偏差として目標相対回転角度θretが演算される。そしてアッパステアリングシャフト28に対し相対的にロアステアリングシャフト30を目標相対回転角度θret回転させるよう舵角可変装置14が制御されることにより、前輪の舵角が目標舵角δftに制御される。また後輪の目標舵角δrtと現在の舵角δrとの偏差が演算され、該偏差が0になるよう後輪操舵装置60が制御されることにより、後輪の舵角が目標舵角δrtに制御される。
従ってこの第二の実施形態によれば、前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるときには、推定ヨーレートYRaが上限値による制限によって制限されることにより補正後の推定ヨーレートYRaaが演算される。そして前輪及び後輪の舵角は補正後の推定ヨーレートYRaaに基づいてフィードバック制御される。
特に第二の実施形態によれば、目標相対回転角度θretは目標舵角δftと前輪の現在の舵角δfとの偏差として演算される。従って軌跡制御が開始又は更新された後に運転者によって操舵操作が行われても、前輪の舵角を確実に目標舵角δftに制御することができる。また車両を指数関数の目標軌跡に沿って走行させるに適した舵角になるよう運転者によって操舵操作が行われる場合には、フィードバック制御量が小さくなる。よって運転者が運転操作に熟練している場合には、上述の第一の実施形態の場合に比して舵角可変装置14の制御量を低減し、その負荷を軽減することができる。尚この作用効果は後述の第四の実施形態に於いても同様に得られる。
第三の実施形態
この第二の実施形態は上記表1に示されている如く以下の特徴を有する。
舵角制御装置:セミバイワイヤ式
目標軌跡:指数関数
前輪舵角の制御:フィードフォワード
旋回状態量の制限方法:ヨーレートのピーク低減による制限
この第三の実施形態に於ける車両の走行制御は、ステップ500に於ける目標舵角の演算を除き、上述の第一の実施形態と同様に実行される。そしてステップ500に於ける目標舵角の演算は図10に示されたフローチャートに従って実行される。尚図10に於いて、図5に示されたステップに対応するステップには、図5に於いて付されたステップ番号と同一のステップ番号が付されている。
図10に示されている如く、ステップ505乃至555及びステップ585、590は上述の第一の実施形態と同様に実行される。ステップ550に於いて肯定判別が行われると、制御はステップ570へ進む。
ステップ570に於いては車速Vが高いほど大きくなるよう車速Vに応じて所定値ΔYRdecが設定されると共に、補正判定値YRdecが基準値YRrefよりも所定値ΔYRdec小さい値に設定される。
ステップ575に於いては推定ヨーレートYRaの大きさの最大値YRamaxと基準値YRrefとの偏差ΔYRamaxが演算されると共に、偏差ΔYRamaxに基づいてゲインGpに対する正の補正係数Kpが演算される。またゲインGpに補正係数Kpが乗算されることによる大きさの補正が行われると共に、時間の補正が行われることにより、ゲインの適合化が行われる。この場合時間の補正は、両側全領域補正、前側の片側全領域補正、後側の片側全領域補正の何れであってもよい。
ステップ580に於いては推定ヨーレートYRaの補正が必要な領域の各サイクルについて、推定ヨーレートYRaに適合化後のゲインGpaが乗算されることにより補正後の推定ヨーレートYRaaが演算される。
従ってこの第三の実施形態によれば、前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるときには、推定ヨーレートYRaがピーク低減による制限によって制限されることにより補正後の推定ヨーレートYRaaが演算される。そして前輪及び後輪の舵角は補正後の推定ヨーレートYRaaに基づいてフィードフォワード制御される。
第四の実施形態
この第四の実施形態は上記表1に示されている如く以下の特徴を有する。
舵角制御装置:セミバイワイヤ式
目標軌跡:指数関数
前輪舵角の制御:フィードバック
旋回状態量の制限方法:ヨーレートのピーク低減による制限
この第四の実施形態に於ける車両の走行制御は基本的には上述の第三の実施形態と同様に実行されるが、ステップ600に於ける舵角制御に於いては前輪及び後輪の舵角が上述の第二の実施形態と同様にフィードバック制御される。
従ってこの第四の実施形態によれば、前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるときには、推定ヨーレートYRaがピーク低減による制限によって制限されることにより補正後の推定ヨーレートYRaaが演算される。そして前輪及び後輪の舵角は補正後の推定ヨーレートYRaaに基づいてフィードバック制御される。
尚上述の第一乃至第四の実施形態によれば、ステップ900に於いて補正後の検出操舵トルクThdb、即ち前輪の舵角制御に起因する操舵トルクの変動が排除された操舵トルクが演算され、トルクThdb及び車速Vに基づいて操舵負担軽減トルクTpadが演算される。そして上記式83に従って前輪の舵角の制御に起因する操舵トルクの変動量ΔThbtが演算され、目標アシストトルクTpatが運転者の操舵負担軽減トルクTpadと操舵トルクの変動量ΔThatとの和に演算される。更にアシストトルクが目標アシストトルクTpatになるよう電動式パワーステアリング装置22が制御される。
従って運転者の操舵負担を軽減することができるだけでなく、軌跡制御に伴う前輪の舵角の制御に起因する操舵トルクの変動を相殺し、軌跡制御に起因して運転者が操舵トルクに違和感を覚えることを効果的に防止することができる。
第五の実施形態
この第五の実施形態は上記表2に示されている如く以下の特徴を有する。
舵角制御装置:バイワイヤ式
目標軌跡:指数関数
舵角の制御:フィードフォワード
旋回状態量の制限方法:ヨーレートの上限値による制限
図11はバイワイヤ式のステアリング装置及び後輪操舵装置が搭載された車両に適用された本発明による車両の走行制御装置の第五の実施形態を示す概略構成図である。
図11に於いて、符号80は第五の実施形態の走行制御装置を全体的に示している。操舵入力手段としてのステアリングホイール20が運転者によって操舵操作されると、ラック・アンド・ピニオン型のステアリング機構82によりラックバー84及びタイロッド26L及び26Rが駆動され、これにより左右の前輪18FL及び18FRが転舵される。
ステアリングホイール20に連結されたステアリングシャフト86及びステアリング機構82のピニオンシャフト88は相互に連結されていない。ステアリングシャフト86には図11には示されていない減速歯車機構を介して操舵反力トルク付与用の電動機90が連結されている。電動機90は電子制御装置92の操舵反力制御部によって制御され、これによりステアリングホイール20に所要の操舵反力トルクが付与される。ピニオンシャフト88には図11には示されていない減速歯車機構を介して転舵駆動用の電動機94が連結されている。電動機94は電子制御装置92の舵角制御部によって制御され、これによりピニオンシャフト88が回転駆動される。
尚図示の実施形態に於いては、ピニオンシャフト88の回転は回転−直線運動変換機構としてのラック・アンド・ピニオン型のステアリング機構82によりラックバー84の直線運動に変換されるようになっているが、ステアリング機構は当技術分野に於いて公知の任意の構成のものであってよい。
かくしてステアリングホイール20、ステアリング機構82、電動機90、94等は、運転者の操舵操作に応じて左右の前輪18FL及び18FRを転舵すると共に、必要に応じて運転者の操舵操作に依存せずに左右の前輪の舵角を修正するバイワイヤ式の操舵装置96を構成している。
ステアリングシャフト86には操舵角θを検出する操舵角センサ50が設けられており、操舵角センサ50により検出された操舵角θを示す信号は電子制御装置92へ入力される。電子制御装置92には車速センサ56により検出された車速Vを示す信号、舵角センサ66により検出された後輪の舵角δrを示す信号、及び回転角度センサ98により検出されたピニオンシャフト88の回転角度θpを示す信号も入力される。
尚電子制御装置92の各制御部はそれぞれCPUとROMとRAMと入出力ポート装置とを有し、これらが双方向性のコモンバスにより互いに接続されたマイクロコンピュータを含むものであってよい。また操舵角センサ50、舵角センサ66及び回転角度センサ98はそれぞれ車両の左旋回方向への操舵の場合を正として操舵角θ、後輪の舵角δr及び回転角度θpを検出する。
後に詳細に説明する如く、電子制御装置92は図12に示されたフローチャートに従って操舵装置96の電動機90及び94を制御する。特に電子制御装置92も操舵角θ及び車速Vに基づき車両の軌跡制御の必要性を判定する。そして電子制御装置92は、軌跡制御が不要であると判定したときには、車速Vが高いほど大きくなるよう、車速Vに基づき所定の操舵特性を達成するための目標ステアリングギヤ比Ntを演算する。更に電子制御装置92はステアリングギヤ比が目標ステアリングギヤ比Ntになるよう操舵装置96の電動機94を制御する。
また電子制御装置92は、軌跡制御が必要であると判定したときには、そのときの操舵角θ及び車速Vに基づき車両を指数関数の目標軌跡に沿って走行させるための前輪の目標舵角δbtを上記式62又は64に従って演算する。
また電子制御装置16は上記式88に従って前輪の目標舵角δbtに基づいて推定ヨーレートYRaを演算する。そして電子制御装置16は、推定ヨーレートYRaの大きさの最大値YRamaxが基準値YRrefを越えるか否かの判別により、前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるか否かを判定する。
電子制御装置16はヨーレートYRが過大になる虞れがないと判定したときには、前輪の目標舵角δftを前輪の目標舵角δbtに設定し、左右前輪の舵角が目標舵角δftになるよう操舵装置96をフィードフォワード式に制御する。また電子制御装置16は後輪の舵角δrを0に維持する。
これに対し電子制御装置16は、ヨーレートYRが過大になる虞れがあると判定したときには、推定ヨーレートYRaが補正されるべき領域については上記「旋回状態量の上限値による制限」の何れかの方法により補正後の推定ヨーレートYRaaを演算する。そして電子制御装置16は、上記式73及び74に従って前輪の目標舵角δft及び後輪の目標舵角δrtを演算し、それぞれ前輪の目標舵角δft及び後輪の目標舵角δrtに基づいて操舵装置96及び後輪操舵装置60を制御する。
尚ヨーレートYRが過大になる虞れがあると判定した場合であっても、推定ヨーレートYRaが補正される必要がない領域については、電子制御装置16は前輪の目標舵角δbtを前輪の目標舵角δftに設定する。そして電子制御装置16は左右前輪の舵角が目標舵角δftになるよう操舵装置96を制御し、後輪の舵角δrを0に維持する。
また電子制御装置92は、軌跡制御が実行されているか否かに関係なく、上記式86に従って補正後の検出操舵トルクTh0を演算すると共に、補正後の検出操舵トルクTh0及び車速Vに基づいて操舵負担軽減トルクTpadを演算する。そして電子制御装置92は、上記式87に従って目標操舵トルクThbtを演算し、操舵トルクが目標操舵トルクThbtになるよう操舵装置96の電動機90を制御する。
この第五の実施形態に於ける車両の走行制御は図12に示されたフローチャートに従って実行される。尚図12に示されたフローチャートによる走行制御は、図には示されていないイグニッションスイッチの閉成により開始され、所定の時間毎に繰返し実行される。また図12に於いて、それぞれ図2に示されたステップに対応するステップには、図2に於いて付されたステップ番号と同一のステップ番号が付されている。
図12と図2との比較より解る如く、この第五の実施形態に於いては第一の実施形態に於けるステップ800に対応するステップは実行されず、ステップ600又は750が完了すると、制御はステップ950へ進む。
尚この第五の実施形態のステップ500に於いて実行されるステップ505に於いては、ピニオンシャフト88の回転角度θpに基づいて前輪の舵角δfが求められ、前輪の舵角δf及び車速Vに基づいて上記式46に従って距離x0が演算される。
従ってこの第五の実施形態によれば、前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるときには、推定ヨーレートYRaが上限値による制限によって制限されることにより補正後の推定ヨーレートYRaaが演算される。そして前輪及び後輪の舵角は補正後の推定ヨーレートYRaaに基づいてフィードフォワード制御される。
また上述の第一乃至第四の実施形態に於けるステップ900に対応するステップ950に於いては、運転者が操舵反力として感じる操舵トルクの制御が行われる。まず操舵角θに基づいて上記式86に従って補正後の検出操舵トルクTh0が演算される。また補正後の検出操舵トルクTh0に基づいて図13に示されたグラフに対応するマップより基本操舵負担軽減トルクTpadbが演算され、車速Vに基づいて図8に示されたグラフに対応するマップより車速係数Kvが演算される。そして操舵負担軽減トルクTpadが基本操舵負担軽減トルクTpadbと車速係数Kvとの積に演算される。尚操舵負担軽減トルクTpadは図14に示されたグラフに対応するマップより演算されてもよい。
更に補正後の検出操舵トルクTh0及び操舵負担軽減トルクTpadに基づき上記式87に従って目標操舵トルクThbtが演算され、操舵トルクが目標操舵トルクThbtになるよう操舵装置96の電動機90が制御される。
尚上述の電動機90の制御による操舵トルクの制御は、後述の第六乃至第八の実施形態に於いても同様に行われる。即ち舵角制御装置がバイワイヤ式のものである場合には、操舵トルクの制御は、推定ヨーレートYRaの制限が上限値による制限であるか否かピーク低減による制限であるか否かに関係なく同一の要領にて行われる。
第六の実施形態
この第六の実施形態は上記表2に示されている如く以下の特徴を有する。
舵角制御装置:バイワイヤ式
目標軌跡:指数関数
舵角の制御:フィードバック
旋回状態量の制限方法:ヨーレートの上限値による制限
この第六の実施形態に於ける車両の走行制御は基本的には上述の第五の実施形態と同様に実行されるが、ステップ600に於ける舵角制御に於いては前輪及び後輪の舵角がフィードバック制御される。
即ちサイクル毎にピニオンシャフト88の回転角度θpに基づいて前輪の現在の舵角δfが求められ、前輪の目標舵角δftと現在の舵角δfとの偏差Δδftが演算される。そして舵角の偏差Δδftの大きさが小さくなるよう操舵装置96の電動機94が制御される。よって前輪の舵角はフィードバック制御によって目標舵角δftに制御される。
従って第六の実施形態によれば、前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるときには、第二の実施形態の場合と同様に、推定ヨーレートYRaが上限値による制限によって制限されることにより補正後の推定ヨーレートYRaaが演算される。そして前輪及び後輪の舵角は補正後の推定ヨーレートYRaaに基づいてフィードバック制御される。
第七の実施形態
この第七の実施形態は上記表2に示されている如く以下の特徴を有する。
舵角制御装置:バイワイヤ式
目標軌跡:指数関数
舵角の制御:フィードフォワード
旋回状態量の制限方法:ヨーレートのピーク低減による制限
図17に示されている如く、この第七の実施形態に於ける車両の走行制御は、ステップ500に於ける目標舵角の演算を除き、上述の第五の実施形態と同様に実行される。そしてステップ500に於ける目標舵角の演算は、上述の第三の実施形態と同様に図10に示されたフローチャートに従って実行される。
従ってこの第七の実施形態によれば、前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるときには、第三の実施形態と同様に推定ヨーレートYRaがピーク低減による制限によって制限されることにより補正後の推定ヨーレートYRaaが演算される。そして前輪及び後輪の舵角は補正後の推定ヨーレートYRaaに基づいてフィードフォワード制御される。
第八の実施形態
この第八の実施形態は上記表2に示されている如く以下の特徴を有する。
舵角制御装置:バイワイヤ式
目標軌跡:指数関数
舵角の制御:フィードバック
旋回状態量の制限方法:ヨーレートのピーク低減による制限
この第八の実施形態に於ける車両の走行制御は基本的には上述の第七の実施形態と同様に実行されるが、ステップ600に於ける軌跡制御に於いては第六の実施形態と同様に前輪及び後輪の舵角がフィードバック制御される。
従ってこの第七の実施形態によれば、前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるときには、第三の実施形態と同様に推定ヨーレートYRaがピーク低減による制限によって制限されることにより補正後の推定ヨーレートYRaaが演算される。そして前輪及び後輪の舵角は補正後の推定ヨーレートYRaaに基づいてフィードバック制御される。
尚上述の第五乃至第八の実施形態によれば、舵角制御装置がセミバアワイヤ式の舵角制御装置であり舵角制御装置により前輪の舵角が制御されない場合の操舵トルクに相当する値として、補正後の検出操舵トルクTh0が演算される。そして補正後の検出操舵トルクTh0及び車速Vに基づいて操舵負担軽減トルクTpadが演算される。更に補正後の検出操舵トルクTh0より操舵負担軽減トルクTpadを減算した値として目標操舵トルクTpbtが演算され、操舵トルクが目標操舵トルクTpbtになるよう操舵装置96の電動機90が制御される。
従って運転者に適度の操舵負担を与えることができるだけでなく、軌跡制御に伴う前輪の舵角の制御に起因する操舵トルクの変動を防止し、軌跡制御に起因して運転者が操舵トルクに違和感を覚えることを効果的に防止することができる。
以上の説明より、上述の各実施形態によれば、車両の目標軌跡や実軌跡を求めるための車外情報の取得を要することなく、車両を運転者が希望する軌跡に沿って走行させることができることが理解されよう。
また上述の各実施形態によれば、目標軌跡は指数関数の軌跡であるので、目標軌跡が円弧状の軌跡である場合に比して、車両の軌跡を車両の乗員にとって一層好ましい軌跡に制御することができる。特にこれらの実施形態によれば、距離xが上記式40に従って変化するよう指数関数の目標軌跡が設定される。よって目標軌跡が円弧状の軌跡である場合に比して、人の知覚特性にとって好ましい軌跡を達成することができる。
また第一、第二、第五、第六の実施形態によれば、前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるときには、推定ヨーレートYRaが上限値による制限によって制限されることにより補正後の推定ヨーレートYRaaが演算される。そして補正後の推定ヨーレートYRaaに基づいて前輪及び後輪の目標舵角が演算され、前輪及び後輪の舵角がそれらの目標舵角に基づいて制御される。
よって推定ヨーレートYRaは基準値YRrefを越える時間的領域に於いてのみ低減補正される。従ってピーク低減による制限の場合に比して他の時間的領域に於ける推定ヨーレートYRaの増大補正量を小さくしたり、推定ヨーレートYRaが増大補正される時間的領域を小さくすることができる。
また第三、第四、第七、第八の実施形態によれば、前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるときには、推定ヨーレートYRaがピーク低減による制限によって制限されることにより補正後の推定ヨーレートYRaaが演算される。そして補正後の推定ヨーレートYRaaに基づいて前輪及び後輪の目標舵角が演算され、前輪及び後輪の舵角がそれらの目標舵角に基づいて制御される。
よってピーク低減による制限の場合に比して補正後の推定ヨーレートYRaaの変化を補正前の推定ヨーレートYRaの変化に近づけることができる。よって推定ヨーレートYRaが制限されることに起因して車両のヨーレートが不自然に変化すること及びこれに起因して車両の乗員が違和感を覚える虞れを低減することができる。
上述の各実施形態は、前輪のみの舵角制御ではヨーレートYRが過大になる虞れがあるときには、推定ヨーレートYRaの制限によって車両のヨーレートが過大になることを防止するものである。しかしこれらの実施形態は、前輪のみの舵角制御では車両のロール角Rvが過大になる虞れがあるときには、推定ヨーレートYRaの制限によって車両のロール角Rvが過大になることを防止する実施形態に変形されてよい。
第一の変形例
図15は上述の第一の実施形態が車両のロール角Rvが過大になることを防止する実施形態に変形された第一の変形例に於ける前輪及び後輪の目標舵角演算ルーチンを示すフローチャートである。尚図15に於いて図5に示されたステップに対応するステップには図5に於いて付されたステップ番号と同一のステップ番号が付されている。
図15と図5との比較より解る如く、ステップ505〜540及びステップ565〜590は第一の実施形態の場合と同様に実行される。またステップ540及び545の次にそれぞれステップ540a及び545aが実行され、ステップ550及び560に代えてそれぞれステップ550a及び560aが実行される。
ステップ540aに於いては推定ヨーレートYRa及び車速Vに基づいて上記式70に対応する下記の式xxに従って車両の推定ロール角Rvaが演算される。
Rva=M*H*V*YRa/(Kr−Mg*H) ……(xx)
ステップ545aに於いては、車速Vが高いほど車両のロール角の基準値Rvrefが小さい値になるよう、車速Vに基づいて図37に示されたグラフに対応するマップより基準値Rvrefが演算される。
ステップ550aに於いては車両の推定ロール角Rvaの大きさの最大値Rvamaxが基準値Rvrefを越えるか否かの判別、即ち前輪のみの舵角制御ではロール角Rvが過大になる虞れがあるか否かの判別が行われる。肯定判別が行われたときには制御はステップ560aへ進み、否定判別が行われたときにはステップ555に於いて前輪の目標舵角δftが目標舵角δbtに設定されると共に、後輪の目標舵角δrtが0に設定される。
ステップ560aに於いては推定ヨーレートYRaが低減補正されることによってロール角Rvの大きさが低減補正されるべき時間的領域について、推定ヨーレートYRaの大きさと基準値YRrefとの偏差ΔYRa(各サイクルの偏差ΔYRai)が演算される。
第二の変形例
図16は上述の第三の実施形態が車両のロール角Rvが過大になることを防止する実施形態に変形された第二の変形例に於ける前輪及び後輪の目標舵角演算ルーチンを示すフローチャートである。尚図16に於いて図10に示されたステップに対応するステップには図10に於いて付されたステップ番号と同一のステップ番号が付されている。
図16と図10との比較より解る如く、ステップ505〜540及びステップ565〜590は第一の実施形態の場合と同様に実行される。またステップ540及び545の次にそれぞれステップ540a及び545aが実行され、ステップ550及び560に代えてそれぞれステップ550a及び560aが実行される。
第一及び第二の変形例によれば、前輪のみの舵角制御では車両のロール角Rvが過大になる虞れがあるときには、推定ヨーレートYRaを制限することによって車両のロール角Rvが過大になることを防止することができる。尚第二、第四乃至第八の実施形態も第一及び第二の変形例と同様に推定ヨーレートYRaの制限によって車両のロール角Rvが過大になることを防止する変形例に変形可能である。
以上に於いては本発明を特定の実施形態について詳細に説明したが、本発明は上述の実施形態に限定されるものではなく、本発明の範囲内にて他の種々の実施形態が可能であることは当業者にとって明らかであろう。
例えば前輪の舵角がフィードフォワード式に制御される場合には後輪の舵角もフィードフォワード式に制御され、前輪の舵角がフィードバック式に制御される場合には後輪の舵角もフィードバック式に制御されるようになっている。しかし後輪の舵角は前輪の舵角の制御方式に関係なくフィードフォワード式及びフィードバック式の何れにより制御されてよい。
また各実施形態に於いては、軌跡制御のための前輪の舵角の制御が行われないときには、後輪の舵角は0に維持されるようになっているが、予め設定された前後輪舵角比に基づいて制御されてもよい。
また案内棒は前輪の前後方向に沿って延在するものとされているが、車両の前後方向に対する案内棒の傾斜角は運転者の操舵操作量に基づいて設定される限り、前輪の前後方向に沿う方向とは異なる方向であってもよい。例えば案内棒の傾斜角は前輪の舵角δと方向の補正係数Kdとの積に設定されてもよい。
また各実施形態に於いては、車両の走行制御は前輪の舵角の制御と操舵トルクの制御とを含んでいるが、操舵トルクの制御は任意の要領にて実行されてよい。
また各実施形態に於いては、前輪の舵角はフィードフォワード式又はフィードバック式に制御されるようになっているが、それぞれゲインが乗算されたフィードフォワード制御量とフィードバック制御量との和に基づいて制御されるよう修正されてもよい。