JP2008049828A - Yaw rate estimating device - Google Patents
Yaw rate estimating device Download PDFInfo
- Publication number
- JP2008049828A JP2008049828A JP2006228014A JP2006228014A JP2008049828A JP 2008049828 A JP2008049828 A JP 2008049828A JP 2006228014 A JP2006228014 A JP 2006228014A JP 2006228014 A JP2006228014 A JP 2006228014A JP 2008049828 A JP2008049828 A JP 2008049828A
- Authority
- JP
- Japan
- Prior art keywords
- yaw rate
- vehicle
- turning state
- estimation
- curve radius
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
Description
本発明は、車両のヨーレートを推定するヨーレート推定装置に関する。 The present invention relates to a yaw rate estimation apparatus that estimates a yaw rate of a vehicle.
従来、ヨーレート推定装置としては、例えば非特許文献１や特許文献１に記載されたものが知られている。非特許文献１に記載のヨーレート推定装置は、ホイール速度と横加速度に基づきヨーレートを推定している。特許文献１に記載のヨーレート推定装置は、内外輪速度差に基づくヨーレートを推定するに際して、定常旋回状態時における車速と横加速度に基づくヨーレートの推定値から、内外輪速度差に基づくヨーレート推定のパラメータを算出している。
しかしながら、非特許文献１のような横加速度を用いたヨーレート推定装置では、定常旋回状態ではないときに、精度が悪くなるという問題がある。また、特許文献１では、旋回時における内外輪の回転数差により生じるヨーレート推定誤差を小さくすることが可能となるが、非定常旋回状態におけるヨーレートの推定については何ら考慮されていない。
However, the yaw rate estimation device using the lateral acceleration as in Non-Patent
本発明の目的は、車両が定常旋回状態ではないときでも高精度にヨーレートを推定することができるヨーレート推定装置を提供することにある。 An object of the present invention is to provide a yaw rate estimation device capable of estimating a yaw rate with high accuracy even when the vehicle is not in a steady turning state.
本発明のヨーレート推定装置は、車両の車速を検出する車速検出手段と、車両の横加速度を検出する横加速度検出手段と、車速検出手段により検出される車速及び横加速度検出手段により検出される横加速度に基づいて車両の第１ヨーレートを推定する第１ヨーレート推定手段と、記第１ヨーレート推定手段による推定法と異なる推定法で車両の第２ヨーレートを推定する第２ヨーレート推定手段と、第１ヨーレート及び第２ヨーレートに基づいて車両の第３ヨーレートを推定する第３ヨーレート推定手段と、車両の旋回状態を判定する旋回状態判定手段とを備え、第３ヨーレート推定手段は、旋回状態判定手段により車両が定常旋回状態ではないと判定されたときには、車両が定常旋回状態であると判定されたときに比べて、第１ヨーレートに対する第２ヨーレートの重み付けを大きくして第３ヨーレートを推定することを特徴とするものである。 The yaw rate estimation apparatus according to the present invention includes a vehicle speed detecting means for detecting the vehicle speed of the vehicle, a lateral acceleration detecting means for detecting the lateral acceleration of the vehicle, a vehicle speed detected by the vehicle speed detecting means, and a lateral speed detected by the lateral acceleration detecting means. First yaw rate estimation means for estimating the first yaw rate of the vehicle based on acceleration, second yaw rate estimation means for estimating the second yaw rate of the vehicle by an estimation method different from the estimation method by the first yaw rate estimation means, A third yaw rate estimating means for estimating the third yaw rate of the vehicle based on the yaw rate and the second yaw rate; and a turning state determining means for determining the turning state of the vehicle. When it is determined that the vehicle is not in a steady turning state, the first yaw rate is greater than when the vehicle is determined to be in a steady turning state. It is characterized in estimating a third yaw rate by increasing the weighting of the second yaw rate against.
このように本発明においては、車両の横加速度を用いて車両の第１ヨーレートを推定し、この第１ヨーレートの推定法と異なる推定法（例えばカーブ半径など）を用いて車両の第２ヨーレートを推定し、これらの第１ヨーレート及び第２ヨーレートに基づいて車両の第３ヨーレートを推定する。そして、車両の旋回状態に応じて車両の最終的なヨーレートを求める。例えば、車両が定常旋回状態であるときは、第１ヨーレートをそのまま最終的なヨーレートとし、車両が定常旋回状態ではない（非定常旋回状態である）ときは、第３ヨーレートを最終的なヨーレートとする。このとき、車両が定常旋回状態ではないときは、車両が定常旋回状態であるときに比べて、第１ヨーレートに対する第２ヨーレートの重み付けを大きくした第３ヨーレートが得られる。これにより、車両が定常旋回状態にあるときだけでなく、定常旋回状態ではないときにも、高精度にヨーレートを推定することが可能となる。 Thus, in the present invention, the first yaw rate of the vehicle is estimated using the lateral acceleration of the vehicle, and the second yaw rate of the vehicle is calculated using an estimation method (for example, a curve radius) different from the first yaw rate estimation method. The third yaw rate of the vehicle is estimated based on the first yaw rate and the second yaw rate. Then, the final yaw rate of the vehicle is obtained according to the turning state of the vehicle. For example, when the vehicle is in a steady turning state, the first yaw rate is used as it is as the final yaw rate, and when the vehicle is not in a steady turning state (is in an unsteady turning state), the third yaw rate is used as the final yaw rate. To do. At this time, when the vehicle is not in a steady turning state, a third yaw rate obtained by increasing the weight of the second yaw rate with respect to the first yaw rate is obtained compared to when the vehicle is in a steady turning state. As a result, the yaw rate can be estimated with high accuracy not only when the vehicle is in a steady turning state but also when the vehicle is not in a steady turning state.
本発明のヨーレート推定装置では、車両が走行する道路のカーブ半径を推定するカーブ半径推定手段を更に備え、第３ヨーレート推定手段は、カーブ半径推定手段により推定されるカーブ半径が小さい場合は大きい場合と比較して第１ヨーレートに対する第２ヨーレートの重み付けが大きいことが好ましい。一般に車両が走行する道路のカーブ半径が小さくなるほど、車両が非定常旋回状態になりやすくなる。従って、カーブ半径推定手段により車両が実際に走行する道路のカーブ半径を推定し、この推定したカーブ半径に基づいて第３ヨーレートを推定することができる。このとき、カーブ半径が小さい場合は、カーブ半径が大きい場合と比較して、第１ヨーレートに対する第２ヨーレートの重み付けが大きくなるように第３ヨーレートを推定することで、車両が走行する道路のカーブ半径に起因するヨーレート推定の誤差を確実に小さくすることができる。 The yaw rate estimation apparatus of the present invention further includes curve radius estimation means for estimating the curve radius of the road on which the vehicle travels, and the third yaw rate estimation means is large when the curve radius estimated by the curve radius estimation means is small. It is preferable that the weighting of the second yaw rate with respect to the first yaw rate is larger than that of the first yaw rate. In general, the smaller the curve radius of the road on which the vehicle travels, the more likely the vehicle will be in an unsteady turning state. Therefore, the curve radius estimating means can estimate the curve radius of the road on which the vehicle actually travels, and the third yaw rate can be estimated based on the estimated curve radius. At this time, when the curve radius is small, the third yaw rate is estimated so that the weight of the second yaw rate is increased with respect to the first yaw rate, compared with the case where the curve radius is large. The error in yaw rate estimation due to the radius can be reliably reduced.
本発明のヨーレート推定装置では、車両の操舵速度を検出する操舵速度検出手段を更に備え、第３ヨーレート推定手段は、操舵速度検出手段により検出される操舵速度が高い場合は小さい場合と比較して第１ヨーレートに対する第２ヨーレートの重み付けが大きいこととしても良い。一般にドライバーが操舵を操作する操舵速度が高くなるほど、車両が非定常旋回状態になりやすくなる。従って、操舵速度検出手段により操舵速度を検出し、この検出した操舵速度に基づいて第３ヨーレートを推定することができる。このとき、操舵速度が高い場合は、操舵速度が小さい場合と比較して、第１ヨーレートに対する第２ヨーレートの重み付けが大きくなるように第３ヨーレートを推定することで、操舵速度に起因するヨーレート推定の誤差を確実に小さくすることができる。 The yaw rate estimation apparatus of the present invention further includes a steering speed detection means for detecting the steering speed of the vehicle, and the third yaw rate estimation means is higher when the steering speed detected by the steering speed detection means is higher than when the steering speed is lower. The weighting of the second yaw rate with respect to the first yaw rate may be large. In general, the higher the steering speed at which the driver operates the steering, the easier the vehicle is in an unsteady turning state. Accordingly, the steering speed can be detected by the steering speed detecting means, and the third yaw rate can be estimated based on the detected steering speed. At this time, when the steering speed is high, the third yaw rate is estimated so that the weighting of the second yaw rate with respect to the first yaw rate is larger than when the steering speed is low, thereby estimating the yaw rate due to the steering speed. The error can be reduced reliably.
本発明のヨーレート推定装置では、車両の前後加速度を検出する前後加速度検出手段を更に備え、第３ヨーレート推定手段は、前後加速度検出手段により検出される前後加速度が高い場合は小さい場合と比較して第１ヨーレートに対する第２ヨーレートの重み付けが大きいこととしても良い。一般にドライバーのアクセル操作によって生じる車両の前後加速度が高くなるほど、車両が非定常旋回状態になりやすくなる。従って、前後加速度検出手段により前後加速度を検出し、この検出した前後加速度に基づいて第３ヨーレートを推定することができる。このとき、前後加速度が高い場合は、前後加速度が小さい場合と比較して、第１ヨーレートに対する第２ヨーレートの重み付けが大きくなるように第３ヨーレートを推定することで、前後加速度に起因するヨーレート推定の誤差を確実に小さくすることができる。 The yaw rate estimation apparatus of the present invention further includes longitudinal acceleration detection means for detecting longitudinal acceleration of the vehicle, and the third yaw rate estimation means is higher when the longitudinal acceleration detected by the longitudinal acceleration detection means is high than when it is small. The weighting of the second yaw rate with respect to the first yaw rate may be large. In general, the higher the longitudinal acceleration of the vehicle generated by the driver's accelerator operation, the more likely the vehicle will be in an unsteady turning state. Accordingly, the longitudinal acceleration can be detected by the longitudinal acceleration detecting means, and the third yaw rate can be estimated based on the detected longitudinal acceleration. At this time, when the longitudinal acceleration is high, the yaw rate estimation due to the longitudinal acceleration is performed by estimating the third yaw rate so that the weighting of the second yaw rate with respect to the first yaw rate is larger than when the longitudinal acceleration is small. The error can be reduced reliably.
本発明のヨーレート推定装置では、車両が走行する道路のカーブ半径を推定するカーブ半径推定手段を更に備え、第２ヨーレート推定手段は、カーブ半径推定手段により推定されるカーブ半径及び車速検出手段により検出される車速に基づいて第２ヨーレートを推定することが好ましい。これにより、第１ヨーレートの推定法とは異なる推定法によって、第２ヨーレートを確実に推定することができる。また、車両が実際に走行する道路のカーブ半径を用いて第２ヨーレートを推定するため、車両の走行状態だけでなく、道路環境をも含めてヨーレートを推定することができ、より広範囲の条件をもとにヨーレートを推定することが可能となる。 The yaw rate estimation apparatus of the present invention further comprises curve radius estimation means for estimating the curve radius of the road on which the vehicle travels, and the second yaw rate estimation means is detected by the curve radius and vehicle speed detection means estimated by the curve radius estimation means. The second yaw rate is preferably estimated based on the vehicle speed. Thereby, the second yaw rate can be reliably estimated by an estimation method different from the estimation method of the first yaw rate. In addition, since the second yaw rate is estimated using the curve radius of the road on which the vehicle actually travels, the yaw rate can be estimated not only in the traveling state of the vehicle but also in the road environment. Based on this, it becomes possible to estimate the yaw rate.
本発明によれば、車両が定常旋回状態ではないときでも高精度にヨーレートを推定することができるので、車両の旋回状態にかかわらず車両の挙動を正確に把握することが可能となる。 According to the present invention, since the yaw rate can be estimated with high accuracy even when the vehicle is not in a steady turning state, the behavior of the vehicle can be accurately grasped regardless of the turning state of the vehicle.
以下、図面を参照して、本発明に係るヨーレート推定装置の好適な実施形態について詳細に説明する。なお、全図中、同一又は相当部分には同一符号を付すこととする。 Hereinafter, a preferred embodiment of a yaw rate estimation apparatus according to the present invention will be described in detail with reference to the drawings. In the drawings, the same or corresponding parts are denoted by the same reference numerals.
図１は、本実施形態に係るヨーレート推定装置の構成を示すブロック図である。ヨーレート推定装置１は、図示しない車両に搭載されており、図１に示すように、車両の横加速度を検出する横加速度センサ２と、車両の速度（車速）を検出する車速センサ３と、車両に搭載されて進行方向前方の道路を撮像するカメラ４と、車両の操舵速度を検出する操舵速度センサ５と、車両の前後加速度を検出する前後加速度センサ６と、車両の旋回状態を判定し、この結果に基づいて車両のヨーレートを推定する制御ユニット７を備えている。
FIG. 1 is a block diagram illustrating a configuration of a yaw rate estimation apparatus according to the present embodiment. The yaw
制御ユニット７は、カメラ４で撮像した車両の進行方向前方における道路画像を画像処理して、道路のカーブ半径を求める画像処理部８と、横加速度センサ２で検出した横加速度、車速センサ３で検出した車速、画像処理部８で求めたカーブ半径、操舵速度センサ５で検出した操舵速度、及び前後加速度センサ６で検出した前後加速度に基づいて、車両のヨーレートを推定するヨーレート推定部９とを備えている。
The
図２は、ヨーレート推定部９のヨーレート推定処理手順を示すフローチャートである。図２に示すように、ヨーレートの推定が開始されると、まず、横加速度センサ２で検出した横加速度と、車速センサ３で検出した車速とに基づき車両の第１ヨーレートを推定する（ステップ１）。第１ヨーレートの推定は、第１ヨーレートをωｌａ、横加速度をａｙ（ｍ／ｓ２）、車速をＶ（ｍ／ｓ）としたときに、
によって第１ヨーレートωｌａを求めることにより行う。
FIG. 2 is a flowchart showing the yaw rate estimation processing procedure of the yaw
To obtain the first yaw rate ω la .
なお、第１ヨーレートをより正確に推定するためには車速Ｖではなく車前後速Ｖｘを用いる必要があるが、実際上は車速Ｖを用いても誤差はそれ程大きくならないため、ヨーレート推定装置１では車速Ｖを用いて第１ヨーレートを推定する。
Since in order to estimate the first yaw rate more accurately it is necessary to use a vehicle speed V instead car longitudinal speed V x, practice the error does not become so large even with a vehicle speed V, the yaw
そして、車両が定常旋回状態であるか否かを判定する（ステップ２）。具体的には、（１）画像処理部８で求めたカーブ半径の変位量が設定値よりも大きい場合は、車両がカーブに進入、又は車両がカーブから退出するものと判断し、（２）操舵速度センサ５で検出した操舵速度が設定値よりも高い場合は、操舵速度が高いと判断し、（３）前後加速度センサ６で検出した前後加速度が設定値よりも高い場合は、前後加速度が高いと判断し、それぞれ定常旋回状態ではない（非定常旋回状態である）と判定する。
Then, it is determined whether or not the vehicle is in a steady turning state (step 2). Specifically, (1) when the displacement amount of the curve radius obtained by the
このとき、車両が定常旋回状態であると判定されると、第１ヨーレートを最終ヨーレートωｅｓｔと設定する（ステップ３）。 At this time, if it is determined that the vehicle is in a steady turning state, the first yaw rate is set to the final yaw rate ω est (step 3).
一方、車両が定常旋回状態ではないと判定されると、画像処理部８で求めたカーブ半径と車速センサ３で検出した車速とに基づき第２ヨーレートを推定する（ステップ４）。第２ヨーレートの推定は、第２ヨーレートをωｃａｍ、道路のカーブ半径をＲ（ｍ）、車速をＶ（ｍ／ｓ）としたときに、
によって第２ヨーレートωｃａｍを求めることにより行う。
On the other hand, if it is determined that the vehicle is not in a steady turning state, the second yaw rate is estimated based on the curve radius obtained by the
To obtain the second yaw rate ω cam .
このようにして、第１ヨーレート及び第２ヨーレートを推定すると、第１ヨーレート及び第２ヨーレートの加重平均をとることで、車両の第３ヨーレートを推定する（ステップ５）。第３ヨーレートの推定は、第３ヨーレートをωｅｓｔ、第１ヨーレートの設計価重み関数をｗ１、第２ヨーレートの設計価重み関数をｗ２としたときに、
によって第３ヨーレートωｅｓｔを求めることにより行う。
When the first yaw rate and the second yaw rate are estimated in this way, the third yaw rate of the vehicle is estimated by taking a weighted average of the first yaw rate and the second yaw rate (step 5). The third yaw rate is estimated when ω est is the third yaw rate, w 1 is the design value weight function of the first yaw rate, and w 2 is the design value weight function of the second yaw rate.
To obtain the third yaw rate ω est .
また、数式３における重み関数ｗ１及びｗ２は、前後加速度をａｘ（ｍ/ｓ２）、操舵速度をγ（ｒａｄ／ｓ）、操舵角速度をδ（ｒａｄ）、横加速度を用いてヨーレートを推定する第１ヨーレートの適合関数をＫｌａ、道路のカーブ半径を用いてヨーレートを推定する第２ヨーレートの適合関数をＫｃａｍとしたときに、
となる。なお、第１ヨーレートの適合関数Ｋｌａ及び第２ヨーレートの適合関数Ｋｃａｍは、実験により適切な値が設定される。
In addition, the weighting functions w 1 and w 2 in
It becomes. Note that the first yaw rate adaptation function Kla and the second yaw rate adaptation function Kcam are set to appropriate values through experiments.
そして、推定された第３ヨーレートを最終ヨーレートと設定する（ステップ６）。 Then, the estimated third yaw rate is set as the final yaw rate (step 6).
上記数式３及び数式４から分かるように、（ａ）道路のカーブ半径が小さくなり、（ｂ）操舵速度が高くなり、（ｃ）前後加速度が高くなると、第１ヨーレートωｌａの重み付けが小さくなると共に第２ヨーレートωｃａｍの重み付けが大きくなる。これは、道路のカーブ半径が小さくなると、ドライバーは急な動作を行う傾向が高くなり、また、ドライバーが急な動作を行っていると、操舵速度が高くなったり前後加速度が高くなったりするためである。このため、（ａ）〜（ｃ）のときは、ヨーレートの推定精度が低下する第１ヨーレートωｌａの重み付けを小さくして、第２ヨーレートωｃａｍの重み付けを大きくする。
As can be seen from
一方、（Ａ）道路のカーブ半径が大きくなり、（Ｂ）操舵速度が低くなり、（Ｃ）前後加速度が低くなると、第１ヨーレートωｌａの重み付けが大きくなり、第２ヨーレートωｃａｍの重み付けが小さくなる。すなわち、（Ａ）〜（Ｃ）のときは車両が定常旋回状態に近づくため、ヨーレートの推定精度が高くなる第１ヨーレートωｌａの重み付けを大きくして、第２ヨーレートωｃａｍの重み付けを小さくする。 On the other hand, when (A) the curve radius of the road increases, (B) the steering speed decreases, and (C) the longitudinal acceleration decreases, the weighting of the first yaw rate ω la increases and the weighting of the second yaw rate ω cam increases. Get smaller. That is, in (A) to (C), since the vehicle approaches a steady turning state, the weight of the first yaw rate ω la that increases the estimation accuracy of the yaw rate is increased, and the weight of the second yaw rate ω cam is decreased. .
以上において、制御ユニット７におけるヨーレート推定部９のステップ１は、「車速検出手段３により検出される速度及び横加速度検出手段２により検出される横加速度に基づいて車両の第１ヨーレートを推定する第１ヨーレート推定手段」を構成する。同ヨーレート推定部９のステップ４は、「第１ヨーレート推定手段による推定法と異なる推定法で車両の第２ヨーレートを推定する第２ヨーレート推定手段」を構成する。同ヨーレート推定部９のステップ５は、「第１ヨーレート及び第２ヨーレートに基づいて第３ヨーレートを推定する第３ヨーレート推定手段」を構成する。カメラ４、操舵速度センサ５、前後加速度センサ６、制御ユニット７における画像処理部８及びヨーレート推定部９のステップ２は、「車両の旋回状態を判定する旋回状態判定手段」を構成する。
In the above,
図３は、ヨーレートの推定をシミュレーションするための条件として、車両が走行する道路におけるカーブの曲率の一例を示した図である。横加速度及び車速に基づく従来のヨーレート（第１ヨーレートに相当）の推定法によりシミュレーションを行ったところ、図４に示すような結果となった。図４に示すように、カーブに進入するとき（Ｉ）とカーブから退出するとき（ＩＩＩ）のヨーレート推定誤差が大きくなっていることが分かる。つまり、カーブに進入するとき（Ｉ）とカーブから退出するとき（ＩＩＩ）は、操舵速度センサ５により検出された操舵速度が設定値よりも高くなることで、又は前後加速度センサ６により検出された前後加速度が設定値よりも高くなることで定常旋回状態ではなくなり、ヨーレートの推定誤差が大きくなっている。
FIG. 3 is a diagram showing an example of the curvature of the curve on the road on which the vehicle travels as a condition for simulating the estimation of the yaw rate. When a simulation was performed using a conventional yaw rate estimation method (corresponding to the first yaw rate) based on the lateral acceleration and the vehicle speed, the results shown in FIG. 4 were obtained. As shown in FIG. 4, it can be seen that the yaw rate estimation error is large when entering the curve (I) and when exiting the curve (III). In other words, when entering the curve (I) and when leaving the curve (III), the steering speed detected by the
これに対して、ヨーレート推定装置１によりヨーレートの推定のシミュレーションを行った場合には、図５に示すように、道路のカーブ半径（曲率）Ｒ、操舵速度γ、前後加速度ａｘの変動に基づいて、第１ヨーレートの重み付けｗ１と第２ヨーレートの重み付けｗ２とを調整することにより、図６に示すような結果となった。
In contrast, in the case of a simulation of the estimated yaw rate by the yaw
図５に示すように、カーブに進入するとき（Ｉ）は、車両が定常旋回状態ではないと判定されるため、第１ヨーレートと第２ヨーレートの加重平均をとる第３ヨーレートが推定され、カーブの曲率が大きくなる（カーブ半径が小さくなる）に従って、第１ヨーレートωｌａの重み付けｗ１が小さくなると共に第２ヨーレートωｃａｍの重み付けｗ２が大きくなる。カーブから退出するとき（ＩＩＩ）は、車両が定常旋回状態ではないと判定されるため、第１ヨーレートと第２ヨーレートの加重平均をとる第３ヨーレートが推定され、カーブの曲率が小さくなる（カーブ半径が大きくなる）に従って、第１ヨーレートωｌａの重み付けｗ１が大きくなると共に第２ヨーレートωｃａｍの重み付けｗ２が小さくなる。一方、カーブの曲率（カーブ半径）が一定の道路を走行している間（ＩＩ）は、車両が定常旋回状態であると判定されるため、第１ヨーレートが最終ヨーレートとなる。 As shown in FIG. 5, when entering the curve (I), since it is determined that the vehicle is not in a steady turning state, a third yaw rate that takes a weighted average of the first yaw rate and the second yaw rate is estimated, and the curve As the curvature becomes larger (the curve radius becomes smaller), the weight w 1 of the first yaw rate ω la becomes smaller and the weight w 2 of the second yaw rate ω cam becomes larger. When leaving the curve (III), since it is determined that the vehicle is not in a steady turning state, a third yaw rate that takes a weighted average of the first yaw rate and the second yaw rate is estimated, and the curvature of the curve becomes small (curve As the radius increases, the weight w 1 of the first yaw rate ω la increases and the weight w 2 of the second yaw rate ω cam decreases. On the other hand, while the vehicle is traveling on a road having a constant curvature (curve radius) (II), the vehicle is determined to be in a steady turning state, so the first yaw rate is the final yaw rate.
従って、図６に示すように、車両が定常旋回状態であるときには、図４に示す従来のヨーレート推定法と同等の結果が得られるが、車両が定常旋回状態でないときには、ヨーレートの推定誤差が十分小さくなったことが分かる。これにより、本実施形態によるヨーレート推定法の有効性が明らかになったと言える。 Therefore, as shown in FIG. 6, when the vehicle is in a steady turning state, a result equivalent to the conventional yaw rate estimation method shown in FIG. 4 is obtained. However, when the vehicle is not in a steady turning state, the estimation error of the yaw rate is sufficient. You can see that it has become smaller. Thus, it can be said that the effectiveness of the yaw rate estimation method according to the present embodiment has been clarified.
以上のようなヨーレート推定装置１によれば、車両が実際に旋回する道路をカメラ４で撮像して画像処理することで、道路のカーブ半径Ｒを推定し、このカーブ半径Ｒと車速とに基づき第２ヨーレートを推定する。そして、車両が定常旋回状態ではないときは、車両の旋回状態に応じた重み付けにより第１ヨーレートと第２ヨーレートとの加重平均をとることで、第３ヨーレートを求める。このため、車両が定常旋回状態ではないときに第１ヨーレートの推定精度が低下したとしても、第３ヨーレートを最終ヨーレートとすることでヨーレート推定の精度低下を抑制することができる。これにより、車両が定常旋回状態であるときでも、非定常旋回状態であるときでも、高精度にヨーレートを推定することが可能となる。
According to the yaw
また、車両が実際に走行する道路のカーブ半径Ｒを用いて第２ヨーレートを推定するため、車両の走行状態だけでなく、車両が実際に走行する道路環境を含めた広範囲の条件をもとにヨーレートを推定することが可能となる。 In addition, since the second yaw rate is estimated using the curve radius R of the road on which the vehicle actually travels, not only the travel state of the vehicle but also a wide range of conditions including the road environment on which the vehicle actually travels. The yaw rate can be estimated.
なお、本発明は、上記実施形態に限定されるものではない。例えば、上記実施形態では、カーブ半径と車速に基づき第２ヨーレートを推定したが、第１ヨーレートと異なる推定法で第２ヨーレートを推定すれば如何なる推定法でもよく、例えば、ヨーレートセンサ（不図示）で検出されるヨーレートや、車輪速センサ（不図示）で検出される内外輪の車輪速などに基づいて第２ヨーレートを推定してもよい。 The present invention is not limited to the above embodiment. For example, in the above embodiment, the second yaw rate is estimated based on the curve radius and the vehicle speed. However, any estimation method may be used as long as the second yaw rate is estimated by an estimation method different from the first yaw rate, for example, a yaw rate sensor (not shown). The second yaw rate may be estimated on the basis of the yaw rate detected at, the wheel speeds of the inner and outer wheels detected by a wheel speed sensor (not shown), or the like.
また、カメラ４で撮像した道路画像を画像処理部８で画像処理することで、車両進行方向前方における道路の半径を求めて（推定して）いるが、道路のカーブ半径を推定することができれば如何なる手段でカーブ半径を推定してもよく、例えば、ナビゲーションシステム等によりカーブ半径を推定したり、路車間通信等によりカーブ半径情報を取得することによりカーブ半径を推定したりしてもよい。
Further, the road image captured by the camera 4 is image-processed by the
また、車両が定常旋回状態であるか否かの判定は、画像処理部８で推定した道路のカーブ半径、操舵速度センサ５で検出した操舵速度、及び前後加速度センサ６で検出した前後加速度に基づいて判断しているが、これらのうち単体で判断してもよく、適宜組み合わせて判断してもよい。また、第３ヨーレートの推定は、画像処理部８で求めた道路のカーブ半径、操舵速度センサ５で検出した操舵速度、及び前後加速度センサ６で検出した前後加速度に基づいた第１ヨーレート及び第２ヨーレートの重み付けにより算出しているが、これらのうち単体で算出してもよく、適宜組み合わせて算出してもよい。
Whether the vehicle is in a steady turning state is determined based on the road curve radius estimated by the
また、車両が定常旋回状態であるときは、第１ヨーレートを最終ヨーレートとしているが、車両の旋回状態に関わらず、第３ヨーレートを最終ヨーレートとしてもよい。この場合には、車両が定常旋回状態でないときには、定常旋回状態であるときと比較して、第１ヨーレートに対する第２ヨーレートの重み付けを大きくして、つまり第２ヨーレートを重視して第３ヨーレートを推定すればよい。 When the vehicle is in a steady turning state, the first yaw rate is the final yaw rate, but the third yaw rate may be the final yaw rate regardless of the turning state of the vehicle. In this case, when the vehicle is not in a steady turning state, the weight of the second yaw rate is increased with respect to the first yaw rate compared to when the vehicle is in a steady turning state. It may be estimated.
１…ヨーレート推定装置、２…横加速度センサ（横加速度検出手段）、３…車速センサ（車速検出手段）、４…カメラ（旋回状態判定手段、カーブ半径推定手段）、５…操舵速度センサ（操舵速度検出手段、旋回状態判定手段）、６…前後加速度センサ（前後加速度検出手段、旋回状態判定手段）、７…制御ユニット、８…画像処理部（旋回状態判定手段、カーブ半径推定手段）、９…ヨーレート推定部（第１ヨーレート推定手段、第２ヨーレート推定手段、第３ヨーレート推定手段、旋回状態判定手段）。
DESCRIPTION OF
Claims (5)
前記車両の横加速度を検出する横加速度検出手段と、
前記車速検出手段により検出される車速及び前記横加速度検出手段により検出される横加速度に基づいて前記車両の第１ヨーレートを推定する第１ヨーレート推定手段と、
前記第１ヨーレート推定手段による推定法と異なる推定法で前記車両の第２ヨーレートを推定する第２ヨーレート推定手段と、
前記第１ヨーレート及び前記第２ヨーレートに基づいて前記車両の第３ヨーレートを推定する第３ヨーレート推定手段と、
前記車両の旋回状態を判定する旋回状態判定手段とを備え、
前記第３ヨーレート推定手段は、前記旋回状態判定手段により前記車両が定常旋回状態ではないと判定されたときには、前記車両が定常旋回状態であると判定されたときに比べて、前記第１ヨーレートに対する前記第２ヨーレートの重み付けを大きくして前記第３ヨーレートを推定することを特徴とするヨーレート推定装置。 Vehicle speed detecting means for detecting the vehicle speed of the vehicle;
Lateral acceleration detecting means for detecting lateral acceleration of the vehicle;
First yaw rate estimation means for estimating a first yaw rate of the vehicle based on a vehicle speed detected by the vehicle speed detection means and a lateral acceleration detected by the lateral acceleration detection means;
Second yaw rate estimation means for estimating the second yaw rate of the vehicle by an estimation method different from the estimation method by the first yaw rate estimation means;
Third yaw rate estimating means for estimating a third yaw rate of the vehicle based on the first yaw rate and the second yaw rate;
Turning state determining means for determining a turning state of the vehicle,
The third yaw rate estimator is configured to detect the first yaw rate when the turning state determining means determines that the vehicle is not in a steady turning state, compared to when the vehicle is determined to be in a steady turning state. A yaw rate estimation apparatus that estimates the third yaw rate by increasing the weight of the second yaw rate.
前記第３ヨーレート推定手段は、前記カーブ半径推定手段により推定されるカーブ半径が小さい場合は大きい場合と比較して前記第１ヨーレートに対する前記第２ヨーレートの重み付けが大きいことを特徴とする請求項１に記載のヨーレート推定装置。 A curve radius estimating means for estimating a curve radius of a road on which the vehicle runs;
2. The third yaw rate estimation means is characterized in that the weight of the second yaw rate with respect to the first yaw rate is larger when the curve radius estimated by the curve radius estimation means is smaller than when the curve radius is large. The yaw rate estimation apparatus described in 1.
前記第３ヨーレート推定手段は、前記操舵速度検出手段により検出される操舵速度が高い場合は小さい場合と比較して前記第１ヨーレートに対する前記第２ヨーレートの重み付けが大きいことを特徴とする請求項１に記載のヨーレート推定装置。 A steering speed detecting means for detecting a steering speed of the vehicle;
2. The third yaw rate estimation means is characterized in that the weighting of the second yaw rate with respect to the first yaw rate is larger when the steering speed detected by the steering speed detection means is higher than when the steering speed is low. The yaw rate estimation apparatus described in 1.
前記第３ヨーレート推定手段は、前記前後加速度検出手段により検出される前後加速度が高い場合は小さい場合と比較して前記第１ヨーレートに対する前記第２ヨーレートの重み付けが大きいことを特徴とする請求項１に記載のヨーレート推定装置。 It further comprises longitudinal acceleration detecting means for detecting longitudinal acceleration of the vehicle,
2. The third yaw rate estimation means is characterized in that the weight of the second yaw rate relative to the first yaw rate is larger when the longitudinal acceleration detected by the longitudinal acceleration detection means is high than when the longitudinal acceleration is small. The yaw rate estimation apparatus described in 1.
前記第２ヨーレート推定手段は、前記カーブ半径推定手段により推定されるカーブ半径及び前記車速検出手段により検出される車速に基づいて前記第２ヨーレートを推定することを特徴とする請求項１〜４の何れか１項に記載のヨーレート推定装置。 A curve radius estimating means for estimating a curve radius of a road on which the vehicle runs;
5. The second yaw rate estimation unit estimates the second yaw rate based on a curve radius estimated by the curve radius estimation unit and a vehicle speed detected by the vehicle speed detection unit. The yaw rate estimation apparatus according to any one of the above.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2006228014A JP2008049828A (en) | 2006-08-24 | 2006-08-24 | Yaw rate estimating device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2006228014A JP2008049828A (en) | 2006-08-24 | 2006-08-24 | Yaw rate estimating device |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2008049828A true JP2008049828A (en) | 2008-03-06 |
Family
ID=39234279
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2006228014A Pending JP2008049828A (en) | 2006-08-24 | 2006-08-24 | Yaw rate estimating device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2008049828A (en) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPWO2010073300A1 (en) * | 2008-12-26 | 2012-05-31 | トヨタ自動車株式会社 | Traveling route estimation device and traveling route estimation method used in the device |
| KR20130136079A (en) * | 2012-06-04 | 2013-12-12 | 현대모비스 주식회사 | Method and apparatus for calculating yawrate and method for controlling the lane keeping assist system using the same |
| JP2018043720A (en) * | 2016-09-16 | 2018-03-22 | Ntn株式会社 | Slide suppression control device |
| JP2018054483A (en) * | 2016-09-29 | 2018-04-05 | 株式会社Ｓｕｂａｒｕ | Steering assist ratio computation device of power steering system and method of computing steering assist ratio of power steering system |
| JP2021178636A (en) * | 2019-10-17 | 2021-11-18 | パイオニア株式会社 | Calculation device, control method, program and storage medium |
| JP2022122796A (en) * | 2021-02-10 | 2022-08-23 | 本田技研工業株式会社 | Yaw rate estimation device |
-
2006
- 2006-08-24 JP JP2006228014A patent/JP2008049828A/en active Pending
Cited By (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPWO2010073300A1 (en) * | 2008-12-26 | 2012-05-31 | トヨタ自動車株式会社 | Traveling route estimation device and traveling route estimation method used in the device |
| JP5146542B2 (en) * | 2008-12-26 | 2013-02-20 | トヨタ自動車株式会社 | Traveling route estimation device and traveling route estimation method used in the device |
| US8989913B2 (en) | 2008-12-26 | 2015-03-24 | Toyota Jidosha Kabushiki Kaisha | Travel route estimation device and travel route estimation method used in the same device |
| KR20130136079A (en) * | 2012-06-04 | 2013-12-12 | 현대모비스 주식회사 | Method and apparatus for calculating yawrate and method for controlling the lane keeping assist system using the same |
| KR101927111B1 (en) * | 2012-06-04 | 2019-03-12 | 현대모비스 주식회사 | Method and Apparatus for Calculating Yawrate and Method for Controlling the Lane Keeping Assist System Using the Same |
| JP2018043720A (en) * | 2016-09-16 | 2018-03-22 | Ntn株式会社 | Slide suppression control device |
| JP2018054483A (en) * | 2016-09-29 | 2018-04-05 | 株式会社Ｓｕｂａｒｕ | Steering assist ratio computation device of power steering system and method of computing steering assist ratio of power steering system |
| JP2021178636A (en) * | 2019-10-17 | 2021-11-18 | パイオニア株式会社 | Calculation device, control method, program and storage medium |
| JP2022122796A (en) * | 2021-02-10 | 2022-08-23 | 本田技研工業株式会社 | Yaw rate estimation device |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP3608635A1 (en) | Positioning system | |
| US10147003B2 (en) | Lane detection device and method thereof, curve starting point detection device and method thereof, and steering assistance device and method thereof | |
| JP6515823B2 (en) | Lane change support device | |
| US20180186372A1 (en) | Lane departure prevention apparatus | |
| US20130049988A1 (en) | Device and method for traffic sign recognition | |
| US20200377082A1 (en) | Method and apparatus for vision based lateral acceleration prediction | |
| JP6319192B2 (en) | Vehicle speed limiter | |
| JP6572264B2 (en) | Vehicle road friction coefficient estimation apparatus and vehicle road friction coefficient estimation method | |
| JP2005254861A (en) | Vehicle condition detection system and vehicle condition detection method | |
| JP7143722B2 (en) | Vehicle position estimation device | |
| JP5114351B2 (en) | Arousal level judgment device | |
| JP2008049828A (en) | Yaw rate estimating device | |
| WO2016194168A1 (en) | Travel control device and method | |
| JP2009078649A (en) | Stabilizer control device, stabilizer controlling method, and stabilizer controlling program | |
| JP2016206976A (en) | Preceding vehicle track calculation device for driving support control of vehicle | |
| WO2016158786A1 (en) | Collision avoidance device and collision avoidance system | |
| JP2019156297A (en) | Travel support system and control method of vehicle | |
| JP2008003789A (en) | Driver state determination device | |
| JP2010102538A (en) | Drowse determining device | |
| JP7302411B2 (en) | Driving skill evaluation device | |
| JP2009032031A (en) | Road information acquisition device, road information acquisition method and road information acquisition program | |
| US11285938B2 (en) | Method for controlling a vehicle on a bend and roll stability control system | |
| JP7176299B2 (en) | Stop support device | |
| JP2020091789A (en) | Collision avoidance assistance device | |
| CN116118770A (en) | Self-adaptive rationalizer of vehicle sensing system for robust automatic driving control |