JPH05314397A - Sensor signal processor - Google Patents

Sensor signal processor

Info

Publication number
JPH05314397A
JPH05314397A JP4118828A JP11882892A JPH05314397A JP H05314397 A JPH05314397 A JP H05314397A JP 4118828 A JP4118828 A JP 4118828A JP 11882892 A JP11882892 A JP 11882892A JP H05314397 A JPH05314397 A JP H05314397A
Authority
JP
Japan
Prior art keywords
yaw rate
sensor
correction signal
signal
value
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP4118828A
Other languages
Japanese (ja)
Other versions
JP2864868B2 (en
Inventor
Hideki Sudo
秀樹 数藤
Yoshinori Yamamura
吉典 山村
Takeshi Ito
健 伊藤
Junji Tsutsumi
淳二 堤
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 JP4118828A priority Critical patent/JP2864868B2/en
Publication of JPH05314397A publication Critical patent/JPH05314397A/en
Application granted granted Critical
Publication of JP2864868B2 publication Critical patent/JP2864868B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Abstract

PURPOSE:To calculate an accurate yaw rate regardless of the drift amount of a yaw rate sensor in the sensor signal processor for calculating the yaw rate based on output signals from the yaw rate sensor. CONSTITUTION:A first constitution is provided with a yaw rate correction signal calculating means d1 for updating the zero point signal of the yaw rate sensor in a direction for equalizing the ratio of the values of only the plus component and the only the minus component of a steering angle and the ratio of the values of the only the plus component and only the minus component of the yaw rate when steering below prescribed steering amplitude is continued for a prescribed time under the condition of being below prescribed velocity fluctuation. The second constitution is provided with a yaw rate correction signal calculating means d2 for estimating the generated yaw rate from the steering angle, forward/backward direction velocity and vehicle characteristics and updating the output signal of the yaw rate sensor as the zero point signal when the estimated generated yaw rate is a permissible yaw rate error determined beforehand or less.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は、車両の操安性向上のた
めに搭載される車両運動制御装置等に使用するヨーレー
トセンサのセンサ信号処理装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a sensor signal processing device for a yaw rate sensor used in a vehicle motion control device or the like mounted to improve the steering stability of a vehicle.

【0002】[0002]

【従来の技術】従来のセンサ信号処理装置としては、例
えば、特開昭57−44568号公報にみられるよう
に、車両の横加速度若しくはヨーレートを検出し、その
検出信号を後輪舵角にフィードバックし、後輪を転舵さ
せる車両の操舵装置に用いられるものがある。
2. Description of the Related Art As a conventional sensor signal processing device, for example, as disclosed in Japanese Patent Laid-Open No. 57-44568, lateral acceleration or yaw rate of a vehicle is detected, and the detection signal is fed back to a rear wheel steering angle. However, there is a vehicle steering device that steers the rear wheels.

【0003】[0003]

【発明が解決しようとする課題】しかしながら、このよ
うなセンサ信号処理装置にあっては、ヨーレート検出用
のセンサ出力信号に含まれるドリフト成分の補償を全く
考慮していない為、センサ検出値にドリフトが発生する
と、上記車両の操舵装置の場合では、車両が直進状態で
あっても後輪が転舵されてしまうという問題が生じる。
However, in such a sensor signal processing device, since the compensation of the drift component contained in the sensor output signal for yaw rate detection is not considered at all, the drift in the sensor detection value is caused. In the case of the above-described vehicle steering system, the problem arises that the rear wheels are steered even when the vehicle is in a straight traveling state.

【0004】本発明は、上記のような問題に着目してな
されたもので、ヨーレートセンサからの出力信号に基づ
いてヨーレートを算出するセンサ信号処理装置におい
て、ヨーレートセンサのドリフト量にかかわらず正確な
ヨーレートを算出することを共通の課題とする。
The present invention has been made by paying attention to the above problems, and in a sensor signal processing device for calculating a yaw rate based on an output signal from a yaw rate sensor, an accurate yaw rate sensor regardless of a drift amount of the yaw rate sensor. The common issue is to calculate the yaw rate.

【0005】[0005]

【課題を解決するための手段】上記共通の課題を解決す
るため請求項1記載のセンサ信号処理装置では、所定の
操舵振幅以下の操舵が、所定の速度変動以下の条件で所
定時間内継続した場合、その間の操舵角のプラス成分の
みの値とマイナス成分のみの値の比と、その間のヨーレ
ートのプラス成分のみの値とマイナス成分のみの値の比
を等しくする方向でヨーレートセンサのゼロ点信号を更
新するヨーレート補正信号算出手段を設けた。
In order to solve the above-mentioned common problems, in the sensor signal processing device according to the first aspect of the present invention, steering with a predetermined steering amplitude or less is continued within a predetermined time under conditions of a predetermined speed fluctuation or less. In this case, the yaw rate sensor zero point signal is set in the same direction as the ratio between the values of only the positive component and the value of only the negative component of the steering angle and the ratio of the value of only the positive component and the value of only the negative component of the yaw rate between them. The yaw rate correction signal calculation means for updating

【0006】即ち、図1(イ) のクレーム対応図に示すよ
うに、車両の操舵角を検出する操舵角検出手段aと、車
両の前後方向速度を検出する速度検出手段bと、車両の
発生ヨーレートに応じた信号を出力するヨーレートセン
サcと、前記速度検出手段bの出力と前記操舵角検出手
段aの出力と前記ヨーレートセンサcの出力とからヨー
レート補正信号を演算するヨーレート補正信号算出手段
d1と、前記ヨーレートセンサcの出力する信号と前記
ヨーレート補正信号とから発生ヨーレートを算出するヨ
ーレート算出手段eとからなるセンサ信号処理装置にお
いて、前記ヨーレート補正信号算出手段d1は、前記操
舵角が所定値以下の操舵振幅をもって正負に操舵されて
いる状態が所定時間以上継続し、かつ、その間の前記前
後方向の速度の変動が所定値以下であるという条件が満
たされた時、その所定時間内の前記操舵角のプラス成分
のみの信号から演算される値(Is+)とマイナス成分の
みの信号から演算される値(Is-)と、前記ヨーレート
のプラス成分のみの信号から演算される値(ψ+)とマ
イナス成分のみの信号から演算される値(ψ−)を算出
し、Is+対Is-の比とψ+対ψ−の比が等しくなるよう
にヨーレート補正信号を演算することを特徴とする。
That is, as shown in the claim correspondence diagram of FIG. 1 (a), a steering angle detecting means a for detecting the steering angle of the vehicle, a speed detecting means b for detecting the longitudinal speed of the vehicle, and a generation of the vehicle. A yaw rate sensor c that outputs a signal according to a yaw rate, a yaw rate correction signal calculation means d1 that calculates a yaw rate correction signal from the output of the speed detection means b, the output of the steering angle detection means a, and the output of the yaw rate sensor c. And a yaw rate calculation means e for calculating a generated yaw rate from the signal output from the yaw rate sensor c and the yaw rate correction signal, in the yaw rate correction signal calculation means d1, the steering angle is set to a predetermined value. The state of being steered positively and negatively with the following steering amplitude continues for a predetermined time or longer, and the change in the speed in the front-rear direction during that time is continued. When the condition that is equal to or less than a predetermined value is satisfied, a value (Is +) calculated from the signal of only the positive component of the steering angle and a value (Is- ) And a value (ψ +) calculated from the signal of only the positive component of the yaw rate and a value (ψ−) calculated from the signal of only the negative component, and the ratio of Is + to Is− and ψ + to ψ− The yaw rate correction signal is calculated so that the ratio becomes equal.

【0007】請求項2記載のセンサ信号処理装置では、
請求項1記載のセンサ信号処理装置において、ヨーレー
ト補正信号算出手段d1は、前記Is+,Is-,ψ+,ψ
−の値として、プラス成分やマイナス成分のみの信号か
ら演算される積分値を用いてヨーレート補正信号を演算
するようにしている。
In the sensor signal processing device according to claim 2,
The sensor signal processing device according to claim 1, wherein the yaw rate correction signal calculation means d1 is Is +, Is-, ψ +, ψ.
As the value of −, the yaw rate correction signal is calculated by using the integral value calculated from the signals of only the plus component and the minus component.

【0008】請求項3記載のセンサ信号処理装置では、
請求項1,2記載のセンサ信号処理装置において、ヨー
レート補正信号算出手段d1は、更新前のヨーレート補
正信号以外の複数のヨーレート補正信号を仮に設定し、
各々のヨーレート補正信号を用いて請求項1または請求
項2記載の演算を行ない、前記Is+対Is-の比と、前記
各々のヨーレート補正信号を用いて演算したψ+とψ−
の値を用いて新たなヨーレート補正信号を算出し、ヨー
レート補正信号の更新を行なうようにしている。
In the sensor signal processing device according to claim 3,
In the sensor signal processing device according to claim 1 or 2, the yaw rate correction signal calculation means d1 provisionally sets a plurality of yaw rate correction signals other than the yaw rate correction signal before update,
The calculation according to claim 1 or 2 is performed using each yaw rate correction signal, and the ratio of Is + to Is- and ψ + and ψ− calculated using each yaw rate correction signal.
A new yaw rate correction signal is calculated using the value of, and the yaw rate correction signal is updated.

【0009】上記共通の課題を解決するため請求項4記
載のセンサ信号処理装置では、発生ヨーレートを操舵角
と前後方向速度と車両特性とから推定し、その推定発生
ヨーレートが予め定めた許容ヨーレート誤差以下である
場合、その時のヨーレートセンサの出力信号をゼロ点信
号として更新するヨーレート補正信号算出手段を設け
た。
In order to solve the above common problems, in the sensor signal processing device according to the present invention, the generated yaw rate is estimated from the steering angle, the longitudinal speed and the vehicle characteristic, and the estimated generated yaw rate is a predetermined allowable yaw rate error. In the following cases, the yaw rate correction signal calculation means for updating the output signal of the yaw rate sensor at that time as a zero point signal is provided.

【0010】即ち、図1(ロ) のクレーム対応図に示すよ
うに、車両の操舵角を検出する操舵角検出手段aと、車
両の前後方向速度を検出する速度検出手段bと、車両の
発生ヨーレートに応じた信号を出力するヨーレートセン
サcと、前記速度検出手段bの出力と前記操舵角検出手
段aの出力と前記ヨーレートセンサcの出力とからヨー
レート補正信号を演算するヨーレート補正信号算出手段
d2と、前記ヨーレートセンサcの出力する信号と前記
ヨーレート補正信号とから発生ヨーレートを算出するヨ
ーレート算出手段eとからなるセンサ信号処理装置にお
いて、前記ヨーレート補正信号算出手段d2は、発生ヨ
ーレートを前記操舵角と前記前後方向速度と車両特性と
から推定し、その推定発生ヨーレートが予め定めた許容
ヨーレート誤差以下であるという条件が満たされた時、
前記ヨーレートセンサ出力を、前記ヨーレート補正信号
とすることを特徴とする。
That is, as shown in the claim correspondence diagram of FIG. 1 (b), a steering angle detecting means a for detecting the steering angle of the vehicle, a speed detecting means b for detecting the longitudinal speed of the vehicle, and a generation of the vehicle. A yaw rate sensor c that outputs a signal according to the yaw rate, a yaw rate correction signal calculation means d2 that calculates a yaw rate correction signal from the output of the speed detection means b, the output of the steering angle detection means a, and the output of the yaw rate sensor c. And a yaw rate calculation means e for calculating a generated yaw rate from the signal output from the yaw rate sensor c and the yaw rate correction signal. In the sensor signal processing device, the yaw rate correction signal calculation means d2 changes the generated yaw rate to the steering angle. And the above-mentioned longitudinal speed and vehicle characteristics, and the estimated generated yaw rate is less than a predetermined allowable yaw rate error. When the conditions are met that is,
The output of the yaw rate sensor is used as the yaw rate correction signal.

【0011】請求項5記載のセンサ信号処理装置では、
請求項4記載のセンサ信号処理装置において、前記ヨー
レート補正信号算出手段d2は、前記前後方向速度が所
定値以下であるという条件が満たされた時、前記ヨーレ
ートセンサ出力を、前記ヨーレート補正信号としてい
る。
In the sensor signal processing device according to claim 5,
5. The sensor signal processing device according to claim 4, wherein the yaw rate correction signal calculation means d2 uses the yaw rate sensor output as the yaw rate correction signal when a condition that the longitudinal speed is equal to or lower than a predetermined value is satisfied. ..

【0012】[0012]

【作用】請求項1記載の発明の作用を説明する。The operation of the present invention will be described.

【0013】発生ヨーレートを算出する時は、ヨーレー
ト補正信号算出手段d1において、速度検出手段bの出
力と操舵角検出手段aの出力とヨーレートセンサcの出
力とからヨーレート補正信号が演算され、ヨーレート算
出手段eにおいて、ヨーレートセンサcの出力する信号
と前記ヨーレート補正信号とから発生ヨーレートが算出
される。
When calculating the generated yaw rate, the yaw rate correction signal calculation means d1 calculates the yaw rate correction signal from the output of the speed detection means b, the output of the steering angle detection means a and the output of the yaw rate sensor c, and calculates the yaw rate. In the means e, the generated yaw rate is calculated from the signal output from the yaw rate sensor c and the yaw rate correction signal.

【0014】このうちヨーレート補正信号算出手段d1
での演算処理を述べると、操舵角が所定値以下の操舵振
幅をもって正負に操舵されている状態が所定時間以上継
続し、かつ、その間の前後方向の速度の変動が所定値以
下であるという条件が満たされた時、その所定時間内の
操舵角のプラス成分のみの信号から演算される値(Is
+)とマイナス成分のみの信号から演算される値(Is
-)と、ヨーレートのプラス成分のみの信号から演算さ
れる値(ψ+)とマイナス成分のみの信号から演算され
る値(ψ−)を算出し、Is+対Is-の比とψ+対ψ−の
比が等しくなるようにヨーレート補正信号が演算され
る。
Of these, yaw rate correction signal calculation means d1
In the calculation process described in (1), the condition that the steering angle is positively or negatively steered with a steering amplitude equal to or less than a predetermined value continues for a predetermined time or more, and the speed fluctuation in the front-rear direction during that time is less than the predetermined value. When is satisfied, a value (Is
The value (Is
-) And a value (ψ +) calculated from the signal of only the positive component of the yaw rate and a value (ψ−) calculated from the signal of only the negative component, and the ratio of Is + to Is- and ψ + to ψ− The yaw rate correction signal is calculated so that the ratio becomes equal.

【0015】考え方としては、所定の走行条件下では、
操舵角検出値とヨーレート検出値とは対応関係にある。
そこで、所定の走行条件下で、所定時間内の正負の操舵
角の各値と所定時間内の正負のヨーレートの各値とが互
いに符合する関係となるようにヨーレートセンサcのゼ
ロ点信号を更新する様にしている。
The idea is that under certain running conditions,
The steering angle detection value and the yaw rate detection value have a correspondence relationship.
Therefore, under a predetermined traveling condition, the zero point signal of the yaw rate sensor c is updated so that the positive and negative steering angle values within a predetermined time and the positive and negative yaw rate values within the predetermined time are in a mutually matching relationship. I am trying to do it.

【0016】請求項2記載の発明の作用を説明する。The operation of the invention according to claim 2 will be described.

【0017】請求項2記載では、ヨーレート補正信号算
出手段d1において、前記Is+,Is-,ψ+,ψ−の値
として、プラス成分やマイナス成分のみの信号から演算
される積分値を用いてヨーレート補正信号が演算され
る。
In the second aspect, the yaw rate correction signal calculating means d1 uses the integrated value calculated from the signals of only the plus component and the minus component as the value of Is +, Is-, ψ +, ψ- The signal is calculated.

【0018】請求項3記載の発明の作用を説明する。The operation of the invention according to claim 3 will be described.

【0019】請求項3記載では、ヨーレート補正信号算
出手段d1において、更新前のヨーレート補正信号以外
の複数のヨーレート補正信号が仮に設定され、各々のヨ
ーレート補正信号を用いて請求項1または請求項2記載
の演算が行なわれ、前記Is+対Is-の比と、前記各々の
ヨーレート補正信号を用いて演算したψ+とψ−の値を
用いて新たなヨーレート補正信号が算出され、ヨーレー
ト補正信号の更新がなされる。
According to a third aspect of the present invention, the yaw rate correction signal calculating means d1 temporarily sets a plurality of yaw rate correction signals other than the yaw rate correction signal before updating, and the respective yaw rate correction signals are used. The calculation described above is performed, a new yaw rate correction signal is calculated using the ratio of Is + to Is-, and the values of ψ + and ψ− calculated using the respective yaw rate correction signals, and the yaw rate correction signal is updated. Is done.

【0020】請求項4記載の発明の作用を説明する。The operation of the invention according to claim 4 will be described.

【0021】発生ヨーレートの基本的な算出作用は、上
記と同様である。
The basic calculation operation of the generated yaw rate is the same as above.

【0022】このうちヨーレート補正信号算出手段d2
での演算処理を述べると、発生ヨーレートを操舵角と前
後方向速度と車両特性とから推定し、その推定発生ヨー
レートが予め定めた許容ヨーレート誤差以下であるとい
う条件が満たされた時、ヨーレートセンサ出力が、ヨー
レート補正信号とされる。
Of these, yaw rate correction signal calculation means d2
The yaw rate sensor output is calculated when the condition that the estimated yaw rate is less than a predetermined allowable yaw rate error is satisfied by estimating the generated yaw rate from the steering angle, the longitudinal speed and the vehicle characteristics. Is used as a yaw rate correction signal.

【0023】考え方としては、例えば、低速直進走行時
には、ヨーレートの発生はない。そこで、ヨーレートが
発生しないような走行条件下でのヨーレートセンサ出力
をゼロ点信号として更新する様にしている。
As a way of thinking, for example, no yaw rate is generated during low-speed straight traveling. Therefore, the output of the yaw rate sensor under the running condition where the yaw rate is not generated is updated as a zero point signal.

【0024】請求項5記載の発明の作用を説明する。The operation of the invention of claim 5 will be described.

【0025】請求項4記載のセンサ信号処理装置におい
て、ヨーレート補正信号算出手段d2において、前後方
向速度が所定値以下であるという条件が満たされた時、
ヨーレートセンサ出力が、ヨーレート補正信号とされ
る。
In the sensor signal processing device according to the fourth aspect, when the yaw rate correction signal calculating means d2 satisfies the condition that the longitudinal speed is equal to or less than a predetermined value,
The output of the yaw rate sensor is used as a yaw rate correction signal.

【0026】[0026]

【実施例】以下、本発明の実施例を図面に基づいて説明
する。
Embodiments of the present invention will be described below with reference to the drawings.

【0027】(第1実施例)まず、構成を説明する。(First Embodiment) First, the structure will be described.

【0028】図2は請求項1〜3に対応する本発明第1
実施例のセンサ信号処理装置が適用された後輪舵角制御
システムを示す図、図3は車両の後輪舵角を制御するコ
ントローラ内の構成を示すブロック図である。
FIG. 2 shows a first invention according to claims 1 to 3.
FIG. 3 is a diagram showing a rear wheel steering angle control system to which the sensor signal processing device of the embodiment is applied, and FIG. 3 is a block diagram showing a configuration in a controller that controls a rear wheel steering angle of a vehicle.

【0029】図2に示された構成を説明すると、ステア
リングホイール1による回転運動はコラムシャフト2に
よってギアボックス3に伝達され、タイロッド4の直線
運動に変換される。タイロッド4の直線運動は、ナック
ルアーム5の揺動運動に変換され、前輪6が転舵され
る。この際、コラムシャフト2の回転角度は操舵角セン
サ15(操舵角検出手段に相当)によってコントローラ
8に伝達される。
Explaining the configuration shown in FIG. 2, the rotational movement by the steering wheel 1 is transmitted to the gearbox 3 by the column shaft 2 and converted into the linear movement of the tie rod 4. The linear motion of the tie rod 4 is converted into the swing motion of the knuckle arm 5, and the front wheels 6 are steered. At this time, the rotation angle of the column shaft 2 is transmitted to the controller 8 by the steering angle sensor 15 (corresponding to steering angle detecting means).

【0030】車両11には、車両に生じる車両のヨー運
動で生じるヨーレートを検出するヨーレートセンサ7、
コントローラ8、サーボアクチュエータ9が搭載され、
アクチュエータ9には、ギアボックス10が接続されて
いる。アクチュエータ9の運動は、ギアボックス10,
タイロッド14,ナックルアーム13を介して後輪12
に伝達される。17はアクチュエータ9を位置制御する
ための実舵角を検出する実舵角センサである。16は車
両の走行速度を検出する車速センサ(速度検出手段に相
当)である。
The vehicle 11 has a yaw rate sensor 7 for detecting a yaw rate generated by the yaw motion of the vehicle.
The controller 8 and the servo actuator 9 are installed,
A gear box 10 is connected to the actuator 9. The movement of the actuator 9 depends on the gearbox 10,
Rear wheel 12 via tie rod 14 and knuckle arm 13
Be transmitted to. Reference numeral 17 denotes an actual steering angle sensor for detecting the actual steering angle for controlling the position of the actuator 9. Reference numeral 16 denotes a vehicle speed sensor (corresponding to speed detecting means) for detecting the traveling speed of the vehicle.

【0031】車両走行中、ヨーレートが発生すると、ヨ
ーレートセンサ7により検出される。この検出信号は、
電圧に変換されてコントローラ8に送られると同時に、
操舵角センサ15により検出された操舵角と、車速セン
サ16により検出された車速とがコントローラ8に送ら
れる。コントローラ8は、これらの信号をもとにアクチ
ュエータ10を制御し、後輪12を操舵する。
When a yaw rate is generated while the vehicle is traveling, it is detected by the yaw rate sensor 7. This detection signal is
At the same time it is converted to voltage and sent to the controller 8,
The steering angle detected by the steering angle sensor 15 and the vehicle speed detected by the vehicle speed sensor 16 are sent to the controller 8. The controller 8 controls the actuator 10 based on these signals to steer the rear wheels 12.

【0032】図3において、入力されたヨーレート信号
は、ヨーレート算出演算部8a(ヨーレート算出手段に
相当)において、ゼロ点電圧算出部8d(ヨーレート補
正信号算出手段に相当)の出力するゼロ点電圧をもとに
ヨーレートに変換され、目標後輪舵角演算部8bに入力
される。同時に、車速センサ16,操舵角センサ15か
らの信号も目標後輪舵角演算部8bに入力される。後輪
舵角位置決めサーボ系8cは、アクチュエータ9を制御
し、後輪12の舵角を目標後輪舵角演算部8bの出力す
る目標後輪舵角に追従させる。また、ゼロ点電圧算出部
8dは、車速センサ16,操舵角センサ15,ヨーレー
トセンサ7からの入力信号をもとにゼロ点電圧を算出す
る。
In FIG. 3, the input yaw rate signal is the zero point voltage output from the zero point voltage calculation section 8d (corresponding to the yaw rate correction signal calculating means) in the yaw rate calculation calculating section 8a (corresponding to the yaw rate calculating means). The yaw rate is converted into the original yaw rate, and the yaw rate is input to the target rear wheel steering angle calculation unit 8b. At the same time, the signals from the vehicle speed sensor 16 and the steering angle sensor 15 are also input to the target rear wheel steering angle calculation unit 8b. The rear wheel steering angle positioning servo system 8c controls the actuator 9 so that the steering angle of the rear wheel 12 follows the target rear wheel steering angle output by the target rear wheel steering angle calculation unit 8b. Further, the zero-point voltage calculation unit 8d calculates the zero-point voltage based on the input signals from the vehicle speed sensor 16, the steering angle sensor 15, and the yaw rate sensor 7.

【0033】次に、作用を説明する。Next, the operation will be described.

【0034】(A) ゼロ点電圧算出演算部8dの働き ヨーレートセンサ7の出力電圧をVy,更新前のゼロ点
電圧をVzoとする。通常、ヨーレート算出演算部8a
は、センサの出力電圧Vyからゼロ点電圧Vzoを減算
し、変換定数Cをかけることによりヨーレートψを算出
している。
(A) Operation of the zero point voltage calculation operation section 8d The output voltage of the yaw rate sensor 7 is Vy, and the zero point voltage before updating is Vzo. Normally, the yaw rate calculation calculator 8a
Calculates the yaw rate ψ by subtracting the zero-point voltage Vzo from the output voltage Vy of the sensor and applying the conversion constant C.

【0035】ψ=C・(Vy−Vzo) しかしながら、ゼロ点電圧Vzoは、使用環境等の変化な
どによりドリフトするため、以下に示す方法によりヨー
レートセンサ7のゼロ点電圧を推定し、上記ゼロ点電圧
Vzoの値を更新することによりセンサドリフトの影響を
回避する。
Ψ = C (Vy-Vzo) However, since the zero point voltage Vzo drifts due to changes in the operating environment, etc., the zero point voltage of the yaw rate sensor 7 is estimated by the method described below, and the above zero point is calculated. The influence of sensor drift is avoided by updating the value of voltage Vzo.

【0036】ゼロ点電圧算出演算部8dでは、ゼロ点算
出演算のために、5msの制御周期毎に、以下の積分演算
を行なう。
In the zero-point voltage calculation calculation unit 8d, the following integral calculation is performed every 5 ms control cycle for the zero-point calculation calculation.

【0037】 操舵角θのプラス成分のみの積分値(Is+) 操舵角θのマイナス成分のみの積分値(Is-) C・(Vy−Vzo)のプラス成分のみの積分値(ψ0+) C・(Vy−Vzo)のマイナス成分のみの積分値(ψ0
-) C・(Vy−Vzo−α)のプラス成分のみの積分値(ψ
1+) C・(Vy−Vzo−α)のマイナス成分のみの積分値
(ψ1-) C・(Vy−Vzo+α)のプラス成分のみの積分値(ψ
2+) C・(Vy−Vzo+α)のマイナス成分のみの積分値
(ψ2-) これらの積分値は、以下に示すセンサのゼロ点電圧推定
演算を行なった時点で、ゼロにリセットされる。
Integral value of only positive component of steering angle θ (Is +) Integrated value of only negative component of steering angle θ (Is−) C · (Vy−Vzo) Integral value of only positive component (ψ0 +) C · ( Integral value (ψ0) of only the negative component of Vy-Vzo
-) C · (Vy-Vzo-α) integral value (ψ
1+) Integral value of only minus component of C · (Vy−Vzo−α) (ψ1−) Integral value of only plus component of C · (Vy−Vzo + α) (ψ
2+) Integral values of only minus component of C · (Vy−Vzo + α) (ψ2−) These integral values are reset to zero at the time of performing the zero point voltage estimation calculation of the sensor described below.

【0038】センサのゼロ点電圧算出演算は、過去20
秒間の間、車速変動が5km/h以下であり、かつ、操舵状
態が正負に行なわれおり、その操舵振幅が±30deg 以
下という状態が継続した場合に行なう。
The calculation of the zero point voltage of the sensor has been performed in the past 20
This is performed when the vehicle speed fluctuation is 5 km / h or less for a second, the steering state is positive or negative, and the steering amplitude is ± 30 deg or less.

【0039】上記条件が満たされなかった場合、上記各
積分値をゼロにリセットし終了する。 (B) ゼロ点推定演算 以下、ゼロ点推定演算について図6及び図7のフローチ
ャートに基づいて説明する。図6はゼロ点電圧算出演算
処理を示すフローチャートであり、図7は上述した積分
演算処理を示すフローチャートである。
When the above conditions are not satisfied, the respective integrated values are reset to zero and the process is terminated. (B) Zero point estimation calculation The zero point estimation calculation will be described below with reference to the flowcharts of FIGS. 6 and 7. FIG. 6 is a flow chart showing the zero point voltage calculation calculation process, and FIG. 7 is a flow chart showing the integral calculation process described above.

【0040】図7の積分演算処理は、一定時間おき(こ
こでは5msおき)に起動され、前記積分演算を行なう。
その積分内容を図4に示す。図7のステップ群80での
積分演算を行なった結果、Is+,Is-,ψ0+,ψ0-,ψ
1+,ψ1-,ψ2+,ψ2-の各積分値が得られる。
The integral calculation process of FIG. 7 is started at regular time intervals (here, every 5 ms) to perform the integral calculation.
The contents of the integration are shown in FIG. Is +, Is-, ψ0 +, ψ0-, ψ are obtained as a result of the integration calculation in the step group 80 of FIG.
Each integrated value of 1+, ψ1-, ψ2 +, ψ2- is obtained.

【0041】また、積分演算と同一周期で、図7のステ
ップ群81での処理により操舵角θsの最大値θsmaxと
最小値θsminが更新され、図7のステップ群82での処
理により車速Vの最大値Vmax と最小値Vmin が更新さ
れる。
Further, the maximum value θsmax and the minimum value θsmin of the steering angle θs are updated by the processing in the step group 81 in FIG. 7 at the same cycle as the integral calculation, and the vehicle speed V of the vehicle speed V is updated by the processing in the step group 82 in FIG. The maximum value Vmax and the minimum value Vmin are updated.

【0042】これらの値は、図6のゼロ点電圧算出演算
処理で用いられる。
These values are used in the zero point voltage calculation calculation process of FIG.

【0043】ゼロ点電圧算出演算処理を図6のフローチ
ャートにしたがって説明する。
The zero point voltage calculation calculation process will be described with reference to the flowchart of FIG.

【0044】まず、ステップ60では、tcの値が4000
かどうか(5ms ×4000=20sec )によって積分の演算時
間が20秒間に達したか否かを判断する。20秒間に達
していなければ終了する。
First, in step 60, the value of tc is 4000
It is determined whether or not the integration calculation time has reached 20 seconds depending on whether or not (5 ms × 4000 = 20 seconds). If it has not reached 20 seconds, the process ends.

【0045】次に、ステップ61,62では、θsmax,
θsminの値により操舵が正負に行なわれており、かつ、
操舵振幅が±30deg 以内か否かを確認する。これは、
操舵振幅があまりに大きいとタイヤの非線形領域にはい
ってしまうため操舵振幅に制限を設けた。
Next, in steps 61 and 62, θsmax,
Steering is positive or negative depending on the value of θsmin, and
Check if the steering amplitude is within ± 30 deg. this is,
If the steering amplitude is too large, it enters the non-linear region of the tire, so the steering amplitude is limited.

【0046】また、ステップ63では、Vmax ,Vmin
の値により、車速変動が5km/h以内であったか否かを確
認する。これは、車速が大きく変動してしまうと車両の
ヨーレートゲインが変化してしまうためである。
In step 63, Vmax and Vmin
Check whether the vehicle speed fluctuation is within 5 km / h based on the value of. This is because the yaw rate gain of the vehicle changes when the vehicle speed changes significantly.

【0047】そして、ステップ61〜63の操舵角及び
車速の各条件を満たしていなければ、ステップ64へ進
み、各積分値をゼロにリセットし、さらに、ステップ6
5へ進み、tc=0にセットして終了する。
If the steering angle and vehicle speed conditions in steps 61 to 63 are not satisfied, the process proceeds to step 64, in which each integrated value is reset to zero, and then step 6
5 and sets tc = 0 and ends.

【0048】一方、ステップ61〜63の操舵角及び車
速の各条件を満たれていれば、ステップ66以降に進
み、センサのゼロ点電圧の推定値Vznを求め、ヨーレー
ト算出演算に用いるゼロ点電圧Vzoの値をVznに更新す
る。図5はヨーレート算出演算の内容を説明する図であ
る。
On the other hand, if the conditions of the steering angle and the vehicle speed in steps 61 to 63 are satisfied, the process proceeds to step 66 and thereafter, the estimated value Vzn of the zero point voltage of the sensor is obtained, and the zero point voltage used in the yaw rate calculation is calculated. The value of Vzo is updated to Vzn. FIG. 5 is a diagram for explaining the contents of the yaw rate calculation calculation.

【0049】ステップ66では、上記積分演算により求
めたIs+,Is-,ψ0+,ψ0-,ψ1+,ψ1-,ψ2+,ψ2-
を基に、 K=Is+/Is-,L0=ψ0+/ψ0-,L1=ψ1+/ψ1-,L2=ψ2+/ψ2- の各値を計算する。
In step 66, Is +, Is-, ψ0 +, ψ0-, ψ1 +, ψ1-, ψ2 +, ψ2- determined by the above integral calculation.
Based on, K = Is + / Is-, L0 = ψ0 + / ψ0-, L1 = ψ1 + / ψ1-, L2 = ψ2 + / ψ2- are calculated.

【0050】ステップ67では、K=L0かどうかを判断
し、K=L0の場合はゼロ点電圧は現状のままで正しいこ
とを示しているので、更新は行なわず終了する。
In step 67, it is judged whether or not K = L0. If K = L0, it means that the zero point voltage is correct as it is. Therefore, the updating is not performed and the process ends.

【0051】それ以外の場合は、ステップ68へ進み、
図5に示すように、K<L0の場合とK>L0とに分ける。
Otherwise, proceed to step 68,
As shown in FIG. 5, it is divided into the case of K <L0 and the case of K> L0.

【0052】K<L0の場合は、真のゼロ点電圧は、Vz0
とVz1の間にあるので、 Vzn=Vz0+α(L0−K)/(L0−L1) により、直線補間を用いて新たなゼロ点電圧Vznを求め
る(ステップ69)。
When K <L0, the true zero point voltage is Vz0
Since it is between Vzn and Vz1, a new zero point voltage Vzn is obtained using linear interpolation by Vzn = Vz0 + α (L0-K) / (L0-L1) (step 69).

【0053】K>L0の場合は、真のゼロ点電圧は、Vz2
とVz0の間にあるので、 Vzn=Vz0+α(K−L0)/(L2−L0) により、直線補間を用いて新たなゼロ点電圧Vznを求め
る(ステップ70)。
When K> L0, the true zero-point voltage is Vz2
And Vz0, Vzn = Vz0 + α (K-L0) / (L2-L0) is used to obtain a new zero-point voltage Vzn using linear interpolation (step 70).

【0054】そして、ステップ71では、ステップ64
と同一処理により各積分値をゼロにリセットし、さら
に、ステップ72へ進み、上記演算により求められたゼ
ロ点電圧Vznを新たなゼロ点電圧Vzoとして更新し、ス
テップ65でtc=0にセットして終了する。
Then, in step 71, step 64
The respective integrated values are reset to zero by the same processing as the above, and the process proceeds to step 72, the zero point voltage Vzn obtained by the above calculation is updated as a new zero point voltage Vzo, and tc = 0 is set at step 65. And finish.

【0055】次に、効果を説明する。Next, the effect will be described.

【0056】操舵角θs が±30deg 以下の操舵振幅を
もって正負に操舵されている状態が20秒以上継続し、
かつ、その間の車速Vの変動が5km/h以下であるという
条件が満たされた時、その20秒内の操舵角θs のプラ
ス成分のみの積分値(Is+)とマイナス成分のみの積分
値(Is-)と、ヨーレートψのプラス成分のみの積分値
(ψ+)とマイナス成分のみの積分値(ψ−)を算出
し、Is+対Is-の比とψ+対ψ−の比が等しくなるよう
にヨーレートセンサ7のゼロ点電圧Vzoを更新するよう
にした為、ヨーレートセンサ7のドリフト量にかかわら
ず正しいヨーレートψを算出することが出来る。
The steering angle θs is positively and negatively steered with a steering amplitude of ± 30 deg or less for more than 20 seconds,
Further, when the condition that the variation of the vehicle speed V during that time is 5 km / h or less is satisfied, the integral value (Is +) of only the positive component and the integral value (Is of only the negative component of the steering angle θs within the 20 seconds are satisfied. -) And the integral value (ψ +) of only the positive component of the yaw rate ψ and the integral value (ψ−) of only the negative component, so that the ratio of Is + to Is- is equal to the ratio of ψ + to ψ−. Since the zero point voltage Vzo of the sensor 7 is updated, the correct yaw rate ψ can be calculated regardless of the drift amount of the yaw rate sensor 7.

【0057】この結果、ヨーレートψを制御情報とする
後輪舵角制御で、ヨーレート検出値がドリフトすること
で直進走行時に後輪が転舵されるということが解消さ
れ、高い後輪舵角制御精度を確保することが出来る。
As a result, in the rear wheel steering angle control using the yaw rate ψ as the control information, the fact that the rear wheel is steered during straight traveling due to drift of the yaw rate detection value is eliminated, and a high rear wheel steering angle control is achieved. Accuracy can be secured.

【0058】尚、この第1実施例では、ヨーレートの積
分演算に用いる仮のゼロ点を3個設けて演算を行なった
が、もっと多数の仮のゼロ点を設けてそのうち最も妥当
な値を新たなゼロ点として用いる方法も考えられる。
In the first embodiment, the calculation is performed by providing three temporary zero points used for the integral calculation of the yaw rate. However, a larger number of temporary zero points are provided and the most appropriate value is newly updated. It is also possible to use it as a zero point.

【0059】また、本実施例の中で用いた積分演算の代
わりに、積分と同様な意味を持つ他の演算法(例えば、
平均値等)を用いることも勿論可能である。
Further, instead of the integral calculation used in this embodiment, another arithmetic method having the same meaning as the integral (for example,
Of course, it is also possible to use the average value).

【0060】次の第2実施例も同様であるが、ヨーレー
トのゼロ点更新を行なう際、単位時間あたりの更新量に
制限を設け、旧ゼロ点から新たなゼロ点に滑らかに更新
を行なうようにしても良い。
As in the case of the second embodiment, the yaw rate zero point is updated by limiting the amount of update per unit time so that the old zero point can be smoothly updated to the new zero point. You can

【0061】次の第2実施例も同様であるが、このセン
サ信号処理装置は、本実施例で示した後輪舵角制御シス
テムの他に、ヨーレートを制御情報とする制動力制御シ
ステム(左右輪に制動力差を与える)や駆動力制御シス
テム(左右輪に駆動力差を与える)等の他の制御システ
ムにも適用することが出来る。
This sensor signal processing device is similar to the following second embodiment, but in addition to the rear wheel steering angle control system shown in the present embodiment, a braking force control system (right and left) using yaw rate as control information is used. The present invention can be applied to other control systems such as applying a braking force difference to a wheel) and a driving force control system (applying a driving force difference to left and right wheels).

【0062】(第2実施例)この第2実施例は、請求項
4及び請求項5に記載の発明に対応するセンサ信号処理
装置の例である。
(Second Embodiment) This second embodiment is an example of a sensor signal processing device corresponding to the invention described in claims 4 and 5.

【0063】構成的には、図2及び図3に示す第1実施
例と同様であるので、図示並びに説明を省略する。
Since the structure is the same as that of the first embodiment shown in FIGS. 2 and 3, illustration and description thereof will be omitted.

【0064】作用を説明する。The operation will be described.

【0065】(A) ゼロ点電圧算出演算部8dの働き ヨーレートセンサ7の出力電圧をVy,更新前のゼロ点
電圧をVzoとする。通常、ヨーレート算出演算部8a
は、センサの出力電圧Vyからゼロ点電圧Vzoを減算
し、変換定数Kをかけることによりヨーレートψを算出
している。
(A) Function of the zero point voltage calculation operation section 8d The output voltage of the yaw rate sensor 7 is Vy, and the zero point voltage before updating is Vzo. Normally, the yaw rate calculation calculator 8a
Calculates the yaw rate ψ by subtracting the zero-point voltage Vzo from the output voltage Vy of the sensor and applying the conversion constant K.

【0066】ψ=K・(Vy−Vzo) しかしながら、ゼロ点電圧Vzoは、使用環境等の変化な
どによりドリフトするため、以下に示す方法によりヨー
レートセンサ7のゼロ点電圧を推定し、上記ゼロ点電圧
Vzoの値を更新することによりセンサドリフトの影響を
回避する。
Ψ = K (Vy-Vzo) However, the zero point voltage Vzo drifts due to changes in the operating environment, etc. Therefore, the zero point voltage of the yaw rate sensor 7 is estimated by the following method, and the zero point The influence of sensor drift is avoided by updating the value of voltage Vzo.

【0067】基本の考え方は、ヨーレートが発生してい
ない状態の出力電圧Vyをヨーレートセンサ7のゼロ点
電圧としてVzoの値を更新することである。ここで、発
生ヨーレートが許容ヨーレート誤差以下の場合をヨーレ
ートが発生していない状態と判断する。
The basic idea is to update the value of Vzo using the output voltage Vy in the state where the yaw rate is not generated as the zero point voltage of the yaw rate sensor 7. Here, when the generated yaw rate is equal to or less than the allowable yaw rate error, it is determined that the yaw rate is not generated.

【0068】極低速時に発生するヨーレートψ’は次式
で表される。
The yaw rate ψ'generated at an extremely low speed is expressed by the following equation.

【0069】ψ’=Vθ/NL ここで、θは操舵角、Nはステアリンギア比、Lはホイ
ールベース長である。
Ψ ′ = Vθ / NL where θ is the steering angle, N is the steer gear ratio, and L is the wheel base length.

【0070】許容ヨーレート誤差をψ'mとし、上式を書
き換えると次式になる。
When the allowable yaw rate error is ψ'm and the above equation is rewritten, the following equation is obtained.

【0071】V=NLψ'm/|θ| ここで、車速Vは許容ヨーレート誤差ψ'mを発生する速
度である。したがって、この車速V以下の時、発生ヨー
レートは許容ヨーレート誤差以下である。Vは車速セン
サ16のパルス信号より測定する。
V = NLψ'm / | θ | Here, the vehicle speed V is a speed at which the allowable yaw rate error ψ'm is generated. Therefore, when the vehicle speed is V or less, the generated yaw rate is less than the allowable yaw rate error. V is measured from the pulse signal of the vehicle speed sensor 16.

【0072】ここで、車速パルス間隔に進む距離をxと
すると、上式は次式で表される。
Here, when the distance advanced to the vehicle speed pulse interval is x, the above equation is expressed by the following equation.

【0073】NLψ'm/|θ|=x/tr ここで、trは、前記Vに相当する車速パルスが発生して
いる時のパルス間の時間である。上記式を変形すると、
次式が得られる。
NLψ′m / | θ | = x / tr Here, tr is the time between pulses when the vehicle speed pulse corresponding to the V is generated. When the above formula is transformed,
The following equation is obtained.

【0074】tr=x|θ|/NLψ'm 例えば、実際の車両の諸元例として、x=0.78(m) ,L
=3.3(m),N=15.3,ψ'm=1(deg/sec) を代入する
と、 tr= 0.015|θ| となる。したがって、trは操舵角θによって定まる。こ
のtrを越えても車速パルスが発生しない場合、発生ヨー
レートは許容ヨーレート誤差以下であり、ゼロ点電圧V
zoを更新する。
Tr = x | θ | / NLψ'm For example, as an example of specifications of an actual vehicle, x = 0.78 (m), L
= 3.3 (m), N = 15.3, ψ'm = 1 (deg / sec), tr = 0.015 | θ | Therefore, tr is determined by the steering angle θ. If the vehicle speed pulse is not generated even if this tr is exceeded, the generated yaw rate is less than the allowable yaw rate error, and the zero point voltage V
Update zo.

【0075】(B) ゼロ点推定演算 以下、ゼロ点推定演算について図9及び図10のフロー
チャートに基づいて説明する。図9はゼロ点電圧算出演
算処理を示すフローチャートであり、図10は上述した
車速パルスが発生している時のパルス間の時間trの演算
処理を示すフローチャートである。
(B) Zero Point Estimation Calculation The zero point estimation calculation will be described below with reference to the flowcharts of FIGS. 9 and 10. FIG. 9 is a flow chart showing the zero point voltage calculation calculation process, and FIG. 10 is a flow chart showing the calculation process of the time tr between pulses when the vehicle speed pulse described above is generated.

【0076】図10のtr演算処理は、一定時間おき(こ
こでは5msおき)に起動され、前記時間trの演算を行な
う。まず、ステップ100〜102では、時間trの演算
を行なう。
The tr calculation process of FIG. 10 is started at fixed time intervals (here, every 5 ms), and the time tr is calculated. First, in steps 100 to 102, the time tr is calculated.

【0077】そして、ステップ103では、車速パルス
が発生(Vp=1)しているか否かを判定する。
Then, in step 103, it is determined whether or not a vehicle speed pulse is generated (Vp = 1).

【0078】車速パルスが発生している場合は、ステッ
プ104〜ステップ106へ進み、全ての条件をリセッ
トする。
If the vehicle speed pulse is generated, the process proceeds to steps 104 to 106 to reset all the conditions.

【0079】車速パルスが発生していない場合は、ステ
ップ107へ進み、カウントアップを行なう。カウント
中に操舵角θが増えたら時間trを更新し、一番厳しい条
件とする。
When the vehicle speed pulse is not generated, the routine proceeds to step 107, where the count-up is performed. If the steering angle θ increases during counting, the time tr is updated and the most severe condition is set.

【0080】ゼロ点電圧算出演算処理を図9のフローチ
ャートにしたがって説明する。
The zero point voltage calculation processing will be described with reference to the flowchart of FIG.

【0081】まず、ステップ90では、車速Vが5km/h
以下かどうかを判定する。5km/h以上の場合は終了す
る。
First, at step 90, the vehicle speed V is 5 km / h.
It is determined whether or not If the speed is 5 km / h or more, the process ends.

【0082】ステップ91では、tc=trかどうかを判定
する。tcがtrに満たない場合は終了する。
In step 91, it is determined whether tc = tr. If tc is less than tr, terminate.

【0083】ステップ92では、tc=trとなると、Cを
カウントアップする。Cは2つの車速パルス間に何回tc
=trとなったかをカウントするカウンタである。
In step 92, when tc = tr, C is incremented. C is the number of times tc between two vehicle speed pulses
This is a counter that counts whether or not = tr.

【0084】図8に示すように、C=1の時は、出力電
圧Vyの測定のみを行ない、ゼロ点電圧Vzoの更新は行
なわない(ステップ93→ステップ94)。
As shown in FIG. 8, when C = 1, only the output voltage Vy is measured and the zero-point voltage Vzo is not updated (step 93 → step 94).

【0085】C>1の時は、前回測定した出力電圧Vy
を新たなゼロ点としてゼロ点電圧Vzoを更新し、さら
に、その時の出力電圧Vyを測定する(ステップ93→
ステップ95→ステップ94)。
When C> 1, the output voltage Vy measured last time
The zero point voltage Vzo is updated with the new zero point as the new zero point, and the output voltage Vy at that time is measured (step 93 →
Step 95 → step 94).

【0086】この後、ステップ96でtcをリセットし、
ステップ97でθs をリセットして終了する。
Thereafter, tc is reset at step 96,
In step 97, θs is reset and the process ends.

【0087】次に、効果を説明する。Next, the effect will be described.

【0088】車速Vが5km/h以下の状態であって、発生
ヨーレートを操舵角θと車速Vと車両特性とから推定
し、その推定発生ヨーレートψ’が予め定めた許容ヨー
レート誤差ψ'm以下であるという条件が満たされた時、
ヨーレートセンサ7からの出力電圧Vyをゼロ点電圧V
zoとして更新するようにした為、ヨーレートセンサ7の
ドリフト量にかかわらず正しいヨーレートψを算出する
ことが出来る。
When the vehicle speed V is 5 km / h or less, the generated yaw rate is estimated from the steering angle θ, the vehicle speed V and the vehicle characteristics, and the estimated generated yaw rate ψ'is less than a predetermined allowable yaw rate error ψ'm. When the condition that is
The output voltage Vy from the yaw rate sensor 7 is set to the zero point voltage Vy.
Since it is updated as zo, the correct yaw rate ψ can be calculated regardless of the drift amount of the yaw rate sensor 7.

【0089】この結果、ヨーレートψを制御情報とする
後輪舵角制御で、ヨーレート検出値がドリフトすること
で直進走行時に後輪が転舵されるということが解消さ
れ、高い後輪舵角制御精度を確保することが出来る。
As a result, in the rear wheel steering angle control using the yaw rate ψ as the control information, the fact that the rear wheel is steered during straight traveling due to the drift of the detected yaw rate is eliminated, and the high rear wheel steering angle control is performed. Accuracy can be secured.

【0090】尚、この第2実施例では、C=1の時はゼ
ロ点電圧Vzoの更新は行なわなかったが、これは2つの
車速パルス間に車両が加減速することを考慮して、より
正確なゼロ点電圧を定める為である。C=1の時の出力
電圧Vyを新たなゼロ点としてゼロ点電圧Vzoを更新し
た場合でも、許容ヨーレート誤差以内でゼロ点電圧を定
めることが出来る。
In the second embodiment, the zero-point voltage Vzo is not updated when C = 1, but this is taken into consideration in consideration of the acceleration / deceleration of the vehicle between two vehicle speed pulses. This is to determine an accurate zero point voltage. Even when the output voltage Vy when C = 1 is set as a new zero point and the zero point voltage Vzo is updated, the zero point voltage can be determined within the allowable yaw rate error.

【0091】[0091]

【発明の効果】請求項1記載の本発明にあっては、ヨー
レートセンサからの出力信号に基づいてヨーレートを算
出するセンサ信号処理装置において、所定の操舵振幅以
下の操舵が、所定の速度変動以下の条件で所定時間内継
続した場合、その間の操舵角のプラス成分のみの値とマ
イナス成分のみの値の比と、その間のヨーレートのプラ
ス成分のみの値とマイナス成分のみの値の比を等しくす
る方向でヨーレートセンサのゼロ点信号を更新するヨー
レート補正信号算出手段を設けた為、ヨーレートセンサ
のドリフト量にかかわらず正確なヨーレートを算出する
ことが出来るという効果が得られる。
According to the first aspect of the present invention, in the sensor signal processing device for calculating the yaw rate based on the output signal from the yaw rate sensor, the steering with the predetermined steering amplitude or less is the predetermined speed fluctuation or less. If the steering angle continues for a predetermined time under the condition of, the ratio of the value of only the positive component and the value of the negative component of the steering angle during that period is made equal to the ratio of the value of only the positive component of the yaw rate and the value of only the negative component. Since the yaw rate correction signal calculating means for updating the zero point signal of the yaw rate sensor in the direction is provided, it is possible to obtain an effect that an accurate yaw rate can be calculated regardless of the drift amount of the yaw rate sensor.

【0092】請求項2記載の本発明にあっては、請求項
1記載のセンサ信号処理装置において、ヨーレート補正
信号算出手段は、前記Is+,Is-,ψ+,ψ−の値とし
て、プラス成分やマイナス成分のみの信号から演算され
る積分値を用いてヨーレート補正信号を演算するように
した為、プラス成分積算値とマイナス成分積算値に基づ
くヨーレート補正となり、より正確なヨーレートを算出
することが出来る。
According to a second aspect of the present invention, in the sensor signal processing apparatus according to the first aspect, the yaw rate correction signal calculating means has a plus component as a value of Is +, Is-, ψ +, ψ-. Since the yaw rate correction signal is calculated using the integrated value calculated from the signal of only the minus component, the yaw rate correction is based on the plus component integrated value and the minus component integrated value, and a more accurate yaw rate can be calculated. ..

【0093】請求項3記載の本発明にあっては、請求項
1,2記載のセンサ信号処理装置において、ヨーレート
補正信号算出手段は、更新前のヨーレート補正信号以外
の複数のヨーレート補正信号を仮に設定し、各々のヨー
レート補正信号を用いて請求項1または請求項2記載の
演算を行ない、Is+対Is-の比と、各々のヨーレート補
正信号を用いて演算したψ+とψ−の値を用いて新たな
ヨーレート補正信号を算出し、ヨーレート補正信号の更
新を行なうようにした為、基準となるゼロ点の精度が高
まることで、より正確なヨーレートを算出することが出
来る。
According to a third aspect of the present invention, in the sensor signal processing device according to the first and second aspects, the yaw rate correction signal calculation means temporarily outputs a plurality of yaw rate correction signals other than the yaw rate correction signal before updating. The yaw rate correction signal is set and the calculation according to claim 1 or 2 is performed using each yaw rate correction signal, and the ratio of Is + to Is- and the values of ψ + and ψ− calculated using each yaw rate correction signal are used. Since a new yaw rate correction signal is calculated and the yaw rate correction signal is updated, the accuracy of the reference zero point is increased, so that a more accurate yaw rate can be calculated.

【0094】請求項4記載の本発明にあっては、ヨーレ
ートセンサからの出力信号に基づいてヨーレートを算出
するセンサ信号処理装置において、発生ヨーレートを操
舵角と前後方向速度と車両特性とから推定し、その推定
発生ヨーレートが予め定めた許容ヨーレート誤差以下で
ある場合、その時のヨーレートセンサの出力信号をゼロ
点信号として更新するヨーレート補正信号算出手段を設
けた為、ヨーレートセンサのドリフト量にかかわらず正
確なヨーレートを算出することが出来るという効果が得
られる。
According to the fourth aspect of the present invention, in the sensor signal processing device for calculating the yaw rate based on the output signal from the yaw rate sensor, the generated yaw rate is estimated from the steering angle, the longitudinal speed and the vehicle characteristic. , If the estimated generated yaw rate is less than or equal to a predetermined allowable yaw rate error, the yaw rate correction signal calculation means for updating the output signal of the yaw rate sensor at that time as a zero point signal is provided, so that it is accurate regardless of the drift amount of the yaw rate sensor. The effect that it is possible to calculate a different yaw rate is obtained.

【0095】請求項5記載の本発明にあっては、請求項
4記載のセンサ信号処理装置において、ヨーレート補正
信号算出手段は、前後方向速度が所定値以下であるとい
う条件が満たされた時、ヨーレートセンサ出力を、ヨー
レート補正信号とするようにした為、サンプリングされ
るヨーレートセンサ出力が安定し、より正確なヨーレー
トを算出することが出来る。
According to a fifth aspect of the present invention, in the sensor signal processing apparatus according to the fourth aspect, the yaw rate correction signal calculating means satisfies the condition that the longitudinal velocity is equal to or less than a predetermined value, Since the yaw rate sensor output is used as the yaw rate correction signal, the sampled yaw rate sensor output is stable, and a more accurate yaw rate can be calculated.

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

【図1】本発明のセンサ信号処理装置を示すクレーム対
応図である。
FIG. 1 is a claim correspondence diagram showing a sensor signal processing device of the present invention.

【図2】実施例のセンサ信号処理装置が適用された後輪
舵角制御システムを示す全体図である。
FIG. 2 is an overall view showing a rear wheel steering angle control system to which the sensor signal processing device of the embodiment is applied.

【図3】実施例のシステムのコントローラの内部構成を
示すブロック図である。
FIG. 3 is a block diagram showing an internal configuration of a controller of the system of the embodiment.

【図4】第1実施例のヨーレート算出演算に用いる操舵
角とヨーレートの各積分演算の内容を説明する図であ
る。
FIG. 4 is a diagram illustrating the content of each integral calculation of a steering angle and a yaw rate used in the yaw rate calculation calculation of the first embodiment.

【図5】第1実施例のヨーレート算出演算でのゼロ点電
圧を求める手法を説明する図である。
FIG. 5 is a diagram illustrating a method of obtaining a zero-point voltage in a yaw rate calculation calculation according to the first embodiment.

【図6】第1実施例装置でのゼロ点電圧算出演算処理の
流れを示すフローチャートである。
FIG. 6 is a flowchart showing the flow of zero-point voltage calculation processing in the device of the first embodiment.

【図7】第1実施例装置での積分値等の演算処理の流れ
を示すフローチャートである。
FIG. 7 is a flowchart showing a flow of calculation processing of an integrated value and the like in the device of the first embodiment.

【図8】第2実施例装置でのゼロ点電圧の更新タイミン
グを説明する車速パルス特性図である。
FIG. 8 is a vehicle speed pulse characteristic diagram illustrating the update timing of the zero-point voltage in the second embodiment device.

【図9】第2実施例装置でのゼロ点電圧算出演算処理の
流れを示すフローチャートである。
FIG. 9 is a flowchart showing the flow of zero-point voltage calculation processing in the device of the second embodiment.

【図10】第2実施例装置でのtr,tcの演算処理の流れ
を示すフローチャートである。
FIG. 10 is a flow chart showing a flow of arithmetic processing of tr and tc in the device of the second embodiment.

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

a 操舵角検出手段 b 速度検出手段 c ヨーレートセンサ d1 ヨーレート補正信号算出手段 d2 ヨーレート補正信号算出手段 e ヨーレート算出手段 a steering angle detection means b speed detection means c yaw rate sensor d1 yaw rate correction signal calculation means d2 yaw rate correction signal calculation means e yaw rate calculation means

───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.5 識別記号 庁内整理番号 FI 技術表示箇所 B62D 113:00 137:00 (72)発明者 堤 淳二 神奈川県横浜市神奈川区宝町2番地 日産 自動車株式会社内─────────────────────────────────────────────────── ─── Continuation of the front page (51) Int.Cl. 5 Identification number Reference number within the agency FI Technical display location B62D 113: 00 137: 00 (72) Inventor Junji Tsutsumi 2 Takaracho, Kanagawa-ku, Kanagawa Prefecture Nissan Motor Co., Ltd. Within the corporation

Claims (5)

【特許請求の範囲】[Claims] 【請求項1】 車両の操舵角を検出する操舵角検出手段
と、車両の前後方向速度を検出する速度検出手段と、車
両の発生ヨーレートに応じた信号を出力するヨーレート
センサと、前記速度検出手段の出力と前記操舵角検出手
段の出力と前記ヨーレートセンサの出力とからヨーレー
ト補正信号を演算するヨーレート補正信号算出手段と、
前記ヨーレートセンサの出力する信号と前記ヨーレート
補正信号とから発生ヨーレートを算出するヨーレート算
出手段とからなるセンサ信号処理装置において、 前記ヨーレート補正信号算出手段は、前記操舵角が所定
値以下の操舵振幅をもって正負に操舵されている状態が
所定時間以上継続し、かつ、その間の前記前後方向の速
度の変動が所定値以下であるという条件が満たされた
時、その所定時間内の前記操舵角のプラス成分のみの信
号から演算される値(Is+)とマイナス成分のみの信号
から演算される値(Is-)と、前記ヨーレートのプラス
成分のみの信号から演算される値(ψ+)とマイナス成
分のみの信号から演算される値(ψ−)を算出し、Is+
対Is-の比とψ+対ψ−の比が等しくなるようにヨーレ
ート補正信号を演算することを特徴とするセンサ信号処
理装置。
1. A steering angle detecting means for detecting a steering angle of a vehicle, a speed detecting means for detecting a longitudinal speed of the vehicle, a yaw rate sensor for outputting a signal according to a yaw rate generated by the vehicle, and the speed detecting means. A yaw rate correction signal calculation means for calculating a yaw rate correction signal from the output of the steering angle detection means and the output of the yaw rate sensor,
In a sensor signal processing device comprising a yaw rate calculation means for calculating a generated yaw rate from a signal output from the yaw rate sensor and the yaw rate correction signal, the yaw rate correction signal calculation means has a steering amplitude in which the steering angle is a predetermined value or less. When the condition that the positive and negative steering is continued for a predetermined time or more and the fluctuation of the speed in the front-rear direction during that time is less than a predetermined value, the plus component of the steering angle within the predetermined time is satisfied. Value (Is +) calculated from the signal of only the negative component and a value (Is-) calculated from the signal of only the negative component, and a value (ψ +) calculated from the signal of only the positive component of the yaw rate and the signal of only the negative component Calculate the value (ψ−) calculated from
A sensor signal processing device, wherein a yaw rate correction signal is calculated so that a ratio of Is- and a ratio of ψ + to ψ- become equal.
【請求項2】 請求項1記載のセンサ信号処理装置にお
いて、 前記ヨーレート補正信号算出手段は、前記Is+の値とし
て前記所定時間内の操舵角のプラス成分のみの積分値を
用い、前記Is-の値として前記所定時間内の操舵角のマ
イナス成分のみの積分値を用い、前記ψ+の値として前
記所定時間内の前記ヨーレートのプラス成分のみの積分
値を用い、ψ−の値として前記所定時間内の前記ヨーレ
ートのマイナス成分のみの積分値を用いる手段であるこ
とを特徴とするセンサ信号処理装置。
2. The sensor signal processing device according to claim 1, wherein the yaw rate correction signal calculation means uses an integrated value of only a positive component of the steering angle within the predetermined time as the value of Is +, and the value of Is− As the value, the integrated value of only the minus component of the steering angle within the predetermined time is used, as the value of ψ +, the integrated value of only the positive component of the yaw rate within the predetermined time is used, and as the value of ψ− within the predetermined time. 2. A sensor signal processing device, characterized in that it is means for using an integrated value of only the negative component of the yaw rate.
【請求項3】 請求項1,2記載のセンサ信号処理装置
において、 前記ヨーレート補正信号算出手段は、更新前のヨーレー
ト補正信号以外の複数のヨーレート補正信号を仮に設定
し、各々のヨーレート補正信号を用いて請求項1または
請求項2記載の演算を行ない、前記Is+対Is-の比と、
前記各々のヨーレート補正信号を用いて演算したψ+と
ψ−の値を用いて新たなヨーレート補正信号を算出し、
ヨーレート補正信号の更新を行なうことを特徴とするセ
ンサ信号処理装置。
3. The sensor signal processing device according to claim 1, wherein the yaw rate correction signal calculation means temporarily sets a plurality of yaw rate correction signals other than the yaw rate correction signal before update, and each yaw rate correction signal is set. The calculation according to claim 1 or 2 is performed by using the ratio of Is + to Is-, and
A new yaw rate correction signal is calculated using the values of ψ + and ψ− calculated using the respective yaw rate correction signals,
A sensor signal processing device characterized by updating a yaw rate correction signal.
【請求項4】 車両の操舵角を検出する操舵角検出手段
と、車両の前後方向速度を検出する速度検出手段と、車
両の発生ヨーレートに応じた信号を出力するヨーレート
センサと、前記速度検出手段の出力と前記操舵角検出手
段の出力と前記ヨーレートセンサの出力とからヨーレー
ト補正信号を演算するヨーレート補正信号算出手段と、
前記ヨーレートセンサの出力する信号と前記ヨーレート
補正信号とから発生ヨーレートを算出するヨーレート算
出手段とからなるセンサ信号処理装置において、 前記ヨーレート補正信号算出手段は、発生ヨーレートを
前記操舵角と前記前後方向速度と車両特性とから推定
し、その推定発生ヨーレートが予め定めた許容ヨーレー
ト誤差以下であるという条件が満たされた時、前記ヨー
レートセンサ出力を、前記ヨーレート補正信号とするこ
とを特徴とするセンサ信号処理装置。
4. A steering angle detecting means for detecting a steering angle of a vehicle, a speed detecting means for detecting a longitudinal speed of the vehicle, a yaw rate sensor for outputting a signal according to a yaw rate generated by the vehicle, and the speed detecting means. A yaw rate correction signal calculation means for calculating a yaw rate correction signal from the output of the steering angle detection means and the output of the yaw rate sensor,
In a sensor signal processing device comprising a yaw rate calculating means for calculating a generated yaw rate from a signal output from the yaw rate sensor and the yaw rate correction signal, the yaw rate correction signal calculating means may change the generated yaw rate to the steering angle and the longitudinal speed. And a vehicle characteristic, and when the condition that the estimated generated yaw rate is equal to or less than a predetermined allowable yaw rate error is satisfied, the yaw rate sensor output is used as the yaw rate correction signal. apparatus.
【請求項5】 請求項4記載のセンサ信号処理装置にお
いて、 前記ヨーレート補正信号算出手段は、前記前後方向速度
が所定値以下であるという条件が満たされた時、前記ヨ
ーレートセンサ出力を、前記ヨーレート補正信号とする
ことを特徴とするセンサ信号処理装置。
5. The sensor signal processing device according to claim 4, wherein the yaw rate correction signal calculation means outputs the yaw rate sensor output to the yaw rate sensor when a condition that the longitudinal speed is equal to or less than a predetermined value is satisfied. A sensor signal processing device characterized by using a correction signal.
JP4118828A 1992-05-12 1992-05-12 Sensor signal processing device Expired - Fee Related JP2864868B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP4118828A JP2864868B2 (en) 1992-05-12 1992-05-12 Sensor signal processing device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP4118828A JP2864868B2 (en) 1992-05-12 1992-05-12 Sensor signal processing device

Publications (2)

Publication Number Publication Date
JPH05314397A true JPH05314397A (en) 1993-11-26
JP2864868B2 JP2864868B2 (en) 1999-03-08

Family

ID=14746163

Family Applications (1)

Application Number Title Priority Date Filing Date
JP4118828A Expired - Fee Related JP2864868B2 (en) 1992-05-12 1992-05-12 Sensor signal processing device

Country Status (1)

Country Link
JP (1) JP2864868B2 (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6278929B1 (en) 1998-10-30 2001-08-21 Aisin Seiki Kabushiki Kaisha Vehicle motion control system
US6324445B2 (en) 1998-10-13 2001-11-27 Aisin Seiki Kabushiki Kaisha Yaw rate detecting system for a vehicle
KR100946190B1 (en) * 2005-11-17 2010-03-09 주식회사 만도 Shock offset error detection method for yaw rate sensor in a vehicle
JP2020057379A (en) * 2018-09-30 2020-04-09 バイドゥ・ユーエスエイ・リミテッド・ライアビリティ・カンパニーBaidu USA LLC Method and device for calibrating vehicle control parameters, on-vehicle controller and unmanned vehicle
CN113562066A (en) * 2021-07-20 2021-10-29 浙江万安科技股份有限公司 Wire-controlled steering system and fault diagnosis method

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102494676B1 (en) * 2016-01-06 2023-02-02 에이치엘만도 주식회사 Steering control apparatus

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6324445B2 (en) 1998-10-13 2001-11-27 Aisin Seiki Kabushiki Kaisha Yaw rate detecting system for a vehicle
US6278929B1 (en) 1998-10-30 2001-08-21 Aisin Seiki Kabushiki Kaisha Vehicle motion control system
DE19952308C2 (en) * 1998-10-30 2003-05-28 Aisin Seiki Device for regulating the driving behavior of a motor vehicle
KR100946190B1 (en) * 2005-11-17 2010-03-09 주식회사 만도 Shock offset error detection method for yaw rate sensor in a vehicle
JP2020057379A (en) * 2018-09-30 2020-04-09 バイドゥ・ユーエスエイ・リミテッド・ライアビリティ・カンパニーBaidu USA LLC Method and device for calibrating vehicle control parameters, on-vehicle controller and unmanned vehicle
CN113562066A (en) * 2021-07-20 2021-10-29 浙江万安科技股份有限公司 Wire-controlled steering system and fault diagnosis method

Also Published As

Publication number Publication date
JP2864868B2 (en) 1999-03-08

Similar Documents

Publication Publication Date Title
US6546323B2 (en) Vehicle front/rear wheel steering angle control apparatus and vehicle front/rear wheel steering angle control method
EP1652752B1 (en) Ackerman angle based vehicle steering angle correction
JP2982595B2 (en) Actual steering angle control device for vehicle
KR960007419B1 (en) Controlling apparatus of steering angle of rear wheels of four-wheel steering vehicle
JPH06104455B2 (en) Vehicle motion condition estimation device
US4971175A (en) Steering system for vehicles
JPH01202581A (en) Rear wheel steering angle control method in front-rear-wheel-steering vehicle
JPH08202403A (en) Vehicle state quantity estimation device
KR100311291B1 (en) Vehicle stability control device
JP2864868B2 (en) Sensor signal processing device
JP2009214753A (en) Vehicle travel state estimating device
JPH0591607A (en) Controller for wheel drive motor
JPS62240811A (en) Traveling direction detector for vehicle
JP5768865B2 (en) Electric power steering device
JP3168758B2 (en) Detection yaw rate correction device
JP4135158B2 (en) Vehicle front and rear wheel steering angle control device
EP0551891A2 (en) Apparatus for controlling steering angle of rear wheel of four-wheel steering vehicle and method therefor
JPH07246948A (en) Compensator of quantity of vehicle motion state
JP3624047B2 (en) Rear wheel steering device
JP2770505B2 (en) Vehicle rear wheel steering angle control device
JPH05147551A (en) Rear wheel steering angle controller for four-wheel steering vehicle
JPH06273444A (en) Correction apparatus of detected yaw rate
SU933525A1 (en) Device for automatic correction of wheeled vehicle trajectory
JP2755068B2 (en) Vehicle weight center slip angle measuring device
JP2940372B2 (en) Auxiliary steering angle control device for vehicles

Legal Events

Date Code Title Description
LAPS Cancellation because of no payment of annual fees