JP2006175899A - Behavior controller for vehicle - Google Patents

Behavior controller for vehicle Download PDF

Info

Publication number
JP2006175899A
JP2006175899A JP2004368255A JP2004368255A JP2006175899A JP 2006175899 A JP2006175899 A JP 2006175899A JP 2004368255 A JP2004368255 A JP 2004368255A JP 2004368255 A JP2004368255 A JP 2004368255A JP 2006175899 A JP2006175899 A JP 2006175899A
Authority
JP
Japan
Prior art keywords
yaw rate
parameter
vehicle
steering
limit value
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.)
Granted
Application number
JP2004368255A
Other languages
Japanese (ja)
Other versions
JP4554348B2 (en
Inventor
Kensuke Oshima
健介 大島
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Subaru Corp
Original Assignee
Fuji Heavy Industries Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Fuji Heavy Industries Ltd filed Critical Fuji Heavy Industries Ltd
Priority to JP2004368255A priority Critical patent/JP4554348B2/en
Publication of JP2006175899A publication Critical patent/JP2006175899A/en
Application granted granted Critical
Publication of JP4554348B2 publication Critical patent/JP4554348B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To attain stable control by always setting a target yaw rate or the like in the optimal region, and to urge a driver to switch a steering operation to a proper steering status. <P>SOLUTION: A controller 40 inputs each road information, a front image, each wheel speed, a steering wheel angle, a real yaw rate and lateral acceleration. Then, the controller 40 judges whether the behavior of a vehicle is an under-steer status or an over-steer status based on those input signals, and outputs a signal to a brake driving part 13 so that the behavior of the vehicle can be stabilized while limiting a target yaw rate at a limiting yaw rate which can be generated by a vehicle 1. Also, the controller 40 decides whether or not the steering status by the current driver exceeds limitation, and when it exceeds the limitation, the controller 40 outputs a signal to a power steering controller 30 for executing the reduction correction of an assist torque by an electric motor 17 in order to urge a driver to switch the steering operation to the proper steering status. <P>COPYRIGHT: (C)2006,JPO&NCIPI

Description

本発明は、制動力により車両のアンダステア傾向やオーバステア傾向を適切に防止する車両の挙動制御装置に関する。   The present invention relates to a vehicle behavior control device that appropriately prevents an understeer tendency or an oversteer tendency of a vehicle by a braking force.

近年、車両のコーナリング等の際の車両にはたらく力の関係から、コーナリング中に制動力を適切な車輪に加え、車両安定性を向上させる車両挙動制御装置が開発され、実用化されている。   In recent years, a vehicle behavior control device has been developed and put into practical use to improve vehicle stability by applying braking force to an appropriate wheel during cornering due to the force acting on the vehicle during cornering of the vehicle.

例えば、特開平9−39762号公報には、車両の運転状態から演算される目標ヨーレートと実際に生じている実ヨーレートを比較して、実ヨーレートが過剰である場合は旋回外側前輪に制動力を発生させ、逆に、実ヨーレートが不足している場合は後輪に制動力を発生させて車両挙動の安定化を図る技術が開示されている。そして、この技術では、更に、上述の制動力制御の実行中に、車両の走行状態に応じた(定常円旋回状態を考慮した)理想操舵角を求め、この理想操舵角と実舵角との偏差に対応する特性値を算出して、偏差が大きいほどパワーステアリング装置のアシスト率を低下させることが開示されている。
特開平9−39762号公報
For example, in Japanese Patent Laid-Open No. 9-39762, a target yaw rate calculated from the driving state of a vehicle is compared with an actual yaw rate that is actually generated. If the actual yaw rate is excessive, braking force is applied to the front outer wheel of the turn. On the contrary, there is disclosed a technique for stabilizing the vehicle behavior by generating a braking force on the rear wheel when the actual yaw rate is insufficient. In this technique, during the execution of the braking force control described above, an ideal steering angle corresponding to the traveling state of the vehicle (considering the steady circular turning state) is obtained, and the ideal steering angle and the actual steering angle are calculated. It is disclosed that a characteristic value corresponding to the deviation is calculated and the assist rate of the power steering device is lowered as the deviation is larger.
JP 9-39762 A

しかしながら、上述の特許文献1に開示される車両挙動制御装置では、制動力制御の基準があくまでも車両の運転状態から演算される目標ヨーレートで設定され、また、理想操舵角の設定も、定常円旋回状態を理想とするため、実際の路面状態を考慮すると、目標ヨーレートや、理想操舵角が過大に設定されて、適切な領域内での制御が却って困難となってしまうという問題がある。例えば、低μ路等において、単にハンドル角、車速等の運転状態から目標ヨーレートや理想操舵角が設定された場合、これらは走行の限界を超えてしまい、適切な制御ができなくなる虞がある。   However, in the vehicle behavior control device disclosed in Patent Document 1 described above, the reference of the braking force control is set at a target yaw rate calculated from the driving state of the vehicle, and the ideal steering angle is also set at a steady circular turn. Considering the actual road surface condition in order to make the state ideal, there is a problem that the target yaw rate and the ideal steering angle are set excessively, making control in an appropriate region difficult. For example, when the target yaw rate or the ideal steering angle is set simply from the driving state such as the steering wheel angle and the vehicle speed on a low μ road, etc., these may exceed the limits of travel, and appropriate control may not be possible.

本発明は上記事情に鑑みてなされたもので、目標とするヨーレート等を常に最適な領域内で設定して安定した制御が行え、且つ、ドライバに適切な操舵状態への転舵を促すことができる車両の挙動制御装置を提供することを目的とする。   The present invention has been made in view of the above circumstances, and it is possible to perform stable control by always setting a target yaw rate or the like within an optimum region, and to prompt the driver to steer to an appropriate steering state. It is an object of the present invention to provide a vehicle behavior control device that can perform this.

本発明は、車両の運転状態に基づき求めるパラメータを第1のパラメータとして演算する第1のパラメータ演算手段と、車両が走行する道路形状に基づき求めるパラメータを第2のパラメータとして演算する第2のパラメータ演算手段と、路面状態に基づき求めるパラメータをパラメータ制限値として演算するパラメータ制限値演算手段と、上記第1のパラメータと上記第2のパラメータを上記パラメータ制限値で制限するパラメータ制限手段と、上記パラメータ制限手段で制限処理した上記第1のパラメータと上記第2のパラメータとに基づき、車輪に制動力を付加して車両にヨーモーメントを発生させる制動力制御手段と、上記パラメータ制限値と現在の操舵状態に基づき現在の操舵状態が予め設定する領域範囲内の操舵状態か否か判断し、上記予め設定する領域範囲外の操舵状態と判断した場合に、操舵アシストトルクを補正するパワーステアリング制御補正手段とを備えたことを特徴としている。   The present invention provides a first parameter calculation means for calculating a parameter obtained based on a driving state of a vehicle as a first parameter, and a second parameter for calculating a parameter obtained based on a road shape on which the vehicle travels as a second parameter. Calculation means, parameter limit value calculation means for calculating a parameter determined based on the road surface condition as a parameter limit value, parameter limit means for limiting the first parameter and the second parameter with the parameter limit value, and the parameter Based on the first parameter and the second parameter subjected to the restriction processing by the restriction means, braking force control means for applying a braking force to the wheel to generate a yaw moment in the vehicle, the parameter restriction value and the current steering Based on the state, it is determined whether or not the current steering state is a steering state within a preset range. , When it is determined that the steering state of the outside area range set above previously, is characterized in that a power steering control correction means for correcting the steering assist torque.

本発明による車両の挙動制御装置によれば、目標とするヨーレート等を常に最適な領域内で設定して安定した制御が行え、且つ、ドライバに適切な操舵状態への転舵を促すことが可能となる。   According to the vehicle behavior control device of the present invention, it is possible to perform stable control by always setting a target yaw rate or the like within an optimum region, and to prompt the driver to steer to an appropriate steering state. It becomes.

以下、図面に基づいて本発明の実施の形態を説明する。
図1乃至図14は本発明の実施の第1形態を示し、図1は車両挙動制御装置を搭載した車両の概略構成を示す説明図、図2は車両挙動制御装置の機能ブロック図、図3はパワーステアリング制御装置で設定されるアシスト電流の特性図、図4は自車位置とノードに関する説明図、図5はノード角度及びカーブ曲率半径の演算に関する説明図、図6はナビゲーション装置からのデータの説明図、図7はヨーレート制限値の特性図、図8はアシストトルク減少補正量の特性図、図9は車両挙動制御のメインプログラムのフローチャート、図10はφt1,φt2の設定ルーチンのフローチャート、図11はφt1とφt2による制動力制御ルーチンのフローチャート、図12はアンダステア防止制御ルーチンのフローチャート、図13はオーバステア防止制御ルーチンのフローチャート、図14はφLに基づいたパワーステアリング制御補正ルーチンのフローチャートである。
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
1 to 14 show a first embodiment of the present invention, FIG. 1 is an explanatory diagram showing a schematic configuration of a vehicle equipped with a vehicle behavior control device, FIG. 2 is a functional block diagram of the vehicle behavior control device, and FIG. Is a characteristic diagram of the assist current set by the power steering control device, FIG. 4 is an explanatory diagram regarding the vehicle position and the node, FIG. 5 is an explanatory diagram regarding the calculation of the node angle and the curve curvature radius, and FIG. 6 is the data from the navigation device 7 is a characteristic diagram of the yaw rate limit value, FIG. 8 is a characteristic diagram of the assist torque reduction correction amount, FIG. 9 is a flowchart of a main program for vehicle behavior control, and FIG. 10 is a flowchart of a setting routine for φt1 and φt2. 11 is a flowchart of a braking force control routine using φt1 and φt2, FIG. 12 is a flowchart of an understeer prevention control routine, and FIG. 13 is an oversteer prevention control routine. FIG. 14 is a flowchart of a power steering control correction routine based on φL.

図1において、符号1はセンターディファレンシャル装置および自動変速装置を有する4輪駆動車を一例とする車両を示し、車両前部に配置されたエンジン2による駆動力は、このエンジン2後方の自動変速装置(トルクコンバータ等も含んで図示)3からトランスミッション出力軸3aを経てセンターディファレンシャル装置4に伝達される。そして、駆動力は、このセンターディファレンシャル装置4から、リヤドライブ軸5、プロペラシャフト6、ドライブピニオン7を介して後輪終減速装置8に入力される一方、センターディファレンシャル装置4から、フロントドライブ軸9を介して前輪終減速装置10に入力される。ここで、自動変速装置3、センターディファレンシャル装置4、及び、前輪終減速装置10等は、図示しないケース内に一体に設けられている。   In FIG. 1, reference numeral 1 denotes a vehicle, which is an example of a four-wheel drive vehicle having a center differential device and an automatic transmission, and the driving force of the engine 2 arranged at the front of the vehicle is an automatic transmission behind the engine 2. (Including a torque converter and the like) 3 is transmitted to the center differential device 4 through the transmission output shaft 3a. The driving force is input from the center differential device 4 to the rear wheel final reduction device 8 via the rear drive shaft 5, the propeller shaft 6, and the drive pinion 7, while from the center differential device 4 to the front drive shaft 9 To the front wheel final reduction gear 10. Here, the automatic transmission device 3, the center differential device 4, the front wheel final reduction device 10 and the like are integrally provided in a case (not shown).

後輪終減速装置8に入力された駆動力は、後輪左ドライブ軸11rlを経て左後輪12rlに、後輪右ドライブ軸11rrを経て右後輪12rrに伝達される。一方、前輪終減速装置10に入力された駆動力は、前輪左ドライブ軸11flを経て左前輪12flに、前輪右ドライブ軸11frを経て右前輪12frに伝達される。   The driving force input to the rear wheel final reduction gear 8 is transmitted to the left rear wheel 12rl through the rear wheel left drive shaft 11rl and to the right rear wheel 12rr through the rear wheel right drive shaft 11rr. On the other hand, the driving force input to the front wheel final reduction gear 10 is transmitted to the left front wheel 12fl via the front wheel left drive shaft 11fl and to the right front wheel 12fr via the front wheel right drive shaft 11fr.

一方、符号13は車両のブレーキ駆動部を示し、このブレーキ駆動部13には、ドライバにより操作されるブレーキペダル14と接続されたマスターシリンダ15が接続されている。そして、ドライバがブレーキペダル14を操作するとマスターシリンダ15により、ブレーキ駆動部13を通じて、4輪12fl,12fr,12rl,12rrの各ホイールシリンダ16fl,16fr,16rl,16rrにブレーキ圧が導入され、これにより4輪にブレーキがかかって制動される。   On the other hand, reference numeral 13 denotes a brake drive unit of the vehicle, and a master cylinder 15 connected to a brake pedal 14 operated by a driver is connected to the brake drive unit 13. When the driver operates the brake pedal 14, the master cylinder 15 introduces brake pressure to the wheel cylinders 16fl, 16fr, 16rl, 16rr of the four wheels 12fl, 12fr, 12rl, 12rr through the brake drive unit 13, thereby The four wheels are braked and braked.

ブレーキ駆動部13は、加圧源、減圧弁、増圧弁等を備えたハイドロリックユニットで、後述する車両挙動制御装置としての制御装置40からの入力信号に応じて、各ホイールシリンダ16fl,16fr,16rl,16rrに対して、それぞれ独立にブレーキ圧を導入自在に構成されている。   The brake drive unit 13 is a hydraulic unit including a pressurizing source, a pressure reducing valve, a pressure increasing valve, and the like, and each wheel cylinder 16fl, 16fr, etc. according to an input signal from a control device 40 as a vehicle behavior control device described later. With respect to 16rl and 16rr, the brake pressure can be independently introduced.

また、図1中、符号30はパワーステアリング制御装置を示し、電動式パワーステアリングの電動モータ17に対し、例えば、図3に示す、ステアリング入力トルク−車速に応じた特性のアシスト電流を出力することでアシストトルクを発生させ、ドライバが据切りのときの軽い操舵力に対して高速走行時にはしっかりとした操舵感を得られるように制御する。更に、このパワーステアリング制御装置30は、後述の制御装置40からの信号を受け、アシストトルクを減少補正させる制御を行う。この減少補正量は、制御装置40により設定されるため後述する。   Further, in FIG. 1, reference numeral 30 denotes a power steering control device, which outputs, for example, an assist current having characteristics corresponding to steering input torque-vehicle speed shown in FIG. 3 to the electric motor 17 of the electric power steering. The assist torque is generated by the control so that the driver can obtain a solid steering feeling during high-speed driving against a light steering force when the driver is stationary. Further, the power steering control device 30 receives a signal from the control device 40 described later and performs control to reduce and correct the assist torque. The decrease correction amount is set by the control device 40 and will be described later.

また、車両1には、公知のナビゲーション装置21が搭載され、制御装置40と接続されており、このナビゲーション装置21からは、図4に示すように、自車走行ルートに関して送出されるノード数n、自車位置の東経、自車位置の北緯、自車直後のノードに関するデータ、及び自車前方の設定範囲内における自車走行ルートのノードに関するデータ(自車直前のノードに関するデータ、自車前方2点目のノードに関するデータ、…、自車前方(n−1)点目のノードに関するデータ)が、例えば500ms毎に出力される。各ノードに関するデータには、図示の如く、自車位置からノードまでの東方向位置、自車位置からノードまでの北方向位置、ノード位置に交差点があるか否かを識別する交差点フラグ、道路種別、道路幅等の情報が含まれている。   Also, the vehicle 1 is equipped with a known navigation device 21 and is connected to the control device 40. From this navigation device 21, as shown in FIG. , East longitude of own vehicle position, north latitude of own vehicle position, data relating to node immediately after own vehicle, and data relating to node of own vehicle traveling route within setting range ahead of own vehicle (data relating to node immediately preceding own vehicle, forward of own vehicle Data relating to the second node,..., Data relating to the (n−1) th node ahead of the host vehicle) are output, for example, every 500 ms. As shown in the figure, the data relating to each node includes an east direction position from the own vehicle position to the node, a north position from the own vehicle position to the node, an intersection flag for identifying whether there is an intersection at the node position, road type Information such as road width is included.

このナビゲーション装置21は、乗員により目的地が入力された場合には、入力された目的地に対して自車が進むべく最適な案内経路を設定する。そして、設定された案内経路上の、例えば自車前方300mまでのノードに関するデータと自車直後のノードに関するデータを自車走行ルートのノードに関するデータとして制御部40に出力する。   When a destination is input by the occupant, the navigation device 21 sets an optimum guide route for the host vehicle to travel to the input destination. Then, for example, data relating to a node up to 300 m ahead of the host vehicle and data relating to a node immediately after the host vehicle are output to the control unit 40 as data relating to a node of the host vehicle travel route.

一方、ナビゲーション装置21は、乗員による目的地の入力がなされていない場合は、例えば道路種別や道路幅等の情報に基づいて自車が進むであろう経路の優先順位を推定し、その中で最も優先順位の高い経路を推定経路として設定する。そして、設定された推定経路上の例えば自車前方300mまでのノードに関するデータと自車直後のノードに関するデータを自車走行ルートのノードに関するデータとして制御部40に出力する。   On the other hand, when the destination is not input by the occupant, the navigation device 21 estimates the priority order of the route on which the vehicle will travel based on information such as the road type and the road width, for example. The route with the highest priority is set as the estimated route. Then, for example, data relating to the node up to 300 m ahead of the host vehicle and data relating to the node immediately after the host vehicle are output to the control unit 40 as data relating to the node of the host vehicle travel route.

また、車両1には、ステレオ光学系として例えば電荷結合素子(CCD)等の固体撮像素子を用いた1組の(左右)のCCDカメラ22L、22Rが設けられている。これら左右のCCDカメラ22L、22Rは、それぞれ車室内の天井前方に一定の間隔をもって取り付けられ、車外の対象を異なる視点からステレオ撮像し、画像を制御装置40に出力する。   Further, the vehicle 1 is provided with a pair of (left and right) CCD cameras 22L and 22R using a solid-state imaging device such as a charge coupled device (CCD) as a stereo optical system. These left and right CCD cameras 22L and 22R are respectively mounted at a certain interval in front of the ceiling in the vehicle interior, take a stereo image of an object outside the vehicle from different viewpoints, and output an image to the control device 40.

更に、車両には、4輪12fl,12fr,12rl,12rrの各車輪速度ωfl,ωfr,ωrl,ωrrを検出する車輪速度センサ23fl,23fr,23rl,23rr、車両1のハンドル角θHを検出するハンドル角センサ24、実ヨーレートφrを検出するヨーレートセンサ25、横加速度Gyを検出する横加速度センサ26等の各センサが設けられており、制御装置40に各センサ信号を出力するように構成されている。   Further, the vehicle has wheel speed sensors 23fl, 23fr, 23rl, 23rr for detecting wheel speeds ωfl, ωfr, ωrl, ωrr of the four wheels 12fl, 12fr, 12rl, 12rr, and a handle for detecting the handle angle θH of the vehicle 1. Sensors such as an angle sensor 24, a yaw rate sensor 25 that detects the actual yaw rate φr, and a lateral acceleration sensor 26 that detects the lateral acceleration Gy are provided, and each sensor signal is output to the control device 40. .

制御装置40は、ナビゲーション装置21から上述の各道路情報が入力され、CCDカメラ22L、22Rから上述の前方画像が入力される。また、各センサ23fl,23fr,23rl,23rr、24、25、26から、それぞれ、4輪12fl,12fr,12rl,12rrの各車輪速度ωfl,ωfr,ωrl,ωrr、ハンドル角θH、実ヨーレートφr、横加速度Gyが入力される。そして、これらの入力信号に基づき、制御装置40は、車両の挙動がアンダステア状態か、オーバステア状態か判定し、車両挙動を安定させるべくブレーキ駆動部13に信号出力する。また、制御装置40は、現在のドライバによる操舵状態が限界を超えていないか否かを判定し、限界を超えている場合には、ドライバに適切な操舵状態への転舵を促すべくパワーステアリング制御装置30に対して電動モータ17によるアシストトルクを減少補正するように信号出力する。   The control device 40 receives the above-described road information from the navigation device 21 and the above-described front image from the CCD cameras 22L and 22R. Further, from the sensors 23fl, 23fr, 23rl, 23rr, 24, 25, 26, the wheel speeds ωfl, ωfr, ωrl, ωrr of the four wheels 12fl, 12fr, 12rl, 12rr, the steering wheel angle θH, the actual yaw rate φr, Lateral acceleration Gy is input. Based on these input signals, the control device 40 determines whether the behavior of the vehicle is an understeer state or an oversteer state, and outputs a signal to the brake drive unit 13 to stabilize the vehicle behavior. Further, the control device 40 determines whether or not the current steering state by the driver exceeds the limit, and if it exceeds the limit, the power steering is performed to prompt the driver to steer to an appropriate steering state. A signal is output to the control device 30 so that the assist torque by the electric motor 17 is reduced and corrected.

すなわち、制御装置40は、マイクロコンピュータとその周辺回路で構成され、図2に示すように、車速演算部40a、道路形状認識部40b、自車進行路推定部40c、カーブ進入判定部40d、路面μ推定部40e、第1のヨーレート演算部40f、第2のヨーレート演算部40g、ヨーレート制限値演算部40h、ヨーレート制限部40i、制動力制御部40j、パワーステアリング制御補正部40kから主要に構成されている。   That is, the control device 40 is composed of a microcomputer and its peripheral circuits, and as shown in FIG. 2, a vehicle speed calculation unit 40a, a road shape recognition unit 40b, a host vehicle traveling path estimation unit 40c, a curve approach determination unit 40d, a road surface It mainly comprises a μ estimation unit 40e, a first yaw rate calculation unit 40f, a second yaw rate calculation unit 40g, a yaw rate limit value calculation unit 40h, a yaw rate limit unit 40i, a braking force control unit 40j, and a power steering control correction unit 40k. ing.

車速演算部40aは、4輪の車輪速センサ、すなわち各車輪速度センサ23fl,23fr,23rl,23rrから4輪12fl,12fr,12rl,12rrの各車輪速度ωfl,ωfr,ωrl,ωrrが入力され、例えばこれらの平均を演算することにより車速V(=(ωfl+ωfr+ωrl+ωrr)/4)を演算し、自車進行路推定部40c、路面μ推定部40e、第1のヨーレート演算部40f、第2のヨーレート演算部40g、制動力制御部40j、パワーステアリング制御補正部40kに出力する。   The vehicle speed calculation unit 40a receives four wheel speed sensors, that is, wheel speed sensors ωfl, ωfr, ωrl, ωrr of the four wheels 12fl, 12fr, 12rl, 12rr from the wheel speed sensors 23fl, 23fr, 23rl, 23rr, For example, the vehicle speed V (= (ωfl + ωfr + ωrl + ωrr) / 4) is calculated by calculating the average of these, and the own vehicle traveling path estimation unit 40c, the road surface μ estimation unit 40e, the first yaw rate calculation unit 40f, and the second yaw rate calculation are calculated. Output to the unit 40g, the braking force control unit 40j, and the power steering control correction unit 40k.

道路形状認識部40bでは、ナビゲーション装置21から送信されたノード毎の位置情報に基づき、各々のノードについて、1つ手前のノードとの間隔、カーブ曲率半径及びノード角度が演算される。これらの演算値は、交差点識別、道路種別、道路幅、後述する特異点識別等に関する情報と共に、各ノードの属性情報として記憶格納される。   In the road shape recognizing unit 40b, on the basis of the position information for each node transmitted from the navigation device 21, the distance from the previous node, the curve curvature radius, and the node angle are calculated for each node. These calculated values are stored and stored as attribute information of each node together with information on intersection identification, road type, road width, singular point identification described later, and the like.

具体的には、道路形状認識部40bは、ナビゲーション装置21から送信された、自車位置を基準としたノード座標(図5参照)を用いて、ノードPj(xP[j],yp[j])と1つ手前のノードPj-1(xp[j-1],yp[j-1])との間隔Lp[j]を、
Lp[j]=((xP[j]−xp[j-1])+(yp[j]−yp[j-1])1/2
(但し、1≦j≦n−1)
…(1)
により各ノードについて演算する。
Specifically, the road shape recognizing unit 40b uses the node coordinates (see FIG. 5) transmitted from the navigation device 21 and based on the vehicle position as a reference, to the node Pj (xP [j], yp [j]). ) And the previous node Pj-1 (xp [j-1], yp [j-1]), an interval Lp [j]
Lp [j] = ((xP [j] −xp [j−1]) 2 + (yp [j] −yp [j−1]) 2 ) 1/2
(However, 1 ≦ j ≦ n−1)
... (1)
To calculate each node.

続いて、道路形状認識部40bは、例えば図6に示すように、ノード座標に基づいて、各ノードPjにおけるノード角度tp[j]を、以下(2)式により演算する。
tp[j]=sin−1(((xp[j-1]−xp[j])・(yp[j]−yp[j+1])
−(xp[j]−xp[j+1])・(yp[j-1]−yp[j]))
/(Lp[j]・Lp[j+1])) …(2)
尚、ここで得られたノード角度tp[j]は、右コーナの場合、−値で表され、左コーナの場合、+値で表される。
Subsequently, as shown in FIG. 6, for example, the road shape recognition unit 40b calculates a node angle tp [j] at each node Pj based on the node coordinates by the following equation (2).
tp [j] = sin -1 (((xp [j-1] -xp [j]). (yp [j] -yp [j + 1])
− (Xp [j] −xp [j + 1]) · (yp [j−1] −yp [j]))
/ (Lp [j] · Lp [j + 1])) (2)
Note that the node angle tp [j] obtained here is represented by a-value in the case of the right corner, and is represented by a + value in the case of the left corner.

以上の計算結果に基づいて、道路形状認識部40bでは、ノードPjでのカーブ曲率半径rp[j]を、以下(3)式により演算する。
rp[j]=min(LP[j],Lp[j+1])/2/tan(|tp[j]|/2)
…(3)
ここで、min(Lp[j],Lp[j+1])は、Lp[j]とLp[j+1]の何れか短い方を選択するとの意味であり、例えば、図6においては、Lp[j]<Lp[j+1]であるため、min(LP[j],Lp[j+1])=Lp[j]である。
Based on the above calculation results, the road shape recognition unit 40b calculates the curve curvature radius rp [j] at the node Pj by the following equation (3).
rp [j] = min (LP [j], Lp [j + 1]) / 2 / tan (| tp [j] | / 2)
... (3)
Here, min (Lp [j], Lp [j + 1]) means that the shorter one of Lp [j] and Lp [j + 1] is selected. For example, in FIG. Since Lp [j] <Lp [j + 1], min (LP [j], Lp [j + 1]) = Lp [j].

また、道路形状認識部40bは、ナビゲーション装置21から送信されるデータをそのまま用いて(ナビゲーション装置21で予め定義づけられているデータをそのまま用いて)、各ノード毎に交差点識別(交差点か否か、或いは案内経路上の交差点か)、道路の種別(高速自動車国道、都市高速道路、一般国道、主要地方道、その他)、道路幅の設定等を行う。   Further, the road shape recognition unit 40b uses the data transmitted from the navigation device 21 as it is (using the data predefined in the navigation device 21 as it is), and identifies the intersection for each node (whether it is an intersection or not). Or an intersection on the guide route), the type of road (highway automobile national road, urban highway, general national road, main local road, etc.), road width, etc. are set.

更に、道路形状認識部40bでは、ナビゲーション装置21から送信された各ノードについての特異点判定を行い、ノードPjが特異点であると判定された場合には、判定されたノードPjを除いた前後のノードPj-1,Pj+1間におけるノード角度tp[J+1]、カーブ曲率半径rp[j+1]の再演算を行う。   Further, the road shape recognition unit 40b performs singular point determination for each node transmitted from the navigation device 21, and when it is determined that the node Pj is a singular point, before and after removing the determined node Pj. The node angle tp [J + 1] and the curve curvature radius rp [j + 1] between the nodes Pj-1 and Pj + 1 are recalculated.

すなわち、隣接するノード間隔が接近しすぎていると演算されたカーブ曲率半径は実際の道路の曲率半径よりも小さくなりすぎた値となってしまい、結果として何でもないカーブで過剰に車両挙動制御をしてしまう。これを防止するため、道路形状認識部40bでは、このようなノードを、道路種別属性cp[j]、道路幅属性wp[j]を考慮した上で、ノード間隔Lp[j]、ノード角度tp[j]に基づいて、ノード角度、カーブ曲率半径演算時の特異点として除外する。   In other words, the curve radius of curvature calculated when the distance between adjacent nodes is too close becomes a value that is too smaller than the radius of curvature of the actual road, resulting in excessive vehicle behavior control with an empty curve. Resulting in. In order to prevent this, in the road shape recognition unit 40b, such a node is considered in consideration of the road type attribute cp [j] and the road width attribute wp [j], and the node interval Lp [j] and the node angle tp. Based on [j], it is excluded as a singular point when calculating the node angle and curve curvature radius.

こうして、道路形状認識部40bにて最終的に演算されたカーブ曲率半径rp[j]は、カーブ進入判定部40d、及び、第2のヨーレート演算部40gに出力される。   Thus, the curve curvature radius rp [j] finally calculated by the road shape recognition unit 40b is output to the curve approach determination unit 40d and the second yaw rate calculation unit 40g.

自車進行路推定部40cは、CCDカメラ22L、22Rから画像情報が、ハンドル角センサ24からハンドル角θHが、車速演算部40aから車速Vがそれぞれ入力される。そして、CCDカメラ22L、22Rから画像情報に基づき自車両1前方の立体物データと側壁データと白線データの前方情報を検出し、これら前方情報や自車両1の運転状態から自車両1の進行路(自車進行路)を推定する。   The own vehicle traveling path estimation unit 40c receives image information from the CCD cameras 22L and 22R, a steering wheel angle θH from the steering wheel angle sensor 24, and a vehicle speed V from the vehicle speed calculation unit 40a. Based on the image information from the CCD cameras 22L and 22R, the front information of the three-dimensional object data, the side wall data, and the white line data ahead of the own vehicle 1 is detected, and the traveling path of the own vehicle 1 is determined from the forward information and the driving state of the own vehicle 1. Estimate (own vehicle traveling path).

ここで、自車進行路推定部40cにおける、CCDカメラ22L、22Rからの画像の処理は、例えば以下のように行われる。まず、CCDカメラ22L、22Rで撮像した自車両の進入方向の環境の1組のステレオ画像対に対し、対応する位置のずれ量から三角測量の原理によって画像全体に渡る距離情報を求める処理を行なって、三次元の距離分布を表す距離画像を生成する。そして、このデータを基に、周知のグルーピング処理や、予め記憶しておいた3次元的な道路形状データ、側壁データ、立体物データ等と比較し、白線データ、道路に沿って存在するガードレール、縁石等の側壁データ、車両等の立体物データを抽出する。こうして抽出された白線データ、側壁データ、立体物データは、それぞれのデータ毎に異なったナンバーが割り当てられる。   Here, the processing of the images from the CCD cameras 22L and 22R in the own vehicle traveling path estimation unit 40c is performed as follows, for example. First, for a pair of stereo images of the environment in the approach direction of the host vehicle imaged by the CCD cameras 22L and 22R, a process for obtaining distance information over the entire image from the corresponding positional deviation amount by the principle of triangulation is performed. Thus, a distance image representing a three-dimensional distance distribution is generated. And based on this data, compared with the well-known grouping process, prestored three-dimensional road shape data, side wall data, solid object data, etc., white line data, guardrails existing along the road, Side wall data such as curbs and three-dimensional object data such as vehicles are extracted. The white line data, the side wall data, and the three-dimensional object data extracted in this way are assigned different numbers for each data.

そして、自車進行路推定部40cでは、自車進行路を以下の何れかにより推定する。
a.白線に基づく自車進行路推定…左右両方、若しくは、左右どちらか片側の白線データが得られており、これら白線データから自車両1が走行している車線の形状が推定できる場合、自車進行路は、自車両1の幅や、自車両1の現在の車線内の位置を考慮して、白線と並行して形成される。
And in the own vehicle travel path estimation part 40c, the own vehicle travel path is estimated by either of the following.
a. The own vehicle traveling path estimation based on the white line ... If the white line data on both the left and right sides or the left and right sides is obtained, and the shape of the lane in which the vehicle 1 is traveling can be estimated from these white line data, the own vehicle travels The road is formed in parallel with the white line in consideration of the width of the host vehicle 1 and the position of the host vehicle 1 in the current lane.

b.ガードレール、縁石等の側壁データに基づく自車進行路推定…左右両方、若しくは、左右どちらか片側の側壁データが得られており、これら側壁データから自車両1が走行している車線の形状が推定できる場合、自車進行路は、自車両1の幅や、自車両1の現在の車線内の位置を考慮して、側壁と並行して形成される。   b. Self-vehicle travel path estimation based on side data of guardrails, curbs, etc. Side wall data on both the left and right sides or left and right sides is obtained, and the shape of the lane in which the vehicle 1 is traveling is estimated from these side wall data If possible, the own vehicle traveling path is formed in parallel with the side wall in consideration of the width of the own vehicle 1 and the position of the own vehicle 1 in the current lane.

c.自車両1の走行軌跡に基づく自車走行路推定…自車両1の運転状態を基に、自車進行路を推定する。例えば、車速V、ハンドル角θHを基に、以下ように自車進行路を推定する。   c. Self-vehicle travel path estimation based on the travel trajectory of the host vehicle 1 ... The host vehicle travel path is estimated based on the driving state of the host vehicle 1. For example, the own vehicle traveling path is estimated based on the vehicle speed V and the steering wheel angle θH as follows.

ハンドル角θHから求められる実舵角δf(=θH/n:nはステアリングギヤ比)が、所定値(例えば0.57度)以上で転舵が行われているか否か判定され、実舵角δfが0.57度以上で操舵が行われている場合は、実舵角δfと車速Vを用いて例えば以下(4)、(5)式により現在の旋回曲率Cuaが算出される。
Re=(1+A0・V)・(L/δf) …(4)
Cua=1/Re …(5)
ここで、Reは旋回半径(運転状態から導出した値)、Lはホイールベースである。また、A0は車両の諸元で決まるスタビリティファクタであり、車両質量をm,前軸と重心間の距離をLf,後軸と重心間の距離をLr,フロント等価コーナリングパワーをCPf,リア等価コーナリングパワーをCPrとすると次式で求められる。
A0=(−m・(Lf・CPf−Lr・CPr))
/(2・L・CPf・CPr) …(6)
It is determined whether the steering is performed when the actual steering angle δf (= θH / n: n is a steering gear ratio) obtained from the steering wheel angle θH is a predetermined value (for example, 0.57 degrees) or more. When the steering is performed with δf of 0.57 degrees or more, the current turning curvature Cua is calculated by using the actual steering angle δf and the vehicle speed V, for example, by the following equations (4) and (5).
Re = (1 + A0 · V 2 ) · (L / δf) (4)
Cua = 1 / Re (5)
Here, Re is a turning radius (value derived from the driving state), and L is a wheelbase. A0 is a stability factor determined by the specifications of the vehicle. The vehicle mass is m, the distance between the front shaft and the center of gravity is Lf, the distance between the rear shaft and the center of gravity is Lr, the front equivalent cornering power is CPf, and the rear equivalent. When the cornering power is CPr, the following formula is obtained.
A0 = (− m · (Lf · CPf−Lr · CPr))
/ (2 ・ L 2・ CPf ・ CPr) (6)

また、実舵角δfが0.57度より小さい場合は、現在の旋回曲率Cuaは0(直進走行状態)とされる。   When the actual steering angle δf is smaller than 0.57 degrees, the current turning curvature Cua is set to 0 (straight running state).

こうして、得られる現在の旋回曲率Cuaを加えた過去所定時間(例えば約0.3秒間)の旋回曲率から平均旋回曲率を算出し、自車進行路を推定する。こうして推定した自車進行路は、カーブ進入判定部40dに出力される。   In this way, the average turning curvature is calculated from the turning curvature of the past predetermined time (for example, about 0.3 seconds) to which the obtained current turning curvature Cua is added, and the own vehicle traveling path is estimated. The vehicle traveling path thus estimated is output to the curve approach determination unit 40d.

カーブ進入判定部40dは、道路形状認識部40bからナビゲーション装置21からの情報を基に求めた道路形状が、自車進行路推定部40cから画像情報や運転状態を基に求めた自車進行路が入力される。そして、これらを比較して、自車両1がカーブに進入しようとしているのか否か判断し、判定結果を、第1のヨーレート演算部40f、第2のヨーレート演算部40g、ヨーレート制限値演算部40hに出力する。例えば、自車進行路推定部40cによる自車進行路が旋回状態となっていても道路形状認識部40bからの道路形状にカーブが認識されていない場合や、両者のデータ間に大きなずれがある場合等には、カーブに進入しようしていないとして判定結果を出力する。また、交差点におけるナビゲーション装置21からの情報を基に求めた道路形状(誘導経路)が直進であっても、自車進行路推定部40cによる自車進行路が旋回状態となっている場合は、カーブに進入しようとしていると判定する。   The curve approach determination unit 40d determines the road shape obtained from the road shape recognition unit 40b based on the information from the navigation device 21 based on the image information and the driving state from the vehicle travel path estimation unit 40c. Is entered. Then, these are compared to determine whether or not the host vehicle 1 is about to enter the curve, and the determination results are shown as a first yaw rate calculator 40f, a second yaw rate calculator 40g, and a yaw rate limit value calculator 40h. Output to. For example, even if the vehicle traveling path estimated by the host vehicle traveling path estimation unit 40c is in a turning state, a curve is not recognized in the road shape from the road shape recognition unit 40b, or there is a large difference between the two data. In some cases, the determination result is output as if the vehicle is not entering the curve. Moreover, even if the road shape (guidance route) obtained based on the information from the navigation device 21 at the intersection is straight ahead, when the own vehicle traveling path by the own vehicle traveling path estimation unit 40c is in a turning state, Determine that you are about to enter a curve.

路面μ推定部40eは、ハンドル角センサ24からハンドル角θHが、ヨーレートセンサ25から実ヨーレートφrが、横加速度センサ26から横加速度Gyが、車速演算部40aから車速Vがそれぞれ入力され、走行中の路面μを推定し、ヨーレート制限値演算部40hに出力する。この路面μ推定部40eでの路面μの推定は、例えば、本出願人が先に提出した特開平8−2274号公報に既述した算出方法(適応制御を用いて路面μを推定する)等を用いて行われる。   The road surface μ estimation unit 40e receives the steering wheel angle θH from the steering wheel angle sensor 24, the actual yaw rate φr from the yaw rate sensor 25, the lateral acceleration Gy from the lateral acceleration sensor 26, and the vehicle speed V from the vehicle speed calculation unit 40a. Is calculated and output to the yaw rate limit value calculation unit 40h. The estimation of the road surface μ in the road surface μ estimation unit 40e is, for example, the calculation method (estimating the road surface μ using adaptive control) described in Japanese Patent Application Laid-Open No. 8-2274 previously filed by the applicant. It is done using.

第1のヨーレート演算部40fは、ハンドル角センサ24からハンドル角θHが、車速演算部40aから車速Vが、カーブ進入判定部40dからカーブ進入の判断結果が入力される。   The first yaw rate calculation unit 40f receives the handle angle θH from the handle angle sensor 24, the vehicle speed V from the vehicle speed calculation unit 40a, and the determination result of the curve entry from the curve entry determination unit 40d.

そして、以下(7)式により、自車両1の運転状態に基づくヨーレートを第1のヨーレートφ1として演算し、特に、カーブ進入判定部40dからの判断結果がカーブ進入との結果の場合、この演算した第1のヨーレートφ1をヨーレート制限部40iに出力する。
φ1=(1/(1+T・s))・Gγδf(0)・δf …(7)
ここで、Tは時定数、sはラプラス演算子、Gγδf(0)はヨーレート定常ゲインであり、ヨーレート定常ゲインGγδf(0)は、以下の(8)式により求められる。
Gγδf(0)=(1/(1+A0・V))・(V/L) …(8)
尚、上述の(7)式は、2次系で表現される車両の応答遅れを1次系に近似した式である。このように、第1のヨーレート演算部40fは第1のパラメータ演算手段として設けられている。
Then, the yaw rate based on the driving state of the host vehicle 1 is calculated as the first yaw rate φ1 by the following expression (7), and in particular, when the determination result from the curve approach determination unit 40d is a result of the curve approach, this calculation is performed. The first yaw rate φ1 is output to the yaw rate limiting unit 40i.
φ1 = (1 / (1 + T · s)) · Gγδf (0) · δf (7)
Here, T is a time constant, s is a Laplace operator, Gγδf (0) is a yaw rate steady gain, and yaw rate steady gain Gγδf (0) is obtained by the following equation (8).
Gγδf (0) = (1 / (1 + A0 · V 2 )) · (V / L) (8)
Note that the above equation (7) is an equation that approximates the response delay of the vehicle expressed by the secondary system to the primary system. Thus, the first yaw rate calculation unit 40f is provided as the first parameter calculation means.

第2のヨーレート演算部40gは、車速演算部40aから車速Vが、道路形状認識部40bから最終的に演算されたカーブ曲率半径rp[j]が、カーブ進入判定部40dからカーブ進入の判断結果が入力される。   The second yaw rate calculation unit 40g has the vehicle speed V from the vehicle speed calculation unit 40a, the curve curvature radius rp [j] finally calculated from the road shape recognition unit 40b, and the determination result of the curve entry from the curve entry determination unit 40d. Is entered.

そして、カーブ進入判定部40eからの判断結果がカーブ進入との結果の場合、以下の(9)式により道路形状に基づくヨーレートを第2のヨーレートφ2として演算し、ヨーレート制限部40iに出力する。すなわち、第2のヨーレート演算部40gは、第2のパラメータ演算手段として設けられている。
φ2=V/rp[j] …(9)
When the determination result from the curve approach determination unit 40e is a result of curve approach, the yaw rate based on the road shape is calculated as the second yaw rate φ2 by the following equation (9), and is output to the yaw rate limiting unit 40i. That is, the second yaw rate calculator 40g is provided as a second parameter calculator.
φ2 = V / rp [j] (9)

ヨーレート制限値演算部40hは、ハンドル角センサ24からハンドル角θHが、路面μ推定部40eから路面μが、カーブ進入判定部40dからカーブ進入の判断結果が入力される。   The yaw rate limit value calculation unit 40h receives the steering wheel angle θH from the steering wheel angle sensor 24, the road surface μ from the road surface μ estimation unit 40e, and the determination result of the curve approach from the curve approach determination unit 40d.

そして、例えば、図7に示すような、予め設定しておいたマップを参照して、その路面μの状態のハンドル角θHで、車両1が発生させることの可能な限界ヨーレートをヨーレート制限値φLとして演算し、ヨーレート制限部40iとパワーステアリング制御補正部40kに出力する。すなわち、このヨーレート制限値演算部40hは、パラメータ制限値演算手段として設けられている。   Then, for example, referring to a map set in advance as shown in FIG. 7, the yaw rate limit value φL indicates the limit yaw rate that the vehicle 1 can generate at the steering wheel angle θH in the state of the road surface μ. And output to the yaw rate limiting unit 40i and the power steering control correction unit 40k. That is, the yaw rate limit value calculation unit 40h is provided as parameter limit value calculation means.

ヨーレート制限部40iは、第1のヨーレート演算部40fから第1のヨーレートφ1が、第2のヨーレート演算部40gから第2のヨーレートφ2が、ヨーレート制限値演算部40hからヨーレート制限値φLが入力される。   The yaw rate limiter 40i receives the first yaw rate φ1 from the first yaw rate calculator 40f, the second yaw rate φ2 from the second yaw rate calculator 40g, and the yaw rate limit value φL from the yaw rate limit value calculator 40h. The

そして、第1のヨーレートφ1と第2のヨーレートφ2の絶対値|φ1|,|φ2|が共にヨーレート制限値φLの絶対値|φL|を超えないように制限処理して、ヨーレートφt1,φt2を設定し、これら制限処理した第1,第2のヨーレートφt1,φt2を制動力制御部40jに出力する。すなわち、このヨーレート制限部40iは、パラメータ制限手段として設けられている。   Then, the absolute values | φ1 | and | φ2 | of the first yaw rate φ1 and the second yaw rate φ2 are both limited so as not to exceed the absolute value | φL | of the yaw rate limit value φL, and the yaw rates φt1 and φt2 are set. The first and second yaw rates φt1 and φt2 that have been set and subjected to the restriction processing are output to the braking force control unit 40j. That is, the yaw rate limiting unit 40i is provided as parameter limiting means.

制動力制御部40jは、ハンドル角センサ24からハンドル角θHが、ヨーレートセンサ25から実ヨーレートφrが、車速演算部40aから車速Vが、ヨーレート制限部40iから制限処理された第1,第2のヨーレートφt1,φt2が入力される。   The braking force control unit 40j performs the first and second processings in which the steering angle θH from the steering angle sensor 24, the actual yaw rate φr from the yaw rate sensor 25, the vehicle speed V from the vehicle speed calculation unit 40a, and the yaw rate limiting unit 40i are limited. The yaw rates φt1 and φt2 are input.

そして、制限処理された第1のヨーレートφt1と実ヨーレートφrとのヨーレート偏差Δφt1(=φr−φt1)を演算し、このヨーレート偏差Δφt1の絶対値|Δφt1|が設定値C1以上の場合に制動力制御を開始する。   Then, the yaw rate deviation Δφt1 (= φr−φt1) between the first yaw rate φt1 subjected to the restriction process and the actual yaw rate φr is calculated, and the braking force is obtained when the absolute value | Δφt1 | of the yaw rate deviation Δφt1 is equal to or larger than the set value C1. Start control.

制動力制御では、制限処理された第1のヨーレートφt1の絶対値|φt1|と実ヨーレートφrの絶対値|φr|とを比較して、制限処理された第1のヨーレートφt1の絶対値|φt1|が実ヨーレートφrの絶対値|φr|より大であると判定された場合は、車両1はアンダステア傾向であるためアンダステア防止制御が実行される。逆に、制限処理された第1のヨーレートφt1の絶対値|φt1|が実ヨーレートφrの絶対値|φr|より小であると判定された場合は、車両1はオーバステア傾向であるためオーバステア防止制御が実行される。   In the braking force control, the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is compared with the absolute value | φr | of the actual yaw rate φr, and the absolute value | φt1 of the first yaw rate φt1 subjected to the restriction process is compared. When | is determined to be greater than the absolute value | φr | of the actual yaw rate φr, the vehicle 1 has an understeer tendency, so that understeer prevention control is executed. Conversely, if it is determined that the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is smaller than the absolute value | φr | of the actual yaw rate φr, the vehicle 1 tends to oversteer, so that the oversteer prevention control is performed. Is executed.

アンダステア防止制御では、制限処理された第1のヨーレートφt1の絶対値|φt1|と制限処理された第2のヨーレートφt2の絶対値|φt2|とを比較し、これら絶対値が大きい方のヨーレートを基準に、再度、アンダステア防止制御を実行するか否かの判定が行われる。   In the understeer prevention control, the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is compared with the absolute value | φt2 | of the second yaw rate φt2 subjected to the restriction process, and the yaw rate having the larger absolute value is compared. Whether or not to execute the understeer prevention control is again determined based on the reference.

具体的には、制限処理された第1のヨーレートφt1の絶対値|φt1|の方が大きい場合は、|φt1|−|φr|>α1か否かの判定が行われ(α1は予め設定しておいた値)、制限処理された第2のヨーレートφt2の絶対値|φt2|の方が大きい場合は、|φt2|−|φr|>α2か否かの判定が行われる(α2は予め設定しておいた値)。ここで、α1<α2。このように絶対値が大きい方のヨーレートを制御作動の判定に用いることにより、不必要な制御介入が防止され、ドライバに制御介入による違和感を与えることが防止できるようになっているのである。   Specifically, when the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is larger, it is determined whether | φt1 | − | φr |> α1 (α1 is set in advance). If the absolute value | φt2 | of the limited second yaw rate φt2 is larger, it is determined whether or not | φt2 | − | φr |> α2 (α2 is set in advance) Value). Here, α1 <α2. By using the yaw rate having the larger absolute value in this way for determining the control operation, unnecessary control intervention is prevented and the driver can be prevented from feeling uncomfortable due to the control intervention.

そして、|φt1|−|φr|>α1、或いは、|φt2|−|φr|>α2を満たした場合は、例えば、以下の(10)式に基づき目標制動力BF2rを演算し、旋回内側後輪に対し、この目標制動力BF2rを付与するようにブレーキ駆動部13に対して信号が出力される。
BF2r=G1・((ΔA・4・L・CPf・CPr・V)
/((CPf・CPr)/dr))・φr …(10)
ここで、G1 はゲイン、drはリアトレッドを示し、ΔAは、
ΔA=((δf/(Gγδf(0)・δf+Δφt2))
−(1/Gγδf(0)))/(L・V) …(11)
である。尚、(11)式中のΔφt2は、
Δφt2=φr−(φt2+β) …(12)
である。ここで、Δφt2を単にφr−φt2としないのは、アンダステア防止制御を作動させた時点では自車両1は既にアンダステア状態であり、カーブを通過するための道路形状に基づくヨーレートφt2が得られるように制御したのでは目標量が不足する可能性がある。従って、φt2+βとして、この不足分を補えるようにするのである。尚、このβは、アンダステア状態となってからの時間や絶対量から予め計算される値である。また、一定値であっても良い。
When | φt1 | − | φr |> α1 or | φt2 | − | φr |> α2 is satisfied, for example, the target braking force BF2r is calculated based on the following formula (10), A signal is output to the brake drive unit 13 so as to apply the target braking force BF2r to the wheels.
BF2r = G1 ・ ((ΔA ・ 4 ・ L 2・ CPf ・ CPr ・ V)
/ ((CPf · CPr) / dr)) · φr (10)
Here, G1 is a gain, dr is a rear tread, and ΔA is
ΔA = ((δf / (Gγδf (0) · δf + Δφt2))
− (1 / Gγδf (0))) / (L · V) (11)
It is. Note that Δφt2 in the equation (11) is
Δφt2 = φr− (φt2 + β) (12)
It is. Here, the reason why Δφt2 is not simply φr−φt2 is that when the understeer prevention control is activated, the host vehicle 1 is already in the understeer state, and the yaw rate φt2 based on the road shape for passing the curve is obtained. If controlled, the target amount may be insufficient. Therefore, this shortage can be compensated as φt2 + β. Β is a value calculated in advance from the time and absolute amount after the understeer state. Further, it may be a constant value.

一方、オーバステア防止制御では、制限処理された第1のヨーレートφt1の絶対値|φt1|と制限処理された第2のヨーレートφt2の絶対値|φt2|とを比較し、これら絶対値が小さい方のヨーレートを基準に、再度、オーバステア防止制御を実行するか否かの判定が行われる。   On the other hand, in the oversteer prevention control, the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is compared with the absolute value | φt2 | of the second yaw rate φt2 subjected to the restriction process. Whether or not the oversteer prevention control is executed again is determined based on the yaw rate.

具体的には、制限処理された第1のヨーレートφt1の絶対値|φt1|の方が小さい場合は、|φr|−|φt1|>α4か否かの判定が行われ(α4は予め設定しておいた値)、制限処理された第2のヨーレートφt2の絶対値|φt2|の方が小さい場合は、|φr|−|φt2|>α3か否かの判定が行われる(α3は予め設定しておいた値)。ここで、α3<α4。このように絶対値が大きい方のヨーレートを制御作動の判定に用いることにより、不必要な制御介入が防止され、ドライバに制御介入による違和感を与えることが防止できるようになっているのである。   Specifically, when the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is smaller, it is determined whether or not | φr | − | φt1 |> α4 (α4 is set in advance). If the absolute value | φt2 | of the limited second yaw rate φt2 is smaller, it is determined whether or not | φr | − | φt2 |> α3 (α3 is set in advance) Value). Here, α3 <α4. By using the yaw rate having the larger absolute value in this way for determining the control operation, unnecessary control intervention is prevented and the driver can be prevented from feeling uncomfortable due to the control intervention.

そして、|φr|−|φt1|>α4、或いは、|φr|−|φt2|>α3を満たした場合は、例えば、以下の(13)式に基づき目標制動力BF2fを演算し、旋回外側前輪に対し、この目標制動力BF2fを付与するようにブレーキ駆動部13に対して信号が出力される。
BF2f=G1・((ΔA・4・L・CPf・CPr・V)
/((CPf・CPr)/df))・φr …(13)
ここで、dfはフロントトレッドを示す。
When | φr | − | φt1 |> α4 or | φr | − | φt2 |> α3 is satisfied, for example, the target braking force BF2f is calculated based on the following equation (13), and the turning outer front wheel On the other hand, a signal is output to the brake drive unit 13 so as to apply the target braking force BF2f.
BF2f = G1 · ((ΔA · 4 · L 2 · CPf · CPr · V)
/ ((CPf · CPr) / df)) · φr (13)
Here, df indicates a front tread.

このように、制動力制御部40jは、制動力制御手段として設けられている。   Thus, the braking force control part 40j is provided as a braking force control means.

パワーステアリング制御補正部40kは、ハンドル角センサ24からハンドル角θHが、車速演算部61から車速Vが、ヨーレート制限値演算部40hからヨーレート制限値φLが入力される。   The power steering control correction unit 40k receives the steering wheel angle θH from the steering wheel angle sensor 24, the vehicle speed V from the vehicle speed calculation unit 61, and the yaw rate limit value φL from the yaw rate limit value calculation unit 40h.

そして、ヨーレート制限値φLを基に、例えば、以下の(14)式により目標操舵角θLを逆算し、現在の実舵角θHと目標操舵角θLとの差(θH−θL)の絶対値|θH−θL|が予め設定しておいた閾値λより大きい場合、現在の実舵角θHと目標操舵角θLとの差(θH−θL)の絶対値|θH−θL|に応じて、例えば、図8に示すような、予め設定しておいたマップを参照して、アシストトルク減少補正量ΔTasを設定して、パワーステアリング制御装置30に出力する。
θL=((1+T・s)/Gγδf(0))・φL・n …(14)
Then, based on the yaw rate limit value φL, for example, the target steering angle θL is calculated by the following equation (14), and the absolute value of the difference (θH−θL) between the current actual steering angle θH and the target steering angle θL | When θH−θL | is larger than a preset threshold value λ, according to the absolute value | θH−θL | of the difference (θH−θL) between the current actual steering angle θH and the target steering angle θL, for example, With reference to a map set in advance as shown in FIG. 8, the assist torque reduction correction amount ΔTas is set and output to the power steering control device 30.
θL = ((1 + T · s) / Gγδf (0)) · φL · n (14)

ここで、図8に示すように、アシストトルク減少補正量ΔTasは、現在の実舵角θHと目標操舵角θLとの差(θH−θL)が大きくなる程、大きく設定され、パワーステアリング制御装置30によるアシストトルクの量を減少させる。換言すれば、ドライバが目標操舵角θLから離れる側に操舵することが、ハンドルが重くなるためにやりずらくなり、これにより、目標操舵角θLへの操舵を促すようになっているのである。   Here, as shown in FIG. 8, the assist torque reduction correction amount ΔTas is set larger as the difference (θH−θL) between the current actual steering angle θH and the target steering angle θL increases, and the power steering control device 30 reduces the amount of assist torque. In other words, it is difficult for the driver to steer away from the target steering angle θL because the handle becomes heavy, and thus, steering to the target steering angle θL is urged.

このように、パワーステアリング制御補正部40kは、パワーステアリング制御補正手段として設けられている。   Thus, the power steering control correction unit 40k is provided as power steering control correction means.

次に、制御装置40で実行される車両挙動制御を図9のフローチャートで説明する。このプログラムは、所定時間毎に繰り返し実行されるもので、まず、ステップ(以下、「S」と略称)101では、必要なパラメータ(各道路情報、前方画像、4輪12fl,12fr,12rl,12rrの各車輪速度ωfl,ωfr,ωrl,ωrr、ハンドル角θH、実ヨーレートφr、横加速度Gy等)の読み込みを行う。   Next, the vehicle behavior control executed by the control device 40 will be described with reference to the flowchart of FIG. This program is repeatedly executed every predetermined time. First, in step (hereinafter abbreviated as “S”) 101, necessary parameters (each road information, front image, four wheels 12fl, 12fr, 12rl, 12rr) Wheel speeds ωfl, ωfr, ωrl, ωrr, steering wheel angle θH, actual yaw rate φr, lateral acceleration Gy, etc.).

次いで、S102に進み、必要パラメータ(車速V、路面μ等)の演算を行う。   Next, in S102, necessary parameters (vehicle speed V, road surface μ, etc.) are calculated.

次に、S103に進み、道路形状認識部40bにおいて、ナビゲーション装置21から送信されたノード毎の位置情報に基づき、最終的なカーブ曲率半径rp[j]等の道路形状を認識する。   In step S103, the road shape recognition unit 40b recognizes the road shape such as the final curve curvature radius rp [j] based on the position information for each node transmitted from the navigation device 21.

次いで、S104に進み、自車進行路推定部40cにおいて、CCDカメラ22L、22Rからの画像情報や運転状態に基づき、前述のa,b,cの何れかにより自車進行路を推定する。   Next, the process proceeds to S104, and the own vehicle traveling path estimation unit 40c estimates the own vehicle traveling path from any one of the above-described a, b, and c based on the image information from the CCD cameras 22L and 22R and the driving state.

そして、S105に進んで、カーブ進入判定部40dは、ナビゲーション装置21からの情報を基に求めた道路形状と、画像情報や運転状態を基に求めた自車進行路とを比較して、自車両1がカーブに進入しようとしているのか否か判定し、カーブに進入しようとしているのであればS106へと進み、それ以外の場合はルーチンを抜ける。このS105での判定は、例えば、自車進行路が旋回状態となっていても道路形状でカーブが認識されていない場合や、両者のデータ間に大きなずれがある場合等には、カーブに進入しようしていないとして判定する。また、交差点におけるナビゲーション装置21からの情報を基に求めた道路形状(誘導経路)が直進であっても、自車進行路が旋回状態となっている場合は、カーブに進入しようとしていると判定する。   In S105, the curve approach determination unit 40d compares the road shape obtained based on the information from the navigation device 21 with the own vehicle traveling path obtained based on the image information and the driving state, It is determined whether or not the vehicle 1 is about to enter the curve. If the vehicle 1 is about to enter the curve, the process proceeds to S106. Otherwise, the routine is exited. The determination in S105 is, for example, when the vehicle travels in a turning state and the curve is not recognized by the road shape, or when there is a large deviation between the two data, the vehicle enters the curve. Judge as not doing. Further, even if the road shape (guidance route) obtained based on information from the navigation device 21 at the intersection is straight ahead, it is determined that the vehicle is going to enter a curve when the vehicle traveling route is in a turning state. To do.

S105でカーブに進入と判定してS106に進むと、第1のヨーレート演算部40fは、前述の(7)式により、自車両1の運転状態に基づくヨーレートを第1のヨーレートφ1として演算する。   When it is determined that the vehicle has entered the curve in S105 and the process proceeds to S106, the first yaw rate calculation unit 40f calculates the yaw rate based on the driving state of the host vehicle 1 as the first yaw rate φ1 by the above-described equation (7).

次いで、S107に進み、第2のヨーレート演算部40gは、前述の(9)式により道路形状に基づくヨーレートを第2のヨーレートφ2として演算する。   Next, the process proceeds to S107, and the second yaw rate calculation unit 40g calculates the yaw rate based on the road shape as the second yaw rate φ2 by the above-described equation (9).

次いで、S108に進み、ヨーレート制限値演算部40hは、例えば、図7に示すような、予め設定しておいたマップを参照して、その路面μの状態のハンドル角θHで、車両1が発生させることの可能な限界ヨーレートをヨーレート制限値φLとして演算する。   Next, in S108, the yaw rate limit value calculation unit 40h generates the vehicle 1 with the steering wheel angle θH in the state of the road surface μ with reference to a preset map as shown in FIG. 7, for example. The limit yaw rate that can be set is calculated as the yaw rate limit value φL.

その後、S109に進むと、ヨーレート制限部40iにより、ヨーレート制限値φLによる第1,第2のヨーレートφ1,φ2の制限処理(φt1,φt2の設定)が実行される。   Thereafter, when the process proceeds to S109, the yaw rate limiting unit 40i executes the limiting process (setting of φt1, φt2) of the first and second yaw rates φ1, φ2 by the yaw rate limiting value φL.

このφt1,φt2の設定は、例えば、図10のフローチャートに従って実行され、まず、S201で第1のヨーレートφ1の絶対値|φ1|とヨーレート制限値φLの絶対値|φL|の比較が行われる。   The setting of φt1 and φt2 is executed, for example, according to the flowchart of FIG. 10. First, in S201, the absolute value | φ1 | of the first yaw rate φ1 and the absolute value | φL | of the yaw rate limit value φL are compared.

このS201での比較の結果、第1のヨーレートφ1の絶対値|φ1|がヨーレート制限値φLの絶対値|φL|を超えていなければ(|φ1|<|φL|の場合)、第1のヨーレートφ1は、車両1が発生可能なヨーレートであると判定してS202に進み、制限処理された第1のヨーレートφt1には、そのまま第1のヨーレートφ1が設定される(φt1=φ1)。   If the absolute value | φ1 | of the first yaw rate φ1 does not exceed the absolute value | φL | of the yaw rate limit value φL as a result of the comparison in S201 (if | φ1 | <| φL |), the first The yaw rate φ1 is determined to be a yaw rate that can be generated by the vehicle 1 and the process proceeds to S202, and the first yaw rate φ1 is set as it is to the first yaw rate φt1 subjected to the restriction process (φt1 = φ1).

逆に、S201での比較の結果、第1のヨーレートφ1の絶対値|φ1|がヨーレート制限値φLの絶対値|φL|以上の場合(|φ1|≧|φL|の場合)、この第1のヨーレートφ1は、車両1が発生困難なヨーレートであると判定してS203に進み、制限処理された第1のヨーレートφt1には、ヨーレート制限値φLが設定される(φt1=φL)。   Conversely, if the absolute value | φ1 | of the first yaw rate φ1 is greater than or equal to the absolute value | φL | of the yaw rate limit value φL as a result of the comparison in S201 (if | φ1 | ≧ | φL |), The yaw rate φ1 is determined to be a yaw rate that is difficult for the vehicle 1 to generate, and the process proceeds to S203, and the yaw rate limit value φL is set to the first yaw rate φt1 subjected to the limit process (φt1 = φL).

次に、S204に進み、第2のヨーレートφ2の絶対値|φ2|とヨーレート制限値φLの絶対値|φL|の比較が行われる。   Next, in S204, the absolute value | φ2 | of the second yaw rate φ2 is compared with the absolute value | φL | of the yaw rate limit value φL.

このS204での比較の結果、第2のヨーレートφ2の絶対値|φ2|がヨーレート制限値φLの絶対値|φL|を超えていなければ(|φ2|<|φL|の場合)、第2のヨーレートφ2は、車両1が発生可能なヨーレートであると判定してS205に進み、制限処理された第2のヨーレートφt2には、そのまま第2のヨーレートφ2が設定され(φt2=φ2)、ルーチンを抜ける。   If the absolute value | φ2 | of the second yaw rate φ2 does not exceed the absolute value | φL | of the yaw rate limit value φL as a result of the comparison in S204 (if | φ2 | <| φL |), the second value The yaw rate φ2 is determined to be a yaw rate that can be generated by the vehicle 1 and the process proceeds to S205, and the second yaw rate φ2 is set as it is to the second yaw rate φt2 subjected to the restriction process (φt2 = φ2). Exit.

逆に、S204での比較の結果、第2のヨーレートφ2の絶対値|φ2|がヨーレート制限値φLの絶対値|φL|以上の場合(|φ2|≧|φL|の場合)、この第2のヨーレートφ2は、車両1が発生困難なヨーレートであると判定してS206に進み、制限処理された第2のヨーレートφt2には、ヨーレート制限値φLが設定され(φt2=φL)、ルーチンを抜ける。   Conversely, if the absolute value | φ2 | of the second yaw rate φ2 is greater than or equal to the absolute value | φL | of the yaw rate limit value φL (in the case of | φ2 | ≧ | φL |) as a result of the comparison in S204, The yaw rate φ2 is determined to be a yaw rate that is difficult for the vehicle 1 to generate, and the process proceeds to S206. The second yaw rate φt2 subjected to the limit process is set with the yaw rate limit value φL (φt2 = φL), and the routine is exited. .

再び、図9のフローチャートに戻り、S109でφt1,φt2の設定を行った後は、S110に進み、制動力制御部40jによりφt1,φt2による制動力制御が実行される。この制動力制御は、例えば、図11〜図13に示すフローチャートに従って実行され、まず、S301で制限処理された第1のヨーレートφt1と実ヨーレートφrとのヨーレート偏差Δφt1(=φr−φt1)を演算する。   Returning to the flowchart of FIG. 9 again, after setting φt1 and φt2 in S109, the process proceeds to S110, where braking force control by φt1 and φt2 is executed by the braking force control unit 40j. This braking force control is executed in accordance with, for example, the flowcharts shown in FIGS. 11 to 13. First, the yaw rate deviation Δφt1 (= φr−φt1) between the first yaw rate φt1 and the actual yaw rate φr subjected to the limiting process in S301 is calculated. To do.

次いで、S302に進み、ヨーレート偏差Δφt1の絶対値|Δφt1|が設定値C1以上か否か判定し、設定値C1以上の場合にはS303以降の制動力制御を開始し、設定値C1を超えていないのであれば、そのままルーチンを抜ける。   Next, the process proceeds to S302, in which it is determined whether or not the absolute value | Δφt1 | of the yaw rate deviation Δφt1 is greater than or equal to the set value C1. If not, exit the routine.

S302でヨーレート偏差Δφt1の絶対値|Δφt1|が設定値C1以上であるとして、S303に進むと、制限処理された第1のヨーレートφt1の絶対値|φt1|と実ヨーレートφrの絶対値|φr|とが比較され、制限処理された第1のヨーレートφt1の絶対値|φt1|が実ヨーレートφrの絶対値|φr|より大であると判定された場合は、車両1はアンダステア傾向であるため、S304に進んでアンダステア防止制御が実行される。逆に、制限処理された第1のヨーレートφt1の絶対値|φt1|が実ヨーレートφrの絶対値|φr|より小であると判定された場合は、車両1はオーバステア傾向であるため、S305に進んでオーバステア防止制御が実行される。   Assuming that the absolute value | Δφt1 | of the yaw rate deviation Δφt1 is equal to or greater than the set value C1 in S302, the process proceeds to S303, where the absolute value | φt1 | of the limited first yaw rate φt1 and the absolute value | φr | And the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is determined to be larger than the absolute value | φr | of the actual yaw rate φr, the vehicle 1 tends to understeer. Proceeding to S304, understeer prevention control is executed. On the other hand, when it is determined that the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is smaller than the absolute value | φr | of the actual yaw rate φr, the vehicle 1 tends to oversteer, so the process proceeds to S305. Then, the oversteer prevention control is executed.

S304で実行されるアンダステア防止制御は、例えば、図12のフローチャートに示すように、まず、S401で制限処理された第1のヨーレートφt1の絶対値|φt1|と制限処理された第2のヨーレートφt2の絶対値|φt2|の比較が行われる。   For example, as shown in the flowchart of FIG. 12, the understeer prevention control executed in S304 is first performed by the absolute value | φt1 | of the first yaw rate φt1 restricted in S401 and the second yaw rate φt2 restricted. The absolute values of | φt2 | are compared.

そして、制限処理された第1のヨーレートφt1の絶対値|φt1|が制限処理された第2のヨーレートφt2の絶対値|φt2|より大きい場合(|φt1|>|φt2|の場合)は、S402に進み、|φt1|−|φr|>α1か否かの判定が行われ(α1は予め設定しておいた値)、|φt1|−|φr|>α1の場合はS404以降へと進み、|φt1|−|φr|≦α1の場合はそのままルーチンを抜ける。   When the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is larger than the absolute value | φt2 | of the second yaw rate φt2 subjected to the restriction process (in the case of | φt1 |> | φt2 |), S402 To determine whether or not | φt1 | − | φr |> α1 (α1 is a preset value). If | φt1 | − | φr |> α1, the process proceeds to S404 and thereafter. If | φt1 | − | φr | ≦ α1, the routine is directly exited.

また、制限処理された第1のヨーレートφt1の絶対値|φt1|が制限処理された第2のヨーレートφt2の絶対値|φt2|以下の場合(|φt1|≦|φt2|の場合)は、S403に進み、|φt2|−|φr|>α2か否かの判定が行われ(α2は予め設定しておいた値)、|φt2|−|φr|>α2の場合はS404以降へと進み、|φt2|−|φr|≦α2の場合はそのままルーチンを抜ける。すなわち、大きい方の制限処理されたヨーレートを基準として判定を行うのである。   When the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is equal to or smaller than the absolute value | φt2 | of the second yaw rate φt2 subjected to the restriction process (in the case of | φt1 | ≦ | φt2 |), S403 To determine whether or not | φt2 | − | φr |> α2 (α2 is a preset value). If | φt2 | − | φr |> α2, the process proceeds to S404 and thereafter. If | φt2 | − | φr | ≦ α2, the routine is exited. That is, the determination is made based on the larger yaw rate subjected to the restriction process.

そして、S402で|φt1|−|φr|>α1、或いは、S403で|φt2|−|φr|>α2となってS404に進むと、前述の(12)式により、φt2+βを基準とするヨーレート偏差Δφt2を演算する。   Then, if | φt1 | − | φr |> α1 in S402 or | φt2 | − | φr |> α2 in S403 and the process proceeds to S404, the yaw rate deviation based on φt2 + β is determined according to the above equation (12). Δφt2 is calculated.

次いで、S405に進み、前述の(10)式により、目標制動力BF2rが演算され、S406に進んで、旋回内側後輪に対し、目標制動力BF2rが出力されてルーチンを抜ける。   Next, the process proceeds to S405, where the target braking force BF2r is calculated by the above-described equation (10). The process proceeds to S406, where the target braking force BF2r is output to the turning inner rear wheel, and the routine is exited.

一方、S305で実行されるオーバステア防止制御は、例えば、図13のフローチャートに示すように、まず、S501で制限処理された第1のヨーレートφt1の絶対値|φt1|と制限処理された第2のヨーレートφt2の絶対値|φt2|の比較が行われる。   On the other hand, in the oversteer prevention control executed in S305, for example, as shown in the flowchart of FIG. 13, first, the absolute value | φt1 | of the first yaw rate φt1 restricted in S501 and the second subjected to the restriction processing. The absolute value | φt2 | of the yaw rate φt2 is compared.

そして、制限処理された第1のヨーレートφt1の絶対値|φt1|が制限処理された第2のヨーレートφt2の絶対値|φt2|より大きい場合(|φt1|>|φt2|の場合)は、S502に進み、|φr|−|φt2|>α3か否かの判定が行われ(α3は予め設定しておいた値)、|φr|−|φt2|>α3の場合はS504以降へと進み、|φr|−|φt2|≦α3の場合はそのままルーチンを抜ける。   When the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is larger than the absolute value | φt2 | of the second yaw rate φt2 subjected to the restriction process (in the case of | φt1 |> | φt2 |), S502 To determine whether or not | φr | − | φt2 |> α3 (α3 is a preset value). If | φr | − | φt2 |> α3, the process proceeds to S504 and thereafter. If | φr | − | φt2 | ≦ α3, the routine is directly exited.

また、制限処理された第1のヨーレートφt1の絶対値|φt1|が制限処理された第2のヨーレートφt2の絶対値|φt2|以下の場合(|φt1|≦|φt2|の場合)は、S503に進み、|φr|−|φt1|>α4か否かの判定が行われ(α4は予め設定しておいた値)、|φr|−|φt1|>α4の場合はS504以降へと進み、|φr|−|φt1|≦α4の場合はそのままルーチンを抜ける。すなわち、小さい方の制限処理されたヨーレートを基準として判定を行うのである。   When the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is equal to or smaller than the absolute value | φt2 | of the second yaw rate φt2 subjected to the restriction process (in the case of | φt1 | ≦ | φt2 |), S503 Is determined whether or not | φr | − | φt1 |> α4 (α4 is a preset value). If | φr | − | φt1 |> α4, the process proceeds to S504 and thereafter. If | φr | − | φt1 | ≦ α4, the routine is directly exited. That is, the determination is made based on the yaw rate subjected to the smaller restriction process.

そして、S502で|φr|−|φt2|>α3、或いは、S503で|φr|−|φt1|>α4となってS504に進むと、前述の(12)式により、φt2+βを基準とするヨーレート偏差Δφt2を演算する。   When | φr | − | φt2 |> α3 in S502 or | φr | − | φt1 |> α4 in S503 and the process proceeds to S504, the yaw rate deviation based on φt2 + β is determined according to the above equation (12). Δφt2 is calculated.

次いで、S505に進み、前述の(13)式により、目標制動力BF2fが演算され、S506に進んで、旋回外側前輪に対し、目標制動力BF2fが出力されてルーチンを抜ける。   Next, the process proceeds to S505, where the target braking force BF2f is calculated by the above-described equation (13), and the process proceeds to S506, where the target braking force BF2f is output to the turning outer front wheel and the routine is exited.

以上のように、図9のS110においてφt1,φt2による制動力制御が実行され、更に、S111に進んで、パワーステアリング制御補正部40kにおいて、ヨーレート制限値φLに基づいたパワーステアリング制御補正が実行されてプログラムを抜ける。   As described above, the braking force control by φt1 and φt2 is executed in S110 of FIG. 9, and the process further proceeds to S111, where the power steering control correction based on the yaw rate limit value φL is executed in the power steering control correction unit 40k. Exit the program.

このパワーステアリング制御補正は、例えば、図14に示すフローチャートに従って実行され、まず、S601でヨーレート制限値φLに基づき目標操舵角θLが、前述の(14)式により演算される。   This power steering control correction is executed, for example, according to the flowchart shown in FIG. 14. First, in S601, the target steering angle θL is calculated by the above-described equation (14) based on the yaw rate limit value φL.

次に、S602に進み、現在の実舵角θHと目標操舵角θLとの差(θH−θL)の絶対値|θH−θL|と予め設定しておいた閾値λとを比較する。この比較の結果、|θH−θL|≦λで、現在の実舵角θHと目標操舵角θLとに乖離がみられない場合は、そのままルーチンを抜ける。   In step S602, the absolute value | θH-θL | of the difference (θH−θL) between the current actual steering angle θH and the target steering angle θL is compared with a preset threshold value λ. As a result of this comparison, if | θH−θL | ≦ λ and there is no difference between the current actual steering angle θH and the target steering angle θL, the routine is directly exited.

逆に、|θH−θL|>λで、現在の実舵角θHと目標操舵角θLとの間にλを超える差がある場合には、S603に進み、現在の実舵角θHと目標操舵角θLとの差(θH−θL)の絶対値|θH−θL|に応じて、例えば、図8に示すような、予め設定しておいたマップを参照して、アシストトルク減少補正量ΔTasを設定し、S604に進んでパワーステアリング制御装置30に出力してルーチンを抜ける。   Conversely, if | θH−θL |> λ and there is a difference exceeding λ between the current actual steering angle θH and the target steering angle θL, the process proceeds to S603, where the current actual steering angle θH and the target steering angle are determined. According to the absolute value | θH−θL | of the difference (θH−θL) from the angle θL, for example, referring to a map set in advance as shown in FIG. Set, proceed to S604, output to the power steering control device 30, and exit the routine.

このように、本実施の第1形態によれば、制動力制御部40jで目標とする第1,第2のヨーレートφt1、φt2、及び、パワーステアリング制御補正部40kで理想とする舵角は常にヨーレート制限値φLを超えないように設定されるので、これらが過大な目標値となることがなく、常に適切な制御を行え、安定した制御性が得られるようになっている。   Thus, according to the first embodiment, the first and second yaw rates φt1 and φt2 targeted by the braking force control unit 40j and the ideal steering angle by the power steering control correction unit 40k are always set. Since they are set so as not to exceed the yaw rate limit value φL, they do not become excessive target values, and appropriate control can always be performed and stable controllability can be obtained.

また、ドライバが限界以上の操舵を行った場合、パワーステアリング制御補正部40kによりドライバにアシスト力の減少という形態で報知されるため、ドライバに適切な操舵状態に戻すことを促すことができる。   Further, when the driver steers beyond the limit, the power steering control correction unit 40k is notified to the driver in the form of a reduction in assist force, so that the driver can be prompted to return to an appropriate steering state.

更に、本実施の第1形態による制動力制御部40jによる制動力制御は、運転状態に基づくヨーレートに加え、道路形状に基づくヨーレートによる制御となっているため、走行環境に応じた自然で最適な制動力制御が行える。   Furthermore, since the braking force control by the braking force control unit 40j according to the first embodiment is controlled by the yaw rate based on the road shape in addition to the yaw rate based on the driving state, it is natural and optimal according to the driving environment. Braking force control can be performed.

尚、本実施の第1形態では、道路形状認識部40bは、ナビゲーション装置21からの情報を基に道路形状を得るようにしているが、これに限ることなく、例えば、レーダーやカメラによりカーブ情報が得られればこの情報を用いても良い。また、ITS(Intelligent Transportation System )で供給される情報からカーブ情報を得るようにしても良い。   In the first embodiment, the road shape recognition unit 40b obtains the road shape based on the information from the navigation device 21, but the present invention is not limited to this, for example, curve information by a radar or a camera. If this is obtained, this information may be used. Further, curve information may be obtained from information supplied by ITS (Intelligent Transportation System).

次に、図15乃至図21は本発明の実施の第2形態を示し、図15は車両挙動制御装置を搭載した車両の概略構成を示す説明図、図16は車両挙動制御装置の機能ブロック図、図17は車両挙動制御のメインプログラムのフローチャート、図18はφt1の設定ルーチンのフローチャート、図19はφt1による制動力制御ルーチンのフローチャート、図20はアンダステア防止制御ルーチンのフローチャート、図21はオーバステア防止制御ルーチンのフローチャートである。尚、本実施の第2形態は、制動力制御を車両の運転状態に基づき求めるヨーレートのみを基に実行できるように変更したものであり、他の構成、作用効果は前記第1形態と同様であるので、同じ構成には同じ符号を記し、説明は省略する。   Next, FIGS. 15 to 21 show a second embodiment of the present invention, FIG. 15 is an explanatory diagram showing a schematic configuration of a vehicle equipped with a vehicle behavior control device, and FIG. 16 is a functional block diagram of the vehicle behavior control device. 17 is a flowchart of a main program for vehicle behavior control, FIG. 18 is a flowchart of a φt1 setting routine, FIG. 19 is a flowchart of a braking force control routine by φt1, FIG. 20 is a flowchart of an understeer prevention control routine, and FIG. It is a flowchart of a control routine. In the second embodiment, the braking force control is changed so that it can be executed only based on the yaw rate obtained based on the driving state of the vehicle, and the other configurations and operational effects are the same as those in the first embodiment. Therefore, the same components are denoted by the same reference numerals, and description thereof is omitted.

すなわち、図15に示すように、本実施の第2形態による制御装置50には、各センサ23fl,23fr,23rl,23rr、24、25、26から、それぞれ、4輪12fl,12fr,12rl,12rrの各車輪速度ωfl,ωfr,ωrl,ωrr、ハンドル角θH、実ヨーレートφr、横加速度Gyが入力される。   That is, as shown in FIG. 15, the control device 50 according to the second embodiment includes four wheels 12fl, 12fr, 12rl, 12rr from the sensors 23fl, 23fr, 23rl, 23rr, 24, 25, 26, respectively. Wheel speed ωfl, ωfr, ωrl, ωrr, steering wheel angle θH, actual yaw rate φr, and lateral acceleration Gy.

そして、これらの入力信号に基づき、制御装置50は、車両の挙動がアンダステア状態か、オーバステア状態か判定し、車両挙動を安定させるべくブレーキ駆動部13に信号出力する。また、制御装置50は、現在のドライバによる操舵状態が限界を超えていないか否かを判定し、限界を超えている場合には、ドライバに適切な操舵状態への転舵を促すべくパワーステアリング制御装置30に対して電動モータ17によるアシストトルクを減少補正するように信号出力する。   Then, based on these input signals, the control device 50 determines whether the behavior of the vehicle is an understeer state or an oversteer state, and outputs a signal to the brake drive unit 13 to stabilize the vehicle behavior. Further, the control device 50 determines whether or not the current steering state by the driver exceeds the limit, and if it exceeds the limit, the power steering is performed to prompt the driver to steer to an appropriate steering state. A signal is output to the control device 30 so that the assist torque by the electric motor 17 is reduced and corrected.

制御装置50は、マイクロコンピュータとその周辺回路で構成され、図16に示すように、車速演算部40a、路面μ推定部40e、第1のヨーレート演算部40f、ヨーレート制限値演算部40h、パワーステアリング制御補正部40k、ヨーレート制限部50a、制動力制御部50bから主要に構成されている。   The control device 50 is composed of a microcomputer and its peripheral circuits, and as shown in FIG. 16, a vehicle speed calculation unit 40a, a road surface μ estimation unit 40e, a first yaw rate calculation unit 40f, a yaw rate limit value calculation unit 40h, a power steering The control correction unit 40k, the yaw rate limiting unit 50a, and the braking force control unit 50b are mainly configured.

ヨーレート制限部50aは、第1のヨーレート演算部40fから第1のヨーレートφ1が、ヨーレート制限値演算部40hからヨーレート制限値φLが入力される。   The yaw rate limiter 50a receives the first yaw rate φ1 from the first yaw rate calculator 40f and the yaw rate limit value φL from the yaw rate limit value calculator 40h.

そして、第1のヨーレートφ1の絶対値|φ1|がヨーレート制限値φLの絶対値|φL|を超えないように制限処理してヨーレートφt1を設定し、この制限処理した第1のヨーレートφt1を制動力制御部50bに出力する。すなわち、このヨーレート制限部50aは、パラメータ制限手段として設けられている。   Then, the yaw rate φt1 is set by performing the limiting process so that the absolute value | φ1 | of the first yaw rate φ1 does not exceed the absolute value | φL | of the yaw rate limiting value φL, and the first yaw rate φt1 subjected to the limiting process is controlled. It outputs to the power control part 50b. That is, the yaw rate limiting unit 50a is provided as parameter limiting means.

制動力制御部50aは、ハンドル角センサ24からハンドル角θHが、ヨーレートセンサ25から実ヨーレートφrが、車速演算部40aから車速Vが、ヨーレート制限部50aから制限処理された第1のヨーレートφt1が入力される。   The braking force control unit 50a has the steering angle θH from the steering wheel angle sensor 24, the actual yaw rate φr from the yaw rate sensor 25, the vehicle speed V from the vehicle speed calculation unit 40a, and the first yaw rate φt1 subjected to the limiting process from the yaw rate limiting unit 50a. Entered.

そして、制限処理された第1のヨーレートφt1と実ヨーレートφrとのヨーレート偏差Δφt1(=φr−φt1)を演算し、このヨーレート偏差Δφt1の絶対値|Δφt1|が設定値C2以上の場合に制動力制御を開始する。   Then, the yaw rate deviation Δφt1 (= φr−φt1) between the first yaw rate φt1 subjected to the restriction process and the actual yaw rate φr is calculated, and the braking force is obtained when the absolute value | Δφt1 | of the yaw rate deviation Δφt1 is equal to or larger than the set value C2. Start control.

制動力制御では、制限処理された第1のヨーレートφt1の絶対値|φt1|と実ヨーレートφrの絶対値|φr|とを比較して、制限処理された第1のヨーレートφt1の絶対値|φt1|が実ヨーレートφrの絶対値|φr|より大であると判定された場合は、車両1はアンダステア傾向であるためアンダステア防止制御が実行される。逆に、制限処理された第1のヨーレートφt1の絶対値|φt1|が実ヨーレートφrの絶対値|φr|より小であると判定された場合は、車両1はオーバステア傾向であるためオーバステア防止制御が実行される。   In the braking force control, the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is compared with the absolute value | φr | of the actual yaw rate φr, and the absolute value | φt1 of the first yaw rate φt1 subjected to the restriction process is compared. When | is determined to be greater than the absolute value | φr | of the actual yaw rate φr, the vehicle 1 has an understeer tendency, so that understeer prevention control is executed. Conversely, if it is determined that the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is smaller than the absolute value | φr | of the actual yaw rate φr, the vehicle 1 tends to oversteer, so that the oversteer prevention control is performed. Is executed.

アンダステア防止制御では、更に、ヨーレート偏差Δφt1の絶対値|Δφt1|が予め設定しておいた値P1より大か否か判定され、|Δφt1|>P1の場合には、以下の(15)式に基づき目標制動力BF2rを演算し、旋回内側後輪に対し、この目標制動力BF2rを付与するようにブレーキ駆動部13に対して信号が出力される。
BF2r=G1・((ΔB・4・L・CPf・CPr・V)
/((CPf・CPr)/dr))・φr …(15)
ここで、ΔBは、
ΔB=((δf/(Gγδf(0)・δf+Δφt1))
−(1/Gγδf(0)))/(L・V) …(16)
である。
In the understeer prevention control, it is further determined whether or not the absolute value | Δφt1 | of the yaw rate deviation Δφt1 is larger than a preset value P1, and if | Δφt1 |> P1, the following equation (15) is satisfied. Based on this, the target braking force BF2r is calculated, and a signal is output to the brake drive unit 13 so as to apply this target braking force BF2r to the rear turning inner wheel.
BF2r = G1 ・ ((ΔB ・ 4 ・ L 2・ CPf ・ CPr ・ V)
/ ((CPf · CPr) / dr)) · φr (15)
Where ΔB is
ΔB = ((δf / (Gγδf (0) · δf + Δφt1))
− (1 / Gγδf (0))) / (L · V) (16)
It is.

一方、オーバステア防止制御では、更に、ヨーレート偏差Δφt1の絶対値|Δφt1|が予め設定しておいた値P2より大か否か判定され、|Δφt1|>P2の場合には、以下の(17)式に基づき目標制動力BF2fを演算し、旋回外側前輪に対し、この目標制動力BF2fを付与するようにブレーキ駆動部13に対して信号が出力される。
BF2f=G1・((ΔB・4・L・CPf・CPr・V)
/((CPf・CPr)/df))・φr …(17)
このように、制動力制御部50bは、制動力制御手段として設けられている。
On the other hand, in the oversteer prevention control, it is further determined whether or not the absolute value | Δφt1 | of the yaw rate deviation Δφt1 is larger than a preset value P2, and if | Δφt1 |> P2, the following (17) Based on the equation, a target braking force BF2f is calculated, and a signal is output to the brake drive unit 13 so as to apply this target braking force BF2f to the front outside wheel.
BF2f = G1 · ((ΔB · 4 · L 2 · CPf · CPr · V)
/ ((CPf · CPr) / df)) · φr (17)
Thus, the braking force control part 50b is provided as a braking force control means.

次に、制御装置50で実行される車両挙動制御を図17のフローチャートで説明する。このプログラムは、所定時間毎に繰り返し実行されるもので、まず、S701では、必要なパラメータ(4輪12fl,12fr,12rl,12rrの各車輪速度ωfl,ωfr,ωrl,ωrr、ハンドル角θH、実ヨーレートφr、横加速度Gy等)の読み込みを行う。   Next, the vehicle behavior control executed by the control device 50 will be described with reference to the flowchart of FIG. This program is repeatedly executed every predetermined time. First, in S701, necessary parameters (four wheel speeds 12fl, 12fr, 12rl, 12rr, wheel speeds ωfl, ωfr, ωrl, ωrr, steering wheel angle θH, actual Yaw rate φr, lateral acceleration Gy, etc.) are read.

次いで、S702に進み、必要パラメータ(車速V、路面μ等)の演算を行う。   Next, in S702, necessary parameters (vehicle speed V, road surface μ, etc.) are calculated.

次に、S703に進み、第1のヨーレート演算部40fは、前述の(7)式により、自車両1の運転状態に基づくヨーレートを第1のヨーレートφ1として演算する(第1形態のS106と同様)。   Next, proceeding to S703, the first yaw rate calculation unit 40f calculates the yaw rate based on the driving state of the host vehicle 1 as the first yaw rate φ1 by the above-described equation (7) (similar to S106 in the first embodiment). ).

次いで、S704に進み、ヨーレート制限値演算部40hは、例えば、図7に示すような、予め設定しておいたマップを参照して、その路面μの状態のハンドル角θHで、車両1が発生させることの可能な限界ヨーレートをヨーレート制限値φLとして演算する(第1形態のS108と同様)。   Next, in S704, the yaw rate limit value calculation unit 40h generates the vehicle 1 with the steering wheel angle θH in the state of the road surface μ with reference to a map set in advance as shown in FIG. The limit yaw rate that can be set is calculated as the yaw rate limit value φL (similar to S108 in the first embodiment).

その後、S705に進むと、ヨーレート制限部50aにより、ヨーレート制限値φLによる第1のヨーレートφ1の制限処理(φt1の設定)が実行される。   Thereafter, when the process proceeds to S705, the yaw rate limiting unit 50a executes the limiting process (setting of φt1) of the first yaw rate φ1 by the yaw rate limiting value φL.

このφt1の設定は、例えば、図18のフローチャートに従って実行され、まず、S801で第1のヨーレートφ1の絶対値|φ1|とヨーレート制限値φLの絶対値|φL|の比較が行われる。   The setting of φt1 is executed, for example, according to the flowchart of FIG. 18. First, in S801, the absolute value | φ1 | of the first yaw rate φ1 and the absolute value | φL | of the yaw rate limit value φL are compared.

このS801での比較の結果、第1のヨーレートφ1の絶対値|φ1|がヨーレート制限値φLの絶対値|φL|を超えていなければ(|φ1|<|φL|の場合)、第1のヨーレートφ1は、車両1が発生可能なヨーレートであると判定してS802に進み、制限処理された第1のヨーレートφt1には、そのまま第1のヨーレートφ1が設定され(φt1=φ1)、ルーチンを抜ける。   If the absolute value | φ1 | of the first yaw rate φ1 does not exceed the absolute value | φL | of the yaw rate limit value φL as a result of the comparison in S801 (if | φ1 | <| φL |), the first The yaw rate φ1 is determined to be a yaw rate that can be generated by the vehicle 1, and the process proceeds to S802. The first yaw rate φ1 is set as it is to the first yaw rate φt1 subjected to the restriction process (φt1 = φ1), and the routine is executed. Exit.

逆に、S801での比較の結果、第1のヨーレートφ1の絶対値|φ1|がヨーレート制限値φLの絶対値|φL|以上の場合(|φ1|≧|φL|の場合)、この第1のヨーレートφ1は、車両1が発生困難なヨーレートであると判定してS803に進み、制限処理された第1のヨーレートφt1には、ヨーレート制限値φLが設定され(φt1=φL)、ルーチンを抜ける。   Conversely, if the absolute value | φ1 | of the first yaw rate φ1 is greater than or equal to the absolute value | φL | of the yaw rate limit value φL (in the case of | φ1 | ≧ | φL |) as a result of the comparison in S801, The yaw rate φ1 is determined to be a yaw rate that is difficult for the vehicle 1 to generate, and the process proceeds to S803. The first yaw rate φt1 subjected to the limit process is set with the yaw rate limit value φL (φt1 = φL), and the routine is exited. .

再び、図17のフローチャートに戻り、S705でφt1の設定を行った後は、S706に進み、制動力制御部50bによりφt1による制動力制御が実行される。この制動力制御は、例えば、図19〜図21に示すフローチャートに従って実行され、まず、S901で制限処理された第1のヨーレートφt1と実ヨーレートφrとのヨーレート偏差Δφt1(=φr−φt1)を演算する。   Returning to the flowchart of FIG. 17 again, after setting φt1 in S705, the process proceeds to S706, where braking force control by φt1 is executed by the braking force control unit 50b. This braking force control is executed in accordance with, for example, the flowcharts shown in FIGS. 19 to 21, and first, the yaw rate deviation Δφt1 (= φr−φt1) between the first yaw rate φt1 and the actual yaw rate φr restricted in S901 is calculated. To do.

次いで、S902に進み、ヨーレート偏差Δφt1の絶対値|Δφt1|が設定値C2以上か否か判定し、設定値C2以上の場合にはS903以降の制動力制御を開始し、設定値C2を超えていないのであれば、そのままルーチンを抜ける。   Next, in S902, it is determined whether or not the absolute value | Δφt1 | of the yaw rate deviation Δφt1 is greater than or equal to the set value C2, and if it is greater than or equal to the set value C2, braking force control after S903 is started and exceeds the set value C2. If not, exit the routine.

S902でヨーレート偏差Δφt1の絶対値|Δφt1|が設定値C2以上であるとして、S903に進むと、制限処理された第1のヨーレートφt1の絶対値|φt1|と実ヨーレートφrの絶対値|φr|とが比較され、制限処理された第1のヨーレートφt1の絶対値|φt1|が実ヨーレートφrの絶対値|φr|より大であると判定された場合は、車両1はアンダステア傾向であるため、S904に進んでアンダステア防止制御が実行される。逆に、制限処理された第1のヨーレートφt1の絶対値|φt1|が実ヨーレートφrの絶対値|φr|より小であると判定された場合は、車両1はオーバステア傾向であるため、S905に進んでオーバステア防止制御が実行される。   In S902, assuming that the absolute value | Δφt1 | of the yaw rate deviation Δφt1 is equal to or larger than the set value C2, the process proceeds to S903, where the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process and the absolute value | φr | And the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is determined to be larger than the absolute value | φr | of the actual yaw rate φr, the vehicle 1 tends to understeer. Proceeding to S904, understeer prevention control is executed. On the other hand, if it is determined that the absolute value | φt1 | of the first yaw rate φt1 subjected to the restriction process is smaller than the absolute value | φr | of the actual yaw rate φr, the vehicle 1 tends to oversteer, and thus the process proceeds to S905. Then, the oversteer prevention control is executed.

S904で実行されるアンダステア防止制御は、例えば、図20のフローチャートに示すように、まず、S1001でヨーレート偏差Δφt1の絶対値|Δφt1|が設定値P1より大か否か判定される。   In the understeer prevention control executed in S904, for example, as shown in the flowchart of FIG. 20, first, in S1001, it is determined whether the absolute value | Δφt1 | of the yaw rate deviation Δφt1 is larger than the set value P1.

このS1001の判定の結果、|Δφt1|>P1の場合は、S1002に進み、前述の(15)式により、目標制動力BF2rが演算され、S1003に進んで、旋回内側後輪に対し、目標制動力BF2rが出力されてルーチンを抜ける。   As a result of the determination in S1001, if | Δφt1 |> P1, the process proceeds to S1002, and the target braking force BF2r is calculated by the above-described equation (15), and the process proceeds to S1003, where the target braking force is applied to the turning inner rear wheel. The power BF2r is output and the routine is exited.

また、S1001の判定の結果、|Δφt1|≦P1の場合は、そのままルーチンを抜ける。   On the other hand, if | Δφt1 | ≦ P1 as a result of the determination in S1001, the routine is directly exited.

一方、S905で実行されるオーバステア防止制御は、例えば、図21のフローチャートに示すように、まず、S1101でヨーレート偏差Δφt1の絶対値|Δφt1|が設定値P2より大か否か判定される。   On the other hand, in the oversteer prevention control executed in S905, for example, as shown in the flowchart of FIG. 21, first, in S1101, it is determined whether or not the absolute value | Δφt1 | of the yaw rate deviation Δφt1 is larger than the set value P2.

このS1101の判定の結果、|Δφt1|>P2の場合は、S1102に進み、前述の(17)式により、目標制動力BF2fが演算され、S1103に進んで、旋回外側前輪に対し、目標制動力BF2fが出力されてルーチンを抜ける。   As a result of the determination in S1101, if | Δφt1 |> P2, the process proceeds to S1102, the target braking force BF2f is calculated by the above-described equation (17), and the process proceeds to S1103, where the target braking force is applied to the turning outer front wheel. BF2f is output and the routine is exited.

また、S1101の判定の結果、|Δφt1|≦P2の場合は、そのままルーチンを抜ける。   On the other hand, if | Δφt1 | ≦ P2 as a result of the determination in S1101, the routine is directly exited.

以上のように、図17のS706においてφt1による制動力制御が実行され、更に、S707に進むと、前述の第1形態のS111と同様、パワーステアリング制御補正部40kにおいて、ヨーレート制限値φLに基づいたパワーステアリング制御補正が実行され、プログラムを抜ける。   As described above, the braking force control by φt1 is executed in S706 of FIG. 17, and when the process proceeds to S707, the power steering control correction unit 40k is based on the yaw rate limit value φL as in S111 of the first embodiment. The power steering control correction is executed and the program is exited.

このように、本実施の第2形態に示す、道路形状に基づく第2のヨーレートを用いない制動力制御においても、前述の第1形態と同様に、制動力制御部50bで目標とする第1のヨーレートφt1、及び、パワーステアリング制御補正部40kで理想とする舵角は常にヨーレート制限値φLを超えないように設定されるので、これらが過大な目標値となることがなく、常に適切な制御を行え、安定した制御性が得られるようになっている。   Thus, also in the braking force control that does not use the second yaw rate based on the road shape shown in the second embodiment, the first target set by the braking force control unit 50b is the same as in the first embodiment. Since the ideal steering angle of the yaw rate φt1 and the power steering control correction unit 40k is always set so as not to exceed the yaw rate limit value φL, these are not excessive target values and are always controlled appropriately. So that stable controllability can be obtained.

また、ドライバが限界以上の操舵を行った場合、パワーステアリング制御補正部40kによりドライバにアシスト力の減少という形態で報知されるため、ドライバに適切な操舵状態に戻すことを促すことができる。   Further, when the driver steers beyond the limit, the power steering control correction unit 40k is notified to the driver in the form of a reduction in assist force, so that the driver can be prompted to return to an appropriate steering state.

本発明の実施の第1形態による、車両挙動制御装置を搭載した車両の概略構成を示す説明図Explanatory drawing which shows schematic structure of the vehicle carrying the vehicle behavior control apparatus by 1st Embodiment of this invention. 同上、車両挙動制御装置の機能ブロック図Same as above, functional block diagram of vehicle behavior control device 同上、パワーステアリング制御装置で設定されるアシスト電流の特性図Same as above, characteristic diagram of assist current set by power steering controller 同上、自車位置とノードに関する説明図Same as above, explanatory diagram about own vehicle position and node 同上、ノード角度及びカーブ曲率半径の演算に関する説明図Same as above, explanatory diagram regarding calculation of node angle and curve curvature radius 同上、ナビゲーション装置からのデータの説明図Same as above, explanatory diagram of data from navigation device 同上、ヨーレート制限値の特性図Same as above, characteristic diagram of yaw rate limit value 同上、アシストトルク減少補正量の特性図Same as above, characteristic diagram of assist torque reduction correction amount 同上、車両挙動制御のメインプログラムのフローチャートSame as above, flowchart of main program for vehicle behavior control 同上、φt1,φt2の設定ルーチンのフローチャートSame as above, flowchart of φt1, φt2 setting routine 同上、φt1とφt2による制動力制御ルーチンのフローチャートSame as above, flowchart of braking force control routine by φt1 and φt2 同上、アンダステア防止制御ルーチンのフローチャートSame as above, flowchart of understeer prevention control routine 同上、オーバステア防止制御ルーチンのフローチャートSame as above, flowchart of oversteer prevention control routine 同上、φLに基づいたパワーステアリング制御補正ルーチンのフローチャートSame as above, flowchart of power steering control correction routine based on φL 本発明の実施の第2形態による、車両挙動制御装置を搭載した車両の概略構成を示す説明図Explanatory drawing which shows schematic structure of the vehicle carrying the vehicle behavior control apparatus by 2nd Embodiment of this invention. 同上、車両挙動制御装置の機能ブロック図Same as above, functional block diagram of vehicle behavior control device 同上、車両挙動制御のメインプログラムのフローチャートSame as above, flowchart of main program for vehicle behavior control 同上、φt1の設定ルーチンのフローチャートSame as above, flowchart of φt1 setting routine 同上、φt1による制動力制御ルーチンのフローチャートSame as above, flowchart of braking force control routine by φt1 同上、アンダステア防止制御ルーチンのフローチャートSame as above, flowchart of understeer prevention control routine 同上、オーバステア防止制御ルーチンのフローチャートSame as above, flowchart of oversteer prevention control routine

符号の説明Explanation of symbols

1 車両
12fl,12fr,12rl,12rr 車輪
13 ブレーキ駆動部
16fl,16fr,16rl,16rr ホイールシリンダ
17 電動モータ
21 ナビゲーション装置
22L,22R CCDカメラ
23fl,23fr,23rl,23rr 車輪速センサ
24 ハンドル角センサ
25 ヨーレートセンサ
26 横加速度センサ
30 パワーステアリング制御装置
40 制御装置
40a 車速演算部
40b 道路形状認識部
40c 自車進行路推定部
40d カーブ進入判定部
40e 路面μ推定部
40f 第1のヨーレート演算部(第1のパラメータ演算手段)
40g 第2のヨーレート演算部(第2のパラメータ演算手段)
40h ヨーレート制限値演算部(パラメータ制限値演算手段)
40i ヨーレート制限部(パラメータ制限手段)
40j 制動力制御部(制動力制御手段)
40k パワーステアリング制御補正部(パワーステアリング制御補正手段)
代理人 弁理士 伊 藤 進
DESCRIPTION OF SYMBOLS 1 Vehicle 12fl, 12fr, 12rl, 12rr Wheel 13 Brake drive part 16fl, 16fr, 16rl, 16rr Wheel cylinder 17 Electric motor 21 Navigation device 22L, 22R CCD camera 23fl, 23fr, 23rl, 23rr Wheel speed sensor 24 Handle angle sensor 25 Yaw rate Sensor 26 lateral acceleration sensor 30 power steering control device 40 control device 40a vehicle speed calculation unit 40b road shape recognition unit 40c own vehicle traveling path estimation unit 40d curve approach determination unit 40e road surface μ estimation unit 40f first yaw rate calculation unit (first Parameter calculation means)
40g Second yaw rate calculation unit (second parameter calculation means)
40h Yaw rate limit value calculation unit (parameter limit value calculation means)
40i yaw rate limiting unit (parameter limiting means)
40j Braking force control unit (braking force control means)
40k power steering control correction unit (power steering control correction means)
Agent Patent Attorney Susumu Ito

Claims (3)

車両の運転状態に基づき求めるパラメータを第1のパラメータとして演算する第1のパラメータ演算手段と、
車両が走行する道路形状に基づき求めるパラメータを第2のパラメータとして演算する第2のパラメータ演算手段と、
路面状態に基づき求めるパラメータをパラメータ制限値として演算するパラメータ制限値演算手段と、
上記第1のパラメータと上記第2のパラメータを上記パラメータ制限値で制限するパラメータ制限手段と、
上記パラメータ制限手段で制限処理した上記第1のパラメータと上記第2のパラメータとに基づき、車輪に制動力を付加して車両にヨーモーメントを発生させる制動力制御手段と、
上記パラメータ制限値と現在の操舵状態に基づき現在の操舵状態が予め設定する領域範囲内の操舵状態か否か判断し、上記予め設定する領域範囲外の操舵状態と判断した場合に、操舵アシストトルクを補正するパワーステアリング制御補正手段と、
を備えたことを特徴とする車両の挙動制御装置。
First parameter calculation means for calculating a parameter to be obtained based on the driving state of the vehicle as a first parameter;
A second parameter calculation means for calculating a parameter to be calculated based on a road shape on which the vehicle travels as a second parameter;
Parameter limit value calculating means for calculating a parameter to be calculated based on the road surface condition as a parameter limit value;
Parameter limiting means for limiting the first parameter and the second parameter with the parameter limit value;
Braking force control means for applying a braking force to the wheels and generating a yaw moment on the vehicle based on the first parameter and the second parameter restricted by the parameter restriction means;
Based on the parameter limit value and the current steering state, it is determined whether or not the current steering state is a steering state within a preset range, and if it is determined that the steering state is outside the preset range, the steering assist torque Power steering control correction means for correcting
A vehicle behavior control apparatus comprising:
車両の運転状態に基づき求めるパラメータを第1のパラメータとして演算する第1のパラメータ演算手段と、
路面状態に基づき求めるパラメータをパラメータ制限値として演算するパラメータ制限値演算手段と、
上記第1のパラメータを上記パラメータ制限値で制限するパラメータ制限手段と、
上記パラメータ制限手段で制限処理した上記第1のパラメータに基づき、車輪に制動力を付加して車両にヨーモーメントを発生させる制動力制御手段と、
上記パラメータ制限値と現在の操舵状態に基づき現在の操舵状態が予め設定する領域範囲内の操舵状態か否か判断し、上記予め設定する領域範囲外の操舵状態と判断した場合に、操舵アシストトルクを補正するパワーステアリング制御補正手段と、
を備えたことを特徴とする車両の挙動制御装置。
First parameter calculation means for calculating a parameter to be obtained based on the driving state of the vehicle as a first parameter;
Parameter limit value calculating means for calculating a parameter to be calculated based on the road surface condition as a parameter limit value;
Parameter limiting means for limiting the first parameter with the parameter limit value;
Braking force control means for adding a braking force to the wheels to generate a yaw moment on the vehicle based on the first parameter restricted by the parameter restriction means;
Based on the parameter limit value and the current steering state, it is determined whether or not the current steering state is a steering state within a preset range, and if it is determined that the steering state is outside the preset range, the steering assist torque Power steering control correction means for correcting
A vehicle behavior control apparatus comprising:
上記パワーステアリング制御補正手段は、上記現在の操舵状態が上記予め設定する領域範囲外の操舵状態と判断した場合に、操舵アシストトルクを減少補正することを特徴とする請求項1又は請求項2記載の車両の挙動制御装置。   3. The power steering control correction unit according to claim 1, wherein the power steering control correction unit corrects the steering assist torque to be decreased when the current steering state is determined to be a steering state outside the preset range. Vehicle behavior control device.
JP2004368255A 2004-12-20 2004-12-20 Vehicle behavior control device Active JP4554348B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2004368255A JP4554348B2 (en) 2004-12-20 2004-12-20 Vehicle behavior control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2004368255A JP4554348B2 (en) 2004-12-20 2004-12-20 Vehicle behavior control device

Publications (2)

Publication Number Publication Date
JP2006175899A true JP2006175899A (en) 2006-07-06
JP4554348B2 JP4554348B2 (en) 2010-09-29

Family

ID=36730425

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2004368255A Active JP4554348B2 (en) 2004-12-20 2004-12-20 Vehicle behavior control device

Country Status (1)

Country Link
JP (1) JP4554348B2 (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100764180B1 (en) 2006-05-02 2007-10-05 주식회사 만도 Control apparatus for steering assist torque of automobile
JP2011219089A (en) * 2010-04-09 2011-11-04 Navteq North America Llc Method and system for vehicle esc system using map data
JP2011252760A (en) * 2010-06-01 2011-12-15 Honda Motor Co Ltd Yaw rate detection device
CN110329239A (en) * 2018-03-28 2019-10-15 马自达汽车株式会社 The control device of vehicle
CN110682916A (en) * 2018-07-05 2020-01-14 丰田自动车株式会社 Vehicle driving assistance device
CN113942494A (en) * 2021-10-28 2022-01-18 中汽创智科技有限公司 Vehicle steering control method and device and storage medium

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0939762A (en) * 1995-08-01 1997-02-10 Toyota Motor Corp Controller for behavior of vehicle
JP2002120711A (en) * 2000-10-11 2002-04-23 Fuji Heavy Ind Ltd Vehicle behavior control device
JP2004168154A (en) * 2002-11-19 2004-06-17 Fuji Heavy Ind Ltd Vehicle behavior control device

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0939762A (en) * 1995-08-01 1997-02-10 Toyota Motor Corp Controller for behavior of vehicle
JP2002120711A (en) * 2000-10-11 2002-04-23 Fuji Heavy Ind Ltd Vehicle behavior control device
JP2004168154A (en) * 2002-11-19 2004-06-17 Fuji Heavy Ind Ltd Vehicle behavior control device

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100764180B1 (en) 2006-05-02 2007-10-05 주식회사 만도 Control apparatus for steering assist torque of automobile
US10220856B2 (en) 2010-04-09 2019-03-05 Here Global B.V. Method and system for vehicle ESC system using map data
US9302659B2 (en) 2010-04-09 2016-04-05 Here Global B.V. Method and system for vehicle ESC system using map data
JP2016145035A (en) * 2010-04-09 2016-08-12 ヘレ グローバル ベスローテン フェンノートシャップHERE Global B.V. Method and system for vehicle esc system using map data
US9499166B2 (en) 2010-04-09 2016-11-22 Here Global B.V. Method and system for vehicle ESC system using map data
JP2011219089A (en) * 2010-04-09 2011-11-04 Navteq North America Llc Method and system for vehicle esc system using map data
US10543848B2 (en) 2010-04-09 2020-01-28 Here Global B.V. Method and system for vehicle ESC system using map data
US10899360B2 (en) 2010-04-09 2021-01-26 Here Global B.V. Method and system for vehicle ESC system using map data
JP2011252760A (en) * 2010-06-01 2011-12-15 Honda Motor Co Ltd Yaw rate detection device
CN110329239A (en) * 2018-03-28 2019-10-15 马自达汽车株式会社 The control device of vehicle
CN110329239B (en) * 2018-03-28 2022-07-19 马自达汽车株式会社 Vehicle control device
CN110682916A (en) * 2018-07-05 2020-01-14 丰田自动车株式会社 Vehicle driving assistance device
CN110682916B (en) * 2018-07-05 2022-08-09 丰田自动车株式会社 Vehicle driving assistance device
CN113942494A (en) * 2021-10-28 2022-01-18 中汽创智科技有限公司 Vehicle steering control method and device and storage medium

Also Published As

Publication number Publication date
JP4554348B2 (en) 2010-09-29

Similar Documents

Publication Publication Date Title
JP5407952B2 (en) Vehicle driving support device and vehicle driving support method
US8145385B2 (en) Vehicle driving control apparatus and vehicle driving control method
US9142131B2 (en) Vehicle driving support apparatus
US7392120B2 (en) Vehicle dynamics control apparatus
JP3823924B2 (en) Vehicle behavior control device
JP5088350B2 (en) Vehicle driving support device and vehicle driving support method
JP5375752B2 (en) Vehicle driving support device
JP6952014B2 (en) Vehicle control device, vehicle control method, and vehicle control system
JP3990623B2 (en) Vehicle behavior control device
JP2010030399A (en) Vehicle operation support device and vehicle operation support method
JP6381069B2 (en) Vehicle driving support control device
JP6986463B2 (en) Driving support device, driving support method and driving support system
JP6898636B2 (en) Vehicle travel control device
JP4554348B2 (en) Vehicle behavior control device
JP2020125058A (en) Vehicular turning-attitude control method and turning-attitude control apparatus
JP5309764B2 (en) Side obstacle avoidance device and side obstacle avoidance method
JP2007099166A (en) Vehicle behavior controller
JP6706166B2 (en) Vehicle running control device
JP5387204B2 (en) Vehicle driving support device and vehicle driving support method
JP4519819B2 (en) Vehicle motion control device
JP4052279B2 (en) Deceleration control device
JP2004210053A (en) Traveling control device for vehicle
JP5608069B2 (en) Integrated control device for vehicle
JP6077747B2 (en) VEHICLE SLALOM TRAVEL JUDGING DEVICE AND VEHICLE CONTROL DEVICE HAVING THIS VEHICLE SLALOM TRAVEL JUDGING DEVICE
JP2023151394A (en) Vehicle control method and vehicle control apparatus

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20071019

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20090707

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20090903

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20100216

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20100412

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: 20100629

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20100714

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130723

Year of fee payment: 3

R150 Certificate of patent or registration of utility model

Ref document number: 4554348

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

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

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

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250