JP2005326239A - Yaw rate detection apparatus and yaw rate zero-point correction method - Google Patents

Yaw rate detection apparatus and yaw rate zero-point correction method Download PDF

Info

Publication number
JP2005326239A
JP2005326239A JP2004144006A JP2004144006A JP2005326239A JP 2005326239 A JP2005326239 A JP 2005326239A JP 2004144006 A JP2004144006 A JP 2004144006A JP 2004144006 A JP2004144006 A JP 2004144006A JP 2005326239 A JP2005326239 A JP 2005326239A
Authority
JP
Japan
Prior art keywords
yaw rate
zero point
steering angle
zero
history
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
JP2004144006A
Other languages
Japanese (ja)
Other versions
JP4572574B2 (en
Inventor
Takashi Ogawa
高志 小川
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.)
Denso Corp
Original Assignee
Denso Corp
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 Denso Corp filed Critical Denso Corp
Priority to JP2004144006A priority Critical patent/JP4572574B2/en
Publication of JP2005326239A publication Critical patent/JP2005326239A/en
Application granted granted Critical
Publication of JP4572574B2 publication Critical patent/JP4572574B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Landscapes

  • Gyroscopes (AREA)
  • Navigation (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Traffic Control Systems (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide a yaw rate detection apparatus and a yaw rate zero-point correction method capable of performing yaw rate zero-point correction under any road conditions. <P>SOLUTION: By identifying the transfer function of a yaw rate with respect to a steering angle of a self vehicle through the use of a steering angle of the self vehicle detected by a steering detecting part 110, a yaw rate detected by a yaw rate detecting part 130, and a zero-point history of the yaw rate detecting part 130 stored in a yaw rate zero-point history storage part 160, a zero point of the yaw rate detecting part 130 is estimated. <P>COPYRIGHT: (C)2006,JPO&NCIPI

Description

本発明は、ヨーレート検出装置、及びヨーレート零点補正方法に関するものである。   The present invention relates to a yaw rate detection device and a yaw rate zero correction method.

車両の走行制御などに用いられるヨーレートセンサは、センサ雰囲気温度などが原因で時間の経過と共に中立点(すなわち、零点)がドリフトすることが知られている。従って、車両の正確なヨーレートを算出するために、ヨーレートセンサの中立点を何らかの手法で推定し、ヨーレートセンサからの出力値を補正する必要がある。   It is known that a neutral point (that is, a zero point) drifts with the lapse of time in a yaw rate sensor used for vehicle running control or the like due to sensor ambient temperature or the like. Therefore, in order to calculate the accurate yaw rate of the vehicle, it is necessary to estimate the neutral point of the yaw rate sensor by some method and correct the output value from the yaw rate sensor.

この課題に対し、従来、ヨーレートの中立点補正を走行中でも行えるようにした車両のヨーレート検出装置が提案されている(例えば、特許文献1参照。)。この特許文献1に開示されているヨーレート検出装置によれば、例えば、ある程度の速度を出して車両が走行しているとき、舵角変化が直進状態とみなせる所定の舵角内であり、角速度変化が所定角速度内である場合に、ヨーレートセンサからの最大角速度と最小角速度を採用し、それを角速度候補値としてメモリに記憶した後、舵角候補値を所定距離分メモリに記憶させ、角速度候補値の総和と角速度候補値の数により角速度補正を行う。
特開2002−107147号公報
Conventionally, a yaw rate detection device for a vehicle has been proposed in which neutral point correction of the yaw rate can be performed while the vehicle is traveling (see, for example, Patent Document 1). According to the yaw rate detection device disclosed in Patent Document 1, for example, when the vehicle is traveling at a certain speed, the steering angle change is within a predetermined steering angle that can be regarded as a straight traveling state, and the angular speed change Is within the predetermined angular velocity, the maximum angular velocity and the minimum angular velocity from the yaw rate sensor are adopted and stored in the memory as angular velocity candidate values, and then the steering angle candidate values are stored in the memory for a predetermined distance to obtain the angular velocity candidate values. The angular velocity correction is performed based on the sum of the values and the number of candidate angular velocity values.
JP 2002-107147 A

前述したように、ヨーレートセンサは、車両の走行制御などに用いられるため、どのような道路状況であってもヨーレートセンサの零点を推定する必要がある。しかしながら、従来のヨーレート検出装置は、舵角変化が直進状態とみなせる所定の舵角内であり、かつ角速度変化が所定角速度内である場合にのみ角速度補正が可能なものである。   As described above, since the yaw rate sensor is used for vehicle running control or the like, it is necessary to estimate the zero point of the yaw rate sensor in any road condition. However, the conventional yaw rate detection device can correct the angular velocity only when the change in the steering angle is within a predetermined steering angle that can be regarded as a straight traveling state and the change in the angular velocity is within the predetermined angular velocity.

従って、例えば、カーブ路が連続するような道路状況では、舵角や角速度が著しく変化することが多いため、ヨーレートセンサの零点を推定する機会が少なくなり、その結果、零点補正が出来なくなる。   Therefore, for example, in a road situation in which curved roads are continuous, the steering angle and the angular velocity often change remarkably, so the opportunity to estimate the zero point of the yaw rate sensor is reduced, and as a result, the zero point cannot be corrected.

本発明は、かかる問題を鑑みてなされたもので、あるゆる道路状況においても、ヨーレートの零点を補正することができるヨーレート検出装置、及びヨーレート零点補正方法を提供することを目的とする。   The present invention has been made in view of such a problem, and an object of the present invention is to provide a yaw rate detection device and a yaw rate zero correction method that can correct the zero of the yaw rate even in any road conditions.

上記課題を解決するためになされた請求項1に記載のヨーレート検出装置は、車両の操舵角を検出する操舵角検出手段と、車両のヨーレートを検出するヨーレート検出手段と、ヨーレート零点推定手段の推定したヨーレート検出手段の零点の履歴を記憶するヨーレート零点履歴記憶手段と、操舵角検出手段及びヨーレート検出手段が検出した操舵角及びヨーレートと、ヨーレート零点履歴記憶手段の記憶する零点の履歴とを用いて、車両の操舵角に対する車両のヨーレートの伝達関数を同定することによって、ヨーレート検出手段の検出したヨーレートの零点補正に用いる零点を推定するヨーレート零点推定手段と、を備えることを特徴とする。   The yaw rate detection apparatus according to claim 1, which has been made to solve the above-described problem, is a steering angle detection unit that detects a steering angle of a vehicle, a yaw rate detection unit that detects a yaw rate of the vehicle, and an estimation of a yaw rate zero point estimation unit. Using the yaw rate zero point history storage means for storing the zero point history of the yaw rate detection means, the steering angle and yaw rate detected by the steering angle detection means and the yaw rate detection means, and the zero point history stored in the yaw rate zero history storage means And yaw rate zero point estimating means for estimating a zero point used for correcting the zero point of the yaw rate detected by the yaw rate detecting means by identifying a transfer function of the yaw rate of the vehicle with respect to the steering angle of the vehicle.

本発明は、自動車等の車両が平面上を運動するものとし、車両の左右方向の荷重移動を考えない平面2輪モデルの運動方程式から、車両の操舵角に対するヨーレートの伝達関数が求められることに着目したものである。   According to the present invention, a vehicle such as an automobile moves on a plane, and a transfer function of a yaw rate with respect to a steering angle of the vehicle is obtained from a motion equation of a plane two-wheel model that does not consider the load movement in the left-right direction of the vehicle. It is the one that paid attention.

すなわち、車両の操舵角、ヨーレート、これまでに推定したヨーレート検出手段の零点の履歴を用いて、前述の車両の操舵角に対するヨーレートの伝達関数を同定する(システム同定)。   That is, the transfer function of the yaw rate with respect to the steering angle of the vehicle is identified using the history of the steering angle of the vehicle, the yaw rate, and the zero point history of the yaw rate detecting means estimated so far (system identification).

この車両の操舵角に対するヨーレートの伝達関数を同定することによって、ヨーレート検出手段の零点が推定できるため、ヨーレート検出手段の雰囲気温度などが原因で時間の経過と共に零点がドリフトしたり、カーブ路が連続したりするような道路状況であっても、推定した零点を用いてヨーレートの零点を補正することができる。   By identifying the transfer function of the yaw rate with respect to the steering angle of the vehicle, the zero point of the yaw rate detecting means can be estimated. Therefore, the zero point drifts over time due to the ambient temperature of the yaw rate detecting means, or the curve road is continuous. Even in such a road situation, the zero point of the yaw rate can be corrected using the estimated zero point.

請求項2に記載のヨーレート検出装置は、ヨーレート零点推定手段が推定した零点を用いて、ヨーレート検出手段が検出するヨーレートの零点を補正する零点補正手段を備えることを特徴とする。これにより、ヨーレートの零点を補正することができる。   According to a second aspect of the present invention, there is provided a yaw rate detecting device comprising zero point correcting means for correcting the zero point of the yaw rate detected by the yaw rate detecting means using the zero point estimated by the yaw rate zero point estimating means. Thereby, the zero point of the yaw rate can be corrected.

請求項3に記載のヨーレート検出装置によれば、ヨーレート零点推定手段は、1次遅れ系、及び2次遅れ系の少なくとも一方の伝達関数を同定することによって、零点を推定することを特徴とする。一般に、平面2輪モデルの運動方程式から求められる伝達関数は、2次遅れ系で示されるため、この2次遅れ系の伝達関数を同定することによって、ヨーレート検出手段の零点を推定することができる。   According to the yaw rate detection apparatus of claim 3, the yaw rate zero point estimation means estimates the zero point by identifying a transfer function of at least one of the first-order lag system and the second-order lag system. . In general, since the transfer function obtained from the equation of motion of the planar two-wheel model is represented by a second-order lag system, the zero point of the yaw rate detection means can be estimated by identifying the transfer function of the second-order lag system. .

なお、車両の運動が著しく変動しない(安定した)状況においては、平面2輪モデルの運動方程式から求められる2次遅れ系の伝達関数を1次遅れ系の伝達関数で近似し、この1次遅れ系の伝達関数を同定することによって、ヨーレート検出手段の零点を推定するようにしてもよい。これにより、零点の推定に要する演算処理を軽減することができる。   In a situation where the vehicle motion does not fluctuate significantly (stable), the transfer function of the second-order lag system obtained from the equation of motion of the planar two-wheel model is approximated by the transfer function of the first-order lag system, and this first-order lag The zero point of the yaw rate detection means may be estimated by identifying the transfer function of the system. As a result, it is possible to reduce the arithmetic processing required for zero point estimation.

請求項4に記載のヨーレート検出装置は、ヨーレート検出手段の検出したヨーレートの履歴を記憶するヨーレート履歴記憶手段を備え、ヨーレート零点推定手段は、操舵角検出手段及びヨーレート検出手段が検出した現在の操舵角及びヨーレートと、ヨーレート履歴記憶手段の記憶するヨーレートの履歴と、ヨーレート零点履歴記憶手段の記憶する零点の履歴とを用いて、1次遅れ系の伝達関数を同定することによって、零点を推定することを特徴とする。これにより、1次遅れ系の伝達関数に基づいて、ヨーレート検出手段の零点を推定することができる。   The yaw rate detection device according to claim 4 includes a yaw rate history storage unit that stores a history of the yaw rate detected by the yaw rate detection unit, and the yaw rate zero point estimation unit includes the current steering detected by the steering angle detection unit and the yaw rate detection unit. The zero point is estimated by identifying the transfer function of the first-order lag system using the angle and yaw rate, the yaw rate history stored in the yaw rate history storage means, and the zero history stored in the yaw rate zero history storage means. It is characterized by that. Thereby, the zero point of the yaw rate detecting means can be estimated based on the transfer function of the first-order lag system.

請求項5に記載のヨーレート検出装置は、操舵角検出手段の検出した操舵角の履歴を記憶する操舵角履歴記憶手段と、ヨーレート検出手段の検出したヨーレートの履歴を記憶するヨーレート履歴記憶手段とを備え、ヨーレート零点推定手段は、操舵角検出手段及びヨーレート検出手段が検出した現在の操舵角及びヨーレートと、操舵角履歴記憶手段の記憶する操舵角の履歴と、ヨーレート履歴記憶手段の記憶するヨーレートの履歴と、ヨーレート零点履歴記憶手段の記憶する零点の履歴とを用いて、2次遅れ系の伝達関数を同定することによって、零点を推定することを特徴とする。これにより、2次遅れ系の伝達関数に基づいて、ヨーレート検出手段の零点を推定することができる。   According to a fifth aspect of the present invention, there is provided a yaw rate detection device comprising: a steering angle history storage means for storing a history of the steering angle detected by the steering angle detection means; and a yaw rate history storage means for storing a history of the yaw rate detected by the yaw rate detection means. The yaw rate zero point estimation means includes the current steering angle and yaw rate detected by the steering angle detection means and the yaw rate detection means, the history of the steering angle stored in the steering angle history storage means, and the yaw rate stored in the yaw rate history storage means. The zero point is estimated by identifying the transfer function of the second-order lag system using the history and the zero point history stored in the yaw rate zero point history storage means. Thereby, the zero point of the yaw rate detecting means can be estimated based on the transfer function of the second order lag system.

請求項6に記載のヨーレート検出装置は、車両の速度を検出する速度検出手段を備え、ヨーレート零点推定手段は、車両が一定速度で走行する場合に推定することを特徴とする。前述の車両の操舵角に対するヨーレートの伝達関数は、車両の速度を変数としてもつ。そのため、車両が一定速度で走行する場合、この変数は定数として扱えることから、車両が一定速度で走行する場合に推定することで、車両の速度変動を考慮することなく、ヨーレート検出手段の零点を推定することができる。   According to a sixth aspect of the present invention, there is provided a yaw rate detection device comprising speed detection means for detecting the speed of the vehicle, and the yaw rate zero point estimation means estimates when the vehicle travels at a constant speed. The transfer function of the yaw rate with respect to the steering angle of the vehicle has the vehicle speed as a variable. Therefore, since this variable can be treated as a constant when the vehicle travels at a constant speed, the zero point of the yaw rate detection means can be calculated without considering the speed fluctuation of the vehicle by estimating when the vehicle travels at a constant speed. Can be estimated.

請求項7に記載のヨーレート検出装置によれば、ヨーレート零点推定手段は、指数重み付き逐次最小二乗法を用いて、伝達関数から導出される差分方程式の係数として含まれる零点を逐次推定するものであることを特徴とする。   According to the yaw rate detection apparatus of the seventh aspect, the yaw rate zero estimation means sequentially estimates the zero included as the coefficient of the difference equation derived from the transfer function using the exponential weighted sequential least square method. It is characterized by being.

一般に、センサノイズ等の外乱に対するロバスト性、及び推定結果を得るまでの応答性に優れていると言われる指数重み付き逐次最小二乗法(REWLS法)を用いて逐次推定することで、推定されるヨーレート検出手段の零点の精度を向上することができる。   In general, it is estimated by performing sequential estimation using the exponential weighted sequential least squares method (REWLS method), which is said to be robust against disturbances such as sensor noise, and responsiveness until an estimation result is obtained. The zero point accuracy of the yaw rate detection means can be improved.

請求項8〜請求項14に記載のヨーレート零点補正方法は、請求項1〜請求項7に記載のヨーレート検出装置の作用効果と同様であるため、その説明を省略する。   Since the yaw rate zero point correction method according to claims 8 to 14 is the same as the function and effect of the yaw rate detection device according to claims 1 to 7, the description thereof is omitted.

以下、本発明のヨーレート検出装置、及びヨーレート零点補正方法の実施形態について、図面を参照して説明する。なお、本実施形態では、自動車等の車両に搭載され、自車両に発生するヨーレートを検出するヨーレート検出装置について説明する。   Hereinafter, embodiments of a yaw rate detection device and a yaw rate zero correction method of the present invention will be described with reference to the drawings. In the present embodiment, a yaw rate detection device that is mounted on a vehicle such as an automobile and detects a yaw rate generated in the host vehicle will be described.

図1に、本実施形態のヨーレート検出装置の全体構成のブロック図を示す。同図に示すように、本実施形態のヨーレート検出装置100は、操舵角検出部110、操舵角履歴記憶部120、ヨーレート検出部130、ヨーレート履歴記憶部140、ヨーレート零点推定部150、ヨーレート零点履歴記憶部160、及び、何れも図示しない、所定時間毎に自車両の速度を検出する車速センサとヨーレート零点補正部によって構成される。   FIG. 1 is a block diagram showing the overall configuration of the yaw rate detection apparatus according to this embodiment. As shown in the figure, the yaw rate detection device 100 of the present embodiment includes a steering angle detection unit 110, a steering angle history storage unit 120, a yaw rate detection unit 130, a yaw rate history storage unit 140, a yaw rate zero point estimation unit 150, and a yaw rate zero point history. The storage unit 160 is configured by a vehicle speed sensor that detects the speed of the host vehicle every predetermined time and a yaw rate zero point correction unit, both of which are not shown.

操舵角検出部110は、自車両のステアリングホイール(以下、ステアリング)の操舵角を検出するステアリングセンサであり、所定時間毎に検出した操舵角の大きさを示す操舵角{str(k)、k=1、2、・・・、n}信号を操舵角履歴記憶部120、及びヨーレート零点推定部150へ出力する。   The steering angle detector 110 is a steering sensor that detects the steering angle of the steering wheel (hereinafter referred to as “steering”) of the host vehicle, and indicates a steering angle {str (k), k indicating the magnitude of the steering angle detected every predetermined time. = 1, 2,..., N} signals are output to the steering angle history storage unit 120 and the yaw rate zero point estimation unit 150.

なお、操舵角検出部110から出力される操舵角{str(k)}信号は、零点(中立点)が十分に補正された値とする。一般に、走行中の操舵角の零点は、例えば、特開平11−034899号公報に開示されている操舵角中立学習装置等を用いて演算されている。従って、操舵角は、多くの局面において十分な精度を有している。なお、操舵角の零点の精度が低い時には、一時的にヨーレート検出部130の零点を別手法により推定してもよい。   The steering angle {str (k)} signal output from the steering angle detection unit 110 is a value in which the zero point (neutral point) is sufficiently corrected. In general, the zero point of the steering angle during traveling is calculated using, for example, a steering angle neutral learning device disclosed in JP-A-11-034899. Therefore, the steering angle has sufficient accuracy in many aspects. When the accuracy of the steering angle zero point is low, the zero point of the yaw rate detection unit 130 may be temporarily estimated by another method.

操舵角履歴記憶部120は、操舵角検出部110から出力される操舵角{str(k)}信号を受信し、その受信順序に応じて順次、操舵角{str(k)}データを記憶する。   The steering angle history storage unit 120 receives the steering angle {str (k)} signal output from the steering angle detection unit 110, and sequentially stores the steering angle {str (k)} data according to the reception order. .

ヨーレート検出部130は、自車両に発生するヨーレート(自車両の鉛直方向を軸とした角速度)を検出するヨーレートセンサであり、所定時間毎に検出したヨーレートの大きさを示すヨーレート{yaweng(k)}信号をヨーレート履歴記憶部140、及びヨーレート零点推定部150へ出力する。なお、このヨーレート検出部130から出力されるヨーレート{yaweng(k)}信号は、零点補正されていないものである。 Yaw rate detecting section 130 is a yaw rate sensor for detecting a yaw rate generated on the vehicle (angular velocity and the vertical direction of the vehicle axis), yaw rate that indicates the magnitude of the yaw rate detected every predetermined time {yaw eng (k )} Signal is output to the yaw rate history storage unit 140 and the yaw rate zero point estimation unit 150. Note that the yaw rate {yaw eng (k)} signal output from the yaw rate detector 130 is not zero-corrected.

ヨーレート履歴記憶部140は、ヨーレート検出部130から出力されるヨーレート{yaweng(k)}信号を受信し、その受信順序に応じて順次、ヨーレート{yaweng(k)}データを記憶する。 The yaw rate history storage unit 140 receives the yaw rate {yaw eng (k)} signal output from the yaw rate detection unit 130, and sequentially stores the yaw rate {yaw eng (k)} data according to the reception order.

ヨーレート零点推定部150は、操舵角検出部110、及びヨーレート検出部130からの操舵角{str(k)}信号とヨーレート{yaweng(k)}信号、及びヨーレート零点履歴記憶部160の記憶するn回前に推定したヨーレート検出部130の零点を示すヨーレートセンサ零点{Y(k−n)}データを用いて、ヨーレート検出部130の検出した現在のヨーレート{yaweng(k)}の零点補正に用いるヨーレートセンサ零点{Y(k)}を所定時間毎に逐次推定する。 The yaw rate zero point estimation unit 150 stores the steering angle {str (k)} signal and the yaw rate {yaw eng (k)} signal from the steering angle detection unit 110 and the yaw rate detection unit 130, and the yaw rate zero point history storage unit 160. Using the yaw rate sensor zero {Y c (k−n)} data indicating the zero of the yaw rate detector 130 estimated n times before, the zero of the current yaw rate {y eng (k)} detected by the yaw rate detector 130 The yaw rate sensor zero point {Y c (k)} used for correction is sequentially estimated every predetermined time.

ヨーレート補正部(図示せず)は、ヨーレート零点推定部150から出力されるヨーレートセンサ零点{Y(k)}データを用いて、ヨーレート検出部130が検出するヨーレート{yaweng(k)}の零点を補正する。これにより、ヨーレートの零点補正が可能になる。 The yaw rate correction unit (not shown) uses the yaw rate sensor zero {Y c (k)} data output from the yaw rate zero estimation unit 150 to detect the yaw rate {y eng (k)} detected by the yaw rate detection unit 130. Correct the zero point. This makes it possible to correct the zero point of the yaw rate.

ヨーレート零点履歴記憶部160は、ヨーレート零点推定部150から出力されるヨーレートセンサ零点{Y(k)}データを取得し、その出力順序に応じて順次記憶するものである。 The yaw rate zero point history storage unit 160 acquires the yaw rate sensor zero point {Y c (k)} data output from the yaw rate zero point estimation unit 150 and sequentially stores the data according to the output order.

このような構成を有する本実施形態のヨーレート検出装置100は、前述したように、自車両が平面上を運動するものとし、自車両の左右方向の荷重移動を考えない平面2輪モデルの運動方程式から、自車両の操舵角に対する自車両のヨーレートの伝達関数が求められることに着目したものである。   As described above, the yaw rate detection apparatus 100 of the present embodiment having such a configuration assumes that the host vehicle moves on a plane, and the equation of motion of a plane two-wheel model that does not consider load movement in the left-right direction of the host vehicle. Therefore, the transfer function of the yaw rate of the own vehicle with respect to the steering angle of the own vehicle is obtained.

すなわち、自車両の操舵角、ヨーレート、これまでに推定したヨーレート検出部130の零点の履歴を用いて、前述の自車両の操舵角に対するヨーレートの伝達関数を同定する(システム同定)。そして、この自車両の操舵角に対するヨーレートの伝達関数を同定することによって、ヨーレート検出部130の零点を推定する。   That is, the transfer function of the yaw rate with respect to the steering angle of the host vehicle is identified by using the steering angle and yaw rate of the host vehicle and the history of the zero point of the yaw rate detecting unit 130 estimated so far (system identification). Then, the zero point of the yaw rate detector 130 is estimated by identifying the transfer function of the yaw rate with respect to the steering angle of the host vehicle.

ここで、自車両の操舵角に対するヨーレートの伝達関数を同定することによって、ヨーレート検出部130の零点が推定できることについて、数式を用いながら説明する。先ず、自車両が一定速度で走行する場合、自車両の操舵角(str)に対するヨーレート(yaw)の伝達関数(yaw/str)は、下記の数式1に示すように、2次遅れ系の伝達関数で示されるものである。なお、数式1において、演算子(z)、及び自車両の運動状態に応じて変化する係数(a、a、b、b)を示している。 Here, the fact that the zero point of the yaw rate detection unit 130 can be estimated by identifying the transfer function of the yaw rate with respect to the steering angle of the host vehicle will be described using mathematical expressions. First, when the host vehicle travels at a constant speed, the transfer function (yaw / str) of the yaw rate (yaw) with respect to the steering angle (str) of the host vehicle is transmitted in a second-order lag system as shown in Equation 1 below. It is indicated by a function. In Formula 1, coefficients (a 1 , a 2 , b 1 , b 2 ) that change according to the operator (z) and the motion state of the host vehicle are shown.

(数1)
伝達関数(yaw/str)={(b+b−1)/(1+a−1+a−2)}
上記数式1の伝達関数(yaw/str)から、下記の数式2に示すように、操舵角{str(k)}を入力とし、ヨーレート{yaw(k)}を出力とする1入出力差分方程式を導出することができる。
(Equation 1)
Transfer function (yaw / str) = {(b 1 + b 2 z −1 ) / (1 + a 1 z −1 + a 2 z −2 )}
From the transfer function (yaw / str) of Equation 1 above, as shown in Equation 2 below, a 1-input / output difference equation with the steering angle {str (k)} as input and the yaw rate {yaw (k)} as output. Can be derived.

(数2)
yaw(k)={−a×yaw(k−1)}−{a×yaw(k−2)}+{b×str(k)}+{b×str(k−1)}
上記数式2により、零点補正前のヨーレート{yaweng(k)}を下記の数式3のように示すことができる。なお、同数式におけるヨーレート{yaweng(k)}、及び操舵角{str(k)}は、操舵角検出部110、及びヨーレート検出部130によって検出されるものである。また、この数式におけるヨーレート{yaweng(k−1)}、{yaweng(k−2)}、ヨーレートセンサ零点{Y(k−1)}、{Y(k−2)}、及び操舵角操舵角{str(k−1)}は、操舵角履歴記憶部120、ヨーレート履歴記憶部140、及びヨーレート零点履歴記憶部160に記憶されるデータである。
(Equation 2)
yaw (k) = {− a 1 × yaw (k−1)} − {a 2 × yaw (k−2)} + {b 1 × str (k)} + {b 2 × str (k−1) }
From the above formula 2, the yaw rate {yaw eng (k)} before the zero correction can be expressed as the following formula 3. The yaw rate {yaw eng (k)} and the steering angle {str (k)} in the equation are detected by the steering angle detection unit 110 and the yaw rate detection unit 130. Also, the yaw rate {yaw eng (k-1)}, {yaw eng (k-2)}, yaw rate sensor zero {Y c (k-1)}, {Y c (k-2)} in this equation, and The steering angle steering angle {str (k−1)} is data stored in the steering angle history storage unit 120, the yaw rate history storage unit 140, and the yaw rate zero point history storage unit 160.

(数3)
yaweng(k)=−a×{yaweng(k−1)−Y(k−1)}−a×{yaweng(k−2)−Y(k−2)}+{b×str(k)}+{b×str(k−1)}+c
上記数式3における(c)は、ヨーレート{yaweng(k)}の零点補正に用いるべく零点を示すものである。従って、数式3における自車両の運動状態に応じて変化する係数(a、a、b、b)を逐次同定することで、ヨーレート検出部130の零点補正に用いる零点(c)を推定することができる。
(Equation 3)
yaw eng (k) = − a 1 × {yaw eng (k−1) −Y c (k−1)} − a 2 × {yaw eng (k−2) −Y c (k−2)} + { b 1 × str (k)} + {b 2 × str (k−1)} + c 0
(C 0 ) in Equation 3 indicates a zero point to be used for zero point correction of the yaw rate {yaw eng (k)}. Accordingly, by sequentially identifying the coefficients (a 1 , a 2 , b 1 , b 2 ) that change according to the motion state of the host vehicle in Formula 3, the zero (c 0 ) used for the zero correction of the yaw rate detection unit 130. Can be estimated.

このように、2次遅れ系の伝達関数から導出される1入出力差分方程式に基づいて、ヨーレート検出部130の零点補正に用いる零点(c)を推定する場合には、現在及び前回の操舵角{str(k)}、{str(k−1)}、現在、前回及び前々回のヨーレート{yaweng(k)}、{yaweng(k−1)}、{yaweng(k−2)}、前回及び前々回のヨーレートセンサ零点{Y(k−1)}、{Y(k−2)}を用いて逐次推定することができる。 As described above, when the zero point (c 0 ) used for the zero point correction of the yaw rate detection unit 130 is estimated based on the one-input / output difference equation derived from the transfer function of the second-order lag system, the current and previous steerings are estimated. Angular {str (k)}, {str (k-1)}, current, previous and previous yaw rates {yaw eng (k)}, {yaw eng (k-1)}, {yaw eng (k-2) }, Yaw rate sensor zeros {Y c (k−1)} and {Y c (k−2)} of the previous time and the previous time can be sequentially estimated.

なお、本実施形態においては、一般に、センサノイズ等の外乱に対するロバスト性、及び推定結果を得るまでの応答性に優れていると言われる指数重み付き逐次最小二乗法(以下、REWLS法)を用いて、前述の係数(a、a、b、b)を逐次同定する。これにより、推定される零点の精度を向上することができる。 In this embodiment, generally, an exponentially weighted sequential least square method (hereinafter referred to as a RWLS method), which is said to be excellent in robustness against disturbances such as sensor noise, and response until obtaining an estimation result, is used. Then, the aforementioned coefficients (a 1 , a 2 , b 1 , b 2 ) are sequentially identified. Thereby, the precision of the estimated zero can be improved.

続いて、REWLS法によって係数(a、a、b、b)を同定する場合の例について説明する。先ず、下記の数式4〜数式6に示すように変数を定義する。なお、数式5の係数ベクトル{θ(k)}、及び数式6のベクトル{Ψ(k)}は各々ベクトルを示している。 Next, an example of identifying coefficients (a 1 , a 2 , b 1 , b 2 ) by the RWLS method will be described. First, variables are defined as shown in Equations 4 to 6 below. Note that the coefficient vector {θ (k)} in Expression 5 and the vector {Ψ (k)} in Expression 6 indicate vectors.

(数4)
y(k)=yaweng(k)
(数5)
θ(k)=[a
(数6)
Ψ(k)=[−{yaweng(k−1)−Y(k−1)} −{yaweng(k−2)−Y(k−2)} str(k) str(k−1) 1]
上記数式4〜数式6のように変数を定義することで、零点補正前のヨーレート{y(k)}は、下記の数式7のように示される。
(Equation 4)
y (k) = yaw eng (k)
(Equation 5)
θ (k) = [a 1 a 2 b 1 b 2 c 0 ] T
(Equation 6)
Ψ (k) = [− {yaw eng (k−1) −Y c (k−1)} − {yaw eng (k−2) −Y c (k−2)} str (k) str (k− 1) 1] T
By defining variables as in Equations 4 to 6, the yaw rate {y h (k)} before zero correction is expressed as Equation 7 below.

(数7)
(k)=Ψ(k)θ(k)
ここで、REWLS法を適用すると、下記の数式8の値を最小化するように、下記の数式9〜数式11に従って係数ベクトル{θ(k)}を逐次計算するものである。なお、数式9〜数式11中の(I)は単位行列(単位ベクトル)を示している。
(Equation 7)
y h (k) = Ψ T (k) θ (k)
Here, when the RWLS method is applied, the coefficient vector {θ (k)} is sequentially calculated according to the following formulas 9 to 11 so as to minimize the value of the following formula 8. In Equations 9 to 11, (I) indicates a unit matrix (unit vector).

Figure 2005326239
Figure 2005326239

(数9)
K(k)=P(k−1)Ψ(k){λI+Ψ(k)P(k−1)Ψ(k)}−1
(数10)
P(k)={I−K(k)Ψ(k)}P(k−1)/λ
(数11)
θ(k)=θ(k−1)+K(k){y(k)−Ψ(k)θ(k−1)}
この係数ベクトル{θ(k)}を逐次計算することで、ヨーレート検出部130の零点補正に用いる零点(c)を得ることができる。
(Equation 9)
K (k) = P (k−1) Ψ (k) {λI + Ψ T (k) P (k−1) Ψ (k)} −1
(Equation 10)
P (k) = {I−K (k) Ψ T (k)} P (k−1) / λ
(Equation 11)
θ (k) = θ (k−1) + K (k) {y (k) −Ψ T (k) θ (k−1)}
By sequentially calculating this coefficient vector {θ (k)}, the zero point (c 0 ) used for the zero point correction of the yaw rate detection unit 130 can be obtained.

次に、本実施形態のヨーレート検出装置100によるヨーレート零点推定処理について、図2に示すフローチャートを用いて説明する。なお、変数(k=1)、(k=2)、及び(k≧3)の場合についての処理を各々説明する。また、本ヨーレート零点推定処理は、所定時間毎に繰り返し処理されるものである。   Next, yaw rate zero point estimation processing by the yaw rate detection apparatus 100 of the present embodiment will be described using the flowchart shown in FIG. The processing for the cases of variables (k = 1), (k = 2), and (k ≧ 3) will be described. In addition, the yaw rate zero point estimation process is repeatedly performed every predetermined time.

{変数(k=1)の場合}
先ず、同図のステップ(以下、Sと記す)10では、本ヨーレート零点推定処理が始めて実行されたか否か、すなわち、所定時間毎にインクリメントされる変数(k)が2に満たないか否かを判定する。ここで、肯定判定される場合にはS20へ処理を進め、否定判定される場合にはS30へ処理を移行する。
{In case of variable (k = 1)}
First, in step (hereinafter referred to as S) 10 in the figure, whether or not the yaw rate zero point estimation process is executed for the first time, that is, whether or not the variable (k) incremented every predetermined time is less than 2. Determine. If the determination is affirmative, the process proceeds to S20. If the determination is negative, the process proceeds to S30.

S20では、REWLS法を用いて係数ベクトル{θ(k)}を逐次計算する際の初期パラメータを設定する。ここで設定するパラメータとしては、λ(例えば、1の値に近い0.95、0.98等)、P(1):所定値、及びY(1):ヨーレート検出部130の雰囲気温度が低いときのヨーレート検出部130の零点である。 In S20, initial parameters for sequentially calculating the coefficient vector {θ (k)} using the RWLS method are set. Parameters set here include λ (for example, 0.95, 0.98, etc., close to a value of 1), P (1): a predetermined value, and Y c (1): the ambient temperature of the yaw rate detector 130. This is the zero point of the yaw rate detection unit 130 when it is low.

S30では、自車両の現在の速度{Vn(k)}、現在のヨーレート{yaweng(k)}、現在の操舵角{str(k)}を取得する。S40では、前述した数式3の2次遅れ系の伝達関数から導出される1入出力差分方程式が成立する条件を満たしているか否かを判定する。 In S30, the current speed {Vn (k)} of the host vehicle, the current yaw rate {yaw eng (k)}, and the current steering angle {str (k)} are acquired. In S40, it is determined whether or not a condition for satisfying the one-input / output difference equation derived from the transfer function of the second-order lag system of Equation 3 is satisfied.

すなわち、数式1の伝達関数は、前述したように、自車両の速度を変数としてもつ。そのため、車両が一定速度で走行する場合、この変数は定数として扱えることから、車両が一定速度で走行する場合、車両の速度変動を考慮することなく、ヨーレート検出部130の零点を推定することができる。   That is, the transfer function of Formula 1 has the speed of the host vehicle as a variable, as described above. Therefore, when the vehicle travels at a constant speed, this variable can be treated as a constant. Therefore, when the vehicle travels at a constant speed, the zero point of the yaw rate detection unit 130 can be estimated without considering the speed fluctuation of the vehicle. it can.

また、この数式1の伝達関数から導出される1入出力差分方程式は、過去2回前のデータを用いて求められるものであることから、自車両が過去2回前から現在まで一定速度である場合に、上記1入出力差分方程式が成立する条件を満たすことになる。   In addition, since the one-input / output difference equation derived from the transfer function of Formula 1 is obtained using data from the previous two times, the host vehicle has a constant speed from the previous two times to the present. In this case, the condition for satisfying the one-input / output difference equation is satisfied.

従って、S40では、自車両の速度{Vn(k)}、{Vn(k−1)}、{Vn(k−2)}が略同じ(一定速度)である場合にS50へ処理を進め、そうでない場合にはS70へ処理を進める。なお、過去2回前までの自車両の速度{Vn(k−1)}、{Vn(k−2)}が取得されていない場合にもS70で処理を進める。   Accordingly, in S40, if the speeds {Vn (k)}, {Vn (k-1)}, and {Vn (k-2)} of the host vehicle are substantially the same (constant speed), the process proceeds to S50. If not, the process proceeds to S70. Note that the process proceeds in S70 even when the speeds {Vn (k-1)} and {Vn (k-2)} of the host vehicle up to the past two times have not been acquired.

S70では、係数ベクトル{θ(k)}、及びP(k)を各々係数ベクトル{θ(k−1)}、P(k−1)に置き換える。なお、(k=1)の場合、係数ベクトル{θ(1)}は、数式1に示した伝達関数から予め求めることができる所定値を設定し、P(1)は、S20にて設定した初期パラメータを設定する。   In S70, coefficient vectors {θ (k)} and P (k) are replaced with coefficient vectors {θ (k−1)} and P (k−1), respectively. In the case of (k = 1), the coefficient vector {θ (1)} is set to a predetermined value that can be obtained in advance from the transfer function shown in Equation 1, and P (1) is set in S20. Set initial parameters.

S80では、自車両の速度{Vn(1)}、ヨーレート{yaweng(1)}、操舵角{str(1)}、係数ベクトル{θ(1)}、及びP(1)を記憶する。S90では、変数(k)を1インクリメントする。 In S80, the speed {Vn (1)} of the own vehicle, the yaw rate {yaw eng (1)}, the steering angle {str (1)}, the coefficient vector {θ (1)}, and P (1) are stored. In S90, the variable (k) is incremented by 1.

{変数(k=2)の場合}
S10において否定判定されるため、S30へ処理を進める。S30では、自車両の現在の速度{Vn(k)}、現在のヨーレート{yaweng(k)}、現在の操舵角{str(k)}を取得する。S40では、前述した数式3の2次遅れ系の伝達関数から導出される1入出力差分方程式が成立する条件を満たしているか否かを判定する。ここでは、変数(k=2)であるため、S70へ処理を進める。
{In case of variable (k = 2)}
Since a negative determination is made in S10, the process proceeds to S30. In S30, the current speed {Vn (k)} of the host vehicle, the current yaw rate {yaw eng (k)}, and the current steering angle {str (k)} are acquired. In S40, it is determined whether or not a condition for satisfying the one-input / output difference equation derived from the transfer function of the second-order lag system of Equation 3 is satisfied. Here, since it is a variable (k = 2), the process proceeds to S70.

S70では、係数ベクトル{θ(k)}、及びP(k)を各々係数ベクトル{θ(k−1)}、P(k−1)に置き換える。なお、変数(k=2)の場合、係数ベクトル{θ(2)}は、前回の係数ベクトル{θ(1)}を置き換え、P(2)についても同様に前回のP(1)に置き換える。   In S70, coefficient vectors {θ (k)} and P (k) are replaced with coefficient vectors {θ (k−1)} and P (k−1), respectively. In the case of a variable (k = 2), the coefficient vector {θ (2)} replaces the previous coefficient vector {θ (1)}, and P (2) is also replaced with the previous P (1). .

S80では、自車両の速度{Vn(2)}、ヨーレート{yaweng(2)}、操舵角{str(2)}、係数ベクトル{θ(2)}、及びP(2)を記憶する。S90では、変数(k)を1インクリメントする。 In S80, the vehicle speed {Vn (2)}, yaw rate {yaw eng (2)}, steering angle {str (2)}, coefficient vector {θ (2)}, and P (2) are stored. In S90, the variable (k) is incremented by 1.

{変数(k≧3)の場合}
S10において否定判定されるため、S30へ処理を進める。S30では、自車両の現在の速度{Vn(k)}、現在のヨーレート{yaweng(k)}、現在の操舵角{str(k)}を取得する。
{In case of variable (k ≧ 3)}
Since a negative determination is made in S10, the process proceeds to S30. In S30, the current speed {Vn (k)} of the host vehicle, the current yaw rate {yaw eng (k)}, and the current steering angle {str (k)} are acquired.

S40では、前述した数式3の2次遅れ系の伝達関数から導出される1入出力差分方程式が成立する条件を満たしているか否かを判定する。ここで、変数(k=3)であり、また、自車両の速度{Vn(k)}が3回連続して略同じ(速度一定)である場合、S50へ処理を進める。   In S40, it is determined whether or not a condition for satisfying the one-input / output difference equation derived from the transfer function of the second-order lag system of Equation 3 is satisfied. Here, if it is a variable (k = 3) and the speed {Vn (k)} of the host vehicle is substantially the same for three consecutive times (constant speed), the process proceeds to S50.

S50では、数式4で示したy(k)、及び数式6で示したΨ(k)を生成する。S60では、S50にて生成したy(k)、及びΨ(k)を用いて、REWLS法によるP(3)、及び係数ベクトル{θ(3)}の同定を行う。これにより、係数ベクトル{θ(3)}に含まれるヨーレート{yaweng(3)}を零点補正するための零点(c)が推定される。 In S50, y (k) expressed by Formula 4 and Ψ (k) expressed by Formula 6 are generated. In S60, P (3) and coefficient vector {θ (3)} are identified by the RWLS method using y (k) and Ψ (k) generated in S50. Thereby, the zero point (c 0 ) for correcting the zero point of the yaw rate {yaw eng (3)} included in the coefficient vector {θ (3)} is estimated.

S80では、自車両の速度{Vn(3)}、ヨーレート{yaweng(3)}、操舵角{str(3)}、係数ベクトル{θ(3)}、及びP(3)を記憶する。S90では、変数(k)を1インクリメントする。以後、前述した処理を繰り返し行う。 In S80, the speed {Vn (3)} of the own vehicle, the yaw rate {yaw eng (3)}, the steering angle {str (3)}, the coefficient vector {θ (3)}, and P (3) are stored. In S90, the variable (k) is incremented by 1. Thereafter, the above-described processing is repeated.

このように、本実施形態のヨーレート検出装置100は、操舵検出部110の検出する自車両の操舵角、ヨーレート検出部130の検出するヨーレート、これまでに推定したヨーレート検出部130の零点の履歴を用いて、自車両の操舵角に対するヨーレートの伝達関数を同定する(システム同定)。そして、この自車両の操舵角に対するヨーレートの伝達関数を同定することによって、ヨーレート検出部130の零点を推定する。   As described above, the yaw rate detection apparatus 100 according to the present embodiment includes the history of the steering angle of the host vehicle detected by the steering detection unit 110, the yaw rate detected by the yaw rate detection unit 130, and the zero point history of the yaw rate detection unit 130 estimated so far. The transfer function of the yaw rate with respect to the steering angle of the host vehicle is identified (system identification). Then, the zero point of the yaw rate detection unit 130 is estimated by identifying the transfer function of the yaw rate with respect to the steering angle of the host vehicle.

これにより、ヨーレート検出部130の雰囲気温度などが原因で時間の経過と共に零点がドリフトしたり、また、図3に示すように、カーブ路が連続する区間を走行したりする場合であっても、推定した零点を用いてヨーレートの零点を補正することができる。   Thereby, even if the zero point drifts with the passage of time due to the ambient temperature of the yaw rate detection unit 130, or as shown in FIG. The zero point of the yaw rate can be corrected using the estimated zero point.

(変形例)
例えば、自車両の運動が著しく変動しない(安定した)状況においては、平面2輪モデルの運動方程式から求められる2次遅れ系の伝達関数を1次遅れ系の伝達関数で近似し、この1次遅れ系の伝達関数を同定することによって、ヨーレート検出部130の零点を推定するようにしてもよい。
(Modification)
For example, in a situation where the motion of the host vehicle does not vary significantly (stable), the transfer function of the second-order lag system obtained from the equation of motion of the plane two-wheel model is approximated by the transfer function of the first-order lag system. The zero point of the yaw rate detector 130 may be estimated by identifying the transfer function of the delay system.

例えば、下記の数式12に示す1入出力差分方程式から推定することで、零点の推定に要する演算処理を軽減することができる。なお、同数式中の係数(a、b)の同定については、本実施形態と同じようにREWLS法を適用すればよい。 For example, by calculating from the one-input / output difference equation shown in Equation 12 below, it is possible to reduce the arithmetic processing required for zero point estimation. Incidentally, the identification of the coefficients in the formula (a 1, b 1) may be applied to REWLS method like this embodiment.

(数12)
yaweng(k)=−a×{yaweng(k−1)−Y(k−1)}+{b×str(k)}+c
この1次遅れ系の伝達関数から導出される1入出力差分方程式に基づいて、ヨーレート検出部130の零点補正に用いる零点(c)を推定する場合には、現在の操舵角{str(k)}、現在、及び前回のヨーレート{yaweng(k)}、{yaweng(k−1)}、前回のヨーレートセンサ零点{Y(k−1)}を用いて逐次推定することができる。
(Equation 12)
yaw eng (k) = − a 1 × {yaw eng (k−1) −Y c (k−1)} + {b 1 × str (k)} + c 0
When estimating the zero point (c 0 ) used for the zero point correction of the yaw rate detection unit 130 based on the one-input / output difference equation derived from the transfer function of the first-order lag system, the current steering angle {str (k )}, Current and previous yaw rates {yaw eng (k)}, {yaw eng (k-1)}, and previous yaw rate sensor zero {Y c (k-1)} .

本発明の実施形態に係わる、ヨーレート検出装置100の全体構成を示すブロック図である。1 is a block diagram showing an overall configuration of a yaw rate detection apparatus 100 according to an embodiment of the present invention. 本発明の実施形態に係わる、ヨーレート零点推定処理の流れを示すフローチャートである。It is a flowchart which shows the flow of the yaw rate zero point estimation process concerning embodiment of this invention. 従来技術と本発明における、ヨーレートの零点が推定可能な走行状況を示す図である。It is a figure which shows the driving | running | working condition which can estimate the zero point of a yaw rate in a prior art and this invention.

符号の説明Explanation of symbols

100 ヨーレート検出装置
110 操舵角検出部
120 操舵角履歴記憶部
130 ヨーレート検出部
140 ヨーレート履歴記憶部
150 ヨーレート零点推定部
160 ヨーレート零点履歴記憶部
100 Yaw Rate Detection Device 110 Steering Angle Detection Unit 120 Steering Angle History Storage Unit 130 Yaw Rate Detection Unit 140 Yaw Rate History Storage Unit 150 Yaw Rate Zero Point Estimation Unit 160 Yaw Rate Zero Point History Storage Unit

Claims (14)

車両の操舵角を検出する操舵角検出手段と、
前記車両のヨーレートを検出するヨーレート検出手段と、
後記ヨーレート零点推定手段の推定した前記ヨーレート検出手段の零点の履歴を記憶するヨーレート零点履歴記憶手段と、
前記操舵角検出手段及び前記ヨーレート検出手段が検出した操舵角及びヨーレートと、前記ヨーレート零点履歴記憶手段の記憶する零点の履歴とを用いて、前記車両の操舵角に対する前記車両のヨーレートの伝達関数を同定することによって、前記ヨーレート検出手段の検出したヨーレートの零点を推定するヨーレート零点推定手段と、を備えることを特徴とするヨーレート検出装置。
Steering angle detection means for detecting the steering angle of the vehicle;
Yaw rate detection means for detecting the yaw rate of the vehicle;
Yaw rate zero point history storage means for storing a history of the zero point of the yaw rate detection means estimated by the yaw rate zero point estimation means described later;
Using the steering angle and yaw rate detected by the steering angle detection means and the yaw rate detection means, and the zero point history stored in the yaw rate zero point history storage means, a transfer function of the vehicle yaw rate with respect to the steering angle of the vehicle is obtained. A yaw rate detection device comprising: a yaw rate zero point estimation unit that estimates a zero point of the yaw rate detected by the yaw rate detection unit by identifying.
前記ヨーレート零点推定手段が推定した零点を用いて、前記ヨーレート検出手段が検出するヨーレートの零点を補正する零点補正手段を備えることを特徴とする請求項1記載のヨーレート検出装置。   2. The yaw rate detection device according to claim 1, further comprising a zero point correction unit that corrects a zero point of the yaw rate detected by the yaw rate detection unit using the zero point estimated by the yaw rate zero point estimation unit. 前記ヨーレート零点推定手段は、1次遅れ系、及び2次遅れ系の少なくとも一方の前記伝達関数を同定することによって、前記零点を推定することを特徴とする請求項1又は2記載のヨーレート検出装置。   The yaw rate detection device according to claim 1 or 2, wherein the yaw rate zero point estimation means estimates the zero point by identifying the transfer function of at least one of a first-order lag system and a second-order lag system. . 前記ヨーレート検出手段の検出したヨーレートの履歴を記憶するヨーレート履歴記憶手段を備え、
前記ヨーレート零点推定手段は、前記操舵角検出手段及び前記ヨーレート検出手段が検出した現在の操舵角及びヨーレートと、前記ヨーレート履歴記憶手段の記憶するヨーレートの履歴と、前記ヨーレート零点履歴記憶手段の記憶する零点の履歴とを用いて、前記1次遅れ系の伝達関数を同定することによって、前記零点を推定することを特徴とする請求項3記載のヨーレート検出装置。
Yaw rate history storage means for storing the history of the yaw rate detected by the yaw rate detection means,
The yaw rate zero point estimation means stores the current steering angle and yaw rate detected by the steering angle detection means and the yaw rate detection means, the history of the yaw rate stored in the yaw rate history storage means, and the yaw rate zero point history storage means. 4. The yaw rate detection apparatus according to claim 3, wherein the zero point is estimated by identifying a transfer function of the first-order lag system using a history of zero points.
前記操舵角検出手段の検出した操舵角の履歴を記憶する操舵角履歴記憶手段と、
前記ヨーレート検出手段の検出したヨーレートの履歴を記憶するヨーレート履歴記憶手段とを備え、
前記ヨーレート零点推定手段は、前記操舵角検出手段及び前記ヨーレート検出手段が検出した現在の操舵角及びヨーレートと、前記操舵角履歴記憶手段の記憶する操舵角の履歴と、前記ヨーレート履歴記憶手段の記憶するヨーレートの履歴と、前記ヨーレート零点履歴記憶手段の記憶する零点の履歴とを用いて、前記2次遅れ系の伝達関数を同定することによって、前記零点を推定することを特徴とする請求項3記載のヨーレート検出装置。
Steering angle history storage means for storing the history of the steering angle detected by the steering angle detection means;
Yaw rate history storage means for storing the history of the yaw rate detected by the yaw rate detection means,
The yaw rate zero point estimation means includes a current steering angle and yaw rate detected by the steering angle detection means and the yaw rate detection means, a history of steering angles stored in the steering angle history storage means, and a storage in the yaw rate history storage means. 4. The zero point is estimated by identifying the transfer function of the second-order lag system using the history of the yaw rate to be performed and the zero point history stored in the yaw rate zero point history storage means. The yaw rate detection device described.
前記車両の速度を検出する速度検出手段を備え、
前記ヨーレート零点推定手段は、前記車両が一定速度で走行する場合に推定することを特徴とする請求項1〜5の何れか1項に記載のヨーレート検出装置。
Comprising speed detecting means for detecting the speed of the vehicle;
6. The yaw rate detection device according to claim 1, wherein the yaw rate zero point estimation means estimates when the vehicle travels at a constant speed.
前記ヨーレート零点推定手段は、指数重み付き逐次最小二乗法を用いて、前記伝達関数から導出される差分方程式の係数として含まれる前記零点を逐次推定するものであることを特徴とする請求項1〜6の何れか1項に記載のヨーレート検出装置。   The yaw rate zero estimation means sequentially estimates the zero included as a coefficient of a difference equation derived from the transfer function using an exponentially weighted sequential least square method. The yaw rate detection device according to any one of 6. 車両の操舵角を検出する操舵角検出手段、及び前記車両のヨーレートを検出するヨーレート検出手段から出力された操舵角及びヨーレートと、これまでに推定した前記ヨーレート検出手段の零点の履歴とを用いて、前記車両の操舵角に対する前記車両のヨーレートの伝達関数を同定することによって、前記ヨーレート検出手段の検出したヨーレートの零点を推定することを特徴とするヨーレート零点補正方法。   Using the steering angle detection means for detecting the steering angle of the vehicle, the steering angle and yaw rate output from the yaw rate detection means for detecting the yaw rate of the vehicle, and the zero point history of the yaw rate detection means estimated so far A yaw rate zero correction method for estimating the zero point of the yaw rate detected by the yaw rate detecting means by identifying a transfer function of the yaw rate of the vehicle with respect to the steering angle of the vehicle. 前記推定した零点を用いて、前記ヨーレート検出手段が検出するヨーレートの零点を補正することを特徴とする請求項8記載のヨーレート零点補正方法。   9. The yaw rate zero correction method according to claim 8, wherein the yaw rate zero detected by the yaw rate detection means is corrected using the estimated zero. 前記零点は、1次遅れ系、及び2次遅れ系の少なくとも一方の前記伝達関数を同定することによって推定されることを特徴とする請求項8又は9記載のヨーレート零点補正方法。   10. The yaw rate zero correction method according to claim 8, wherein the zero is estimated by identifying the transfer function of at least one of a first-order lag system and a second-order lag system. 前記零点は、前記操舵角検出手段及び前記ヨーレート検出手段から出力された現在の操舵角及びヨーレートと、これまでに前記ヨーレート検出手段から出力されたヨーレートの履歴と、これまでに推定した前記ヨーレート検出手段の零点の履歴とを用いて、前記1次遅れ系の伝達関数を同定することによって推定されることを特徴とする請求項10記載のヨーレート零点補正方法。   The zero point includes the current steering angle and yaw rate output from the steering angle detection unit and the yaw rate detection unit, the history of the yaw rate output from the yaw rate detection unit so far, and the yaw rate detection estimated so far. 11. The yaw rate zero point correction method according to claim 10, wherein the yaw rate zero point correction method is estimated by identifying a transfer function of the first-order lag system using a zero point history of the means. 前記零点は、前記操舵角検出手段及び前記ヨーレート検出手段から出力された現在の操舵角及びヨーレートと、これまでに前記操舵角検出手段及び前記ヨーレート検出手段から出力された操舵角及びヨーレートの履歴と、これまでに推定した前記ヨーレート検出手段の零点の履歴とを用いて、前記2次遅れ系の伝達関数を同定することによって推定されることを特徴とする請求項10記載のヨーレート零点補正方法。   The zero point includes the current steering angle and yaw rate output from the steering angle detection unit and the yaw rate detection unit, and the history of the steering angle and yaw rate output from the steering angle detection unit and the yaw rate detection unit so far. 11. The yaw rate zero point correction method according to claim 10, wherein the yaw rate zero point correction method is estimated by identifying the transfer function of the second-order lag system using the zero point history of the yaw rate detection means estimated so far. 前記零点は、前記車両が一定速度で走行する場合に推定することを特徴とする請求項8〜12の何れか1項に記載のヨーレート零点補正方法。   The yaw rate zero correction method according to any one of claims 8 to 12, wherein the zero point is estimated when the vehicle travels at a constant speed. 前記零点は、前記伝達関数から導出される差分方程式の係数として含まれるものであって、前記差分方程式に対して指数重み付き逐次最小二乗法を適用することで、前記零点を逐次推定することを特徴とする請求項8〜13の何れか1項に記載のヨーレート零点補正方法。   The zero is included as a coefficient of a difference equation derived from the transfer function, and the zero is sequentially estimated by applying an exponentially weighted sequential least square method to the difference equation. The yaw rate zero point correction method according to any one of claims 8 to 13, wherein the yaw rate zero point correction method is provided.
JP2004144006A 2004-05-13 2004-05-13 Yaw rate detection device and yaw rate zero correction method Expired - Fee Related JP4572574B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2004144006A JP4572574B2 (en) 2004-05-13 2004-05-13 Yaw rate detection device and yaw rate zero correction method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2004144006A JP4572574B2 (en) 2004-05-13 2004-05-13 Yaw rate detection device and yaw rate zero correction method

Publications (2)

Publication Number Publication Date
JP2005326239A true JP2005326239A (en) 2005-11-24
JP4572574B2 JP4572574B2 (en) 2010-11-04

Family

ID=35472712

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2004144006A Expired - Fee Related JP4572574B2 (en) 2004-05-13 2004-05-13 Yaw rate detection device and yaw rate zero correction method

Country Status (1)

Country Link
JP (1) JP4572574B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008032632A (en) * 2006-07-31 2008-02-14 Denso Corp Calibration device of angular velocity sensor, and angular velocity value identifying device

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02106470A (en) * 1988-10-14 1990-04-18 Nissan Motor Co Ltd Movement state quantity estimating device for vehicle
JP2000055933A (en) * 1998-08-03 2000-02-25 Mazda Motor Corp Device for detecting anomaly of sensor for detecting travelling state for vehicle
JP2001280995A (en) * 2000-03-29 2001-10-10 Data Tec:Kk Device and method for drift removal, and behavior detecting sensor for moving object

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02106470A (en) * 1988-10-14 1990-04-18 Nissan Motor Co Ltd Movement state quantity estimating device for vehicle
JP2000055933A (en) * 1998-08-03 2000-02-25 Mazda Motor Corp Device for detecting anomaly of sensor for detecting travelling state for vehicle
JP2001280995A (en) * 2000-03-29 2001-10-10 Data Tec:Kk Device and method for drift removal, and behavior detecting sensor for moving object

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008032632A (en) * 2006-07-31 2008-02-14 Denso Corp Calibration device of angular velocity sensor, and angular velocity value identifying device

Also Published As

Publication number Publication date
JP4572574B2 (en) 2010-11-04

Similar Documents

Publication Publication Date Title
JP6884276B2 (en) Systems and methods for controlling vehicles
CN108573270B (en) Method and apparatus for synchronizing multi-sensor target information fusion and multi-sensor sensing, computer device, and recording medium
US10942075B2 (en) Method and apparatus for determining a driver&#39;s hand torque on a steering wheel of a vehicle
JP5152778B2 (en) Inclination angle detector for motorcycles
WO2015111344A1 (en) Anomalous travel location detection device and anomalous travel location detection method
JP5396873B2 (en) Driver operation prediction apparatus and program
WO2019230038A1 (en) Self-position estimation device
JP5904226B2 (en) Vehicle behavior prediction apparatus and program
JP2017122960A (en) Vehicle location estimation device
US11577736B2 (en) Method and device for ascertaining a highly accurate estimated value of a yaw rate for controlling a vehicle
KR101345433B1 (en) Method and apparatus for detecting hand-off state of steering handle
JP5189316B2 (en) Yaw rate sensor output determination device and following vehicle determination device
JP7368181B2 (en) Wear amount estimation system and calculation model generation system
JP7206883B2 (en) Yaw rate corrector
JP6939759B2 (en) Vehicle condition estimation device
JP4572574B2 (en) Yaw rate detection device and yaw rate zero correction method
JP2711746B2 (en) Angular velocity measuring device
JP4483984B2 (en) Driver state estimation device
JP5091047B2 (en) Vehicle attitude angle estimation device and sensor drift estimation device
US11938952B2 (en) Traveling trajectory estimation system, traveling trajectory estimation program, and traveling trajectory estimating method
JP7360976B2 (en) Sensor error correction device
JP7234617B2 (en) Body attitude angle estimation device
JP5120034B2 (en) Vehicle traveling direction estimation device
JP7206875B2 (en) Vehicle lateral speed estimator
JP4983770B2 (en) Conversion coefficient derivation method and navigation apparatus

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20060706

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20081125

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20100106

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20100224

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20100720

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

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20100802

R151 Written notification of patent or utility model registration

Ref document number: 4572574

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

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

Free format text: PAYMENT UNTIL: 20130827

Year of fee payment: 3

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees