JP3990623B2 - 車両挙動制御装置 - Google Patents
車両挙動制御装置 Download PDFInfo
- Publication number
- JP3990623B2 JP3990623B2 JP2002335453A JP2002335453A JP3990623B2 JP 3990623 B2 JP3990623 B2 JP 3990623B2 JP 2002335453 A JP2002335453 A JP 2002335453A JP 2002335453 A JP2002335453 A JP 2002335453A JP 3990623 B2 JP3990623 B2 JP 3990623B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- yaw rate
- road
- road shape
- control device
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Control Of Vehicle Engines Or Engines For Specific Uses (AREA)
- Traffic Control Systems (AREA)
- Regulating Braking Force (AREA)
- Navigation (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、特に、自車両がアンダステア状態の場合に該アンダステア状態を最適に抑制する車両挙動制御装置に関する。
【０００２】
【従来の技術】
近年、車両のコーナリング等の際の車両にはたらく力の関係から、コーナリング中に制動力を適切な車輪に加え、車両安定性を向上させる車両挙動制御装置が開発され、実用化されている。
【０００３】
こうした車両挙動制御装置では、車両の実際のヨーレート（以下、実ヨーレートと略称）を検出し、車両の運転状態から目標ヨーレートを演算し、これらの関係、すなわち、実ヨーレートの絶対値が目標ヨーレートの絶対値より大きい場合は、車両はオーバステア傾向、逆に実ヨーレートの絶対値が目標ヨーレートの絶対値より小さい場合は、車両はアンダステア傾向と判定する。そして、オーバステア傾向の場合には旋回外側前輪を制動輪として選択し、アンダステア傾向の場合には旋回内側後輪を制動輪として選択し、所定の制動力を付加して車両の安定性を維持するものがある（例えば、特許文献１参照）。
【０００４】
【特許文献１】
特開平９−２２３４号広報
【０００５】
【発明が解決しようとする課題】
ところで、アンダステア状態においては、ドライバは、車両をより旋回させるため、通常走行時よりも大きく操舵してしまうことからステアリングを過剰に切り込むのが通例であり、上述の特許文献１のような車両挙動制御装置でアンダステア傾向を防止する際には、目標ヨーレートが大きくなって、制御量が過剰となり、失速、曲がりすぎとなる場合がある。また、アンダステア状態を、運転状態を基に演算する目標ヨーレートを用いて防止するだけでは、前方のカーブを旋回することが不可能な場合があり、更に、道路状態によっても、現在の運転状態のままでは制動制御のみで安定した車両挙動を維持して旋回することに対応できない場合も多い。
【０００６】
本発明は上記事情に鑑みてなされたもので、前方のカーブ形状、道路状態、運転状態等に応じ、ドライバに違和感を与えることなく最適なアンダステア状態の防止制御を実行し、安定した車両挙動を維持することができる車両挙動制御装置を提供することを目的とする。
【０００７】
【課題を解決するための手段】
上記目的を達成するため請求項１記載の本発明の車両挙動制御装置は、少なくとも自車両のアンダステア状態を検出し、該アンダステア状態を抑制させるアンダステア防止手段を備えた車両挙動制御装置において、道路形状を認識する道路形状認識手段と、自車進行路を推定する自車進行路推定手段とを有し、上記アンダステア防止手段は、上記自車両がアンダステア状態で上記道路形状と上記自車進行路との関係からカーブに進入すると判断した場合、上記道路形状に基づき該道路を走行するのに必要な道路形状に基づくヨーレートを演算すると共に上記自車両の運転状態に基づく目標ヨーレートを演算して、上記道路形状に基づくヨーレートと上記目標ヨーレートとを比較し、大きい方のヨーレートが実際のヨーレートを所定に超える場合に上記道路を走行するのに必要な駆動力のトルクダウン量と上記道路を走行するためのヨーレートを生じる所定の車輪に付与する制動力を演算し出力することを特徴としている。
【０００８】
また、請求項２記載の本発明の車両挙動制御装置は、請求項１記載の車両挙動制御装置において、上記道路形状認識手段は、ナビゲーション装置からのデータに基づき道路形状を認識することを特徴としている。
【０００９】
更に、請求項３記載の本発明の車両挙動制御装置は、請求項１又は請求項２記載の車両挙動制御装置において、上記自車進行路推定手段は、自車両前方を画像にて捉え該画像情報に基づき自車進行路を推定することを特徴としている。
【００１０】
更に、請求項４記載の本発明の車両挙動制御装置は、請求項１乃至請求項３の何れか一つに記載の車両挙動制御装置において、上記アンダステア防止手段は、上記道路を走行するのに必要な駆動力のトルクダウン量を求める場合、路面摩擦係数を基に該トルクダウン量を演算することを特徴としている。
【００１１】
すなわち、請求項１記載の車両挙動制御装置は、アンダステア防止手段は、自車両がアンダステア状態で、道路形状認識手段で認識した道路形状と自車進行路推定手段で推定した自車進行路との関係からカーブに進入すると判断した場合、道路形状に基づき該道路を走行するのに必要な道路形状に基づくヨーレートを演算すると共に自車両の運転状態に基づく目標ヨーレートを演算する。そして、道路形状に基づくヨーレートと目標ヨーレートとを比較し、大きい方のヨーレートが実際のヨーレートを所定に超える場合に道路を走行するのに必要な駆動力のトルクダウン量と道路を走行するためのヨーレートを生じる所定の車輪に付与する制動力を演算し出力する。これにより、前方のカーブ形状、道路状態、運転状態等に応じ、ドライバに違和感を与えることなく最適なアンダステア状態の防止制御を実行し、安定した車両挙動を維持することが可能となる。
【００１２】
この際、道路形状認識手段は、具体的には請求項２記載のように、ナビゲーション装置からのデータに基づき道路形状を認識するものとし、自車進行路推定手段は、具体的には請求項３記載のように、自車両前方を画像にて捉え該画像情報に基づき自車進行路を推定するものとする。
【００１３】
また、アンダステア防止手段は、道路を走行するのに必要な駆動力のトルクダウン量を求める場合、具体的には請求項４記載のように、路面摩擦係数を基に該トルクダウン量を演算する。
【００１４】
【発明の実施の形態】
以下、図面を参照して本発明の実施の形態を説明する。図１〜図７は本発明の実施の一形態に係わり、図１は車両挙動制御装置を搭載した車両の概略構成を示す説明図、図２は車両挙動制御装置のアンダステア防止機能部分の機能ブロック図、図３はナビゲーション装置からのデータの説明図、図４は自車位置とノードに関する説明図、図５はノード角度及びカーブ曲率半径の演算に関する説明図、図６は車両挙動制御のメインプログラムのフローチャート、図７はアンダステア防止制御ルーチンのフローチャートである。
【００１５】
図１において、符号１はセンターディファレンシャル装置および自動変速装置を有する４輪駆動車を一例とする車両を示し、車両前部に配置されたエンジン２による駆動力は、このエンジン２後方の自動変速装置（トルクコンバータ等も含んで図示）３からトランスミッション出力軸３ａを経てセンターディファレンシャル装置４に伝達される。そして、駆動力は、このセンターディファレンシャル装置４から、リヤドライブ軸５、プロペラシャフト６、ドライブピニオン７を介して後輪終減速装置８に入力される一方、センターディファレンシャル装置４から、フロントドライブ軸９を介して前輪終減速装置１０に入力される。ここで、自動変速装置３、センターディファレンシャル装置４、及び、前輪終減速装置１０等は、図示しないケース内に一体に設けられている。
【００１６】
後輪終減速装置８に入力された駆動力は、後輪左ドライブ軸１１rlを経て左後輪１２rlに、後輪右ドライブ軸１１rrを経て右後輪１２rrに伝達される。一方、前輪終減速装置１０に入力された駆動力は、前輪左ドライブ軸１１flを経て左前輪１２flに、前輪右ドライブ軸１１frを経て右前輪１２frに伝達される。
【００１７】
符号１３は車両のブレーキ駆動部を示し、このブレーキ駆動部１３には、ドライバにより操作されるブレーキペダル１４と接続されたマスターシリンダ１５が接続されている。そして、ドライバがブレーキペダル１４を操作するとマスターシリンダ１５により、ブレーキ駆動部１３を通じて、４輪１２fl，１２fr，１２rl，１２rrの各ホイールシリンダ（左前輪ホイールシリンダ１６fl，右前輪ホイールシリンダ１６fr，左後輪ホイールシリンダ１６rl，右後輪ホイールシリンダ１６rr）にブレーキ圧が導入され、これにより４輪にブレーキがかかって制動される。
【００１８】
ブレーキ駆動部１３は、加圧源、減圧弁、増圧弁等を備えたハイドロリックユニットで、後述する車両挙動制御装置としての制御装置４０からの入力信号に応じて、各ホイールシリンダ１６fl，１６fr，１６rl，１６rrに対して、それぞれ独立にブレーキ圧を導入自在に構成されている。
【００１９】
車両１には、公知のナビゲーション装置２１が搭載され、制御装置４０と接続されており、このナビゲーション装置２１からは、図３に示すように、自車走行ルートに関して送出されるノード数ｎ、自車位置の東経、自車位置の北緯、自車直後のノードに関するデータ、及び自車前方の設定範囲内における自車走行ルートのノードに関するデータ（自車直前のノードに関するデータ、自車前方２点目のノードに関するデータ、…、自車前方（ｎ−１）点目のノードに関するデータ）が、例えば５００ｍｓ毎に出力される。各ノードに関するデータには、図示の如く、自車位置からノードまでの東方向位置、自車位置からノードまでの北方向位置、ノード位置に交差点があるか否かを識別する交差点フラグ、道路種別、道路幅等の情報が含まれている。
【００２０】
このナビゲーション装置２１は、乗員により目的地が入力された場合には、入力された目的地に対して自車が進むべく最適な案内経路を設定する。そして、設定された案内経路上の、例えば自車前方３００ｍまでのノードに関するデータと自車直後のノードに関するデータを自車走行ルートのノードに関するデータとして制御部４０に出力する。
【００２１】
一方、ナビゲーション装置２１は、乗員による目的地の入力がなされていない場合は、例えば道路種別や道路幅等の情報に基づいて自車が進むであろう経路の優先順位を推定し、その中で最も優先順位の高い経路を推定経路として設定する。そして、設定された推定経路上の例えば自車前方３００ｍまでのノードに関するデータと自車直後のノードに関するデータを自車走行ルートのノードに関するデータとして制御部４０に出力する。
【００２２】
また、車両１には、ステレオ光学系として例えば電荷結合素子（ＣＣＤ）等の固体撮像素子を用いた１組の（左右）のＣＣＤカメラ２２Ｌ、２２Ｒが設けられている。これら左右のＣＣＤカメラ２２Ｌ、２２Ｒは、それぞれ車室内の天井前方に一定の間隔をもって取り付けられ、車外の対象を異なる視点からステレオ撮像し、画像を制御装置４０に入力する。
【００２３】
更に、車両には、４輪１２fl，１２fr，１２rl，１２rrの各車輪速度ωfl，ωfr，ωrl，ωrrを検出する車輪速度センサ２３fl，２３fr，２３rl，２３rr、車両１のハンドル角θH を検出するハンドル角センサ２４、実ヨーレートφrを検出するヨーレートセンサ２５、横加速度Ｇyを検出する横加速度センサ２６等の各センサが設けられており、制御装置４０に各センサ信号を入力するように構成されている。
【００２４】
制御装置４０は、ナビゲーション装置２１から上述の各道路情報が入力され、ＣＣＤカメラ２２Ｌ、２２Ｒから上述の前方画像が入力される。また、各センサ２３fl，２３fr，２３rl，２３rr、２４、２５、２６から、それぞれ、４輪１２fl，１２fr，１２rl，１２rrの各車輪速度ωfl，ωfr，ωrl，ωrr、ハンドル角θH、実ヨーレートφr、横加速度Ｇyが入力される。そして、これらの入力に基づき、制御装置４０は、車両の挙動がアンダステア状態か、オーバステア状態か判定し、車両挙動を安定させるべくブレーキ駆動部１３やエンジン制御装置３０に信号出力するように構成されている。
【００２５】
すなわち、制御装置４０は、マイクロコンピュータとその周辺回路で構成され、図２に示すように、アンダステア防止手段としてのアンダステア防止機能に関する部分は、車速演算部４０ａ、ヨーレート定常ゲイン演算部４０ｂ、道路形状認識部４０ｃ、自車進行路推定部４０ｄ、カーブ進入判定部４０ｅ、目標ヨーレート演算部４０ｆ、道路形状に基づくヨーレート演算部４０ｇ、ヨーレート比較判定部４０ｈ、制御判断部４０ｉ、路面μ（路面摩擦係数）推定部４０ｊ、許容横加速度演算部４０ｋ、許容速度演算部４０ｌ、トルクダウン量演算部４０ｍ、ヨーレート偏差演算部４０ｎ、目標制動力演算部４０ｏから主要に構成されている。
【００２６】
車速演算部４０ａは、４輪の車輪速センサ、すなわち各車輪速度センサ２３fl，２３fr，２３rl，２３rrから４輪１２fl，１２fr，１２rl，１２rrの各車輪速度ωfl，ωfr，ωrl，ωrrが入力され、例えばこれらの平均を演算することにより車速Ｖ（＝（ωfl，ωfr，ωrl，ωrr）／４）を演算し、ヨーレート定常ゲイン演算部４０ｂ、自車進行路推定部４０ｄ、道路形状に基づくヨーレート演算部４０ｇ、路面μ推定部４０ｊ、トルクダウン量演算部４０ｍ、目標制動力演算部４０ｏに出力する。
【００２７】
ヨーレート定常ゲイン演算部４０ｂは、ハンドル角センサ２４からハンドル角θHが入力され、車両の定常円旋回時の実舵角δfに対するヨーレートの値（ヨーレート定常ゲインＧγδｆ（０））を以下の（１）式により求め、目標ヨーレート演算部４０ｆと目標制動力演算部４０ｏに出力する。すなわち、ホイールベースをＬ，車両の諸元で決まるスタビリティファクタをＡ0とすると、
Ｇγδｆ（０）＝（１／（１＋Ａ0・Ｖ２））・（Ｖ／Ｌ） …（１）
また、スタビリティファクタＡ0は、車両質量をｍ，前軸と重心間の距離をＬf，後軸と重心間の距離をＬr，フロント等価コーナリングパワーをＣＰf，リア等価コーナリングパワーをＣＰrとすると次式で求められる。
Ａ0＝（−ｍ・（Ｌf・ＣＰf−Ｌr・ＣＰr））
／（２・Ｌ２・ＣＰf・ＣＰr） …（２）
【００２８】
道路形状認識部４０ｃでは、ナビゲーション装置２１から送信されたノード毎の位置情報に基づき、各々のノードについて、１つ手前のノードとの間隔、カーブ曲率半径及びノード角度が演算される。これらの演算値は、交差点識別、道路種別、道路幅、後述する特異点識別等に関する情報と共に、各ノードの属性情報として記憶格納される。
【００２９】
具体的には、道路形状認識部４０ｃは、ナビゲーション装置２１から送信された、自車位置を基準としたノード座標（図４参照）を用いて、ノードＰj（ｘP[j]，ｙp[j]）と１つ手前のノードＰj-1（ｘp[j-1]，ｙp[j-1]）との間隔Ｌp[j]を、
Ｌp[j]＝（（ｘP[j]−ｘp[j-1]）２＋（ｙp[j]−ｙp[j-1]）２）１／２
（但し、１≦ｊ≦ｎ−１）…（３）
により各ノードについて演算する。
【００３０】
続いて、道路形状認識部４０ｃは、例えば図５に示すように、ノード座標に基づいて、各ノードＰjにおけるノード角度ｔp[j]を、以下（４）式により演算する。
ｔp[j]＝sin−１（（（ｘp[j-1]−ｘp[j]）・（ｙp[j]−ｙp[j+1]）
−（ｘp[j]−ｘp[j+1]）・（ｙp[j-1]−ｙp[j]））／（Ｌp[j]・Ｌp[j+1]）） …（４）
尚、ここで得られたノード角度ｔp[j]は、右コーナの場合、正値で表され、左コーナの場合、負値で表される。
【００３１】
以上の計算結果に基づいて、道路形状認識部４０ｃでは、ノードＰjでのカーブ曲率半径ｒp[j]を、以下（５）式により演算する。
ｒp[j]＝min（ＬP[j]，Ｌp[j+1]）／２／tan（｜ｔp[j]｜／２）…（５）
ここで、min（Ｌp[j]，Ｌp[j+1]）は、Ｌp[j]とＬp[j+1]の何れか短い方を選択するとの意味であり、例えば、図５においては、Ｌp[j]＜Ｌp[j+1]であるため、min（ＬP[j]，Ｌp[j+1]）＝Ｌp[j]である。
【００３２】
また、道路形状認識部４０ｃは、ナビゲーション装置２１から送信されるデータをそのまま用いて（ナビゲーション装置２１で予め定義づけられているデータをそのまま用いて）、各ノード毎に交差点識別（交差点か否か、或いは案内経路上の交差点か）、道路の種別（高速自動車国道、都市高速道路、一般国道、主要地方道、その他）、道路幅の設定等を行う。
【００３３】
更に、道路形状認識部４０ｃでは、ナビゲーション装置２１から送信された各ノードについての特異点判定を行い、ノードＰjが特異点であると判定された場合には、判定されたノードＰjを除いた前後のノードＰj-1，Ｐj+1間におけるノード角度ｔp[J+1]、カーブ曲率半径ｒp[j+1]の再演算を行う。
【００３４】
すなわち、隣接するノード間隔が接近しすぎていると演算されたカーブ曲率半径は実際の道路の曲率半径よりも小さくなりすぎた値となってしまい、結果として何でもないカーブで過剰に車両挙動制御をしてしまう。これを防止するため、道路形状認識部４０ｃでは、このようなノードを、道路種別属性ｃp[j]、道路幅属性ｗp[j]を考慮した上で、ノード間隔Ｌp[j]、ノード角度ｔp[j]に基づいて、ノード角度、カーブ曲率半径演算時の特異点として除外する。
【００３５】
こうして、道路形状認識部４０ｃにて最終的に演算されたカーブ曲率半径ｒp[j]は、カーブ進入判定部４０ｅ、道路形状に基づくヨーレート演算部４０ｇ、許容速度演算部４０ｌに出力される。すなわち、本実施の形態においては、ナビゲーション装置２１、道路形状認識部４０ｃにて道路形状認識手段が構成されている。
【００３６】
自車進行路推定部４０ｄは、ＣＣＤカメラ２２Ｌ、２２Ｒから画像情報が、ハンドル角センサ２４からハンドル角θHが、車速演算部４０ａから車速Ｖがそれぞれ入力される。そして、ＣＣＤカメラ２２Ｌ、２２Ｒから画像情報に基づき自車両１前方の立体物データと側壁データと白線データの前方情報を検出し、これら前方情報や自車両１の運転状態から自車両１の進行路（自車進行路）を推定する。
【００３７】
ここで、自車進行路推定部４０ｄにおける、ＣＣＤカメラ２２Ｌ、２２Ｒからの画像の処理は、例えば以下のように行われる。まず、ＣＣＤカメラ２２Ｌ、２２Ｒで撮像した自車両の進入方向の環境の１組のステレオ画像対に対し、対応する位置のずれ量から三角測量の原理によって画像全体に渡る距離情報を求める処理を行なって、三次元の距離分布を表す距離画像を生成する。そして、このデータを基に、周知のグルーピング処理や、予め記憶しておいた３次元的な道路形状データ、側壁データ、立体物データ等と比較し、白線データ、道路に沿って存在するガードレール、縁石等の側壁データ、車両等の立体物データを抽出する。こうして抽出された白線データ、側壁データ、立体物データは、それぞれのデータ毎に異なったナンバーが割り当てられる。
【００３８】
そして、自車進行路推定部４０ｄでは、自車進行路を以下の何れかにより推定する。
ａ．白線に基づく自車進行路推定…左右両方、若しくは、左右どちらか片側の白線データが得られており、これら白線データから自車両１が走行している車線の形状が推定できる場合、自車進行路は、自車両１の幅や、自車両１の現在の車線内の位置を考慮して、白線と並行して形成される。
【００３９】
ｂ．ガードレール、縁石等の側壁データに基づく自車進行路推定…左右両方、若しくは、左右どちらか片側の側壁データが得られており、これら側壁データから自車両１が走行している車線の形状が推定できる場合、自車進行路は、自車両１の幅や、自車両１の現在の車線内の位置を考慮して、側壁と並行して形成される。
【００４０】
ｃ．自車両１の走行軌跡に基づく自車走行路推定…自車両１の運転状態を基に、自車進行路を推定する。例えば、車速Ｖ、ハンドル角θHを基に、以下ように自車進行路を推定する。
【００４１】
ハンドル角θHから求められる実舵角δfが、所定値（例えば０．５７度）以上で転舵が行われているか否か判定され、実舵角δfが０．５７度以上で操舵が行われている場合は、実舵角δfと車速Ｖを用いて例えば以下（６）、（７）式により現在の旋回曲率Ｃuaが算出される。
Ｒｅ＝（１＋Ａ0・Ｖ２）・（Ｌ／δ） …（６）
Ｃua＝１／Ｒｅ …（７）
ここで、Ｒｅは旋回半径（運転状態から導出した値）である。
【００４２】
また、実舵角δfが０．５７度より小さい場合は、現在の旋回曲率Ｃuaは０（直進走行状態）とされる。
【００４３】
こうして、得られる現在の旋回曲率Ｃuaを加えた過去所定時間（例えば約０．３秒間）の旋回曲率から平均旋回曲率を算出し、自車進行路を推定する。すなわち、この自車進行路推定部４０ｄは、自車進行路推定手段として設けられている。
【００４４】
カーブ進入判断部４０ｅは、道路形状認識部４０ｃからナビゲーション装置２１からの情報を基に求めた道路形状が、自車進行路推定部４０ｄから画像情報や運転状態を基に求めた自車進行路が入力される。そして、これらを比較して、自車両１がカーブに進入しようとしているのか否か判断し、判断結果を、目標ヨーレート演算部４０ｆ、道路形状に基づくヨーレート演算部４０ｇに出力する。例えば、自車進行路推定部４０ｄによる自車進行路が旋回状態となっていても道路形状認識部４０ｃからの道路形状にカーブが認識されていない場合や、両者のデータ間に大きなずれがある場合等には、カーブに進入しようしていないとして判断結果を出力する。また、交差点におけるナビゲーション装置２１からの情報を基に求めた道路形状（誘導経路）が直進であっても、自車進行路推定部４０ｄによる自車進行路が旋回状態となっている場合は、カーブに進入しようとしていると判断する。
【００４５】
目標ヨーレート演算部４０ｆは、ハンドル角センサ２４からハンドル角θHが、ヨーレート定常ゲイン演算部４０ｂからヨーレート定常ゲインＧγδｆ（０）が、カーブ進入判定部４０ｅからカーブ進入の判断結果が入力される。
【００４６】
そして、以下（８）式により、自車両１の運転状態に基づく目標ヨーレートφt1を演算し、特に、自車両１がアンダステア状態の際には、カーブ進入判定部４０ｅからの判断結果がカーブ進入との結果の場合、この演算した目標ヨーレートφt1をヨーレート比較判断部４０ｈに出力する。
【００４７】
すなわち、ハンドル角θHから求められる実舵角δfと、ヨーレート定常ゲインＧγδｆ（０）を基に、車両の応答遅れを考慮して目標ヨーレートφt1は、時定数をＴ，ラプラス演算子をｓとして、
φt1＝（１／（１＋Ｔ・ｓ））・Ｇγδｆ（０）・δf …（８）
で得られる。尚、上述の（８）式は、２次系で表現される車両の応答遅れを１次系に近似した式である。
【００４８】
道路形状に基づくヨーレート演算部４０ｇは、車速演算部４０ａから車速Ｖが、道路形状認識部４０ｃから最終的に演算されたカーブ曲率半径ｒp[j]が、カーブ進入判定部４０ｅからカーブ進入の判断結果が入力される。
【００４９】
そして、カーブ進入判定部４０ｅからの判断結果がカーブ進入との結果の場合、以下の（９）式により道路形状に基づくヨーレートφt2を演算し、ヨーレート比較判定部４０ｈ、ヨーレート偏差演算部４０ｎに出力する。
φt2＝Ｖ／ｒp[j] …（９）
【００５０】
ヨーレート比較判定部４０ｈは、目標ヨーレート演算部４０ｆから自車両１の運転状態に基づく目標ヨーレートφt1が入力され、道路形状に基づくヨーレート演算部４０ｇから道路形状に基づくヨーレートφt2が入力される。そして、これら２つのヨーレートの絶対値の大きさを比較して、大きい方のヨーレートを制御判断部４０ｉに出力する。
【００５１】
制御判断部４０ｉは、ヨーレートセンサ２５から実ヨーレートφrが入力され、ヨーレート比較判定部４０ｈから運転状態に基づく目標ヨーレートφt1と道路形状に基づくヨーレートφt2の絶対値とで大きい方のヨーレートが入力される。
【００５２】
そして、制御判断部４０ｉは、上述の大きい方のヨーレートの絶対値と実ヨーレートφrの絶対値との差が予め設定しておいた値以上の場合、アンダステア防止制御を作動させる信号を許容横加速度演算部４０ｋ、ヨーレート偏差演算部４０ｎに出力する。
【００５３】
この際、上述の予め設定しておいた値は、運転状態に基づく目標ヨーレートφt1の絶対値の方が大きい場合と、道路形状に基づくヨーレートφt2の絶対値の方が大きい場合とでそれぞれ異なる値が設定されている。具体的には、運転状態に基づく目標ヨーレートφt1の絶対値の方が大きい場合は、｜φt1｜−｜φr｜＞α１か否かの判定が行われ（すなわち、予め設定しておいた値はα１）、道路形状に基づくヨーレートφt2の絶対値の方が大きい場合は、｜φt2｜−｜φr｜＞α２か否かの判定が行われる（すなわち、予め設定しておいた値はα２）。ここで、α１＜α２。このように絶対値が大きい方のヨーレートを制御作動の判定に用いることにより、不必要な制御介入が防止され、ドライバに制御介入による違和感を与えることが防止できるようになっているのである。
【００５４】
路面μ推定部４０ｊは、ハンドル角センサ２４からハンドル角θHが、ヨーレートセンサ２５から実ヨーレートφrが、横加速度センサ２６から横加速度Ｇyが、車速演算部４０ａから車速Ｖがそれぞれ入力され、走行中の路面μを推定し、許容横加速度演算部４０ｋに出力する。この路面μ推定部４０ｊでの路面μの推定は、例えば、本出願人が先に提出した特開平８−２２７４号公報に既述した算出方法（適応制御を用いて路面μを推定する）等を用いて行われる。
【００５５】
許容横加速度演算部４０ｋは、制御判断部４０ｉからアンダステア防止制御の作動信号が、路面μ推定部４０ｊから推定した路面μが入力される。そして、制御判断部４０ｉからアンダステア防止制御の作動信号が入力された際に、以下の（１０）式により、許容横加速度ａｙを演算し、許容速度演算部４０ｌに出力する。
ａｙ＝（路面μ）・（安全率Ｋμｓ）・（重力加速度ｇ）…（１０）
ここで、カーブでの路面μは、現在の路面μのまま一定であると仮定し、路面μ推定部４０ｊにより推定した値をそのまま用いて計算する。また、安全率Ｋμｓは、路面μの推定精度や、車両特性（例えば、路面μが０．５でも０．５ｇの横加速度発生は不可能）を考慮し、０．５〜１．０程度の値とする。尚、この許容横加速度ａｙは、その他、車速Ｖや、前後駆動力、道路勾配、道路のバンク角等で補正し、より正確な値としても良い。
【００５６】
許容速度演算部４０ｌは、道路形状認識部４０ｃから最終的に演算されたカーブ曲率半径ｒp[j]が、許容横加速度演算部４０ｋから許容横加速度ａｙが入力され、カーブ進入に可能な最大の車速である許容速度Ｖａが、例えば以下の（１１）式により演算され、トルクダウン量演算部４０ｍに出力される。
Ｖａ＝（ｒp[j]・ａｙ）１／２ …（１１）
【００５７】
トルクダウン量演算部４０ｍは、車速演算部４０ａから車速Ｖが、許容速度演算部４０ｌから許容速度Ｖａが入力され、これらを比較して、前方のカーブを現在の運転状態（車速状態）では安定して旋回できないと判定した場合は必要なトルクダウン量Ｔdw（このトルク値までエンジン駆動力を低下させる）を演算して、エンジン制御装置３０に出力する。
【００５８】
すなわち、トルクダウン量演算部４０ｍは、Ｖ≦Ｖａであれば、現在の運転状態でも安定した旋回ができると判断し、エンジン制御装置３０に対してトルクダウン等の信号は出力しない。これに対し、Ｖ＞Ｖａである場合は、現在の車速では安定した旋回ができないと判断して、以下の（１２）式で必要なトルクダウン量Ｔdwを与える。
Ｔdw＝ａ・ｍ＋ｂ・Ｖａ２ …（１２）
ここで、ａは車両のころがり抵抗係数、ｂは車両の空気抵抗係数である。
【００５９】
ヨーレート偏差演算部４０ｎは、ヨーレートセンサ２５から実ヨーレートφrが、道路形状に基づくヨーレート演算部４０ｇから道路形状に基づくヨーレートφt2が、制御判断部４０ｉからアンダステア防止制御の作動信号がそれぞれ入力される。そして、制御判断部４０ｉからアンダステア防止制御の作動信号が入力された際に、以下の（１３）式により、φt2＋α３を基準とするヨーレート偏差Δφt2を演算し、目標制動力演算部４０ｏに出力する。
Δφt2＝φr−（φt2＋α３） …（１３）
ここで、ヨーレート偏差Δφt2を単にφr−φt2としないのは、アンダステア防止制御を作動させた時点では自車両１は既にアンダステア状態であり、カーブを通過するための道路形状に基づくヨーレートφt2が得られるように制御したのでは目標量が不足する可能性がある。従って、φt2＋α３として、この不足分を補えるようにするのである。尚、このα３は、アンダステア状態となってからの時間や絶対量から予め計算される値である。また、一定値であっても良い。
【００６０】
目標制動力演算部４０ｏは、ハンドル角センサ２４からハンドル角θHが、ヨーレートセンサ２５から実ヨーレートφrが、車速演算部４０ａから車速Ｖが、ヨーレート定常ゲイン演算部４０ｂからヨーレート定常ゲインＧγδｆ（０）が、ヨーレート偏差演算部４０ｎからφt2＋α３を基準とするヨーレート偏差Δφt2がそれぞれ入力される。
【００６１】
そして、目標制動力演算部４０ｏは、上述の各入力値と車両諸元を考慮して、例えば、以下の（１４）式により目標制動力ＢＦ２ｒを演算し、旋回内側後輪に対して、この目標制動力ＢＦ２ｒを付与するようにブレーキ駆動部１３に信号出力する。
ＢＦ２ｒ＝Ｇ1・（（ΔＡ・４・Ｌ２・ＣＰf・ＣＰr・Ｖ）
／（（ＣＰf・ＣＰr）／ｄｒ））・φr …（１４）
ここで、Ｇ1 はゲイン、ｄｆはフロントトレッド、ｄｒはリアトレッドを示し、ΔＡは、
ΔＡ＝（（δｆ／（Ｇγδｆ（０）・δｆ＋Δφt2））
−（１／Ｇγδｆ（０）））／（Ｌ・Ｖ） …（１５）
である。尚、（１５）式中のΔφt2は、さらに車両の進行方向と前後方向のなす角である横すべり角βを考慮して補正したものを用いても良い。
【００６２】
このように、本実施の形態によるアンダステア防止機能では、アンダステア防止のために旋回内側後輪に制動力を付与する際に、道路形状に基づくヨーレートφt2を基にして得られるヨーレート偏差Δφt2を基に制動力を設定するため、必要以上に制動力が大きくなることがなく、また、現在のドライバのステアリング操作ではカーブを通過することができないような場合であっても、カーブを通過できるように必要なヨーレートの発生が行われるのである。
【００６３】
尚、制御装置４０は、更にオーバステア防止機能の部分も有しているが、ここではその構成の説明は省略する。
【００６４】
次に、制御装置４０で実行される車両挙動制御を図６のフローチャートで説明する。このプログラムは、所定時間毎に繰り返し実行されるもので、まず、ステップ（以下、「Ｓ」と略称）１０１では、必要なパラメータの読み込みを行う。
【００６５】
次いで、Ｓ１０２に進むと、前述の（１）式によりヨーレート定常ゲインＧγδｆ（０）を演算し、Ｓ１０３に進み、前述の（８）式により目標ヨーレートφt1を演算する。
【００６６】
次に、Ｓ１０４に進むと、ヨーレート偏差Δφt1（＝φr−φt1）の演算が行われ、Ｓ１０５へと進む。
【００６７】
Ｓ１０５では、Δφt1の絶対値｜Δφt1｜と、０に極めて近い閾値Ｃ１との比較が行われ、Δφt1の絶対値｜Δφt1｜がＣ１以下である場合（｜Δφt1｜≦Ｃ１の場合）は、車両挙動は略ニュートラルステア状態であるため、そのままルーチンを抜ける。
【００６８】
一方、Ｓ１０５で、Δφt1の絶対値｜Δφt1｜がＣ１より大きい場合（｜Δφt1｜＞Ｃ１の場合）は、Ｓ１０６に進み、目標ヨーレートφt1の絶対値｜φt1｜と実ヨーレートφrの絶対値｜φr｜との比較を行う。
【００６９】
そして、Ｓ１０６の比較の結果、実ヨーレートφrの絶対値｜φr｜が目標ヨーレートφt1の絶対値｜φt1｜より大きければＳ１０７に進み、オーバステア防止制御を行い、逆に、実ヨーレートφrの絶対値｜φr｜が目標ヨーレートφt1の絶対値｜φt1｜より小さければＳ１０８に進み、後述の図７のフローチャートで説明するアンダステア防止制御を行うように設定してルーチンを抜ける。尚、Ｓ１０７によるオーバステア防止制御は、簡単に説明すると、旋回外側前輪を制動輪として選択し、必要な目標制動力を、ヨーレート偏差Δφt1や実ヨーレートφr等を用いて演算し出力する制御となっている。
【００７０】
図７に示すフローチャートは、前述のＳ１０８で実行されるアンダステア防止制御を示し、Ｓ２０１で必要なパラメータの読み込みを行い、Ｓ２０２に進み、道路形状認識部４０ｃは、ナビゲーション装置２１から送信されたノード毎の位置情報に基づき、最終的なカーブ曲率半径ｒp[j]等の道路形状を認識する。
【００７１】
次いで、Ｓ２０３に進み、自車進行路推定部４０ｄは、ＣＣＤカメラ２２Ｌ、２２Ｒからの画像情報や運転状態に基づき、前述のａ，ｂ，ｃの何れかにより自車進行路を推定する。
【００７２】
そして、Ｓ２０４に進んで、カーブ進入判断部４０ｅは、ナビゲーション装置２１からの情報を基に求めた道路形状と、画像情報や運転状態を基に求めた自車進行路とを比較して、自車両１がカーブに進入しようとしているのか否か判断し、カーブに進入しようとしているのであればＳ２０５へと進み、それ以外の場合はルーチンを抜ける。このＳ２０４での判断は、例えば、自車進行路が旋回状態となっていても道路形状でカーブが認識されていない場合や、両者のデータ間に大きなずれがある場合等には、カーブに進入しようしていないとして判断する。また、交差点におけるナビゲーション装置２１からの情報を基に求めた道路形状（誘導経路）が直進であっても、自車進行路が旋回状態となっている場合は、カーブに進入しようとしていると判断する。
【００７３】
Ｓ２０４でカーブに進入と判断してＳ２０５に進むと、道路形状に基づくヨーレート演算部４０ｇは、前述の（９）式により道路形状に基づくヨーレートφt2を演算する。
【００７４】
その後、Ｓ２０６に進み、ヨーレート比較判定部４０ｈは、Ｓ１０３で演算した自車両１の運転状態に基づく目標ヨーレートφt1の絶対値｜φt1｜と、Ｓ２０４で演算した道路形状に基づくヨーレートφt2の絶対値｜φt2｜とを比較する。
【００７５】
この結果、｜φt1｜＞｜φt2｜であれば、Ｓ２０７に進み、制御判断部４０ｉは、｜φt1｜−｜φr｜＞α１が成立するか否かの判定を行い、｜φt1｜≦｜φt2｜であれば、Ｓ２０８に進み、制御判断部４０ｉは、｜φt2｜−｜φr｜＞α２が成立するか否かの判定を行う。すなわち、絶対値の大きい方のヨーレートから実ヨーレートφrの絶対値｜φr｜を減算した値が、α１より大か（Ｓ２０７）、或いは、α２より大か（Ｓ２０８）の判定を行う。
【００７６】
こうして、Ｓ２０６からＳ２０７に進み、｜φt1｜−｜φr｜＞α１が成立する場合は、アンダステア防止制御を作動させるべくＳ２０９に進み、｜φt1｜−｜φr｜＞α１が成立しない場合（｜φt1｜−｜φr｜≦α１の場合）には、不要なアンダステア防止制御となるのを避けるためルーチンを抜ける。
【００７７】
同様に、Ｓ２０６からＳ２０８に進み、｜φt2｜−｜φr｜＞α２が成立する場合は、アンダステア防止制御を作動させるべくＳ２０９に進み、｜φt2｜−｜φr｜＞α２が成立しない場合（｜φt2｜−｜φr｜≦α２の場合）には、不要なアンダステア防止制御となるのを避けるためルーチンを抜ける。
【００７８】
Ｓ２０７、或いは、Ｓ２０８からＳ２０９に進むと、路面μ推定部４０ｊは、路面μを推定し、Ｓ２１０に進んで、許容横加速度演算部４０ｋは、前述の（１０）式により、許容横加速度ａｙを演算する。
【００７９】
その後、Ｓ２１１に進み、許容速度演算部４０ｌは、最終的に演算されたカーブ曲率半径ｒp[j]と許容横加速度ａｙを基にカーブ進入に可能な最大の車速である許容速度Ｖａを演算する。
【００８０】
そして、Ｓ２１２に進むと、トルクダウン量演算部４０ｍは、現在の車速Ｖと許容速度Ｖａとを比較して、現在の車速Ｖが許容速度Ｖａを上回っている場合（Ｖ＞Ｖａの場合）は、Ｓ２１３に進んで、必要なトルクダウン量Ｔdw（このトルク値までエンジン駆動力を低下させる）を、前述の（１２）式により演算し、エンジン制御装置３０に出力し、Ｓ２１４へと進む。
【００８１】
一方、Ｓ２１２で、現在の車速Ｖが許容速度Ｖａ以下の場合（Ｖ≦Ｖａの場合）は、現在の駆動力の状態でカーブを通過できると判断し、そのままＳ２１４へとジャンプする。
【００８２】
Ｓ２１４では、ヨーレート偏差演算部４０ｎは、φt2＋α３を基準とするヨーレート偏差Δφt2を演算し、Ｓ２１５に進んで、目標制動力演算部４０ｏは、前述の（１４）式により目標制動力ＢＦ２ｒを演算し、Ｓ２１６に進んで、旋回内側後輪に対し、目標制動力ＢＦ２ｒを付与するように信号出力してルーチンを抜ける。
【００８３】
尚、本実施の形態では、道路形状認識部４０ｃは、ナビゲーション装置２１からの情報を基に道路形状を得るようにしているが、これに限ることなく、例えば、レーダーやカメラによりカーブ情報が得られればこの情報を用いても良い。また、ＩＴＳ（Intelligent Transportation System ）で供給される情報からカーブ情報を得るようにしても良い。
【００８４】
【発明の効果】
以上説明したように本発明によれば、前方のカーブ形状、道路状態、運転状態等に応じ、ドライバに違和感を与えることなく最適なアンダステア状態の防止制御を実行し、安定した車両挙動を維持することが可能となる。
【図面の簡単な説明】
【図１】車両挙動制御装置を搭載した車両の概略構成を示す説明図
【図２】車両挙動制御装置のアンダステア防止機能部分の機能ブロック図
【図３】ナビゲーション装置からのデータの説明図
【図４】自車位置とノードに関する説明図
【図５】ノード角度及びカーブ曲率半径の演算に関する説明図
【図６】車両挙動制御のメインプログラムのフローチャート
【図７】アンダステア防止制御ルーチンのフローチャート
【符号の説明】
１ 自車両
２ エンジン
１２fl，１２fr，１２rl，１２rr 車輪
１３ ブレーキ駆動部
１６fl，１６fr，１６rl，１６rr ホイールシリンダ
２１ ナビゲーション装置（道路形状認識手段）
２２Ｌ，２２Ｒ ＣＣＤカメラ
２５ ヨーレートセンサ
４０ 制御装置（車両挙動制御装置、アンダステア防止手段）
４０ａ 車速演算部
４０ｂ ヨーレート定常ゲイン演算部
４０ｃ 道路形状認識部（道路形状認識手段）
４０ｄ 自車進行路推定部（自車進行路推定手段）
４０ｅ カーブ進入判定部
４０ｆ 目標ヨーレート演算部
４０ｇ 道路形状に基づくヨーレート演算部
４０ｈ ヨーレート比較判定部
４０ｉ 制御判断部
４０ｊ 路面μ推定部
４０ｋ 許容横加速度演算部
４０ｌ 許容速度演算部
４０ｍ トルクダウン量演算部
４０ｎ ヨーレート偏差演算部
４０ｏ 目標制動力演算部
【発明の属する技術分野】
本発明は、特に、自車両がアンダステア状態の場合に該アンダステア状態を最適に抑制する車両挙動制御装置に関する。
【０００２】
【従来の技術】
近年、車両のコーナリング等の際の車両にはたらく力の関係から、コーナリング中に制動力を適切な車輪に加え、車両安定性を向上させる車両挙動制御装置が開発され、実用化されている。
【０００３】
こうした車両挙動制御装置では、車両の実際のヨーレート（以下、実ヨーレートと略称）を検出し、車両の運転状態から目標ヨーレートを演算し、これらの関係、すなわち、実ヨーレートの絶対値が目標ヨーレートの絶対値より大きい場合は、車両はオーバステア傾向、逆に実ヨーレートの絶対値が目標ヨーレートの絶対値より小さい場合は、車両はアンダステア傾向と判定する。そして、オーバステア傾向の場合には旋回外側前輪を制動輪として選択し、アンダステア傾向の場合には旋回内側後輪を制動輪として選択し、所定の制動力を付加して車両の安定性を維持するものがある（例えば、特許文献１参照）。
【０００４】
【特許文献１】
特開平９−２２３４号広報
【０００５】
【発明が解決しようとする課題】
ところで、アンダステア状態においては、ドライバは、車両をより旋回させるため、通常走行時よりも大きく操舵してしまうことからステアリングを過剰に切り込むのが通例であり、上述の特許文献１のような車両挙動制御装置でアンダステア傾向を防止する際には、目標ヨーレートが大きくなって、制御量が過剰となり、失速、曲がりすぎとなる場合がある。また、アンダステア状態を、運転状態を基に演算する目標ヨーレートを用いて防止するだけでは、前方のカーブを旋回することが不可能な場合があり、更に、道路状態によっても、現在の運転状態のままでは制動制御のみで安定した車両挙動を維持して旋回することに対応できない場合も多い。
【０００６】
本発明は上記事情に鑑みてなされたもので、前方のカーブ形状、道路状態、運転状態等に応じ、ドライバに違和感を与えることなく最適なアンダステア状態の防止制御を実行し、安定した車両挙動を維持することができる車両挙動制御装置を提供することを目的とする。
【０００７】
【課題を解決するための手段】
上記目的を達成するため請求項１記載の本発明の車両挙動制御装置は、少なくとも自車両のアンダステア状態を検出し、該アンダステア状態を抑制させるアンダステア防止手段を備えた車両挙動制御装置において、道路形状を認識する道路形状認識手段と、自車進行路を推定する自車進行路推定手段とを有し、上記アンダステア防止手段は、上記自車両がアンダステア状態で上記道路形状と上記自車進行路との関係からカーブに進入すると判断した場合、上記道路形状に基づき該道路を走行するのに必要な道路形状に基づくヨーレートを演算すると共に上記自車両の運転状態に基づく目標ヨーレートを演算して、上記道路形状に基づくヨーレートと上記目標ヨーレートとを比較し、大きい方のヨーレートが実際のヨーレートを所定に超える場合に上記道路を走行するのに必要な駆動力のトルクダウン量と上記道路を走行するためのヨーレートを生じる所定の車輪に付与する制動力を演算し出力することを特徴としている。
【０００８】
また、請求項２記載の本発明の車両挙動制御装置は、請求項１記載の車両挙動制御装置において、上記道路形状認識手段は、ナビゲーション装置からのデータに基づき道路形状を認識することを特徴としている。
【０００９】
更に、請求項３記載の本発明の車両挙動制御装置は、請求項１又は請求項２記載の車両挙動制御装置において、上記自車進行路推定手段は、自車両前方を画像にて捉え該画像情報に基づき自車進行路を推定することを特徴としている。
【００１０】
更に、請求項４記載の本発明の車両挙動制御装置は、請求項１乃至請求項３の何れか一つに記載の車両挙動制御装置において、上記アンダステア防止手段は、上記道路を走行するのに必要な駆動力のトルクダウン量を求める場合、路面摩擦係数を基に該トルクダウン量を演算することを特徴としている。
【００１１】
すなわち、請求項１記載の車両挙動制御装置は、アンダステア防止手段は、自車両がアンダステア状態で、道路形状認識手段で認識した道路形状と自車進行路推定手段で推定した自車進行路との関係からカーブに進入すると判断した場合、道路形状に基づき該道路を走行するのに必要な道路形状に基づくヨーレートを演算すると共に自車両の運転状態に基づく目標ヨーレートを演算する。そして、道路形状に基づくヨーレートと目標ヨーレートとを比較し、大きい方のヨーレートが実際のヨーレートを所定に超える場合に道路を走行するのに必要な駆動力のトルクダウン量と道路を走行するためのヨーレートを生じる所定の車輪に付与する制動力を演算し出力する。これにより、前方のカーブ形状、道路状態、運転状態等に応じ、ドライバに違和感を与えることなく最適なアンダステア状態の防止制御を実行し、安定した車両挙動を維持することが可能となる。
【００１２】
この際、道路形状認識手段は、具体的には請求項２記載のように、ナビゲーション装置からのデータに基づき道路形状を認識するものとし、自車進行路推定手段は、具体的には請求項３記載のように、自車両前方を画像にて捉え該画像情報に基づき自車進行路を推定するものとする。
【００１３】
また、アンダステア防止手段は、道路を走行するのに必要な駆動力のトルクダウン量を求める場合、具体的には請求項４記載のように、路面摩擦係数を基に該トルクダウン量を演算する。
【００１４】
【発明の実施の形態】
以下、図面を参照して本発明の実施の形態を説明する。図１〜図７は本発明の実施の一形態に係わり、図１は車両挙動制御装置を搭載した車両の概略構成を示す説明図、図２は車両挙動制御装置のアンダステア防止機能部分の機能ブロック図、図３はナビゲーション装置からのデータの説明図、図４は自車位置とノードに関する説明図、図５はノード角度及びカーブ曲率半径の演算に関する説明図、図６は車両挙動制御のメインプログラムのフローチャート、図７はアンダステア防止制御ルーチンのフローチャートである。
【００１５】
図１において、符号１はセンターディファレンシャル装置および自動変速装置を有する４輪駆動車を一例とする車両を示し、車両前部に配置されたエンジン２による駆動力は、このエンジン２後方の自動変速装置（トルクコンバータ等も含んで図示）３からトランスミッション出力軸３ａを経てセンターディファレンシャル装置４に伝達される。そして、駆動力は、このセンターディファレンシャル装置４から、リヤドライブ軸５、プロペラシャフト６、ドライブピニオン７を介して後輪終減速装置８に入力される一方、センターディファレンシャル装置４から、フロントドライブ軸９を介して前輪終減速装置１０に入力される。ここで、自動変速装置３、センターディファレンシャル装置４、及び、前輪終減速装置１０等は、図示しないケース内に一体に設けられている。
【００１６】
後輪終減速装置８に入力された駆動力は、後輪左ドライブ軸１１rlを経て左後輪１２rlに、後輪右ドライブ軸１１rrを経て右後輪１２rrに伝達される。一方、前輪終減速装置１０に入力された駆動力は、前輪左ドライブ軸１１flを経て左前輪１２flに、前輪右ドライブ軸１１frを経て右前輪１２frに伝達される。
【００１７】
符号１３は車両のブレーキ駆動部を示し、このブレーキ駆動部１３には、ドライバにより操作されるブレーキペダル１４と接続されたマスターシリンダ１５が接続されている。そして、ドライバがブレーキペダル１４を操作するとマスターシリンダ１５により、ブレーキ駆動部１３を通じて、４輪１２fl，１２fr，１２rl，１２rrの各ホイールシリンダ（左前輪ホイールシリンダ１６fl，右前輪ホイールシリンダ１６fr，左後輪ホイールシリンダ１６rl，右後輪ホイールシリンダ１６rr）にブレーキ圧が導入され、これにより４輪にブレーキがかかって制動される。
【００１８】
ブレーキ駆動部１３は、加圧源、減圧弁、増圧弁等を備えたハイドロリックユニットで、後述する車両挙動制御装置としての制御装置４０からの入力信号に応じて、各ホイールシリンダ１６fl，１６fr，１６rl，１６rrに対して、それぞれ独立にブレーキ圧を導入自在に構成されている。
【００１９】
車両１には、公知のナビゲーション装置２１が搭載され、制御装置４０と接続されており、このナビゲーション装置２１からは、図３に示すように、自車走行ルートに関して送出されるノード数ｎ、自車位置の東経、自車位置の北緯、自車直後のノードに関するデータ、及び自車前方の設定範囲内における自車走行ルートのノードに関するデータ（自車直前のノードに関するデータ、自車前方２点目のノードに関するデータ、…、自車前方（ｎ−１）点目のノードに関するデータ）が、例えば５００ｍｓ毎に出力される。各ノードに関するデータには、図示の如く、自車位置からノードまでの東方向位置、自車位置からノードまでの北方向位置、ノード位置に交差点があるか否かを識別する交差点フラグ、道路種別、道路幅等の情報が含まれている。
【００２０】
このナビゲーション装置２１は、乗員により目的地が入力された場合には、入力された目的地に対して自車が進むべく最適な案内経路を設定する。そして、設定された案内経路上の、例えば自車前方３００ｍまでのノードに関するデータと自車直後のノードに関するデータを自車走行ルートのノードに関するデータとして制御部４０に出力する。
【００２１】
一方、ナビゲーション装置２１は、乗員による目的地の入力がなされていない場合は、例えば道路種別や道路幅等の情報に基づいて自車が進むであろう経路の優先順位を推定し、その中で最も優先順位の高い経路を推定経路として設定する。そして、設定された推定経路上の例えば自車前方３００ｍまでのノードに関するデータと自車直後のノードに関するデータを自車走行ルートのノードに関するデータとして制御部４０に出力する。
【００２２】
また、車両１には、ステレオ光学系として例えば電荷結合素子（ＣＣＤ）等の固体撮像素子を用いた１組の（左右）のＣＣＤカメラ２２Ｌ、２２Ｒが設けられている。これら左右のＣＣＤカメラ２２Ｌ、２２Ｒは、それぞれ車室内の天井前方に一定の間隔をもって取り付けられ、車外の対象を異なる視点からステレオ撮像し、画像を制御装置４０に入力する。
【００２３】
更に、車両には、４輪１２fl，１２fr，１２rl，１２rrの各車輪速度ωfl，ωfr，ωrl，ωrrを検出する車輪速度センサ２３fl，２３fr，２３rl，２３rr、車両１のハンドル角θH を検出するハンドル角センサ２４、実ヨーレートφrを検出するヨーレートセンサ２５、横加速度Ｇyを検出する横加速度センサ２６等の各センサが設けられており、制御装置４０に各センサ信号を入力するように構成されている。
【００２４】
制御装置４０は、ナビゲーション装置２１から上述の各道路情報が入力され、ＣＣＤカメラ２２Ｌ、２２Ｒから上述の前方画像が入力される。また、各センサ２３fl，２３fr，２３rl，２３rr、２４、２５、２６から、それぞれ、４輪１２fl，１２fr，１２rl，１２rrの各車輪速度ωfl，ωfr，ωrl，ωrr、ハンドル角θH、実ヨーレートφr、横加速度Ｇyが入力される。そして、これらの入力に基づき、制御装置４０は、車両の挙動がアンダステア状態か、オーバステア状態か判定し、車両挙動を安定させるべくブレーキ駆動部１３やエンジン制御装置３０に信号出力するように構成されている。
【００２５】
すなわち、制御装置４０は、マイクロコンピュータとその周辺回路で構成され、図２に示すように、アンダステア防止手段としてのアンダステア防止機能に関する部分は、車速演算部４０ａ、ヨーレート定常ゲイン演算部４０ｂ、道路形状認識部４０ｃ、自車進行路推定部４０ｄ、カーブ進入判定部４０ｅ、目標ヨーレート演算部４０ｆ、道路形状に基づくヨーレート演算部４０ｇ、ヨーレート比較判定部４０ｈ、制御判断部４０ｉ、路面μ（路面摩擦係数）推定部４０ｊ、許容横加速度演算部４０ｋ、許容速度演算部４０ｌ、トルクダウン量演算部４０ｍ、ヨーレート偏差演算部４０ｎ、目標制動力演算部４０ｏから主要に構成されている。
【００２６】
車速演算部４０ａは、４輪の車輪速センサ、すなわち各車輪速度センサ２３fl，２３fr，２３rl，２３rrから４輪１２fl，１２fr，１２rl，１２rrの各車輪速度ωfl，ωfr，ωrl，ωrrが入力され、例えばこれらの平均を演算することにより車速Ｖ（＝（ωfl，ωfr，ωrl，ωrr）／４）を演算し、ヨーレート定常ゲイン演算部４０ｂ、自車進行路推定部４０ｄ、道路形状に基づくヨーレート演算部４０ｇ、路面μ推定部４０ｊ、トルクダウン量演算部４０ｍ、目標制動力演算部４０ｏに出力する。
【００２７】
ヨーレート定常ゲイン演算部４０ｂは、ハンドル角センサ２４からハンドル角θHが入力され、車両の定常円旋回時の実舵角δfに対するヨーレートの値（ヨーレート定常ゲインＧγδｆ（０））を以下の（１）式により求め、目標ヨーレート演算部４０ｆと目標制動力演算部４０ｏに出力する。すなわち、ホイールベースをＬ，車両の諸元で決まるスタビリティファクタをＡ0とすると、
Ｇγδｆ（０）＝（１／（１＋Ａ0・Ｖ２））・（Ｖ／Ｌ） …（１）
また、スタビリティファクタＡ0は、車両質量をｍ，前軸と重心間の距離をＬf，後軸と重心間の距離をＬr，フロント等価コーナリングパワーをＣＰf，リア等価コーナリングパワーをＣＰrとすると次式で求められる。
Ａ0＝（−ｍ・（Ｌf・ＣＰf−Ｌr・ＣＰr））
／（２・Ｌ２・ＣＰf・ＣＰr） …（２）
【００２８】
道路形状認識部４０ｃでは、ナビゲーション装置２１から送信されたノード毎の位置情報に基づき、各々のノードについて、１つ手前のノードとの間隔、カーブ曲率半径及びノード角度が演算される。これらの演算値は、交差点識別、道路種別、道路幅、後述する特異点識別等に関する情報と共に、各ノードの属性情報として記憶格納される。
【００２９】
具体的には、道路形状認識部４０ｃは、ナビゲーション装置２１から送信された、自車位置を基準としたノード座標（図４参照）を用いて、ノードＰj（ｘP[j]，ｙp[j]）と１つ手前のノードＰj-1（ｘp[j-1]，ｙp[j-1]）との間隔Ｌp[j]を、
Ｌp[j]＝（（ｘP[j]−ｘp[j-1]）２＋（ｙp[j]−ｙp[j-1]）２）１／２
（但し、１≦ｊ≦ｎ−１）…（３）
により各ノードについて演算する。
【００３０】
続いて、道路形状認識部４０ｃは、例えば図５に示すように、ノード座標に基づいて、各ノードＰjにおけるノード角度ｔp[j]を、以下（４）式により演算する。
ｔp[j]＝sin−１（（（ｘp[j-1]−ｘp[j]）・（ｙp[j]−ｙp[j+1]）
−（ｘp[j]−ｘp[j+1]）・（ｙp[j-1]−ｙp[j]））／（Ｌp[j]・Ｌp[j+1]）） …（４）
尚、ここで得られたノード角度ｔp[j]は、右コーナの場合、正値で表され、左コーナの場合、負値で表される。
【００３１】
以上の計算結果に基づいて、道路形状認識部４０ｃでは、ノードＰjでのカーブ曲率半径ｒp[j]を、以下（５）式により演算する。
ｒp[j]＝min（ＬP[j]，Ｌp[j+1]）／２／tan（｜ｔp[j]｜／２）…（５）
ここで、min（Ｌp[j]，Ｌp[j+1]）は、Ｌp[j]とＬp[j+1]の何れか短い方を選択するとの意味であり、例えば、図５においては、Ｌp[j]＜Ｌp[j+1]であるため、min（ＬP[j]，Ｌp[j+1]）＝Ｌp[j]である。
【００３２】
また、道路形状認識部４０ｃは、ナビゲーション装置２１から送信されるデータをそのまま用いて（ナビゲーション装置２１で予め定義づけられているデータをそのまま用いて）、各ノード毎に交差点識別（交差点か否か、或いは案内経路上の交差点か）、道路の種別（高速自動車国道、都市高速道路、一般国道、主要地方道、その他）、道路幅の設定等を行う。
【００３３】
更に、道路形状認識部４０ｃでは、ナビゲーション装置２１から送信された各ノードについての特異点判定を行い、ノードＰjが特異点であると判定された場合には、判定されたノードＰjを除いた前後のノードＰj-1，Ｐj+1間におけるノード角度ｔp[J+1]、カーブ曲率半径ｒp[j+1]の再演算を行う。
【００３４】
すなわち、隣接するノード間隔が接近しすぎていると演算されたカーブ曲率半径は実際の道路の曲率半径よりも小さくなりすぎた値となってしまい、結果として何でもないカーブで過剰に車両挙動制御をしてしまう。これを防止するため、道路形状認識部４０ｃでは、このようなノードを、道路種別属性ｃp[j]、道路幅属性ｗp[j]を考慮した上で、ノード間隔Ｌp[j]、ノード角度ｔp[j]に基づいて、ノード角度、カーブ曲率半径演算時の特異点として除外する。
【００３５】
こうして、道路形状認識部４０ｃにて最終的に演算されたカーブ曲率半径ｒp[j]は、カーブ進入判定部４０ｅ、道路形状に基づくヨーレート演算部４０ｇ、許容速度演算部４０ｌに出力される。すなわち、本実施の形態においては、ナビゲーション装置２１、道路形状認識部４０ｃにて道路形状認識手段が構成されている。
【００３６】
自車進行路推定部４０ｄは、ＣＣＤカメラ２２Ｌ、２２Ｒから画像情報が、ハンドル角センサ２４からハンドル角θHが、車速演算部４０ａから車速Ｖがそれぞれ入力される。そして、ＣＣＤカメラ２２Ｌ、２２Ｒから画像情報に基づき自車両１前方の立体物データと側壁データと白線データの前方情報を検出し、これら前方情報や自車両１の運転状態から自車両１の進行路（自車進行路）を推定する。
【００３７】
ここで、自車進行路推定部４０ｄにおける、ＣＣＤカメラ２２Ｌ、２２Ｒからの画像の処理は、例えば以下のように行われる。まず、ＣＣＤカメラ２２Ｌ、２２Ｒで撮像した自車両の進入方向の環境の１組のステレオ画像対に対し、対応する位置のずれ量から三角測量の原理によって画像全体に渡る距離情報を求める処理を行なって、三次元の距離分布を表す距離画像を生成する。そして、このデータを基に、周知のグルーピング処理や、予め記憶しておいた３次元的な道路形状データ、側壁データ、立体物データ等と比較し、白線データ、道路に沿って存在するガードレール、縁石等の側壁データ、車両等の立体物データを抽出する。こうして抽出された白線データ、側壁データ、立体物データは、それぞれのデータ毎に異なったナンバーが割り当てられる。
【００３８】
そして、自車進行路推定部４０ｄでは、自車進行路を以下の何れかにより推定する。
ａ．白線に基づく自車進行路推定…左右両方、若しくは、左右どちらか片側の白線データが得られており、これら白線データから自車両１が走行している車線の形状が推定できる場合、自車進行路は、自車両１の幅や、自車両１の現在の車線内の位置を考慮して、白線と並行して形成される。
【００３９】
ｂ．ガードレール、縁石等の側壁データに基づく自車進行路推定…左右両方、若しくは、左右どちらか片側の側壁データが得られており、これら側壁データから自車両１が走行している車線の形状が推定できる場合、自車進行路は、自車両１の幅や、自車両１の現在の車線内の位置を考慮して、側壁と並行して形成される。
【００４０】
ｃ．自車両１の走行軌跡に基づく自車走行路推定…自車両１の運転状態を基に、自車進行路を推定する。例えば、車速Ｖ、ハンドル角θHを基に、以下ように自車進行路を推定する。
【００４１】
ハンドル角θHから求められる実舵角δfが、所定値（例えば０．５７度）以上で転舵が行われているか否か判定され、実舵角δfが０．５７度以上で操舵が行われている場合は、実舵角δfと車速Ｖを用いて例えば以下（６）、（７）式により現在の旋回曲率Ｃuaが算出される。
Ｒｅ＝（１＋Ａ0・Ｖ２）・（Ｌ／δ） …（６）
Ｃua＝１／Ｒｅ …（７）
ここで、Ｒｅは旋回半径（運転状態から導出した値）である。
【００４２】
また、実舵角δfが０．５７度より小さい場合は、現在の旋回曲率Ｃuaは０（直進走行状態）とされる。
【００４３】
こうして、得られる現在の旋回曲率Ｃuaを加えた過去所定時間（例えば約０．３秒間）の旋回曲率から平均旋回曲率を算出し、自車進行路を推定する。すなわち、この自車進行路推定部４０ｄは、自車進行路推定手段として設けられている。
【００４４】
カーブ進入判断部４０ｅは、道路形状認識部４０ｃからナビゲーション装置２１からの情報を基に求めた道路形状が、自車進行路推定部４０ｄから画像情報や運転状態を基に求めた自車進行路が入力される。そして、これらを比較して、自車両１がカーブに進入しようとしているのか否か判断し、判断結果を、目標ヨーレート演算部４０ｆ、道路形状に基づくヨーレート演算部４０ｇに出力する。例えば、自車進行路推定部４０ｄによる自車進行路が旋回状態となっていても道路形状認識部４０ｃからの道路形状にカーブが認識されていない場合や、両者のデータ間に大きなずれがある場合等には、カーブに進入しようしていないとして判断結果を出力する。また、交差点におけるナビゲーション装置２１からの情報を基に求めた道路形状（誘導経路）が直進であっても、自車進行路推定部４０ｄによる自車進行路が旋回状態となっている場合は、カーブに進入しようとしていると判断する。
【００４５】
目標ヨーレート演算部４０ｆは、ハンドル角センサ２４からハンドル角θHが、ヨーレート定常ゲイン演算部４０ｂからヨーレート定常ゲインＧγδｆ（０）が、カーブ進入判定部４０ｅからカーブ進入の判断結果が入力される。
【００４６】
そして、以下（８）式により、自車両１の運転状態に基づく目標ヨーレートφt1を演算し、特に、自車両１がアンダステア状態の際には、カーブ進入判定部４０ｅからの判断結果がカーブ進入との結果の場合、この演算した目標ヨーレートφt1をヨーレート比較判断部４０ｈに出力する。
【００４７】
すなわち、ハンドル角θHから求められる実舵角δfと、ヨーレート定常ゲインＧγδｆ（０）を基に、車両の応答遅れを考慮して目標ヨーレートφt1は、時定数をＴ，ラプラス演算子をｓとして、
φt1＝（１／（１＋Ｔ・ｓ））・Ｇγδｆ（０）・δf …（８）
で得られる。尚、上述の（８）式は、２次系で表現される車両の応答遅れを１次系に近似した式である。
【００４８】
道路形状に基づくヨーレート演算部４０ｇは、車速演算部４０ａから車速Ｖが、道路形状認識部４０ｃから最終的に演算されたカーブ曲率半径ｒp[j]が、カーブ進入判定部４０ｅからカーブ進入の判断結果が入力される。
【００４９】
そして、カーブ進入判定部４０ｅからの判断結果がカーブ進入との結果の場合、以下の（９）式により道路形状に基づくヨーレートφt2を演算し、ヨーレート比較判定部４０ｈ、ヨーレート偏差演算部４０ｎに出力する。
φt2＝Ｖ／ｒp[j] …（９）
【００５０】
ヨーレート比較判定部４０ｈは、目標ヨーレート演算部４０ｆから自車両１の運転状態に基づく目標ヨーレートφt1が入力され、道路形状に基づくヨーレート演算部４０ｇから道路形状に基づくヨーレートφt2が入力される。そして、これら２つのヨーレートの絶対値の大きさを比較して、大きい方のヨーレートを制御判断部４０ｉに出力する。
【００５１】
制御判断部４０ｉは、ヨーレートセンサ２５から実ヨーレートφrが入力され、ヨーレート比較判定部４０ｈから運転状態に基づく目標ヨーレートφt1と道路形状に基づくヨーレートφt2の絶対値とで大きい方のヨーレートが入力される。
【００５２】
そして、制御判断部４０ｉは、上述の大きい方のヨーレートの絶対値と実ヨーレートφrの絶対値との差が予め設定しておいた値以上の場合、アンダステア防止制御を作動させる信号を許容横加速度演算部４０ｋ、ヨーレート偏差演算部４０ｎに出力する。
【００５３】
この際、上述の予め設定しておいた値は、運転状態に基づく目標ヨーレートφt1の絶対値の方が大きい場合と、道路形状に基づくヨーレートφt2の絶対値の方が大きい場合とでそれぞれ異なる値が設定されている。具体的には、運転状態に基づく目標ヨーレートφt1の絶対値の方が大きい場合は、｜φt1｜−｜φr｜＞α１か否かの判定が行われ（すなわち、予め設定しておいた値はα１）、道路形状に基づくヨーレートφt2の絶対値の方が大きい場合は、｜φt2｜−｜φr｜＞α２か否かの判定が行われる（すなわち、予め設定しておいた値はα２）。ここで、α１＜α２。このように絶対値が大きい方のヨーレートを制御作動の判定に用いることにより、不必要な制御介入が防止され、ドライバに制御介入による違和感を与えることが防止できるようになっているのである。
【００５４】
路面μ推定部４０ｊは、ハンドル角センサ２４からハンドル角θHが、ヨーレートセンサ２５から実ヨーレートφrが、横加速度センサ２６から横加速度Ｇyが、車速演算部４０ａから車速Ｖがそれぞれ入力され、走行中の路面μを推定し、許容横加速度演算部４０ｋに出力する。この路面μ推定部４０ｊでの路面μの推定は、例えば、本出願人が先に提出した特開平８−２２７４号公報に既述した算出方法（適応制御を用いて路面μを推定する）等を用いて行われる。
【００５５】
許容横加速度演算部４０ｋは、制御判断部４０ｉからアンダステア防止制御の作動信号が、路面μ推定部４０ｊから推定した路面μが入力される。そして、制御判断部４０ｉからアンダステア防止制御の作動信号が入力された際に、以下の（１０）式により、許容横加速度ａｙを演算し、許容速度演算部４０ｌに出力する。
ａｙ＝（路面μ）・（安全率Ｋμｓ）・（重力加速度ｇ）…（１０）
ここで、カーブでの路面μは、現在の路面μのまま一定であると仮定し、路面μ推定部４０ｊにより推定した値をそのまま用いて計算する。また、安全率Ｋμｓは、路面μの推定精度や、車両特性（例えば、路面μが０．５でも０．５ｇの横加速度発生は不可能）を考慮し、０．５〜１．０程度の値とする。尚、この許容横加速度ａｙは、その他、車速Ｖや、前後駆動力、道路勾配、道路のバンク角等で補正し、より正確な値としても良い。
【００５６】
許容速度演算部４０ｌは、道路形状認識部４０ｃから最終的に演算されたカーブ曲率半径ｒp[j]が、許容横加速度演算部４０ｋから許容横加速度ａｙが入力され、カーブ進入に可能な最大の車速である許容速度Ｖａが、例えば以下の（１１）式により演算され、トルクダウン量演算部４０ｍに出力される。
Ｖａ＝（ｒp[j]・ａｙ）１／２ …（１１）
【００５７】
トルクダウン量演算部４０ｍは、車速演算部４０ａから車速Ｖが、許容速度演算部４０ｌから許容速度Ｖａが入力され、これらを比較して、前方のカーブを現在の運転状態（車速状態）では安定して旋回できないと判定した場合は必要なトルクダウン量Ｔdw（このトルク値までエンジン駆動力を低下させる）を演算して、エンジン制御装置３０に出力する。
【００５８】
すなわち、トルクダウン量演算部４０ｍは、Ｖ≦Ｖａであれば、現在の運転状態でも安定した旋回ができると判断し、エンジン制御装置３０に対してトルクダウン等の信号は出力しない。これに対し、Ｖ＞Ｖａである場合は、現在の車速では安定した旋回ができないと判断して、以下の（１２）式で必要なトルクダウン量Ｔdwを与える。
Ｔdw＝ａ・ｍ＋ｂ・Ｖａ２ …（１２）
ここで、ａは車両のころがり抵抗係数、ｂは車両の空気抵抗係数である。
【００５９】
ヨーレート偏差演算部４０ｎは、ヨーレートセンサ２５から実ヨーレートφrが、道路形状に基づくヨーレート演算部４０ｇから道路形状に基づくヨーレートφt2が、制御判断部４０ｉからアンダステア防止制御の作動信号がそれぞれ入力される。そして、制御判断部４０ｉからアンダステア防止制御の作動信号が入力された際に、以下の（１３）式により、φt2＋α３を基準とするヨーレート偏差Δφt2を演算し、目標制動力演算部４０ｏに出力する。
Δφt2＝φr−（φt2＋α３） …（１３）
ここで、ヨーレート偏差Δφt2を単にφr−φt2としないのは、アンダステア防止制御を作動させた時点では自車両１は既にアンダステア状態であり、カーブを通過するための道路形状に基づくヨーレートφt2が得られるように制御したのでは目標量が不足する可能性がある。従って、φt2＋α３として、この不足分を補えるようにするのである。尚、このα３は、アンダステア状態となってからの時間や絶対量から予め計算される値である。また、一定値であっても良い。
【００６０】
目標制動力演算部４０ｏは、ハンドル角センサ２４からハンドル角θHが、ヨーレートセンサ２５から実ヨーレートφrが、車速演算部４０ａから車速Ｖが、ヨーレート定常ゲイン演算部４０ｂからヨーレート定常ゲインＧγδｆ（０）が、ヨーレート偏差演算部４０ｎからφt2＋α３を基準とするヨーレート偏差Δφt2がそれぞれ入力される。
【００６１】
そして、目標制動力演算部４０ｏは、上述の各入力値と車両諸元を考慮して、例えば、以下の（１４）式により目標制動力ＢＦ２ｒを演算し、旋回内側後輪に対して、この目標制動力ＢＦ２ｒを付与するようにブレーキ駆動部１３に信号出力する。
ＢＦ２ｒ＝Ｇ1・（（ΔＡ・４・Ｌ２・ＣＰf・ＣＰr・Ｖ）
／（（ＣＰf・ＣＰr）／ｄｒ））・φr …（１４）
ここで、Ｇ1 はゲイン、ｄｆはフロントトレッド、ｄｒはリアトレッドを示し、ΔＡは、
ΔＡ＝（（δｆ／（Ｇγδｆ（０）・δｆ＋Δφt2））
−（１／Ｇγδｆ（０）））／（Ｌ・Ｖ） …（１５）
である。尚、（１５）式中のΔφt2は、さらに車両の進行方向と前後方向のなす角である横すべり角βを考慮して補正したものを用いても良い。
【００６２】
このように、本実施の形態によるアンダステア防止機能では、アンダステア防止のために旋回内側後輪に制動力を付与する際に、道路形状に基づくヨーレートφt2を基にして得られるヨーレート偏差Δφt2を基に制動力を設定するため、必要以上に制動力が大きくなることがなく、また、現在のドライバのステアリング操作ではカーブを通過することができないような場合であっても、カーブを通過できるように必要なヨーレートの発生が行われるのである。
【００６３】
尚、制御装置４０は、更にオーバステア防止機能の部分も有しているが、ここではその構成の説明は省略する。
【００６４】
次に、制御装置４０で実行される車両挙動制御を図６のフローチャートで説明する。このプログラムは、所定時間毎に繰り返し実行されるもので、まず、ステップ（以下、「Ｓ」と略称）１０１では、必要なパラメータの読み込みを行う。
【００６５】
次いで、Ｓ１０２に進むと、前述の（１）式によりヨーレート定常ゲインＧγδｆ（０）を演算し、Ｓ１０３に進み、前述の（８）式により目標ヨーレートφt1を演算する。
【００６６】
次に、Ｓ１０４に進むと、ヨーレート偏差Δφt1（＝φr−φt1）の演算が行われ、Ｓ１０５へと進む。
【００６７】
Ｓ１０５では、Δφt1の絶対値｜Δφt1｜と、０に極めて近い閾値Ｃ１との比較が行われ、Δφt1の絶対値｜Δφt1｜がＣ１以下である場合（｜Δφt1｜≦Ｃ１の場合）は、車両挙動は略ニュートラルステア状態であるため、そのままルーチンを抜ける。
【００６８】
一方、Ｓ１０５で、Δφt1の絶対値｜Δφt1｜がＣ１より大きい場合（｜Δφt1｜＞Ｃ１の場合）は、Ｓ１０６に進み、目標ヨーレートφt1の絶対値｜φt1｜と実ヨーレートφrの絶対値｜φr｜との比較を行う。
【００６９】
そして、Ｓ１０６の比較の結果、実ヨーレートφrの絶対値｜φr｜が目標ヨーレートφt1の絶対値｜φt1｜より大きければＳ１０７に進み、オーバステア防止制御を行い、逆に、実ヨーレートφrの絶対値｜φr｜が目標ヨーレートφt1の絶対値｜φt1｜より小さければＳ１０８に進み、後述の図７のフローチャートで説明するアンダステア防止制御を行うように設定してルーチンを抜ける。尚、Ｓ１０７によるオーバステア防止制御は、簡単に説明すると、旋回外側前輪を制動輪として選択し、必要な目標制動力を、ヨーレート偏差Δφt1や実ヨーレートφr等を用いて演算し出力する制御となっている。
【００７０】
図７に示すフローチャートは、前述のＳ１０８で実行されるアンダステア防止制御を示し、Ｓ２０１で必要なパラメータの読み込みを行い、Ｓ２０２に進み、道路形状認識部４０ｃは、ナビゲーション装置２１から送信されたノード毎の位置情報に基づき、最終的なカーブ曲率半径ｒp[j]等の道路形状を認識する。
【００７１】
次いで、Ｓ２０３に進み、自車進行路推定部４０ｄは、ＣＣＤカメラ２２Ｌ、２２Ｒからの画像情報や運転状態に基づき、前述のａ，ｂ，ｃの何れかにより自車進行路を推定する。
【００７２】
そして、Ｓ２０４に進んで、カーブ進入判断部４０ｅは、ナビゲーション装置２１からの情報を基に求めた道路形状と、画像情報や運転状態を基に求めた自車進行路とを比較して、自車両１がカーブに進入しようとしているのか否か判断し、カーブに進入しようとしているのであればＳ２０５へと進み、それ以外の場合はルーチンを抜ける。このＳ２０４での判断は、例えば、自車進行路が旋回状態となっていても道路形状でカーブが認識されていない場合や、両者のデータ間に大きなずれがある場合等には、カーブに進入しようしていないとして判断する。また、交差点におけるナビゲーション装置２１からの情報を基に求めた道路形状（誘導経路）が直進であっても、自車進行路が旋回状態となっている場合は、カーブに進入しようとしていると判断する。
【００７３】
Ｓ２０４でカーブに進入と判断してＳ２０５に進むと、道路形状に基づくヨーレート演算部４０ｇは、前述の（９）式により道路形状に基づくヨーレートφt2を演算する。
【００７４】
その後、Ｓ２０６に進み、ヨーレート比較判定部４０ｈは、Ｓ１０３で演算した自車両１の運転状態に基づく目標ヨーレートφt1の絶対値｜φt1｜と、Ｓ２０４で演算した道路形状に基づくヨーレートφt2の絶対値｜φt2｜とを比較する。
【００７５】
この結果、｜φt1｜＞｜φt2｜であれば、Ｓ２０７に進み、制御判断部４０ｉは、｜φt1｜−｜φr｜＞α１が成立するか否かの判定を行い、｜φt1｜≦｜φt2｜であれば、Ｓ２０８に進み、制御判断部４０ｉは、｜φt2｜−｜φr｜＞α２が成立するか否かの判定を行う。すなわち、絶対値の大きい方のヨーレートから実ヨーレートφrの絶対値｜φr｜を減算した値が、α１より大か（Ｓ２０７）、或いは、α２より大か（Ｓ２０８）の判定を行う。
【００７６】
こうして、Ｓ２０６からＳ２０７に進み、｜φt1｜−｜φr｜＞α１が成立する場合は、アンダステア防止制御を作動させるべくＳ２０９に進み、｜φt1｜−｜φr｜＞α１が成立しない場合（｜φt1｜−｜φr｜≦α１の場合）には、不要なアンダステア防止制御となるのを避けるためルーチンを抜ける。
【００７７】
同様に、Ｓ２０６からＳ２０８に進み、｜φt2｜−｜φr｜＞α２が成立する場合は、アンダステア防止制御を作動させるべくＳ２０９に進み、｜φt2｜−｜φr｜＞α２が成立しない場合（｜φt2｜−｜φr｜≦α２の場合）には、不要なアンダステア防止制御となるのを避けるためルーチンを抜ける。
【００７８】
Ｓ２０７、或いは、Ｓ２０８からＳ２０９に進むと、路面μ推定部４０ｊは、路面μを推定し、Ｓ２１０に進んで、許容横加速度演算部４０ｋは、前述の（１０）式により、許容横加速度ａｙを演算する。
【００７９】
その後、Ｓ２１１に進み、許容速度演算部４０ｌは、最終的に演算されたカーブ曲率半径ｒp[j]と許容横加速度ａｙを基にカーブ進入に可能な最大の車速である許容速度Ｖａを演算する。
【００８０】
そして、Ｓ２１２に進むと、トルクダウン量演算部４０ｍは、現在の車速Ｖと許容速度Ｖａとを比較して、現在の車速Ｖが許容速度Ｖａを上回っている場合（Ｖ＞Ｖａの場合）は、Ｓ２１３に進んで、必要なトルクダウン量Ｔdw（このトルク値までエンジン駆動力を低下させる）を、前述の（１２）式により演算し、エンジン制御装置３０に出力し、Ｓ２１４へと進む。
【００８１】
一方、Ｓ２１２で、現在の車速Ｖが許容速度Ｖａ以下の場合（Ｖ≦Ｖａの場合）は、現在の駆動力の状態でカーブを通過できると判断し、そのままＳ２１４へとジャンプする。
【００８２】
Ｓ２１４では、ヨーレート偏差演算部４０ｎは、φt2＋α３を基準とするヨーレート偏差Δφt2を演算し、Ｓ２１５に進んで、目標制動力演算部４０ｏは、前述の（１４）式により目標制動力ＢＦ２ｒを演算し、Ｓ２１６に進んで、旋回内側後輪に対し、目標制動力ＢＦ２ｒを付与するように信号出力してルーチンを抜ける。
【００８３】
尚、本実施の形態では、道路形状認識部４０ｃは、ナビゲーション装置２１からの情報を基に道路形状を得るようにしているが、これに限ることなく、例えば、レーダーやカメラによりカーブ情報が得られればこの情報を用いても良い。また、ＩＴＳ（Intelligent Transportation System ）で供給される情報からカーブ情報を得るようにしても良い。
【００８４】
【発明の効果】
以上説明したように本発明によれば、前方のカーブ形状、道路状態、運転状態等に応じ、ドライバに違和感を与えることなく最適なアンダステア状態の防止制御を実行し、安定した車両挙動を維持することが可能となる。
【図面の簡単な説明】
【図１】車両挙動制御装置を搭載した車両の概略構成を示す説明図
【図２】車両挙動制御装置のアンダステア防止機能部分の機能ブロック図
【図３】ナビゲーション装置からのデータの説明図
【図４】自車位置とノードに関する説明図
【図５】ノード角度及びカーブ曲率半径の演算に関する説明図
【図６】車両挙動制御のメインプログラムのフローチャート
【図７】アンダステア防止制御ルーチンのフローチャート
【符号の説明】
１ 自車両
２ エンジン
１２fl，１２fr，１２rl，１２rr 車輪
１３ ブレーキ駆動部
１６fl，１６fr，１６rl，１６rr ホイールシリンダ
２１ ナビゲーション装置（道路形状認識手段）
２２Ｌ，２２Ｒ ＣＣＤカメラ
２５ ヨーレートセンサ
４０ 制御装置（車両挙動制御装置、アンダステア防止手段）
４０ａ 車速演算部
４０ｂ ヨーレート定常ゲイン演算部
４０ｃ 道路形状認識部（道路形状認識手段）
４０ｄ 自車進行路推定部（自車進行路推定手段）
４０ｅ カーブ進入判定部
４０ｆ 目標ヨーレート演算部
４０ｇ 道路形状に基づくヨーレート演算部
４０ｈ ヨーレート比較判定部
４０ｉ 制御判断部
４０ｊ 路面μ推定部
４０ｋ 許容横加速度演算部
４０ｌ 許容速度演算部
４０ｍ トルクダウン量演算部
４０ｎ ヨーレート偏差演算部
４０ｏ 目標制動力演算部
Claims (4)
- 少なくとも自車両のアンダステア状態を検出し、該アンダステア状態を抑制させるアンダステア防止手段を備えた車両挙動制御装置において、道路形状を認識する道路形状認識手段と、自車進行路を推定する自車進行路推定手段とを有し、
上記アンダステア防止手段は、上記自車両がアンダステア状態で上記道路形状と上記自車進行路との関係からカーブに進入すると判断した場合、上記道路形状に基づき該道路を走行するのに必要な道路形状に基づくヨーレートを演算すると共に上記自車両の運転状態に基づく目標ヨーレートを演算して、上記道路形状に基づくヨーレートと上記目標ヨーレートとを比較し、大きい方のヨーレートが実際のヨーレートを所定に超える場合に上記道路を走行するのに必要な駆動力のトルクダウン量と上記道路を走行するためのヨーレートを生じる所定の車輪に付与する制動力を演算し出力することを特徴とする車両挙動制御装置。 - 上記道路形状認識手段は、ナビゲーション装置からのデータに基づき道路形状を認識することを特徴とする請求項１記載の車両挙動制御装置。
- 上記自車進行路推定手段は、自車両前方を画像にて捉え該画像情報に基づき自車進行路を推定することを特徴とする請求項１又は請求項２記載の車両挙動制御装置。
- 上記アンダステア防止手段は、上記道路を走行するのに必要な駆動力のトルクダウン量を求める場合、路面摩擦係数を基に該トルクダウン量を演算することを特徴とする請求項１乃至請求項３の何れか一つに記載の車両挙動制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002335453A JP3990623B2 (ja) | 2002-11-19 | 2002-11-19 | 車両挙動制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002335453A JP3990623B2 (ja) | 2002-11-19 | 2002-11-19 | 車両挙動制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2004168154A JP2004168154A (ja) | 2004-06-17 |
| JP3990623B2 true JP3990623B2 (ja) | 2007-10-17 |
Family
ID=32699580
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2002335453A Expired - Fee Related JP3990623B2 (ja) | 2002-11-19 | 2002-11-19 | 車両挙動制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3990623B2 (ja) |
Families Citing this family (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4511859B2 (ja) * | 2004-03-29 | 2010-07-28 | 本田技研工業株式会社 | 車両の運動制御装置 |
| JP4554348B2 (ja) * | 2004-12-20 | 2010-09-29 | 富士重工業株式会社 | 車両の挙動制御装置 |
| US8612109B2 (en) * | 2007-07-31 | 2013-12-17 | Nissan Motor Co., Ltd. | Vehicular running control apparatus and vehicular running control method |
| JP2009176188A (ja) * | 2008-01-28 | 2009-08-06 | Aisin Aw Co Ltd | 道路走行予想軌跡導出装置、道路走行予想軌跡導出方法および道路走行予想軌跡導出プログラム |
| JP5286027B2 (ja) * | 2008-10-28 | 2013-09-11 | 株式会社アドヴィックス | 車両安定化制御装置 |
| JP5056751B2 (ja) * | 2008-12-26 | 2012-10-24 | トヨタ自動車株式会社 | 運転制御装置 |
| US8630779B2 (en) * | 2010-04-09 | 2014-01-14 | Navteq B.V. | Method and system for vehicle ESC system using map data |
| GB2492953A (en) | 2011-07-13 | 2013-01-23 | Land Rover Uk Ltd | Vehicle control system and method employing output from an imaging device |
| US9573591B2 (en) * | 2015-03-18 | 2017-02-21 | Continental Automotive Systems, Inc. | System and method utilizing detected load for vehicle handling |
| JP2018062886A (ja) | 2016-10-12 | 2018-04-19 | いすゞ自動車株式会社 | 省燃費制御装置及び省燃費制御方法 |
| JP6986463B2 (ja) * | 2018-02-13 | 2021-12-22 | 日立Astemo株式会社 | 運転支援装置、運転支援方法及び運転支援システム |
| CN113942494B (zh) * | 2021-10-28 | 2024-04-19 | 中汽创智科技有限公司 | 一种车辆转向控制方法、装置和存储介质 |
| CN117962835A (zh) * | 2024-03-29 | 2024-05-03 | 长春深蓝智造电子产品有限公司 | 一种汽车电子稳定控制系统及方法 |
-
2002
- 2002-11-19 JP JP2002335453A patent/JP3990623B2/ja not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2004168154A (ja) | 2004-06-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| DE102017108782B4 (de) | Fahrtsteuerungsvorrichtung für Fahrzeug | |
| US7580785B2 (en) | Vehicle dynamics control apparatus | |
| US7058494B2 (en) | Vehicle dynamics control apparatus | |
| EP1908660B1 (en) | Obstacle avoidance control apparatus | |
| JP5407952B2 (ja) | 車両運転支援装置及び車両運転支援方法 | |
| US8577515B2 (en) | Vehicle driving assistant and vehicle driving assisting method | |
| US20150336587A1 (en) | Driving assist device | |
| JP3990623B2 (ja) | 車両挙動制御装置 | |
| EP1129917A2 (en) | Motion control system for vehicle | |
| JP3946294B2 (ja) | 制動力制御装置 | |
| JP6952014B2 (ja) | 車両制御装置、車両制御方法、及び車両制御システム | |
| JP5015632B2 (ja) | 車両の制動力制御装置 | |
| JP2002046509A (ja) | 車両の運動制御装置 | |
| JP3167990B2 (ja) | カーブ進入制御装置 | |
| JP6986463B2 (ja) | 運転支援装置、運転支援方法及び運転支援システム | |
| JP4813154B2 (ja) | 車両の路面摩擦係数推定装置 | |
| JP4554348B2 (ja) | 車両の挙動制御装置 | |
| JP2020125058A (ja) | 車両の旋回姿勢制御方法及び旋回姿勢制御装置 | |
| JP2007099166A (ja) | 車両挙動制御装置 | |
| JP5965171B2 (ja) | 車両の制御装置 | |
| JP4519819B2 (ja) | 車両運動制御装置 | |
| JP2002274344A (ja) | 車両運動制御装置 | |
| JP6706166B2 (ja) | 車両の走行制御装置 | |
| JP2002293226A (ja) | 車両運動制御装置 | |
| JP2004210053A (ja) | 車両用走行制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20051031 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20070703 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070720 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100727 Year of fee payment: 3 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 3990623 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110727 Year of fee payment: 4 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110727 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120727 Year of fee payment: 5 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120727 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130727 Year of fee payment: 6 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| LAPS | Cancellation because of no payment of annual fees |