本発明は、ロール角推定装置およびそれを備えた輸送機器に関する。 The present invention relates to a transport apparatus including the estimation device and its roll angle.
従来より、自動二輪車等の車両のロール角を推定する種々の推定装置が提案されている。 Conventionally, various estimation device for estimating the roll angle of the vehicle such as a motorcycle has been proposed. 例えば、推定装置により推定されたロール角に基づいてヘッドライトの向きを制御することにより車両の傾斜にかかわらずヘッドライトで適切な方向に光を照射することができる。 For example, light can be irradiated in the appropriate direction in the headlight regardless inclination of the vehicle by controlling the orientation of the headlight based on the roll angle estimated by the estimation device.
特許文献1に記載された車両姿勢推定装置では、車両運動の前後加速度、横加速度、上下加速度、ヨー加速度およびロール角速度の各検出値、前後車体速度の推定値およびピッチ角速度の推定値に基づいてロール角およびピッチ角が推定される。 In the vehicle attitude estimation apparatus described in Patent Document 1, the longitudinal acceleration of the vehicle motion, lateral acceleration, vertical acceleration, the yaw acceleration and the detected value of the roll angular velocity, based on the estimated value of the estimated value and the pitch angular velocity of the longitudinal vehicle body speed roll angle and the pitch angle is estimated.
しかしながら、従来の推定装置では、高い精度で車両のロール角を推定することができない。 However, the conventional estimation apparatus, it is impossible to estimate the roll angle of the vehicle with high accuracy. それにより、例えば、車両が傾斜していないにもかかわらず、ヘッドライトの向きが傾くことがある。 Thus, for example, even though the vehicle is not inclined, there is the orientation of the headlight is tilted.
本発明の目的は、移動体のロール角を高い精度で推定することが可能なロール角推定装置およびそれを備えた輸送機器を提供することである。 An object of the present invention is to provide a transport apparatus having a roll angle estimating apparatus and it capable of estimating the roll angle of the moving body with high accuracy.
(1)第1の発明に係るロール角推定装置は、移動体のロール角を推定するロール角推定装置であって、少なくとも2つの方向に沿った第1および第2の軸の周りでの第1および第2の角速度をそれぞれ検出する第1および第2の角速度検出器と、少なくとも3つの方向における第1、第2および第3の加速度をそれぞれ検出する第1、第2および第3の加速度検出器と、移動体の進行方向の移動速度に関する情報を検出する速度情報検出器と、移動体のロール角を推定するとともに第1および第2の角速度検出器ならびに第1、第2および第3の加速度検出器のうち少なくとも1つのオフセット誤差を推定するように構成された推定部とを備え、推定部は、 現在の推定動作において、第1および第2の角速度検出器の検出値、第1、第2お (1) roll angle estimation apparatus according to the first invention is a roll angle estimating apparatus for estimating the roll angle of the moving body, in about the first and second axes along at least two directions the first and second angular velocity detectors for detecting first and second angular velocity respectively, the first in at least three directions, first, second and third acceleration for detecting the second and third acceleration respectively detector and a speed information detector for detecting information on the movement speed of the moving direction of the moving body, the first and second angular velocity detectors, and first with estimating the roll angle of the moving body, the second and third comprising of an estimation unit configured to estimate at least one offset error of the acceleration detector, estimating section, in the current estimation operation, the detection values of the first and second angular velocity detectors, first , the second your び第3の加速度検出器の検出値、速度情報検出器の検出値、前回の推定動作によるロール角の推定値ならびに前回の推定動作によるオフセット誤差の推定値に基づいて、移動体のロール角および少なくとも1つのオフセット誤差を推定するものである。 Beauty detected value of the third acceleration detector, the detection value of the speed information detector, based on the estimated value of the offset error by the estimation value and the previous estimation operation of the roll angle by previous rounds of estimation operation, the roll angle of the moving object and it is intended to estimate at least one offset error.
そのロール角推定装置においては、少なくとも2つの方向に沿った第1および第2の軸の周りでの第1および第2の角速度がそれぞれ第1および第2の角速度検出器により検出される。 In the roll angle estimation device, first and second angular velocities about the first and second axes along at least two directions is detected by the first and second angular velocity detectors, respectively. また、少なくとも3つの方向における第1、第2および第3の加速度がそれぞれ第1、第2および第3の加速度検出器により検出される。 The first in at least three directions, the second and third acceleration is detected by the first, second and third acceleration detectors respectively. さらに、移動体の進行方向の移動速度に関する情報が速度情報検出器により検出される。 Furthermore, information on moving speed of the moving direction of the moving object is detected by the speed information detector. そして、推定部により移動体のロール角が推定されるとともに第1および第2の角速度検出器ならびに第1、第2および第3の加速度検出器のうち少なくとも1つの検出器による検出値のオフセット誤差が推定される。 The first and second angular velocity detectors, and first with the roll angle of the moving object is estimated by the estimation unit, the offset error of the detected value of at least one detector of the second and third acceleration detector There are estimated.
この場合、推定部は、現在の推定動作において第1および第2の角速度検出器の検出値、第1、第2および第3の加速度検出器の検出値、速度情報検出器の検出値、前回の推定動作によるロール角の推定値ならびに前回の推定動作によるオフセット誤差の推定値に基づいて、移動体のロール角および少なくとも1つのオフセット誤差を推定する。 In this case, the estimation unit, the first and second detection values ​​of the angular velocity detector in the current estimation operation, first, the detection value of the second and third acceleration detectors, the detection value of the speed information detector, the last estimated value of the roll angle by the estimation operation and based on the estimated value of the offset error due to previous estimation operation, it estimates the roll angle and at least one offset error of the moving body.
このように、ロール角とともにオフセット誤差が推定され、オフセット誤差の推定値が次の推定動作の際に用いられる。 Thus, the offset error is estimated with the roll angle, estimated value of the offset error is used when the next estimation operation. それにより、第1および第2の角速度検出器ならびに第1、第2および第3の加速度検出器のうち少なくとも1つのオフセット誤差によるロール角の推定精度の低下が補償される。 Thereby, the first and second angular velocity detectors and first decrease in the estimation accuracy of the roll angle by at least one offset error of the second and third acceleration detector is compensated. その結果、ロール角を高い精度で推定することが可能となる。 As a result, it is possible to estimate the roll angle with a high accuracy.
(2)第1および第2の角速度検出器は、互いに異なる方向に沿った第1および第2の軸の周りでの第1および第2の角速度をそれぞれ検出し、第1、第2および第3の加速度検出器は、互いに異なる第1、第2および第3の方向における第1、第2および第3の加速度をそれぞれ検出してもよい。 (2) first and second angular velocity detector detects respectively the first and second angular velocities about the first and second axes along different directions from each other, first, second and 3 of the acceleration detector, first mutually different, first in the second and third direction, second and third acceleration may be detected, respectively.
この場合、互いに異なる方向に沿った第1および第2の軸の周りでの第1および第2の角速度がそれぞれ第1および第2の角速度検出器により検出される。 In this case, the first and second angular velocities about the first and second axes along different directions from each other is detected by the first and second angular velocity detectors, respectively. また、互いに異なる第1、第2および第3の方向における第1、第2および第3の加速度がそれぞれ第1、第2および第3の加速度検出器により検出される。 Also detected first, first second and third acceleration respectively, the second and the third acceleration detectors in the first, second and third direction different from each other.
(3)推定部は、少なくとも1つのオフセット誤差として、第1および第2の角速度検出器の少なくとも一方のオフセット誤差を推定してもよい。 (3) estimation unit, as at least one offset error, at least one of the offset error of the first and second angular velocity detectors may be estimated.
角速度検出器では、加速度検出器に比べてオフセット誤差が発生しやすい。 The angular velocity detector, the offset error is likely to occur as compared to the acceleration detector. したがって、第1および第2の角速度検出器の少なくとも一方のオフセット誤差の推定値を次の推定動作の際に用いることにより、ロール角の推定精度が十分に向上する。 Therefore, by using an estimate of at least one of the offset error of the first and second angular velocity detectors on the next estimation operation, the estimation accuracy of the roll angle is sufficiently improved.
(4)推定部は、少なくとも1つのオフセット誤差として、第1および第2の角速度検出器のオフセット誤差を推定してもよい。 (4) estimation unit, as at least one offset error, the offset error of the first and second angular velocity detectors may be estimated.
この場合、第1および第2の角速度検出器のオフセット誤差の推定値を次の推定動作の際に用いることにより、ロール角の推定精度がより向上する。 In this case, by using the estimated value of the offset error of the first and second angular velocity detectors on the next estimation operation, the estimation accuracy of the roll angle is further improved.
(5)推定部は、少なくとも1つのオフセット誤差として、第1、第2および第3の加速度検出器の少なくとも1つのオフセット誤差をさらに推定してもよい。 (5) estimating portion, as at least one offset error, first, may further estimate at least one offset error of the second and third acceleration detector.
この場合、第1および第2の角速度検出器の少なくとも一方のオフセット誤差の推定値に加えて第1、第2および第3の加速度検出器の少なくとも1つのオフセット誤差の推定値を次の推定動作の際に用いることにより、ロール角の推定精度がさらに向上する。 In this case, first, an estimate of at least one offset error of the second and third acceleration detector next estimation operation in addition to the estimated value of at least one of the offset error of the first and second angular velocity detectors by using it in the estimation accuracy of the roll angle is further improved.
(6)第1の加速度は移動体の上下方向における加速度であり、推定部は、第1の加速度検出器のオフセット誤差を推定してもよい。 (6) the first acceleration is acceleration in the vertical direction of the moving body, the estimation unit may estimate the offset error of the first acceleration detector.
移動体のロール角が小さい範囲では、移動体の上下方向の加速度はほとんど変化しない。 Ranging roll angle of the moving object is small, vertical acceleration of the moving body is hardly changed. このような上下方向の加速度の検出値が第1の加速度検出器のオフセット誤差により変化した場合、ロール角の推定の際に上下方向の加速度の検出値の変化の影響が大きくなる。 If the detected value of such vertical acceleration is changed by the offset error of the first acceleration detector, the influence of change in the detected values ​​of vertical acceleration at the time of estimation of the roll angle increases. したがって、第1の加速度検出器のオフセット誤差の推定値を次の推定動作の際に用いることにより、ロール角の小さい範囲での推定精度がさらに向上する。 Accordingly, by using the estimated value of the offset error of the first acceleration detector during subsequent estimation operation, further improves the accuracy of estimation of a small range of roll angle.
(7)移動体は、前輪および後輪を有し、速度情報検出器は、情報として後輪の回転速度を検出する後輪回転速度検出器を含み、推定部は、移動体の移動速度をさらに推定するように構成され、現在の推定動作において第1および第2の角速度検出器の検出値、第1、第2および第3の加速度検出器の検出値、後輪回転速度検出器の検出値、前回の推定動作によるロール角の推定値、前回の推定動作によるオフセット誤差の推定値ならびに前回の推定動作による移動速度の推定値に基づいて、移動体のロール角、少なくとも1つのオフセット誤差および移動体の移動速度を推定してもよい。 (7) moving body has a front and rear wheels, speed information detector includes a wheel rotation speed detector after detecting the rotational speed of the rear wheels as the information, the estimation unit, the moving speed of the moving object is further configured to estimate the first and second detection values of the angular velocity detector in the current estimation operation, first, the detection value of the second and third acceleration detector, the detection of the rear wheel rotational speed detector value, the estimated value of the roll angle from the previous estimation operation, the estimated value of the offset error due to previous estimation operation and based on the estimated value of the moving speed from the previous estimation operation, the roll angle of the moving body, at least one offset error and the moving speed of the moving body may be estimated.
移動体の移動速度と後輪の回転速度と移動体のロール角との間には一定の関係がある。 There is a relationship between the rotational speed of the moving speed and the rear wheel of the moving body and the roll angle of the moving object. そのため、後輪の回転速度の検出値およびロール角の推定値に基づいて移動体の移動速度を推定することができる。 Therefore, it is possible to estimate the movement speed of the moving object based on the estimated value of the detected value and the roll angle of the rotational speed of the rear wheels. したがって、現在の推定動作において第1および第2の角速度検出器の検出値、第1、第2および第3の加速度検出器の検出値、後輪の回転速度の検出値、前回の推定動作によるロール角の推定値、前回の推定動作によるオフセット誤差の推定値ならびに前回の推定動作による移動速度の推定値に基づいて、移動体のロール角、少なくとも1つのオフセット誤差および移動体の移動速度を推定することができる。 Thus, the first and second detection values ​​of the angular velocity detector in the current estimation operation, first, the detection value of the second and third acceleration detectors, the detection value of the rotational speed of the rear wheels, according to the preceding estimation operation estimated value of the roll angle estimated value of the offset error due to previous estimation operation and based on the estimated value of the moving speed from the previous estimation operation, the roll angle of the moving object, estimating a movement speed of at least one offset error and mobile can do.
移動体が小さい半径で低速で旋回する場合には、後輪の回転速度は前輪の回転速度に比べて移動体の移動速度に近い。 When turning at a low speed in mobile small radius, the rotational speed of the rear wheels is closer to the moving speed of the moving body than the rotational speed of the front wheels. したがって、後輪の回転速度の検出値を用いることにより、移動体のロール角、少なくとも1つのオフセット誤差および移動体の移動速度を高い精度で推定することが可能となる。 Accordingly, by using the detection value of the rotational speed of the rear wheel, the roll angle of the moving body, it is possible to estimate the movement speed of the at least one offset error and mobile with high accuracy.
(8)移動体は、前輪および後輪を有し、速度情報検出器は、前輪の回転速度を検出する前輪回転速度検出器と、前輪回転速度検出器の検出値から後輪の回転速度を情報として推定する後輪回転速度推定部とを含み、推定部は、移動体の移動速度をさらに推定するように構成され、現在の推定動作において第1および第2の角速度検出器の検出値、第1、第2および第3の加速度検出器の検出値、後輪回転速度推定部の推定値、前回の推定動作によるロール角の推定値、前回の推定動作によるオフセット誤差の推定値ならびに前回の推定動作による移動速度の推定値に基づいて、移動体のロール角、少なくとも1つのオフセット誤差および移動体の移動速度を推定してもよい。 (8) moving body has a front and rear wheels, speed information detector and the front wheel rotational speed detector for detecting a front wheel rotational speed, the rotational speed of the rear wheel from the detected value of the front wheel rotational speed detector and a wheel rotation speed estimation unit after estimating the information, the estimation unit is configured to further estimate a moving speed of the moving body, the first and second detection values ​​of the angular velocity detector in the current estimation operation, first, the detection value of the second and third acceleration detector, the rear wheel rotation speed estimation unit estimates the estimated value of the roll angle from the previous estimation operation, the estimated value of the offset error due to previous estimation operation and the previous based on the estimated value of the moving speed by estimation operation, the roll angle of the moving object may be estimated movement speed of at least one offset error and mobile.
移動体が小さい半径で低速で旋回する場合には、前輪の旋回半径は後輪の旋回半径に比べて大きくなる。 When turning at a low speed in mobile small radius, front turning radius becomes larger than the turning radius of the rear wheel. それにより、前輪回転速度検出器により検出される前輪の回転速度は後輪の回転速度に比べて高くなる。 Thereby, the front wheel rotation speed detected by the wheel rotational speed detector is higher than the rotational speed of the rear wheels. そこで、前輪回転速度検出器の検出値から後輪回転速度推定部により後輪の回転速度が推定される。 Therefore, the rotational speed of the rear wheels is estimated by the rear wheel rotation speed estimation unit from the detected value of the front wheel rotational speed detector. それにより、前輪回転速度検出器が設けられた場合にも、後輪回転速度検出器が設けられた場合と同様に、移動体のロール角、少なくとも1つのオフセット誤差および移動体の移動速度を高い精度で推定することが可能となる。 Thereby, even when the front wheel rotational speed detector is provided, as in the case where the rear wheel rotational speed detector is provided, the roll angle of the moving object, a higher moving speed of the at least one offset error and mobile It can be estimated with accuracy.
(9)推定部は、現在の推定動作において第1および第2の角速度検出器の検出値、第1、第2および第3の加速度検出器の検出値、速度情報検出器の検出値、前回の推定動作によるロール角の推定値ならびに前回の推定動作によるオフセット誤差の推定値の関係を用いて移動体のロール角および少なくとも1つのオフセット誤差を推定するカルマンフィルタを含んでもよい。 (9) estimation unit, first and second detection values ​​of the angular velocity detector in the current estimation operation, first, the detection value of the second and third acceleration detectors, the detection value of the speed information detector, the last the estimation operation may include a Kalman filter for estimating the roll angle and at least one offset error of the moving object by using the relationship between the estimated value of the offset error by the estimation value and the previous estimation operation of the roll angle by.
この場合、カルマンフィルタのアルゴリズムを用いることにより推定部を容易に実現することができる。 In this case, it is possible to easily realize the estimator by using the algorithm of the Kalman filter.
(10)第2の発明に係る輸送機器は、移動可能に構成された移動体と、移動体のロール角を推定する第1の発明に係るロール角推定装置と、ロール角推定装置により推定されたロール角を用いた処理を行う処理部とを備えたものである。 (10) transport device according to the second invention, the movable body that is movable in the roll angle estimation apparatus according to the first invention for estimating the roll angle of the moving object is estimated by the roll angle estimation device and those having a processing unit for performing processing using the roll angle.
その輸送機器においては、第1の発明に係るロール角推定装置により移動体のロール角が高い精度で推定される。 In its transport equipment, the roll angle of the moving object is estimated with high accuracy by a roll angle estimating apparatus according to the first invention. それにより、処理部によるロール角を用いた処理が高い精度で行われる。 Thus, treatment with the roll angle by the processing unit are carried out with high accuracy.
本発明によれば、移動体のロール角を高い精度で推定することが可能となる。 According to the present invention, it is possible to estimate the roll angle of the moving body with high accuracy.
本発明の一実施の形態に係るロール角推定装置を備えた車両の模式図である。 It is a schematic view of a vehicle provided with a roll angle estimation apparatus according to an embodiment of the present invention. 本発明の一実施の形態に係るロール角推定装置の構成を示すブロック図である。 Is a block diagram showing the configuration of a roll angle estimating apparatus according to an embodiment of the present invention. カルマンフィルタの概念を示す図である。 Is a diagram showing the concept of the Kalman filter. センサ群の取り付け位置を説明するための図である。 It is a diagram for explaining a mounting position of the sensor group. 後輪の断面図である。 It is a cross-sectional view of the rear wheel. センサ群の取り付け位置をベクトルで表した図である。 The mounting position of the sensor group is a diagram showing a vector. ロール角推定装置による各パラメータの推定値の時間遷移を示す図である。 It is a diagram showing a time transition of the estimated values ​​of the parameters by the roll angle estimation device. 各パラメータの推定値の時間遷移を示す図である。 It is a diagram showing a time transition of the estimated value of each parameter. 本発明の他の実施の形態に係るロール角推定装置を備えた車両の模式図である。 It is a schematic view of a vehicle provided with a roll angle estimating apparatus according to another embodiment of the present invention. 車両の旋回時の前輪および後輪の旋回半径を示す図である。 Is a diagram illustrating the turning radius of the front and rear wheels during turning of the vehicle. 前輪速度と後輪速度との関係の計算結果を示す図である。 Is a graph showing the calculation results of the relationship between the front wheel speed and rear wheel speed.
以下、本発明の実施の形態に係るロール角推定装置を車両に適用した例を説明する。 Hereinafter, the roll angle estimating apparatus according to an embodiment of the present invention will be described an example of application to a vehicle.
(1)車両の構成 図1は本発明の一実施の形態に係るロール角推定装置を備えた車両の模式図である。 (1) Configuration FIG. 1 of a vehicle is a schematic view of a vehicle provided with a roll angle estimation apparatus according to an embodiment of the present invention. 図1の車両100は自動二輪車である。 Vehicle 100 in FIG. 1 is a motorcycle.
図1に示すように、車両100は車体1を備える。 As shown in FIG. 1, a vehicle 100 includes a vehicle body 1. 車体1の前部に前輪2が取り付けられ、車体1の後部に後輪3が取り付けられる。 Front wheel 2 is attached to the front portion of the vehicle body 1, the rear wheel 3 is attached to the rear portion of the vehicle body 1. また、車体1の中央部には、センサ群5が取り付けられる。 The central portion of the vehicle body 1, a sensor group 5 is attached. センサ群5の詳細については、後述する。 For more information about the sensor group 5 will be described later.
後輪3のホイールに後輪3の回転速度を検出する後輪速度センサ7が取り付けられる。 Wheel speed sensor 7 after detecting the rotational speed of the rear wheel 3 to the rear wheel 3 of the wheel is attached.
車体1の前側の上部には、ハンドル11が左右に揺動可能に設けられる。 On the front side of the upper portion of the vehicle body 1, a handle 11 is provided to be swingable right and left. ハンドル11の近傍にナビゲーションシステム12が設けられる。 Navigation system 12 is provided in the vicinity of the handle 11. また、車体1の前部にはヘッドライト14およびヘッドライト駆動装置15が設けられる。 Further, the headlight 14 and headlight drive 15 is provided on a front portion of the vehicle body 1. ヘッドライト駆動装置15はヘッドライト14の向きを制御する。 Headlight driving device 15 controls the orientation of the headlight 14. 車体1の後部には、電子制御ユニット(以下、ECUと略記する)20が設けられる。 The rear portion of the vehicle body 1, an electronic control unit (hereinafter, abbreviated as ECU) 20 is provided.
センサ群5および後輪速度センサ7の出力信号は、ECU20に与えられる。 The output signal of the sensors 5 and the rear wheel speed sensor 7 is given to the ECU 20. ECU20は、車体1の各部を制御するとともに車体1のロール角を推定し、推定したロール角を例えばナビゲーションシステム12およびヘッドライト駆動装置15に与える。 ECU20 estimates the roll angle of the vehicle body 1 and it controls each section of the vehicle body 1, providing a roll angle estimated for example the navigation system 12 and the headlight drive 15.
本実施の形態では、センサ群5、後輪速度センサ7およびECU20がロール角推定装置を構成する。 In this embodiment, sensors 5, the rear wheel speed sensor 7 and the ECU20 constitute a roll angle estimating apparatus.
(2)ロール角推定装置の構成 図2は本発明の一実施の形態に係るロール角推定装置の構成を示すブロック図である。 (2) Configuration FIG. 2 of the roll angle estimator is a block diagram showing the configuration of a roll angle estimating apparatus according to an embodiment of the present invention.
図2のロール角推定装置10は、センサ群5、後輪速度センサ7、ローパスフィルタ61〜65、微分器71,72およびカルマンフィルタ80により構成される。 Roll angle estimating apparatus 10 of FIG. 2, sensor group 5, the rear wheel speed sensor 7, a low-pass filter 61 to 65, constituted by a differentiator 71, 72 and the Kalman filter 80. カルマンフィルタ80の機能は、図1のECU20およびプログラムにより実現される。 Function of the Kalman filter 80 is realized by ECU20 and program of FIG.
センサ群5は、ロール角速度センサ51、ヨー角速度センサ52、上下加速度センサ53、前後加速度センサ54および左右加速度センサ55を含む。 Sensors 5 includes a roll angular velocity sensor 51, the yaw angular velocity sensor 52, the vertical acceleration sensor 53, longitudinal acceleration sensor 54 and lateral acceleration sensor 55.
ロール角速度センサ51は、車体1のロール角速度を検出するように車体1に設けられる。 Roll angular velocity sensor 51 is provided on the vehicle body 1 so as to detect the roll angular velocity of the vehicle body 1. ロール角速度は、車両100の前後軸周りの角速度である。 Roll angular velocity is an angular velocity around longitudinal axis of the vehicle 100. ヨー角速度センサ52は、車体1のヨー角速度を検出するように車体1に設けられる。 The yaw angular velocity sensor 52 is provided on the vehicle body 1 so as to detect a yaw rate of the vehicle body 1. ヨー角速度は、車両100の上下軸周りの角速度である。 The yaw angular velocity is an angular velocity about the vertical axis of the vehicle 100.
上下加速度センサ53は、車体1の上下加速度を検出するように車体1に設けられる。 Vertical acceleration sensor 53 is provided on the vehicle body 1 so as to detect the vertical acceleration of the vehicle body 1. 上下加速度は、車体1の上下方向の加速度である。 Vertical acceleration is a vertical acceleration of the vehicle body 1. 前後加速度センサ54は、車体1の前後加速度を検出するように車体1に設けられる。 Longitudinal acceleration sensor 54 is provided on the vehicle body 1 so as to detect the longitudinal acceleration of the vehicle body 1. 前後加速度は、車体1の前後方向の加速度である。 Longitudinal acceleration is longitudinal acceleration of the vehicle body 1. 左右加速度センサ55は、車体1の左右加速度を検出するように車体1に設けられる。 Lateral acceleration sensor 55 is provided on the vehicle body 1 so as to detect the lateral acceleration of the vehicle body 1. 左右加速度は、車体1の左右方向の加速度である。 Lateral acceleration is the acceleration in the lateral direction of the vehicle body 1.
ロール角速度センサ51の出力信号は、ローパスフィルタ61を通してロール角速度としてカルマンフィルタ80および微分器71に与えられる。 The output signal of the roll angular velocity sensor 51 is provided through the low-pass filter 61 to the Kalman 80 and differentiator 71 as a roll angular velocity. ローパスフィルタ61は、ロール角速度センサ51の出力信号のノイズを除去する。 Low pass filter 61 removes the noise of the output signal of the roll angular velocity sensor 51. 微分器71は、ロール角速度の微分値をロール角加速度としてカルマンフィルタ80に与える。 Differentiator 71 provides a differential value of the roll angular velocity Kalman filter 80 as the roll angle acceleration. ヨー角速度センサ52の出力信号は、ローパスフィルタ62を通してヨー角速度としてカルマンフィルタ80および微分器72に与えられる。 The output signal of the yaw angular velocity sensor 52 is provided to the Kalman filter 80 and differentiator 72 as yaw rate through a low-pass filter 62. ローパスフィルタ62は、ヨー角速度センサ52の出力信号のノイズを除去する。 Low pass filter 62 removes the noise of the output signal of the yaw angular velocity sensor 52. 微分器72は、ヨー角速度の微分値をヨー角加速度としてカルマンフィルタ80に与える。 Differentiator 72 provides the Kalman filter 80 the differential value of the yaw angular velocity as the yaw angular acceleration.
上下加速度センサ53の出力信号は、ローパスフィルタ63を通して上下加速度としてカルマンフィルタ80に与えられる。 The output signal of the vertical acceleration sensor 53 is provided to the Kalman filter 80 as the vertical acceleration through a low-pass filter 63. 前後加速度センサ54の出力信号は、ローパスフィルタ64を通して前後加速度としてカルマンフィルタ80に与えられる。 The output signal of the longitudinal acceleration sensor 54 is provided to the Kalman filter 80 as longitudinal acceleration through a low-pass filter 64. 左右加速度センサ55の出力信号は、ローパスフィルタ65を通して左右加速度としてカルマンフィルタ80に与えられる。 The output signal of the lateral acceleration sensor 55 is provided to the Kalman filter 80 as lateral acceleration through a low-pass filter 65.
後輪速度センサ7の出力信号は、後輪速度としてカルマンフィルタ80に与えられる。 The output signal of the rear wheel speed sensor 7 is provided to the Kalman filter 80 as the rear wheel speed. 後輪速度は、路面と後輪3のタイヤとの間に滑りが生じないと仮定した場合のタイヤの最外周の回転速度であり、実際には後輪速度センサ7の出力信号およびタイヤのサイズに基づいて算出される。 The rear wheel speed is outermost rotational speed of the tire when the slippage between the tire of the road surface and the rear wheel 3 is assumed to not occur, the actual size of the output signal and the tire of the rear wheel speed sensor 7 It is calculated on the basis of. 説明を簡略化するために、図2では、後輪速度センサ7から後輪速度を示す信号が出力されるものとする。 To simplify the explanation, in FIG. 2, a signal indicating the rear wheel speed from the rear wheel speed sensor 7 is assumed to be output.
ここで、ロール角速度、ロール角加速度、ヨー角速度、ヨー角加速度、上下加速度、前後加速度、左右加速度および後輪速度を下表の符号で表す。 Here, representing the roll angular velocity, roll angle acceleration, yaw rate, yaw angular acceleration, vertical acceleration, longitudinal acceleration, the lateral acceleration and the rear wheel speed below the sign. なお、各パラメータを表す符号の上の1つのドットは1階微分を意味する。 Note that one dot on the code representing each parameter means one derivative.
カルマンフィルタ80は、上記のパラメータに基づいてロール角、車両速度、ロール角速度センサオフセット、ヨー角速度センサオフセットおよび上下加速度センサオフセットを推定して出力する。 Kalman filter 80 is the roll angle, vehicle speed, and roll angular velocity sensor offset estimates the yaw rate sensor offset and vertical acceleration sensor offset output based on the above parameters.
ここで、車両100の進行方向に平行な鉛直面を前後方向鉛直面と呼び、前後方向鉛直面に垂直な鉛直面を左右鉛直面と呼ぶ。 Here, it referred to as the longitudinal direction a vertical plane parallel vertical plane to the traveling direction of the vehicle 100 is called the left and right vertical plane perpendicular vertical plane in the longitudinal direction a vertical plane. ロール角は、左右鉛直面内で重力方向に対する車体1の傾斜角度である。 Roll angle is a tilt angle of the vehicle body 1 with respect to the direction of gravity within the lateral vertical plane. 車両速度は、車体1の進行方向の速度である。 Vehicle speed is a traveling direction of the velocity of the vehicle body 1.
ロール角速度センサオフセットは、ロール角速度センサ51のオフセット誤差であり、ヨー角速度センサオフセットは、ヨー角速度センサ52のオフセット誤差であり、上下加速度センサオフセットは、上下加速度センサ53のオフセット誤差である。 Roll angular rate sensor offset is the offset error of the roll angular velocity sensor 51, yaw rate sensor offset is the offset error of the yaw angular velocity sensor 52, the vertical acceleration sensor offset is the offset error of the vertical acceleration sensor 53.
車両速度、ロール角速度センサオフセット、ヨー角速度センサオフセットおよび上下加速度センサオフセットを下表の符号で表す。 It represents vehicle speed, the roll angular velocity sensor offset, a yaw rate sensor offset and vertical acceleration sensor offset table code.
本実施の形態に係るロール角推定装置10では、ロール角速度センサ51、ヨー角速度センサ52、上下加速度センサ53、前後加速度センサ54、左右加速度センサ55および後輪速度センサ7を用いて後述する式(17),(18)の5つの関係式が導出される。 In roll angle estimating apparatus 10 according to the present embodiment, the roll angular velocity sensor 51, the yaw angular velocity sensor 52, the vertical acceleration sensor 53 will be described later with reference to the longitudinal acceleration sensor 54, lateral acceleration sensor 55 and the rear wheel speed sensor 7 formula ( 17), it is derived five relational expressions (18). これらの関係式を用いてロール角φおよび車両速度V xという2つのパラメータが推定される。 Two parameters roll angle φ and the vehicle speed V x is estimated by using these relational expressions. すなわち、関係式の数と推定される出力の数との間に冗長性が存在する。 That is, there is redundancy between the number of outputs is estimated that the number of relations. 言い換えると、関係式の数が推定する出力の数よりも多い。 In other words, more than the number of outputs the number of relational expressions is estimated. この冗長性を利用してロール角速度センサオフセットb r 、ヨー角速度センサオフセットb yおよび上下加速度センサオフセットb zを推定することが可能となる。 Roll angular rate sensor offset b r by utilizing this redundancy, it is possible to estimate the yaw rate sensor offset b y and the vertical acceleration sensor offset b z.
(3)カルマンフィルタ80の構成 図3はカルマンフィルタ80の概念を示す図である。 (3) Configuration FIG 3 of the Kalman filter 80 is a diagram showing the concept of the Kalman filter 80. 図3のカルマンフィルタ80では、以下に説明する車両100の運動学モデルが用いられる。 In the Kalman filter 80 of FIG. 3, kinematic model of the vehicle 100 to be described below is used.
図3において、カルマンフィルタ80は、システム方程式8a、加算機能8b、積分機能8c、観測方程式8d、減算機能8eおよびカルマンゲイン8fにより構成される。 3, the Kalman filter 80 is configured system equation 8a, summing function 8b, integral function 8c, observation equation 8d, the subtraction function 8e and Kalman gain 8f. システム方程式8aは関数f(x,u)を含み、観測方程式8dは関数h(x)を含み、カルマンゲイン8fは5次のカルマンゲインKを含む。 System equation 8a includes a function f (x, u), observation equation 8d includes a function h (x), the Kalman gain 8f includes a fifth-order Kalman gain K.
現在の推定動作において、システム方程式8aの入力パラメータuとして、ロール角速度ω rの検出値、ロール角加速度(ロール角速度ω rの微分値)の検出値、ヨー角速度ω yの検出値、ヨー角加速度(ヨー角速度ω yの微分値) の検出値および前後加速度G xの検出値が与えられる。 In the current estimation operation, as an input parameter u of the system equations 8a, the detection value of the roll angular velocity omega r, the detected value of the roll angular acceleration (differential value of the roll angular velocity omega r), the detection value of the yaw angular velocity omega y, the yaw angular acceleration detection values of the detected value and the longitudinal acceleration G x of (differential value of the yaw angular velocity omega y) is given. また、システム方程式8aの入力パラメータxとして、前回の推定動作によるロール角φの推定値、車両速度V xの推定値、ロール角速度センサオフセットb rの推定値、ヨー角速度センサオフセットb yの推定値および上下加速度センサオフセットb zの推定値が与えられる。 Further, as an input parameter x of the system equations 8a, the estimated value of the roll angle φ from the previous estimation operation, the estimated value of the vehicle speed V x, the estimated value of the roll angular velocity sensor offset b r, estimated value of the yaw angular velocity sensor offset b y and estimated value of the vertical acceleration sensor offset b z is given. システム方程式8aの出力は、ロール角φの微分値、車両速度V xの微分値、ロール角速度センサオフセットb rの微分値、ヨー角速度センサオフセットb yの微分値および上下加速度センサオフセットb zの微分値である。 The output of the system equations 8a is the differential value of the roll angle phi, the differential value of the vehicle speed V x, the differential value of the roll angular velocity sensor offset b r, differentiation of the differential value and the vertical acceleration sensor offset b z of the yaw rate sensor offset b y is the value.
ロール角φの微分値、車両速度V xの微分値、ロール角速度センサオフセットb rの微分値、ヨー角速度センサオフセットb yの微分値および上下加速度センサオフセットb zの微分値に前回の推定動作により得られた5次のカルマンゲインKが加算される。 Differential value of the roll angle phi, the differential value of the vehicle speed V x, the differential value of the roll angular velocity sensor offset b r, the previous estimation operation on the differential value of the differential value and the vertical acceleration sensor offset b z of the yaw rate sensor offset b y the resulting 5-order Kalman gain K is added.
カルマンゲインKが加算されたロール角φの微分値、車両速度V xの微分値、ロール角速度センサオフセットb rの微分値、ヨー角速度センサオフセットb yの微分値および上下加速度センサオフセットb zの微分値が積分されることにより、現在の推定動作によるロール角φの推定値、車両速度V xの推定値、ロール角速度センサオフセットb rの推定値、ヨー角速度センサオフセットb yの推定値および上下加速度センサオフセットb zの推定値が得られる。 Kalman gain K differential value of the roll angle φ of the addition, the differential value of the vehicle speed V x, the differential value of the roll angular velocity sensor offset b r, the differential value and the vertical acceleration sensor offset b z of the yaw rate sensor offset b y differential by the value is integrated, the estimated value of the roll angle φ with the current estimation operation, the estimated value of the vehicle speed V x, the estimated value of the roll angular velocity sensor offset b r, estimate and vertical acceleration of the yaw rate sensor offset b y estimate of sensor offset b z is obtained.
また、観測方程式8dの入力パラメータxとして、ロール角φの推定値、車両速度V xの推定値、ロール角速度センサオフセットb rの推定値、ヨー角速度センサオフセットb yの推定値および上下加速度センサオフセットb zの推定値が与えられる。 Further, as an input parameter x of the observation equation 8d, the estimated value of the roll angle phi, the estimated value of the vehicle speed V x, the roll angular velocity sensor offset b estimate of r, estimate and vertical acceleration sensor offset of the yaw angular velocity sensor offset b y estimate of b z is given. 観測方程式8dから上下加速度G zの算出値、左右加速度G yの算出値および後輪速度v rの算出値が得られる。 Calculated value of the vertical acceleration G z from the observation equation 8d, the calculated value of the calculated value and rear wheel speed v r of the lateral acceleration G y is obtained.
また、カルマンフィルタ80には、入力パラメータyとして上下加速度G zの検出値、左右加速度G yの検出値および後輪速度v rの検出値が与えられる。 Also, the Kalman filter 80, the detection value of the vertical acceleration G z as an input parameter y, the detection value of the detection value and the rear wheel velocity v r of the lateral acceleration G y is given. 上下加速度G z 、左右加速度G yおよび後輪速度v rの検出値と算出値との差に基づいてカルマンゲインKが算出される。 Vertical acceleration G z, Kalman gain K is calculated based on the difference between the detected value and the calculated value of the lateral acceleration G y and the rear wheel speed v r.
この運動学モデルのシステム方程式8aおよび観測方程式8dを導出することにより、入力パラメータu,yと出力パラメータxとの関係式を導くことができる。 By deriving the system equations 8a and observation equation 8d of the kinematic model, can be derived equation input parameters u, y and the output parameter x.
(4)システム方程式および観測方程式の導出 本実施の形態では、運動学モデルを簡単化するために以下の点を仮定する。 (4) In the system equation and deriving the embodiment of the observation equation, assume the following points in order to simplify the kinematic model.
(a)車両100はピッチングしない。 (A) vehicle 100 is not pitching.
(b)後輪3と路面との間に回転方向の滑りは生じない。 (B) sliding in a rotational direction between the rear wheel 3 and the road surface does not occur.
(c)後輪3の横滑り速度は0である。 (C) side-slip velocity of the rear wheels 3 is 0.
(d)路面は平坦でかつ傾斜していない。 (D) the road surface is not flat and inclined.
これらの仮定(a)〜(d)に基づいて以下のようにして運動学モデル式を導出する。 As it follows, based on these assumptions (a) ~ (d) deriving a kinematic model equation.
ロール角、ロール角の微分値、ピッチ角、ピッチ角の微分値、ヨー角、ヨー角の微分値、ロール角速度、ヨー角速度およびピッチ角速度を下表の符号で表す。 Roll angle represents the differential value of the roll angle, pitch angle, the differential value of the pitch angle, yaw angle, the differential value of the yaw angle, roll velocity, the yaw angular velocity and the pitch angular velocity in the table below the sign.
まず、一般的なオイラー角と角速度との関係式から次式が成立する。 First, the following equation from equation with common Euler angles and the angular velocity is satisfied.
上記の仮定(a)からピッチ角およびその微分値は0となる。 Pitch angle and the differential value from the assumption (a) above is zero. したがって、上式(1)は次式のようになる。 Therefore, the above equation (1) becomes the following equation.
上式(2)の2行目よりピッチ角速度ω pを削除することができる。 It is possible to remove the pitch angular velocity ω p from the second row of the above equation (2). それにより、次式が求まる。 As a result, it is obtained the following equation.
図4はセンサ群5の取り付け位置を説明するための図である。 Figure 4 is a diagram for explaining the mounting positions of the sensor group 5. 図4の左側に車両100の左側面を示し、右側に車両100の正面を示す。 On the left side of FIG. 4 shows a left side of the vehicle 100, a front of the vehicle 100 on the right. 図5は後輪3の断面図である。 Figure 5 is a cross-sectional view of the rear wheel 3. 図6はセンサ群5の取り付け位置をベクトルで表した図である。 6 is a view showing the mounting position of the sensor group 5 in a vector.
図4において、センサ群5の取り付け位置をPSとする。 4, the mounting position of the sensor group 5 and PS. 取り付け位置PSから後輪3の中心までの水平距離をLとし、路面から取り付け位置PSまでの高さをhとする。 The horizontal distance from the mounting position PS to the center of the rear wheel 3 is L, the height from the road surface to the mounting position PS and h.
図5においては、後輪3は路面RDに対してロール角φ傾斜している。 In FIG. 5, the rear wheel 3 are rolling angle φ inclined to the road surface RD. 上記の仮定(d)より路面RDは傾斜していない。 The road surface RD than the above assumption (d) are not inclined. 後輪3のタイヤTRと路面RDとの接地点をPとする。 The ground point of the tire TR and the road surface RD of the rear wheel 3, P. また、後輪3のタイヤTRの断面の半径をR crとし、後輪3の半径をR eとする。 Moreover, the radius of the cross section of the tire TR of the rear wheel 3 and R cr, the radius of the rear wheel 3 and R e.
図6において、慣性座標系の原点Oを基準とするセンサ群5の取り付け位置PSの位置ベクトルをrvとし、慣性座標系の原点Oを基準とする接地点Pの位置ベクトルをrv 0とし、接地点Pからセンサ群5の取り付け位置PSまでのベクトルをρvとする。 6, the position vector of the mounting position PS of the sensor group 5 relative to the origin O of the inertial coordinate system and rv, the position vector of the ground contact point P relative to the origin O of the inertial coordinate system and rv 0, tangent a vector from the point P to the mounting position PS of the sensor group 5 and [rho] v. この場合、rv=rv 0 +ρvが成り立つ。 In this case, holds true rv = rv 0 + ρv.
ここで、位置ベクトルrvの2階微分ベクトル、位置ベクトルrv 0の2階微分ベクトル、ベクトルρvの2階微分ベクトルおよび重力加速度ベクトルを下表の符号で表す。 Here, representing the second-order differential vector of the position vector rv, second derivative vector of the position vector rv 0, the second-order differential vectors and the gravitational acceleration vector Vector ρv in the following table code. なお、各パラメータを表す符号の上の2つのドットは2階微分を意味する。 Incidentally, two dots on the code representing each parameter means second derivative.
ここで、取り付け位置PSの上下加速度センサ53、前後加速度センサ54および左右加速度センサ55により検出される加速度ベクトルをGvとする。 Here, the vertical acceleration sensor 53 of the mounting position PS, the acceleration vector detected by the longitudinal acceleration sensor 54 and lateral acceleration sensor 55 and Gv. 加速度ベクトルをGvは、次式のように、位置ベクトルrvの2階微分ベクトルに重力加速度ベクトルを加算することにより得られる。 The acceleration vector Gv, as follows, are obtained by adding the gravitational acceleration vector to second derivative vector of the position vector rv.
以下、上式(4)の右辺を算出する。 Hereinafter, it calculates the right side of the above equation (4). 図6のベクトルρvは、次式で表される。 Vector ρv 6 is represented by the following equation.
上式(5)において、[e]=[e 1 ,e 2 ,e 3 ]である。 In the above formula (5), a [e] = [e 1, e 2, e 3]. e 1 、e 2およびe 3は、車体1に固定された基底ベクトルであり、e 1は車体1の前方向の基底ベクトルであり、e 2は車体1の左方向の基底ベクトルであり、e 3は車体1の垂直上方向の基底ベクトルである。 e 1, e 2 and e 3 are basis vectors which is fixed to the vehicle body 1, e 1 is the basis vector of the previous direction of the vehicle body 1, e 2 is the basis vectors of the left direction of the vehicle body 1, e 3 is a basis vector in the vertical upward direction of the vehicle body 1. また、ρは行列である。 In addition, ρ is a matrix. 上式(5)の行列ρは、図4および図5より次式で表される。 Matrix ρ of the equation (5) is represented by the following formula from FIGS.
上式(6)からベクトルρvの2階微分ベクトルは次式のように求まる。 Second differentiation Vector ρv from the above equation (6) is obtained by the following equation.
上式(7)において、a x 、a yおよびa zは関数である。 In the above equation (7), a x, a y and a z is a function. 関数a x ,a y ,a zは上式(5)および(6)を計算することにより求めることができる。 Function a x, a y, a z can be determined by calculating the above equation (5) and (6). 上式(6)から上式(7)への変形の際に上式(3)を用いることによりロール角φの微分値およびヨー角ψの微分値を消去することができる。 Can be erased differential value and the differential value of the yaw angle ψ of the roll angle φ by using the above equation (3) during the deformation of the above equation (7) from the above equation (6).
次に、車両100の横滑り速度をV yとする。 Next, the side-slip velocity of the vehicle 100 and V y. 図6の位置ベクトルrv 0の1階微分ベクトルは、車両速度V xおよび横滑り速度をV yを用いて次式のように表される。 First-order differential vector of the position vector rv 0 in FIG. 6, the vehicle speed V x and side-slip velocity by using a V y is expressed by the following equation.
上式(8)において、[e0]=[e0 1 ,e0 2 ,e0 3 ]である。 In the above equation (8), a [e0] = [e0 1, e0 2, e0 3]. e0 1 、e0 2およびe0 3は、慣性座標系の基底ベクトル[e]=[e 1 ,e 2 ,e 3 ]をヨー角ψのみ回転させることにより得られる基底ベクトルである。 e0 1, e0 2 and e0 3 are the basis vectors obtained by rotating the base vector of the inertial coordinate system [e] = [e 1, e 2, e 3] only the yaw angle [psi.
仮定(c)からV y =0とし、上式(8)を1階微分すると、位置ベクトルrv 0の2階微分ベクトルは次式のように表される。 And the assumption (c) and V y = 0, is differentiated above equation (8) first floor, second derivative vector of the position vector rv 0 is expressed by the following equation.
最後に、重力加速度ベクトルは次式のように表される。 Finally, the gravitational acceleration vector is expressed by the following equation.
上式(10)においては、gは重力加速度の大きさである。 In the above equation (10), g is the magnitude of the gravitational acceleration.
上式(4),(7),(9),(10)から取り付け位置PSにおいて検出される加速度ベクトルGvは次式のように表される。 Equation (4), (7), (9), the acceleration vector Gv detected at the mounting position PS from (10) is expressed by the following equation.
ここで、取り付け位置PSで検出される加速度ベクトルGvは、前後加速度センサ54により検出される前後加速度G x 、左右加速度センサ55により検出される左右加速度G y 、および上下加速度センサ53により検出される上下加速度G zを用いて次式のように表される。 Here, the acceleration vector Gv detected by the mounting position PS is detected by the lateral acceleration G y and the vertical acceleration sensor 53, is detected by the longitudinal acceleration G x, lateral acceleration sensor 55 which is detected by the longitudinal acceleration sensor 54 with vertical acceleration G z is expressed by the following equation.
したがって、上式(11)より、前後加速度G x 、左右加速度G y 、および上下加速度G zは次式のようになる。 Therefore, the above equation (11), the longitudinal acceleration G x, left right acceleration G y, or down and acceleration G z is expressed by the following equation.
次に、後輪速度v rと車両速度V xとの関係を求める。 Next, determine the relationship between the rear wheel speed v r and the vehicle speed V x. 上記の仮定(b)から後輪3と路面との間に滑りがないので、図5から後輪速度v rと車両速度V xとの間には次式の関係が成り立つ。 Since there is no slip between the rear wheels 3 and the road surface from the assumption (b), the following relation holds between the rear wheel speed v r and the vehicle speed V x from FIG.
上式(13)から次式が求まる。 The following equation is obtained from the above equation (13).
上式(3),(12),(14)から次式が求まる。 The above equation (3), (12), the following equation is obtained from (14).
上式(15)をシステム方程式として用い、上式(16)を観測方程式として用いることにより、拡張カルマンフィルタを適用することが可能となる。 Using the above equation (15) as a system equation, by using the above equation (16) as the observation equation, it is possible to apply an extended Kalman filter.
さらに、ロール角速度センサオフセットb r 、ヨー角速度センサオフセットb yおよび上下加速度センサオフセットb zが変化する場合でも、それらの値の変化は車両100の動きに比べて遅い。 Furthermore, even when the roll angular velocity sensor offset b r, yaw rate sensor offset b y and the vertical acceleration sensor offset b z is changed, a change in their values is slow compared to the movement of the vehicle 100. そのため、ロール角速度センサオフセットb rの微分値、ヨー角速度センサオフセットb yの微分値および上下加速度センサオフセットb zの微分値を0とみなすことができる。 Therefore, the differential value of the roll angular velocity sensor offset b r, a differential value of the differential value and the vertical acceleration sensor offset b z of the yaw rate sensor offset b y can be regarded as zero.
また、上式(15),(16)のロール角速度ω r 、ヨー角速度ω yおよび上下加速度G zをそれぞれω r −b r 、ω y −b yおよびG z −b zで置き換えることにより次式を導出することができる。 Further, the above equation (15), following by replacing the roll angular velocity omega r, yaw angular velocity omega y and the vertical acceleration G z, respectively ω r -b r, ω y -b y and G z -b z (16) it is possible to derive the formula.
上式(17),(18)では、ロール角速度センサオフセットb r 、ヨー角速度センサオフセットb yおよび上下加速度センサオフセットb zが考慮されている。 The above equation (17) and (18), the roll angular velocity sensor offset b r, yaw rate sensor offset b y and the vertical acceleration sensor offset b z is considered.
上式(17)をシステム方程式とし、上式(18)を観測方程式として、拡張カルマンフィルタを適用することにより、ロール角φ、車両速度V x 、ロール角速度センサオフセットb r 、ヨー角速度センサオフセットb yおよび上下加速度センサオフセットb zを推定することができる。 The above equation (17) as a system equation, the above equation (18) as the observation equation, by applying an extended Kalman filter, the roll angle phi, the vehicle speed V x, the roll angular velocity sensor offset b r, yaw rate sensor offset b y and it is possible to estimate the vertical acceleration sensor offset b z.
ここで、上式(17)の右辺が図3の関数f(x,u)に相当し、上式(18)の右辺が図3の関数h(x)に相当する。 Here, the right side of the equation (17) corresponds to the function f (x, u) in FIG. 3, right side of the above equation (18) corresponds to the function h (x) in FIG.
角速度センサでは、加速度センサに比べてオフセット誤差が発生しやすい。 In the angular velocity sensor, the offset error is likely to occur as compared with the acceleration sensor. したがって、本実施の形態では、ロール角速度センサ51のオフセット誤差(ロール角速度センサオフセットb r )およびヨー角速度センサ52のオフセット誤差(ヨー角速度センサオフセットb y )が推定される。 Therefore, in the present embodiment, the offset error of the roll angular velocity sensor 51 (the roll angular velocity sensor offset b r) and the offset error of the yaw angular velocity sensor 52 (yaw rate sensor offset b y) is estimated. ロール角速度センサオフセットb rおよびヨー角速度センサオフセットb yの推定値を次の推定動作の際に用いることによりロール角φの推定精度が十分に向上する。 Estimation accuracy of the roll angle φ is sufficiently improved by the use of the estimated value of the roll angular velocity sensor offset b r and the yaw angular velocity sensor offset b y during the next estimation operation.
また、3つの加速度センサ(上下加速度センサ53、前後加速度センサ54および左右加速度センサ55)のオフセット誤差を推定することができれば、ロール角φの推定精度がさらに向上することが期待される。 Further, three acceleration sensors (vertical acceleration sensor 53, longitudinal acceleration sensor 54 and lateral acceleration sensor 55) if it is possible to estimate the offset error, it is expected that the estimation accuracy of the roll angle φ is further improved. しかしながら、3つの加速度センサのオフセット誤差を推定する場合には、可観測性を保つことはできない。 However, in the case of estimating the offset error of the three acceleration sensors can not maintain the observability. そこで、本実施の形態では、次の理由により上下加速度センサ53のオフセット誤差(上下加速度センサオフセットb z )を推定する。 Therefore, in the present embodiment, to estimate the offset error of the vertical acceleration sensor 53 for the following reasons (the vertical acceleration sensor offset b z). 車体1のロール角φが小さい範囲では、車体1の上下加速度はほとんど変化しない。 In the range roll angle φ of the vehicle body 1 is small, the vertical acceleration of the vehicle body 1 is hardly changed. このような上下加速度の検出値が上下加速度センサオフセットb zにより変化した場合、ロール角φの推定の際に上下加速度の検出値の変化の影響が大きくなる。 If the detected value of such vertical acceleration is changed by the vertical acceleration sensor offset b z, influence of change in the detected values of vertical acceleration at the time of estimation of the roll angle φ increases. したがって、上下加速度センサオフセットb zの推定値を次の推定動作の際に用いることにより、ロール角φの小さい範囲での推定精度がさらに向上する。 Accordingly, by using the estimated value of the vertical acceleration sensor offset b z at the next estimation operation, the estimation accuracy of a small range of the roll angle φ is further improved.
(5)各パラメータの推定値の算出 図7および図8はロール角速度センサ51がオフセット誤差を有する場合および有しない場合における各パラメータの推定値の時間遷移を示す図である。 (5) calculating FIGS. 7 and 8 the estimated values ​​of the parameters is a diagram showing a time transition of the estimated value of each parameter in the case when and without roll angular velocity sensor 51 has an offset error.
ここでは、車両100にオフセット誤差を有しないロール角速度センサ51、ヨー角速度センサ52、上下加速度センサ53、前後加速度センサ54、左右加速度センサ55および後輪速度センサ7を取り付け、 車両100の実際の走行中に得られたロール角速度センサ51、ヨー角速度センサ52、上下加速度センサ53、前後加速度センサ54、左右加速度センサ55および後輪速度センサ7の検出値に基づいて各パラメータの推定値を算出した。 Here, the roll angular velocity sensor 51 having no offset error in the vehicle 100, the yaw rate sensor 52, fitted with a vertical acceleration sensor 53, longitudinal acceleration sensor 54, lateral acceleration sensor 55 and the rear wheel speed sensor 7, the actual running of the vehicle 100 the roll angular velocity sensor 51 obtained during the yaw rate sensor 52, the vertical acceleration sensor 53, and calculates an estimated value of each parameter based on the detected value of the longitudinal acceleration sensor 54, lateral acceleration sensor 55 and the rear wheel speed sensor 7. また、ロール角速度センサ51の検出値に3deg/sのオフセット誤差を付加し、各パラメータの推定値を算出した。 Further, the detection value of the roll angular velocity sensor 51 by adding an offset error of 3 deg / s, were calculated estimated values ​​of the parameters. 図7はロール角φおよび車両速度V xの推定値を示し、図8はロール角速度センサオフセットb r 、ヨー角速度センサオフセットb yおよび上下加速度センサオフセットb zの推定値を示す。 Figure 7 shows an estimate of the roll angle φ and the vehicle speed V x, Figure 8 shows an estimate of the roll angular velocity sensor offset b r, yaw rate sensor offset b y and the vertical acceleration sensor offset b z.
符号L0は、ロール角速度センサ51 の検出値にオフセット誤差が付加されない場合における各パラメータの推定値を示し、Loffは、ロール角速度センサ51の検出値にオフセット誤差が付加された場合における各パラメータの推定値を示す。 Reference numeral L0 indicates the estimated values of each parameter when the the detected value of the roll angular velocity sensor 51 is not added offset error, Loff is the estimation of the parameters in the case where the offset error is added to the detected value of the roll angular velocity sensor 51 It shows the value.
図7に示すように、ロール角速度センサ51の検出値にオフセット誤差が付加された場合におけるロール角φの推定値は、短時間でロール角速度センサ51の検出値にオフセット誤差が付加されない場合におけるロール角φの推定値に一致している。 As shown in FIG. 7, the roll when the roll estimate of the roll angle φ in the case where the offset error is added to the detected value of the angular velocity sensor 51 is not short time added offset error of the detected value of the roll angular velocity sensor 51 It coincides with the estimated value of the angular φ. また、ロール角速度センサ51の検出値にオフセット誤差が付加された場合における車両速度V xの推定値は、ロール角速度センサ51の検出値にオフセット誤差が付加されない場合における車両速度V xの推定値にほぼ一致している。 Also, the estimated value of the vehicle speed V x in the case where the offset error is added to the detected value of the roll angular velocity sensor 51, the estimated value of the vehicle speed V x in a case where the detected value of the roll angular velocity sensor 51 is not added offset error It is almost the same.
図8に示すように、ロール角速度センサ51検出値にオフセット誤差が付加された場合におけるロール角速度センサオフセットb rの推定値とロール角速度センサ51の検出値にオフセット誤差が付加されない場合におけるロール角速度センサオフセットb r の推定値との差はオフセット誤差の値(3deg/s)に等しくなる。 As shown in FIG. 8, the roll angular velocity sensor when the the detected value of the roll angular velocity sensor offset b estimate of r and the roll angular velocity sensor 51 in the case where the offset error is added to the roll angular velocity sensor 51 detects values not added offset error the difference between the estimated value of the offset b r is equal to the value of the offset error (3deg / s).
なお、ヨー角速度センサオフセットb yおよび上下加速度センサオフセットb zの推定値は、ロール角速度センサ51の検出値にオフセット誤差が付加されない場合にも付加された場合にもほぼ0となった。 Incidentally, the estimated value of the yaw angular velocity sensor offset b y and the vertical acceleration sensor offset b z became almost 0 even when it is added even if the offset error is not added to the detected value of the roll angular velocity sensor 51.
このように、本実施の形態に係るロール角推定装置10によれば、ロール角速度センサ51がオフセット誤差を有する場合でも、ロール角φを高精度で推定することができることがわかる。 Thus, according to the roll angle estimating apparatus 10 according to this embodiment, even when the roll angular velocity sensor 51 has an offset error, it is understood that it is possible to estimate the roll angle φ with high accuracy.
(6)実施の形態の効果 本実施の形態に係るロール角推定装置10によれば、ロール角φおよび車両速度V xとともにロール角速度センサオフセットb r 、ヨー角速度センサオフセットb yおよび上下加速度センサオフセットb zが推定され、ロール角速度センサオフセットb r 、ヨー角速度センサオフセットb yおよび上下加速度センサオフセットb zの推定値が次の推定動作の際に用いられる。 (6) According to the roll angle estimating apparatus 10 according to the effect the present embodiment of the embodiment, the roll angular velocity with the roll angle φ and the vehicle speed V x sensor offset b r, yaw rate sensor offset b y and the vertical acceleration sensor offset b z is estimated, the roll angular velocity sensor offset b r, estimated value of the yaw angular velocity sensor offset b y and the vertical acceleration sensor offset b z is used when the next estimation operation. それにより、ロール角速度センサオフセットb r 、ヨー角速度センサオフセットb yおよび上下加速度センサオフセットb zによるロール角φの推定精度の低下が補償される。 Thereby, the roll angular velocity sensor offset b r, decrease in the estimation accuracy of the roll angle φ by the yaw rate sensor offset b y and the vertical acceleration sensor offset b z is compensated. その結果、ロール角φを高い精度で推定することが可能となる。 As a result, it is possible to estimate the roll angle φ with high accuracy.
また、加速度センサに比べてオフセットが発生しやすいロール角速度センサ51およびヨー角速度センサ52のオフセット誤差の推定値が次の推定動作に用いられる。 Also, the estimated value of the offset error of the offset easily occurs roll angular velocity sensor 51 and yaw rate sensor 52 as compared to the acceleration sensor is used in the next estimation operation. それにより、ロール角φの推定精度が十分に向上する。 Thereby, the estimation accuracy of the roll angle φ is sufficiently improved.
さらに、上下加速度センサ53のオフセット誤差の推定値が次の推定動作の際に用いられる。 Furthermore, the estimated value of the offset error of the vertical acceleration sensor 53 is used when the next estimation operation. それにより、ロール角φの小さい範囲での推定精度がさらに向上する。 Thereby, the estimation accuracy of a small range of the roll angle φ is further improved.
また、後輪速度センサ7により検出される後輪速度v rの検出値が推定動作に用いられる。 The detection value of the wheel speed v r after being detected by the rear wheel speed sensor 7 is used for estimation operation. それにより、車両100が小さい半径で低速で旋回する場合でも、車体1のロール角φ、ロール角速度センサオフセットb r 、ヨー角速度センサオフセットb y 、上下加速度センサオフセットb zおよび車両速度V xを高い精度で推定することが可能となる。 Thereby, even when turning at low speed in a radius the vehicle 100 is small, the roll angle of the vehicle body 1 phi, the roll angular velocity sensor offset b r, yaw rate sensor offset b y, the vertical acceleration sensor offset b z and the vehicle speed V x high It can be estimated with accuracy.
このように、ロール角推定装置10により車体1のロール角φが高い精度で推定される。 Thus, the roll angle φ of the vehicle body 1 is estimated with high accuracy by a roll angle estimating apparatus 10. それにより、ECU20により推定されたロール角φに基づいてナビゲーションシステム12およびヘッドライト駆動装置15が正確に動作する。 Thereby, the navigation system 12 and the head light driving device 15 to operate correctly, based on φ roll angle estimated by the ECU 20.
(7)他の実施の形態 (a)上記実施の形態に係るロール角推定装置10では、後輪3のホイールに後輪3の回転速度を検出する後輪速度センサ7が取り付けられるが、図9に示すように、後輪速度センサ7の代わりに前輪2のホイールに前輪2の回転速度を検出する前輪速度センサ6が取り付けられてもよい。 (7) In the roll angle estimating apparatus 10 according to another embodiment (a) above embodiment, wheel speed sensor 7 after detecting the rotational speed of the rear wheel 3 to the rear wheel 3 of the wheel is attached, FIG. as shown in 9, a front wheel speed sensor 6 for detecting the rotational speed of the front wheel 2 to wheel 2 wheels instead of the rear wheel speed sensor 7 may be attached. 図9は本発明の他の実施の形態に係るロール角推定装置を備えた車両の模式図である。 Figure 9 is a schematic view of a vehicle provided with a roll angle estimating apparatus according to another embodiment of the present invention. すなわち、上記実施の形態では、後輪速度センサ7により検出される後輪速度v rが用いられるが、後輪速度センサ7により検出される後輪速度v rの代わりに、図9に示される前輪速度センサ6により検出される前輪速度から後輪速度v rが推定されてもよい。 That is, in the above embodiment, the wheel speed v r after being detected by the rear wheel speed sensor 7 is used, instead of the wheel speed v r after being detected by the rear wheel speed sensor 7, shown in Figure 9 rear wheel speed v r from the front wheel speed detected may be estimated by the front wheel speed sensor 6.
車両100が小さい半径で低速で旋回する場合には、前輪2の旋回半径は後輪3の旋回半径に比べて大きくなる。 When turning at low speed in a radius the vehicle 100 is low, turning radius of the front wheel 2 is larger than the turning radius of the rear wheel 3. それにより、前輪速度センサ6により検出される前輪2の回転速度は後輪3の回転速度に比べて高くなる。 Thereby, the rotational speed of the front wheel 2 detected by the front wheel speed sensor 6 becomes higher than the rotational speed of the rear wheel 3. そこで、前輪速度センサ6により検出される前輪2の回転速度からECU20により後輪速度v rが推定される。 Therefore, the rear wheel speed v r can be estimated by the ECU20 from the rotational speed of the front wheel 2 detected by the front wheel speed sensor 6.
図10は車両100の旋回時の前輪2および後輪3の旋回半径を示す図である。 Figure 10 is a diagram illustrating the turning radius of the front wheel 2 and rear wheels 3 at the time of turning of the vehicle 100. 上記の仮定(c)より後輪3の横滑り速度は0であるため、前輪2の旋回半径r fと後輪3の旋回半径r rとの間には次式の関係が成り立つ。 Since the above side-slip velocity assumption (c) from the rear wheel 3 of a 0, the following equation of relationship between the turning radius r r of the front wheels 2 turning radius r f and the rear wheel 3 is established.
ここで、Laは車両100のホイールベース長である。 Here, La is the wheel base length of the vehicle 100. 上式(19)より次式が得られる。 The following equation from the above equation (19) is obtained.
前輪2の接地点の速度V fと後輪3の接地点の速度V rとの比は前輪2の旋回半径r fと後輪3の旋回半径r rと等しくなる。 The ratio of the velocity V r of the ground point of the velocity V f and the rear wheel 3 of the ground contact point of the front wheel 2 is equal to the turning radius r r of the rear wheel 3 and the turning radius r f of the front wheel 2. したがって、次式が成り立つ。 Therefore, the following equation holds.
さらに、車両100が定常旋回していると仮定すると、後輪3の旋回半径r rは後輪3の接地点の速度V rおよびロール角φを用いて次式で表される。 Further, when the vehicle 100 is assumed to be steady turning, turning radius r r of the rear wheel 3 is represented by the following equation using the velocity V r and the roll angle φ of the ground contact point of the rear wheel 3.
上式(22)において、gは重力加速度の大きさである。 In the above equation (22), g is the magnitude of the gravitational acceleration. 上式(22)を上式(21)に代入すると、次式が導き出される。 Substituting the above equation (22) in the above equation (21), the following equation is derived.
上式(23)から後輪3の接地点の速度V rは次式のように表される。 Velocity V r of the ground contact point of the rear wheel 3 from the above equation (23) is expressed by the following equation.
上式(24)は次式の条件が満たされる場合にのみ解を持つ。 Equation (24) has a solution only if the following condition is satisfied.
車両100の旋回半径が小さい場合には、上式(25)の条件が満たされない場合が生じる。 If the turning radius of the vehicle 100 is low, if the condition of the above equation (25) is not satisfied occurs. そのような場合にも解が存在するように、上式(24)を次式のように修正する。 As solution exists even in such a case, modifying the above equation (24) as follows.
上式(26)におけるロール角φとしては前回の推定動作におけるロール角φの推定値を用いる。 The roll angle φ in the above formula (26) using the estimated value of the roll angle φ in the previous estimation operation.
上式(26)から前輪2の接地点の速度V fと後輪3の接地点の速度V rとの関係が求められる。 Relationship between the velocity V r of the equation (26) from the ground point of the rear wheel 3 and the speed V f at the ground point of the front wheel 2 is determined. したがって、前輪速度センサ6により検出される前輪2の回転速度(以下、前輪速度v fと呼ぶ)から後輪速度v rを算出することができる。 Thus, the rotational speed of the front wheel 2 detected by the front wheel speed sensor 6 (hereinafter, referred to as a front wheel speed v f) can be calculated rear wheel speed v r from.
図11は前輪速度v fと後輪速度v rとの関係の計算結果を示す図である。 Figure 11 is a graph showing a calculation result of the relationship between the front wheel speed v f and the rear wheel speed v r. 図11の横軸は後輪速度v rを表し、縦軸は前輪速度v fを表す。 11, the horizontal axis represents the rear wheel speed v r, and the vertical axis represents the front wheel speed v f.
図11に示すように、前輪速度センサ6により検出される前輪速度v fから後輪速度v rを推定することができる。 As shown in FIG. 11, it is possible to estimate the rear wheel speed v r from the front wheel velocity v f detected by the front wheel speed sensor 6. したがって、前輪速度センサ6のみが設けられる場合にも、後輪速度センサ7が設けられた場合と同様に、車体1のロール角φ、車両速度V x 、ロール角速度センサオフセットb r 、ヨー角速度センサオフセットb yおよび上下加速度センサオフセットb zを高い精度で推定することができる。 Therefore, even when only the front wheel speed sensor 6 is provided, as in the case where the rear wheel speed sensor 7 is provided, the roll angle of the vehicle body 1 phi, the vehicle speed V x, the roll angular velocity sensor offset b r, the yaw angular velocity sensor the offset b y and the vertical acceleration sensor offset b z can be estimated with high accuracy.
(b)上記実施の形態におけるロール角速度センサ51およびヨー角速度センサ52の代わりに車両100の前後方向および上下方向とは異なる2以上の軸の周りでの角速度を検出する2以上の角速度センサを用いてもよい。 (B) using two or more angular velocity sensor for sensing an angular velocity around two or more different axes the longitudinal direction and the vertical direction of the vehicle 100 in place of the roll angular velocity sensor 51 and the yaw angular velocity sensor 52 in the above embodiment it may be. この場合、幾何学的方法により2以上の角速度センサの検出値をロール角速度ω rおよびヨー角速度ω yに変換することが可能である。 In this case, the detection value of 2 or more angular rate sensors by geometrical methods can be converted to the roll angular velocity omega r and the yaw angular velocity omega y. それにより、上式(17),(18)を用いることができる。 Thus, the above equation (17), can be used (18).
(c)上記実施の形態におけるロール角速度センサ51およびヨー角速度センサ52に加えて、車両100の左右方向の軸の周りでの角速度を検出する角速度センサを用いてもよい。 In addition to the roll angular velocity sensor 51 and the yaw angular velocity sensor 52 in the form of (c) above embodiments may be used an angular velocity sensor for detecting angular velocities around the lateral axis of the vehicle 100. この場合、ロール角φの推定精度がさらに向上する。 In this case, estimation accuracy of the roll angle φ is further improved.
(d)上記実施の形態における上下加速度センサ53、前後加速度センサ54および左右加速度センサ55の代わりに車両100の上下方向、前後方向および左右方向とは異なる3以上の方向の加速度を検出する3以上の加速度センサを用いてもよい。 (D) the implementation of the vertical in the embodiment the acceleration sensor 53, the vertical direction of the vehicle 100, instead of the longitudinal acceleration sensor 54 and lateral acceleration sensor 55, three or more for detecting accelerations in different three or more direction to the longitudinal direction and the lateral direction an acceleration sensor may be used for. この場合、幾何学的方法により3以上の加速度センサの検出値を上下加速度G z 、前後加速度G xおよび左右加速度G yに変換することが可能である。 In this case, a detection value of 3 or more acceleration sensors by geometrical methods vertical acceleration G z, can be converted into longitudinal acceleration G x and the lateral acceleration G y. それにより、上式(17),(18)を用いることができる。 Thus, the above equation (17), can be used (18).
(e)上記実施の形態では、カルマンフィルタ80によりロール角速度センサオフセットb rおよびヨー角速度センサオフセットb yが推定されるが、これに限定されず、ロール角速度センサオフセットb rのみが推定されてもよく、ヨー角速度センサオフセットb yのみが推定されてもよい。 In the form of (e) above embodiment, although the roll angular velocity sensor offset b r and the yaw angular velocity sensor offset b y is estimated by the Kalman filter 80 is not limited thereto, may be only the roll angular velocity sensor offset b r are estimated only yaw rate sensor offset b y may be estimated. ロール角速度センサオフセットb rのみを推定する場合、その他のセンサオフセットの値をゼロとして計算を行えばよい。 When estimating the only roll angular velocity sensor offset b r, it is sufficient to calculate the value of other sensors offset zero. 同様にヨー角速度センサオフセットb yのみを推定する場合、その他のセンサオフセットの値をゼロとして計算を行えばよい。 Similarly when estimating only the yaw angular velocity sensor offset b y, it is sufficient to calculate the value of other sensors offset zero.
(f)上記実施の形態では、上下加速度センサオフセットb zが推定されるが、これに限定されず、前後加速度センサ54のオフセット誤差が推定されてもよく、または左右加速度センサ55のオフセット誤差が推定されてもよい。 In the form of (f) above embodiment, although the vertical acceleration sensor offset b z is estimated, without being limited thereto, may be estimated offset error of the longitudinal acceleration sensor 54 or the offset error of the lateral acceleration sensor 55, is estimation may be.
(g)上記実施の形態では、カルマンフィルタ80の入力パラメータの1つとして後輪速度v rが用いられるが、これに限定されず、車両100の走行速度(車両速度)を測定可能な速度センサにより検出される車両速度をカルマンフィルタ80の入力パラメータの1つとして用いてもよい。 (G) In the above embodiment, although the rear wheel speed v r is used as one of the input parameters of the Kalman filter 80 is not limited to this, the measurable velocity sensor the running speed of the vehicle 100 (vehicle speed) the vehicle speed detected may be used as one of the input parameters of the Kalman filter 80.
(h)上記実施の形態では、カルマンフィルタ80により車両速度V xが推定されるが、例えば、速度センサにより車両速度が検出される場合には、カルマンフィルタ80により車両速度V xが推定されなくてもよい。 (H) In the above embodiment, the vehicle speed V x is estimated by the Kalman filter 80, for example, when the vehicle speed is detected by the speed sensor, without the vehicle speed V x is estimated by the Kalman filter 80 good.
(i)上記実施の形態では、カルマンフィルタ80がECU20およびプログラムにより実現されるが、これに限定されず、カルマンフィルタ80の一部またはすべての機能が電子回路等のハードウエアにより実現されてもよい。 (I) In the above embodiments, but the Kalman filter 80 is realized by ECU20 and programs are not limited to, some or all of the features of the Kalman filter 80 may be realized by hardware such as an electronic circuit.
(j)上記実施の形態におけるカルマンフィルタ80の代わりに、他の適応フィルタリング手法を用いてもよい。 Instead of the Kalman filter 80 in the form of (j) above embodiments may use other adaptive filtering techniques. 例えば、LMS(最小平均二乗)適応フィルタまたはH∞フィルタリング等を用いてもよい。 For example, it may be used LMS (Least Mean Square) adaptive filter or H∞ filtering the like.
(k)上記実施の形態では、ロール角推定装置10が自動二輪車に適用されるが、これに限定されず、ロール角推定装置10は自動四輪車もしくは自動三輪車等の他の車両または船舶等の種々の輸送機器に適用することができる。 In the form of (k) above embodiment, although the roll angle estimation device 10 is applied to a motorcycle, not limited thereto, the roll angle estimating apparatus 10 other vehicles or ships and the like, such as four-wheeled vehicles or three-wheeled vehicle it can be applied in a variety of transportation equipment.
(l)上記実施の形態では、ロール角推定装置10により推定されたロール角φがナビゲーションシステム12およびヘッドライト駆動装置15に用いられるが、これに限定されず、ロール角推定装置10により推定されたロール角φは、輸送機器の他の制御等の種々の処理に用いることができる。 In the form of (l) above embodiment, although the roll angle φ estimated by the roll angle estimation device 10 is used in the navigation system 12 and the head light driving device 15 is not limited to this, estimated by the roll angle estimation device 10 roll angle φ can be used in various processes, such as other control of transportation equipment.
(8)請求項の各構成要素と実施の形態の各要素との対応 以下、請求項の各構成要素と実施の形態の各要素との対応の例について説明するが、本発明は下記の例に限定されない。 (8) Correspondences between elements of the embodiment and the components of the claims will be described below, but the corresponding example of the elements of the embodiment and the elements recited in the claims, the invention of the following examples but it is not limited to.
上記実施の形態では、車両100の前後方向の軸が第1の軸の例であり、車両100の上下方向の軸が第2の軸の例であり、ロール角速度ω rが第1の角速度の例であり、ヨー角速度ω yが第2の角速度の例であり、ロール角速度センサ51が第1の角速度検出器の例であり、ヨー角速度センサ52が第2の角速度検出器の例である。 In the above embodiment, an example of a longitudinal axis the first axis of the vehicle 100, the vertical axis of the vehicle 100 is an example of a second axis, the roll angular velocity omega r is in the first angular velocity an example, the yaw angular velocity omega y is an example of a second angular, roll angular velocity sensor 51 is an example of a first angular velocity detector, yaw rate sensor 52 is an example of a second angular velocity detector.
また、 車両100の上下方向が第1の方向の例であり、 車両100の前後方向が第2の方向の例であり、 車両100の左右方向が第3の方向の例であり、上下加速度G zが第1の加速度の例であり、前後加速度G xが第2の加速度の例であり、左右加速度G yが第3の加速度の例であり、上下加速度センサ53が第1の加速度検出器の例であり、前後加速度センサ54が第2の加速度検出器の例であり、左右加速度センサ55が第3の加速度検出器の例である。 Further, an example vertical direction of the first direction of the vehicle 100, an example of a longitudinal direction and a second direction of the vehicle 100, the left-right direction of the vehicle 100 is an example of a third direction, the vertical acceleration G z is an example of a first acceleration, the longitudinal acceleration G x is an example of a second acceleration, lateral acceleration G y is an example of a third acceleration, vertical acceleration sensor 53 is first acceleration detector an example, the longitudinal acceleration sensor 54 is an example of a second acceleration detector, lateral acceleration sensor 55 is an example of a third acceleration detector.
さらに、後輪速度v rまたは前輪速度v fが移動速度に関する情報の例であり、後輪速度センサ7または前輪速度センサ6が速度情報検出器の例であり、ECU20が推定部の例である。 Further, the rear wheel speed v r or front wheel speed v f is an example of information on the movement speed, the rear wheel speed sensor 7 or the front wheel speed sensor 6 is an example of speed information detector are examples of ECU20 estimation unit .
また、車両100または車体1が移動体の例であり、前輪2が前輪の例であり、後輪3が後輪の例であり、後輪速度センサ7が後輪回転速度推定部の例であり、前輪速度センサ6が前輪回転速度検出器の例であり、ECU20が後輪回転速度推定部の例である。 Further, an example of a vehicle 100 or the vehicle body 1 is mobile, the front wheel 2 is an example of a front wheel, an example of the rear wheel 3 is the rear wheel, the rear wheel speed sensor 7 is an example of a rear wheel rotation speed estimation unit There is an example of a front wheel speed sensor 6 is front-wheel rotational speed detector, an example of a rear wheel rotational speed estimation unit ECU20 is.
また、ローパスフィルタ63,64,65が第1、第2および第3のローパスフィルタの例であり、ECU20およびプログラムにより実現されるカルマンフィルタ80がカルマンフィルタの例である。 Further, the low-pass filter 63, 64 and 65 are first, an example of a second and third low-pass filter, the Kalman filter 80 implemented by ECU20 and programs are examples of the Kalman filter. ナビゲーションシステム12またはヘッドライト駆動装置15が処理部の例である。 Navigation system 12 or headlight drive 15 is an example of a processing unit.
請求項の各構成要素として、請求項に記載されている構成または機能を有する他の種々の要素を用いることもできる。 As the elements recited in the claims, it can also be used various other elements having configurations or functions described in the claims.
本発明は、輸送機器等のロール角を推定するために利用することができる。 The present invention can be utilized to estimate the roll angle, such as transport equipment.
前記推定部は、現在の推定動作において前記第1および第2の角速度検出器の検出値、前記第1、第2および第3の加速度検出器の検出値、前記速度情報検出器の検出値、 前回の推定動作によるロール角の推定値ならびに前回の推定動作によるオフセット誤差の推定値に基づいて、前記移動体のロール角および前記少なくとも1つのオフセット誤差を推定する、ロール角推定装置。 The estimation unit is configured in the current estimation operation first and second detection values ​​of the angular velocity detector, the first, second and the detected value of the third acceleration detector, the detection value of the speed information detector, estimated value of the roll angle from the previous estimation operation and based on the estimated value of the offset error due to previous estimation operation, estimates the roll angle and the at least one offset error of the movable body, the roll angle estimating apparatus.
前記第1、第2および第3の加速度検出器は、互いに異なる3つの方向における第1、第2および第3の加速度をそれぞれ検出する、請求項1記載のロール角推定装置。 It said first, second and third acceleration detectors, first in three different directions, to detect the second and third acceleration respectively, roll angle estimating apparatus according to claim 1.
前記推定部は、前記少なくとも1つのオフセット誤差として、前記第1および第2の角速度検出器の少なくとも一方のオフセット誤差を推定する、請求項1または2記載のロール角推定装置。 The estimation unit is configured as at least one offset error, estimating at least one of the offset error of the first and second angular velocity detectors, roll angle estimating apparatus according to claim 1 or 2 wherein.
前記推定部は、前記少なくとも1つのオフセット誤差として、前記第1および第2の角速度検出器のオフセット誤差を推定する、請求項1〜3のいずれかに記載のロール角推定装置。 The estimation unit is configured as at least one offset error, we estimate the offset error of the first and second angular velocity detectors, roll angle estimating apparatus according to claim 1.
前記推定部は、前記少なくとも1つのオフセット誤差として、前記第1、第2および第3の加速度検出器の少なくとも1つのオフセット誤差をさらに推定する、請求項4記載のロール角推定装置。 The estimation unit is configured as at least one offset error, said first and further estimates at least one offset error of the second and third acceleration detectors, roll angle estimating apparatus according to claim 4, wherein.
前記推定部は、前記第1の加速度検出器のオフセット誤差を推定する、請求項5記載のロール角推定装置。 The estimation unit estimates an offset error of the first acceleration detector, the roll angle estimating apparatus according to claim 5, wherein.
前記推定部は、前記移動体の移動速度をさらに推定するように構成され、現在の推定動作において前記第1および第2の角速度検出器の検出値、前記第1、第2および第3の加速度検出器の検出値、前記後輪速度検出器の検出値、前回の推定動作によるロール角の推定値、前回の推定動作によるオフセット誤差の推定値ならびに前回の推定動作による移動速度の推定値に基づいて、前記移動体のロール角、前記少なくとも1つのオフセット誤差および前記移動体の移動速度を推定する、請求項1〜6のいずれかに記載のロール角推定装置。 The estimating unit is further configured to estimate the traveling speed of the movable body, wherein the current estimation operation first and second detection values ​​of the angular velocity detector, the first, second and third acceleration the detection value of the detector, based on the detection value of the rear wheel speed detector, the estimated value of the roll angle from the previous estimation operation, the estimated value of the moving speed of the estimated value and the previous estimation operation of the offset error due to previous estimation operation Te, roll angle of the moving body, wherein estimating the movement speed of the at least one offset error and the moving body, the roll angle estimating apparatus according to any one of claims 1 to 6.
前記推定部は、前記移動体の移動速度をさらに推定するように構成され、現在の推定動作において前記第1および第2の角速度検出器の検出値、前記第1、第2および第3の加速度検出器の検出値、前記後輪回転速度推定部の推定値、前回の推定動作によるロール角の推定値、前回の推定動作によるオフセット誤差の推定値ならびに前回の推定動作による移動速度の推定値に基づいて、前記移動体のロール角、前記少なくとも1つのオフセット誤差および前記移動体の移動速度を推定する、請求項1〜6のいずれかに記載のロール角推定装置。 The estimating unit is further configured to estimate the traveling speed of the movable body, wherein the current estimation operation first and second detection values ​​of the angular velocity detector, the first, second and third acceleration the detection value of the detector, the estimated value of the rear wheel rotation speed estimation unit, the estimated value of the roll angle from the previous estimation operation, the estimated value of the moving speed of the estimated value and the previous estimation operation of the offset error due to previous estimation operation based on, roll angle of the moving body, wherein estimating the movement speed of the at least one offset error and the moving body, the roll angle estimating apparatus according to any one of claims 1 to 6.
前記推定部は、現在の推定動作において前記第1および第2の角速度検出器の検出値、前記第1、第2および第3の加速度検出器の検出値、前記速度情報検出器の検出値、前回の推定動作によるロール角の推定値および前回の推定動作によるオフセット誤差の推定値の関係を用いて前記移動体のロール角および前記少なくとも1つのオフセット誤差を推定するカルマンフィルタを含む、請求項1〜8のいずれかに記載のロール角推定装置。 The estimation unit is configured in the current estimation operation first and second detection values ​​of the angular velocity detector, the first, second and the detected value of the third acceleration detector, the detection value of the speed information detector, roll angle of the moving body by using the relationship between the estimated value of the offset error due to estimate and previous estimation operation of the roll angle from the previous estimation operation and includes the Kalman filter to estimate at least one offset error claim 1 roll angle estimating apparatus according to any one of 8.
前記ロール角推定装置により推定されたロール角を用いた処理を行う処理部とを備えた、輸送機器。 And a processing unit for performing processing using the roll angle estimated by the roll angle estimation device, transportation equipment.