JPS63101169A - Operating condition estimating device for vehicle - Google Patents

Operating condition estimating device for vehicle

Info

Publication number
JPS63101169A
JPS63101169A JP61244043A JP24404386A JPS63101169A JP S63101169 A JPS63101169 A JP S63101169A JP 61244043 A JP61244043 A JP 61244043A JP 24404386 A JP24404386 A JP 24404386A JP S63101169 A JPS63101169 A JP S63101169A
Authority
JP
Japan
Prior art keywords
vehicle
value
detected
motion state
state quantity
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.)
Pending
Application number
JP61244043A
Other languages
Japanese (ja)
Inventor
Taketoshi Kawabe
川辺 武俊
Takeshi Ito
健 伊藤
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.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co 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 Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP61244043A priority Critical patent/JPS63101169A/en
Publication of JPS63101169A publication Critical patent/JPS63101169A/en
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D7/00Steering linkage; Stub axles or their mountings
    • B62D7/06Steering linkage; Stub axles or their mountings for individually-pivoted wheels, e.g. on king-pins
    • B62D7/14Steering linkage; Stub axles or their mountings for individually-pivoted wheels, e.g. on king-pins the pivotal axes being situated in more than one plane transverse to the longitudinal centre line of the vehicle, e.g. all-wheel steering
    • B62D7/15Steering linkage; Stub axles or their mountings for individually-pivoted wheels, e.g. on king-pins the pivotal axes being situated in more than one plane transverse to the longitudinal centre line of the vehicle, e.g. all-wheel steering characterised by means varying the ratio between the steering angles of the steered wheels
    • B62D7/159Steering linkage; Stub axles or their mountings for individually-pivoted wheels, e.g. on king-pins the pivotal axes being situated in more than one plane transverse to the longitudinal centre line of the vehicle, e.g. all-wheel steering characterised by means varying the ratio between the steering angles of the steered wheels characterised by computing methods or stabilisation processes or systems, e.g. responding to yaw rate, lateral wind, load, road condition
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric energy management in electromobility

Abstract

PURPOSE:To enable operation for modifying features of vehicle, as required, even after the vehicle has transferred to straight drive condition, by employing various detection values being stored when the vehicle is under turning condition repeatedly. CONSTITUTION:A detection value memory means 104 stores a steering angle thetas detected through a steering angle detection means 101, a vehicle speed V detected through a vehicle speed detection means 102 and a motion condition quantity M detected through a motion condition quantity detecting means 103 under turning condition of vehicle. A motion quantity condition quantity estimating means 105 obtains an estimated motion quantity M, from the values stored in the detection value memory means 104 based on a vehicle model preset as a motion formula employing features P of vehicle. A vehicle feature modifying means 106 compares the estimated motion quantity with the detected motion condition quantity M being stored in the detection value memory means 104, and modifies the features P of the vehicle model contained in the estimating means 105 based on the comparison results.

Description

【発明の詳細な説明】 (産業上の利用分野) この発明は、ステアリングハンドルの操舵角と車速とか
ら、車両の運動特性の制御に用い得る運動状Li量の推
定を行う車両運動状態推定装置に関するものである。
Detailed Description of the Invention (Industrial Application Field) The present invention relates to a vehicle motion state estimation device that estimates a motion state Li amount that can be used to control vehicle motion characteristics from the steering angle of a steering wheel and vehicle speed. It is related to.

(従来品技術) 上述の如き運動状態推定装置としては、例えば、本出願
人が先に特願昭60−50553号にて提案したものが
ある。
(Prior Art) As a motion state estimating device as described above, for example, there is one previously proposed by the present applicant in Japanese Patent Application No. 50553/1982.

この装置は、車両諸元に基づく運動方程式として予め設
定した車両モデルに関する演算を行ってステアリングハ
ンドルの操舵角(以下、単に操舵角と呼ぶ)と車速とに
対応する車両の運動状態量を推定するとともに、この推
定値を実際の検出値と比較して前記車両諸元をその走行
時の実際の値に修正するものであり、この装置によれば
、検出の比較的容易な運動状態量を用いて車両諸元を修
正することにて、他の運動状態量の推定精度を向上させ
ることができ、ひいては、それらの運動状態量の推定値
を用いて車両の運動特性の制御を行うに際し、その制御
精度を向上させることができる。
This device performs calculations on a vehicle model preset as a motion equation based on vehicle specifications to estimate the amount of motion state of the vehicle corresponding to the steering angle of the steering wheel (hereinafter simply referred to as the steering angle) and vehicle speed. At the same time, this estimated value is compared with the actual detected value to correct the vehicle specifications to the actual values at the time of driving. According to this device, the motion state quantity that is relatively easy to detect is used. By correcting the vehicle specifications, it is possible to improve the estimation accuracy of other motion state quantities, and in turn, when controlling the vehicle motion characteristics using the estimated values of those motion state quantities. Control accuracy can be improved.

(発明が解決しようとする問題点) ところで、本願発明者らは、上記従来の装置について研
究を重ねるうちに、次の改良点を見出した。
(Problems to be Solved by the Invention) By the way, the inventors of the present application discovered the following improvement point while conducting repeated research on the above-mentioned conventional device.

すなわち、この装置は、車載のマイクロコンピュータに
より、車両諸元を所定の小さな値だけ修正する演算処理
を所定時間毎に繰返し実行することにて、最終的に車両
諸元をその走行時の実際の値(適正値)に一致させるも
のであり、一方、この演算処理のための実際の運動状態
量の検出は、車両が旋回走行状態にある間しか行い得な
い。
In other words, this device uses an on-vehicle microcomputer to repeatedly perform arithmetic processing that corrects vehicle specifications by a predetermined small value at predetermined intervals, and ultimately converts the vehicle specifications to the actual state at the time of driving. On the other hand, the actual motion state quantity for this arithmetic processing can be detected only while the vehicle is in a turning state.

このため、上記の装置にあっては、車両諸元の修正前の
値が適正値と大きく異なっている場合に、旋回走行状態
の持続時間が充分に長くないと、第8図に示すように、
車両諸元の設定値(図中実線で示す)が適正値(図中鎖
線で示す)に充分収束しないうちに(図中tlで示す時
間にて)旋回走行状態が終了してしまい、設定値と適正
値との間に誤差eが残留することがあるという問題があ
った。
For this reason, with the above device, if the vehicle specifications before correction are significantly different from the appropriate values, if the duration of the turning state is not long enough, the ,
The turning running state ends (at the time indicated by tl in the figure) before the vehicle specification settings (indicated by the solid line in the figure) have sufficiently converged to the appropriate values (indicated by the chain line in the figure), and the set value There is a problem in that an error e may remain between the value and the appropriate value.

この発明は、かかる従来装置の問題点を改良した運動状
態推定装置を提供するものである。
The present invention provides a motion state estimating device that improves the problems of the conventional device.

(問題点を解決するための手段) この発明の車両運動状態推定装置は、第1図に示すよう
に、ステアリングハンドルの操舵角を検出する操舵角検
出手段101と、 車速を検出する車速検出手段102と、車両の運動状態
量を検出する運動状態量検出手段103と、 旋回走行状態の車両の前記操舵角、車速および運動状態
量の検出値を記憶する検出値記憶手段104と、 記憶されていた前記操舵角および車速から、車両諸元に
基づ(運動方程式として設定された車両モデルに関する
演算により、検出される前記運動状態量と同種の運動状
態量を推定して求める運動状態量推定手段105と、 運動状態量の前記推定値を、記憶されていた運動状態量
の前記検出値と比較し、その比較結果に基づき前記運動
状態量推定手段105の車両諸元を修正する車両諸元修
正手段106とを具えてなる。
(Means for Solving the Problems) As shown in FIG. 1, the vehicle motion state estimating device of the present invention includes a steering angle detecting means 101 for detecting the steering angle of a steering wheel, and a vehicle speed detecting means for detecting the vehicle speed. 102, a motion state quantity detection means 103 for detecting the motion state quantity of the vehicle, a detected value storage means 104 for storing the detected values of the steering angle, vehicle speed, and motion state quantity of the vehicle in the turning state; a motion state quantity estimating means for estimating and calculating a motion state quantity of the same type as the detected motion state quantity based on the vehicle specifications (by calculation regarding a vehicle model set as a motion equation) from the steering angle and vehicle speed; 105, and vehicle specification correction for comparing the estimated value of the motion state quantity with the detected value of the stored motion state quantity and correcting the vehicle specifications of the motion state quantity estimating means 105 based on the comparison result. means 106.

(作 用) かかる装置にあっては、操舵角検出手段101が検出し
たハンドル操舵角θ、と、車速検出手段102が検出し
た車速Vと、運動状態量検出手段103が検出した運動
状態量Mとの、車両が旋回走行状態の場合の値を検出値
記憶手段104が記憶し、運動状態量推定手段105が
、車両諸元値Pに基づく運動方程式として予め設定され
た車両モデルを用いて、前記検出値記憶手段104が記
憶していたハンドル操舵角θ、と車速Vとから、前記運
動状態量Mと同種の運動状態量9を推定して求め、そし
て、車両諸元修正手段106が、運動状BIの推定値富
を、前記検出値記憶手段104が記憶していた運動状態
量の検出値Mと比較して、その結果に基づき、前記運動
状態量推定手段105が有する車両モデルの車両諸元値
Pを適正値に修正する。
(Function) In such a device, the steering wheel steering angle θ detected by the steering angle detection means 101, the vehicle speed V detected by the vehicle speed detection means 102, and the motion state quantity M detected by the motion state quantity detection means 103. The detected value storage means 104 stores the value when the vehicle is in a turning running state, and the motion state amount estimating means 105 uses a vehicle model preset as a motion equation based on the vehicle specification value P. A motion state quantity 9 of the same type as the motion state quantity M is estimated and obtained from the steering wheel steering angle θ and vehicle speed V stored in the detected value storage means 104, and the vehicle specification correction means 106: The estimated value of the motion state BI is compared with the detected value M of the motion state quantity stored in the detected value storage means 104, and based on the result, the vehicle of the vehicle model possessed by the motion state quantity estimation means 105 is determined. Correct the specification value P to an appropriate value.

従って、この装置によれば、旋回走行状態である際に検
出値記憶手段104に記憶させておいた検出値θs、V
、Mを繰返し用いることにて、車両諸元値Pの修正のた
めの演算を、直進走行状態に移行した後も必要なだけ行
うことができるので、車両諸元の修正前の値が適正値と
大きく異なっている場合で、しかも旋回走行状態の持続
時間が短い場合でも、常に、車両諸元値Pを適正値に充
分良好に一致させる修正を行うことができる。
Therefore, according to this device, the detected values θs, V
, M can be repeatedly used to perform calculations for correcting the vehicle specification value P as many times as necessary even after the vehicle has shifted to the straight-ahead driving state, so that the value before correction of the vehicle specification is the appropriate value. Even if the vehicle specification value P is significantly different from the actual value and the duration of the turning state is short, the vehicle specification value P can always be corrected to sufficiently match the appropriate value.

(実施例) 以下に、この発明の実施例を図面に基づき詳細に説明す
る。
(Example) Hereinafter, an example of the present invention will be described in detail based on the drawings.

第2図は、この発明の車両運動状態推定装置の一実施例
を示す構成図であり、図中1は演算処理装置を示す。
FIG. 2 is a block diagram showing an embodiment of the vehicle motion state estimating device of the present invention, and numeral 1 in the figure indicates an arithmetic processing unit.

ここにおける演算処理装置1はマイクロコンピュータあ
るいは他の電気回路にて構成されるものであり、第2図
では機能ブロックで表されている。
The arithmetic processing device 1 here is constituted by a microcomputer or other electric circuit, and is represented by functional blocks in FIG.

この例の装置はまた、この装置の搭載される車両(以下
、自軍と呼ぶ)のステアリングハンドルの操舵角θ、を
検出する、操舵角検出手段101としての操舵角センサ
2と、自車の車速Vを検出する、車速検出手段102と
しての車速センサ3と、自車の運動状態量の一つである
ヨーレートMを検出する、運動状態量検出手段103と
してのヨーレートセンサ4とを具え、さらに、自軍が旋
回走行中であることの判定のための、自軍の重心点での
横加速度を検出する重心点検加速度センサ5および自軍
の非重心点での横加速度を検出する非重心点横加速度セ
ンサ6と、後述するコーナリングパワーKF +K11
の修正のための横方向速度センサ7とを具える。
The device of this example also includes a steering angle sensor 2 as a steering angle detecting means 101 for detecting the steering angle θ of the steering wheel of a vehicle on which this device is mounted (hereinafter referred to as own vehicle), and a vehicle speed of the own vehicle. A vehicle speed sensor 3 serving as a vehicle speed detecting means 102 for detecting V, and a yaw rate sensor 4 serving as a moving state quantity detecting means 103 for detecting a yaw rate M, which is one of the moving state quantities of the own vehicle, and further, A center-of-gravity inspection acceleration sensor 5 detects lateral acceleration at the center of gravity of the own force, and a non-center-of-gravity lateral acceleration sensor 6 detects lateral acceleration at a non-center of gravity point of the own force, for determining whether the own force is turning. and cornering power KF +K11, which will be described later.
and a lateral velocity sensor 7 for correction of.

演算処理装置1は、第2図に示すように、検出値記憶手
段104としての検出値記憶部11と、運動状態量推定
手段105としての運動状態量推定値演算部12と、自
車の車両諸元の一つであるヨー慣性モーメンH2の修正
のための、車両諸元修正手段106としてのヨー慣性モ
ーメント適正値演算部13とを具え、これらの他に、自
軍が旋回走行中であることを判定するための旋回走行判
定部14および定常旋回走行判定部15と、運動状態量
推定値演算部12が用いるスタビリテイファクタAの修
正のための、スタビリテイファクタ適否判定部16およ
びスタビリテイファクタ適正値演算部17と、運動状態
量推定値演算部12が用いる前後輪コーナリングパワー
Kr、に*の修正のための、コーナリングパワー適否判
定部18およびコーナリングパワー適正値演算部19と
を具えてなる。
As shown in FIG. 2, the arithmetic processing device 1 includes a detected value storage unit 11 as a detected value storage unit 104, a motion state quantity estimated value calculation unit 12 as a motion state quantity estimation unit 105, and a vehicle It is equipped with a yaw moment of inertia appropriate value calculation unit 13 as a vehicle specification correction means 106 for correcting the yaw moment of inertia H2, which is one of the specifications, and in addition to these, it is necessary to confirm that the own army is running in a turn. A stability factor suitability determination unit 16 and a stability factor determination unit 16 for correcting the stability factor A used by the motion state quantity estimated value calculation unit 12. The cornering power appropriateness determination unit 18 and the cornering power appropriate value calculation unit 19 are provided for correcting * in the front and rear wheel cornering power Kr used by the appropriate value calculation unit 17 and the motion state quantity estimated value calculation unit 12. .

ここで、検出値記憶部11は、コーナリングパワー適否
判定部18が後述する信号Foを出力すると、操舵角セ
ンサ2から出力される操舵角検出値θ。
Here, the detected value storage unit 11 stores the steering angle detected value θ output from the steering angle sensor 2 when the cornering power suitability determination unit 18 outputs a signal Fo, which will be described later.

と、車速センサ3から出力される車速検出値Vと、ヨー
レートセンサ4から出力されるヨーレート検出僅少とを
、自軍が旋回走行している間についてのみ所定時間毎に
記憶して、ヨー慣性モーメントI2を修正させるための
信号F SINを出力するとともに、記憶した各検出値
声、θ8、およびVを出力する。
The vehicle speed detection value V output from the vehicle speed sensor 3 and the yaw rate detection slight output from the yaw rate sensor 4 are stored at predetermined time intervals only while the own army is turning, and the yaw inertia moment I2 is stored. It outputs a signal F_SIN for correcting , and also outputs each stored detected value, θ8, and V.

またここで、運動状態量推定値演算部12は、検出値記
憶部11が信号F SINを出力しないときは、センサ
2.3から出力される操舵角検出値θ、および車速検出
値Vから、自車の車両諸元に基づく運動方程式として予
め設定された車両モデルを用い、ヨーレート推定値ψ、
ヨー角加速度推定値ψ、横方向速度推定値vy、および
横方向並進加速度推定値vyを演算して、これらを出力
し、検出値記憶部11が信号F SINを出力したとき
は、検出値記憶部11から出力される、記憶されていた
操舵角検出値θ、および車速Vから、上記車両モデルを
用いてヨーレート推定値ψを求め、これを出力する。
Here, when the detected value storage unit 11 does not output the signal F SIN, the motion state quantity estimated value calculation unit 12 calculates the following from the detected steering angle value θ and the detected vehicle speed value V output from the sensor 2.3. Using a vehicle model set in advance as a motion equation based on the vehicle specifications of the own vehicle, the estimated yaw rate ψ,
The estimated yaw angular acceleration value ψ, the estimated lateral velocity vy, and the estimated lateral translational acceleration value vy are calculated and output, and when the detected value storage unit 11 outputs the signal F SIN, the detected value storage unit 11 outputs the signal F SIN. The estimated yaw rate ψ is determined from the stored steering angle detection value θ and the vehicle speed V outputted from the unit 11 using the vehicle model, and is output.

そして、ヨー慣性モーメント適正値演算部13は、検出
値記憶部11から出力される、記憶されていたヨーレー
ト検出僅少と、運動状態量推定値演算部12から出力さ
れるヨーレート推定僅少とに基づきヨー慣性モーメント
lzの適正値を演算し、これを出力する。
Then, the yaw inertia appropriate value calculation unit 13 calculates the yaw rate based on the stored yaw rate detection slight output from the detection value storage unit 11 and the yaw rate estimation slight output from the motion state quantity estimated value calculation unit 12. An appropriate value of the moment of inertia lz is calculated and output.

この一方、旋回走行判定部14は、センサ2.4から出
力される操舵角検出値θ3およびヨーレート検出値φと
、重心点検加速度センサ5から出力される重心点検加速
度検出値α。と、運動状態量推定値から出力されるヨー
レート推定値ψとに基づき自軍が旋回走行中であるか否
かを判定して、旋回走行中であると判定した場合には信
号Fアを出力し、定常旋回走行判定部15は、旋回走行
判定部14が信号F7を出力すると、重心点および非重
心点横加速度センサ5,6から出力される重心点および
非重心点横加速度検出値α。、α1と、運動状態量推定
値演算部12から出力される、ヨー角加速度推定値ψお
よび横方向並進加速度推定値vyとに基づき自軍が定常
旋回走行中であるか否かを判定して、定常旋回走行中で
あると判定した場合には信号pioを出力する。
On the other hand, the turning running determination unit 14 uses the steering angle detection value θ3 and the yaw rate detection value φ output from the sensor 2.4, and the center of gravity inspection acceleration detection value α output from the center of gravity inspection acceleration sensor 5. and the yaw rate estimate ψ output from the motion state quantity estimate, it is determined whether or not the own army is turning, and if it is determined that it is turning, it outputs the signal Fa. When the turning determination unit 14 outputs the signal F7, the steady turning determination unit 15 detects the centroid and non-gravity lateral acceleration detection values α output from the gravity and non-gravity lateral acceleration sensors 5 and 6. , α1, and the estimated yaw angular acceleration value ψ and estimated lateral translational acceleration value vy output from the motion state quantity estimated value calculation unit 12, and determine whether or not the own army is in steady turning. If it is determined that the vehicle is in steady turning mode, a signal pio is output.

またここで、スタビリテイファクタ適否判定部16は、
定常旋回走行判定部15が信号Fア。を出力すると、上
述したヨーレート検出値テとヨーレート推定値ψとに基
づき、運動状態量推定値演算部12の車両モデルによっ
て求められるステビリティファクタAが適正値であるか
否かを判定して、適正値でないと判定した場合には、信
号F’stを出力するとともに、所定数の操舵角検出値
θ、と車速検出値■とヨーレート検出値φとをそれぞれ
平均化した値θ、■、φを出力し、スタビリテイファク
タ適正値演算部17は、スタビリテイファクタ適否判定
部16が信号F’stを出力すると、上記平均値θ。
In addition, the stability factor suitability determination unit 16
The steady turning running determination section 15 outputs the signal Fa. is output, it is determined whether or not the stability factor A obtained by the vehicle model of the motion state quantity estimation value calculation unit 12 is an appropriate value based on the above-mentioned yaw rate detection value te and yaw rate estimation value ψ. If it is determined that the value is not appropriate, a signal F'st is output, and values θ, ■, φ are averaged from a predetermined number of detected steering angle values θ, vehicle speed detection value ■, and yaw rate detection value φ, respectively. When the stability factor appropriateness determination section 16 outputs the signal F'st, the stability factor appropriate value calculation section 17 calculates the above average value θ.

■、ψに基づきスタビリテイファクタAを演算して、こ
のスタビリテイファクタAを所定数集めた後、それらに
ついて平均化した値Aを適正値として出力する。
(2) A stability factor A is calculated based on ψ, and after a predetermined number of stability factors A are collected, a value A obtained by averaging them is output as an appropriate value.

さらに、ここにおけるコーナリングパワー適否判定部1
8は、スタビリテイファクタAが適正値となると、横方
向速度センサ7から出力される横方向速度検出値Vyと
、上述した横方向速度推定値Vyとに基づき、運動状態
量推定値演算部12の車両モデルに与えられた自軍の車
両諸元の一部としての前後輪コーナリングパワーに、、
にえが適正値であるか否かを判定して、適正値であると
判定した場合には信号FDを出力し、コーナリングパワ
ー適正値演算部19は、コーナリングパワー適否判定部
18が車両モデルの前後輪コーナリングパワーKF、に
*を適正値でないと判断すると、車速検出値■と、横方
向速度検出値vyと、スタビリテイファクタ平均値λ(
車両モデルによって求められるスタビリテイファクタが
適正値の場合はその値)に基づき、前輪コーナリングパ
ワーに、および後輪コーナリングパワーKRの適正値を
演算して、これらを出力する。
Furthermore, the cornering power suitability determination section 1 here
8 is a motion state quantity estimated value calculation unit 12 based on the lateral velocity detected value Vy outputted from the lateral velocity sensor 7 and the above-mentioned lateral velocity estimated value Vy when the stability factor A becomes an appropriate value. The front and rear wheel cornering power as part of the military vehicle specifications given to the vehicle model of
The cornering power appropriate value calculation unit 19 determines whether or not the cornering power is an appropriate value, and outputs a signal FD if it is determined to be an appropriate value, and the cornering power appropriateness determination unit 18 outputs a signal FD. If it is determined that * is not an appropriate value for the front and rear wheel cornering power KF, the detected vehicle speed value ■, the detected lateral speed value vy, and the stability factor average value λ(
Based on the stability factor determined by the vehicle model (if it is an appropriate value), appropriate values for front wheel cornering power and rear wheel cornering power KR are calculated and output.

第3図〜第6図は、上記演算処理装置1をマイクロコン
ピュータを用いて構成した場合にこの演算処理装置lが
実行する演算および処理のプログラムを示すフローチャ
ートであり、以下に、これらのフローチャートの説明と
ともにこの実施例の動作を説明する。
3 to 6 are flowcharts showing calculation and processing programs executed by the arithmetic processing device 1 when the arithmetic processing device 1 is configured using a microcomputer. The operation of this embodiment will be explained along with the explanation.

第3図に示すプログラムは、第2図中の運動状態量推定
値演算部12、ヨー慣性モーメント適正値演算部13.
旋回走行判定部14、定常旋回走行判定部15、スタビ
リテイファクタ適否判定部16およびコーナリングパワ
ー適否判定部18に相当する機能を有するものであり、
イグニッションスイッチがONとされて電源の供給がな
されると各変数、フラグおよび検出値記憶用メモリの内
容がクリア(=0)とされ、その後所定時間Δを毎に繰
返し実行される。
The program shown in FIG. 3 includes the motion state quantity estimated value calculation section 12, the yaw inertia moment appropriate value calculation section 13.
It has functions corresponding to the turning running determination section 14, the steady turning running determining section 15, the stability factor suitability determining section 16, and the cornering power suitability determining section 18,
When the ignition switch is turned on and power is supplied, the contents of each variable, flag, and detected value storage memory are cleared (=0), and thereafter, the process is repeated every predetermined time period Δ.

ここでは先ず、ステップ21で、自軍車両諸元の一つと
してのヨー慣性モーメン)Izの修正を指示する、後述
のフラグF’s+やが1であるか否かを判定し、FSI
M=1でなければ(プログラムの初回実行時も、FSI
M=0であるので)ステップ22に進む。またFs+M
=1であれば、後述するヨー慣性適正値演算処理のステ
ップ81に進む。
First, in step 21, it is determined whether a flag F's+, which will be described later, instructs correction of the yaw moment of inertia (Iz), which is one of the specifications of the own vehicle, is 1, and the FSI
If M = 1 (even when the program is executed for the first time, the FSI
Since M=0), proceed to step 22. Also Fs+M
If =1, the process proceeds to step 81 of yaw inertia appropriate value calculation processing, which will be described later.

そして、ステップ22では、自軍の運動状態を表す車両
モデルとして設定した以下の運動方程式と、推定式とに
関する演算を逐次行って、センサ2゜3から出力される
操舵角検出値θ、および車速検出値■から、ヨーレート
推定値少、ヨー角加速度推定値ψ、横方向速度推定値v
y、および横方向並進加速度推定値V、を求める。
Then, in step 22, calculations regarding the following equation of motion set as a vehicle model representing the movement state of the own army and the estimation formula are performed one after another, and the detected steering angle value θ and the detected vehicle speed output from the sensors 2 and 3 are calculated. From the value ■, the estimated yaw rate is small, the estimated yaw angular acceleration is ψ, and the estimated lateral velocity is v.
y, and the estimated lateral translational acceleration value V.

イト ψ”a+” ψ+a、・V、+b、−6g  ・(1’
)イ\ ■、=33・ψ+aa’ Vy”bz’ θs  ””
(2)ψ= f、pat            ・・
・ (3)但し、式(1) 、 (2)は運動方程式、
式(3) 、 (4)は推定式であって、 であり、ここで、 LF ;自車の前車輪と重心との間の距離LR;自車の
後車輪と重心との間の距離M ;自車の車両質量 N ;ステアリングギヤ比 である。尚、これら、LF、Lll、M、NおよびKF
 、Km 、Izは自車の車両諸元としてあらかじめ値
を設定しである。
It ψ"a+" ψ+a, ・V, +b, -6g ・(1'
)I\ ■、=33・ψ+aa'Vy”bz' θs ””
(2) ψ= f, pat...
・(3) However, equations (1) and (2) are equations of motion,
Equations (3) and (4) are estimation equations, where: LF; distance LR between the front wheels of the own vehicle and the center of gravity; distance M between the rear wheels and the center of gravity of the own vehicle ; Vehicle mass N of own vehicle; Steering gear ratio. In addition, these, LF, Lll, M, N and KF
, Km, and Iz are values set in advance as vehicle specifications of the own vehicle.

次にここではステップ23に進み、このステップ23で
は、検出値の記憶準備ができたことを示す後述のフラグ
FDが1であるか否かを判定して、F。
Next, the process proceeds to step 23, in which it is determined whether or not a flag FD, which will be described later, is 1, indicating that preparations for storing detected values are complete.

・1であれば、後述する検出値記憶サブルーチンに進む
。また、F、=1でなければ、引続くステップ24に進
む。
- If it is 1, proceed to the detected value storage subroutine described later. Moreover, if F,=1 is not found, the process proceeds to the subsequent step 24.

ステップ24では、センサ2.4.5から出力される操
舵角検出値θ8、ヨーレート検出値iおよび重心点検加
速度検出値α。と、ステップ22で求めたヨーレート推
定値ψとの各々について絶対値を求め、これらの絶対値
1θsl、IMl、lα。11ψ1がそれぞれ、それら
に対応する所定値以上であるときは、旋回走行中である
と判定し得ることからステップ25に進み旋回走行を示
すフラグFTを1とする。また、上記絶対値1θs  
1.Ill。
In step 24, the steering angle detection value θ8, the yaw rate detection value i, and the center of gravity inspection acceleration detection value α are output from the sensor 2.4.5. and the yaw rate estimated value ψ obtained in step 22, and obtain these absolute values 1θsl, IMl, lα. When 11ψ1 are each greater than or equal to the corresponding predetermined value, it can be determined that the vehicle is turning, so the process proceeds to step 25 and a flag FT indicating turning is set to 1. In addition, the above absolute value 1θs
1. Ill.

Iα。1,1ψ1の少なくとも一つが、対応する所定値
未満のときは、旋回走行中でないと判定してステップ2
6に進み、フラグF、を0とする。
Iα. When at least one of 1 and 1ψ1 is less than the corresponding predetermined value, it is determined that the vehicle is not turning and the process proceeds to step 2.
Proceed to step 6 and set flag F to 0.

その後はステップ27にて、フラグF、が1であるか否
かを判定し、F7=1であればステップ28に進み、F
T=1でなければリターンする。
Thereafter, in step 27, it is determined whether the flag F is 1, and if F7=1, the process proceeds to step 28,
If T=1, return.

これらのステップ24〜27によれば、自軍が旋回走行
中か否かを判定することができる。
According to these steps 24 to 27, it is possible to determine whether or not the own army is turning.

ステップ28では、センサ5,6から出力される重心点
および非重心点横加速度検出値α。、α1と、ステップ
22で求めたヨー角加速度推定値ψおよび横方向並進加
速度推定値■、とについて、1α。−α11ユ0.  
lψ1Σ0.IV、l=0の条件が全て満足されるかど
うかを調べ、上記の条件が全て満足されるときは、定常
旋回走行中であると判定し得ることからステップ29に
進み定常旋回走行中を示すフラグF7゜を1とする。ま
た、上記の条件が1つでも満足されないときは、定常旋
回走行中でないと判定してステップ30に進みフラグF
丁。を0とする。
In step 28, the centroid point and non-gravity center point lateral acceleration detection values α output from the sensors 5 and 6. , α1, and the estimated yaw angular acceleration value ψ and the estimated lateral translational acceleration value ■ obtained in step 22, 1α. -α11yu0.
lψ1Σ0. It is checked whether all the conditions of IV and l=0 are satisfied, and if all the above conditions are satisfied, it can be determined that the vehicle is in steady turning mode, so the process proceeds to step 29, indicating that steady turning mode is in progress. Set flag F7° to 1. In addition, if even one of the above conditions is not satisfied, it is determined that steady turning is not being performed, and the process proceeds to step 30, where the flag F
Ding. Let be 0.

そして、ステップ31では、フラグF、。が1であるか
否かを判定し、Fyo=1であればステップ33に進み
、F7゜=1でなければ、ステップ32に進んで、後述
する、CI+ Σθ8.ΣV、Σ灸を全てクリヤ(・0
)とした後リターンする。
Then, in step 31, the flag F. is 1, and if Fyo=1, the process proceeds to step 33; if F7°=1, the process proceeds to step 32, and CI+Σθ8. Cleared all ΣV and Σ moxibustion (・0
) and then returns.

これらのステップ28〜32によれば、自軍が定常旋回
中であるか否かを判定することができる。
According to these steps 28 to 32, it is possible to determine whether or not the own army is making a steady turn.

ステップ33では、センサ4から出力されるヨーレート
検出値ψと、ステップ22で求めたヨーレート推定値φ
とかり1ψ−91を求めて1ψ−ψ1ユ0であるか否か
を判定し、そうであれば、車両諸元から導かれるスタビ
リテイファクタAが適正値であると考え得ることからス
テップ34に進み、また1ψ−ψl=oでないときは、
スタビリテイファクタAが適正値でないと判断して、後
述するスタビリテイファクタ適正値演算サブルーチンに
進む。
In step 33, the yaw rate detection value ψ output from the sensor 4 and the yaw rate estimated value φ obtained in step 22 are determined.
Then, 1ψ-91 is determined and it is determined whether or not 1ψ-ψ1 is 0. If so, the stability factor A derived from the vehicle specifications can be considered to be an appropriate value, so proceed to step 34. Proceed, and when 1ψ−ψl=o,
It is determined that the stability factor A is not an appropriate value, and the process proceeds to a stability factor appropriate value calculation subroutine to be described later.

このようにして、このステップ33では、スタビリテイ
ファクタが適正値であるか否かの判定を行うことができ
る。
In this way, in this step 33, it can be determined whether the stability factor is an appropriate value.

スタビリテイファクタ適正値演算サブルーチンは、上述
の如くフラグF31M=0であって自軍が旋回走行中、
しかも定常旋回走行中で、かつスタビリテイファクタA
が適正値でないときに実行されるものであり、そのフロ
ーチャートは第4図に示す。
The stability factor appropriate value calculation subroutine is executed when flag F31M=0 and the own army is turning, as described above.
Moreover, the stability factor A is
This is executed when the value is not an appropriate value, and its flowchart is shown in FIG.

ここでは先ずステップ41にて、変数軸に1を加算し、
次に、ステップ42にて、センサ2,3゜4からそれぞ
れ出力される操舵角検出値θ8、車速検出値V、ヨーレ
ート検出値声を前回の当該ステップ実行時の各々の合計
値Σθ8.Σ■、Σ声にそれぞれ加算する。
Here, first in step 41, 1 is added to the variable axis,
Next, in step 42, the detected steering angle value θ8, the detected vehicle speed value V, and the detected yaw rate value output from the sensors 2 and 3°4 are converted to the respective sum values Σθ8. Add to Σ■ and Σvoice, respectively.

そしてステップ43では、C3が所定数xI以上となっ
たか否かを判定して、C1≧X、であればステップ44
に進んでフラグF、を1とし、またC1≧XIでなけれ
ばステップ45にてフラグF、をOとする。
Then, in step 43, it is determined whether C3 is greater than or equal to a predetermined number xI, and if C1≧X, step 44
Step 45 sets flag F to 1, and if C1≧XI does not hold, flag F is set to O in step 45.

その後のステップ46では、フラグF、が1であるか否
かを判定し、F、=1であればステップ47に進み、F
、=1でなければリターンして上述の演算処理を繰返す
In the subsequent step 46, it is determined whether the flag F, is 1 or not, and if F,=1, the process proceeds to step 47;
, if not equal to 1, the program returns and repeats the above-mentioned arithmetic processing.

これらのステップ41〜46によれば、θ6.■。According to these steps 41 to 46, θ6. ■.

声について少なくともL個のデータを検出する間に自軍
が定常旋回走行を続けた場合の各合計値ΣΣθ8.ΣV
、Σ少を求めることができる。
Each total value ΣΣθ8 when the own army continues steady turning while detecting at least L pieces of data regarding voices. ΣV
, Σ can be found.

ステップ47では、上記合計値Σθ8.ΣV。In step 47, the total value Σθ8. ΣV.

Σφの各々をこのステップでは検出個数となったCIで
割って、検出値の平均値θ!+V+ φを求め、次のス
テップ48では、これの平均値から次式を用いてスタビ
リテイファクタAを求める。
Each of Σφ is divided by CI, which is the number of detections in this step, to obtain the average value θ! of the detected values. +V+φ is determined, and in the next step 48, the stability factor A is determined from the average value using the following equation.

さらにステップ49では、ステップ48で求めたスタビ
リテイファクタAを前回の当該ステップ実行時の合計値
ΣAに加算し、ステップ50では変数C!に1を加算す
る。
Further, in step 49, the stability factor A obtained in step 48 is added to the total value ΣA at the previous execution of the step, and in step 50, the stability factor A obtained in step 48 is added to the total value ΣA of the previous execution of the step, and in step 50, the variable C! Add 1 to .

そしてここではステップ51に進み、このステップ51
では02が所定数X2以上となったか否かを判定して、
C2≧Xtでなければステップ55にてΣθ3゜Σ■、
Σφ、C1を全てクリヤ(・O)とした後リターンして
上述の演算処理を繰返し、またC2≧X2であれば、ス
テップ52に進んで、合計値ΣAをこのステップではA
の個数となったC2で割ってスタビリテイファクタの平
均値Aを求める。
And here we proceed to step 51, and this step 51
Then, determine whether 02 is greater than or equal to the predetermined number X2,
If C2≧Xt does not hold, in step 55 Σθ3゜Σ■,
After clearing all Σφ and C1 (・O), return and repeat the above calculation process. If C2≧X2, proceed to step 52 and set the total value ΣA to A in this step.
The average value A of the stability factors is determined by dividing by C2, which is the number of stability factors.

引続くステップ53では、下記の表−1に示すようにス
タビリテイファクタ平均値Aに対応させて次式を満足す
るようあらかじめ設定し、メモリ内にデータテーブルと
して記憶させておいた前後輪コーナリングパワーKF 
、に、の暫定値を読出して、これらの暫定値Kr 、K
Rをステップ22で用いる式(11,(2)におけるK
F+Kjlと置換える。
In the subsequent step 53, the front and rear wheel cornering powers are calculated in advance and stored in the memory as a data table in correspondence with the stability factor average value A to satisfy the following formula as shown in Table 1 below. KF
, and read out the provisional values of Kr and K.
K in equation (11, (2)) using R in step 22
Replace with F+Kjl.

K、・K R2(LF +L* )” ・・・ (6) (表−1) そして、ステップ54ではC2とΣAとをクリヤ(=0
)とし、その後はリターンする。これらのステップ47
〜55によれば、スタビリテイファクタの適正値とみな
し得る平均値Xを求めることができ、さらに、この平均
値Aをもたらす前後輪コーナ°リングパワーの暫定値K
F、KRを求めることができる。
K,・K R2(LF +L*)" ... (6) (Table-1) Then, in step 54, C2 and ΣA are cleared (=0
) and then return. These steps 47
According to ~55, it is possible to obtain an average value X that can be considered as an appropriate value of the stability factor, and furthermore, a provisional value K of the cornering power of the front and rear wheels that brings about this average value A.
F and KR can be obtained.

上述のように、スタビリテイファクタ適正値演算サブル
ーチンは、第2図中のスタビリテイファクタ適正値演算
部17として機能する。
As described above, the stability factor appropriate value calculation subroutine functions as the stability factor appropriate value calculation section 17 in FIG.

スタビリテイファクタ適正値演算サブルーチンによって
スタビリテイファクタが適正値となると、第3図のプロ
グラムは次回の実行時には、フラグFt+s=0で、自
車が定常旋回中であればステップ33を経てステップ3
4に進む。
When the stability factor becomes an appropriate value by the stability factor appropriate value calculation subroutine, the next time the program in FIG.
Proceed to step 4.

このステップ34では、センサ7から出力される横方向
速度検出値V、と、ステップ22で求めた横方向速度推
定値V、とからV、−V、を求めてV。
In step 34, V and -V are determined from the detected lateral velocity value V output from the sensor 7 and the estimated lateral velocity value V determined in step 22.

−V、=Oであるか否かを判定し、そうであれば、前後
輪コーナリングパワーKF +Klが適正値であると考
え得ることから、ステップ36に進み、このステップで
検出値の記憶準備ができたことを示すFt、を1とした
後リターンする。またV、−V、Σ0でなければ、Kr
、Kmが適正値でないと判断して、ステップ35でフラ
グF、を0とした後、コーナリングパワー適正値演算サ
ブルーチンに進む。
It is determined whether or not -V,=O, and if so, it can be considered that the front and rear wheel cornering power KF +Kl is an appropriate value, so the process proceeds to step 36, and in this step, preparations for storing the detected values are made. Return after setting Ft, which indicates completion, to 1. Also, if V, −V, and Σ0 are not present, Kr
, Km are not appropriate values, and after setting the flag F to 0 in step 35, the program proceeds to the cornering power appropriate value calculation subroutine.

従って、これらのステップ34〜36では、前後輪コー
ナリングパワーKF、Kllが適正値であるか否かを判
定することができる。
Therefore, in these steps 34 to 36, it can be determined whether the front and rear wheel cornering powers KF and Kll are appropriate values.

コーナリングパワー適正値演算サブルーチンは、上述の
ように、フラグF !IN・0であって、自軍が定常旋
回走行中であり、かつスタビリテイファクタが適正値で
あって、前後輪コーナリングパワーKF、KRが適正値
でないときに実行されるものであり、そのフローチャー
トは第5図に示す。
As mentioned above, the cornering power appropriate value calculation subroutine is executed when the flag F! This is executed when IN・0, the own army is making a steady turn, the stability factor is an appropriate value, and the front and rear wheel cornering powers KF and KR are not appropriate values.The flowchart is as follows. It is shown in FIG.

このサブルーチンは先ず、ステップ61にてセンサ7か
ら出力される横方向速度検出値V、が■。
In this subroutine, first, in step 61, the detected lateral velocity value V output from the sensor 7 is ■.

=0となる状態を選択し、この状態における、センサ3
から出力される車速検出値Vをステップ62で前回の当
該ステップ実行時の合計値ΣVに加算し、ステップ63
では変数C1に1を加算する。
Select a state where = 0, and in this state, sensor 3
In step 62, the vehicle speed detection value V output from
Now, add 1 to variable C1.

そしてステップ64では、C8が所定数X1以上となっ
たか否かを判定し、C5≧X、でなければその後リター
ンして上述の演算処理を繰返し、またC3≧X3であれ
ば、ステップ65に進んで、合計値ΣVをこのステップ
ではVの個数となったC3で割ってV、=Oにおける車
速検出値Vの平均値V、を求める。
Then, in step 64, it is determined whether C8 is equal to or greater than a predetermined number Then, the total value ΣV is divided by C3, which is the number of V in this step, to obtain the average value V of the vehicle speed detection values V at V,=O.

引続くステップ66では、ステップ65で求めた平均値
vPから、次式を用いて後輪コーナリングパワーKRの
適正値を求める。
In the subsequent step 66, an appropriate value of the rear wheel cornering power KR is determined from the average value vP determined in step 65 using the following equation.

そして、ステップ67では、上記Klの適正値と、スタ
ビリテイファクタの適正値である平均値Aとから、次式
を用いて前輪コーナリングパワーKFの適正値を求める
Then, in step 67, the appropriate value of the front wheel cornering power KF is determined from the appropriate value of Kl and the average value A, which is the appropriate value of the stability factor, using the following equation.

このようにして、このコーナリングパワー適正値演算サ
ブルーチンは、第2図中のコーナリングパワー適正値演
算部19として機能し、前後輪コーナリングパワーに、
、Klの適正値を求めることができ、これらの適正値は
、上述した暫定値から置換えられて、ステップ22にお
ける式(11,(2)で用いられる。
In this way, this cornering power appropriate value calculation subroutine functions as the cornering power appropriate value calculation section 19 in FIG. 2, and calculates the cornering power of the front and rear wheels.
, Kl can be determined, and these appropriate values are used in equations (11 and (2)) in step 22, replacing the above-mentioned provisional values.

コーナリングパワー適正値演算サブルーチンによってコ
ーナリングパワーが適正値となると、第3図のプログラ
ムは次回の実行時には、フラグF31M−0で自軍が定
常旋回走行中であり、かつスタビリテイファクタが適正
値のままであれば、ステップ34を経てステップ36に
進み、このステップでフラグFoを1とした後リターン
する。
When the cornering power is set to an appropriate value by the cornering power appropriate value calculation subroutine, the next time the program in Figure 3 is executed, flag F31M-0 indicates that the team is in steady turning mode and the stability factor remains at the appropriate value. If there is, the process proceeds to step 36 via step 34, where the flag Fo is set to 1, and then the process returns.

その後、第3図のプログラムは、フラグF !11H=
Oであればステップ23で、FD・ 1であることから
検出値記憶サブルーチンに進む。
After that, the program of FIG. 3 sets the flag F! 11H=
If it is O, then in step 23, since it is FD.1, the process proceeds to the detected value storage subroutine.

検出値記憶サブルーチンは第2図中の検出値記憶部11
として機能するものであり、そのフローチャートは第6
図に示す。
The detected value storage subroutine is performed in the detected value storage section 11 in FIG.
The flowchart is shown in the 6th section.
As shown in the figure.

このサブルーチンは先ずステップ71にて、メモリ内に
収集した検出値数を示す変数C#が所定数X#以上であ
るか否かを判定し、C4≧X4であれば、メモリ内に充
分な数の検出値があると判断して後述するステップ78
に進み、またC4≧X4でなければ、ステップ72にて
、メモリ内の04番地にセンサ2.3.4から出力され
る操舵角検出値θ8、車速検出値Vおよびヨーレート検
出値声を書込む。
This subroutine first determines in step 71 whether the variable C# indicating the number of detected values collected in the memory is greater than or equal to a predetermined number X#, and if C4≧X4, there is a sufficient number in the memory. It is determined that there is a detected value of
If C4 ≧ .

そして次のステップ73では、操舵角検出値θ。In the next step 73, the detected steering angle value θ is determined.

の絶対値1θ、1が所定の角度χ、を越えているか否か
を判定し、1θsl>Xsであれば旋回走行中であると
判断して、ステップ74で04に1を加えることにてメ
モリ内の次の番地を準備し、1θ。
It is determined whether the absolute value 1θ, 1 of Prepare the next address in 1θ.

1〉X、でなければ旋回走行が終了したと判断して変数
C3を1とする。
If it is not 1>X, it is determined that the turning has ended and the variable C3 is set to 1.

引続くステップ76ではC4とC3を乗じて変数C,を
求める。
In the subsequent step 76, a variable C is obtained by multiplying C4 and C3.

この変数06は、メモリ内に検出値が全く無いか、自軍
が旋回走行しており検出値を収集中であるときに0とな
り、メモリ内に少なくとも1個の検出値があって自軍が
直進状態に移行し、ヨー慣性モーメント■2の修正準備
ができると1以上になることから、次のステップ77で
は、C6がOか否かを判定し、Ch−0でなければ、ス
テップ78にてヨー慣性モーメントI2の修正を指示す
るフラグF SINを1とする。またch−0であれば
、ステップ79でフラグF□、をOとして検出値の収集
を続ける。そして、ステップ80ではF++・ Oとし
てて、自軍が定常旋回走行中でありかつスタビリテイフ
ァクタAおよび前後輪コーナリングパワーK F +K
mが適正値であるときに各検出値の記憶を行うようにす
る。
This variable 06 becomes 0 when there is no detected value in the memory or when the own army is turning and collecting detected values, and it becomes 0 when there is at least one detected value in the memory and the own army is moving straight. When the yaw moment of inertia ■2 is ready to be corrected, it becomes 1 or more, so in the next step 77, it is determined whether C6 is O, and if it is not Ch-0, the yaw is changed in step 78. A flag F SIN instructing correction of the moment of inertia I2 is set to 1. If it is ch-0, the flag F□ is set to O in step 79 and detection value collection continues. Then, in step 80, F++・O is set, and the own army is in steady turning, and the stability factor A and the front and rear wheel cornering power K F +K
Each detected value is stored when m is a proper value.

このようにしてフラグFs+工が1となると、第3図の
プログラムはステップ21から、ヨー慣性モーメント適
正値演算処理を行うべく、ステップ81に進む。
When the flag Fs+f becomes 1 in this manner, the program shown in FIG. 3 proceeds from step 21 to step 81 to calculate the appropriate value for the yaw moment of inertia.

この演算処理では、下記の表−2に示すようにあらかじ
めIz(0)〜l2(X、−1)までpX。
In this calculation process, pX is calculated in advance from Iz(0) to l2(X, -1) as shown in Table 2 below.

個のヨー慣性モーメント■2の数値を設定してメモリ内
にデータテーブルの形で準備しておき、ステップ81で
はこれらの数値の中から変数iに対応するものを読出し
て以下の演算処理におけるヨー慣性モーメントI2とす
る。
The numerical values of the yaw moment of inertia ■2 are set and prepared in the form of a data table in the memory, and in step 81, the one corresponding to the variable i is read out from these numerical values and used for the yaw in the following calculation process. Let the moment of inertia be I2.

(表−2) そして、ステップ82では、ステップ81で読出された
I2を適用したステップ22の式(1)を用いて、メモ
リ内に記憶しておいたj番地の操舵角検出値θ、(j)
および車速検出値V(j)からヨーレート推定値ψ(j
)を求め、引続くステップ83ではこのヨーレート推定
値M(j)と、メモリ内に記憶しておいたj番地のヨー
レート検出値M(D とから以下の式の積分、具体的に
はヨーレート誤差値E=1ψ−ψ1)の前回までの合計
値ΣEへの今回の誤差値Eの加算(E(i)=ΣE+E
)を行って、ヨーレート誤差積分値E(i)を求める。
(Table 2) Then, in step 82, the detected steering angle value θ, ( j)
and the estimated yaw rate ψ(j) from the detected vehicle speed value V(j)
) is calculated, and in the subsequent step 83, the yaw rate estimated value M(j) and the yaw rate detected value M(D) at address j stored in the memory are used to calculate the integral of the following equation, specifically, the yaw rate error. Addition of the current error value E to the previous total value ΣE of the value E = 1ψ - ψ1) (E (i) = ΣE + E
) to obtain the yaw rate error integral value E(i).

E(i) =f lψ−ψldt      ・・・(
9)さらに、ステップ84ではjに1を加えてメモリ内
の次の番地の検出値を次に読出すものとし、ステップ8
5では、jがメモリ内の検出値の個数04となったか否
かを判定する。ここで、J=Caであれば、メモリ内の
全ての検出値についてヨーレート誤差積分値E(1)が
求められているので、ステップ86に進んでiに1を加
え、j=caでなければ、ステップ82に戻って、次の
番地の検出値につきヨーレート誤差値Eを再び求める。
E(i) = f lψ−ψldt...(
9) Furthermore, in step 84, 1 is added to j and the detected value at the next address in the memory is read out next, and step 8
In step 5, it is determined whether j has reached 04, which is the number of detected values in the memory. Here, if J=Ca, the yaw rate error integral value E(1) has been obtained for all detected values in the memory, so proceed to step 86 and add 1 to i. , returns to step 82 and calculates the yaw rate error value E again for the detected value at the next address.

ステップ87では、変数iが所定値X、になったか否か
を判定し、1=X5でなければステップ81に戻ってデ
ータテーブル上の前回ヨー慣性モーメント1zとして用
いた数値の次の数値をメモリ内から続出し、この数値を
ヨー慣性モーメントI2として、再び全ての検出値のヨ
ーレート誤差積分値E (1)を求め、i=X、−?j
らば次のステップ88に進む。
In step 87, it is determined whether the variable i has reached the predetermined value X, and if 1 = Using this value as the yaw inertia moment I2, find the yaw rate error integral value E (1) of all detected values again, i=X, -? j
If so, proceed to the next step 88.

これらのステップ81〜87によれば、X3個のヨー慣
性モーメントについてそれぞれヨーレート誤差積分値E
(i)を求めることができ、その後のステップ88では
、E(i)の中の最小値である最小誤差E(1)をX2
個のE(i)中から検索して、そのE(1)を与えたヨ
ー慣性モーメントの数値、すなわち適正値IZ  C1
>を求め、さらに引続くステップ89では、この適正値
1z  (6)を、ステップ22における式(1)のヨ
ー慣性モーメントI2の数値とする。
According to these steps 81 to 87, the yaw rate error integral value E is calculated for each of the X3 yaw inertia moments.
(i), and in the subsequent step 88, the minimum error E(1), which is the minimum value in E(i), is determined by
The numerical value of the yaw inertia moment given E(1) by searching from E(i), that is, the appropriate value IZ C1
In the subsequent step 89, this appropriate value 1z (6) is set as the numerical value of the yaw moment of inertia I2 in equation (1) in step 22.

そして、ステップ90では、変数’*  j+ C4,
Then, in step 90, the variable '* j+ C4,
.

C3、およびフラグps+xを全てクリヤ(・0)とし
、その後はリターンして再び上述のプログラムを実行す
る。
C3 and the flag ps+x are all cleared (.0), and then the program returns to execute the above program again.

従って、これらのステップ81〜90は、第2図中のヨ
ー慣性モーメント適正値演算部13として機能する。
Therefore, these steps 81 to 90 function as the yaw inertia moment appropriate value calculation section 13 in FIG.

以上述べたように、この例の装置によれば第7図に操舵
角θ、について例示するように、車両が旋回走行状態で
ある際に記憶しておいた操舵角検出値θ8、車速検出値
■およびヨーレート検出値テを繰返し用いることにて、
車両諸元としてのヨー慣性モーメントIzの適正値を求
める演算を車両の走行状態の如何にかかわらず、所要の
回数行うことができるので、I2の初期設定値、あるい
は前回走行時の修正値が現在の適正値と大きく異なって
いる場合で、しかも旋回走行状態の持続時間が短い場合
でも、常に運動状態量の推定に用いるヨー慣性モーメン
ト■2の値(図中実線で示す)を適正値(図中鎖線で示
す)に充分良好に一致させる修正を行うことができる。
As described above, according to the device of this example, as illustrated in FIG. 7 for the steering angle θ, the detected steering angle value θ8 and the detected vehicle speed value are By repeatedly using ■ and yaw rate detection value Te,
The calculation to find the appropriate value of the yaw moment of inertia Iz as a vehicle specification can be performed as many times as required regardless of the vehicle running condition, so the initial setting value of I2 or the corrected value from the previous run is the current value. Even if the yaw moment of inertia ■2 (indicated by the solid line in the figure) used to estimate the motion state quantity is significantly different from the appropriate value, and even if the duration of the turning state is short, the value of the yaw inertia moment (indicated by the medium dashed line) can be modified to provide a sufficiently good match.

またこの例によれば、ヨー慣性モーメントI2の修正前
に、スタビリテイファクタAの修正を経て、車両諸元の
うちの前後輪コーナリングパワーKF+Klを適正値に
修正するので、ヨー慣性モーメントI2の修正精度をさ
らに高めることができる。
Furthermore, according to this example, before correcting the yaw moment of inertia I2, the stability factor A is corrected and the front and rear wheel cornering power KF+Kl of the vehicle specifications is corrected to an appropriate value, so the yaw moment of inertia I2 is corrected. Accuracy can be further increased.

以上、図示例に基づき説明したが、この発明は、他の車
両諸元の修正にも用い得ることはもちろんである。
Although the above description has been made based on the illustrated example, it goes without saying that the present invention can also be used to modify other vehicle specifications.

(発明の効果) かくしてこの発明の車両運動状態推定装置によれば、車
両が旋回走行状態である際に記憶しておいた各種検出値
を繰返し用いることにて、車両諸元値の修正のための演
算を、車両が直進走行状態に移行した後も所要に応じて
行うことができるので、車両諸元の修正前の値が適正値
と大きく異なっている場合であって旋回走行状態の持続
時間が短い場合でも、常に、車両諸元値を適正値に充分
良好に一致させる修正を行うことができ、ひいては、そ
の修正された車両諸元値に基づく車両モデルを車両の運
動特性の制御に用いることにて、その制御精度を大幅に
向上させることができる。
(Effects of the Invention) Thus, according to the vehicle motion state estimating device of the present invention, by repeatedly using various detected values stored when the vehicle is in a turning state, vehicle specification values can be corrected. This calculation can be performed as necessary even after the vehicle has shifted to the straight-ahead driving state, so even if the values before correction of the vehicle specifications are significantly different from the appropriate values, the duration of the turning driving state can be calculated. Even if the vehicle specification values are short, it is always possible to make corrections that make the vehicle specification values match sufficiently well with the appropriate values, and a vehicle model based on the corrected vehicle specification values can be used to control the vehicle dynamic characteristics. In this way, the control accuracy can be greatly improved.

【図面の簡単な説明】[Brief explanation of the drawing]

第1図はこの発明の概念図、 第2図はこの発明の一実施例の構成を示すブロック線図
、 第3図は第2図中の演算処理装置において実行されるプ
ログラムを示すフローチャート、第4図は第3図中のス
タビリテイファクタ適正値演算サブルーチンを示すフロ
ーチャート、第5図は第3図中のコーナリングパワー適
正値演算サブルーチンを示すフローチャート、第6図は
第3図中の検出値記憶サブルーチンを示すフローチャー
ト、 第7図は第2図に示す例の装置の作動状態を示す特性図
、 第8図は従来装置の作動状態を示す特性図である。 101・・・操舵角検出手段 102・・・車速検出手
段103・・・運動状態量検出手段 104・・・検出値記憶手段 105・・・運動状態量推定手段 106・・・車両諸元修正手段 1・・・演算処理装置    2・・・操舵角センサ3
・・・車速センサ     4・・・ヨーレートセンサ
5・・・重心点検加速度センサ 6・・・非重心点横加速度センサ 7・・・横方向速度センサ  11・・・検出値記憶部
12・・・運動状態量推定値演算部 13・・・ヨー慣性モーメント適正値演算部14・・・
旋回走行判定部 15・・・定常旋回走行判定部 16・・・スタビリテイファクタ適否判定部17・・・
スタビリテイファクタ適正値演算部18・・・コーナリ
ングパワー適否判定部19・・・コーナリングパワー適
正値演算部θS・・・操舵角検出値  V・・・車速検
出値n・・・運動状態量検出値 H・・・運動状態量推定値 P・・・車両諸元値)・・
・ヨーレート検出値 α。・・・重心点検加速度検出値 α1・・・非重心点横加速度検出値 V、・・・横方向速度検出値 ψ・・・ヨーレート推定値 イ) ψ・・・ヨー角加速度推定値 vy・・・横方向速度推定値 vy・・・横方向並進加速度推定値 I2・・・ヨー慣性モーメント に、・・・前輪コーナリングパワー に、・・・後輪コーナリングパワー 1、・・・操舵角平均値  V・・・車速平均値φ・・
・ヨーレート平均値 τ・・・スタビリテイファクタ平均値 e・・・車両諸元誤差 Fs+M+FT +Fto+Fsy+Fo ”’フラグ
特許出願人  日産自動車株式会社 第5図      第6図
Fig. 1 is a conceptual diagram of the present invention; Fig. 2 is a block diagram showing the configuration of an embodiment of the invention; Fig. 3 is a flowchart showing a program executed in the arithmetic processing unit in Fig. 2; Figure 4 is a flowchart showing the stability factor appropriate value calculation subroutine in Figure 3, Figure 5 is a flowchart showing the cornering power appropriate value calculation subroutine in Figure 3, and Figure 6 is the detected value storage in Figure 3. A flowchart showing a subroutine, FIG. 7 is a characteristic diagram showing the operating state of the example device shown in FIG. 2, and FIG. 8 is a characteristic diagram showing the operating state of the conventional device. 101...Steering angle detection means 102...Vehicle speed detection means 103...Motion state quantity detection means 104...Detected value storage means 105...Motion state quantity estimation means 106...Vehicle specification correction means 1... Arithmetic processing unit 2... Steering angle sensor 3
... Vehicle speed sensor 4 ... Yaw rate sensor 5 ... Center of gravity inspection acceleration sensor 6 ... Non-center of gravity point lateral acceleration sensor 7 ... Lateral speed sensor 11 ... Detection value storage unit 12 ... Movement State quantity estimated value calculation unit 13...Yaw inertia moment appropriate value calculation unit 14...
Turning running determination unit 15... Steady turning running determining unit 16... Stability factor suitability determining unit 17...
Stability factor appropriate value calculation unit 18...Cornering power appropriateness determination unit 19...Cornering power appropriate value calculation unit θS...Steering angle detected value V...Vehicle speed detection value n...Motion state amount detection value H...Estimated motion state quantity P...Vehicle specification value)...
・Yaw rate detection value α. ... Center of gravity inspection acceleration detected value α1... Non-center of gravity point lateral acceleration detected value V, ... Lateral velocity detected value ψ... Yaw rate estimated value a) ψ... Yaw angular acceleration estimated value vy...・Estimated lateral speed vy...Estimated lateral translational acceleration I2...Yaw moment of inertia,...Front wheel cornering power,...Rear wheel cornering power 1,...Steering angle average value V ...Vehicle speed average value φ...
-Yaw rate average value τ...Stability factor average value e...Vehicle specification error Fs+M+FT +Fto+Fsy+Fo'' Flag patent applicant Nissan Motor Co., Ltd. Figure 5 Figure 6

Claims (1)

【特許請求の範囲】 1、ステアリングハンドルの操舵角を検出する操舵角検
出手段と、 車速を検出する車速検出手段と、 車両の運動状態量を検出する運動状態量検出手段と、 旋回走行状態の車両の前記操舵角、車速および運動状態
量の検出値を記憶する検出値記憶手段と、記憶されてい
た前記操舵角および車速から、車両諸元に基づく運動方
程式として設定された車両モデルに関する演算により、
検出される前記運動状態量と同種の運動状態量を推定し
て求める運動状態量推定手段と、 運動状態量の前記推定値を、記憶されていた運動状態量
の前記検出値と比較し、その比較結果に基づき前記運動
状態量推定手段の車両諸元を修正する車両諸元修正手段
とを具えてなる車両運動状態推定装置。
[Scope of Claims] 1. Steering angle detection means for detecting the steering angle of the steering wheel; Vehicle speed detection means for detecting vehicle speed; Motion state quantity detection means for detecting the motion state quantity of the vehicle; A detection value storage means for storing detected values of the steering angle, vehicle speed, and motion state quantity of the vehicle, and calculations regarding a vehicle model set as a motion equation based on vehicle specifications from the stored steering angle and vehicle speed. ,
a motion state amount estimating means for estimating and calculating a motion state quantity of the same type as the detected motion state quantity; and comparing the estimated value of the motion state quantity with the detected value of the motion state quantity stored. A vehicle motion state estimating device comprising: vehicle specification modifying means for modifying vehicle specifications of the motion state quantity estimation means based on a comparison result.
JP61244043A 1986-10-16 1986-10-16 Operating condition estimating device for vehicle Pending JPS63101169A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP61244043A JPS63101169A (en) 1986-10-16 1986-10-16 Operating condition estimating device for vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP61244043A JPS63101169A (en) 1986-10-16 1986-10-16 Operating condition estimating device for vehicle

Publications (1)

Publication Number Publication Date
JPS63101169A true JPS63101169A (en) 1988-05-06

Family

ID=17112867

Family Applications (1)

Application Number Title Priority Date Filing Date
JP61244043A Pending JPS63101169A (en) 1986-10-16 1986-10-16 Operating condition estimating device for vehicle

Country Status (1)

Country Link
JP (1) JPS63101169A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0460582A2 (en) * 1990-06-04 1991-12-11 Nippondenso Co., Ltd. Steering angle detecting apparatus for motor vehicles
JP2006027388A (en) * 2004-07-14 2006-02-02 Advics:Kk Attitude control device for vehicle

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0460582A2 (en) * 1990-06-04 1991-12-11 Nippondenso Co., Ltd. Steering angle detecting apparatus for motor vehicles
JP2006027388A (en) * 2004-07-14 2006-02-02 Advics:Kk Attitude control device for vehicle
JP4501568B2 (en) * 2004-07-14 2010-07-14 株式会社アドヴィックス Vehicle attitude control device

Similar Documents

Publication Publication Date Title
US9114824B2 (en) Steering system, steering control device and steering control method
US5343393A (en) Steering angle detecting apparatus for motor vehicles based on the phase difference between a steering angle detection signal and steering angle estimated signal
JPS61211165A (en) Car move state inference device
JPS62137276A (en) Steering system control device for vehicle
JP2002145037A (en) Coefficient of friction on road estimating device of vehicle
JPH08332971A (en) Vehicle behavior control device
JPH1134701A (en) Vehicular behavior control device
JP3033314B2 (en) Vehicle running characteristics control device
JP2012063184A (en) Yaw rate calibration device
US6128569A (en) Method and apparatus for estimating sideslip angle of automotive vehicle
JP4140409B2 (en) Vehicle steering angle detection device
US10625777B2 (en) Attitude control system
JP2011110952A (en) Device for controlling vehicle motion
JPS63101169A (en) Operating condition estimating device for vehicle
US6397135B1 (en) Rear-wheel steering angle control device
JPH06221968A (en) Road surface friction coefficient detection device
JP3843798B2 (en) Steering angle detector for vehicle
JP2004026074A (en) Device for estimating turning characteristic of vehicle
JPH1151668A (en) Angular speed detector
JP4161829B2 (en) Vehicle attitude control device
KR101940726B1 (en) Smart Parking Assist System and the method for Wheel Radius Correction thereof
JPH07246948A (en) Compensator of quantity of vehicle motion state
JP2013018381A (en) Electric power steering device
JP2000233738A (en) Running condition judging device for vehicle
JPS62163868A (en) Estimating device for motional condition quantity of vehicle