Roll angle estimation device and transport equipment

Patent metadata

Field	Value
Publication number	US-9630672-B2
Application number	US-201013518060-A
Country	US
Kind code	B2
Filing date	Nov 10, 2010
Priority date	Dec 21, 2009
Publication date	Apr 25, 2017
Grant date	Apr 25, 2017

Abstract

A Kalman filter in a roll angle estimation device estimates a roll angle of a vehicle body, a vehicle speed, a roll angular velocity sensor offset, a yaw angular velocity sensor offset, and a vertical acceleration sensor offset on the basis of detected values of a roll angular velocity sensor, a yaw angular velocity sensor, a vertical acceleration sensor, a longitudinal acceleration sensor, a lateral acceleration sensor, and a rear-wheel speed sensor, and also on the basis of estimated values of the roll angle, the vehicle speed, the roll angular velocity sensor offset, the yaw angular velocity sensor offset, and the vertical acceleration sensor offset obtained in a previous estimation operation.

First claim

The invention claimed is:

1. A roll angle estimation device that estimates a roll angle of a movable object, the roll angle estimation device comprising:
a roll angular velocity detector that detects a roll angular velocity;
a yaw angular velocity detector that detects a yaw angular velocity;
first, second, and third acceleration detectors that detect first, second, and third accelerations, respectively, in at least three directions different from one another;
a speed information detector that detects information regarding a moving speed in a traveling direction of the movable object; and
an estimator that estimates the roll angle of the movable object and also estimates at least an offset error of the roll angular velocity detector and an offset error of the yaw angular velocity detector; wherein
the estimator estimates the roll angle of the movable object, the offset error of the roll angular velocity detector, and the offset error of the yaw angular velocity detector in a current estimation operation on the basis of a detected value of the roll angular velocity detector, a detected value of the yaw angular velocity detector, detected values of the first, second, and third acceleration detectors, a detected value of the speed information detector, an estimated value of the roll angle obtained in a previous estimation operation, an estimated value of the offset error of the roll angular velocity detector obtained in the previous estimation operation, and an estimated value of the offset error of the yaw angular velocity detector obtained in the previous estimation operation.

2. The roll angle estimation device according to claim 1 , wherein the estimator further estimates an offset error of at least one of the first, second, and third acceleration detectors in the current and previous estimation operations; and
the estimator estimates the roll angle of the movable object, the offset error of the roll angular velocity detector, the offset error of the yaw angular velocity detector, and the offset error of the at least one of the first, second, and third acceleration detectors in the current estimation operation on the basis of the detected value of the roll angular velocity detector, the detected value of the yaw angular velocity detector, the detected values of the first, second, and third acceleration detectors, the detected value of the speed information detector, the estimated value of the offset error of the roll angular velocity detector obtained in the previous estimation operation, the estimated value of the offset error of the yaw angular velocity detector obtained in the previous estimation operation, and the offset error of the at least one of the first, second, and third acceleration detectors obtained in the previous estimation operation.

3. The roll angle estimation device according to claim 2 , wherein the first acceleration is an acceleration in an up-and-down direction of the movable object, and the estimator estimates the offset error of the first acceleration detector as the offset error of the at least one of the first, second, and third acceleration detectors.

4. The roll angle estimation device according to claim 1 , wherein
the movable object includes a front wheel and a rear wheel;
the speed information detector includes a rear-wheel rotational speed detector that detects a rotational speed of the rear wheel as the information; and
the estimator estimates a moving speed of the movable object, and estimates the roll angle of the movable object, the offset error of the roll angular velocity detector, the offset error of the yaw angular velocity detector, and the moving speed of the movable object in the current estimation operation on the basis of the detected value of the roll angular velocity detector, the detected value of the yaw angular velocity detector, the detected values of the first, second, and third acceleration detectors, a detected value of the rear-wheel speed detector, the estimated value of the roll angle obtained in the previous estimation operation, the estimated value of the offset error of the roll angular velocity detector obtained in the previous estimation operation, the estimated value of the offset error of the yaw angular velocity detector obtained in the previous estimation operation, and an estimated value of the moving speed obtained in the previous estimation operation.

5. The roll angle estimation device according to claim 1 , wherein
the movable object includes a front wheel and a rear wheel;
the speed information detector includes:
a front-wheel rotational speed detector that detects a rotational speed of the front wheel; and
a rear-wheel rotational speed estimator that estimates, as the information, a rotational speed of the rear wheel from a detected value of the front-wheel rotational speed detector; and
the estimator estimates a moving speed of the movable object, and estimates the roll angle of the movable object, the offset error of the roll angular velocity detector, the offset error of the yaw angular velocity detector, and the moving speed of the movable object in the current estimation operation on the basis of the detected value of the roll angular velocity detector, the detected value of the yaw angular velocity detector, the detected values of the first, second, and third acceleration detectors, an estimated value of the rear-wheel rotational speed estimator, the estimated value of the roll angle obtained in the previous estimation operation, the estimated value of the offset error of the roll angular velocity detector obtained in the previous estimation operation, the estimated value of the offset error of the yaw angular velocity detector obtained in the previous estimation operation, and an estimated value of the moving speed obtained in the previous estimation operation.

6. The roll angle estimation device according to claim 1 , wherein the estimator includes a Kalman filter that estimates the roll angle of the movable object, the offset error of the roll angular velocity detector, and the offset error of the yaw angular velocity detector in the current estimation operation by using a relationship among the detected value of the roll angular velocity detector, the detected value of the yaw angular velocity detector, the detected values of the first, second, and third acceleration detectors, the detected value of the speed information detector, the estimated value of the roll angle obtained in the previous estimation operation, the estimated value of the offset error of the roll angular velocity detector obtained in the previous estimation operation, and the estimated value of the offset error of the yaw angular velocity detector obtained in the previous estimation operation.

7. A transport equipment comprising:
a movable object configured to be movable;
the roll angle estimation device as recited in claim 1 that estimates a roll angle of the movable object; and
a processor that performs processing using the roll angle estimated by the roll angle estimation device.

8. A roll angle estimation device that estimates a roll angle of a movable object, the roll angle estimation device comprising:
a roll angular velocity detector that detects a roll angular velocity;
a yaw angular velocity detector that detects a yaw angular velocity;
first, second, and third acceleration detectors that detect first, second, and third accelerations, respectively, in at least three directions different from one another;
a speed information detector that detects information regarding a moving speed in a traveling direction of the movable object; and
an estimator that estimates the roll angle of the movable object and also estimates at least an offset error of the roll angular velocity detector an

Assignees

• Inoue Hiroyuki
• Fujii Takahiro
• Seki Yoshimichi
• Yamaha Motor Co Ltd

Inventors

• Inoue Hiroyuki
• Fujii Takahiro
• Seki Yoshimichi

Classifications

• B60W2520/125

  Lateral acceleration · CPC title

• B60W2520/105

  Longitudinal acceleration · CPC title

• B60W2520/18

  Roll · CPC title

• B60W2520/00

  Input parameters relating to overall vehicle dynamics · CPC title

• B60Y2200/12

  Motorcycles, Trikes; Quads; Scooters · CPC title