JPH11240458A - Vehicle movement control unit - Google Patents

Vehicle movement control unit

Info

Publication number
JPH11240458A
JPH11240458A JP4390598A JP4390598A JPH11240458A JP H11240458 A JPH11240458 A JP H11240458A JP 4390598 A JP4390598 A JP 4390598A JP 4390598 A JP4390598 A JP 4390598A JP H11240458 A JPH11240458 A JP H11240458A
Authority
JP
Japan
Prior art keywords
yaw rate
vehicle
target yaw
steering
point
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
JP4390598A
Other languages
Japanese (ja)
Other versions
JP4094103B2 (en
Inventor
Koji Matsuno
浩二 松野
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 JP4390598A priority Critical patent/JP4094103B2/en
Publication of JPH11240458A publication Critical patent/JPH11240458A/en
Application granted granted Critical
Publication of JP4094103B2 publication Critical patent/JP4094103B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Abstract

PROBLEM TO BE SOLVED: To realize a stable vehicle behavior control where target yaw rate is adequately set during a steering to modify the vehicle behavior, making a driver to feel no uncomfortableness. SOLUTION: A control unit 50 calculates vehicle speed at a vehicle speed calculation part 51, and vehicle sliding angle at a vehicle sliding angle calculation part 52. A target yaw rate time constant setting part 53 sets a larger time constant as the vehicle sliding angle becomes larger and a spinning tendency becomes stronger, when a spinning tendency is indicated in which codes of the actual yaw rate and the vehicle sliding angle are different from each other and a steering for modification such as a counter steering which quickly changes the vehicle behavior is conducted. A target yaw rate calculation part 55 calculates deviation of the actual yaw rate from the target yaw rate. A braking control unit 56, a longitudinal differential control part 57, and a side differential control part 58 control each of driving units 40, 41, 42 so that the actual yaw rate and the target yaw rate are made identical.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、車両の操舵状態に
応じて適切な車両運動が行えるように制御する車両運動
制御装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a vehicle motion control device for controlling a vehicle to perform a proper vehicle motion in accordance with a steering state of the vehicle.

【0002】[0002]

【従来の技術】近年、車両の走行安定性等を向上させる
ために、操舵角を含む車両の運転状態と車両諸元に基づ
き所定の応答パラメータを有する車両の目標ヨーレート
を求め、この目標ヨーレートを基に車両の運動を制御す
る様々な車両の運動制御装置が開発・実用化されてい
る。
2. Description of the Related Art In recent years, in order to improve the running stability of a vehicle, a target yaw rate of a vehicle having a predetermined response parameter is determined based on a driving condition of the vehicle including a steering angle and vehicle specifications. Various vehicle motion control devices for controlling vehicle motion have been developed and put into practical use.

【0003】しかし、上記目標ヨーレートを操舵角の1
次あるいは2次遅れ系の応答パラメータで一律に演算し
設定すると、ドライバが車両のスピンを検知して、車両
の姿勢を修正するため、ハンドルを素早く戻すようなカ
ウンタステア等の修正操舵の際に、目標ヨーレートが急
速に変化しすぎて車両のヨー運動を必要以上に抑えよう
としてヨー運動制御が過剰に働いてしまうという問題が
ある。
However, when the target yaw rate is set to one of the steering angles,
When uniformly calculated and set using the response parameters of the second or second order delay system, the driver detects the spin of the vehicle and corrects the attitude of the vehicle. However, there is a problem that the target yaw rate changes too rapidly and the yaw motion control is excessively operated in an attempt to suppress the yaw motion of the vehicle more than necessary.

【0004】このため、例えば、特開平8−33297
1号公報で、カウンタステア時において、前半は目標ヨ
ーレートに基づき、後半は実ヨーレートに基づいてヨー
モーメントを発生させるように制御する技術が示されて
いる。
For this reason, for example, Japanese Patent Application Laid-Open No. 8-33297
Japanese Patent Laid-Open Publication No. 1 (1999) -2005 discloses a technique in which control is performed such that a yaw moment is generated based on a target yaw rate in the first half and an actual yaw rate in the second half during counter steering.

【0005】[0005]

【発明が解決しようとする課題】一般に、ドライバ(特
に熟練したドライバ)は、自車のヨーレートだけでな
く、その変化率(ヨー角加速度)をも検知し、あるいは
経験に基づいて、ハンドル操作に対するヨーレートの遅
れを見越した素早い修正操舵を加えることで自車の安定
を保っている。すなわち、このような修正操舵は、ドラ
イバは操舵する方向への進行を希望して行うのではな
く、操舵角を通じて自車を安定させるために必要なヨー
モーメントを与えるものである。
Generally, a driver (especially a skilled driver) detects not only the yaw rate of the own vehicle but also the rate of change (yaw angular acceleration), or based on experience, the driver responds to the steering operation. By adding quick correction steering in anticipation of a yaw rate delay, the vehicle's stability is maintained. In other words, such correction steering does not give the driver the desire to proceed in the steering direction, but gives the yaw moment necessary to stabilize the vehicle through the steering angle.

【0006】従って、このような修正操舵に基づいて目
標ヨーレートを設定して制御する制御則では、操舵角に
より目標ヨーレートが急速に変化しすぎて車両のヨー運
動を必要以上に抑えようとし、ヨー運動制御が過剰に働
いてしまうことになり、ドライバの目論む車両挙動が得
られなくなってしまう。この傾向は、制御系に遅れが大
きいものでは、すなわち、修正操舵を加えてから制御が
作動するまでに時間がかかるものでは一層強まることに
なる。
Accordingly, in the control law for setting and controlling the target yaw rate based on such correction steering, the target yaw rate changes rapidly too much due to the steering angle, so that the yaw motion of the vehicle is suppressed more than necessary. Excessive motion control is performed, and the vehicle behavior that the driver intends cannot be obtained. This tendency is further enhanced when the control system has a large delay, that is, when it takes a long time before the control is activated after the correction steering is applied.

【0007】このため、上記先行技術のように、修正操
舵の前半と後半を区別し、車両挙動の収束性を向上する
制御だけでは、車両挙動を適切に安定させるには不十分
であり、修正操舵の前半、後半の区別無く、修正操舵と
みなせる操舵に対しては目標ヨーレートの変更を少なく
する制御則が必要である。
[0007] Therefore, as in the prior art described above, the control for distinguishing the first half and the second half of the corrective steering and improving the convergence of the vehicle behavior alone is not enough to appropriately stabilize the vehicle behavior. For the steering that can be regarded as the correction steering without distinction between the first half and the second half of the steering, a control law for reducing the change in the target yaw rate is required.

【0008】本発明は上記事情に鑑みてなされたもの
で、車両挙動の修正操舵の際の目標ヨーレートの設定が
適切に行われ、ドライバにとって違和感のない安定した
車両挙動制御が実現できる車両運動制御装置を提供する
ことを目的としている。
The present invention has been made in view of the above circumstances, and a vehicle motion control capable of appropriately setting a target yaw rate at the time of corrective steering of vehicle behavior and realizing stable vehicle behavior control without a sense of incongruity for a driver. It is intended to provide a device.

【0009】[0009]

【課題を解決するための手段】上記目的を達成するため
請求項1記載の本発明による車両運動制御装置は、操舵
角を含む車両の運転状態と車両諸元に基づき車両の目標
とするヨーレートを演算し、この目標ヨーレートを基に
車両の駆動装置を動作して車両挙動を制御する車両運動
制御装置において、車両の挙動を修正する操舵に応じ、
上記目標ヨーレートを補正するものである。
According to a first aspect of the present invention, there is provided a vehicle motion control apparatus for controlling a vehicle based on a vehicle operating condition including a steering angle and vehicle specifications. Calculate, in a vehicle motion control device that controls the vehicle behavior by operating the vehicle drive device based on this target yaw rate, according to the steering to correct the behavior of the vehicle,
This is for correcting the target yaw rate.

【0010】上記請求項1記載の車両運動制御装置は、
操舵角を含む車両の運転状態と車両諸元に基づき車両の
目標とするヨーレートを演算する。ここで、この目標ヨ
ーレートは、車両の挙動を修正する操舵に応じ、補正さ
れて演算される。そして、上記目標ヨーレートを基に車
両の駆動装置を動作して車両挙動を制御する。
[0010] The vehicle motion control device according to claim 1 is
The target yaw rate of the vehicle is calculated based on the vehicle operating condition including the steering angle and the vehicle specifications. Here, the target yaw rate is corrected and calculated according to the steering for correcting the behavior of the vehicle. Then, the vehicle driving device is operated based on the target yaw rate to control the vehicle behavior.

【0011】また、請求項2記載の本発明による車両運
動制御装置は、請求項1記載の車両運動制御装置におい
て、上記操舵は、実際のヨーレートの方向と車体すべり
角の方向に応じて検出するもので、具体的には進行方向
に対して車体がヨーレートと同方向にすべり角をもって
走行しているとき車両の挙動を修正する操舵と判定す
る。
According to a second aspect of the present invention, there is provided a vehicle motion control apparatus according to the first aspect, wherein the steering is detected in accordance with an actual yaw rate direction and a body slip angle direction. Specifically, when the vehicle body is traveling with a slip angle in the same direction as the yaw rate with respect to the traveling direction, the steering is determined to correct the behavior of the vehicle.

【0012】さらに、請求項3記載の本発明による車両
運動制御装置は、請求項1又は請求項2記載の車両運動
制御装置において、上記目標ヨーレートの補正は、少な
くとも車体すべり角に応じて設定するもので、例えば、
上記車体すべり角が大きいほど、上記目標ヨーレートの
急激な変化を抑止する方向に補正する。
Further, according to a third aspect of the present invention, in the vehicle motion control apparatus according to the first or second aspect, the correction of the target yaw rate is set at least according to a vehicle body slip angle. And, for example,
The larger the vehicle body slip angle is, the more the correction is made in such a direction that the rapid change of the target yaw rate is suppressed.

【0013】また、請求項4記載の本発明による車両運
動制御装置は、請求項1又は請求項3記載の車両運動制
御装置において、上記目標ヨーレートの補正は、少なく
とも車速に応じて設定するもので、例えば、上記車速が
大きいほど、上記目標ヨーレートの急激な変化を抑止す
る方向に補正する。
According to a fourth aspect of the present invention, there is provided a vehicle motion control apparatus according to the first or third aspect, wherein the correction of the target yaw rate is set at least according to the vehicle speed. For example, as the vehicle speed increases, the correction is made in such a direction that a rapid change in the target yaw rate is suppressed.

【0014】さらに、請求項5記載の本発明による車両
運動制御装置は、請求項1記載の車両運動制御装置にお
いて、上記目標ヨーレートの補正は、上記操舵角を含む
車両の運転状態及び車両諸元に基づき演算した目標ヨー
レートと道路の曲率半径及び車速から求められる目標ヨ
ーレートとの偏差の絶対値の大きさと、操舵角速度の絶
対値の大きさとに応じて行うもので、例えば、上記車両
挙動から得られる目標ヨーレートと上記道路形状から得
られる上記目標ヨーレートとの差が小さいにもかかわら
ず、操舵角速度の絶対値が大きいほど、すなわち素早い
操舵が行われるほど、上記車両挙動から得られる目標ヨ
ーレートの急激な変化を抑止する方向に補正する。
According to a fifth aspect of the present invention, there is provided a vehicle motion control apparatus according to the first aspect, wherein the correction of the target yaw rate includes the operation state of the vehicle including the steering angle and the vehicle specifications. This is performed in accordance with the absolute value of the deviation between the target yaw rate calculated based on the target yaw rate and the target yaw rate obtained from the radius of curvature of the road and the vehicle speed, and the absolute value of the steering angular velocity. Despite the small difference between the target yaw rate obtained from the road shape and the target yaw rate obtained from the road shape, the larger the absolute value of the steering angular velocity, that is, the quicker the steering, the sharper the target yaw rate obtained from the vehicle behavior. Is corrected in such a direction as to suppress a significant change.

【0015】また、請求項6記載の本発明による車両運
動制御装置は、操舵角を含む車両の運転状態と車両諸元
に基づき車両の目標とするヨーレートを演算し、この目
標ヨーレートを基に車両の駆動装置を動作して車両挙動
を制御する車両運動制御装置において、上記目標ヨーレ
ートの演算に用いる上記操舵角の入力信号は、予め設定
しておいた修正操舵の信号成分を除去して演算に用いる
ものである。
According to a sixth aspect of the present invention, there is provided a vehicle motion control apparatus which calculates a target yaw rate of a vehicle based on a vehicle operating state including a steering angle and vehicle specifications, and calculates a vehicle yaw rate based on the target yaw rate. In the vehicle motion control device that controls the vehicle behavior by operating the drive device, the input signal of the steering angle used for the calculation of the target yaw rate is obtained by removing the signal component of the correction steering that is set in advance and performing the calculation. It is used.

【0016】上記請求項6記載の車両運動制御装置は、
操舵角の入力信号から、例えば、ローパスフィルタによ
り素早い操舵時の信号をカットすることにより、予め設
定しておいた修正操舵の信号成分を除去する。そして、
この操舵角を含む車両の運転状態と車両諸元に基づき車
両の目標とするヨーレートを演算し、この目標ヨーレー
トを基に車両の駆動装置を動作して車両挙動を制御す
る。
According to a sixth aspect of the present invention, there is provided a vehicle motion control device comprising:
For example, a signal component for a quick steering is removed from the input signal of the steering angle by cutting a signal at the time of quick steering by a low-pass filter, for example. And
The target yaw rate of the vehicle is calculated based on the driving state of the vehicle including the steering angle and the vehicle specifications, and the vehicle driving device is operated based on the target yaw rate to control the vehicle behavior.

【0017】さらに、請求項7記載の本発明による車両
運動制御装置は、請求項1,2,3,4,5,6のいず
れか一つに記載の車両運動制御装置において、上記車両
の駆動装置は、各選択した車輪に独立に制動力を付加す
る制動装置と左右輪間の差動を制限する左右輪間差動制
限装置と前後輪間の差動を制限する前後輪間差動制限装
置の少なくとも一つであり、上記目標ヨーレートを基に
して、上記制動装置で車両のオーバーステア傾向の挙動
を修正するには、旋回方向に対して外側の車輪あるいは
外側の前輪を制動させ、車両のアンダーステア傾向の挙
動を修正するには、旋回方向に対して内側の車輪あるい
は内側の後輪を制動させる。また、上記左右輪間差動制
限装置で車両のオーバーステア傾向の挙動を修正するに
は、左右輪間の差動制限を行って旋回方向に対して内側
の駆動力配分が大きくなるようにし、車両のアンダース
テア傾向の挙動を修正するには、左右輪間の差動制限を
行って旋回方向に対して外側の駆動力配分が大きくなる
ようにする。さらに、上記前後輪間差動制限装置で車両
のオーバーステア傾向の挙動を修正するには、前後輪間
の差動制限を行って前輪側の駆動力配分が大きくなるよ
うにし、車両のアンダーステア傾向の挙動を修正するに
は、前後輪間の差動制限を行って後輪側の駆動力配分が
大きくなるようにする。
Further, according to a seventh aspect of the present invention, there is provided a vehicle motion control apparatus according to any one of the first, second, third, fourth, fifth and sixth aspects. The device consists of a braking device that independently applies braking force to each selected wheel, a differential limiting device between left and right wheels that limits the differential between left and right wheels, and a differential limiting device between front and rear wheels that limits differential between front and rear wheels. At least one of the devices, based on the target yaw rate, in order to correct the oversteer tendency of the vehicle with the braking device, braking the outer wheel or the outer front wheel with respect to the turning direction, In order to correct the understeer tendency of the vehicle, the inner wheel or the inner rear wheel with respect to the turning direction is braked. Further, in order to correct the behavior of the vehicle oversteering tendency with the above-mentioned differential limiting device between the left and right wheels, differential limiting between the left and right wheels is performed so that the driving force distribution inward in the turning direction is increased, In order to correct the understeer tendency of the vehicle, the difference between the left and right wheels is limited so that the driving force distribution outside the turning direction is increased. Further, in order to correct the behavior of the vehicle oversteering tendency by the above-described front-rear wheel differential limiting device, the front-wheel side driving force distribution is increased by performing the differential limitation between the front and rear wheels, and the vehicle understeering tendency is increased. In order to correct this behavior, the differential between the front and rear wheels is limited so that the driving force distribution on the rear wheel side is increased.

【0018】[0018]

【発明の実施の形態】以下、図面に基づいて本発明の実
施の形態を説明する。図1〜図6は本発明の実施の第1
形態を示し、図1は車両運動制御装置の機能ブロック
図、図2は車両運動制御装置を搭載した車両の概略構成
を示す説明図、図3は車両運動制御のフローチャート、
図4は目標ヨーレート時定数演算・設定ルーチンのフロ
ーチャート、図5は制動、前後、左右差動制限制御ルー
チンのフローチャート、図6は設定される時定数の説明
図である。尚、本発明の実施の第1形態の車両は、複合
プラネタリギヤ式のセンターディファレンシャル装置お
よび自動変速装置を有する4輪駆動車を例に説明する。
Embodiments of the present invention will be described below with reference to the drawings. 1 to 6 show a first embodiment of the present invention.
FIG. 1 is a functional block diagram of a vehicle motion control device, FIG. 2 is an explanatory diagram showing a schematic configuration of a vehicle equipped with the vehicle motion control device, FIG. 3 is a flowchart of vehicle motion control,
4 is a flowchart of a target yaw rate time constant calculation / setting routine, FIG. 5 is a flowchart of a braking, front / rear, left / right differential limiting control routine, and FIG. 6 is an explanatory diagram of a time constant to be set. The vehicle according to the first embodiment of the present invention will be described by taking a four-wheel drive vehicle having a compound planetary gear type center differential and an automatic transmission as an example.

【0019】図2において、符号1は車両前部に配置さ
れたエンジンを示し、このエンジン1による駆動力は、
上記エンジン1後方の自動変速装置(トルクコンバータ
等も含んで図示)2からトランスミッション出力軸2a
を経てセンターディファレンシャル装置3に伝達され、
このセンターディファレンシャル装置3から、リヤドラ
イブ軸4、プロペラシャフト5、ドライブピニオン6を
介して後輪終減速装置7に入力される一方、トランスフ
ァドライブギヤ8、トランスファドリブンギヤ9、ドラ
イブピニオン軸部となっているフロントドライブ軸10
を介して前輪終減速装置11に入力されるように構成さ
れている。ここで、上記自動変速装置2、センターディ
ファレンシャル装置3および前輪終減速装置11等は、
一体にケース12内に設けられている。
In FIG. 2, reference numeral 1 denotes an engine arranged at the front of the vehicle.
An automatic transmission (including a torque converter and the like) 2 behind the engine 1 to a transmission output shaft 2a
Is transmitted to the center differential device 3 through
From this center differential device 3, the rear drive shaft 4, propeller shaft 5, and drive pinion 6 are input to the rear wheel final reduction gear 7, while the transfer drive gear 8, transfer driven gear 9, and drive pinion shaft are formed. Front drive shaft 10
Is input to the front-wheel final reduction gear 11 via the. Here, the automatic transmission 2, the center differential device 3, the front wheel final reduction gear 11, etc.
It is provided in the case 12 integrally.

【0020】上記後輪終減速装置7に入力された駆動力
は、後輪左ドライブ軸13rlを経て左後輪14rlに、後
輪右ドライブ軸13rrを経て右後輪14rrに伝達される
一方、上記前輪終減速装置11に入力された駆動力は、
前輪左ドライブ軸13flを経て左前輪14flに、前輪右
ドライブ軸13frを経て右前輪14frに伝達されるよう
になっている。
The driving force input to the rear wheel final reduction gear 7 is transmitted to the left rear wheel 14rl via the rear wheel left drive shaft 13rl and to the right rear wheel 14rr via the rear wheel right drive shaft 13rr. The driving force input to the front wheel final reduction gear 11 is
The signal is transmitted to the left front wheel 14fl via the front wheel left drive shaft 13fl and to the right front wheel 14fr via the front wheel right drive shaft 13fr.

【0021】上記センターディファレンシャル装置3
は、入力側の上記トランスミッション出力軸2aに大径
の第1のサンギヤ15が形成されており、この第1のサ
ンギヤ15が小径の第1のピニオン16と噛合して第1
の歯車列が形成されている。
The above-mentioned center differential device 3
Has a first sun gear 15 having a large diameter formed on the transmission output shaft 2a on the input side, and the first sun gear 15 meshes with a first pinion 16 having a small diameter to form a first sun gear.
Gear train is formed.

【0022】また、後輪への出力を行う上記リヤドライ
ブ軸4には、小径の第2のサンギヤ17が形成されてお
り、この第2のサンギヤ17が大径の第2のピニオン1
8と噛合して第2の歯車列が形成されている。
A small-diameter second sun gear 17 is formed on the rear drive shaft 4 for outputting power to the rear wheels. The second sun gear 17 is a large-diameter second pinion 1.
8 and a second gear train is formed.

【0023】上記第1のピニオン16と上記第2のピニ
オン18はピニオン部材19に一体に形成されており、
複数(例えば3個)の上記ピニオン部材19が、キャリ
ア20に設けた固定軸に回転自在に軸支されている。
The first pinion 16 and the second pinion 18 are formed integrally with a pinion member 19,
A plurality (for example, three) of the pinion members 19 are rotatably supported on a fixed shaft provided on the carrier 20.

【0024】上記キャリア20の前端には、上記トラン
スファドライブギヤ8が連結され、前輪への出力が行わ
れるようになっている。
The transfer drive gear 8 is connected to the front end of the carrier 20 so as to output to the front wheels.

【0025】また、上記キャリア20には、前方から上
記トランスミッション出力軸2aが回転自在に挿入され
る一方、後方からは上記リヤドライブ軸4が回転自在に
挿入されて、空間中央に上記第1のサンギヤ15と上記
第2のサンギヤ17を格納する。そして、上記複数のピ
ニオン部材19の上記各第1のピニオン16が上記第1
のサンギヤ15に、上記各第2のピニオン18が上記第
2のサンギヤ17に、共に噛合されている。
The transmission output shaft 2a is rotatably inserted into the carrier 20 from the front, and the rear drive shaft 4 is rotatably inserted from the rear. The sun gear 15 and the second sun gear 17 are stored. The first pinions 16 of the plurality of pinion members 19 correspond to the first pinions.
The second pinion 18 is meshed with the second sun gear 17.

【0026】こうして、入力側の上記第1のサンギヤ1
5に対し、上記第1,第2のピニオン16,18および
上記第2のサンギヤ17を介して一方の出力側に、上記
第1,第2のピニオン16,18の上記キャリア20を
介して他方の出力側に噛み合い構成され、リングギヤの
無い複合プラネタリギヤを成している。
Thus, the first sun gear 1 on the input side
5 through the first and second pinions 16 and 18 and the second sun gear 17 to one output side and the other through the carrier 20 of the first and second pinions 16 and 18. And a composite planetary gear without a ring gear.

【0027】そしてかかる複合プラネタリギヤ式センタ
ーディファレンシャル装置3は、上記第1,第2のサン
ギヤ15,17、および、これらサンギヤ15,17の
周囲に複数個配置される上記第1,第2のピニオン1
6,18の歯数を適切に設定することで差動機能を有す
る。
The compound planetary gear type center differential device 3 includes the first and second sun gears 15 and 17 and a plurality of the first and second pinions 1 arranged around the sun gears 15 and 17.
The differential function is provided by appropriately setting the number of teeth 6 and 18.

【0028】また、上記第1,第2のピニオン16,1
8と上記第1,第2のサンギヤ15,17との噛み合い
ピッチ半径を適切に設定することで、基準トルク配分を
所望の配分(例えば、後輪偏重にした不等トルク配分)
にすることができるようになっているのである。
Further, the first and second pinions 16, 1
By appropriately setting the meshing pitch radii between the gear 8 and the first and second sun gears 15 and 17, the reference torque distribution can be set to a desired distribution (for example, unequal torque distribution with rear wheel biased).
It is possible to be.

【0029】さらに、上記センターディファレンシャル
装置3は、上記第1,第2のサンギヤ15,17と上記
第1,第2のピニオン16,18とを例えばはすば歯車
にし、上記第1の歯車列と上記第2の歯車列のねじれ角
を異にしてスラスト荷重を相殺させることなくスラスト
荷重を残留させ上記ピニオン部材19の両端で発生する
摩擦トルクを、上記第1,第2のピニオン16,18と
上記キャリア20に設けた固定軸の表面に噛み合いによ
る分離、接線荷重の合成力が作用し、摩擦トルクが生じ
るように設定して、入力トルクに比例した差動制限トル
クを得られるようにすることで、このセンターディファ
レンシャル装置3自体によっても差動制限機能が得られ
るようになっている。
Further, in the center differential device 3, the first and second sun gears 15 and 17 and the first and second pinions 16 and 18 are, for example, helical gears, and the first gear train The friction torque generated at both ends of the pinion member 19 by remaining the thrust load without canceling the thrust load by changing the torsion angle of the second gear train and the first and second pinions 16, 18 And the surface of the fixed shaft provided on the carrier 20 is engaged so that the combined force of separation and tangential load acts on the surface to generate a friction torque so that a differential limiting torque proportional to the input torque can be obtained. Thus, the differential limiting function can be obtained by the center differential device 3 itself.

【0030】上記センターディファレンシャル装置3の
2つの出力部材、すなわち上記キャリア20と上記第2
のサンギヤ17との間には、前後差動制限クラッチ作動
部41により動作される可変容量伝達クラッチとしての
油圧多板クラッチ(前後差動制限クラッチ)21が形成
されている。
The two output members of the center differential device 3, namely, the carrier 20 and the second output member
A hydraulic multi-plate clutch (front-rear differential limiting clutch) 21 as a variable displacement transmission clutch operated by a front-rear differential limiting clutch operating section 41 is formed between the sun gear 17 and the sun gear 17.

【0031】上記前後差動制限クラッチ21は、上記第
2のサンギヤ17と一体のリヤドライブ軸4側に設けら
れた複数のドリブンプレート21aと、上記キャリア2
0側に設けられた複数のドライブプレート21bとが交
互に重ねられて構成されている。そして、上記前後差動
制限クラッチ21は、図示しないピストン,押圧プレー
ト等により、制御装置50で制御される前後差動制限ク
ラッチ作動部41により油圧室の油圧が可変押圧され動
作させられる。尚、この前後差動制限クラッチ作動部4
1は、モータ、オイルポンプ、複数の弁を有する油圧装
置で構成される(油圧関連部分については説明を省略す
る)。
The front / rear differential limiting clutch 21 includes a plurality of driven plates 21 a provided on the side of the rear drive shaft 4 integral with the second sun gear 17 and the carrier 2.
A plurality of drive plates 21b provided on the 0 side are alternately stacked. The front-rear differential limiting clutch 21 is operated by a hydraulic pressure in a hydraulic chamber being variably pressed by a front-rear differential limiting clutch operating unit 41 controlled by a control device 50 by a piston, a pressing plate, or the like (not shown). The front and rear differential limiting clutch operating section 4
Reference numeral 1 denotes a motor, an oil pump, and a hydraulic device having a plurality of valves (a description of a hydraulic-related portion is omitted).

【0032】このため、上記前後差動制限クラッチ21
が開放された状態では、上記センターディファレンシャ
ル装置3によるトルク配分がそのまま出力されるが、上
記前後差動制限クラッチ21が完全に圧着すると上記セ
ンターディファレンシャル装置3の差動が制限され、ト
ルク配分が停止され、前後直結状態となる。
For this reason, the front-rear differential limiting clutch 21
Is released, the torque distribution by the center differential device 3 is output as it is, but when the front and rear differential limiting clutch 21 is completely pressed, the differential of the center differential device 3 is limited and the torque distribution is stopped. Then, it is in a directly connected state.

【0033】上記前後差動制限クラッチ21の圧着力
(前後差動制限クラッチトルク)は、上記制御装置50
で制御され、例えば基準トルク配分が後輪偏重の、前後
35:65とすると、前後35:65から、前後差動制
限クラッチトルクを付加してトルク配分を前輪側に大き
く移動させ、前後直結状態で得られるトルク配分比、例
えば50:50の間でトルク配分制御(前後差動制限制
御)されるようになっている。
The pressing force of the front / rear differential limiting clutch 21 (front / rear differential limiting clutch torque) is controlled by the controller 50.
For example, if the reference torque distribution is 35:65 before and after the rear wheel is biased, the front and rear differential limiting clutch torque is added to move the torque distribution largely toward the front wheels from 35:65 before and after the front-rear direct connection state. , The torque distribution control (for example, the front-rear differential limiting control) is performed between 50:50.

【0034】また、上記後輪終減速装置7も、本発明の
実施の形態では、上述のセンターディファレンシャル装
置3と同様の複合プラネタリギヤ式で構成されている。
すなわち、回転自在に保持されたディファレンシャルケ
ース31の外周にはクラウンギヤ32が設けられ、上記
ドライブピニオン6による駆動力は、このクラウンギヤ
32を介して上記ディファレンシャルケース31に伝達
されるようになっている。
In the embodiment of the present invention, the rear wheel final reduction gear 7 is also of a compound planetary gear type similar to the center differential 3 described above.
That is, a crown gear 32 is provided on the outer periphery of the differential case 31 rotatably held, and the driving force of the drive pinion 6 is transmitted to the differential case 31 via the crown gear 32. I have.

【0035】上記ディファレンシャルケース31内に
は、左側部分がクラッチドラム33aとして円筒状に形
成されたキャリヤ34が回転自在に配設されており、こ
のキャリヤ34内に上記後輪右ドライブ軸13rrが挿通
されて上記キャリヤ34と結合されている。
In the differential case 31, a carrier 34 whose left portion is formed as a clutch drum 33a in a cylindrical shape is rotatably disposed, and the rear wheel right drive shaft 13rr is inserted into the carrier 34. And is connected to the carrier 34.

【0036】また、上記ディファレンシャルケース31
内には、上記ディファレンシャルケース31に結合され
た大径の第1のサンギヤ35が設けられ、小径の第1の
ピニオン36と噛合して第1の歯車列が形成されてい
る。
Further, the differential case 31
Inside, a large-diameter first sun gear 35 coupled to the differential case 31 is provided, and meshes with a small-diameter first pinion 36 to form a first gear train.

【0037】さらに、上記ディファレンシャルケース3
1内には、上記後輪左ドライブ軸13rlが挿通され、こ
の後輪左ドライブ軸13rlの先端には小径の第2のサン
ギヤ37が形成されており、この第2のサンギヤ37が
大径の第2のピニオン38と噛合して第2の歯車列が形
成されている。
Further, the differential case 3
1, a rear wheel left drive shaft 13rl is inserted therein, and a small-diameter second sun gear 37 is formed at the tip of the rear wheel left drive shaft 13rl, and the second sun gear 37 has a large diameter. The second gear train is formed by meshing with the second pinion 38.

【0038】上記第1のピニオン36と上記第2のピニ
オン38はピニオン部材39に一体に形成されており、
複数(例えば3個)の上記ピニオン部材39が、キャリ
ア34に設けた固定軸に回転自在に軸支されている。
The first pinion 36 and the second pinion 38 are formed integrally with a pinion member 39,
A plurality (for example, three) of the pinion members 39 are rotatably supported on a fixed shaft provided on the carrier 34.

【0039】また、上記後輪左ドライブ軸13rlの上記
キャリヤ34のクラッチドラム33aに対向する位置に
はクラッチハブ33bが設けられ、これらクラッチドラ
ム33a、クラッチハブ33bにそれぞれドライブプレ
ート、ドリブンプレートが複数交互に設けられて油圧多
板クラッチ(左右差動制限クラッチ)33が形成されて
いる。
A clutch hub 33b is provided on the rear wheel left drive shaft 13rl at a position facing the clutch drum 33a of the carrier 34. The clutch drum 33a and the clutch hub 33b each include a plurality of drive plates and driven plates. Hydraulic multi-plate clutches (left and right differential limiting clutches) 33 are alternately provided.

【0040】そして、上記左右差動制限クラッチ33
は、図示しないピストン,押圧プレート等により、制御
装置50で制御される左右差動制限クラッチ作動部42
により油圧室の油圧が可変押圧され動作させられる。
尚、この左右差動制限クラッチ作動部42は、モータ、
オイルポンプ、複数の弁を有する油圧装置で構成される
(油圧関連部分については説明を省略する)。
The left and right differential limiting clutch 33
Is a left and right differential limiting clutch operating portion 42 controlled by the control device 50 by a piston, a pressing plate, etc. (not shown).
The hydraulic pressure in the hydraulic chamber is variably pressed to operate.
The left and right differential limiting clutch operating section 42 includes a motor,
It is composed of an oil pump and a hydraulic device having a plurality of valves.

【0041】すなわち、上記後輪終減速装置7は、上記
ドライブピニオン6からの駆動力を、クラウンギヤ3
2、ディファレンシャルケース31を介して第1のサン
ギヤ35に伝達し、上記第2のサンギヤ37から上記後
輪左ドライブ軸13rlへ出力する一方、上記キャリヤ3
4から上記後輪右ドライブ軸13rrへ出力する複合プラ
ネタリ式の差動制限制御装置で構成するとともに、一方
の出力側である後輪左ドライブ軸13rlと他方の出力側
であるキャリヤ34との間に摩擦力が可変制御される上
記左右差動制限クラッチ33を介装させた構造となって
いる。
That is, the rear wheel final reduction gear 7 transmits the driving force from the drive pinion 6 to the crown gear 3.
2. The power is transmitted to the first sun gear 35 via the differential case 31 and is output from the second sun gear 37 to the rear left drive shaft 13rl, while the carrier 3
4 from the rear wheel right drive shaft 13rr to the rear wheel left drive shaft 13rl, which is one output side, and the carrier 34, which is the other output side. The left and right differential limiting clutch 33 whose frictional force is variably controlled is interposed.

【0042】そして、複合プラネタリ式の差動制限制御
装置部分で発生される入力トルクに比例した差動制限ト
ルクに加え、必要に応じて油圧多板クラッチが差動制限
トルクを加えて最適な差動制限トルクが発生されるよう
になっている。
Then, in addition to the differential limiting torque proportional to the input torque generated by the composite planetary differential limiting controller, if necessary, the hydraulic multi-plate clutch applies the differential limiting torque to optimize the differential limiting torque. A dynamic limiting torque is generated.

【0043】上記複合プラネタリ式の差動制限制御装置
の部分は、上記第1,第2のサンギヤ35,37および
これらサンギヤ35,37の周囲に複数個配置される上
記第1,第2のピニオン36,38の歯数を適切に設定
することで差動機能を有する。
The composite planetary differential limiting control unit includes the first and second sun gears 35 and 37, and the first and second pinions disposed in plurality around the sun gears 35 and 37. By properly setting the number of teeth of 36 and 38, a differential function is provided.

【0044】また、上記第1,第2のサンギヤ35,3
7と上記第1,第2のピニオン36,38との噛み合い
ピッチ円半径を適切に設定することで、基準トルク配分
が左右50:50の等トルク配分の機能を有する。
The first and second sun gears 35, 3
By setting the radius of the meshing pitch circle of the first pinion 36 and the first and second pinions 36 and 38 appropriately, the reference torque distribution has a function of equal torque distribution of 50:50 on the left and right.

【0045】さらに、上記第1,第2のサンギヤ35,
37と上記第1,第2のピニオン36,38とを例えば
はすば歯車にし、上記第1の歯車列と上記第2の歯車列
のねじれ角を異にしてスラスト荷重を相殺させることな
くスラスト荷重を残留させ上記ピニオン部材39の両端
で発生する摩擦トルクを、上記第1,第2のピニオン3
6,38と上記キャリア34に設けた固定軸の表面に噛
み合いによる分離、接線荷重の合成力が作用し、摩擦ト
ルクが生じるように設定して、入力トルクに比例した差
動制限トルクを得られるようにすることで、入力トルク
に比例した差動制限トルクを得られるようにすること
で、この差動制限装置自体によっても差動制限機能が得
られるようになっている。
Further, the first and second sun gears 35,
37 and the first and second pinions 36 and 38 are, for example, helical gears, and the first gear train and the second gear train have different torsion angles so that the thrust load is not canceled out. The friction torque generated at both ends of the pinion member 39 with the load remaining is reduced by the first and second pinion 3.
The surfaces of the fixed shafts provided on the carrier 34 and the fixed shafts 38 and 38 are separated by meshing, and the combined force of the tangential loads acts to generate a friction torque, so that a differential limiting torque proportional to the input torque can be obtained. By doing so, it is possible to obtain a differential limiting torque proportional to the input torque, so that the differential limiting function can be obtained by the differential limiting device itself.

【0046】このため、上記左右差動制限クラッチ作動
部42により上記左右差動制限クラッチ33が開放され
た状態では、基準トルク配分、すなわち左右50:50
の等トルク配分で滑らかに差動が行われる一方、上記左
右差動制限クラッチ33が連結されると、左右輪間の差
動が制限され、例えば、旋回中のオーバーステア傾向の
場合では内側の車輪のトルク配分が増加し、スリップが
防止されて安定した傾向の走行になる。
Therefore, when the left and right differential limiting clutch 33 is released by the left and right differential limiting clutch operating section 42, the reference torque distribution, that is, the left and right 50:50.
The differential between the left and right wheels is limited when the left and right differential limiting clutch 33 is engaged, and, for example, when the oversteer tends to occur during turning, the differential between the left and right wheels is limited. The torque distribution of the wheels is increased, and slipping is prevented, so that the running tends to be stable.

【0047】符号40は車両のブレーキ駆動部を示し、
このブレーキ駆動部40には、ドライバにより操作され
るブレーキペダル43と接続されたマスターシリンダ4
4が接続されており、ドライバが上記ブレーキペダル4
3を操作すると上記マスターシリンダ44により、上記
ブレーキ駆動部40を通じて、4輪14fl,14fr,1
4rl,14rrの各ホイールシリンダ(左前輪ホイールシ
リンダ45fl,右前輪ホイールシリンダ45fr,左後輪
ホイールシリンダ45rl,右後輪ホイールシリンダ45
rr)にブレーキ圧が導入され、これにより4輪にブレー
キがかかって制動されるように構成されている。
Reference numeral 40 denotes a brake drive unit of the vehicle.
The brake drive unit 40 includes a master cylinder 4 connected to a brake pedal 43 operated by a driver.
4 is connected and the driver operates the brake pedal 4
When the third wheel 3 is operated, the four wheels 14fl, 14fr, 1
4rl, 14rr wheel cylinders (left front wheel cylinder 45fl, right front wheel cylinder 45fr, left rear wheel cylinder 45rl, right rear wheel cylinder 45
A brake pressure is introduced to rr), whereby the four wheels are braked and braked.

【0048】上記ブレーキ駆動部40は、加圧源、減圧
弁、増圧弁等を備えたハイドロリックユニットで、入力
信号に応じて、上記各ホイールシリンダ45fl,45f
r,45rl,45rrに対して、それぞれ独立にブレーキ
圧を導入自在に形成されている。
The brake drive unit 40 is a hydraulic unit having a pressurizing source, a pressure reducing valve, a pressure increasing valve, and the like. Each of the wheel cylinders 45fl and 45f is operated in accordance with an input signal.
The brake pressure is formed independently for each of r, 45rl, and 45rr.

【0049】上記各車輪14fl,14fr,14rl,14
rrは、それぞれの車輪速度が車輪速度センサ46(左前
輪速度センサ46fl,右前輪速度センサ46fr,左後輪
速度センサ46rl,右後輪速度センサ46rr)により検
出されるようになっており、これら車輪速度の信号は、
上記制御装置50に入力されるようになっている。
Each of the wheels 14fl, 14fr, 14rl, 14
rr is such that each wheel speed is detected by a wheel speed sensor 46 (left front wheel speed sensor 46fl, right front wheel speed sensor 46fr, left rear wheel speed sensor 46rl, right rear wheel speed sensor 46rr). The wheel speed signal is
The data is input to the control device 50.

【0050】さらに、車両1にはハンドル角センサ4
7、ヨーレートセンサ48、横加速度センサ49が設け
られており、これら各センサからのハンドル角θH、実
際のヨーレートγ、横加速度Gyの信号は上記制御装置
50に入力されるようになっている。
Further, the vehicle 1 has a steering wheel angle sensor 4
7, a yaw rate sensor 48, and a lateral acceleration sensor 49 are provided. Signals of the steering wheel angle θH, the actual yaw rate γ, and the lateral acceleration Gy from these sensors are input to the control device 50.

【0051】上記制御装置30は、マイクロコンピュー
タとその周辺回路で形成された制御装置で、上述の如
く、上記4輪の車輪速センサ46,ハンドル角センサ4
7,ヨーレートセンサ48および上記横加速度センサ4
9からの各信号が入力され、必要に応じて駆動装置とし
ての上記ブレーキ駆動部40,前後差動制限クラッチ作
動部41,左右差動制限クラッチ作動部42に対して駆
動信号を出力する。
The control device 30 is a control device formed by a microcomputer and its peripheral circuits. As described above, the wheel speed sensors 46 and the steering wheel angle sensors 4 of the four wheels are used.
7, yaw rate sensor 48 and lateral acceleration sensor 4
9 and outputs drive signals to the brake drive unit 40, the front and rear differential limiting clutch operating unit 41, and the left and right differential limiting clutch operating unit 42 as a driving device as necessary.

【0052】上記制御装置50は、図1に示すように、
車速演算部51,車体すべり角演算部52,目標ヨーレ
ート時定数設定部53,目標ヨーレート演算部54,ヨ
ーレート偏差演算部55,制動制御部56,前後差動制
限制御部57および左右差動制限制御部58から主要に
構成されている。
As shown in FIG. 1, the control device 50
Vehicle speed calculation unit 51, vehicle body slip angle calculation unit 52, target yaw rate time constant setting unit 53, target yaw rate calculation unit 54, yaw rate deviation calculation unit 55, braking control unit 56, front and rear differential limit control unit 57, and left and right differential limit control It is mainly composed of a part 58.

【0053】上記車速演算部51は、上記4輪の車輪速
センサ46から各車輪速度の信号が入力され、これらの
信号を予め設定しておいた数式で演算して(例えば、各
車輪速度の平均を算出して)車速Vを求め、上記車体す
べり角演算部52,目標ヨーレート時定数設定部53,
目標ヨーレート演算部54に出力するように形成されて
いる。
The vehicle speed calculating section 51 receives the signals of the respective wheel speeds from the wheel speed sensors 46 of the four wheels, and calculates these signals by a preset mathematical expression (for example, the respective wheel speeds). The vehicle speed V is obtained by calculating the average), the vehicle body slip angle calculating section 52, the target yaw rate time constant setting section 53,
It is formed so as to output to the target yaw rate calculation unit 54.

【0054】上記車体すべり角演算部52は、上記ヨー
レートセンサ48,横加速度センサ49と上記車速演算
部51からの信号(実ヨーレートγ,横加速度Gy,車
速V)を基に以下の(1)式により車体すべり角βを演
算するようになっている。
The vehicle body slip angle calculating section 52 calculates the following (1) based on signals (actual yaw rate γ, lateral acceleration Gy, vehicle speed V) from the yaw rate sensor 48, the lateral acceleration sensor 49 and the vehicle speed calculating section 51. The vehicle slip angle β is calculated by the equation.

【0055】ここで、関数f(t) のtによる積分を、IN
T{f(t)}dtで表わすと、 β=INT{Gy/V−γ}dt …(1) 尚、車体すべり角βは、上記(1)式を基に算出するも
のに限ることなく、例えば直接車体すべり角βを検出可
能な車体すべり角センサ等を用いて検出するようにして
もよい。この車体すべり角演算部52で推定された車体
すべり角βは上記目標ヨーレート時定数設定部53に入
力されるようになっている。
Here, the integral of the function f (t) with t is expressed as IN
When represented by T {f (t)} dt, β = INT {Gy / V−γ} dt (1) Note that the body slip angle β is not limited to that calculated based on the above equation (1). For example, the detection may be performed using a vehicle slip angle sensor or the like that can directly detect the vehicle slip angle β. The vehicle slip angle β estimated by the vehicle slip angle calculation section 52 is input to the target yaw rate time constant setting section 53.

【0056】上記目標ヨーレート時定数設定部53は、
上記ヨーレートセンサ48と、上記車速演算部51,車
体すべり角演算部52からの信号(実ヨーレートγ,車
速V,車体すべり角β)が入力され、目標ヨーレートを
1次遅れで近似し表現する際の応答パラメータとしての
目標ヨーレート時定数Tを演算し、上記目標ヨーレート
演算部54に設定するようになっている。
The target yaw rate time constant setting unit 53
Signals (actual yaw rate γ, vehicle speed V, body slip angle β) from the yaw rate sensor 48, the vehicle speed calculator 51, and the body slip angle calculator 52 are input to approximate and represent the target yaw rate with a first-order delay. The target yaw rate time constant T is calculated as a response parameter of the target yaw rate, and is set in the target yaw rate calculator 54.

【0057】すなわち、目標ヨーレート時定数Tを実ヨ
ーレートγ,車速Vおよび車体すべり角βの関数として
以下のように演算する。目標ヨーレート時定数Tは、 T=K1・V …(2)
That is, the target yaw rate time constant T is calculated as a function of the actual yaw rate γ, the vehicle speed V and the vehicle body slip angle β as follows. The target yaw rate time constant T is as follows: T = K1 · V (2)

【0058】上記K1は、以下の(3)式で設定する。 K1=K2+K3・β' …(3) ここで、K2,K3は予め設定する定数、β' は下記の
条件により設定する車体すべり角設定値である。 β' =−β(γ>0、かつ、β<0) β' =β(γ<0、かつ、β>0) β' =0(上記以外の条件) 尚、車両の左旋回方向の符号を+、車両の右旋回方向の
符号を−とする。
The above K1 is set by the following equation (3). K1 = K2 + K3 · β ′ (3) where K2 and K3 are preset constants, and β ′ is a vehicle slip angle set value set under the following conditions. β ′ = − β (γ> 0 and β <0) β ′ = β (γ <0 and β> 0) β ′ = 0 (conditions other than the above) The sign of the left turning direction of the vehicle Is +, and the sign of the right turning direction of the vehicle is-.

【0059】このため、上記目標ヨーレート時定数設定
部53で設定される目標ヨーレート時定数Tは、図6に
示すように、実ヨーレートγと車体すべり角βの符号が
互いに異なるとき、すなわち、車両の挙動を素早く変更
するカウンタステア等の修正操舵を行うスピン傾向を示
すとき、車体すべり角βが大きくスピン傾向が強いほ
ど、上記(2)式中のK1が大きくなり、大きな値に設
定される。ここでスピン傾向ではない場合は、上記
(2)式中のK1=K2で一定の値となり、車速Vに応
じて変化する通常の目標ヨーレート時定数Tの値とな
る。
Therefore, the target yaw rate time constant T set by the target yaw rate time constant setting section 53 is, as shown in FIG. 6, when the sign of the actual yaw rate γ and the sign of the vehicle body slip angle β are different from each other, K1 in the above equation (2) increases as the vehicle body slip angle β increases and the spin tendency increases, indicating a spin tendency in which corrective steering such as countersteering or the like that quickly changes the behavior of the vehicle is performed. . In the case where the tendency is not the spin tendency, the value becomes a constant value when K1 = K2 in the above equation (2), and becomes the value of the normal target yaw rate time constant T that changes according to the vehicle speed V.

【0060】上記目標ヨーレート演算部54は、上記ハ
ンドル角センサ47と、上記車速演算部51,目標ヨー
レート時定数設定部53からの信号(ハンドル角θH,
車速V,目標ヨーレート時定数T)が入力され、目標ヨ
ーレートγ' を演算し、上記ヨーレート偏差演算部55
に出力するように形成されている。
The target yaw rate calculating section 54 receives signals from the steering wheel angle sensor 47, the vehicle speed calculating section 51, and the target yaw rate time constant setting section 53 (the steering wheel angle θH,
The vehicle speed V and the target yaw rate time constant T) are input, and the target yaw rate γ 'is calculated.
Output.

【0061】この目標ヨーレート演算部54では、定常
的な目標ヨーレートの値を目標ヨーレート定常値として
求め、この目標ヨーレート定常値γ'0に対して上記目標
ヨーレート時定数Tで1次遅れ処理することにより目標
ヨーレートγ' を演算する。
The target yaw rate calculating section 54 obtains a steady-state target yaw rate value as a target yaw rate steady-state value, and performs a first-order lag process on the target yaw rate steady-state value γ'0 by the target yaw rate time constant T. To calculate the target yaw rate γ ′.

【0062】すなわち、ラプラス演算子をsとして、 γ' =(1/(1+T・s))・γ'0 …(4) γ'0=(1/(1+A・V2 ))・(V/(L・n))・θH …(5) ここで、Aはスタビリティファクタ、Lはホイールベー
ス、nはステアリングギヤ比である。
That is, assuming that the Laplace operator is s, γ ′ = (1 / (1 + T · s)) · γ′0 (4) γ′0 = (1 / (1 + A · V 2 )) · (V / (L · n)) · θH (5) where A is a stability factor, L is a wheel base, and n is a steering gear ratio.

【0063】上記(4)式からも解るように、上記目標
ヨーレート時定数Tが大きくなると、目標ヨーレート
γ' の変化が小さくなる。すなわち、目標ヨーレート
γ' の値の操舵に対する追従性が低下させられる。従っ
て、上記目標ヨーレート時定数設定部53では、車両が
スピン傾向を示すとき、スピン傾向が強いほど、上記目
標ヨーレート時定数Tが大きな値に設定されるため、こ
の目標ヨーレート演算部54で目標ヨーレートγ' の変
化が小さく設定されることになる。車両の挙動を素早く
変更するカウンタステア等の修正操舵を行うスピン傾向
の際に、このスピン傾向に応じて、目標ヨーレートγ'
の変化が小さく補正されることになるのである。
As can be seen from the above equation (4), when the target yaw rate time constant T increases, the change in the target yaw rate γ ′ decreases. That is, the followability of the value of the target yaw rate γ 'to steering is reduced. Accordingly, the target yaw rate time constant setting unit 53 sets the target yaw rate time constant T to a larger value when the vehicle shows a spin tendency, as the spin tendency becomes stronger. The change in γ ′ is set to be small. In the case of a spin tendency in which a corrective steering such as a counter steer for quickly changing the behavior of the vehicle is performed, the target yaw rate γ ′ is determined according to the spin tendency.
Is corrected to be small.

【0064】上記ヨーレート偏差演算部55は、上記ヨ
ーレートセンサ48から実ヨーレートγが、上記目標ヨ
ーレート演算部54から目標ヨーレートγ' が入力さ
れ、これら実ヨーレートγと目標ヨーレートγ' の偏差
Δγ(=γ−γ' )を演算して上記制動制御部56,前
後差動制限制御部57,左右差動制限制御部58に出力
するようになっている。
The yaw rate deviation calculating section 55 receives the actual yaw rate γ from the yaw rate sensor 48 and the target yaw rate γ ′ from the target yaw rate calculating section 54, and calculates a deviation Δγ (= γ) between the actual yaw rate γ and the target yaw rate γ ′. .gamma .-. gamma. ') is calculated and output to the braking control unit 56, the front and rear differential restriction control unit 57, and the left and right differential restriction control unit 58.

【0065】上記制動制御部56では、上記ヨーレート
センサ48から実ヨーレートγが、上記ヨーレート偏差
演算部55からヨーレート偏差Δγが入力され、車両を
どの方向にどれだけの量で制動制御すればヨーレート偏
差Δγを0に、すなわち、実ヨーレートγと目標ヨーレ
ートγ' とを一致させることができるのかを演算し、こ
の演算した結果を上記ブレーキ駆動部40に出力し制御
するようになっている。具体的には、以下のように制御
する。
The braking control unit 56 receives the actual yaw rate γ from the yaw rate sensor 48 and the yaw rate deviation Δγ from the yaw rate deviation calculating unit 55. Δγ is set to 0, that is, whether the actual yaw rate γ and the target yaw rate γ ′ can be matched, and the calculated result is output to the brake drive unit 40 for control. Specifically, control is performed as follows.

【0066】・実ヨーレートγとヨーレート偏差Δγが
同符号の場合…車両がオーバーステア傾向のとき…旋回
方向に対して外側の車輪あるいは外側の前輪を制動 ・実ヨーレートγとヨーレート偏差Δγが異符号の場合
…車両がアンダーステア傾向のとき…旋回方向に対して
内側の車輪あるいは内側の後輪を制動 尚、加える制動力は、車両諸元を考慮して車両の運動状
態とヨーレート偏差とを基に予め設定しておいた算出
式、マップにより定める。
When the actual yaw rate γ and the yaw rate deviation Δγ have the same sign: when the vehicle is over-steering, braking the outer wheels or the outer front wheels with respect to the turning direction. The actual yaw rate γ and the yaw rate deviation Δγ have different signs. When the vehicle tends to understeer: Braking the inner wheel or the inner rear wheel with respect to the turning direction The braking force to be applied is based on the motion state of the vehicle and the yaw rate deviation in consideration of the vehicle specifications. It is determined by a calculation formula and a map set in advance.

【0067】上記前後差動制限制御部57は、上記ヨー
レートセンサ48から実ヨーレートγが、上記ヨーレー
ト偏差演算部55からヨーレート偏差Δγが入力され、
車両をどの方向にどれだけの量で前後差動制限制御すれ
ばヨーレート偏差Δγを0に、すなわち、実ヨーレート
γと目標ヨーレートγ' とを一致させることができるの
かを演算し、この演算した結果を上記前後差動制限クラ
ッチ作動部41に出力し制御するようになっている。具
体的には、以下のように制御する。
The front / rear differential limiting control unit 57 receives the actual yaw rate γ from the yaw rate sensor 48 and the yaw rate deviation Δγ from the yaw rate deviation calculating unit 55,
It is calculated whether the yaw rate deviation Δγ can be set to 0, that is, the actual yaw rate γ and the target yaw rate γ ′ can be made equal by controlling the front and rear differential limiting in what direction and by what amount of the vehicle. Is output to the front-rear differential limiting clutch operating section 41 to be controlled. Specifically, control is performed as follows.

【0068】・実ヨーレートγとヨーレート偏差Δγが
同符号の場合…車両がオーバーステア傾向のとき…前輪
側の駆動力配分が大きくなるように前後差動制限クラッ
チトルクを付加 ・実ヨーレートγとヨーレート偏差Δγが異符号の場合
…車両がアンダーステア傾向のとき…後輪側の駆動力配
分が大きくなるように前後差動制限クラッチトルクを解
除 尚、前後差動制限クラッチトルクの値は、車両諸元を考
慮して車両の運動状態とヨーレート偏差とを基に予め設
定しておいた算出式、マップにより定める。
When the actual yaw rate γ and the yaw rate deviation Δγ have the same sign: when the vehicle is over-steering, a front-rear differential limiting clutch torque is added so that the driving force distribution on the front wheels is increased. When the deviation Δγ has a different sign: when the vehicle is understeer; when the front-rear differential limiting clutch torque is released so that the driving force distribution on the rear wheel side is increased. Is determined by a calculation formula and a map which are set in advance based on the motion state of the vehicle and the yaw rate deviation.

【0069】上記左右差動制限制御部58は、上記ヨー
レートセンサ48から実ヨーレートγが、上記ヨーレー
ト偏差演算部55からヨーレート偏差Δγが入力され、
車両をどの方向にどれだけの量で左右差動制限制御すれ
ばヨーレート偏差Δγを0に、すなわち、実ヨーレート
γと目標ヨーレートγ' とを一致させることができるの
かを演算し、この演算した結果を上記左右差動制限クラ
ッチ作動部42に出力し制御するようになっている。具
体的には、以下のように制御する。
The left / right differential limiting control unit 58 receives the actual yaw rate γ from the yaw rate sensor 48 and the yaw rate deviation Δγ from the yaw rate deviation calculating unit 55,
It is calculated whether the yaw rate deviation Δγ can be set to 0, that is, the actual yaw rate γ and the target yaw rate γ 'can be made equal by controlling the vehicle in which direction and by what amount of left and right differential limiting control. Is output to the left and right differential limiting clutch operating section 42 for control. Specifically, control is performed as follows.

【0070】・実ヨーレートγとヨーレート偏差Δγが
同符号の場合…車両がオーバーステア傾向のとき…旋回
方向に対して内側の駆動力配分が大きくなるように左右
差動制限クラッチトルクを付加 ・実ヨーレートγとヨーレート偏差Δγが異符号の場合
…車両がアンダーステア傾向のとき…旋回方向に対して
外側の駆動力配分が大きくなるように左右差動制限クラ
ッチトルクを解除 尚、左右差動制限クラッチトルクの値は、車両諸元を考
慮して車両の運動状態とヨーレート偏差とを基に予め設
定しておいた算出式、マップにより定める。
When the actual yaw rate γ and the yaw rate deviation Δγ have the same sign: when the vehicle is over-steering, a left and right differential limiting clutch torque is added so that the driving force distribution inside the turning direction becomes large. When the yaw rate γ and the yaw rate deviation Δγ have different signs: when the vehicle is understeer, the left and right differential limiting clutch torque is released so that the driving force distribution outside the turning direction is increased. Is determined by a calculation formula and a map which are set in advance based on the vehicle motion state and the yaw rate deviation in consideration of the vehicle specifications.

【0071】次に、上記構成の作用について、図3〜図
5のフローチャートで説明する。図4は車両運動制御の
フローチャートで、まず、ステップ(以下「S」と略
称)101で各センサ値を読み込み、S102に進み、
車速演算部51で車速V、車体すべり角演算部52で前
記(1)式により車体すべり角βを演算する。
Next, the operation of the above configuration will be described with reference to the flowcharts of FIGS. FIG. 4 is a flowchart of the vehicle motion control. First, each sensor value is read in step (hereinafter abbreviated as “S”) 101, and the process proceeds to S102.
The vehicle speed calculation unit 51 calculates the vehicle speed V, and the vehicle body slip angle calculation unit 52 calculates the vehicle body slip angle β according to the above equation (1).

【0072】次いで、S103に進み、目標ヨーレート
時定数設定部53で目標ヨーレート時定数Tを実ヨーレ
ートγ,車速Vおよび車体すべり角βの関数として、後
述する目標ヨーレート時定数T演算・設定ルーチンに従
って演算する。
Next, the routine proceeds to S103, where the target yaw rate time constant setting section 53 sets the target yaw rate time constant T as a function of the actual yaw rate γ, the vehicle speed V and the vehicle body slip angle β in accordance with a target yaw rate time constant T calculation / setting routine to be described later. Calculate.

【0073】その後、S104に進み、目標ヨーレート
演算部54で前記(4)式により目標ヨーレートγ' を
演算し、S105に進んで、ヨーレート偏差演算部55
で実ヨーレートγと目標ヨーレートγ' とからヨーレー
ト偏差Δγ(=γ−γ' )を演算する。
Thereafter, the program proceeds to S104, in which the target yaw rate calculating section 54 calculates the target yaw rate γ 'according to the equation (4).
Calculates the yaw rate deviation Δγ (= γ−γ ′) from the actual yaw rate γ and the target yaw rate γ ′.

【0074】そして、S106に進み、後述する制動、
前後、左右差動制限制御ルーチンに従って制動制御、前
後差動制限制御、左右差動制限制御を行う。
Then, the program proceeds to S106 in which braking, which will be described later,
The braking control, the front-rear differential restriction control, and the left-right differential restriction control are performed according to the front-rear, left-right differential restriction control routine.

【0075】図4は上記S103の目標ヨーレート時定
数T演算・設定ルーチンのフローチャートで、まず、S
201で実ヨーレートγが正の符号(γ>0)で、か
つ、車体すべり角βが負の符号(β<0)か否か判定
し、この条件(γ>0、かつ、β<0)以外の場合はS
202へ進んで、実ヨーレートγが負の符号(γ<0)
で、かつ、車体すべり角βが正の符号(β>0)か否か
判定する。
FIG. 4 is a flowchart of the routine for calculating and setting the target yaw rate time constant T in S103.
At 201, it is determined whether or not the actual yaw rate γ has a positive sign (γ> 0) and the vehicle body slip angle β has a negative sign (β <0), and this condition (γ> 0 and β <0) Otherwise, S
Proceeding to 202, the actual yaw rate γ is negative (γ <0)
It is determined whether the vehicle slip angle β is a positive sign (β> 0).

【0076】そして、上記S201の条件(γ>0、か
つ、β<0)のときはS203へ進んで車体すべり角設
定値β' をβ' =−βとし、上記S202の条件(γ<
0、かつ、β>0)のときはS204へ進んで車体すべ
り角設定値β' をβ' =βとし、上記S202の条件
(γ<0、かつ、β>0)以外のとき(実ヨーレートγ
と車体すべり角βが異符号以外のとき)はS205へ進
んで車体すべり角設定値β' をβ' =0とする。
If the condition of S201 (γ> 0 and β <0) is satisfied, the routine proceeds to S203, where the vehicle slip angle set value β ′ is set to β ′ = − β, and the condition of S202 (γ <0)
If 0 and β> 0, the routine proceeds to S204, in which the vehicle body slip angle set value β ′ is set to β ′ = β, and when the condition other than the condition of S202 (γ <0 and β> 0) is satisfied (actual yaw rate). γ
(When the vehicle slip angle β is other than the opposite sign), the routine proceeds to S205, where the vehicle slip angle set value β ′ is set to β ′ = 0.

【0077】その後、S206に進み、上記S203,
S204,S205で設定した車体すべり角設定値β'
を基に前記(2)式により目標ヨーレート時定数Tを演
算する。
Thereafter, the flow advances to S206, where S203 and S203 are executed.
The vehicle slip angle set value β ′ set in S204 and S205
, The target yaw rate time constant T is calculated by the equation (2).

【0078】このため、目標ヨーレート時定数Tは、実
ヨーレートγと車体すべり角βの符号が互いに異なると
き、すなわち、車両の挙動を素早く変更するカウンタス
テア等の修正操舵を行うスピン傾向を示すとき、車体す
べり角βが大きくスピン傾向が強いほど大きな値に設定
され、ここでスピン傾向以外の場合は、車速Vに応じて
変化する通常の目標ヨーレート時定数Tの値に演算・設
定される。
Therefore, the target yaw rate time constant T is calculated when the sign of the actual yaw rate γ and the sign of the vehicle body slip angle β are different from each other, ie, when the target yaw rate indicates a spin tendency for performing corrective steering such as counter steer for quickly changing the behavior of the vehicle. The larger the vehicle slip angle β and the stronger the spin tendency, the larger the value is set. In cases other than the spin tendency, the value is calculated and set to the value of the normal target yaw rate time constant T that changes according to the vehicle speed V.

【0079】また、図5は上記S106の制動、前後・
左右差動制限制御のフローチャートで、まず、S301
で制動力,前後差動制限クラッチトルクの値,左右差動
制限クラッチトルクの値を、それぞれ車両諸元を考慮し
て車両の運動状態とヨーレート偏差とを基に予め設定し
ておいた算出式、マップにより定め、S302に進む。
FIG. 5 shows the braking, front / rear,
In the flowchart of the left / right differential limiting control, first, at S301
The calculation formulas in which the braking force, the value of the front and rear differential limiting clutch torque, and the value of the left and right differential limiting clutch torque are set in advance based on the vehicle motion state and the yaw rate deviation in consideration of the vehicle specifications. , And the process proceeds to S302.

【0080】上記S302では、実ヨーレートγとヨー
レート偏差Δγの符号を比較する。そして、符号が互い
に同符号ならば、車両はオーバーステア傾向のときであ
り、S303へと進み、制動制御部56は旋回方向に対
して外側の車輪あるいは外側の前輪を制動させるように
ブレーキ駆動部40に出力し、前後差動制限制御部57
は前輪側の駆動力配分が大きくなるように前後差動制限
クラッチトルクを付加するように前後差動制限クラッチ
作動部41に出力し、左右差動制限制御部58は旋回方
向に対して内側の駆動力配分が大きくなるように左右差
動制限クラッチトルクを付加するように左右差動制限ク
ラッチ作動部42に出力する。
In S302, the sign of the actual yaw rate γ is compared with the sign of the yaw rate deviation Δγ. If the signs are the same, the vehicle is in an oversteer tendency, and the process proceeds to S303, where the brake control unit 56 causes the brake driving unit to brake the outer wheel or the outer front wheel in the turning direction. 40, and the front-rear differential limiting control unit 57
Output to the front / rear differential limiting clutch operating section 41 so as to add the front / rear differential limiting clutch torque so that the driving force distribution on the front wheels increases, and the left / right differential limiting control section 58 The right and left differential limiting clutch torque is applied to the left and right differential limiting clutch operating section 42 so as to add the left and right differential limiting clutch torque so as to increase the driving force distribution.

【0081】一方、符号が互いに異符号ならば、車両は
アンダーステア傾向のときであり、S304へと進み、
上記制動制御部56は旋回方向に対して内側の車輪ある
いは内側の後輪を制動させるようにブレーキ駆動部40
に出力し、前後差動制限制御部57は後輪側の駆動力配
分が大きくなるように前後差動制限クラッチトルクを解
除するように前後差動制限クラッチ作動部41に出力
し、左右差動制限制御部58は旋回方向に対して外側の
駆動力配分が大きくなるように左右差動制限クラッチト
ルクを解除するように左右差動制限クラッチ作動部42
に出力する。
On the other hand, if the signs are different signs from each other, it means that the vehicle has an understeer tendency, and the process proceeds to S304.
The brake control unit 56 controls the brake driving unit 40 to brake the inner wheel or the inner rear wheel in the turning direction.
The front-rear differential limiting control unit 57 outputs to the front-rear differential limiting clutch operating unit 41 so as to release the front-rear differential limiting clutch torque so as to increase the driving force distribution on the rear wheel side. The restriction control unit 58 controls the left and right differential limiting clutch operating unit 42 to release the left and right differential limiting clutch torque so as to increase the distribution of the driving force on the outside in the turning direction.
Output to

【0082】このように、本発明の実施の第1形態によ
れば、実ヨーレートγと車体すべり角βの符号が互いに
異なるとき、すなわち、車両の挙動を素早く変更するカ
ウンタステア等の修正操舵を行うスピン傾向を示すと
き、車体すべり角βが大きくスピン傾向が強いほど、目
標ヨーレート時定数Tは大きな値に設定され、目標ヨー
レートγ' の変化が小さく設定・補正されるので、車両
挙動の修正操舵の際の目標ヨーレートの設定が適切に行
われ、ドライバにとって違和感のない安定した車両挙動
制御が実現できる。
As described above, according to the first embodiment of the present invention, when the sign of the actual yaw rate γ and the sign of the vehicle body slip angle β are different from each other, that is, the correction steering such as the countersteer for quickly changing the behavior of the vehicle is performed. When the spin tendency to be performed is shown, the target yaw rate time constant T is set to a larger value and the change in the target yaw rate γ 'is set and corrected to be larger as the body slip angle β is larger and the spin tendency is stronger. The target yaw rate at the time of steering is appropriately set, and stable vehicle behavior control without a sense of incongruity for the driver can be realized.

【0083】次に、図7〜図16は本発明の実施の第2
形態を示し、図7は車両運動制御装置の機能ブロック
図、図8は車両運動制御装置を搭載した車両の概略構成
を示す説明図、図9は道路形状を求める部分の構成の説
明図、図10はナビゲーション装置から得られる点デー
タの例の説明図、図11はカーブの曲率半径の求め方の
説明図、図12は求めたカーブの曲率半径の補正の説明
図、図13はデータ整理部での各ケースの説明図、図1
4は車両運動制御のフローチャート、図15は目標ヨー
レート偏差(絶対値)で設定される目標ヨーレート時定
数基本値の説明図、図16は操舵角速度(絶対値)で設
定される基本値補正係数の説明図である。尚、本発明の
実施の第2形態は、車両挙動から得られる目標ヨーレー
トと道路形状から得られる目標ヨーレートとの偏差から
目標ヨーレート時定数の基本値を設定し、さらにこの基
本値を操舵角速度で補正して目標ヨーレートを1次遅れ
で近似し表現する際の応答パラメータとしての目標ヨー
レート時定数を設定するものである。前記発明の実施の
第1形態と同様の部分には同じ符号を記し、説明は省略
する。
Next, FIGS. 7 to 16 show a second embodiment of the present invention.
7 is a functional block diagram of the vehicle motion control device, FIG. 8 is an explanatory diagram showing a schematic configuration of a vehicle equipped with the vehicle motion control device, and FIG. 9 is an explanatory diagram of a configuration for obtaining a road shape. 10 is an explanatory diagram of an example of point data obtained from the navigation device, FIG. 11 is an explanatory diagram of how to calculate a radius of curvature of a curve, FIG. 12 is an explanatory diagram of correction of a radius of curvature of the obtained curve, and FIG. Of each case in FIG. 1, FIG.
4 is a flowchart of vehicle motion control, FIG. 15 is an explanatory diagram of a target yaw rate time constant basic value set by a target yaw rate deviation (absolute value), and FIG. 16 is a basic value correction coefficient set by a steering angular velocity (absolute value). FIG. In the second embodiment of the present invention, a basic value of a target yaw rate time constant is set from a deviation between a target yaw rate obtained from a vehicle behavior and a target yaw rate obtained from a road shape. The target yaw rate time constant is set as a response parameter when the target yaw rate is corrected and approximated by a first-order lag and expressed. The same parts as those in the first embodiment of the invention are denoted by the same reference numerals, and description thereof will be omitted.

【0084】このため、図8に示すように、車両にはナ
ビゲーション装置61と道路形状検出装置62とが搭載
される。
For this reason, as shown in FIG. 8, the vehicle is equipped with a navigation device 61 and a road shape detection device 62.

【0085】上記ナビゲーション装置61は、図9に示
すように、一般的なものを例として、車両位置検出用セ
ンサ部61a、補助記憶装置61b、情報表示部61
c、操作部61d、演算部61eから主要に構成されて
いる。
As shown in FIG. 9, the navigation device 61 is a general one, for example, a vehicle position detection sensor unit 61a, an auxiliary storage device 61b, and an information display unit 61.
c, an operation unit 61d, and a calculation unit 61e.

【0086】上記車両位置検出用センサ部61aは、具
体的には、全世界測位衛星システム(Global Positioni
ng System;GPS)によるGPS衛星からの電波を受信
して自己位置を測定するためのGPS受信機、車両の絶
対的な走行方向を検出する地磁気センサ、及び、車輪に
固定されたロータ外周に対向して設置された電磁ピック
アップ等からなり、車両の走行に伴って回転するロータ
外周の突起を検出してパルス信号を出力する車輪速セン
サが接続されて、車両位置に係わる走行情報が収集され
るようになっている。
The vehicle position detecting sensor section 61a is, specifically, a global positioning satellite system (Global Positioning Satellite System).
ng System (GPS) to receive radio waves from GPS satellites to measure its own position, a geomagnetic sensor to detect the absolute running direction of the vehicle, and to face the outer periphery of the rotor fixed to the wheels A wheel speed sensor that detects a protrusion on the outer periphery of the rotor that rotates as the vehicle travels and outputs a pulse signal is connected, and travel information related to the vehicle position is collected. It has become.

【0087】上記補助記憶装置61bは、CD−ROM
装置で、道路情報や地形情報等を含む道路地図情報を収
録したCD−ROMがセットされる読み込み専用の記憶
装置に形成されている。上記CD−ROMには、道路地
図情報が、互いに縮尺の異なる複数の階層レベルでそれ
ぞれ記憶されており、さらに、高速道路、一般国道、地
方道というような道路種別情報や交差点に関する通行条
件等の情報が記憶されている。上記道路の地図情報中の
道路データは、図10に示すように、所定間隔で入力さ
れた点データ(ノード)及びこれらの点を連続的に結ん
で形成される線データ(リンク)からなる。
The auxiliary storage device 61b is a CD-ROM
The apparatus is formed in a read-only storage device in which a CD-ROM storing road map information including road information and terrain information is set. In the CD-ROM, road map information is stored at each of a plurality of hierarchical levels having different scales. Further, road type information such as expressways, general national roads, and local roads, and traffic conditions such as intersections, etc., are stored. Information is stored. The road data in the road map information includes, as shown in FIG. 10, point data (nodes) input at predetermined intervals and line data (links) formed by continuously connecting these points.

【0088】上記情報表示部61cは、地図、自車位置
(緯度・経度・高度)、方位、地図上の自車位置、目的
地までの最適経路等を表示する液晶ディスプレイで形成
されている。そして、この情報表示部61c(液晶ディ
スプレイ)と一体に上記操作部61dとしてのタッチパ
ネルが接続され、地図の縮尺の変更、地名の詳細表示、
地域情報および経路誘導等の表示を切り換えるための操
作入力が行えるようになっている。
The information display section 61c is formed of a liquid crystal display for displaying a map, the position of the vehicle (latitude / longitude / altitude), the direction, the position of the vehicle on the map, the optimum route to the destination, and the like. Then, a touch panel as the operation unit 61d is connected integrally with the information display unit 61c (liquid crystal display) to change the scale of the map, display the details of place names,
An operation input for switching the display such as the regional information and the route guidance can be performed.

【0089】上記演算部61eは、上記車両位置検出用
センサ部61aから得られる車両の走行情報と、上記補
助記憶装置61bから読み込んだ地図情報とをマップマ
ッチング等の演算をしながら合成し、その結果を、上記
操作部61dから送られる操作信号に基づいて上記情報
表示部61cに送り、車両の現在位置及びその周辺の地
図、目的地までの最適経路等を表示させるようになって
いる。また、上述の各データ(道路データの点データ、
道路種別情報、現在位置等のデータ)は、後述する制御
装置70のカーブ情報算出部72および第2の目標ヨー
レート演算部74に対しても必要に応じて出力されるよ
うになっている。
The arithmetic section 61e combines the traveling information of the vehicle obtained from the vehicle position detecting sensor section 61a with the map information read from the auxiliary storage device 61b while performing arithmetic operations such as map matching and the like. The result is sent to the information display unit 61c based on the operation signal sent from the operation unit 61d, and the current position of the vehicle and a map around the vehicle, the optimal route to the destination, and the like are displayed. In addition, each of the above data (point data of road data,
The road type information, data such as the current position, and the like) are also output to a curve information calculation unit 72 and a second target yaw rate calculation unit 74 of the control device 70, which will be described later, as needed.

【0090】上記道路形状検出装置62は、本発明の実
施の第2形態では特に道路幅を検出するように設けられ
ており、一対のCCDカメラ62a、画像処理部62
b、道路幅検出部62cから主に構成されている。
In the second embodiment of the present invention, the road shape detecting device 62 is provided so as to particularly detect a road width, and includes a pair of CCD cameras 62a and an image processing unit 62.
b, mainly comprising a road width detector 62c.

【0091】上記一対のCCDカメラ62aは、車室内
の天井前方の左右に一定の間隔をもって取り付けられ、
車外の対象を異なる視点からステレオ撮像するようにな
っており、この一対のCCDカメラ62aで撮像した自
車両の走行方向の映像信号は、上記画像処理部62bに
入力されるようになっている。
The pair of CCD cameras 62a are mounted at a predetermined interval on the left and right in front of the ceiling in the passenger compartment.
An object outside the vehicle is stereo-imaged from a different viewpoint, and a video signal in the traveling direction of the vehicle captured by the pair of CCD cameras 62a is input to the image processing unit 62b.

【0092】上記画像処理部62bは、上記CCDカメ
ラ62aで撮像した自車両の走行方向の環境の1組のス
テレオ画像対に対し、対応する位置のずれ量から三角測
量の原理によって画像全体に渡る距離情報を求める処理
を行なって、三次元の距離分布を表す距離画像を生成し
て上記道路幅検出部62cに出力するように形成されて
いる。
The image processing section 62b covers the entire image of a set of stereo images of the environment in the traveling direction of the vehicle taken by the CCD camera 62a from the amount of displacement of the corresponding position based on the principle of triangulation. It is configured to perform a process of obtaining distance information, generate a distance image representing a three-dimensional distance distribution, and output the generated distance image to the road width detection unit 62c.

【0093】上記道路幅検出部62cは、上記画像処理
部62bからの距離画像の距離分布についてヒストグラ
ム処理を行うことで道路を認識して、この道路幅の算出
を行って、上記制御装置70のカーブ情報算出部72に
対して必要に応じて出力されるようになっている。
The road width detection unit 62c recognizes a road by performing histogram processing on the distance distribution of the distance image from the image processing unit 62b, calculates the road width, and calculates the road width. The information is output to the curve information calculation unit 72 as needed.

【0094】上記道路幅検出部62cでは、例えば白線
は、折れ線で近似され、左右の折れ線で囲まれた範囲が
自車線と判断され、この自車線の左右の折れ線の間隔か
ら道路幅を算出する。このように、この道路形状検出装
置62では道路形状を検出し、その道路形状から道路幅
を求めるようになっているため、この道路形状検出装置
62で検出した道路形状と上記ナビゲーション装置61
で得られる地図上の道路形状データとを比較して一致さ
せるように上記ナビゲーション装置61の地図上での自
車位置を修正して自車位置をより正確に求めるようにす
ることもできる。
In the road width detecting section 62c, for example, a white line is approximated by a broken line, and a range surrounded by left and right broken lines is determined to be the own lane, and the road width is calculated from the interval between the left and right broken lines of the own lane. . As described above, since the road shape detecting device 62 detects the road shape and obtains the road width from the road shape, the road shape detected by the road shape detecting device 62 and the navigation device 61 are determined.
It is also possible to correct the own vehicle position on the map of the navigation device 61 so as to obtain the own vehicle position more accurately so as to compare and match the road shape data on the map obtained by the above.

【0095】上記制御装置70は、マイクロコンピュー
タとその周辺回路で形成され、上記4輪の車輪速センサ
46,ハンドル角センサ47,ヨーレートセンサ48、
さらに、上記ナビゲーション装置61,道路形状検出装
置62からの各信号が入力され、必要に応じて駆動装置
としての上記ブレーキ駆動部40,前後差動制限クラッ
チ作動部41,左右差動制限クラッチ作動部42に対し
て駆動信号を出力する。
The control device 70 is formed by a microcomputer and its peripheral circuits, and includes the four wheel speed sensors 46, the steering wheel angle sensor 47, the yaw rate sensor 48,
Further, signals from the navigation device 61 and the road shape detection device 62 are input, and the brake drive unit 40, the front-rear differential limiting clutch operating unit 41, the left-right differential limiting clutch operating unit as a driving device are input as necessary. A drive signal is output to the control signal.

【0096】上記制御装置70は、図7に示すように、
車速演算部71,カーブ情報算出部72,第1の目標ヨ
ーレート演算部73,第2の目標ヨーレート演算部7
4,目標ヨーレート偏差(絶対値)演算部75,操舵角
速度(絶対値)演算部76,目標ヨーレート時定数設定
部77,最終目標ヨーレート演算部78,ヨーレート偏
差演算部79,制動制御部56,前後差動制限制御部5
7および左右差動制限制御部58から主要に構成されて
いる。
[0096] As shown in FIG.
Vehicle speed calculating section 71, curve information calculating section 72, first target yaw rate calculating section 73, second target yaw rate calculating section 7
4, target yaw rate deviation (absolute value) calculating section 75, steering angular velocity (absolute value) calculating section 76, target yaw rate time constant setting section 77, final target yaw rate calculating section 78, yaw rate deviation calculating section 79, braking control section 56, front and rear Differential limit control unit 5
7 and a left / right differential limiting control unit 58.

【0097】上記車速演算部71は、上記4輪の車輪速
センサ46から各車輪速度の信号が入力され、これらの
信号を予め設定しておいた数式で演算して(例えば、各
車輪速度の平均を算出して)車速Vを求め、上記第1の
目標ヨーレート演算部73,第2の目標ヨーレート演算
部74,目標ヨーレート時定数設定部77および上記最
終目標ヨーレート演算部78に出力するように形成され
ている。
The vehicle speed calculating section 71 receives the signals of the respective wheel speeds from the four wheel speed sensors 46 and calculates these signals by using a preset mathematical expression (for example, the respective wheel speeds). The vehicle speed V is obtained (by calculating an average) and output to the first target yaw rate calculator 73, the second target yaw rate calculator 74, the target yaw rate time constant setting unit 77, and the final target yaw rate calculator 78. Is formed.

【0098】上記カーブ情報算出部72は、例えば図9
に示すように、3点検出部72a,Pn-1 Pn 距離演算
部72b,Pn Pn+1 距離演算部72c,長短判定部7
2d,中点演算部72e,中点同距離点演算部72f,
曲率半径演算部72g,補正部72hおよびデータ整理
部72iから主に構成されている。
The curve information calculation section 72 is provided, for example, in FIG.
As shown in the figure, a three-point detecting section 72a, a Pn-1 Pn distance calculating section 72b, a Pn Pn + 1 distance calculating section 72c, and a length determining section 7
2d, a midpoint calculation unit 72e, a midpoint same distance point calculation unit 72f,
It is mainly composed of a curvature radius calculation unit 72g, a correction unit 72h, and a data reduction unit 72i.

【0099】上記3点検出部72aは、上記ナビゲーシ
ョン装置61から入力された道路の点データ(ノード)
から、車両の走行方向あるいは運転者により選択された
道路上にある3点を、図10に示すように、所定の間隔
で順に(車両に近い方から)第1の点Pn-1 、第2の点
Pn 、第3の点Pn+1 として読み込むものである。
The three-point detecting section 72a outputs the road point data (node) input from the navigation device 61.
, The three points on the road selected by the driver in the traveling direction of the vehicle or the driver are sequentially determined at predetermined intervals (from the side closer to the vehicle) as shown in FIG. Is read as the third point Pn + 1.

【0100】これら読み込んだ3点から、上記第1の点
Pn-1 と上記第2の点Pn の位置情報は上記Pn-1 Pn
距離演算部72bに出力され、上記第2の点Pn と上記
第3の点Pn+1 の位置情報は上記Pn Pn+1 距離演算部
72cに出力されるようになっている。Pn-1 =(Xn-
1 ,Yn-1 ),Pn =(Xn ,Yn ),Pn+1 =(Xn+
1 ,Yn+1 )とする。またカーブの代表点はPn とな
る。従って、点P1のカーブは点P0,P1,P2か
ら、点P2のカーブは点P1,P2,P3から、…、点
Pn のカーブは点Pn-1 ,Pn ,Pn+1 からそれぞれデ
ータが算出される。
From these three read points, the position information of the first point Pn-1 and the second point Pn is obtained from the Pn-1 Pn
The position information of the second point Pn and the third point Pn + 1 is output to the distance calculation unit 72b, and is output to the Pn Pn + 1 distance calculation unit 72c. Pn-1 = (Xn-
1, Yn-1), Pn = (Xn, Yn), Pn + 1 = (Xn +
1, Yn + 1). The representative point of the curve is Pn. Accordingly, the data of the curve of the point P1 is calculated from the points P0, P1, P2, the data of the point P2 is calculated from the points P1, P2, P3,..., And the data of the point Pn is calculated from the points Pn-1, Pn, Pn + 1. Is done.

【0101】上記Pn-1 Pn 距離演算部72bは、上記
3点検出部72aから入力された上記第1の点Pn-1 と
上記第2の点Pn の位置情報を基に上記第1の点Pn-1
と上記第2の点Pn を結ぶ直線距離を演算し、上記長短
判定部72dと上記補正部72hとに出力するように形
成されている。
The Pn-1 Pn distance calculator 72b calculates the first point Pn-1 based on the position information of the first point Pn-1 and the second point Pn input from the three-point detector 72a. Pn-1
And the second point Pn is calculated and output to the length determination unit 72d and the correction unit 72h.

【0102】上記Pn Pn+1 距離演算部72cは、上記
3点検出部72aから入力された上記第2の点Pn と上
記第3の点Pn+1 の位置情報を基に上記第2の点Pn と
上記第3の点Pn+1 を結ぶ直線距離を演算し、上記長短
判定部72dと上記補正部72hとに出力するように形
成されている。
The Pn Pn + 1 distance calculator 72c calculates the second point Pn based on the position information of the second point Pn and the third point Pn + 1 input from the three-point detector 72a. It is configured to calculate a linear distance connecting Pn and the third point Pn + 1 and output the calculated distance to the length determining unit 72d and the correcting unit 72h.

【0103】上記長短判定部72dは、上記Pn-1 Pn
距離演算部72bから入力された上記第1の点Pn-1 と
上記第2の点Pn を結ぶ直線距離と、上記Pn Pn+1 距
離演算部72cから入力された上記第2の点Pn と上記
第3の点Pn+1 を結ぶ直線距離とを比較して、これら直
線距離の長短を判定するものである。そして、直線距離
が短い方の各データ(位置、距離)を上記中点演算部7
2eと上記補正部72gとに出力するとともに、直線距
離が長い方の各データ(位置、距離)を上記中点同距離
点演算部72fに出力するようになっている。
The length determination section 72d calculates the Pn-1 Pn
The linear distance connecting the first point Pn-1 and the second point Pn input from the distance calculator 72b and the second point Pn and the second point Pn input from the Pn Pn + 1 distance calculator 72c. The length of the straight line distance is determined by comparing the straight line distance connecting the third point Pn + 1. Then, each data (position, distance) having the shorter straight-line distance is calculated by the above-mentioned midpoint calculation unit 7.
2e and the correction unit 72g, and outputs the data (position and distance) having the longer linear distance to the midpoint equal distance point calculation unit 72f.

【0104】尚、上記長短判定部72dでの比較の結
果、両方の直線距離が同じ長さと判定された場合には、
どちらの直線を用いても良いため上記第1の点Pn-1 と
上記第2の点Pn を結ぶ直線を短い直線として扱うよう
に予め設定しておく(上記第2の点Pn と上記第3の点
Pn+1 を結ぶ直線を短い直線として扱うようにしても良
い)。
[0104] As a result of the comparison in the length determination section 72d, when both straight distances are determined to be the same length,
Since either of the straight lines may be used, the straight line connecting the first point Pn-1 and the second point Pn is set in advance so as to be treated as a short straight line (the second point Pn and the third point Pn-1). May be treated as a short straight line connecting the point Pn + 1).

【0105】上記中点演算部72eは、上記長短判定部
72dから入力された距離が短い直線の各データ(位
置、距離)に基づき、上記短い方の直線距離の半分の距
離を演算するとともに上記短い方の直線上の中点位置を
決定するように形成されている。ここで、例えば上記第
1の点Pn-1 と上記第2の点Pn を結ぶ直線を短い直線
とし、中点をPn-1,n =(Xn-1,n ,Yn-1,n )とする
と、 Pn-1,n =(Xn-1,n ,Yn-1,n ) =((Xn-1 +Xn )/2,(Yn-1 +Yn )/2)
The midpoint calculation section 72e calculates half of the shorter straight line distance based on the data (position and distance) of the short straight line input from the length determination section 72d, and calculates the half distance. It is formed so as to determine the position of the midpoint on the shorter straight line. Here, for example, a straight line connecting the first point Pn-1 and the second point Pn is a short straight line, and the middle point is Pn-1, n = (Xn-1, n, Yn-1, n). Then, Pn-1, n = (Xn-1, n, Yn-1, n) = ((Xn-1 + Xn) / 2, (Yn-1 + Yn) / 2)

【0106】そして、上記中点演算部72eで演算した
各データは、上記中点同距離点演算部72fと上記曲率
半径演算部72gに出力されるようになっている。
The data calculated by the midpoint calculation section 72e are output to the midpoint equal distance point calculation section 72f and the curvature radius calculation section 72g.

【0107】上記中点同距離点演算部72fは、上記長
短判定部72dから入力された距離が長い直線の各デー
タ(位置、距離)と上記中点演算部72eから入力され
た上記短い方の直線距離の半分の距離のデータから、上
記長い方の直線上で上記第2の点から上記短い方の直線
距離の半分の距離の位置に中点同距離点を決定するもの
である。ここで、例えば上記第2の点Pn と上記第3の
点Pn+1 を結ぶ直線を長い直線とし、中点同距離点をP
n,n+1 =(Xn,n+1 ,Yn,n+1 )とすると、 Pn,n+1 =Pn +Pn Pn,n+1 =(Xn ,Yn )+K2・(Xn+1 −Xn ,Yn+1 −Yn ) =(Xn,n+1 ,Yn,n+1 ) ただし、K2=((Xn −Xn-1 )2 +(Yn −Yn-1
2 1/2 /(2・((Xn+1 −Xn )2 +(Yn+1
−Yn )2 1/2
The midpoint equal distance point calculating section 72f calculates each data (position and distance) of the long straight line inputted from the length determining section 72d and the shorter straight line inputted from the midpoint calculating section 72e. From the data of half the straight line distance, a midpoint equal distance point is determined on the longer straight line at a position half the distance of the shorter straight line distance from the second point. Here, for example, a straight line connecting the second point Pn and the third point Pn + 1 is a long straight line, and
Assuming that n, n + 1 = (Xn, n + 1, Yn, n + 1), Pn, n + 1 = Pn + PnPn, n + 1 = (Xn, Yn) + K2 · (Xn + 1−Xn, Yn + 1−Yn) = (Xn, n + 1, Yn, n + 1) where K2 = ((Xn−Xn−1) 2 + (Yn−Yn−1)
) 2 ) 1/2 / (2 · ((Xn + 1 -Xn) 2 + (Yn + 1)
−Yn) 2 ) 1/2 )

【0108】上記中点同距離点演算部72fで演算した
中点同距離点Pn,n+1 の位置データは、上記曲率半径演
算部72gに出力されるようになっている。
The position data of the midpoint and equidistant points Pn, n + 1 calculated by the midpoint and equidistant point calculation unit 72f is output to the curvature radius calculation unit 72g.

【0109】上記曲率半径演算部72gは、上記中点演
算部72eから入力された中点Pn-1,n の位置データと
上記中点同距離点演算部72fで演算した中点同距離点
Pn,n+1 の位置データに基づき、図11に示すように、
上記中点Pn-1,n で短い方の直線(ここではPn-1 Pn
)に直交する直線と上記中点同距離点Pn,n+1 で長い
方の直線(ここではPn Pn+1 )に直交する直線との交
点位置を走行路のカーブの中心位置On と決定してこの
カーブ中心位置On を基に走行路の曲率半径Rnを演算
するように形成されている。この曲率半径演算部72g
で演算した結果は上記補正部72hに出力されるように
なっている。
The curvature radius calculator 72g calculates the position data of the middle point Pn-1, n input from the middle point calculator 72e and the middle point same distance point Pn calculated by the middle point same distance point calculator 72f. , n + 1, as shown in FIG.
A shorter straight line at the midpoint Pn-1, n (here, Pn-1 Pn
) And the straight line perpendicular to the longer straight line (here, Pn Pn + 1) at the midpoint equidistant point Pn, n + 1 is determined as the center position On of the curve of the traveling road. The radius of curvature Rn of the traveling path is calculated based on the lever center position On. This curvature radius calculator 72g
Is output to the correction unit 72h.

【0110】すなわち、 On =Pn-1,n +Pn-1,n On =(Xn-1,n ,Yn-1,n )+M・(Yn −Yn-1 ,Xn-1 −Xn ) …(6) On =Pn,n+1 +Pn,n+1 On =(Xn,n+1 ,Yn,n+1 )+N・(Yn+1 −Yn ,Xn −Xn+1 ) …(7)That is, On = Pn-1, n + Pn-1, n On = (Xn-1, n, Yn-1, n) + M. (Yn-Yn-1, Xn-1-Xn) (6) ) On = Pn, n + 1 + Pn, n + 1 On = (Xn, n + 1, Yn, n + 1) + N. (Yn + 1-Yn, Xn-Xn + 1) (7)

【0111】従って、 Xn-1,n +M・(Yn −Yn-1 )=Xn,n+1 +N・(Yn+1 −Yn ) …(8) Yn-1,n +M・(Xn-1 −Xn )=Yn,n+1 +N・(Xn −Xn+1 ) …(9)Therefore, Xn-1, n + M ・ (Yn-Yn-1) = Xn, n + 1 + N ・ (Yn + 1-Yn) (8) Yn-1, n + M ・ (Xn-1- Xn) = Yn, n + 1 + N. (Xn-Xn + 1) (9)

【0112】上記(8),(9)式からMを消去してN
を求めると、 N=((Xn-1 −Xn )・(Xn-1,n −Xn,n+1 ) +(Yn-1 −Yn )・(Yn-1,n −Yn,n+1 )) /(Xn-1 ・Yn+1 −Xn+1 ・Yn-1 −Xn-1 ・Yn +Xn ・Yn-1 −Xn ・Yn+1 +Xn+1 ・Yn )…(10)
From the above equations (8) and (9), M is deleted and N
, N = ((Xn-1 -Xn). (Xn-1, n-Xn, n + 1) + (Yn-1 -Yn). (Yn-1, n -Yn, n + 1) ) / (Xn-1.Yn + 1-Xn + 1.Yn-1-Xn-1.Yn + Xn.Yn-1-Xn.Yn + 1 + Xn + 1.Yn) ... (10)

【0113】そして、カーブ中心位置On は、 On =(Xon,Yon)=(Xn,n+1 +N・Yn+1 −N・Yn ,Yn,n+1 +N・Xn −N・Xn+1 )…(11) となる。Then, the curve center position On is expressed as On = (Xon, Yon) = (Xn, n + 1 + N.Yn + 1-N.Yn, Yn, n + 1 + N.Xn-N.Xn + 1) ... (11)

【0114】従って、曲率半径Rn は次式により求めら
れる。 Rn =((Xn −Xn-1 )・(Yn+1 −Yn ) −(Xn+1 −Xn )・(Yn −Yn-1 )) /|((Xn −Xn-1 )・(Yn+1 −Yn ) −(Xn+1 −Xn )・(Yn −Yn-1 ))| ・((Xon−Xn-1,n )2 +(Yon−Yn-1,n )2 1/2 …(12) ここで、曲率半径Rn が正の場合は左旋回、負の場合は
右旋回となる。
Accordingly, the radius of curvature Rn is obtained by the following equation. Rn = ((Xn-Xn-1). (Yn + 1-Yn)-(Xn + 1-Xn). (Yn-Yn-1)) / | ((Xn-Xn-1). (Yn + 1) −Yn) − (Xn + 1−Xn) · (Yn−Yn−1)) | · ((Xon−Xn−1, n) 2 + (Yon−Yn−1, n) 2 ) 1/2 … ( 12) When the radius of curvature Rn is positive, the vehicle turns left, and when the radius of curvature Rn is negative, the vehicle turns right.

【0115】また、上記カーブ中心位置On からカーブ
の代表点である上記第2の点Pn までの距離Lonは、以
下の(13)式により求められる。 Lon=((Xon−Xn )2 +(Yon−Yn )2 1/2 …(13) 上記補正部72hは、上記曲率半径演算部72gからの
曲率半径Rn と上記カーブ中心位置On から上記第2の
点Pn までの距離Lonとの差Deln を演算し、この差
Deln が後述する誤差設定値を超える場合に、上記曲
率半径Rn を補正して常に上記差Deln を上記誤差設
定値以内にするものである。
The distance Lon from the curve center position On to the second point Pn which is a representative point of the curve is obtained by the following equation (13). Lon = ((Xon−Xn) 2 + (Yon−Yn) 2 ) 1/2 (13) The correction section 72 h calculates the radius of curvature Rn from the radius of curvature calculation section 72 g and the curve center position On to determine the above-mentioned curve. A difference Deln from the distance Lon to the second point Pn is calculated, and when the difference Deln exceeds an error set value described later, the curvature radius Rn is corrected to always keep the difference Deln within the error set value. Things.

【0116】この補正部72hにより補正された、ある
いは、上記差Deln が上記誤差設定値以下であり補正
されなかった各点毎の最終的なカーブ情報(カーブの代
表点Pn の位置(Xn ,Yn ),点Pn-1 と点Pn との
距離Ln ,最終的な曲率半径Rn ,カーブ中心位置On
,直線Pn-1 Pn と直線Pn Pn+1 のなす角度から求
められる各点のカーブ角度θn ,カーブ開始点Lsn(カ
ーブ中心位置On から直線Pn-1 Pn に垂直に下ろした
点)と点Pn-1 間の距離,車両位置から各カーブの代表
点までの距離Lssn )はメモリされ、前記データ整理部
72iに出力されるようになっている。
The final curve information (the position (Xn, Yn of the representative point Pn of the curve) of each point corrected by the correction section 72h or not corrected because the difference Deln is equal to or less than the error set value. ), Distance Ln between point Pn-1 and point Pn, final radius of curvature Rn, curve center position On
, The curve angle θn of each point obtained from the angle between the straight line Pn-1 Pn and the straight line Pn Pn + 1, the curve start point Lsn (the point perpendicularly lowered from the curve center position On to the straight line Pn-1 Pn) and the point Pn The distance between -1 and the distance Lssn) from the vehicle position to the representative point of each curve are stored in memory and output to the data reduction section 72i.

【0117】上記誤差設定値は、道路幅Dと上記長短判
定部72dの短い方の直線距離の両方に応じて可変さ
れ、(誤差設定値)=αh・Dで設定されるようになっ
ている(αhは短い方の直線距離に応じて設定される定
数:以後、点間隔補正係数と呼ぶ)。
The error set value is varied according to both the road width D and the shorter straight-line distance of the length determination unit 72d, and is set as (error set value) = αh · D. (Αh is a constant set according to the shorter linear distance: hereinafter, referred to as a point interval correction coefficient).

【0118】上記道路幅Dには、通常、前記道路形状検
出装置62から得られる道路幅の値を採用するようにな
っているが、上記道路形状検出装置62からデータが得
られないときなどは、上記ナビゲーション装置61から
得られる高速道路、一般国道、地方道というような道路
種別情報を基に道路幅Dを設定するようになっている。
ここで、道路幅Dが大きくなるほど上記誤差設定値が大
きくなり補正を行わない方向になるが、これは、実際の
道路で道路幅が大きくなるにつれて曲率半径Rn が大き
くなることを表現するものである。
As the road width D, the value of the road width obtained from the road shape detecting device 62 is usually adopted. However, when data cannot be obtained from the road shape detecting device 62, for example, The road width D is set based on road type information such as an expressway, a general national road, and a local road obtained from the navigation device 61.
Here, as the road width D increases, the error set value increases and the correction is not performed. This indicates that the radius of curvature Rn increases as the road width increases on an actual road. is there.

【0119】直線距離が短いということは、点データが
細かく設定されており正しく道路を表現しているとみな
せるため、補正を行わないようにするものである。
The fact that the straight line distance is short means that correction is not performed because the point data is set finely and it can be regarded that the road is correctly represented.

【0120】したがって、上記点間隔補正係数αhは、
短い方の直線距離が短い値ほど上記点間隔補正係数αh
は大きくなって誤差設定値が大きくなり補正を行わない
方向になっている。例えば、短い方の直線距離が20m
以下の短い場合はαh=1.2、100m以下の中距離
の場合はαh=0.6、100mより大きな場合はαh
=0.3とする。
Therefore, the point interval correction coefficient αh is
The shorter the straight line distance, the shorter the point interval correction coefficient αh
Becomes larger, the error set value becomes larger, and no correction is performed. For example, the shorter straight line distance is 20m
Αh = 1.2 for shorter distances below, αh = 0.6 for medium distances less than 100 m, αh for larger distances than 100 m
= 0.3.

【0121】上記補正部72hによる詳しい補正を図1
2に示す。Pn-1 からPn へのベクトルをB1ve(添字
veはベクトルであることを示す)、P2からP3へのベ
クトルをB2ve(添字veはベクトルであることを示す)
とし、B1ve=(Xn −Xn-1 ,Yn −Yn-1 )=(X
b1,Yb1)、B2ve=(Xn+1 −Xn ,Yn+1 −Yn)
=(Xb2,Yb2)とする。
The detailed correction by the correction section 72h is shown in FIG.
It is shown in FIG. The vector from Pn-1 to Pn is represented by B1ve (subscript
ve indicates a vector), and the vector from P2 to P3 is B2ve (subscript ve indicates a vector)
B1ve = (Xn−Xn−1, Yn−Yn−1) = (X
b1, Yb1), B2ve = (Xn + 1-Xn, Yn + 1-Yn)
= (Xb2, Yb2).

【0122】[0122]

【0123】B1veとB2veのなす角度θn は、 cos θn =(Xb1・Xb2+Yb1・Yb2)/(|B1ve|
・|B2ve|)
The angle θn between B1ve and B2ve is cos θn = (Xb1 · Xb2 + Yb1 · Yb2) / (| B1ve |
・ | B2ve |)

【0124】LonとRn の誤差(比率)Pdeln は、 Pdeln =Rn /Lon =cos( θn /2)=((cos θn +1)/2)1/2 …(14)The error (ratio) Pdeln between Lon and Rn is: Pdeln = Rn / Lon = cos (θn / 2) = ((cos θn + 1) / 2) 1/2 (14)

【0125】よって、LonとRn の差Deln は次式の
ようになる。 Deln =Lon−|Rn |=Lon・(1−Pdeln ) =Lon・(1−((cos θn +1)/2)1/2 ) …(15)
Therefore, the difference Deln between Lon and Rn is as follows. Deln = Lon− | Rn | = Lon · (1-Pdeln) = Lon · (1 − ((cos θn + 1) / 2) 1/2 ) (15)

【0126】ここで、差Deln が誤差設定値(αh・
D)を超える場合に、曲率半径Rnに対してDeln =
αh・Dとなるように補正が行われる。すなわち、 Lon=Deln /(1−((cos θn +1)/2)1/2 ) =αh・D/(1−((cos θn +1)/2)1/2 ) =αh・D/(1−((Xb1・Xb2+Yb1・Yb2+|B1ve| ・|B2ve|)/(2・|B1ve|・|B2ve|))1/2 ) Rn =Lon・Pdeln =αh・D/(1−((cos θn +1)/2)1/2 ) ・((cos θn +1)/2)1/2 =αh・D/((2/(cos θn +1))1/2 −1) =αh・D/((2・|B1ve|・|B2ve|/(Xb1・Xb2 +Yb1・Yb2+|B1ve|・|B2ve|))1/2 −1)…(16)
Here, the difference Deln is equal to the error set value (αh ·
D), the radius of curvature Rn, Deln =
Correction is performed so as to be αh · D. That is, Lon = Deln / (1 − ((cos θn + 1) / 2) 1/2 ) = αh · D / (1 − ((cos θn + 1) / 2) 1/2 ) = αh · D / (1) − ((Xb1 · Xb2 + Yb1 · Yb2 + | B1ve | · | B2ve |) / (2 · | B1ve | · | B2ve |)) 1/2 ) Rn = Lon · Pdeln = αh · D / (1-((cos θn +1) / 2) 1/2 ) · ((cos θn +1) / 2) 1/2 = Αh · D / ((2 / (cos θn + 1)) 1/2 −1) = αh · D / ((2 · | B1ve | · | B2ve | / (Xb1 · Xb2 + Yb1 · Yb2 + | B1ve | · | B2ve |)) 1/2 -1) ... (16)

【0127】このように上記カーブ情報算出部72によ
りカーブ情報を得るため、ナビゲーション装置61から
の一定間隔ではない点データ(ノード)をそのまま利用
することができ、計算のためのデータの補完や、特に複
雑な計算をすることなく簡単な演算処理で速やかに、か
つ、正確に走行路の曲率半径を求めることができるので
ある。
As described above, since the curve information is obtained by the curve information calculation unit 72, point data (nodes) that are not at a constant interval from the navigation device 61 can be used as they are, and data for calculation can be complemented, In particular, the radius of curvature of the traveling road can be quickly and accurately obtained by simple arithmetic processing without performing complicated calculations.

【0128】また、曲率半径を求める各カーブ検出点間
のつながりも自然で、実際の道路形状を正確に表現した
値が得られる。
The connection between the respective curve detection points for obtaining the radius of curvature is also natural, and a value accurately representing the actual road shape can be obtained.

【0129】さらに、演算誤差も実際のカーブの曲率半
径よりも小さめに生じるようになっており、例えばカー
ブ進入時の警報・減速制御において適切な警報を発する
上で好ましいものとなっている。
Further, a calculation error is also generated to be smaller than the actual radius of curvature of the curve, which is preferable for issuing an appropriate warning in, for example, warning / deceleration control when entering a curve.

【0130】また、曲率半径の補正部72hを備えるこ
とにより、より正確な曲率半径の演算が可能になり、補
正の基準に用いられる誤差設定値を実際の道路形状と点
データの数で可変することにより、より一層正確な演算
が行えるようになっている。すなわち、実際の道路で道
路幅が大きくなるにつれて曲率半径が大きくなることを
表現するため、道路幅が大きくなるほど誤差設定値が大
きくなり補正を行わない方向になる。また、直線距離が
短いということは、点データ(ノード)が細かく設定さ
れており正しく道路を表現しているとみなせるため、短
い方の直線距離が短い値ほど誤差設定値が大きくなり補
正を行わない方向になる。
Further, by providing the radius of curvature correction section 72h, it is possible to calculate the radius of curvature more accurately, and to vary the error set value used as a reference for correction with the actual road shape and the number of point data. As a result, more accurate calculations can be performed. That is, in order to express that the radius of curvature increases as the road width increases on an actual road, the error setting value increases as the road width increases, and the correction is not performed. In addition, the fact that the straight line distance is short means that the point data (node) is set finely and it can be considered that the road is correctly expressed. Therefore, the shorter the straight line distance is, the larger the error setting value becomes and the correction is performed. No direction.

【0131】上記データ整理部72iは、上記補正部7
2hで補正された各点毎のデータを整理するもので、不
必要なカーブデータを整理して、余分な演算の削減を行
うものである。
The data arranging section 72i includes the correcting section 7
The data for each point corrected in 2h is arranged, and unnecessary curve data is arranged to reduce unnecessary calculations.

【0132】すなわち、上記ナビゲーション装置61か
らの点データ(ノード)は、1つのカーブを数点で表し
ている場合があり、また、別々のカーブであっても一方
のカーブを対象に制御を行えば他方のカーブについての
制御を省略することができる場合がある。
That is, in the point data (node) from the navigation device 61, one curve may be represented by several points, and even if the curves are separate curves, control is performed on one of the curves. For example, in some cases, control for the other curve can be omitted.

【0133】従って、上記データ整理部72iでは、上
述のことを考慮し、各点データ(ノード)を点Pn-1 か
ら点Pn に向かう場合について以下の4つのケースにあ
てはめて、必要な点データ(ノード)に整理するように
なっている。
Therefore, in consideration of the above, the data rearranging section 72i applies necessary point data to the case where each point data (node) goes from the point Pn-1 to the point Pn in the following four cases. (Nodes).

【0134】・ケース1…カーブはきつくなるが、点P
n-1 から点Pn に行くまでに減速距離(=Rn-1 −Rn
)に余裕がある場合(図13(a)) |Rn-1 |>|Rn |,Rn-1 ・Rn >0、かつ、Ln
>|Rn-1 |−|Rn |ならば、点Pn-1 と点Pn のカ
ーブ情報が必要。すなわち、点Pn-1 から点Pnに行く
までに減速に余裕があるため、点Pn-1 と点Pn の各々
について独立した制御が必要になる。
Case 1: The curve becomes tight, but the point P
Deceleration distance (= Rn-1 -Rn) from n-1 to point Pn
)) (FIG. 13 (a)) | Rn-1 |> | Rn |, Rn-1 · Rn> 0 and Ln
> | Rn-1 |-| Rn |, the curve information of the points Pn-1 and Pn is required. That is, since there is a margin for deceleration from the point Pn-1 to the point Pn, independent control is required for each of the points Pn-1 and Pn.

【0135】また点Pn-1 と点Pn は1つのカーブを表
していると考えて、この1つのカーブ角度(カーブ全角
度θsn)を求めるために点Pn でのカーブ角度θn は加
算する。 点Pn までのカーブ全角度θsn=点Pn-1 までのカーブ
全角度θs(n-1)+2・cos-1 (Rn /Lon) ・ケース2…カーブはきつくなり、点Pn-1 から点Pn
に行くまでに減速距離(=Rn-1 −Rn )に余裕が無い
場合(図13(b)) |Rn-1 |>|Rn |,Rn-1 ・Rn >0、かつ、Ln
<|Rn-1 |−|Rn |ならば、点Pn-1 のカーブ情報
は無視(削減)。すなわち、点Pn のカーブについての
制御を行うことで点Pn-1 のカーブについての制御が吸
収されてしまい、点Pn-1 のカーブ情報は無駄になるた
め無視(削減)する。
Further, since it is considered that the points Pn-1 and Pn represent one curve, the curve angle θn at the point Pn is added to obtain the one curve angle (the entire curve angle θsn). Curve total angle θsn up to point Pn = curve total angle θs (n-1) + 2 · cos -1 (Rn / Lon) to case Pn-1 Case 2 ... The curve becomes tight and the point Pn-1 to Pn
When there is no margin in the deceleration distance (= Rn-1 -Rn) before going to (FIG. 13B). | Rn-1 |> | Rn |, Rn-1 · Rn> 0 and Ln
If <| Rn-1 |-| Rn |, the curve information of the point Pn-1 is ignored (reduced). That is, by performing the control on the curve at the point Pn, the control on the curve at the point Pn-1 is absorbed, and the curve information at the point Pn-1 is wasted (reduced) because it becomes useless.

【0136】また点Pn-1 と点Pn は1つのカーブを表
していると考えて、この1つのカーブ角度(カーブ全角
度θsn)を求めるために点Pn でのカーブ角度θn は加
算する。 点Pn までのカーブ全角度θsn=点Pn-1 までのカーブ
全角度θs(n-1)+2・cos-1 (Rn /Lon) ・ケース3…カーブが緩くなる場合(図13(c)) |Rn-1 |<|Rn |,Rn-1 ・Rn >0 ならば、点Pn のカーブ情報は無視(削減)。すなわ
ち、点Pn-1 で速度は減速されるようになっているた
め、この点Pn-1 よりも緩いカーブである点Pn のカー
ブ情報は不要になり無視(削減)する。尚、Ln が長い
場合、十分に加速してしまうと(点Pn-1 と点Pn とが
独立したカーブとみなせるなら)、点Pn に着くまでに
車速が大きくなってしまうことも考えられるので、Ln
の大きさに応じて点Pn のカーブ情報は保持するように
しても良い。
It is also assumed that the points Pn-1 and Pn represent one curve, and the curve angle θn at the point Pn is added in order to obtain this one curve angle (the entire curve angle θsn). Curve total angle θsn up to point Pn = curve total angle θs (n-1) + 2 · cos −1 (Rn / Lon) to case Pn-1 Case 3 ... The curve becomes loose (FIG. 13 (c)) If | Rn-1 | <| Rn |, Rn-1.Rn> 0, the curve information of the point Pn is ignored (reduced). That is, since the speed is reduced at the point Pn-1, the curve information of the point Pn which is a curve that is gentler than the point Pn-1 becomes unnecessary and is ignored (reduced). If Ln is long and the vehicle accelerates sufficiently (if the points Pn-1 and Pn can be regarded as independent curves), the vehicle speed may increase before reaching the point Pn. Ln
May be stored in accordance with the size of the point Pn.

【0137】また点Pn-1 と点Pn は1つのカーブを表
していると考えて、この1つのカーブ角度(カーブ全角
度θsn)を求めるために点Pn でのカーブ角度θn は加
算する。 点Pn までのカーブ全角度θsn=点Pn-1 までのカーブ
全角度θs(n-1)+2・cos-1 (Rn /Lon) 尚、点Pn-1 と点Pn とが独立したカーブとみなせるな
ら点Pn でのカーブ角度θn は加算せず、新たに加算を
始める(Ln の大きさに応じて決定する)。
Further, assuming that the points Pn-1 and Pn represent one curve, the curve angle θn at the point Pn is added to obtain the one curve angle (the entire curve angle θsn). The total angle θsn of the curve up to the point Pn = the total angle θs (n-1) of the curve up to the point Pn−1 + 2 · cos −1 (Rn / Lon) Note that the points Pn−1 and Pn can be regarded as independent curves. If it is, the curve angle θn at the point Pn is not added, and a new addition is started (determined according to the magnitude of Ln).

【0138】・ケース4…カーブの旋回方向が切り替わ
る場合(図13(d)) Rn-1 ・Rn <0 ならば、点Pn のカーブ情報は必要。すなわち、点Pn-
1 から点Pn に行く際は、旋回方向が異なるため、ここ
だけでのデータの整理は行わない。
Case 4: When the turning direction of the curve is switched (FIG. 13 (d)) Rn-1. If Rn <0, the curve information of the point Pn is necessary. That is, the point Pn-
When going from 1 to the point Pn, since the turning direction is different, the data is not sorted only here.

【0139】また、点Pn-1 まで続いてきたカーブ角度
の合計を、点Pn-1 までのカーブ全角度θs(n-1)とす
る。
The total of the curve angles that have continued up to the point Pn-1 is defined as the total curve angle θs (n-1) up to the point Pn-1.

【0140】さらに、点Pn からのカーブ全角度θsnを
求めるために加算を始める。 点Pn までのカーブ全角度θsn=2・cos-1 (Rn /L
on) 尚、上記各ケースにあてはめて、1つの点に対し必要と
する場合と不要とする場合とが重なった際には、その点
は無視(削減)する。
Further, addition is started in order to obtain the total curve angle θsn from the point Pn. The total angle θsn of the curve up to the point Pn = 2 · cos −1 (Rn / L
on) In addition, in the above cases, when the case where one point is necessary and the case where it is unnecessary overlap, the point is ignored (reduced).

【0141】ここで、減速距離を、カーブの曲率半径R
n とRn-1 の差で計算したのは、以下のためである。点
Pn における基準許容進入速度をVpn、減速度をa、許
容横加速度をayln として、 減速距離=(Vp(n-1)2 −Vpn2 )/(2・a) =(Rn-1 ・ayl(n-1) −Rn ・ayln )/(2・a) =(Rn-1 −Rn )・ayl/(2・a) 減速度aを許容横加速度aylの50%の(1/2)・a
ylとすると、 減速距離=Rn-1 −Rn この結果から、減速距離をカーブの曲率半径Rn とRn-
1 の差で計算したのである。
Here, the deceleration distance is defined by the radius of curvature R of the curve.
The reason for calculating the difference between n and Rn-1 is as follows. Assuming that the reference allowable approach speed at the point Pn is Vpn, the deceleration is a, and the allowable lateral acceleration is ayln, the deceleration distance = (Vp (n−1) 2 −Vpn 2 ) / (2 · a) = (Rn−1 · ayl (n−1) −Rn · ayln) / (2 · a) = (Rn−1−Rn) · ayl / (2 · a) The deceleration a is (1 /) · 50% of the allowable lateral acceleration ayl. a
yl, deceleration distance = Rn-1-Rn From this result, the deceleration distance can be calculated as the curvature radii Rn and Rn-
It was calculated by the difference of one.

【0142】そしてこのようにデータ整理部72iで整
理されたデータは、整理前のデータとともに上記第2の
目標ヨーレート演算部74により必要に応じて読み込ま
れるようになっている。
The data organized by the data organizing section 72i is read by the second target yaw rate calculating section 74 as necessary together with the data before organizing.

【0143】上記第1の目標ヨーレート演算部73は、
上記ハンドル角センサ47と、上記車速演算部71から
の信号(ハンドル角θH,車速V)が入力され、第1の
目標ヨーレートγ'1を演算し、この第1の目標ヨーレー
トγ'1を上記目標ヨーレート偏差(絶対値)演算部75
に出力するようになっている。
The first target yaw rate calculation unit 73
Signals (the steering wheel angle θH and the vehicle speed V) from the steering wheel angle sensor 47 and the vehicle speed calculating unit 71 are input, a first target yaw rate γ′1 is calculated, and the first target yaw rate γ′1 is calculated. Target yaw rate deviation (absolute value) calculation unit 75
Output.

【0144】すなわち、上記第1の目標ヨーレートγ'1
は、車両挙動から得られる目標ヨーレートであり、前記
発明の実施の第1形態と同様に、定常的な目標ヨーレー
トの値を目標ヨーレート定常値として求め、この目標ヨ
ーレート定常値γ'0に対して目標ヨーレート時定数Tで
1次遅れ処理することにより目標ヨーレートγ'1を演算
する。ここで、上記目標ヨーレート時定数Tは、例えば
車速で設定される基準値Tb として、 γ'1=(1/(1+Tb ・s))・γ'0 …(17) Tb =(m・Lf・V)/(2・L・CPr) …(18) mは車両質量、Lfは前軸と重心間の距離、CPrはリ
ア等価コーナリングパワである。
That is, the first target yaw rate γ′1
Is the target yaw rate obtained from the vehicle behavior. As in the first embodiment of the present invention, the value of the steady target yaw rate is obtained as the target yaw rate steady value. The target yaw rate γ′1 is calculated by performing a first-order lag processing with the target yaw rate time constant T. Here, the target yaw rate time constant T is, for example, γ′1 = (1 / (1 + Tb · s)) · γ′0 (17) Tb = (m · Lf ·) V) / (2 · L · CPr) (18) m is the vehicle mass, Lf is the distance between the front shaft and the center of gravity, and CPr is the rear equivalent cornering power.

【0145】上記第2の目標ヨーレート演算部74は、
上記ナビゲーション装置61と、上記車速演算部71、
カーブ情報算出部72からの信号(車速V,現在位置,
前方の曲率半径Rn )を読み込んで、第2の目標ヨーレ
ートγ'2を演算し、この第2の目標ヨーレートγ'2を上
記目標ヨーレート偏差(絶対値)演算部75に出力する
ようになっている。
The second target yaw rate calculation unit 74
The navigation device 61, the vehicle speed calculation unit 71,
The signals (vehicle speed V, current position,
The front curvature radius Rn) is read in, a second target yaw rate γ′2 is calculated, and the second target yaw rate γ′2 is output to the target yaw rate deviation (absolute value) calculation unit 75. I have.

【0146】すなわち、上記第2の目標ヨーレートγ'2
は、道路形状から得られる目標ヨーレートであり、例え
ば以下の(19)式で算出する。 γ'2=V/Rn …(19)
That is, the second target yaw rate γ′2
Is a target yaw rate obtained from the road shape, and is calculated by, for example, the following equation (19). γ'2 = V / Rn (19)

【0147】上記目標ヨーレート偏差(絶対値)演算部
75は、上記1の目標ヨーレート演算部73から第1の
目標ヨーレートγ'1が、上記第2の目標ヨーレート演算
部74から第2の目標ヨーレートγ'2が入力され、これ
らの偏差の絶対値、すなわち、目標ヨーレート偏差(絶
対値)|Δγ' |(=|γ'1−γ'2|あるいは|γ'2−
γ'1|)を演算し、上記目標ヨーレート時定数設定部7
7に出力するようになっている。
The target yaw rate deviation (absolute value) calculating section 75 calculates the first target yaw rate γ′1 from the first target yaw rate calculating section 73 and the second target yaw rate calculating section 74 from the second target yaw rate calculating section 74. γ′2 is input, and the absolute values of these deviations, that is, the target yaw rate deviation (absolute value) | Δγ ′ | (= | γ′1−γ′2 | or | γ′2−
γ′1 |) and calculates the target yaw rate time constant setting unit 7
7 is output.

【0148】上記操舵角速度(絶対値)演算部76は、
上記ハンドル角センサ47からハンドル角θHが入力さ
れ、ハンドル角の速度の絶対値|δV|を、微分処理等
を行って求め、上記目標ヨーレート時定数設定部77に
出力するようになっている。
The steering angular velocity (absolute value) calculation unit 76
The handle angle θH is input from the handle angle sensor 47, the absolute value | δV | of the speed of the handle angle is obtained by performing a differentiation process or the like, and is output to the target yaw rate time constant setting unit 77.

【0149】上記目標ヨーレート時定数設定部77は、
上記車速演算部71から車速Vが、上記目標ヨーレート
偏差(絶対値)演算部75から目標ヨーレート偏差(絶
対値)|Δγ' |が、上記操舵角速度(絶対値)演算部
76から操舵角速度(絶対値)|δV|が入力され、こ
れらの入力値から目標ヨーレート時定数Tを演算し、上
記最終目標ヨーレート演算部78に設定するように形成
されている。
The target yaw rate time constant setting unit 77
The vehicle speed V from the vehicle speed calculator 71, the target yaw rate deviation (absolute value) | Δγ ′ | from the target yaw rate deviation (absolute value) calculator 75, and the steering angular speed (absolute value) from the steering angular speed (absolute value) calculator 76 ΔV | is input, a target yaw rate time constant T is calculated from these input values, and set in the final target yaw rate calculation unit 78.

【0150】この目標ヨーレート時定数設定部77で
は、まず、車速Vで基準値(例えば、前記(18)式で
演算する)を設定したマップを予め定め、このマップを
目標ヨーレート偏差(絶対値)|Δγ' |で検索して、
目標ヨーレート偏差(絶対値)|Δγ' |に応じた時定
数T0 を設定する。
In the target yaw rate time constant setting unit 77, first, a map in which a reference value (for example, calculated by the equation (18)) is set in advance with the vehicle speed V is determined in advance, and this map is used as a target yaw rate deviation (absolute value). | Δγ '|
A time constant T0 corresponding to the target yaw rate deviation (absolute value) | Δγ '| is set.

【0151】上記時定数T0 のマップは、例えば、図1
5に示すように、|Δγ' |が小さくなるほど時定数T
0 が大きく設定されるようになっており、換言すれば、
車両挙動による目標ヨーレート(第1の目標ヨーレート
γ'1)と道路形状から得られる目標ヨーレート(第2の
目標ヨーレートγ'2)との差が少ないときほど、所定の
操舵に対する目標ヨーレート時定数T0 が大きく設定さ
れるようになっている。
The map of the time constant T0 is shown in FIG.
As shown in FIG. 5, as | Δγ ′ |
0 is set to be large, in other words,
The smaller the difference between the target yaw rate (first target yaw rate γ'1) due to the vehicle behavior and the target yaw rate (second target yaw rate γ'2) obtained from the road shape, the smaller the target yaw rate time constant T0 for the predetermined steering. Is set to be large.

【0152】さらに、操舵角速度(絶対値)|δV|を
基に予め設定しておいたマップを検索して、上記目標ヨ
ーレート偏差(絶対値)|Δγ' |に応じた時定数T0
の補正係数K4を定め、この補正係数K4と上記時定数
T0 の積で時定数Tを決定する(T=K4・T0 )。
Further, a preset map is searched based on the steering angular velocity (absolute value) | δV |, and a time constant T0 corresponding to the target yaw rate deviation (absolute value) | Δγ '|
Is determined, and the time constant T is determined by the product of the correction coefficient K4 and the time constant T0 (T = K4 · T0).

【0153】上記補正係数K4のマップは、例えば、図
16に示すように、操舵角速度(絶対値)|δV|が大
きくなるほど補正係数K4が大きく定められ、速く操舵
するほど目標ヨーレート時定数T0 を大きな値に補正す
る。
In the map of the correction coefficient K4, for example, as shown in FIG. 16, the larger the steering angular velocity (absolute value) | δV |, the larger the correction coefficient K4 is set, and the faster the steering, the more the target yaw rate time constant T0 is set. Correct to a large value.

【0154】すなわち、この目標ヨーレート時定数設定
部77では、車両挙動による目標ヨーレートと道路形状
から得られる目標ヨーレートとの差が少ないにも係わら
ず、素早いハンドル操作をするほど、時定数Tを大きな
値に設定するようになっており、車両の挙動を素早く変
更する修正操舵を、車両挙動による目標ヨーレートと道
路形状から得られる目標ヨーレートとの差と操舵角速度
とで検出し、その度合いで時定数Tを演算するのであ
る。
That is, the target yaw rate time constant setting unit 77 increases the time constant T as the steering wheel is operated more quickly, despite the small difference between the target yaw rate due to the vehicle behavior and the target yaw rate obtained from the road shape. Correction steering that quickly changes the behavior of the vehicle is detected based on the difference between the target yaw rate due to the vehicle behavior and the target yaw rate obtained from the road shape and the steering angular velocity, and the time constant is determined by that degree. It calculates T.

【0155】上記最終目標ヨーレート演算部78は、上
記ハンドル角センサ47と、上記車速演算部71,目標
ヨーレート時定数設定部77からの信号(ハンドル角θ
H,車速V,目標ヨーレート時定数T)が入力され、最
終目標ヨーレートγ'sを演算し、上記ヨーレート偏差演
算部79に出力するように形成されている。
The final target yaw rate calculating section 78 receives signals (the steering wheel angle θ) from the steering wheel angle sensor 47, the vehicle speed calculating section 71, and the target yaw rate time constant setting section 77.
H, vehicle speed V, target yaw rate time constant T) are input, the final target yaw rate γ's is calculated, and the calculated target yaw rate γ's is output to the yaw rate deviation calculator 79.

【0156】この最終目標ヨーレート演算部78では、
前記発明の実施の第1形態と同様に、定常的な目標ヨー
レートの値を目標ヨーレート定常値として求め、この目
標ヨーレート定常値γ'0に対して上記目標ヨーレート時
定数設定部77で求めた目標ヨーレート時定数Tで1次
遅れ処理することにより最終的な目標ヨーレートγ'sを
演算する。すなわち、 γ's=(1/(1+T・s))・γ'0 …(20)
In this final target yaw rate calculation section 78,
As in the first embodiment of the present invention, a steady-state target yaw rate value is determined as a target yaw rate steady-state value, and a target yaw rate time constant setting unit 77 determines the target yaw rate steady-state value γ′0. The final target yaw rate γ's is calculated by performing a first-order lag processing with the yaw rate time constant T. That is, γ's = (1 / (1 + T · s)) · γ′0 (20)

【0157】ここで、上記目標ヨーレート時定数Tが大
きくなると、最終目標ヨーレートγ'sの変化が小さくな
り、最終目標ヨーレートγ'sの値の操舵に対する追従性
が低下させられる。上記目標ヨーレート時定数設定部7
7では、車両挙動による目標ヨーレートと道路形状から
得られる目標ヨーレートとの差が少なく、素早いハンド
ル操作をするほど、時定数Tを大きな値に設定するよう
になっているため、この最終目標ヨーレート演算部78
で最終目標ヨーレートγ'sの変化が小さく設定されるこ
とになる。すなわち、道路形状から設定される目標ヨー
レートと車両挙動から設定される目標ヨーレートとの差
が小さいにも係わらず素早く操舵する、車両の挙動を素
早く変更する修正操舵ほど最終的に目標ヨーレートの変
化が小さくなるように補正され、修正操舵の際であって
もドライバにとって違和感のない安定した車両挙動制御
が実現できるのである。
Here, as the target yaw rate time constant T increases, the change in the final target yaw rate γ's decreases, and the followability of the value of the final target yaw rate γ's to steering is reduced. Target yaw rate time constant setting unit 7
7, the difference between the target yaw rate due to the vehicle behavior and the target yaw rate obtained from the road shape is small, and the quicker the steering operation, the larger the time constant T is set. Part 78
Thus, the change in the final target yaw rate γ's is set to be small. That is, although the difference between the target yaw rate set from the road shape and the target yaw rate set from the vehicle behavior is small, the steering speedily changes. It is corrected so as to be small, and stable vehicle behavior control without a sense of incongruity for the driver can be realized even during corrective steering.

【0158】上記ヨーレート偏差演算部79は、上記ヨ
ーレートセンサ48から実ヨーレートγが、上記最終目
標ヨーレート演算部78から最終的な目標ヨーレート
γ'sが入力され、これら実ヨーレートγと最終目標ヨー
レートγ'sの偏差Δγ(=γ−γ's)を演算して上記制
動制御部56,前後差動制限制御部57,左右差動制限
制御部58に出力するようになっている。上記制動制御
部56,前後差動制限制御部57,左右差動制限制御部
58は、前記発明の実施の第1形態で説明したように形
成されている。
The yaw rate deviation calculating section 79 receives the actual yaw rate γ from the yaw rate sensor 48 and the final target yaw rate γ's from the final target yaw rate calculating section 78, and calculates the deviation between the actual yaw rate γ and the final target yaw rate γ's. Δγ (= γ−γ ′s) is calculated and output to the braking control unit 56, the front and rear differential restriction control unit 57, and the left and right differential restriction control unit 58. The braking control unit 56, the front / rear differential restriction control unit 57, and the left / right differential restriction control unit 58 are formed as described in the first embodiment of the present invention.

【0159】次に、上記構成の作用について、図14の
フローチャートで説明する。図14は車両運動制御のフ
ローチャートで、まず、S401で各センサ値を読み込
み、S402に進み、車速演算部71で車速V、カーブ
情報算出部72で走行路のカーブの曲率半径Rnをはじ
めとする各カーブ情報を算出する。
Next, the operation of the above configuration will be described with reference to the flowchart of FIG. FIG. 14 is a flowchart of the vehicle motion control. First, the respective sensor values are read in S401, and the process proceeds to S402. The vehicle speed calculator 71 calculates the vehicle speed V, and the curve information calculator 72 calculates the radius of curvature Rn of the curve of the traveling road. Calculate each curve information.

【0160】次いで、S403に進み、第1の目標ヨー
レート演算部73で車速V,ハンドル角θHに基づき、
前記(17)式により第1の目標ヨーレートγ'1を演算
してS404に進む。
Next, the process proceeds to S403, where the first target yaw rate calculation unit 73 calculates the target yaw rate based on the vehicle speed V and the steering wheel angle θH.
The first target yaw rate γ′1 is calculated by the above equation (17), and the process proceeds to S404.

【0161】上記S404では、第2の目標ヨーレート
演算部74で車速V,カーブ情報を基に、前記(19)
式により第2の目標ヨーレートγ'2を演算する。
In step S404, the second target yaw rate calculation section 74 calculates the above (19) based on the vehicle speed V and the curve information.
The second target yaw rate γ′2 is calculated by the equation.

【0162】そして、S405に進み、目標ヨーレート
偏差(絶対値)演算部75で、上記第1の目標ヨーレー
トγ'1と上記第2の目標ヨーレートγ'2との偏差の絶対
値を演算する。
Then, the flow advances to S405, where the target yaw rate deviation (absolute value) calculating section 75 calculates the absolute value of the deviation between the first target yaw rate γ′1 and the second target yaw rate γ′2.

【0163】その後、S406に進み、操舵角速度(絶
対値)演算部76でハンドル角θHの速度の絶対値|δ
V|を微分処理等を行って求め、S407に進む。
Thereafter, the flow advances to S 406, where the steering angular velocity (absolute value) calculating section 76 calculates the absolute value | δ of the speed of the steering wheel angle θH.
V | is obtained by performing a differentiation process or the like, and the process proceeds to S407.

【0164】上記S407では、目標ヨーレート時定数
設定部77で、車速Vで基準値(例えば、前記(18)
式で演算する)を設定したマップを予め定め、このマッ
プを目標ヨーレート偏差(絶対値)|Δγ' |で検索し
て、目標ヨーレート偏差(絶対値)|Δγ' |に応じた
時定数T0 を設定するとともに、操舵角速度(絶対値)
|δV|を基に予め設定しておいたマップを検索して、
上記目標ヨーレート偏差(絶対値)|Δγ' |に応じた
時定数T0 の補正係数K4を定め、この補正係数K4と
上記時定数T0 の積で時定数Tを決定する(T=K4・
T0 )。
In step S407, the target yaw rate time constant setting unit 77 sets the vehicle speed V to a reference value (for example, (18)
Is calculated in advance, and the map is searched for the target yaw rate deviation (absolute value) | Δγ ′ |, and the time constant T0 corresponding to the target yaw rate deviation (absolute value) | Δγ ′ | Setting and steering angular velocity (absolute value)
Search for a preset map based on | δV |
The correction coefficient K4 of the time constant T0 according to the target yaw rate deviation (absolute value) | Δγ '| is determined, and the time constant T is determined by the product of the correction coefficient K4 and the time constant T0 (T = K4 ·
T0).

【0165】ここで、上記目標ヨーレート時定数設定部
77では、車両挙動による目標ヨーレート(第1の目標
ヨーレートγ'1)と道路形状(第2の目標ヨーレート
γ'2)から得られる目標ヨーレートとの差(目標ヨーレ
ート偏差(絶対値)|Δγ' |)が少ないにも係わら
ず、素早いハンドル操作をするほど、時定数Tを大きな
値に設定するようになっている。
Here, the target yaw rate time constant setting unit 77 calculates a target yaw rate (first target yaw rate γ′1) based on the vehicle behavior and a target yaw rate obtained from the road shape (second target yaw rate γ′2). Is smaller (the target yaw rate deviation (absolute value) | Δγ ′ |), the faster the steering operation is, the larger the time constant T is set.

【0166】次いで、S408に進み、最終目標ヨーレ
ート演算部78で、ハンドル角θH,車速V、および、
上記S407で求めた目標ヨーレート時定数Tを基に、
最終的な目標ヨーレートγ'sを前記(20)式により演
算する。
Then, the flow advances to S408, where the final target yaw rate calculation unit 78 calculates the steering wheel angle θH, the vehicle speed V, and
Based on the target yaw rate time constant T determined in S407,
The final target yaw rate γ's is calculated by the above equation (20).

【0167】さらに、S409に進み、ヨーレート偏差
演算部79で実ヨーレートγと上記最終目標ヨーレート
γ'sとからヨーレート偏差Δγ(=γ−γ's)を演算す
る。
Further, the flow proceeds to S 409, where the yaw rate deviation calculator 79 calculates a yaw rate deviation Δγ (= γ−γ ′s) from the actual yaw rate γ and the final target yaw rate γ ′s.

【0168】そして、S410に進み、前記発明の実施
の第1形態で説明した制動、前後、左右差動制限制御ル
ーチン(図5)に従って制動制御、前後差動制限制御、
左右差動制限制御を行う。
Then, the program proceeds to S410, in which the braking control, the front-rear differential limiting control, and the front-rear differential limiting control routine (FIG. 5) described in the first embodiment of the present invention are performed.
Perform left / right differential limiting control.

【0169】このように、本発明の実施の第2形態によ
れば、道路形状から設定される目標ヨーレートと車両挙
動から設定される目標ヨーレートとの差が小さいにも係
わらず素早く操舵する、車両の挙動を素早く変更する修
正操舵ほど最終的に目標ヨーレートの変化が小さくなる
ように補正され、修正操舵の際であってもドライバにと
って違和感のない安定した車両挙動制御が実現できる。
As described above, according to the second embodiment of the present invention, the vehicle can be quickly steered despite the small difference between the target yaw rate set from the road shape and the target yaw rate set from the vehicle behavior. Is corrected so that the change in the target yaw rate becomes smaller as the steering speed changes more quickly, and even during the correction steering operation, stable vehicle behavior control that does not give a driver an uncomfortable feeling can be realized.

【0170】次に、図17〜図19は本発明の実施の第
3形態を示し、図17は車両運動制御装置の機能ブロッ
ク図、図18は車両運動制御装置を搭載した車両の概略
構成を示す説明図、図19は車両運動制御のフローチャ
ートである。尚、本発明の実施の第3形態は、ハンドル
角センサで検出される信号から、カウンタステア等の修
正操舵にみられる特有の信号を除去して入力することに
より、修正操舵に対しての制御が行われないようにする
もので、前記発明の実施の第1形態と同様の部分には同
じ符号を記し、説明は省略する。
17 to 19 show a third embodiment of the present invention. FIG. 17 is a functional block diagram of a vehicle motion control device, and FIG. 18 shows a schematic configuration of a vehicle equipped with the vehicle motion control device. FIG. 19 is a flowchart of the vehicle motion control. According to the third embodiment of the present invention, the control for the corrective steering is performed by removing a signal peculiar to corrective steering such as counter steer and inputting the signal from the signal detected by the steering wheel angle sensor. The same reference numerals are given to the same parts as those in the first embodiment of the present invention, and the description will be omitted.

【0171】このため、本発明の実施の第3形態では、
制御装置80は、マイクロコンピュータとその周辺回路
で形成され、上記4輪の車輪速センサ46,ハンドル角
センサ47およびヨーレートセンサ48からの各信号が
入力され、必要に応じて駆動装置としての前記ブレーキ
駆動部40,前後差動制限クラッチ作動部41,左右差
動制限クラッチ作動部42に対して駆動信号を出力する
ようになっている。
For this reason, in the third embodiment of the present invention,
The control device 80 is formed by a microcomputer and its peripheral circuits, receives signals from the four wheel speed sensors 46, the steering wheel angle sensor 47, and the yaw rate sensor 48, and if necessary, controls the brake as a driving device. A drive signal is output to the drive unit 40, the front and rear differential limiting clutch operating unit 41, and the left and right differential limiting clutch operating unit 42.

【0172】上記制御装置80は、図17に示すよう
に、車速演算部81,フィルタ処理部82,目標ヨーレ
ート演算部83,ヨーレート偏差演算部84,制動制御
部56,前後差動制限制御部57および左右差動制限制
御部58から主要に構成されている。
As shown in FIG. 17, the control device 80 includes a vehicle speed calculator 81, a filter processor 82, a target yaw rate calculator 83, a yaw rate deviation calculator 84, a brake controller 56, and a front-rear differential limit controller 57. And a left / right differential limiting control unit 58.

【0173】上記車速演算部81は、上記4輪の車輪速
センサ46から各車輪速度の信号が入力され、これらの
信号を予め設定しておいた数式で演算して(例えば、各
車輪速度の平均を算出して)車速Vを求め、目標ヨーレ
ート演算部83に出力するように形成されている。
The vehicle speed calculating section 81 receives signals of the respective wheel speeds from the four wheel speed sensors 46, and calculates these signals by using a preset mathematical expression (for example, the respective wheel speeds). The vehicle speed V is calculated (by calculating an average) and output to the target yaw rate calculation unit 83.

【0174】上記フィルタ処理部82は、いわゆるロー
パスフィルタに構成され、カットオフ周波数は、例えば
1〜2Hz 程度に設定され、前記ハンドル角センサ47
から入力されるハンドル角θHから、カウンタステア等
の修正操舵時にみられる素早い操舵の信号のみを効果的
にカットするものである。このフィルタ処理部82にて
フィルタ処理されたハンドル角θHの信号をθH'とす
る。
The filter processing section 82 is configured as a so-called low-pass filter, the cut-off frequency is set to, for example, about 1 to 2 Hz.
From the steering wheel angle θH input from the steering wheel, only a signal of quick steering which is observed at the time of corrective steering such as counter steering is effectively cut. The signal of the steering wheel angle θH filtered by the filter processing unit 82 is defined as θH ′.

【0175】上記目標ヨーレート演算部83は、上記車
速演算部81から車速Vが、上記フィルタ処理部82か
らフィルタ処理されたハンドル角θH'が入力され、目標
ヨーレートγ' を演算し、上記ヨーレート偏差演算部8
4に出力するように形成されている。
The target yaw rate calculating section 83 receives the vehicle speed V from the vehicle speed calculating section 81 and the filtered steering wheel angle θH ′ from the filter processing section 82, calculates the target yaw rate γ ′, and calculates the yaw rate deviation. Arithmetic unit 8
4 is formed.

【0176】この目標ヨーレート演算部83での目標ヨ
ーレートγ' の演算は、前記発明の実施の第1形態と同
様に、定常的な目標ヨーレートの値を目標ヨーレート定
常値として求め、この目標ヨーレート定常値γ'0に対し
て目標ヨーレート時定数Tで1次遅れ処理することによ
り目標ヨーレートγ' を演算する。ここで、上記目標ヨ
ーレート時定数Tは、例えば前記発明の実施の第2形態
で説明した(18)式による車速で設定される基準値T
b を用いる。
In the calculation of the target yaw rate γ ′ by the target yaw rate calculation section 83, the value of the steady target yaw rate is obtained as the target yaw rate steady value, as in the first embodiment of the present invention. The target yaw rate γ ′ is calculated by subjecting the value γ′0 to first-order lag processing with the target yaw rate time constant T. Here, the target yaw rate time constant T is, for example, a reference value T set by the vehicle speed according to the equation (18) described in the second embodiment of the invention.
Use b.

【0177】すなわち、目標ヨーレートγ' は、以下の
(21)式で演算される。 γ' =(1/(1+Tb ・s))・γ'0 …(21)
That is, the target yaw rate γ ′ is calculated by the following equation (21). γ ′ = (1 / (1 + Tb · s)) · γ′0 (21)

【0178】上記目標ヨーレート定常値γ'0はフィルタ
処理されたハンドル角θH'を用いて演算され、以下のよ
うになる。 γ'0=(1/(1+A・V2 ))・(V/(L・n))・θH' …(22)
The target yaw rate steady-state value γ′0 is calculated using the filtered steering wheel angle θH ′, and is as follows. γ′0 = (1 / (1 + A · V 2 )) · (V / (L · n)) · θH ′ (22)

【0179】上記ヨーレート偏差演算部84は、上記ヨ
ーレートセンサ48から実ヨーレートγが、上記目標ヨ
ーレート演算部83からフィルタ処理されたハンドル角
θH'を用いて演算した目標ヨーレートγ' が入力され、
これら実ヨーレートγと目標ヨーレートγ' の偏差Δγ
(=γ−γ' )を演算して上記制動制御部56,前後差
動制限制御部57,左右差動制限制御部58に出力する
ようになっている。上記制動制御部56,前後差動制限
制御部57,左右差動制限制御部58は、前記発明の実
施の第1形態で説明したように形成されている。
The yaw rate deviation calculator 84 receives the actual yaw rate γ from the yaw rate sensor 48 and the target yaw rate γ 'calculated from the target yaw rate calculator 83 using the filtered steering wheel angle θH ′.
Deviation Δγ between these actual yaw rate γ and target yaw rate γ '
(= Γ−γ ′) is calculated and output to the braking control unit 56, the front and rear differential restriction control unit 57, and the left and right differential restriction control unit 58. The braking control unit 56, the front / rear differential restriction control unit 57, and the left / right differential restriction control unit 58 are formed as described in the first embodiment of the present invention.

【0180】次に、上記構成の作用について、図19の
フローチャートで説明する。図19は車両運動制御のフ
ローチャートで、まず、S501で各センサ値を読み込
み、S502に進み、車速演算部81で車速Vを演算
し、フィルタ処理部82でハンドル角θHの信号をフィ
ルタ処理する(ハンドル角θH')。
Next, the operation of the above configuration will be described with reference to the flowchart of FIG. FIG. 19 is a flowchart of the vehicle motion control. First, the respective sensor values are read in S501, the process proceeds to S502, the vehicle speed V is calculated by the vehicle speed calculator 81, and the signal of the steering wheel angle θH is filtered by the filter processor 82 ( Handle angle θH ').

【0181】次いで、S503に進み、目標ヨーレート
演算部83で車速Vとフィルタ処理したハンドル角θH'
を基に、上記(21),(22)式により、カウンタス
テア等の修正操舵時にみられる素早い操舵の信号の影響
を受けない目標ヨーレートγ' を演算する。
Next, the flow proceeds to S503, in which the target yaw rate calculation unit 83 filters the steering wheel angle θH 'with the vehicle speed V.
Based on the above, the target yaw rate γ 'which is not affected by the quick steering signal observed at the time of the correction steering such as the counter steer is calculated by the above equations (21) and (22).

【0182】次に、S504に進み、ヨーレート偏差演
算部84で実ヨーレートγと上記S503で演算した目
標ヨーレートγ' とからヨーレート偏差Δγ(=γ−
γ' )を演算する。
Next, the flow proceeds to S504, where the yaw rate deviation Δγ (= γ−) is calculated from the actual yaw rate γ by the yaw rate deviation calculating section 84 and the target yaw rate γ ′ calculated in S503.
γ ′).

【0183】そして、S505に進み、前記発明の実施
の第1形態で説明した制動、前後、左右差動制限制御ル
ーチン(図5)に従って制動制御、前後差動制限制御、
左右差動制限制御を行う。
Then, the program proceeds to S505, in which the braking control, the front / rear differential limiting control, the braking / forward / rearward differential limiting control routine (FIG. 5) described in the first embodiment of the present invention are performed.
Perform left / right differential limiting control.

【0184】このように、本発明の実施の第3形態によ
れば、操舵角信号からカウンタステア等の修正操舵時に
みられる素早い操舵の信号のみを効果的にカットして制
御に用いるようにするため、修正操舵に対して過剰に制
御が反応することが無く、修正操舵の際であってもドラ
イバにとって違和感のない安定した車両挙動制御が簡単
に実現できる。
As described above, according to the third embodiment of the present invention, only a quick steering signal observed at the time of correction steering such as countersteering is effectively cut from a steering angle signal and used for control. Therefore, the control does not excessively react to the correction steering, and even during the correction steering, stable vehicle behavior control that does not give a driver a sense of incongruity can be easily realized.

【0185】尚、上記発明の実施の各形態では、制動制
御、前後差動制限制御、左右差動制限制御の3つが備わ
っているもので説明しているが、どれか1つ、あるいは
2つ備えたものであっても良い。
In each of the embodiments of the present invention described above, three types of braking control, front-rear differential limiting control, and left-right differential limiting control are provided, but any one or two of them are provided. It may be provided.

【0186】また、制動制御、前後差動制限制御、左右
差動制限制御は他の例(型)であっても、目標ヨーレー
トを制御を決定するパラメータの一つとして制御を行う
ものであれば、本発明が適応できることは言うまでもな
い。
Further, the braking control, the front-rear differential limiting control, and the left-right differential limiting control are other examples (types) as long as the target yaw rate is controlled as one of the parameters for determining the control. Needless to say, the present invention is applicable.

【0187】[0187]

【発明の効果】以上、説明したように本発明によれば、
車両挙動の修正操舵の際の目標ヨーレートの設定が適切
に行われ、ドライバにとって違和感のない安定した車両
挙動制御を実現することができる。
As described above, according to the present invention,
The target yaw rate at the time of corrective steering of the vehicle behavior is appropriately set, and stable vehicle behavior control without a sense of incongruity for the driver can be realized.

【図面の簡単な説明】[Brief description of the drawings]

【図1】本発明の実施の第1形態による車両運動制御装
置の機能ブロック図
FIG. 1 is a functional block diagram of a vehicle motion control device according to a first embodiment of the present invention.

【図2】本発明の実施の第1形態による車両運動制御装
置を搭載した車両の概略構成を示す説明図
FIG. 2 is an explanatory diagram illustrating a schematic configuration of a vehicle equipped with the vehicle motion control device according to the first embodiment of the present invention;

【図3】本発明の実施の第1形態による車両運動制御の
フローチャート
FIG. 3 is a flowchart of vehicle motion control according to the first embodiment of the present invention;

【図4】本発明の実施の第1形態による目標ヨーレート
時定数演算・設定ルーチンのフローチャート
FIG. 4 is a flowchart of a target yaw rate time constant calculation / setting routine according to the first embodiment of the present invention;

【図5】本発明の実施の第1形態による制動、前後、左
右差動制限制御ルーチンのフローチャート
FIG. 5 is a flowchart of a braking, front-rear, left-right differential limiting control routine according to the first embodiment of the present invention;

【図6】本発明の実施の第1形態による設定される時定
数の説明図
FIG. 6 is an explanatory diagram of a time constant set according to the first embodiment of the present invention.

【図7】本発明の実施の第2形態による車両運動制御装
置の機能ブロック図
FIG. 7 is a functional block diagram of a vehicle motion control device according to a second embodiment of the present invention.

【図8】本発明の実施の第2形態による車両運動制御装
置を搭載した車両の概略構成を示す説明図
FIG. 8 is an explanatory diagram showing a schematic configuration of a vehicle equipped with a vehicle motion control device according to a second embodiment of the present invention.

【図9】本発明の実施の第2形態による道路形状を求め
る部分の構成の説明図
FIG. 9 is an explanatory diagram of a configuration of a part for obtaining a road shape according to the second embodiment of the present invention;

【図10】本発明の実施の第2形態による実際にナビゲ
ーション装置から得られる点データの例の説明図
FIG. 10 is an explanatory diagram of an example of point data actually obtained from the navigation device according to the second embodiment of the present invention;

【図11】本発明の実施の第2形態によるカーブの曲率
半径の求め方の説明図
FIG. 11 is a diagram illustrating a method of obtaining a radius of curvature of a curve according to a second embodiment of the present invention.

【図12】本発明の実施の第2形態による求めたカーブ
の曲率半径の補正の説明図
FIG. 12 is an explanatory diagram of correction of a radius of curvature of a curve obtained according to the second embodiment of the present invention.

【図13】本発明の実施の第2形態によるデータ整理部
での各ケースの説明図
FIG. 13 is an explanatory diagram of each case in the data reduction unit according to the second embodiment of the present invention.

【図14】本発明の実施の第2形態による車両運動制御
のフローチャート
FIG. 14 is a flowchart of vehicle motion control according to a second embodiment of the present invention.

【図15】本発明の実施の第2形態による目標ヨーレー
ト偏差(絶対値)で設定される目標ヨーレート時定数基
本値の説明図
FIG. 15 is an explanatory diagram of a target yaw rate time constant basic value set by a target yaw rate deviation (absolute value) according to the second embodiment of the present invention;

【図16】本発明の実施の第2形態による操舵角速度
(絶対値)で設定される基本値補正係数の説明図
FIG. 16 is an explanatory diagram of a basic value correction coefficient set by a steering angular velocity (absolute value) according to the second embodiment of the present invention;

【図17】本発明の実施の第3形態による車両運動制御
装置の機能ブロック図
FIG. 17 is a functional block diagram of a vehicle motion control device according to a third embodiment of the present invention.

【図18】本発明の実施の第3形態による車両運動制御
装置を搭載した車両の概略構成を示す説明図
FIG. 18 is an explanatory diagram showing a schematic configuration of a vehicle equipped with a vehicle motion control device according to a third embodiment of the present invention.

【図19】本発明の実施の第3形態による車両運動制御
のフローチャート
FIG. 19 is a flowchart of vehicle motion control according to a third embodiment of the present invention.

【符号の説明】[Explanation of symbols]

3 センターディファレンシャル装置 7 後輪終減速装置 21 前後差動制限クラッチ 33 左右差動制限クラッチ 40 ブレーキ駆動部 41 前後差動制限クラッチ作動部 42 左右差動制限クラッチ作動部 46 車輪速度センサ 47 ハンドル角センサ 48 ヨーレートセンサ 49 横加速度センサ 50 制御装置 51 車速演算部 52 車体すべり角演算部 53 目標ヨーレート時定数設定部 54 目標ヨーレート演算部 55 ヨーレート偏差演算部 56 制動制御部 57 前後差動制限制御部 58 左右差動制限制御部 REFERENCE SIGNS LIST 3 center differential device 7 rear wheel final deceleration device 21 front and rear differential limiting clutch 33 left and right differential limiting clutch 40 brake driving unit 41 front and rear differential limiting clutch operating unit 42 left and right differential limiting clutch operating unit 46 wheel speed sensor 47 handle angle sensor 48 Yaw rate sensor 49 Lateral acceleration sensor 50 Control device 51 Vehicle speed calculation unit 52 Vehicle slip angle calculation unit 53 Target yaw rate time constant setting unit 54 Target yaw rate calculation unit 55 Yaw rate deviation calculation unit 56 Brake control unit 57 Front-rear differential limit control unit 58 Left and right Differential limit controller

Claims (7)

【特許請求の範囲】[Claims] 【請求項1】 操舵角を含む車両の運転状態と車両諸元
に基づき車両の目標とするヨーレートを演算し、この目
標ヨーレートを基に車両の駆動装置を動作して車両挙動
を制御する車両運動制御装置において、 車両の挙動を修正する操舵に応じ、上記目標ヨーレート
を補正することを特徴とする車両運動制御装置。
1. A vehicle motion for controlling a vehicle behavior by calculating a target yaw rate of a vehicle based on a vehicle operating condition including a steering angle and vehicle specifications, and operating a vehicle driving device based on the target yaw rate. A control apparatus for controlling a vehicle motion, wherein the target yaw rate is corrected in accordance with steering for correcting the behavior of the vehicle.
【請求項2】 上記操舵は、実際のヨーレートの方向と
車体すべり角の方向に応じて検出することを特徴とする
請求項1記載の車両運動制御装置。
2. The vehicle motion control device according to claim 1, wherein the steering is detected in accordance with an actual yaw rate direction and a vehicle slip angle direction.
【請求項3】 上記目標ヨーレートの補正は、少なくと
も車体すべり角に応じて設定することを特徴とする請求
項1又は請求項2記載の車両運動制御装置。
3. The vehicle motion control device according to claim 1, wherein the correction of the target yaw rate is set at least according to a vehicle body slip angle.
【請求項4】 上記目標ヨーレートの補正は、少なくと
も車速に応じて設定することを特徴とする請求項1又は
請求項3記載の車両運動制御装置。
4. The vehicle motion control device according to claim 1, wherein the correction of the target yaw rate is set at least according to a vehicle speed.
【請求項5】 上記目標ヨーレートの補正は、上記操舵
角を含む車両の運転状態及び車両諸元に基づき演算した
目標ヨーレートと道路の曲率半径及び車速から求められ
る目標ヨーレートとの偏差の絶対値の大きさと、操舵角
速度の絶対値の大きさとに応じて行うことを特徴とする
請求項1記載の車両運動制御装置。
5. The correction of the target yaw rate is performed by calculating an absolute value of a deviation between a target yaw rate calculated from a vehicle operating state including the steering angle and vehicle specifications and a target yaw rate obtained from a curvature radius of a road and a vehicle speed. The vehicle motion control device according to claim 1, wherein the control is performed in accordance with the magnitude and the magnitude of the absolute value of the steering angular velocity.
【請求項6】 操舵角を含む車両の運転状態と車両諸元
に基づき車両の目標とするヨーレートを演算し、この目
標ヨーレートを基に車両の駆動装置を動作して車両挙動
を制御する車両運動制御装置において、 上記目標ヨーレートの演算に用いる上記操舵角の入力信
号は、予め設定しておいた修正操舵の信号成分を除去し
て演算に用いることを特徴とする車両運動制御装置。
6. A vehicle motion for calculating a target yaw rate of a vehicle based on a vehicle operating condition including a steering angle and vehicle specifications, and operating a vehicle driving device based on the target yaw rate to control vehicle behavior. In the control device, the input signal of the steering angle used in the calculation of the target yaw rate may be used in the calculation after removing a preset correction steering signal component.
【請求項7】 上記車両の駆動装置は、各選択した車輪
に独立に制動力を付加する制動装置と左右輪間の差動を
制限する左右輪間差動制限装置と前後輪間の差動を制限
する前後輪間差動制限装置の少なくとも一つであること
を特徴とする請求項1,2,3,4,5,6のいずれか
一つに記載の車両運動制御装置。
7. A driving device for a vehicle, comprising: a braking device for independently applying a braking force to each selected wheel, a differential limiting device between left and right wheels for limiting differential between left and right wheels, and a differential between front and rear wheels. The vehicle motion control device according to any one of claims 1, 2, 3, 4, 5, and 6, wherein the vehicle motion control device is at least one of a front and rear wheel differential limiting device that restricts the vehicle speed.
JP4390598A 1998-02-25 1998-02-25 Vehicle motion control device Expired - Lifetime JP4094103B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP4390598A JP4094103B2 (en) 1998-02-25 1998-02-25 Vehicle motion control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP4390598A JP4094103B2 (en) 1998-02-25 1998-02-25 Vehicle motion control device

Publications (2)

Publication Number Publication Date
JPH11240458A true JPH11240458A (en) 1999-09-07
JP4094103B2 JP4094103B2 (en) 2008-06-04

Family

ID=12676739

Family Applications (1)

Application Number Title Priority Date Filing Date
JP4390598A Expired - Lifetime JP4094103B2 (en) 1998-02-25 1998-02-25 Vehicle motion control device

Country Status (1)

Country Link
JP (1) JP4094103B2 (en)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005280402A (en) * 2004-03-29 2005-10-13 Honda Motor Co Ltd Motion control device for vehicle
JP2005349887A (en) * 2004-06-09 2005-12-22 Nissan Motor Co Ltd Vehicular motion control device
JP2008179365A (en) * 2008-04-22 2008-08-07 Toyota Motor Corp Behavior control device for vehicle
JP2012529397A (en) * 2009-06-08 2012-11-22 ロベルト・ボッシュ・ゲゼルシャフト・ミト・ベシュレンクテル・ハフツング Method for generating differential torque acting on vehicle wheels of vehicle
KR101355351B1 (en) * 2012-01-12 2014-02-05 현대위아 주식회사 Vehicle Touque Distribution Control Apparatus and Controlling Method
JP2015085696A (en) * 2013-10-28 2015-05-07 富士重工業株式会社 Driving power distribution control device
CN109703546A (en) * 2017-10-25 2019-05-03 上汽通用汽车有限公司 Vehicular turn failure operating system and its control method
CN113682309A (en) * 2021-08-31 2021-11-23 中国第一汽车股份有限公司 Yaw control method of timely four-wheel drive system, vehicle and storage medium
CN113942062A (en) * 2021-09-23 2022-01-18 天津长荣科技集团股份有限公司 Method and system for calculating in-place of paper

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4511859B2 (en) * 2004-03-29 2010-07-28 本田技研工業株式会社 Vehicle motion control device
JP2005280402A (en) * 2004-03-29 2005-10-13 Honda Motor Co Ltd Motion control device for vehicle
JP2005349887A (en) * 2004-06-09 2005-12-22 Nissan Motor Co Ltd Vehicular motion control device
JP4561189B2 (en) * 2004-06-09 2010-10-13 日産自動車株式会社 Vehicle motion control device
JP2008179365A (en) * 2008-04-22 2008-08-07 Toyota Motor Corp Behavior control device for vehicle
US8818667B2 (en) 2009-06-08 2014-08-26 Robert Bosch Gmbh Method for producing a differential torque acting on the vehicle wheels of a vehicle
JP2012529397A (en) * 2009-06-08 2012-11-22 ロベルト・ボッシュ・ゲゼルシャフト・ミト・ベシュレンクテル・ハフツング Method for generating differential torque acting on vehicle wheels of vehicle
KR101355351B1 (en) * 2012-01-12 2014-02-05 현대위아 주식회사 Vehicle Touque Distribution Control Apparatus and Controlling Method
JP2015085696A (en) * 2013-10-28 2015-05-07 富士重工業株式会社 Driving power distribution control device
CN109703546A (en) * 2017-10-25 2019-05-03 上汽通用汽车有限公司 Vehicular turn failure operating system and its control method
CN113682309A (en) * 2021-08-31 2021-11-23 中国第一汽车股份有限公司 Yaw control method of timely four-wheel drive system, vehicle and storage medium
CN113682309B (en) * 2021-08-31 2024-03-26 中国第一汽车股份有限公司 Yaw control method of timely four-wheel drive system, vehicle and storage medium
CN113942062A (en) * 2021-09-23 2022-01-18 天津长荣科技集团股份有限公司 Method and system for calculating in-place of paper
CN113942062B (en) * 2021-09-23 2023-05-09 天津长荣科技集团股份有限公司 Paper in-place calculation method and system

Also Published As

Publication number Publication date
JP4094103B2 (en) 2008-06-04

Similar Documents

Publication Publication Date Title
JP3850530B2 (en) Vehicle motion control device
US4794539A (en) Propulsion control using steering angle and vehicle speed to determine tolerance range
JP3577375B2 (en) Traction control device for four-wheel drive vehicle
JP3946294B2 (en) Braking force control device
EP1514754B1 (en) Slip angle estimating method and system for a vehicle
US11548487B2 (en) Lane departure prevention system of vehicle
CN101657345A (en) Device and method for estimating frictional condition of ground contact surface of wheel
CA2220905C (en) Yaw moment control system in vehicle
US7614470B2 (en) Torque proportioning control system
JP5015632B2 (en) Vehicle braking force control device
EP2241470B1 (en) Front and rear drive power distribution control device for vehicle
JP4094103B2 (en) Vehicle motion control device
US6853886B2 (en) Method of estimating quantities that represent state of vehicle
US6810317B2 (en) System and method for controlling and/or regulating the handling characteristics of a motor vehicle
JP2007223388A (en) Device for state estimation and control of vehicle
JPH11115709A (en) Vehicle motion control device
JP2010149740A (en) Vehicle motion control apparatus
JPH0939762A (en) Controller for behavior of vehicle
JPH05278488A (en) Driving force distribution control device for four-wheel drive vehicle
JPH11240434A (en) Vehicle movement control unit
EP1731348A2 (en) Vehicle drive power distribution control device
JP3624929B2 (en) Stability factor derivation method and target yaw rate setting method for rear two-axle vehicle
JP3629916B2 (en) Stability factor derivation method and target yaw rate setting method for front biaxial vehicle
JP5042514B2 (en) Vehicle behavior control device
JP3629915B2 (en) Stability factor derivation method and target yaw rate setting method for rear two-axle vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20050127

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20070607

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20070612

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20070808

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20080305

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

Free format text: PAYMENT UNTIL: 20110314

Year of fee payment: 3

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

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

Free format text: PAYMENT UNTIL: 20110314

Year of fee payment: 3

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

Free format text: PAYMENT UNTIL: 20120314

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20120314

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20130314

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20130314

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20140314

Year of fee payment: 6

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

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

EXPY Cancellation because of completion of term