JP2012063184A - Yaw rate calibration device - Google Patents
Yaw rate calibration device Download PDFInfo
- Publication number
- JP2012063184A JP2012063184A JP2010206248A JP2010206248A JP2012063184A JP 2012063184 A JP2012063184 A JP 2012063184A JP 2010206248 A JP2010206248 A JP 2010206248A JP 2010206248 A JP2010206248 A JP 2010206248A JP 2012063184 A JP2012063184 A JP 2012063184A
- Authority
- JP
- Japan
- Prior art keywords
- steering angle
- yaw rate
- steering
- value
- dead zone
- 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
Links
Images
Landscapes
- Gyroscopes (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
Description
本発明は、車両のヨーレート(旋回率)を検出するヨーレートセンサの較正装置に関する。 The present invention relates to a calibration device for a yaw rate sensor that detects a yaw rate (turning rate) of a vehicle.
車両のヨーレートは、レートジャイロを用いたヨーレートセンサにより検出される。かかるヨーレートセンサのゼロ点の較正は、車両が停止していてヨーレートが発生していないときに、その出力値をゼロに一致させることにより可能である。しかしながら、ヨーレートセンサの出力特性は、温度により変化するため、車両の停車中ではなく、走行中にも継続的に較正を行う必要がある。
特許文献1には、ヨーレートセンサのゼロ点の較正方法の1つとして、操舵角センサで検出した操舵角と車速センサで検出した車速とに基づいて規範ヨーレートを算出し、この規範ヨーレートがゼロであるときにヨーレートが発生していないと推定してヨーレートセンサの出力値をゼロに一致させる方法(以下、「規範ヨーレート較正法」と称する)が記載されている。
The yaw rate of the vehicle is detected by a yaw rate sensor using a rate gyro. Calibration of the zero point of such a yaw rate sensor is possible by making the output value coincide with zero when the vehicle is stopped and no yaw rate is generated. However, since the output characteristics of the yaw rate sensor change depending on the temperature, it is necessary to calibrate continuously while the vehicle is running, not when the vehicle is stopped.
In
しかしながら、特許文献1に記載の従来技術では、車両の停車中もヨーレートセンサの出力値をゼロに較正し、その後、車両が直進状態であるときにもヨーレートセンサの出力値をゼロに較正する必要がある。
また、規範ヨーレート較正法では、操舵角センサに不感帯領域がある場合、例えば、操向ハンドルの回転軸の中立位置からの回転角を検出する方法として歯車機構を用いて、歯車機構のガタ(バックラッシュ)により不感帯領域が生じる場合、歯車機構のガタ分だけ操舵角が不正確となり規範ヨーレートに誤差が生じるという課題があった。
However, in the prior art described in
Further, in the standard yaw rate calibration method, when there is a dead zone in the steering angle sensor, for example, a gear mechanism is used as a method for detecting the rotation angle from the neutral position of the rotation axis of the steering handle. When the dead zone region is generated due to rush, there is a problem that the steering angle is inaccurate by an amount corresponding to the backlash of the gear mechanism and an error occurs in the standard yaw rate.
本発明は、前記した従来の課題を解決するものであり、車両の停車状態でのヨーレートセンサのゼロ点の較正をする必要がなく、車両の走行状態における規範ヨーレート較正法だけでヨーレートセンサのゼロ点の較正ができるヨーレート較正装置を提供することを目的とする。 The present invention solves the above-described conventional problems, and it is not necessary to calibrate the zero point of the yaw rate sensor when the vehicle is stopped. An object of the present invention is to provide a yaw rate calibration apparatus capable of calibrating points.
前記課題を解決するために、請求項1に係る発明は、操舵角を検出する操舵角センサと、車両のヨーレートを検出するヨーレートセンサと、を備え、操舵角センサが検出した操舵角に応じてヨーレートセンサのゼロ点補正をするヨーレート較正装置において、操舵方向を判定する操舵方向判定手段と、車速を検出する車速検出手段と、車両の直進走行状態を判定する直進状態判定手段と、直進状態判定手段により直進走行状態と判定された際の操舵角センサにより検出された操舵角を記憶する操舵角記憶手段と、操舵角記憶手段に記憶された操舵角の値の分布に基づいて操舵角センサの不感帯領域を演算する操舵角検出不感帯領域演算手段と、操舵角検出不感帯領域演算手段によって求められた不感帯領域と操舵方向判定手段によって判定された操舵方向に基づいて検出された操舵角を補正する操舵角補正手段と、操舵角と車速とヨーレートとの相関関係が予め格納されたヨーレート特性データと、操舵角補正手段により補正された操舵角と、車速検出手段により検出された車速と、ヨーレート特性データとに基づいて、ヨーレートセンサで検出されたヨーレートのゼロ点を較正するゼロ点較正手段と、を備えることを特徴とする。
In order to solve the above-described problem, the invention according to
請求項1に記載の発明によれば、操舵角センサの検出する操舵角に不感帯領域が存在して、正確な操舵角が検出されない場合でも、直進状態判定手段により直進走行状態と判定されたときの操舵角センサで検出された操舵角を記憶し、その記憶された操舵角の値の分布に基づいて操舵角センサの不感帯領域を容易に操舵角検出不感帯領域演算手段において演算できる。そして、演算された操舵角センサの不感帯領域と操舵方向判定手段によって判定された操舵方向に基づいて、実際の操舵角が補正されるので、精度の高い操舵角が得られる。こうして得られた補正された操舵角と車速とヨーレート特性データとに基づいてゼロ点較正手段において規範ヨーレートを演算し、更に、そのときにヨーレートセンサで検出されたヨーレートと比較してヨーレートの差分を演算して、ヨーレートのゼロ点補正を行える。従って、車両の走行中に操舵角と車速から正確な規範ヨーレートを演算することによって精度の高いヨーレートセンサのゼロ点較正(ゼロ点補正)ができる。 According to the first aspect of the present invention, even when the dead zone region exists in the steering angle detected by the steering angle sensor and the accurate steering angle is not detected, when the straight traveling state is determined by the straight traveling state determination unit, The steering angle detected by the steering angle sensor is stored, and the dead zone region of the steering angle sensor can be easily calculated by the steering angle detection dead zone calculation means based on the distribution of the stored steering angle values. Since the actual steering angle is corrected based on the calculated dead zone region of the steering angle sensor and the steering direction determined by the steering direction determination means, a highly accurate steering angle can be obtained. Based on the corrected steering angle, vehicle speed, and yaw rate characteristic data obtained in this manner, the zero point calibration means calculates the reference yaw rate, and further compares the yaw rate detected by the yaw rate sensor at that time with the yaw rate difference. It can be calculated to correct the zero point of the yaw rate. Therefore, the zero point calibration (zero point correction) of the yaw rate sensor with high accuracy can be performed by calculating the accurate reference yaw rate from the steering angle and the vehicle speed while the vehicle is running.
請求項2に係る発明は、請求項1に記載の発明の構成に加え、直進状態判定手段により直進走行状態と判定された際の操舵角センサにより検出された操舵角を、車速検出手段により検出された車速と、ヨーレートセンサにより検出されたヨーレートと、ヨーレート特性データとに基づいて、検出されたヨーレートがゼロの値に対応する直進状態模擬操舵角に補正演算する直進状態操舵角演算手段を更に備え、
直進状態操舵角演算手段により演算された直進状態模擬操舵角を、直進状態判定手段により直進走行状態と判定された際の操舵角センサにより検出された操舵角の代わりの操舵角として操舵記憶手段に記憶させて、操舵角検出不感帯領域演算手段において用いられることを特徴とする。
According to a second aspect of the present invention, in addition to the configuration of the first aspect of the invention, the vehicle speed detecting means detects the steering angle detected by the steering angle sensor when the straight traveling state determining means determines that the vehicle is traveling straight. A straight-ahead steering angle calculation means for performing a correction calculation to a straight-ahead state simulated steering angle corresponding to a zero value of the detected yaw rate based on the detected vehicle speed, the yaw rate detected by the yaw rate sensor, and the yaw rate characteristic data; Prepared,
The straight traveling state simulated steering angle calculated by the straight traveling state steering angle calculating unit is stored in the steering storage unit as a steering angle instead of the steering angle detected by the steering angle sensor when the straight traveling state determining unit determines that the vehicle is traveling straight. It is memorized and used in the steering angle detection dead zone calculation means.
請求項2に記載の発明によれば、直進走行状態と判定されたときの操舵角センサで検出された操舵角を、ヨーレートがゼロの値に対応する操舵角に置き換えて記憶するので、操舵角検出不感帯領域演算手段において操舵角センサの不感帯領域をより精度良く演算できる。そして、演算された操舵角センサの不感帯領域と操舵方向判定手段によって判定された操舵方向に基づいて、実際の操舵角が補正されるので、精度の高い操舵角が得られる。こうして得られた補正された操舵角と車速とヨーレート特性データとに基づいてゼロ点較正手段において規範ヨーレートを演算し、更に、そのときにヨーレートセンサで検出されたヨーレートと比較してヨーレートの差分を演算して、ヨーレートのゼロ点補正を行える。従って、車両の走行中に操舵角と車速から正確な規範ヨーレートを演算することによって精度の高いヨーレートセンサのゼロ点較正(ゼロ点補正)ができる。 According to the second aspect of the present invention, the steering angle detected by the steering angle sensor when it is determined that the vehicle is traveling straight ahead is replaced with the steering angle corresponding to the value of the yaw rate being zero, so the steering angle is stored. The dead zone area of the steering angle sensor can be calculated with higher accuracy in the detection dead zone area calculation means. Since the actual steering angle is corrected based on the calculated dead zone region of the steering angle sensor and the steering direction determined by the steering direction determination means, a highly accurate steering angle can be obtained. Based on the corrected steering angle, vehicle speed, and yaw rate characteristic data obtained in this manner, the zero point calibration means calculates the reference yaw rate, and further compares the yaw rate detected by the yaw rate sensor at that time with the yaw rate difference. It can be calculated to correct the zero point of the yaw rate. Therefore, the zero point calibration (zero point correction) of the yaw rate sensor with high accuracy can be performed by calculating the accurate reference yaw rate from the steering angle and the vehicle speed while the vehicle is running.
請求項3に係る発明は、請求項1又は請求項2に記載の発明の構成に加え、更に、操舵角検出不感帯領域演算手段は、操舵角記憶手段に記憶された操舵角の値の最大値と最小値との差分を操舵角センサの不感帯領域とすることを特徴とする。 According to a third aspect of the present invention, in addition to the configuration of the first or second aspect of the invention, the steering angle detection dead zone region calculating means further includes a maximum steering angle value stored in the steering angle storage means. The difference between the value and the minimum value is used as a dead zone region of the steering angle sensor.
請求項3に係る発明によれば、車両が走行を開始してから操舵角記憶手段に記憶された操舵角の値の数が少ない時点でも、操舵角検出不感帯領域演算手段が、操舵角記憶手段に記憶された操舵角の値の最大値と最小値との差分を操舵角センサの不感帯領域とするので容易に操舵角センサの不感帯領域が演算できる。その結果、走行開始の早い時点においてヨーレートセンサのゼロ点較正(ゼロ点補正)を完了することができる。 According to the third aspect of the present invention, the steering angle detection dead zone region calculating means is the steering angle storage means even when the number of steering angle values stored in the steering angle storage means is small after the vehicle starts traveling. Since the difference between the maximum value and the minimum value of the steering angle value stored in is used as the dead zone region of the steering angle sensor, the dead zone region of the steering angle sensor can be easily calculated. As a result, the zero point calibration (zero point correction) of the yaw rate sensor can be completed at an early point of the start of traveling.
請求項4に係る発明は、請求項1又は請求項2に記載の発明の構成に加え、更に、操舵角検出不感帯領域演算手段は、操舵角記憶手段に記憶された操舵角の値の分布の標準偏差値を演算し、演算された標準偏差の所定倍の値を操舵角センサの不感帯領域とすることを特徴とする。 According to a fourth aspect of the present invention, in addition to the configuration of the first or second aspect of the invention, the steering angle detection dead zone calculation means further includes a distribution of steering angle values stored in the steering angle storage means. A standard deviation value is calculated, and a value that is a predetermined multiple of the calculated standard deviation is set as a dead zone region of the steering angle sensor.
請求項4に係る発明によれば、車両が走行を開始してから操舵角記憶手段に記憶された操舵角の値の数が所定以上の数になり標準偏差値の演算が意味のある状態になれば、操舵角検出不感帯領域演算手段は、操舵角記憶手段に記憶された操舵角の値の分布の標準偏差値を演算し、演算された標準偏差の所定倍の値を操舵角センサの不感帯領域とする。その結果、操舵角センサの不感帯領域をノイズの影響を抑制して精度良く演算でき、その操舵角センサの不感帯領域を用いて操舵角補正手段が操舵角を補正するので、ゼロ点較正手段において、規範ヨーレートを精度良く演算でき、ヨーレートセンサのゼロ点較正(ゼロ点補正)を精度良く行うことができる。 According to the fourth aspect of the present invention, the number of steering angle values stored in the steering angle storage means after the vehicle starts traveling becomes a predetermined number or more, and the calculation of the standard deviation value is meaningful. If this is the case, the steering angle detection dead zone calculation means calculates the standard deviation value of the distribution of the steering angle values stored in the steering angle storage means, and calculates a predetermined multiple of the calculated standard deviation as the dead zone of the steering angle sensor. This is an area. As a result, the dead zone region of the steering angle sensor can be accurately calculated while suppressing the influence of noise, and the steering angle correction unit corrects the steering angle using the dead zone region of the steering angle sensor. The reference yaw rate can be calculated with high accuracy, and the zero point calibration (zero point correction) of the yaw rate sensor can be performed with high accuracy.
請求項5に係る発明は、操舵角を検出する操舵角センサと、車両のヨーレートを検出するヨーレートセンサと、を備え、操舵角センサが検出した操舵角に応じてヨーレートセンサのゼロ点補正をするヨーレート較正装置において、操舵方向を判定する操舵方向判定手段と、車両の直進走行状態を判定する直進状態判定手段と、操舵角センサにより検出された操舵角に基づき操舵角速度の発生を検出する操舵角速度検出手段と、直進状態判定手段により直進走行状態と判定され、かつ、操舵角速度検出手段により操舵角速度の発生が確認された際の操舵角を、左操舵及び右操舵それぞれの操舵方向に区別して記憶する操舵角記憶手段と、操舵角と車速とヨーレートとの相関関係が予め格納されたヨーレート特性データと、操舵角記憶手段に記憶された左操舵時の操舵角の値の分布と、右操舵時の操舵角の値の分布と、に基づいて操舵角センサの不感帯領域を演算する操舵角検出不感帯領域演算手段と、操舵角検出不感帯領域演算手段によって求められた不感帯領域と操舵方向判定手段により判定された操舵方向とに基づいて検出された操舵角を補正する操舵角補正手段と、操舵角補正手段により補正された操舵角と、車速検出手段により検出された車速と、ヨーレート特性データとに基づいて、ヨーレートセンサで検出されたヨーレートのゼロ点を較正するゼロ点較正手段と、を備えることを特徴とする。 The invention according to claim 5 includes a steering angle sensor that detects the steering angle and a yaw rate sensor that detects the yaw rate of the vehicle, and corrects the zero point of the yaw rate sensor according to the steering angle detected by the steering angle sensor. In the yaw rate calibration apparatus, a steering angle determining unit that determines a steering direction, a straight traveling state determining unit that determines a straight traveling state of a vehicle, and a steering angular velocity that detects generation of a steering angular velocity based on a steering angle detected by a steering angle sensor. The steering angle when the straight traveling state is determined by the detecting means and the straight traveling state determining means and the generation of the steering angular speed is confirmed by the steering angular velocity detecting means is stored separately for the left steering direction and the right steering direction. Steering angle storage means, yaw rate characteristic data in which a correlation between the steering angle, the vehicle speed, and the yaw rate is stored in advance, and storage in the steering angle storage means Steering angle detection dead zone calculation means for calculating the dead zone area of the steering angle sensor based on the distribution of the steering angle value during left steering and the distribution of the steering angle value during right steering, and steering angle detection A steering angle correction means for correcting a steering angle detected based on the dead zone area obtained by the dead zone calculation means and the steering direction determined by the steering direction determination means; and the steering angle corrected by the steering angle correction means; And zero point calibration means for calibrating the zero point of the yaw rate detected by the yaw rate sensor based on the vehicle speed detected by the vehicle speed detection means and the yaw rate characteristic data.
請求項5に記載の発明によれば、操舵角センサの検出する操舵角に不感帯領域が存在して、正確な操舵角が検出されない場合でも、直進状態判定手段により直進走行状態と判定されたときの操舵角センサで検出された操舵角を、左操舵及び右操舵それぞれの操舵方向毎に記憶する。その記憶された操舵角の値の左操舵方向及び右操舵方向毎の分布に基づいて、操舵角センサの不感帯領域の左操舵方向における端値、操舵角センサの不感帯領域の右操舵方向における端値を容易に操舵角検出不感帯領域演算手段において演算できる。そして、演算された操舵角センサの不感帯領域と操舵方向判定手段によって判定された操舵方向に基づいて、実際の操舵角が補正されるので、精度の高い操舵角が得られる。こうして得られた補正された操舵角と車速とヨーレート特性データとに基づいてゼロ点較正手段において規範ヨーレートを演算し、更に、そのときにヨーレートセンサで検出されたヨーレートと比較してヨーレートの差分を演算して、ヨーレートのゼロ点補正を行える。従って、車両の走行中に操舵角と車速から正確な規範ヨーレートを演算することによって精度の高いヨーレートのゼロ点補正ができる。 According to the fifth aspect of the present invention, even when the dead zone region exists in the steering angle detected by the steering angle sensor and the accurate steering angle is not detected, when the straight traveling state is determined by the straight traveling state determination unit, The steering angle detected by the steering angle sensor is stored for each steering direction of left steering and right steering. Based on the distribution of the stored steering angle value for each of the left and right steering directions, the end value in the left steering direction of the dead zone region of the steering angle sensor and the end value in the right steering direction of the dead zone region of the steering angle sensor Can be easily calculated by the steering angle detection dead zone calculating means. Since the actual steering angle is corrected based on the calculated dead zone region of the steering angle sensor and the steering direction determined by the steering direction determination means, a highly accurate steering angle can be obtained. Based on the corrected steering angle, vehicle speed, and yaw rate characteristic data obtained in this manner, the zero point calibration means calculates the reference yaw rate, and further compares the yaw rate detected by the yaw rate sensor at that time with the yaw rate difference. It can be calculated to correct the zero point of the yaw rate. Therefore, by calculating an accurate standard yaw rate from the steering angle and the vehicle speed while the vehicle is traveling, it is possible to correct the zero point of the yaw rate with high accuracy.
請求項6に係る発明は、請求項5に記載の発明の構成に加え、直進状態判定手段により直進走行状態と判定され、かつ、操舵角速度検出手段により操舵角速度の発生が確認された際に、操舵角センサにより検出された操舵角を、操舵方向判定手段により判定された操舵方向と、車速検出手段により検出された車速と、ヨーレートセンサにより検出されたヨーレートと、ヨーレート特性データとに基づいて、検出されたヨーレートがゼロの値に対応する直進状態模擬操舵角に補正演算する直進状態操舵角演算手段を更に備え、
直進状態操舵角演算手段により演算された直進状態模擬操舵角を、直進状態判定手段により直進走行状態と判定され、かつ、操舵角速度検出手段により操舵角速度の発生が確認された際の操舵角センサにより検出された操舵角の代わりの操舵角として操舵角記憶手段に、左操舵及び右操舵それぞれの各操舵方向に区別して記憶させて、操舵角検出不感帯領域演算手段において用いられることを特徴とする。
In the invention according to claim 6, in addition to the configuration of the invention according to claim 5, when it is determined that the vehicle is traveling straight by the straight traveling state determination unit, and the generation of the steering angular velocity is confirmed by the steering angular velocity detection unit, Based on the steering angle detected by the steering angle sensor based on the steering direction determined by the steering direction determination means, the vehicle speed detected by the vehicle speed detection means, the yaw rate detected by the yaw rate sensor, and the yaw rate characteristic data, A straight traveling state steering angle calculating means for correcting and calculating a straight traveling state simulated steering angle corresponding to a value of zero detected yaw rate;
By the steering angle sensor when the straight traveling state simulated steering angle calculated by the straight traveling state steering angle calculating unit is determined to be a straight traveling state by the straight traveling state determining unit and the generation of the steering angular velocity is confirmed by the steering angular velocity detecting unit. The steering angle storage means distinguishes and stores each steering direction of left steering and right steering as a steering angle instead of the detected steering angle, and is used in the steering angle detection dead zone calculation means.
請求項6に記載の発明によれば、直進状態判定手段により直進走行状態と判定され、かつ、操舵角速度検出手段により操舵角速度の発生が確認された際に、直進状態操舵角演算手段において、操舵角センサにより検出された操舵角を、操舵方向判定手段により判定された操舵方向と、車速検出手段により検出された車速と、ヨーレートセンサにより検出されたヨーレートと、ヨーレート特性データとに基づいて、検出されたヨーレートがゼロの値に対応する直進状態模擬操舵角を演算し、操舵角センサにより検出された操舵角の代わりの操舵角として操舵角記憶手段に、左操舵及び右操舵それぞれの各操舵方向に区別して記憶させるので、操舵角検出不感帯領域演算手段において操舵角センサの不感帯領域をより精度良く演算できる。
そして、演算された操舵角センサの不感帯領域と操舵方向判定手段によって判定された操舵方向に基づいて、実際の操舵角が補正されるので、精度の高い操舵角が得られる。こうして得られた補正された操舵角と車速とヨーレート特性データとに基づいてゼロ点較正手段において規範ヨーレートを演算し、更に、そのときにヨーレートセンサで検出されたヨーレートと比較してヨーレートの差分を演算して、ヨーレートのゼロ点補正を行える。従って、車両の走行中に操舵角と車速から正確な規範ヨーレートを演算することによって精度の高いヨーレートセンサのゼロ点較正(ゼロ点補正)ができる。
また、走行開始の早い時点においてヨーレートセンサのゼロ点較正(ゼロ点補正)を完了することができる。
According to the sixth aspect of the present invention, when the straight traveling state determination unit determines that the vehicle is traveling straight and the steering angular velocity detection unit confirms the generation of the steering angular velocity, the straight traveling state steering angle calculation unit performs steering. The steering angle detected by the angle sensor is detected based on the steering direction determined by the steering direction determination means, the vehicle speed detected by the vehicle speed detection means, the yaw rate detected by the yaw rate sensor, and the yaw rate characteristic data. The calculated straight steering state steering angle corresponding to the value of the zero yaw rate is calculated, and each steering direction of the left steering and the right steering is stored in the steering angle storage means as the steering angle instead of the steering angle detected by the steering angle sensor. Thus, the steering angle detection dead zone calculation means can calculate the dead zone of the steering angle sensor with higher accuracy.
Since the actual steering angle is corrected based on the calculated dead zone region of the steering angle sensor and the steering direction determined by the steering direction determination means, a highly accurate steering angle can be obtained. Based on the corrected steering angle, vehicle speed, and yaw rate characteristic data obtained in this manner, the zero point calibration means calculates the reference yaw rate, and further compares the yaw rate detected by the yaw rate sensor at that time with the yaw rate difference. It can be calculated to correct the zero point of the yaw rate. Therefore, the zero point calibration (zero point correction) of the yaw rate sensor with high accuracy can be performed by calculating the accurate reference yaw rate from the steering angle and the vehicle speed while the vehicle is running.
In addition, the zero point calibration (zero point correction) of the yaw rate sensor can be completed at an early point of the start of traveling.
請求項7に係る発明は、請求項5又は請求項6に記載の発明の構成に加え、更に、操舵角検出不感帯領域演算手段は、操舵角記憶手段に記憶された左操舵時の操舵角の値の分布の第1の最大値と第1の最小値との第1の中間値、及び右操舵時の操舵角の値の分布の第2の最大値と第2の最小値との第2の中間値の差分を操舵角センサの不感帯領域とすることを特徴とする。 According to a seventh aspect of the invention, in addition to the configuration of the fifth or sixth aspect of the invention, the steering angle detection dead zone calculation means further includes a steering angle at the time of left steering stored in the steering angle storage means. A first intermediate value between a first maximum value and a first minimum value of the value distribution, and a second maximum value and a second minimum value of the distribution of the steering angle value during right steering. The difference between the intermediate values is used as a dead zone region of the steering angle sensor.
請求項7に係る発明によれば、車両が走行を開始してから操舵角記憶手段に記憶された操舵角の値の数が少ない時点でも、操舵角検出不感帯領域演算手段が、操舵角記憶手段に記憶された左操舵時の操舵角の値の分布の第1の最大値及び第1の最小値の第1の中間値と、右操舵時の操舵角の値の分布の第2の最大値及び第2の最小値の第2の中間値との差分を操舵角センサの不感帯領域とするので容易に操舵角センサの不感帯領域が演算できる。その結果、走行開始の早い時点においてヨーレートセンサのゼロ点較正(ゼロ点補正)を完了することができる。 According to the seventh aspect of the present invention, the steering angle detection dead zone region calculating means is the steering angle storage means even when the number of steering angle values stored in the steering angle storage means is small after the vehicle starts traveling. The first maximum value and the first intermediate value of the distribution of the steering angle value at the time of left steering and the second maximum value of the distribution of the value of the steering angle at the time of right steering stored in FIG. Since the difference between the second minimum value and the second intermediate value is the dead zone area of the steering angle sensor, the dead zone area of the steering angle sensor can be easily calculated. As a result, the zero point calibration (zero point correction) of the yaw rate sensor can be completed at an early point of the start of traveling.
請求項8に係る発明は、請求項5又は請求項6に記載の発明の構成に加え、更に、操舵角検出不感帯領域演算手段は、操舵角記憶手段に記憶された左操舵時の操舵角の値の分布の第1の平均値と、右操舵時の操舵角の値の分布の第2の平均値との差分を操舵角センサの不感帯領域とすることを特徴とする。 According to an eighth aspect of the invention, in addition to the configuration of the fifth or sixth aspect of the invention, the steering angle detection dead zone calculation means further includes a steering angle at the time of left steering stored in the steering angle storage means. The difference between the first average value of the distribution of values and the second average value of the distribution of steering angle values during right steering is defined as a dead zone region of the steering angle sensor.
請求項8に係る発明によれば、車両が走行を開始してから操舵角記憶手段に記憶された操舵角の値の数が所定以上の数になり第1の平均値及び第2の平均値の演算が意味のある状態になれば、操舵角検出不感帯領域演算手段は、操舵角記憶手段に記憶された操舵角の値の分布の第1及び第2の平均値を演算し、演算された第1及び第2の平均値の差分を操舵角センサの不感帯領域とする。その結果、操舵角センサの不感帯領域をノイズの影響を抑制して精度良く演算でき、その操舵角センサの不感帯領域を用いて操舵角補正手段が操舵角を補正するので、ゼロ点較正手段において、規範ヨーレートを精度良く演算でき、ヨーレートセンサのゼロ点較正(ゼロ点補正)を精度良く行うことができる。 According to the eighth aspect of the present invention, the number of steering angle values stored in the steering angle storage means after the vehicle starts traveling becomes a predetermined number or more, and the first average value and the second average value. The steering angle detection dead zone calculation means calculates the first and second average values of the distribution of the steering angle values stored in the steering angle storage means, and the calculation is performed. The difference between the first and second average values is defined as a dead zone region of the steering angle sensor. As a result, the dead zone region of the steering angle sensor can be accurately calculated while suppressing the influence of noise, and the steering angle correction unit corrects the steering angle using the dead zone region of the steering angle sensor. The reference yaw rate can be calculated with high accuracy, and the zero point calibration (zero point correction) of the yaw rate sensor can be performed with high accuracy.
請求項9に係る発明は、請求項5又は請求項6に記載の発明の構成に加え、更に、操舵角検出不感帯領域演算手段は、操舵角記憶手段に記憶された左操舵時の操舵角の値の分布の最大頻度値である第1の最大頻度値と、右操舵時の操舵角の値の分布の最大頻度値である第2の最大頻度値との差分を操舵角センサの不感帯領域とすることを特徴とする。 According to the ninth aspect of the present invention, in addition to the configuration of the fifth aspect of the present invention, the steering angle detection dead zone region calculating means further includes a steering angle at the time of left steering stored in the steering angle storage means. The difference between the first maximum frequency value, which is the maximum frequency value of the value distribution, and the second maximum frequency value, which is the maximum frequency value of the steering angle value distribution during right steering, is defined as the dead zone region of the steering angle sensor. It is characterized by doing.
請求項9に係る発明によれば、車両が走行を開始してから操舵角記憶手段に記憶された操舵角の値の数が所定以上の数になり第1の最大頻度値及び第2の最大頻度値の演算が意味のある状態になれば、操舵角検出不感帯領域演算手段は、操舵角記憶手段に記憶された操舵角の値の分布の第1及び第2の最大頻度値を演算し、演算された第1及び第2の最大頻度値の差分を操舵角センサの不感帯領域とする。その結果、操舵角センサの不感帯領域をノイズの影響を抑制して精度良く演算でき、その操舵角センサの不感帯領域を用いて操舵角補正手段が操舵角を補正するので、ゼロ点較正手段において、規範ヨーレートを精度良く演算でき、ヨーレートセンサのゼロ点較正(ゼロ点補正)を精度良く行うことができる。 According to the ninth aspect of the present invention, the number of steering angle values stored in the steering angle storage means after the vehicle starts traveling becomes a predetermined number or more, and the first maximum frequency value and the second maximum value. If the calculation of the frequency value becomes a meaningful state, the steering angle detection dead zone region calculating means calculates the first and second maximum frequency values of the distribution of the steering angle value stored in the steering angle storage means, A difference between the calculated first and second maximum frequency values is set as a dead zone region of the steering angle sensor. As a result, the dead zone region of the steering angle sensor can be accurately calculated while suppressing the influence of noise, and the steering angle correction unit corrects the steering angle using the dead zone region of the steering angle sensor. The reference yaw rate can be calculated with high accuracy, and the zero point calibration (zero point correction) of the yaw rate sensor can be performed with high accuracy.
本発明によれば、車両の停車状態でのヨーレートセンサのゼロ点の較正をする必要がなく、車両の走行状態における規範ヨーレート較正法だけでヨーレートセンサのゼロ点の較正ができるヨーレート較正装置を提供することができる。 According to the present invention, there is provided a yaw rate calibration device capable of calibrating the zero point of the yaw rate sensor only by the reference yaw rate calibration method in the running state of the vehicle without the need to calibrate the zero point of the yaw rate sensor when the vehicle is stopped. can do.
《第1の実施形態》
以下に、本発明の第1の実施形態に係る車両用ホイールについて図1から図12を参照しながら詳細に説明する。
図1は、ヨーレート較正装置の機能構成ブロック図である。図2は、操舵角−ヨーレート特性データの説明図である。
<< First Embodiment >>
Hereinafter, a vehicle wheel according to a first embodiment of the present invention will be described in detail with reference to FIGS. 1 to 12.
FIG. 1 is a functional block diagram of the yaw rate calibration apparatus. FIG. 2 is an explanatory diagram of steering angle-yaw rate characteristic data.
ヨーレート較正装置100Aは、図1に示すようにCPU(Central Processing Unit)101、RAM(Random Access Memory)103、ROM(Read Only Memory)104、入出力インタフェース回路105、それらを接続するバス102などを備えるマイクロコンピュータ及び図示しない周辺回路などから構成され、ROM104に格納されたプログラム104aをCPU101が実行し、ヨーレートセンサSYのゼロ点補正(ゼロ点較正)を行う。
As shown in FIG. 1, a yaw rate calibration apparatus 100A includes a central processing unit (CPU) 101, a random access memory (RAM) 103, a read only memory (ROM) 104, an input /
ヨーレート較正装置100Aの入出力インタフェース回路105には、車両の各車輪に設けられた4つの車輪速センサSVWからの各車輪速VWを示す信号、前後加速度センサSαXからの前後加速度αXを示す信号、操向ハンドル(図示せず)の回転角である操舵角θHを検出する操舵角センサSHAからの検出された操舵角θHを示す信号、及び車両のヨーレート(旋回率)γを検出するヨーレートセンサSYからのヨーレートγを示す信号が入力される。また、入出力インタフェース回路105は、図示しない通信部を有し、例えば、CAN(Controller Area Network)通信を介して、電動パワーステアリング制御装置200及び車両運動安定化制御装置300にゼロ点補正されたヨーレートである補正ヨーレートγCを出力する。
The yaw rate calibration apparatus 100A
ちなみに、本実施形態では、操舵角θHの値は、中立点より左側の操舵角を正(+)、中立点より右側の操舵角を負(−)と定義し、ヨーレートγも左旋回率を正(+)、右旋回率を負(−)と定義する。 Incidentally, in this embodiment, the value of the steering angle θ H is defined as a positive (+) steering angle to the left of the neutral point and a negative (−) steering angle to the right of the neutral point, and the yaw rate γ is also defined as the left turn rate. Is defined as positive (+) and the right turn rate is defined as negative (-).
CPU101は、ROM104に格納されるプログラム104aを実行することによって以下の機能部の機能を実行する。ちなみに、ROM(ヨーレート特性データの記憶手段)104は予め、車両特性として実験的に又はシミュレーション計算で得られた操舵角−ヨーレート特性データ104bを格納している。
前記したプログラム104aは、機能構成ブロックとして車速演算部(車速検出手段)11、直進状態判定部12A、操舵角記憶部(操舵角記憶手段、直進状態操舵角演算手段)13A、操舵角検出不感帯領域演算部(舵角検出不感帯領域演算手段)14A、操舵方向判定部(操舵方向判定手段)15、操舵角補正部(操舵角補正手段)16、ヨーレートオフセット量演算部(ゼロ点較正手段)17、ヨーレートゼロ点補正部(ゼロ点較正手段)18、操舵角速度演算部19などを含んで構成されている。
ここで、直進状態判定部12Aは、特許請求の範囲の請求項1に記載の「直進状態判定手段」に対応する。
The
The above-described
Here, the straight-ahead
なお、図1においては、CPU101がプログラム104bを実行する際の機能ブロックの車速演算部11に車輪速センサSVWからの各車輪速VWが入力されるように表示してある。同様に前後加速度センサSαXからの前後加速度αXが直進状態判定部12A及びヨーレートオフセット量演算部17に入力されるように表示してある。また、操舵角センサSHAからの操舵角θHが操舵角記憶部13A、操舵方向判定部15、操舵角補正部16、操舵角速度演算部19に入力されるように表示してある。更に、ヨーレートセンサSYからのヨーレートγが直進状態判定部12A、ヨーレートオフセット量演算部17及びヨーレートゼロ点補正部18に入力されるように表示してある。
In FIG. 1, the wheel speed V W from the wheel speed sensor S VW is input to the vehicle
ちなみに、図1において( )内に示した符号12B,13B,14B,100B、操舵角速度演算部19から直進状態判定部12Bへの破線矢印、破線枠で示した記憶エリア13b、及びヨーレートγの破線矢印による操舵角記憶部13Bへの入力は、第2の実施形態に係るヨーレート較正装置100Bに対応している。
Incidentally,
(車速演算部11)
車速演算部11は、各車輪速センサSVWからの車輪速VWを示す信号を読み込み、車両の車速VSを算出し、直進状態判定部12A及びヨーレートオフセット量演算部17に出力する。
(Vehicle speed calculation unit 11)
The vehicle
(直進状態判定部)
直進状態判定部12Aは、以下に示す直進状態判定条件Xを満たしているか否かをチェックして、直進状態判定条件Xを満たしている場合は、直進状態判定条件Xを満足している信号を操舵角記憶部13Aに出力して、操舵角記憶部13Aにそのとき入力されている操舵角θHの値(操舵角センサ値)を記憶させる。
(Straight-run state determination unit)
The straight traveling
(直進状態判定条件X)
前記した直進状態判定条件Xとは、例えば、前記(1)〜(3)の条件を全て満たしているときに車両が直進状態判定条件Xを満たしているとする。
(1)前後加速度センサSαXで検出された前後加速度αXの絶対値が、0.05G未満
(2)ヨーレートセンサSYで検出されたヨーレートの絶対値が、0.5deg/sec未満
(3)車速演算部11からの車速VSが所定値以上、例えば、30km/hr以上での前進走行
(Straight running condition determination condition X)
The straight-running state determination condition X is, for example, that the vehicle satisfies the straight-running state determination condition X when all the conditions (1) to (3) are satisfied.
(1) The absolute value of the longitudinal acceleration α X detected by the longitudinal acceleration sensor Sα X is less than 0.05 G. (2) The absolute value of the yaw rate detected by the yaw rate sensor S Y is less than 0.5 deg / sec (3 ) Forward traveling when the vehicle speed VS from the vehicle
(操舵角記憶部13A)
操舵角記憶部13Aは、記憶エリア13a(操舵角記憶手段)を有しており、車両のイグニッションスイッチ(以下「IG−SW」と略称する)のオン以後、直進状態判定部112Aからの直進状態判定条件Xを満足している信号を受信したとき、そのとき入力されている操舵角θHの値(操舵角センサ値)を記憶エリア13aに記憶させる。
ちなみに、記憶エリア13aは、具体的にはRAM103の中のプログラム104aによって指定された特定の記憶領域である。
(Steering
The steering
Incidentally, the
なお、直進状態判定部12Aからの直進状態判定条件Xを満足している信号を受信したとき、そのとき入力されている操舵角θHの値(操舵角センサ値)を記憶エリア13aに記憶させるとしたが、それに限定されるものではなく、図2に示した操舵角−ヨーレート特性データ104bを準用して、ヨーレートが発生している分だけ操舵角θHの値を補正して、ヨーレートがゼロの状態の操舵角θHの値に換算した操舵角センサ値を記憶しても良い。
図2において、横軸は後記する不感帯領域の補正を行った後の補正された操舵角θCHが正値の場合を示し、縦軸はその場合の規範ヨーレートγ*を示しているが、補正された操舵角θCHが負値の場合は、図2の原点を通過してそのまま直線が補正された操舵角θCHが負値側及びに規範ヨーレートγ*の負値側に延びた操舵角−ヨーレート特性データとなる。
When a signal satisfying the straight-running state determination condition X is received from the straight-running
In FIG. 2, the horizontal axis indicates the case where the corrected steering angle θ CH after correction of the dead zone described later is a positive value, and the vertical axis indicates the reference yaw rate γ * in that case. If the steering angle theta CH is a negative value, the steering angle steering angle theta CH linearity is corrected as it passes through the origin in Figure 2 is extended to a negative value side of the negative value side and the reference yaw rate gamma * -Yaw rate characteristic data.
前記した直進状態判定条件Xを満たしたときに、図2の操舵角−ヨーレート特性データ104bを準用する。つまり、図2において補正された操舵角θCHの代わりに操舵角θHと車速VSに基づいて、直線の傾きである操舵定常ゲインの値を予め求めておく。ヨーレートセンサSYからのヨーレートγの値と車速VSの値が分かっていれば、次式(1)によって前記したように予め求められた操舵定常ゲインの値からヨーレートγがゼロに相当する操舵角θHの値が算出できる。
(ヨーレートがゼロに相当する操舵角θHの値)=
(操舵角値θHの値)−(ヨーレートγの値)/(操舵定常ゲインの値)
・・・・・・・・(1)
その場合、図1においては表示されていないが、操舵角記憶部13Aにはヨーレートγ、車速VSが入力されている。
When the straight traveling state determination condition X is satisfied, the steering angle-yaw rate
(Value of steering angle θ H corresponding to yaw rate of zero) =
(Steering angle value θ H value) − (yaw rate γ value) / (steering steady gain value)
(1)
In this case, although not displayed in FIG. 1, the yaw rate γ and the vehicle speed VS are input to the steering
なお、操舵角記憶部13Aが記憶エリア13aに記憶した操舵角センサ値は、IG−SWがオフになるとクリアされる。
The steering angle sensor value stored in the
(操舵角検出不感帯領域演算部14A)
次に、操舵角記憶部13Aにおいて記憶エリア13aに記憶された操舵角センサ値を用いて操舵角θHの不感帯領域を演算する方法について説明する。図3は、第1の実施形態のヨーレート較正装置における操舵角記憶部に記憶された操舵角θHの値の分布図である。
操舵角検出不感帯領域演算部14Aは、操舵角記憶部13Aの記憶エリア13aに記憶された操舵角センサ値を読み出して、操舵角センサSHAと操向ハンドルとの間の歯車機構のガタによる不感帯領域の演算を行う。操舵角検出不感帯領域演算部14Aは、第1の実施形態のヨーレート較正装置100Aにおける操舵角記憶部13Aに記憶された操舵角θHの値の分布図(図3参照)に示すように、操舵角記憶部13Aの記憶エリア13aに記憶された操舵角センサ値の数に応じて、その数が所定値未満、例えば、50個未満のときは、最小値Aと最大値Bとを検索して、その差分の半値を不感帯領域の1/2幅θHdeadとして演算する。
そして、記憶エリア13aに記憶された操舵角センサ値の数が所定値以上、例えば、50個以上のときは、図3に示すように横軸に記憶された操舵角θH(操舵角センサ値)、縦軸を発生頻度とした正規分布を仮定し、標準偏差σの所定倍数、例えば、2倍の2σを不感帯領域の1/2幅θHdeadとして演算して設定する。
なお、不感帯領域の1/2幅θHdeadを2σとしたが、それに限定されるものではなく、所定倍数として2.0以外の数値であっても良い。
演算された不感帯領域の1/2幅θHdeadは、操舵角補正部16に入力される。
(Steering angle detection dead zone
Next, a method of calculating the dead zone region of the steering angle θ H using the steering angle sensor value stored in the
The steering angle detection dead
When the number of steering angle sensor values stored in the
Although the half width θ Hdead of the dead zone region is 2σ , the present invention is not limited to this, and the predetermined multiple may be a numerical value other than 2.0.
The calculated ½ width θ Hdead of the dead zone region is input to the steering
(操舵角速度演算部19)
操舵角速度演算部19は、操舵角θHを時間微分して操舵角速度ωHを算出して、操舵方向判定部15とヨーレートオフセット量演算部17に入力する。
(Steering angular velocity calculation unit 19)
The steering angular
(操舵方向判定部15)
操舵方向判定部15は、操舵角θHと操舵角速度ωHに基づいて、左操舵か右操舵かの操舵方向を判定し、操舵角補正部16にその結果を出力する。
操舵方向判定は、原則的に操舵角θHが正(+)の場合は左操舵、操舵角θHが負(−)の場合は右操舵と判定するが、後記する図9の説明図に示すように操舵角速度の符号が正(+)のときは左操舵と優先的に判定し、操舵角速度が負(−)の場合は右操舵と優先的に判定する。この詳細な操舵方向の判定方法については、後記する図9の説明において具体的に説明する。
操舵角センサSHAが、操舵角θHの値がゼロであることを示している場合は、必ずしも正確に中立状態(実操舵角がゼロ)であることを意味せず、中立状態近傍で左右の不感帯領域にいる場合も含むので、操舵方向判定部15は、操舵方向判定できずの信号を操舵角補正部16に出力し、左操舵、右操舵とそれぞれ判定したときはそれに対応する信号を操舵角補正部16に出力する。
(Steering direction determination unit 15)
The steering
In principle, the steering direction is determined to be left steering when the steering angle θ H is positive (+) and right steering when the steering angle θ H is negative (−). As shown, when the sign of the steering angular velocity is positive (+), the left steering is preferentially determined, and when the steering angular velocity is negative (-), the right steering is preferentially determined. This detailed steering direction determination method will be specifically described in the description of FIG. 9 to be described later.
When the steering angle sensor S HA indicates that the value of the steering angle θ H is zero, it does not necessarily mean that the steering angle sensor S HA is in the neutral state (the actual steering angle is zero), and the right and left in the vicinity of the neutral state. Therefore, the steering
(操舵角補正部16)
操舵角補正部16は、操舵方向判定部15からの操舵方向判定の結果に基づいて、そのとき読み込んだ操舵角θHを、操舵角検出不感帯領域演算部14Aから入力された最新の不感帯領域の1/2幅θHdeadで補正して、補正された操舵角θCHをヨーレートオフセット量演算部17に出力する。
(Steering angle correction unit 16)
Based on the result of the steering direction determination from the steering
(ヨーレートオフセット量演算部17)
ヨーレートオフセット量演算部17は、操舵角補正部16から入力された補正された操舵角θCHと車速演算部11から入力された車速VSとに基づき操舵角−ヨーレート特性データ104bを参照して、規範ヨーレートγ*を演算する(図2参照)。更にヨーレートセンサSYから入力されたヨーレートγと、前記演算された規範ヨーレートγ*をローパスフィルタ処理してノイズを除去する。このローパスフィルタ処理されたヨーレートγ及び規範ヨーレートγ*を、以下では、フィルタードヨーレートγ及びフィルタード規範ヨーレートγ*を意味して、単に「ヨーレートγf」及び「規範ヨーレートγ* f」と記載する。
その後、ヨーレートオフセット量演算部17は、前後加速度センサSαXから入力された前後加速度αXと操舵角速度演算部19から入力された操舵角速度ωHとにもとづいて、車両が所定の安定走行条件Yを満たしているか否かを判定し、所定の安定走行条件Yを満たしていると判定した場合に、ヨーレートオフセット量Δγ(=γf−γ* f)を演算して、タイマtの示す時間とともにヨーレートゼロ点補正部18に出力する。所定の安定走行条件Yを満たしていないと判定した場合には、ヨーレートオフセット量Δγ及びタイマtの示す時間はヨーレートゼロ点補正部18に出力されない。
(Yaw rate offset amount calculation unit 17)
The yaw rate offset amount calculation unit 17 refers to the steering angle-yaw rate
Thereafter, the yaw rate offset amount calculation unit 17 determines that the vehicle is in a predetermined stable running condition Y based on the longitudinal acceleration α X input from the longitudinal acceleration sensor Sα X and the steering angular velocity ω H input from the steering angular
(車両の所定の安定走行条件Y)
前記した車両の所定の安定走行条件Yは、例えば、下記(1),(2)の両方が満たされているときである。
(1)前後加速度センサSαXで検出された前後加速度αXの絶対値が、0.05G未満
(2)操舵角速度ωHの絶対値が、10deg/sec未満
操舵角θHが変化していない場合は、操舵角θHの実際の変化が操舵角センサSHAの不感帯によって出力されていない可能性がある。そこで、確実に不感帯の全幅(2・θHdead)の一方の端に詰められた(機械的な表現では当接した)状態であるときにヨーレートγをゼロ点補正するためには、安定走行条件Yの(2)は、操舵角速度ωHの絶対値が、5〜10deg/sec未満であることが好ましい。
(Predetermined stable driving condition Y of the vehicle)
The predetermined stable running condition Y of the vehicle described above is, for example, when both of the following (1) and (2) are satisfied.
(1) The absolute value of the longitudinal acceleration α X detected by the longitudinal acceleration sensor Sα X is less than 0.05 G. (2) The absolute value of the steering angular velocity ω H is less than 10 deg / sec. The steering angle θ H does not change. In this case, there is a possibility that the actual change of the steering angle θ H is not output by the dead zone of the steering angle sensor S HA . Therefore, in order to correct the zero point of the yaw rate γ when it is in a state where it is tightly packed at one end of the full width of the dead zone (2 · θ Hdead ) (in mechanical expression), stable running conditions In Y (2), the absolute value of the steering angular velocity ω H is preferably less than 5 to 10 deg / sec.
(ヨーレートゼロ点補正部18)
ヨーレートゼロ点補正部18は、ヨーレートオフセット量演算部17から入力されたヨーレートオフセット量Δγ及びタイマtの示す時間を記憶エリア(ゼロ点較正手段)18aに時系列的に記憶蓄積する。ちなみに、記憶エリア18aは、具体的にはRAM103のプログラム104aによって指定された特定の記憶エリアである。
(Yaw rate zero point correction unit 18)
The yaw rate zero point correction unit 18 stores and accumulates the yaw rate offset amount Δγ input from the yaw rate offset amount calculation unit 17 and the time indicated by the timer t in the storage area (zero point calibration means) 18a in time series. Incidentally, the
ヨーレートゼロ点補正部18は、ヨーレートセンサSYから入力されたヨーレートγに対して、記憶エリア18aに記憶されたヨーレートオフセット量Δγの平均値〈Δγ〉を用いて、次式(2)のようにゼロ点補正をして補正されたヨーレート(補正ヨーレート)γCを入出力インタフェース回路105、CAN通信などを介して、例えば、電動パワーステアリング制御装置200や車両運動安定化制御装置300に出力する。
γC=γ−〈Δγ〉 ・・・・・・・・・・・・・・・・・・・・(2)
Yoretozero point correcting unit 18, with respect to the yaw rate sensor S Y yaw input from the gamma, the yaw rate offset amount average value of [Delta] [gamma], which is stored in the
γ C = γ− <Δγ> (2)
なお、ヨーレートゼロ点補正部18は、タイマtが示す現在の時間を基準にして、記憶エリア18aに記憶されたヨーレートオフセット量Δγのデータのうち所定の時間T、例えば、30分を超えて遡って記憶された古いヨーレートオフセット量Δγのデータを記憶エリア18aから削除(記憶データから削除)し、タイマtの示す現在の時間から30分以内に記憶されたヨーレートオフセット量Δγの平均値〈Δγ〉を用いるようにする。
The yaw rate zero point correction unit 18 goes back beyond a predetermined time T, for example, 30 minutes, among the data of the yaw rate offset amount Δγ stored in the
これにより、車両の走行中にヨーレートセンサSYの環境温度が変化して、ヨーレートセンサSYから出力されるヨーレートγのゼロ点が変化してもそれに追随してヨーレートオフセット量Δγの平均値〈Δγ〉が更新され、実質的に平均値〈Δγ〉は時間的な移動平均値となる。 As a result, even if the environmental temperature of the yaw rate sensor S Y changes while the vehicle is traveling and the zero point of the yaw rate γ output from the yaw rate sensor S Y changes, the average value of the yaw rate offset amount Δγ follows the change. Δγ> is updated, and the average value <Δγ> is substantially a temporal moving average value.
電動パワーステアリング制御装置200では、補正ヨーレートγCを用いてより正確なアクティブ操舵制御に用いることができる。また、車両運動安定化制御装置300では、補正ヨーレートγCを用いてより正確なヨーモーメント制御などに用いることができる。 The electric power steering control apparatus 200 can be used for more accurate active steering control using the corrected yaw rate γ C. Further, the vehicle motion stabilization control device 300 can be used for more accurate yaw moment control using the corrected yaw rate γ C.
(全体フローチャート)
次に、図4を参照しながらヨーレートのゼロ点補正の全体フローチャートについて説明する。図4は、ヨーレート較正装置におけるヨーレートのゼロ点較正の処理の流れを示す全体フローチャートである。
ステップS01では、IG−SWがオン(ON)されるとCPU101が起動し、タイマtをスタートさせる(「タイマtスタート」)。
そして、車速演算部11は各車輪の車輪速VWから車速VSを演算し、直進状態判定部12A及びヨーレートオフセット量演算部17へ一定の所定の周期で出力する。また、操舵角速度演算部19は、操舵角θHを時間微分して操舵角速度ωHを操舵方向判定部15及びヨーレートオフセット量演算部17へ前記した一定の所定の周期で出力する。
更に、操舵方向判定部15は、操舵角θH及び操舵角速度ωHにもとづいて左方向操舵か右方向操舵かの操舵方向の判定を行い、その判定結果を、操舵方向を判定できない場合も含めて、操舵角補正部16へ前記した一定の所定の周期で出力する。
(Overall flow chart)
Next, an overall flowchart of the zero point correction of the yaw rate will be described with reference to FIG. FIG. 4 is an overall flowchart showing a flow of processing for zero point calibration of the yaw rate in the yaw rate calibration apparatus.
In step S01, when the IG-SW is turned on (ON), the
The vehicle
Further, the steering
ステップS02Aでは、直進状態判定部12A及び操舵角記憶部13Aにおいて処理され、前記した直進状態判定条件Xが満足されたときの操舵角センサ値が記憶エリア13aに記憶される(「操舵角センサ値の記憶」)。このステップS02Aの詳細なフローチャートは、後記する図5の詳細フローチャートで説明する。
ステップS03Aでは、操舵角検出不感帯領域演算部14Aにおいて、記憶エリア13aに記憶された操舵角センサ値を読み出して操舵角センサSHAの不感帯領域演算を行い、操舵角補正部16に出力する(「操舵角センサの不感帯領域演算」)。このステップS03Aの詳細なフローチャートは、後記する図6の詳細フローチャートで説明する。
ステップS04では、操舵角補正部16が、現在の操舵角θHを読み込んで補正し、補正された操舵角θCHをヨーレートオフセット量演算部17に出力する(「操舵角の補正」)。このステップS04の詳細なフローチャートは、後記する図7の詳細フローチャートで説明する。
In step S02A, the steering angle sensor value is processed in the straight traveling
In step S03A, the steering angle detection dead
In step S04, the steering
ステップS05では、ヨーレートオフセット量演算部17が、現在のヨーレートγを読み込んで、車両の所定の安定走行条件Yを満たしている場合に、ヨーレートオフセット量Δγを演算して、ヨーレートゼロ点補正部18に出力する(「ヨーレートのオフセット量の演算」)。このステップS05の詳細なフローチャートは、後記する図10の詳細フローチャートで説明する。
ステップS06では、ヨーレートゼロ点補正部18が、ヨーレートオフセット量演算部17からのヨーレートオフセット量Δγを時系列的に記憶エリア18aへ蓄積記憶して、ヨーレートオフセット量Δγの平均値〈Δγ〉を演算して、現在のヨーレートγを読み込んで、それを平均値〈Δγ〉で補正し、補正されたヨーレートγCを出力する(「ヨーレートのゼロ点補正」)。このステップS06の詳細なフローチャートは、後記する図11の詳細フローチャートで説明する。
In step S05, when the yaw rate offset amount calculation unit 17 reads the current yaw rate γ and satisfies the predetermined stable running condition Y of the vehicle, the yaw rate offset amount Δγ is calculated and the yaw rate zero point correction unit 18 is calculated. (“Calculation of yaw rate offset amount”). A detailed flowchart of step S05 will be described later with reference to a detailed flowchart of FIG.
In step S06, the yaw rate zero point correction unit 18 accumulates and stores the yaw rate offset amount Δγ from the yaw rate offset amount calculation unit 17 in the
ステップS07では、IG−SWがオフ(OFF)されたか否かをチェックし、IG−SWがオフ(OFF)された場合(Yes)は、ステップS08に進み、タイマtをリセットし、ヨーレートゼロ点補正の処理を終了する。ステップS07でNoの場合は、ステップS02Aに戻り、繰り返し処理を行う。 In step S07, it is checked whether or not the IG-SW is turned off. If the IG-SW is turned off (Yes), the process proceeds to step S08, the timer t is reset, and the yaw rate zero point is set. The correction process ends. In the case of No in step S07, the process returns to step S02A and repeats processing.
(ステップS02Aの詳細フローチャート)
次に、図5を参照しながら、図4の全体フローチャートにおけるステップS02Aについて説明する。図5は、図1の直進状態判定部と操舵角記憶部における直進状態における操舵角センサ値の記憶制御の流れを示す詳細フローチャートである。
ステップS21では、操舵角記憶部13Aは、CPU101が起動したときに、記憶エリア13aに記憶された操作角センサ値の数Nを0(ゼロ)にリセットする(「N=0」)。
(Detailed flowchart of step S02A)
Next, step S02A in the overall flowchart of FIG. 4 will be described with reference to FIG. FIG. 5 is a detailed flowchart showing the flow of storage control of the steering angle sensor value in the straight traveling state in the straight traveling state determination unit and the steering angle storage unit of FIG.
In step S21, when the
ステップS22では、直進状態判定部12Aは、車速VS、前後加速度αX、ヨーレートγを読み込んで、車両が直進状態判定条件Xを満足した直進の走行状態か否かをチェックする。直進状態判定条件Xを満足した場合(Yes)は、直進状態判定部12Aは、直進状態判定条件Xを満足したことを示す信号を操舵角記憶部13Aに入力し、ステップS23へ進み、直進状態判定条件Xを満足していない場合(No)は、ステップS25へ進む。
In step S22, the straight traveling
ステップS23では、操舵角記憶部13Aは、操舵角センサSHAからの操舵角θHの値(操舵角センサ値)を読み込んで記憶エリア13aに記憶する。ここで、ステップS23が、特許請求の範囲に記載の「操舵角記憶手段」に対応する。
In step S23, the steering
なお、ステップS23では、操舵角記憶部13Aは、操舵角センサ値として、ヨーレートγの値と車速VSの値が分かっているので、図2の操舵角−ヨーレート特性データ104bを準用し、前記した式(1)の予め求められた操舵定常ゲインの値によってヨーレートセンサSYで検出されたヨーレートがゼロに相当する操舵角θHの値(直進状態模擬操舵角)が算出できる。そして、式(1)によってヨーレートγがゼロに相当する操作角θHを演算して記憶エリア13aに記憶しても良い。その場合、ステップS23が、特許請求の範囲に記載の「直進状態操舵角演算手段」及び「操舵角記憶手段」に対応する。また、式(1)によってヨーレートγがゼロに相当する操作角θHを演算することが、特許請求の範囲に記載の「直進状態判定手段により直進走行状態と判定された際の操舵角センサにより検出された操舵角を、車速検出手段により検出された車速と、ヨーレートセンサにより検出されたヨーレートと、ヨーレート特性データとに基づいて、前記検出されたヨーレートがゼロの値に対応する直進状態模擬操舵角に補正演算する」に対応する。
In step S23, since the steering
ステップS24では、記憶エリア13aに記憶された操舵角センサ値の数Nを1だけインクレメントする(「N=N+1」)。
なお、記憶エリア13aに記憶された操舵角センサ値の数Nは、例えば、記憶エリア13aの先頭部分のロケーションに書き込み更新され、操舵角検出不感帯領域演算部14Aが読み込み可能になっている。
In step S24, the number N of steering angle sensor values stored in the
The number N of steering angle sensor values stored in the
ステップS25では、操舵角記憶部13Aは、IG−SWがオフ(OFF)されたか否かをチェックする。IG−SWがオフされた場合(Yes)は、記憶された操舵角センサ値をクリアする。ちなみに、記憶エリア13aはRAM103の所定の記憶エリアであり、ヨーレート較正装置100Aが電源オフになれば自動的に記憶は消去される。ステップS25でNoの場合は、ステップS22に戻り、操舵角センサ値の記憶の処理を繰り返す。
In step S25, the steering
(ステップS03Aの詳細フローチャート)
次に、図6を参照しながら、図4の全体フローチャートにおけるステップS03Aについて説明する。図6は、図1の操舵角検出不感帯領域演算部における不感帯領域の演算処理の制御の流れを示す詳細フローチャートである。この処理は、操舵角検出不感帯領域演算部14Aにおいて行われる。
ステップS31では、記憶エリア13aに記憶された操舵角センサ値の数Nが所定数以上か否か、例えば、50以上か否かをチェックする(「N≧50?」)。Nが所定数以上の場合(Yes)は、ステップS34へ進み、そうでない場合(No)はステップS32へ進む。
ステップS32では、記憶エリア13aに記憶された操舵角センサ値の中から最大値θHmax、最小値θHminを検索する。ステップS33では、不感帯領域の1/2幅θHdead{=(θHmax−θHmin)/2}を演算する。その後ステップS36へ進む。
(Detailed flowchart of step S03A)
Next, step S03A in the overall flowchart of FIG. 4 will be described with reference to FIG. FIG. 6 is a detailed flowchart showing the flow of control of dead zone calculation processing in the steering angle detection dead zone calculation unit of FIG. This process is performed in the steering angle detection dead
In step S31, it is checked whether or not the number N of steering angle sensor values stored in the
In step S32, the maximum value θ Hmax and the minimum value θ Hmin are searched from the steering angle sensor values stored in the
ステップS31からYesでステップS34へ進むと、記憶エリア13aに記憶された操舵角センサ値の分布は、正規分布であると仮定し、標準偏差σを演算して、それに所定の倍数、例えば、2.0の定数を乗算して2σの値を演算する(「正規分布を仮定し、2σを演算する」)。ステップS35では、不感帯領域の1/2幅θHdeadを設定する(θHdead=2σ)。その後ステップS36へ進む。
When the process proceeds from step S31 to Yes in step S34, it is assumed that the distribution of the steering angle sensor values stored in the
ステップS36では、ステップS33又はステップS35で得られた操舵角センサSHAの不感帯領域の1/2幅を操舵角補正部16に出力する。これで全体フローチャートのステップS03Aの操舵角センサの不感帯領域演算の処理を終わり、全体フローチャートのステップS04へ進む。
At step S36, and outputs the half width of the dead zone of the resulting steering angle sensor S HA in step S33 or step S35 in the steering
(ステップS04の詳細フローチャート)
次に、図7から図9を参照しながら、図4の全体フローチャートにおけるステップS04について説明する。図7は、図1の操舵角補正部における操舵角センサで検出された操舵角を補正する制御の流れを示す詳細フローチャートである。この処理は、操舵角補正部16において行われる。
(Detailed flowchart of step S04)
Next, step S04 in the overall flowchart of FIG. 4 will be described with reference to FIGS. FIG. 7 is a detailed flowchart showing a flow of control for correcting the steering angle detected by the steering angle sensor in the steering angle correction unit of FIG. This process is performed in the steering
ステップS41では、操舵方向判定部15から操舵角θHと操舵角速度ωHに基づいた操舵方向の判定ができたか否かの信号をチェックする。操舵方向の判定ができなかった場合(No)は、操舵角補正をしないで終了する。この場合は、例えば、操舵角センサSHAが操舵角θHの値としてゼロの値を示し、操舵角速度ωHもゼロの値を示しているときである。このとき、ヨーレートオフセット量演算部17には何等信号は出力されない。操舵方向判定部15から左操舵又は右操舵に対応する信号を入力された場合は、操舵方向の判定ができた場合(Yes)であり、ステップS42へ進み、操舵方向判定部15で判定された操舵方向は左か右かをチェックする。
In step S41, a signal indicating whether or not the steering direction is determined based on the steering angle θ H and the steering angular velocity ω H from the steering
ステップS42で操舵方向が左の場合は、ステップS43へ進み、補正された操舵角θCHは、操舵角θHに不感帯領域の1/2幅θHdeadを加算した結果とする(「θCH=θH+θHdead」)。ステップS42で操舵方向が右の場合は、ステップS44へ進み、補正された操舵角θCHは、操舵角センサSHAからの生値である操舵角θHから不感帯領域の1/2幅θHdeadを減算した結果とする(「θCH=θH−θHdead」)。
ステップS43又はステップS44の後は、ステップS45へ進む。
ステップS45では、ヨーレートオフセット量演算部17へ補正された操舵角θCHを出力する。これで全体フローチャートのステップS04の操舵角の補正の処理を終わり、全体フローチャートのステップS05へ進む。
When the steering direction is the left in step S42, the process proceeds to step S43, and the corrected steering angle θ CH is the result of adding the ½ width θ Hdead of the dead zone to the steering angle θ H (“θ CH = θ H + θ Hdead ”). When the steering direction is the right in step S42, the process proceeds to step S44, and the corrected steering angle θ CH is changed from the steering angle θ H which is a raw value from the steering angle sensor S HA to the ½ width θ Hdead of the dead zone. (“Θ CH = θ H −θ Hdead ”).
After step S43 or step S44, the process proceeds to step S45.
In step S45, the corrected steering angle θ CH is output to the yaw rate offset amount calculation unit 17. This completes the process of correcting the steering angle in step S04 of the overall flowchart, and proceeds to step S05 of the overall flowchart.
図8は、実際の操舵角と操舵角センサが検出した操舵角θHの関係の説明図、図9は、操舵角θHの補正を説明する図である。
図8に実線で示した操舵角センサSHAが出力する操舵角θHの値の時間推移は、実際の操舵角θHrealの値の時間推移に対して、不感帯領域が存在するため、例えば中立状態から左操舵を開始してもその立ち上がりはガタ分(ほぼ不感帯領域の1/2幅θHdead)だけ遅れており、左操舵状態で一定の操舵角θHrealを維持して右操舵を開始しても、やはりガタ分だけこの場合は、ほぼ不感帯領域の幅2・θHdead分だけ遅れて立ち下がる。
FIG. 8 is a diagram for explaining the relationship between the actual steering angle and the steering angle θ H detected by the steering angle sensor, and FIG. 9 is a diagram for explaining the correction of the steering angle θ H.
The time transition of the value of the steering angle θ H output from the steering angle sensor S HA indicated by the solid line in FIG. 8 has a dead zone region with respect to the time transition of the actual steering angle θ Hreal value. Even if the left steering is started from the state, the rise is delayed by the backlash (substantially the half width θ Hdead of the dead zone region), and the right steering is started while maintaining the constant steering angle θ Hreal in the left steering state. In this case, however, it falls with a delay of the
そこで、操舵角の補正は、前記したように操舵方向判定部15において判定した操舵方向に応じて、左操舵と判定されたとき、例えば、図9の(a)のA部で示すように、操舵角θHの値が中立から正の方向に変化したとき又は図9の(b)に示すように操舵角速度ωHが正の間、左操舵と判定されて、θCH=θH+θHdeadの左操舵の補正がなされ、その後操舵角θHが正で操舵角速度ωHの値が負にならない間は、左操舵の補正が維持される。これは、操向ハンドルに加わる操舵反力により操舵角センサSHAはガタの一方に(不感帯領域の一方の端に)当接されている状態が継続するからである。
Therefore, when the steering angle is determined to be left steering in accordance with the steering direction determined by the steering
しかし、図9の(a)のB部で示したように正の操舵角θHrealが減少するような右操舵が開始されると操舵角センサSHAはガタの一方(不感帯領域の一方の端)からガタの他方(不感帯領域の他方の端)に当接するまで操舵角θHの変化は開始せず、操舵角θHの減少が開始すると図9の(b)に示すように操舵角速度ωHが負の間、右操舵と判定されて、θCH=θH−θHdeadの補正がなされる。その後操舵角θHが負で操舵角速度ωHの値が正にならない間は、右操舵の補正が維持される。これは、操向ハンドルに加わる操舵反力により操舵角センサSHAはガタの他方に(不感帯領域の他方の端に)当接されている状態が継続するからである。
図9の(a)のC部で示した箇所は、図9の(a)のB部で示した場合の反対操舵であり説明を省略する。
従って、図9の(a)のB部、C部のような場合には、操舵角センサSHAからの生の操舵角θHは、2・θHdead分だけジャンプして補正されることになる。
However, when the right steering is started such that the positive steering angle θ Hreal is reduced as shown in the B part of FIG. 9A, the steering angle sensor S HA has one backlash (one end of the dead zone region). ) To the other side of the play (the other end of the dead zone), the change in the steering angle θ H does not start, and when the steering angle θ H starts to decrease, the steering angular velocity ω as shown in FIG. While H is negative, it is determined that the steering is right, and θ CH = θ H −θ Hdead is corrected. Thereafter, as long as the steering angle θ H is negative and the value of the steering angular velocity ω H does not become positive, the right steering correction is maintained. This is because the state is the steering angle sensor S HA by the steering reaction force applied to the steering handle (the other end of the dead zone) on the other backlash is in contact continues.
The part shown by C part of (a) of FIG. 9 is the opposite steering in the case of B part of (a) of FIG. 9, and description is abbreviate | omitted.
Therefore, in the case of B part and C part in FIG. 9A, the raw steering angle θ H from the steering angle sensor S HA is corrected by jumping by 2 · θ Hdead. Become.
(ステップS05の詳細フローチャート)
次に、図10を参照しながら、図4の全体フローチャートにおけるステップS05について説明する。図10は、図1のヨーレートオフセット量演算部におけるヨーレートオフセット量の演算制御の流れを示す詳細フローチャートである。この処理は、ヨーレートオフセット量演算部17において行われる。
ステップS51では、ステップS45における補正された操舵角θCHの入力を受け、そのときの車速VSを読み取って操舵角−ヨーレート特性データ104b(図2参照)を参照して、規範ヨーレートγ*を演算する(「補正された操舵角θCHと車速VSに基づき、操舵角−ヨーレート特性データを参照して、規範ヨーレートγ*を演算する」)。
ここで、図2では、補正された操舵角θCHが正値の場合で例示してあるが、補正された操舵角θCHが負値の場合は、図2の原点を中心に点対称の直線が補正された操舵角θCHが負値側に延びた操舵角−ヨーレート特性データを用いる。
ステップS52では、ステップS45における補正された操舵角θCHの入力を受け、そのときのヨーレートγを読み込み、ローパスフィルタ処理してヨーレートγfとする(「ヨーレートγをローパスフィルタ処理」)。
ステップS53では、ステップS51で演算された規範ヨーレートγ*をローパスフィルタ処理して規範ヨーレートγ* fとする(「規範ヨーレートγ*をローパスフィルタ処理」)。
このように、ステップS52、S53でヨーレートγ及び規範ヨーレートγ*をローパスフィルタ処理することによってノイズをカットする。
(Detailed flowchart of step S05)
Next, step S05 in the overall flowchart of FIG. 4 will be described with reference to FIG. FIG. 10 is a detailed flowchart showing a flow of calculation control of the yaw rate offset amount in the yaw rate offset amount calculation unit of FIG. This process is performed in the yaw rate offset amount calculation unit 17.
In step S51, the steering angle θ CH corrected in step S45 is input, the vehicle speed VS at that time is read, and the reference yaw rate γ * is calculated with reference to the steering angle-yaw rate
In FIG. 2, but corrected steering angle theta CH is is illustrated in the case of positive value, corrected steering angle theta CH is the case of negative values, the point symmetry around the origin of FIG Steering angle-yaw rate characteristic data in which the steering angle θ CH with the straight line corrected extends to the negative value side is used.
In step S52, the input of the steering angle θ CH corrected in step S45 is received, the yaw rate γ at that time is read, and low-pass filter processing is performed to obtain the yaw rate γ f (“yaw rate γ is low-pass filter processing”).
In step S53, the normative yaw rate γ * calculated in step S51 is low-pass filtered to obtain a normative yaw rate γ * f (“normative yaw rate γ * is low-pass filtered”).
In this way, noise is cut by performing low-pass filter processing on the yaw rate γ and the reference yaw rate γ * in steps S52 and S53.
ステップS54では、前記した車両が所定の安定走行条件Yを満たしているか否かをチェックし、車両が所定の安定走行条件Yを満たしている場合(Yes)は、ステップS55へ進み、ヨーレートオフセット量Δγ(=γf−γ* f)を算出する。そして、ステップS56では、ヨーレートオフセット量Δγの値と、タイマtの示す時間をヨーレートゼロ点補正部18に出力する。
ステップS54において、前記した車両が所定の安定走行条件Yを満たしていない場合(No)は、そのままヨーレートオフセット量Δγの演算をしない。
これで、これで全体フローチャートのステップS05のヨーレートオフセット量の演算の処理を終わり、全体フローチャートのステップS06へ進む。
In step S54, it is checked whether or not the vehicle satisfies the predetermined stable traveling condition Y. If the vehicle satisfies the predetermined stable traveling condition Y (Yes), the process proceeds to step S55, and the yaw rate offset amount is determined. Δγ (= γ f −γ * f ) is calculated. In step S56, the yaw rate offset amount Δγ and the time indicated by the timer t are output to the yaw rate zero point correction unit 18.
In step S54, when the vehicle does not satisfy the predetermined stable running condition Y (No), the yaw rate offset amount Δγ is not calculated as it is.
This completes the calculation of the yaw rate offset amount in step S05 of the overall flowchart, and the process proceeds to step S06 of the overall flowchart.
(ステップS06の詳細フローチャート)
次に、図11、図12を参照しながら、図4の全体フローチャートにおけるステップS06について説明する。図11は、図1のヨーレートゼロ点補正部におけるゼロ点補正の処理の制御の流れを示す詳細フローチャート、図12は、ヨーレートセンサで検出されたヨーレートγを、ヨーレートオフセット量の平均値〈Δγ〉で補正されたヨーレートγCを示す説明図である。この処理は、ヨーレートゼロ点補正部18において行われる。
(Detailed flowchart of step S06)
Next, step S06 in the overall flowchart of FIG. 4 will be described with reference to FIGS. FIG. 11 is a detailed flowchart showing the control flow of the zero point correction process in the yaw rate zero point correction unit of FIG. 1, and FIG. 12 shows the yaw rate γ detected by the yaw rate sensor as an average value <Δγ> of the yaw rate offset amount. It is explanatory drawing which shows the yaw rate (gamma) C correct | amended by. This process is performed in the yaw rate zero point correction unit 18.
ステップS61では、ステップS56において出力されたヨーレートオフセット量Δγの値と、タイマtの示す時間を記憶エリア18aに記憶する。
ステップS62では、タイマtの示す現在の時間から所定の時間T、例えば、30分を超えて遡って記憶された古いヨーレートオフセット量Δγの値とタイマtの示す時間のデータを記憶エリア18aの記憶データから削除する。
ステップS63では記憶エリア18aに記憶されているヨーレートオフセット量Δγの値の平均値〈Δγ〉を演算する。
ステップS64では、現在の読み込んだヨーレートγを平均値〈Δγ〉で補正して、ゼロ点補正されたヨーレートγC(図1では「補正ヨーレートγC」と表示)として出力する(γC=γ−〈Δγ〉)。
In step S61, the value of the yaw rate offset amount Δγ output in step S56 and the time indicated by the timer t are stored in the
In step S62, the value of the old yaw rate offset amount Δγ stored retroactively from the current time indicated by the timer t beyond a predetermined time T, for example, 30 minutes, and the time data indicated by the timer t are stored in the
In step S63, an average value <Δγ> of the values of the yaw rate offset amounts Δγ stored in the
In step S64, the current read yaw rate γ is corrected with the average value <Δγ> and output as a zero-point corrected yaw rate γ C (shown as “corrected yaw rate γ C ” in FIG. 1) (γ C = γ). − <Δγ>).
その結果、図12に示すように時間の推移で変化するヨーレートセンサSY(図2参照)からのヨーレートγを〈Δγ〉だけ補正して、この場合は+側に加算補正されて補正ヨーレートγCが演算された場合である。 As a result, as shown in FIG. 12, the yaw rate γ from the yaw rate sensor S Y (see FIG. 2) that changes with time is corrected by <Δγ>, and in this case, the correction yaw rate γ is corrected by addition to the + side. This is the case when C is calculated.
本実施形態によれば、操舵角補正部16は、操舵角センサSHAに不感帯領域がある場合でも、操舵角センサSHAから出力される操舵角θHの値を、操舵方向判定部15において判定した操舵方向に応じて不感帯領域の1/2幅θHdeadを用いて補正して、より精度の高い補正された操舵角θCHを取得することができる。そして、ヨーレートオフセット量演算部17において、補正された操舵角θCHと車速VSに基づいて精度の良い規範ヨーレートγ*を演算することができる。また、精度の良い規範ヨーレートγ*を得られたときに、ヨーレートセンサSYから出力されたヨーレートγと規範ヨーレートγ*の差分からヨーレートオフセット量Δγが得られ、このヨーレートオフセット量Δγをヨーレートゼロ点補正部18において時系列的に記憶して、所定の時間Tを超えて遡って記憶されたヨーレートオフセット量Δγは自動的に削除する。
According to this embodiment, the steering
この結果、所定の時間Tを超えた古いヨーレートオフセット量Δγは使用しないで、新しい現在から所定の時間T以内のヨーレートオフセット量Δγだけの平均値〈Δγ〉を得て、刻々と得られるヨーレートγを補正した補正ヨーレートγCが出力できる。そして、車両の走行環境の変化によるヨーレートセンサSYの環境温度の変化により出力されるヨーレートγの値の誤差変動に対し、適切にゼロ点補正ができる。 As a result, the old yaw rate offset amount Δγ exceeding the predetermined time T is not used, the average value <Δγ> of the yaw rate offset amount Δγ within the predetermined time T from the new present time is obtained, and the yaw rate γ obtained every moment Can output a corrected yaw rate γ C corrected by. Then, with respect to the error variation of the values of the yaw rate γ to be outputted by a change in environmental temperature of the yaw rate sensor S Y due to a change in the running environment of the vehicle can appropriately zero point correction.
また、操舵角検出不感帯領域演算部14Aは、操舵角記憶部13Aの記憶エリア13aに記憶された操舵角θHの値の数が、所定値、例えば50未満の場合は、不感帯領域の1/2幅θHdeadを、記憶された操舵角θHの最大値と最小値の中間値で決めるので、IG−SWのオンの後、迅速に不感帯領域の1/2幅θHdeadを決定することができる。その結果、ヨーレートセンサSYのゼロ点補正も、IG−SWがオンになってから迅速に開始できる。
また、操舵角記憶部13Aの記憶エリア13aに記憶された操舵角θHの値の数が所定値、例えば、50以上の場合は、標準偏差σの所定倍、例えば、2倍σの値を不感帯領域の1/2幅θHdeadとするので、不感帯領域の1/2幅θHdeadをより正確に決定でき、ヨーレートオフセット量演算部17における規範ヨーレートγ*の演算結果が精度良くでき、ヨーレートセンサSYのゼロ点補正が精度良くできるようになる。
Further, the steering angle detection dead zone
Further, when the number of values of the steering angle θ H stored in the
また、図7の詳細フローチャートに示したように操舵方向判定部15において操舵方向が判定できたときにのみ、ヨーレートオフセット量演算部17へ補正された操舵角θCHを出力する。例えば、操舵角センサSHAが操舵角θHの値としてゼロの値を示し、操舵角速度ωHもゼロの値を示しているときは、操舵方向判定不能として、ヨーレートオフセット量演算部17へ補正された操舵角θCHを出力しないので、ヨーレートオフセット量Δγとして不確かなデータは、ヨーレートオフセット量演算部17で算出されず、記憶エリア18aに記憶蓄積されることもない。その結果、ヨーレートγのゼロ点補正が精度良くできる。
Further, as shown in the detailed flowchart of FIG. 7, the corrected steering angle θ CH is output to the yaw rate offset amount calculation unit 17 only when the steering
なお、本実施形態において、ステップS22において車両が直進状態判定条件Xを満足した直進の走行状態と判定されて、ステップS23において操舵角センサSHAで検出された操舵角θHの値を、ヨーレートγがゼロの値に対応する操舵角θHの値に置き換えて記憶エリア13aに記憶した場合、操舵角検出不感帯領域演部14Aにおいて操舵角センサSHAの不感帯領域をより精度良く演算できる。
In the present embodiment, it is determined that the traveling state of straight vehicle satisfies a straight-running state determination condition X in step S22, the value of the steering angle theta H detected by the steering angle sensor S HA in step S23, the yaw rate If γ is stored in the
《第2の実施形態》
次に、図1、図2、図4、図13から図16を参照しながら本発明の第2の実施形態に係るヨーレート較正装置100Bについて説明する。
本実施形態におけるプログラム104aは、機能構成ブロックとして車速演算部(車速検出手段)11、直進状態判定部12B、操舵角記憶部(操舵角記憶手段、直進状態操舵角演算手段)13B、操舵角検出不感帯領域演算部(操舵角検出不感帯領域演算手段)14B、操舵方向判定部(操舵方向判定手段)15、操舵角補正部(操舵角補正手段)16、ヨーレートオフセット量演算部(ゼロ点較正手段)17、ヨーレートゼロ点補正部(ゼロ点較正手段)18、操舵角速度演算部(操舵角速度検出手段)19などを含んで構成されている。
ここで、直進状態判定部12Bは、特許請求の範囲の請求項5に記載の「直進状態判定手段」に対応する。
<< Second Embodiment >>
Next, a yaw rate calibration apparatus 100B according to a second embodiment of the present invention will be described with reference to FIG. 1, FIG. 2, FIG. 4, and FIG.
The
Here, the straight traveling
第2の実施形態に係るヨーレート較正装置100Bにおける第1の実施形態のヨーレート較正装置100Aからの変更点は、(1)直進状態判定部12Aの代わりに直進状態判定部12Bに、操舵角記憶部13Aの代わりに操舵角記憶部13Bに、操舵角検出不感帯領域演算部14Aの代わりに操舵角検出不感帯領域演算部14Bに変更されることと、(2)操舵角記憶部13Bは、記憶エリア(操舵角記憶手段)13a、13bを有すること、(3)操舵角速度演算部19から操舵角速度ωHが直進状態判定部12Bにも入力されること、(4)操舵方向判定部15の操舵方向判定結果が操舵角記憶部13Bにも入力されること、(5)操舵角記憶部13Bにヨーレートγ、車速VSも入力される点である。ただし、図1では、車速VSの操舵角記憶部13Bへの入力は省略してある。
第2の実施形態において第1の実施形態と同じ構成については同じ符号を付し、重複する説明は省略する。
The changes from the yaw rate calibration device 100A of the first embodiment in the yaw rate calibration device 100B according to the second embodiment are as follows. (1) Instead of the straight travel
In the second embodiment, the same components as those in the first embodiment are denoted by the same reference numerals, and redundant description is omitted.
前記のようなヨーレート較正装置100Bの機能構成ブロックの変更に伴い、図4における全体フローチャートは、第1の実施形態のステップS02AがステップS02Bに、ステップS03AがステップS03Bに、又、ステップS04〜S06それぞれの詳細フローチャートにおいて直進状態判定部12Aは直進状態判定部12Bに、操舵角記憶部13Aは操舵角記憶部13Bに、操舵角検出不感帯領域演算部14Aは操舵角検出不感帯領域演算部14Bに読み替える。また、操舵角記憶部13Bは記憶エリア13a,13b(図1参照)を有しているように読み替える。
In accordance with the change in the functional configuration block of the yaw rate calibration apparatus 100B as described above, the overall flowchart in FIG. 4 shows that step S02A of the first embodiment is changed to step S02B, step S03A is changed to step S03B, and steps S04 to S06. In each detailed flowchart, the straight-ahead
(ステップS02Bの詳細フローチャート)
直進状態判定部12B、操舵角記憶部13Bの機能について、図13を参照しながら図4の全体フローチャートにおけるステップS02Bの詳細フローチャートで説明する。図13は、第2の実施形態のヨーレート較正装置における図1の直進状態判定部と操舵角記憶部における直進状態における操舵角センサ値の記憶制御の流れを示す詳細フローチャートである。
ステップS121では、操舵角記憶部13Bは、CPU101が起動したときに、記憶エリア13aに記憶された左操舵方向の操作角センサ値の数NL、記憶エリア13bに記憶された右操舵方向の操作角センサ値の数NRを0(ゼロ)にリセットする(「NL=NR=0」)。
(Detailed flowchart of step S02B)
The functions of the straight traveling
In step S121, when the
ステップS122では、直進状態判定部12Bは、車速VS、前後加速度αX、ヨーレートγ、操舵角速度演算部19から入力された操舵角速度ωHを読み込んで、車両が直進状態判定条件Zを満足した直進の走行状態か否かをチェックする。直進状態判定条件Zを満足した場合(Yes)は、直進状態判定部12Bは、直進状態判定条件Zを満足したことを示す信号を操舵角記憶部13Bに入力し、ステップS123へ進み、直進状態判定条件Zを満足していない場合(No)は、ステップS127へ進む。
In step S122, the straight traveling
(直進状態判定条件Z)
前記した直進状態判定条件Zとは、例えば、以下の(1)〜(4)の条件を全て満たしているときに車両が直進状態判定条件Zを満たしているとする。
(1)前後加速度センサSαXで検出された前後加速度αXの絶対値が、0.05G未満
(2)ヨーレートセンサSYで検出されたヨーレートの絶対値が、0.5deg/sec未満
(3)操舵角速度演算部19から入力された操舵角速度ωHが、左操舵を示し、その操舵角速度ωHの値が5〜10deg/secの範囲内であるか、又は、右操舵を示し、その操舵角速度ωHの値が−10〜−5deg/secの範囲内である
(4)車速演算部11からの車速VSが所定値以上、例えば、30km/hr以上での前進走行
(Straight running condition determination condition Z)
The straight-running state determination condition Z described above is, for example, that the vehicle satisfies the straight-running state determination condition Z when all of the following conditions (1) to (4) are satisfied.
(1) The absolute value of the longitudinal acceleration α X detected by the longitudinal acceleration sensor Sα X is less than 0.05 G. (2) The absolute value of the yaw rate detected by the yaw rate sensor S Y is less than 0.5 deg / sec (3 ) The steering angular velocity ω H input from the steering angular
ステップS123では、操舵角記憶部13Bは、操舵方向判定部15から入力された操舵方向の判定結果が左操舵を示している場合は、記憶エリア13aに記憶し、操舵方向判定部15から入力された操舵方向の判定結果が右操舵を示している場合は、記憶エリア13bに記憶する(「操舵角センサ値を、左右の操舵方向を区別して、記憶」)。ここで、ステップS123が、特許請求の範囲に記載の「操舵角記憶手段」に対応する。
In step S123, when the steering direction determination result input from the steering
なお、ステップS123では、操舵角記憶部13Bは、操舵角センサ値として、ヨーレートγの値と車速VSの値が分かっているので、図2の操舵角−ヨーレート特性データ104bを準用し、前記した式(1)の予め求められた操舵定常ゲインの値によってヨーレートセンサSYで検出されたヨーレートγがゼロに相当する操舵角θHの値(直進状態模擬操舵角)が算出できる。そして、式(1)によってヨーレートγがゼロに相当する操作角θHを演算して記憶エリア13a,13bに記憶しても良い。図1においては表示されていないが、操舵角記憶部13Bには、車速VSも入力されている。
その場合、ステップS123が、特許請求の範囲に記載の「直進状態操舵角演算手段」及び「操舵角記憶手段」に対応する。また、式(1)によってヨーレートγがゼロに相当する操作角θHを演算することが、特許請求の範囲に記載の「直進状態判定手段により、直進走行状態と判定され、かつ、操舵角速度検出手段により操舵角速度の発生が確認された際に、操舵角センサにより検出された操舵角を、操舵方向判定手段により判定された操舵方向と、車速検出手段により検出された車速と、ヨーレートセンサにより検出されたヨーレートと、ヨーレート特性データとに基づいて、検出されたヨーレートがゼロの値に対応する直進状態模擬操舵角に補正演算する」に対応する。
In step S123, since the steering
In this case, step S123 corresponds to “straight-ahead steering angle calculation means” and “steering angle storage means” recited in the claims. In addition, calculating the operation angle θ H corresponding to zero yaw rate γ according to the equation (1) is “determined to be a straight traveling state by the straight traveling state determination means and the steering angular velocity detection” When the generation of the steering angular velocity is confirmed by the means, the steering angle detected by the steering angle sensor is detected by the steering direction determined by the steering direction determination means, the vehicle speed detected by the vehicle speed detection means, and the yaw rate sensor. The corrected yaw rate is corrected to a straight traveling state simulated steering angle corresponding to a zero value of the detected yaw rate based on the yaw rate and the yaw rate characteristic data ”.
ステップS124では、操舵角記憶部13Bは、操舵方向判定部15からの操舵方向の判定結果が左右いずれかをチェックする(「操舵方向は左右いずれか?」)。操舵方向が左の場合はステップS125へ進み、操舵方向が右の場合はステップS126へ進む。
ステップS125では、記憶エリア13aに記憶された操舵角センサ値の数NLを1だけインクレメントする(「NL=NL+1」)。
ステップS126では、記憶エリア13bに記憶された操舵角センサ値の数NRを1だけインクレメントする(「NR=NR+1」)。
なお、記憶エリア13a,13bに記憶された操舵角センサ値の数NL,NRは、例えば、記憶エリア13a,13bの先頭部分のロケーションに書き込み更新され、操舵角検出不感帯領域演算部14Bが読み込み可能になっている。
ステップS125又はステップS126の後は、ステップS127へ進む。
In step S124, the steering
In step S125, the number N L of steering angle sensor values stored in the
In step S126, the number N R of steering angle sensor values stored in the storage area 13b is incremented by 1 (“N R = N R +1”).
The numbers N L and N R of the steering angle sensor values stored in the
After step S125 or step S126, the process proceeds to step S127.
ステップS127では、操舵角記憶部13Bは、IG−SWがオフ(OFF)されたか否かをチェックする。IG−SWがオフされた場合(Yes)は、記憶された操舵角センサ値をクリアする。ちなみに、記憶エリア13a,13bはRAM103の所定の記憶エリアであり、ヨーレート較正装置100Bが電源オフになれば自動的に記憶は消去される。ステップS127でNoの場合は、ステップS122に戻り、操舵角センサ値の記憶の処理を繰り返す。
In step S127, the steering
(ステップS03Bの詳細フローチャート)
次に、図14から図16を参照しながら、図4の全体フローチャートにおけるステップS03Bについて説明する。図14、図15は、第2の実施形態のヨーレート較正装置における図1の操舵角検出不感帯領域演算部における不感帯領域の演算処理の制御の流れを示す詳細フローチャートである。この処理は、操舵角検出不感帯領域演算部14Bにおいて行われる。
ステップS131では、記憶エリア13aに記憶された操舵角センサ値の数NLが所定数以上か否か、例えば、10以上か否かをチェックする(「NL≧10?」)。NLが所定数以上の場合(Yes)は、ステップS134へ進み、そうでない場合(No)はステップS132へ進む。
ステップS132では、左操舵時に記憶エリア13aに記憶された操舵角センサ値の中から最大値(第1の最大値)θHLmax、最小値(第1の最小値)θHLminを検索する。ステップS133では、中間値(第1の中間値)θHLM{=(θHLmax−θHLmin)/2}を演算する。その後、ステップS135へ進む。
(Detailed flowchart of step S03B)
Next, step S03B in the overall flowchart of FIG. 4 will be described with reference to FIGS. FIGS. 14 and 15 are detailed flowcharts showing the flow of control of the dead zone calculation process in the steering angle detection dead zone calculation unit of FIG. 1 in the yaw rate calibration apparatus of the second embodiment. This process is performed in the steering angle detection dead zone
In step S131, it is checked whether or not the number N L of steering angle sensor values stored in the
In step S132, the maximum value (first maximum value) θ HLmax and the minimum value (first minimum value) θ HLmin are searched from the steering angle sensor values stored in the
ステップS131からYesでステップS134へ進むと、左操舵時に記憶エリア13aに記憶された操舵角センサ値平均値(第1の平均値)θHLAを演算する{θHLA=(ΣθH)/NL}、そしてその後、ステップS135へ進む。
When the process proceeds from step S131 to Yes in step S134, the steering angle sensor value average value (first average value) θ HLA stored in the
ステップS135では、記憶エリア13bに記憶された操舵角センサ値の数NRが所定数以上か否か、例えば、10以上か否かをチェックする(「NR≧10?」)。NRが所定数以上の場合(Yes)は、結合子(B)に従って、図15のステップS138へ進み、そうでない場合(No)はステップS136へ進む。
ステップS136では、右操舵時に記憶エリア13bに記憶された操舵角センサ値の中から最大値(第2の最大値)θHRmax、最小値(第2の最小値)θHRminを検索する。ステップS137では、中間値(第2の中間値)θHRM{=(θHRmax−θHRmin)/2}を演算する。その後、結合子(A)に従って、図15のステップS139へ進む。
In step S135, it is checked whether or not the number N R of steering angle sensor values stored in the storage area 13b is a predetermined number or more, for example, 10 or more (“N R ≧ 10?”). If N R is greater than or equal to the predetermined number (Yes), the process proceeds to step S138 in FIG. 15 according to the connector (B), and otherwise (No) proceeds to step S136.
In step S136, the maximum value (second maximum value) θ HRmax and the minimum value (second minimum value) θ HRmin are searched from the steering angle sensor values stored in the storage area 13b during right steering. In step S137, an intermediate value (second intermediate value) θ HRM {= (θ HRmax −θ HRmin ) / 2} is calculated. Thereafter, the process proceeds to step S139 in FIG. 15 according to the connector (A).
ステップS135からYesでステップS138へ進むと、右操舵時に記憶エリア13bに記憶された操舵角センサ値平均値(第2の平均値)θHRAを演算する{θHRA=(ΣθH)/NR}、そしてその後、ステップS139へ進む。 When the process proceeds from step S135 to Yes in step S138, the steering angle sensor value average value (second average value) θ HRA stored in the storage area 13b at the time of right steering is calculated {θ HRA = (Σθ H ) / N R. } Then, the process proceeds to step S139.
ステップS139では、記憶エリア13aに記憶された操舵角センサ値の数NL、記憶エリア13bに記憶された操舵角センサ値の数NRに応じて不感帯領域の1/2幅θHdeadを演算する。
具体的には、NL<10かつNR<10の場合は、不感帯領域の1/2幅θHdead={(θHLM−θHRM)/2}である。
NL≧10かつNR<10の場合は、不感帯領域の1/2幅θHdead={(θHLA−θHRM)/2}である。
NL<10かつNR≧10の場合は、不感帯領域の1/2幅θHdead={(θHLM−θHRA)/2}である。
NL≧10かつNR≧10の場合は、不感帯領域の1/2幅θHdead={(θHLA−θHRA)/2}である。
その後ステップS140へ進む。
In step S139, the ½ width θ Hdead of the dead zone is calculated according to the number N L of steering angle sensor values stored in the
Specifically, in the case of N L <10 and N R <10, the half width θ Hdead = {(θ HLM −θ HRM ) / 2} of the dead zone region.
In the case of N L ≧ 10 and N R <10, the half width θ Hdead = {(θ HLA −θ HRM ) / 2} of the dead zone region.
When N L <10 and N R ≧ 10, the half width θ Hdead of the dead zone region = {(θ HLM −θ HRA ) / 2}.
In the case of N L ≧ 10 and N R ≧ 10, the half width θ Hdead of the dead zone region = {(θ HLA −θ HRA ) / 2}.
Thereafter, the process proceeds to step S140.
ステップS140では、ステップS139で得られた操舵角センサの不感帯領域の1/2幅θHdeadを操舵角補正部16に出力する。これで全体フローチャートのステップS03Bの操舵角センサの不感帯領域演算の処理を終わり、全体フローチャートのステップS04へ進む。
In step S140, the ½ width θ Hdead of the dead zone region of the steering angle sensor obtained in step S139 is output to the steering
本実施形態によれば、操舵角の補正に当たり、図5の全体フローチャートのステップS02Bにおいて、操舵角センサSHAが操舵角θHの変化を示しているとき、つまり操舵角速度ωHが生じているときに、操舵角センサ値を記憶するか、若しくは、式(1)に従ってヨーレートγがゼロに相当する値の操舵角θHに換算して記憶する。従って、操舵角θHを補正する前の操舵角θHの値が、操舵角センサSHAのガタ、つまり、不感帯領域に入っていない状態で取得して記憶される確率が高いので、左操舵時の前記した中間値θHLM又は平均値θHLAや、右操舵時の前記した中間値θHRM又は平均値θHRAの値の信頼度が高い。 According to the present embodiment, when the steering angle is corrected, in step S02B of the overall flowchart of FIG. 5, when the steering angle sensor S HA indicates a change in the steering angle θ H , that is, the steering angular velocity ω H is generated. Sometimes, the steering angle sensor value is stored, or is converted into the steering angle θ H having a value corresponding to zero in the yaw rate γ according to the equation (1) and stored. Accordingly, since the steering angle θ H before correction of the steering angle θ H has a high probability of being acquired and stored in the state where the steering angle sensor S HA is not loose, that is, not in the dead zone region, left steering The reliability of the intermediate value θ HLM or the average value θ HLA at the time or the intermediate value θ HRM or the average value θ HRA at the time of the right steering is high.
図16は第2の実施形態のヨーレート較正装置における操舵角記憶部13Bの記憶エリア13a,13bに記憶された操舵角θHの値の分布図である。この図では、模式的に表わしているが、符号C1は右操舵時に記憶された最小値θHRminを、符号D1は右操舵時に記憶されたθHRmaxを、符号E1は最小値θHRminとθHRmaxとの中間値θHRMを示している。同様に符号C2は左操舵時に記憶された最小値θHLminを、符号D2は左操舵時に記憶されたθHLmaxを、符号E2は、最小値θHLminとθHLmaxとの中間値θHLMを示している。
また、符号F1は、右操舵時に記憶された操舵角センサ値の平均値θHRAを示し、符号F2は、左操舵時に記憶された操舵角センサ値の平均値θHLAを示している。
FIG. 16 is a distribution diagram of values of the steering angle θ H stored in the
Reference sign F1 represents an average value θ HRA of steering angle sensor values stored during right steering, and reference sign F2 represents an average value θ HLA of steering angle sensor values stored during left steering.
図16では、左操舵時に記憶された操舵角センサ値、右操舵時に記憶された操舵角センサ値の分布は模式的に表わされており、図3に示されたような正規分布とはならない。また、図3よりもより幅が狭く鋭いピークになるが、図16では図3との差異を強調して表示してないだけである。
その結果、第2の実施形態のように操舵角センサ値の数NL,NRが所定数以上の場合にも、2σを用いず、左操舵方向及び右操舵方向それぞれの場合の操舵角センサ値の分布の平均値θHLA,θHMAを用いれば十分に正確な不感帯領域の1/2幅θHdeadを算出できる。
それを用いて操舵角を操舵角補正部16で補正して補正された操舵角θCHと、車速VSとに基づきヨーレートオフセット量演算部17でヨーレートオフセット量Δγがより精度良く演算でき、結果としてヨーレートゼロ点補正部18で正確にヨーレートγのゼロ点補正ができる。
In FIG. 16, the distribution of the steering angle sensor value stored at the time of left steering and the steering angle sensor value stored at the time of right steering are schematically shown and do not become a normal distribution as shown in FIG. . Further, although the peak is narrower and sharper than that in FIG. 3, the difference from FIG. 3 is not highlighted in FIG.
As a result, even when the numbers N L and N R of the steering angle sensor values are equal to or larger than the predetermined number as in the second embodiment, the steering angle sensor in each of the left steering direction and the right steering direction without using 2σ. If the average values θ HLA and θ HMA of the value distribution are used, a sufficiently accurate ½ width θ Hdead of the dead zone can be calculated.
Based on this, the yaw rate offset amount calculation unit 17 can calculate the yaw rate offset amount Δγ more accurately based on the steering angle θ CH corrected by correcting the steering angle by the steering
また、操舵角センサ値の数NL,NRが所定数未満の場合も、中間値θHLM,θHRMを用いて不感帯領域の1/2幅θdeadを算出できるので車両の走行を開始してから迅速に操舵角θHの補正ができ、その結果ヨーレートγのゼロ点補正もより迅速に行うことができる。 In addition, even when the number of steering angle sensor values N L and N R is less than the predetermined number, the half width θ dead of the dead zone can be calculated using the intermediate values θ HLM and θ HRM , so that the vehicle starts to travel. After that, the steering angle θ H can be corrected quickly, and as a result, the zero point correction of the yaw rate γ can be performed more quickly.
本実施形態によれば、第1の実施形態と同様に車両の走行状態のみのヨーレートγのゼロ点補正が可能となる。 According to the present embodiment, the zero point correction of the yaw rate γ can be performed only in the traveling state of the vehicle as in the first embodiment.
また、本実施形態では、図14、図15の詳細フローチャートのステップS134,S138において平均値θHLA,θHRAを用いたがそれに限定されるものではなく、左操舵方向及び右操舵方向それぞれの場合の操舵角センサ値の分布のそれぞれの最大頻度の操舵角センサ値(第1及び第2の最大頻度値)を用いても良い。 In this embodiment, the average values θ HLA and θ HRA are used in steps S134 and S138 in the detailed flowcharts of FIGS. 14 and 15, but the average values θ HLA and θ HRA are not limited thereto. The steering angle sensor values (first and second maximum frequency values) of the maximum frequency of the respective steering angle sensor value distributions may be used.
なお、本実施形態において、ステップS122において車両が直進状態判定条件Zを満足した直進の走行状態と判定されて、ステップS123において操舵角センサSHAで検出された操舵角θHの値を、ヨーレートγがゼロの値に対応する操舵角θHの値に置き換えて記憶エリア13a,13bに記憶した場合、操舵角検出不感帯領域演部14Bにおいて操舵角センサSHAの不感帯領域をより精度良く演算できる。
In this embodiment, it is determined in step S122 that the vehicle is in a straight traveling state that satisfies the straight traveling state determination condition Z, and the value of the steering angle θ H detected by the steering angle sensor S HA in step S123 is determined as the yaw rate.
11 車速演算部(車速検出手段)
12A 直進状態判定部(直進状態判定手段)
12B 直進状態判定部(直進状態判定手段)
13A 操舵角記憶部(操舵角記憶手段、直進状態操舵角演算手段)
13B 操舵角記憶部(操舵角記憶手段、直進状態操舵角演算手段)
13a 記憶エリア(操舵角記憶手段)
13b 記憶エリア(操舵角記憶手段)
14A 操舵角検出不感帯領域演算部(操舵角検出不感帯領域演算手段)
14B 操舵角検出不感帯領域演算部(操舵角検出不感帯領域演算手段)
15 操舵方向判定部(操舵方向判定手段)
16 操舵角補正部(操舵角補正手段)
17 ヨーレートオフセット量演算部(ゼロ点較正手段)
18 ヨーレートゼロ点補正部(ゼロ点較正手段)
18a 記憶エリア(ゼロ点較正手段)
19 操舵角速度演算部(操舵角速度検出手段)
100A ヨーレート較正装置
100B ヨーレート較正装置
101 CPU
102 バス
103 RAM
104 ROM(ヨーレート特性データの記憶手段)
104a プログラム
104b 操舵角−ヨーレート特性データ
105 入出力インタフェース回路
200 電動パワーステアリング制御装置
300 車両運動安定化制御装置
A 最小値
B 最大値
SY ヨーレートセンサ
SHA 操舵角センサ
SVW 車輪速センサ
VS 車速
X 直進状態判定条件
Y 安定走行条件
Z 直進状態判定条件
11 Vehicle speed calculation unit (vehicle speed detection means)
12A Straight-running state determination unit (straight-running state determination means)
12B Straight-running state determination unit (straight-running state determination means)
13A Steering angle storage unit (steering angle storage means, straight-ahead steering angle calculation means)
13B Steering angle storage unit (steering angle storage means, straight-ahead steering angle calculation means)
13a Storage area (steering angle storage means)
13b Storage area (steering angle storage means)
14A Steering angle detection dead zone calculation unit (steering angle detection dead zone calculation unit)
14B Steering angle detection dead zone calculation unit (steering angle detection dead zone calculation unit)
15 Steering direction determination unit (steering direction determination means)
16 Steering angle correction unit (steering angle correction means)
17 Yaw rate offset amount calculation unit (zero point calibration means)
18 Yaw rate zero point correction unit (zero point calibration means)
18a Storage area (zero point calibration means)
19 Steering angular velocity calculation unit (steering angular velocity detection means)
100A Yaw Rate Calibration Device 100B Yaw
102
104 ROM (storage means for yaw rate characteristic data)
Claims (9)
操舵方向を判定する操舵方向判定手段と、
車速を検出する車速検出手段と、
前記車両の直進走行状態を判定する直進状態判定手段と、
該直進状態判定手段により直進走行状態と判定された際の前記操舵角センサにより検出された操舵角を記憶する操舵角記憶手段と、
該操舵角記憶手段に記憶された前記操舵角の値の分布に基づいて前記操舵角センサの不感帯領域を演算する操舵角検出不感帯領域演算手段と、
該操舵角検出不感帯領域演算手段によって求められた前記不感帯領域と前記操舵方向判定手段によって判定された操舵方向に基づいて前記検出された操舵角を補正する操舵角補正手段と、
前記操舵角と車速とヨーレートとの相関関係が予め格納されたヨーレート特性データの記憶手段と、
前記操舵角補正手段により補正された操舵角と、前記車速検出手段により検出された車速と、前記ヨーレート特性データとに基づいて、前記ヨーレートセンサで検出されたヨーレートのゼロ点を較正するゼロ点較正手段と、
を備えることを特徴とするヨーレート較正装置。 In a yaw rate calibration device that includes a steering angle sensor that detects a steering angle and a yaw rate sensor that detects a yaw rate of a vehicle, and corrects a zero point of the yaw rate sensor according to a steering angle detected by the steering angle sensor.
Steering direction determination means for determining the steering direction;
Vehicle speed detection means for detecting the vehicle speed;
Straight-running state determining means for determining the straight-running state of the vehicle;
Steering angle storage means for storing the steering angle detected by the steering angle sensor when the straight traveling state determination means determines that the vehicle is traveling straight ahead;
Steering angle detection dead zone calculation means for calculating a dead zone area of the steering angle sensor based on a distribution of the steering angle values stored in the steering angle storage means;
Steering angle correction means for correcting the detected steering angle based on the dead zone area obtained by the steering angle detection dead zone area calculation means and the steering direction determined by the steering direction determination means;
Storage means for yaw rate characteristic data in which a correlation between the steering angle, the vehicle speed, and the yaw rate is stored in advance;
Zero point calibration for calibrating the zero point of the yaw rate detected by the yaw rate sensor based on the steering angle corrected by the steering angle correcting means, the vehicle speed detected by the vehicle speed detecting means, and the yaw rate characteristic data Means,
A yaw rate calibration apparatus comprising:
前記直進状態操舵角演算手段により演算された直進状態模擬操舵角を、前記直進状態判定手段により直進走行状態と判定された際の前記操舵角センサにより検出された操舵角の代わりの操舵角として前記操舵記憶手段に記憶させて、前記操舵角検出不感帯領域演算手段において用いられることを特徴とする請求項1に記載のヨーレート較正装置。 The steering angle detected by the steering angle sensor when the straight traveling state determination unit determines that the vehicle is traveling straight, the vehicle speed detected by the vehicle speed detection unit, the yaw rate detected by the yaw rate sensor, and the yaw rate A straight-running state steering angle calculating means for performing a correction calculation to a straight-running state simulated steering angle corresponding to a value of the detected yaw rate being zero based on the characteristic data;
The straight-running state simulated steering angle calculated by the straight-running state steering angle calculating unit is used as a steering angle instead of the steering angle detected by the steering angle sensor when the straight-running state determining unit determines that the vehicle is traveling straight ahead. The yaw rate calibration device according to claim 1, wherein the yaw rate calibration device is stored in a steering storage means and used in the steering angle detection dead zone region calculation means.
操舵方向を判定する操舵方向判定手段と、
前記車両の直進走行状態を判定する直進状態判定手段と、
前記操舵角センサにより検出された操舵角に基づき操舵角速度の発生を検出する操舵角速度検出手段と、
前記直進状態判定手段により、直進走行状態と判定され、かつ、前記操舵角速度検出手段により操舵角速度の発生が確認された際の前記操舵角を、左操舵及び右操舵それぞれの操舵方向に区別して記憶する操舵角記憶手段と、
前記操舵角と車速とヨーレートとの相関関係が予め格納されたヨーレート特性データの記憶手段と、
前記操舵角記憶手段に記憶された左操舵時の前記操舵角の値の分布と、右操舵時の前記操舵角の値の分布と、に基づいて前記操舵角センサの不感帯領域を演算する操舵角検出不感帯領域演算手段と、
該操舵角検出不感帯領域演算手段によって求められた前記不感帯領域と前記操舵方向判定手段により判定された操舵方向とに基づいて前記検出された操舵角を補正する操舵角補正手段と、
前記操舵角補正手段により補正された操舵角と、前記車速検出手段により検出された車速と、前記ヨーレート特性データとに基づいて、前記ヨーレートセンサで検出されたヨーレートのゼロ点を較正するゼロ点較正手段と、
を備えることを特徴とするヨーレート較正装置。 In a yaw rate calibration device that includes a steering angle sensor that detects a steering angle and a yaw rate sensor that detects a yaw rate of a vehicle, and corrects a zero point of the yaw rate sensor according to a steering angle detected by the steering angle sensor.
Steering direction determination means for determining the steering direction;
Straight-running state determining means for determining the straight-running state of the vehicle;
Steering angular velocity detection means for detecting the generation of the steering angular velocity based on the steering angle detected by the steering angle sensor;
The steering angle at the time when the straight traveling state is determined by the straight traveling state determining means and the generation of the steering angular speed is confirmed by the steering angular velocity detecting means is distinguished and stored in the steering directions of left steering and right steering. Steering angle storage means for
Storage means for yaw rate characteristic data in which a correlation between the steering angle, the vehicle speed, and the yaw rate is stored in advance;
Steering angle for calculating the dead zone region of the steering angle sensor based on the distribution of the steering angle value during left steering and the distribution of the steering angle value during right steering stored in the steering angle storage means A detection dead zone calculation means;
Steering angle correction means for correcting the detected steering angle based on the dead zone area obtained by the steering angle detection dead zone calculation means and the steering direction determined by the steering direction determination means;
Zero point calibration for calibrating the zero point of the yaw rate detected by the yaw rate sensor based on the steering angle corrected by the steering angle correcting means, the vehicle speed detected by the vehicle speed detecting means, and the yaw rate characteristic data Means,
A yaw rate calibration apparatus comprising:
前記直進状態操舵角演算手段により演算された直進状態模擬操舵角を、前記直進状態判定手段により直進走行状態と判定され、かつ、前記操舵角速度検出手段により操舵角速度の発生が確認された際の前記操舵角センサにより検出された操舵角の代わりの操舵角として前記操舵角記憶手段に、左操舵及び右操舵それぞれの各操舵方向に区別して記憶させて、前記操舵角検出不感帯領域演算手段において用いられることを特徴とする請求項5に記載のヨーレート較正装置。 The steering angle detected by the steering angle sensor when the straight traveling state is determined by the straight traveling state determining unit and the generation of the steering angular velocity is confirmed by the steering angular velocity detecting unit. Based on the steering direction determined by the vehicle speed, the vehicle speed detected by the vehicle speed detecting means, the yaw rate detected by the yaw rate sensor, and the yaw rate characteristic data, the detected yaw rate corresponds to a value of zero. It further comprises a straight-ahead steering angle calculation means for performing a correction calculation on a straight-ahead state simulated steering angle,
The straight-running state simulated steering angle calculated by the straight-running state steering angle calculating unit is determined to be a straight-running driving state by the straight-running state determining unit, and the occurrence of the steering angular velocity is confirmed by the steering angular velocity detecting unit. As the steering angle instead of the steering angle detected by the steering angle sensor, the steering angle storage means distinguishes and stores each steering direction of left steering and right steering, and is used in the steering angle detection dead zone calculation means. The yaw rate calibration apparatus according to claim 5.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010206248A JP5314649B2 (en) | 2010-09-15 | 2010-09-15 | Yaw rate calibration device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010206248A JP5314649B2 (en) | 2010-09-15 | 2010-09-15 | Yaw rate calibration device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2012063184A true JP2012063184A (en) | 2012-03-29 |
JP5314649B2 JP5314649B2 (en) | 2013-10-16 |
Family
ID=46059057
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2010206248A Expired - Fee Related JP5314649B2 (en) | 2010-09-15 | 2010-09-15 | Yaw rate calibration device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5314649B2 (en) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015008796A1 (en) * | 2013-07-17 | 2015-01-22 | 日立オートモティブシステムズ株式会社 | Vehicle control device |
JP2015190920A (en) * | 2014-03-28 | 2015-11-02 | 富士重工業株式会社 | Measurement device, and failure diagnosis device using the same |
JP5804200B2 (en) * | 2012-05-22 | 2015-11-04 | トヨタ自動車株式会社 | Steering transmission system characteristic change detection device |
JP2017105294A (en) * | 2015-12-09 | 2017-06-15 | 日立オートモティブシステムズ株式会社 | Steering angle detection device and steering angle detection method |
JP2021054107A (en) * | 2019-09-26 | 2021-04-08 | ダイハツ工業株式会社 | Steering angle control device |
CN115593514A (en) * | 2022-10-31 | 2023-01-13 | 东风商用车有限公司(Cn) | Steering angle sensor zero calibration method, device, equipment and storage medium |
CN116331348A (en) * | 2023-05-26 | 2023-06-27 | 上海集度汽车有限公司 | Steering neutral correction device, vehicle, method, and computer-readable storage medium |
WO2023136129A1 (en) * | 2022-01-11 | 2023-07-20 | 株式会社ジェイテクト | Zero point estimation device, zero point estimation method, and zero point estimation program |
US11885620B2 (en) | 2021-05-28 | 2024-01-30 | Denso Corporation | Inertia detection device |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07105474A (en) * | 1993-08-10 | 1995-04-21 | Mitsubishi Motors Corp | Method for estimating road traffic status and method for controlling vehicle drive characteristic |
JPH10132550A (en) * | 1996-11-01 | 1998-05-22 | Mitsubishi Motors Corp | Detecting device for neutral point of steering wheel angle of vehicle |
JPH11139332A (en) * | 1997-11-14 | 1999-05-25 | Nissan Motor Co Ltd | Vehicular yaw rate control device |
JP2001130431A (en) * | 1999-11-01 | 2001-05-15 | Koyo Seiko Co Ltd | Steering device for vehicle |
JP2002104220A (en) * | 2000-09-28 | 2002-04-10 | Toyoda Mach Works Ltd | Control device of motor-driven power steering device |
JP2005035459A (en) * | 2003-07-17 | 2005-02-10 | Hino Motors Ltd | Method and device for correcting steering angle |
JP2008275344A (en) * | 2007-04-25 | 2008-11-13 | Honda Motor Co Ltd | Device for determining output of yaw rate sensor, and device for determining preceding/following vehicle |
JP2010127631A (en) * | 2008-11-25 | 2010-06-10 | Honda Motor Co Ltd | Zero point correction apparatus for horizontal behavior amount detecting means |
-
2010
- 2010-09-15 JP JP2010206248A patent/JP5314649B2/en not_active Expired - Fee Related
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07105474A (en) * | 1993-08-10 | 1995-04-21 | Mitsubishi Motors Corp | Method for estimating road traffic status and method for controlling vehicle drive characteristic |
JPH10132550A (en) * | 1996-11-01 | 1998-05-22 | Mitsubishi Motors Corp | Detecting device for neutral point of steering wheel angle of vehicle |
JPH11139332A (en) * | 1997-11-14 | 1999-05-25 | Nissan Motor Co Ltd | Vehicular yaw rate control device |
JP2001130431A (en) * | 1999-11-01 | 2001-05-15 | Koyo Seiko Co Ltd | Steering device for vehicle |
JP2002104220A (en) * | 2000-09-28 | 2002-04-10 | Toyoda Mach Works Ltd | Control device of motor-driven power steering device |
JP2005035459A (en) * | 2003-07-17 | 2005-02-10 | Hino Motors Ltd | Method and device for correcting steering angle |
JP2008275344A (en) * | 2007-04-25 | 2008-11-13 | Honda Motor Co Ltd | Device for determining output of yaw rate sensor, and device for determining preceding/following vehicle |
JP2010127631A (en) * | 2008-11-25 | 2010-06-10 | Honda Motor Co Ltd | Zero point correction apparatus for horizontal behavior amount detecting means |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5804200B2 (en) * | 2012-05-22 | 2015-11-04 | トヨタ自動車株式会社 | Steering transmission system characteristic change detection device |
US9290205B2 (en) | 2012-05-22 | 2016-03-22 | Toyota Jidosha Kabushiki Kaisha | Characteristic change detection device for steering transmission system |
WO2015008796A1 (en) * | 2013-07-17 | 2015-01-22 | 日立オートモティブシステムズ株式会社 | Vehicle control device |
JP2015020504A (en) * | 2013-07-17 | 2015-02-02 | 日立オートモティブシステムズ株式会社 | Vehicle control device |
JP2015190920A (en) * | 2014-03-28 | 2015-11-02 | 富士重工業株式会社 | Measurement device, and failure diagnosis device using the same |
JP2017105294A (en) * | 2015-12-09 | 2017-06-15 | 日立オートモティブシステムズ株式会社 | Steering angle detection device and steering angle detection method |
JP2021054107A (en) * | 2019-09-26 | 2021-04-08 | ダイハツ工業株式会社 | Steering angle control device |
JP7312074B2 (en) | 2019-09-26 | 2023-07-20 | ダイハツ工業株式会社 | Rudder angle control device |
US11885620B2 (en) | 2021-05-28 | 2024-01-30 | Denso Corporation | Inertia detection device |
WO2023136129A1 (en) * | 2022-01-11 | 2023-07-20 | 株式会社ジェイテクト | Zero point estimation device, zero point estimation method, and zero point estimation program |
CN115593514A (en) * | 2022-10-31 | 2023-01-13 | 东风商用车有限公司(Cn) | Steering angle sensor zero calibration method, device, equipment and storage medium |
CN115593514B (en) * | 2022-10-31 | 2024-06-21 | 东风商用车有限公司 | Zero calibration method, device and equipment for steering angle sensor and storage medium |
CN116331348A (en) * | 2023-05-26 | 2023-06-27 | 上海集度汽车有限公司 | Steering neutral correction device, vehicle, method, and computer-readable storage medium |
CN116331348B (en) * | 2023-05-26 | 2023-07-25 | 上海集度汽车有限公司 | Steering neutral correction device, vehicle, method, and computer-readable storage medium |
Also Published As
Publication number | Publication date |
---|---|
JP5314649B2 (en) | 2013-10-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5314649B2 (en) | Yaw rate calibration device | |
US8170746B2 (en) | Method for determining unstable driving states | |
US11584369B2 (en) | Collision detection method and apparatus based on an autonomous vehicle, device and storage medium | |
KR101637887B1 (en) | Determination of a maximum steering angle for a vehicle | |
JP7391701B2 (en) | Method, device, storage medium, and program for removing steady lateral deviation | |
KR20140093961A (en) | Sensor system for independently evaluating the accuracy of the data of the sensor system | |
JP5152778B2 (en) | Inclination angle detector for motorcycles | |
JP3800901B2 (en) | Lane tracking control device | |
JP5804200B2 (en) | Steering transmission system characteristic change detection device | |
JP6419671B2 (en) | Vehicle steering apparatus and vehicle steering method | |
JP2015523268A (en) | Method for ensuring rear wheel control of a motor vehicle with an electric power steering system | |
JP2014080097A (en) | Electric power steering system | |
JP5402244B2 (en) | Vehicle physical quantity estimation device | |
JP2014094723A (en) | Steering device | |
JP2014098591A (en) | Electric power steering device | |
JP2010089577A (en) | Stability factor estimation device for vehicle | |
JP6098545B2 (en) | Vehicle control device | |
JP2016032960A (en) | Vehicle movement amount calculation device, program and method | |
JP2748456B2 (en) | Vehicle steering angle detection device | |
JP2014193645A (en) | Vehicle traveling controller | |
JP2013147182A (en) | Control device of vehicle | |
JP2010127631A (en) | Zero point correction apparatus for horizontal behavior amount detecting means | |
JP2008024233A (en) | Vehicle side slip angle calculation unit | |
JP2008247248A (en) | Vehicular steering device | |
JP5672226B2 (en) | Rear wheel steering device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20121128 |
|
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: 20130625 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20130626 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130705 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
LAPS | Cancellation because of no payment of annual fees |