Sensor drift amount estimating device

A sensor drift amount estimating device comprising:

• vehicle speed estimating means for, on the basis of a sensor signal corresponding to a detected value of a motion state amount of vehicle motion, computing a time differential amount of vehicle speed, and integrating the time differential amount of the vehicle speed, and estimating the vehicle speed;
• computing means for, on the basis of the sensor signal and the vehicle speed estimated by the vehicle speed estimating means, computing a time differential amount of the vehicle speed obtained from equations of motion for vehicle motion;
• drift amount estimating means for estimating a sensor drift amount of the sensor signal by using a relationship that (A) a time differential amount of the vehicle speed that is computed by the vehicle speed estimating means, and (B) the time differential amount of the vehicle speed computed by the computing means based on the sensor signal which is corrected on the basis of the sensor drift amount, are equal;
• and
• correcting means for correcting the sensor signal on the basis of the sensor drift amount estimated by the drift amount estimating means,
• wherein the vehicle speed estimating means estimates the vehicle speed on the basis of the sensor signal corrected by the correcting means, and estimates a slip angle on the basis of the estimated vehicle speed.

A sensor drift amount estimating device comprising:

• attitude angle estimating means for, on the basis of sensor signals corresponding to respective detected values of vertical acceleration, longitudinal acceleration, lateral acceleration, roll angular velocity, and yaw angular velocity of vehicle motion, computing respective time differential amounts of a roll angle and a pitch angle with respect to a vertical axis of a vehicle body, and integrating the respective computed time differential amounts of the roll angle and the pitch angle, and estimating the roll angle and the pitch angle;
• computing means for, on the basis of the sensor signals and the roll angle and the pitch angle estimated by the attitude angle estimating means, computing respective time differential amounts of the roll angle and the pitch angle obtained from equations of motion for vehicle motion;
• drift amount estimating means for estimating respective sensor drift amounts of a sensor signal corresponding to a detected value of the vertical acceleration and a sensor signal corresponding to a detected value of the roll angular velocity, by using a relationship that (A) respective time differential amounts of the roll angle and the pitch angle that are computed by the attitude angle estimating means, and (B) the respective time differential amounts of the roll angle and the pitch angle computed by the computing means based on the sensor signals which are corrected on the basis of the respective sensor drift amounts, are equal;
• and
• correcting means for, on the basis of the sensor drift amounts estimated by the drift amount estimating means, respectively correcting the sensor signal corresponding to the detected value of the vertical acceleration and the sensor signal corresponding to the detected value of the roll angular velocity,
• wherein the attitude angle estimating means estimates the roll angle and the pitch angle on the basis of the sensor signals corresponding to the respective detected values of the longitudinal acceleration, the lateral acceleration, and the yaw angular velocity, and the sensor signals corresponding to the respective detected values of the vertical acceleration and the roll angular velocity corrected by the correcting means.

A sensor drift amount estimating device comprising:

• vehicle speed estimating means for, on the basis of sensor signals corresponding to respective detected values of longitudinal acceleration, lateral acceleration, and yaw angular velocity of vehicle motion, computing respective time differential amounts of longitudinal velocity and lateral velocity, and integrating the respective time differential amounts of the longitudinal velocity and the lateral velocity, and estimating the longitudinal velocity and the lateral velocity;
• computing means for, on the basis of the sensor signals and the longitudinal velocity and the lateral velocity estimated by the vehicle speed estimating means, computing respective time differential amounts of the longitudinal velocity and the lateral velocity obtained from equations of motion for vehicle motion;
• drift amount estimating means for estimating sensor drift amounts of the sensor signals corresponding to the respective detected values of the longitudinal acceleration, the lateral acceleration, and the yaw angular velocity by using a relationship that (A) respective time differential amounts of the longitudinal velocity and the lateral velocity that are computed by the vehicle speed estimating means, and (B) the respective time differential amounts of the longitudinal velocity and the lateral velocity computed by the computing means based on the sensor signals which are corrected on the basis of the sensor drift amounts, are equal;
• and
• correcting means for, on the basis of the sensor drift amounts estimated by the drift amount estimating means, correcting the sensor signals corresponding to the respective detected values of the longitudinal acceleration, the lateral acceleration, and the yaw angular velocity,
• wherein the vehicle speed estimating means estimates the longitudinal velocity and the lateral velocity on the basis of the sensor signals corrected by the correcting means, and estimates a slip angle on the basis of the estimated longitudinal velocity and lateral velocity.

A sensor drift amount estimating device comprising:

• attitude angle estimating means for, on the basis of sensor signals corresponding to respective detected values of longitudinal acceleration, lateral acceleration, vertical acceleration, roll angular velocity, and yaw angular velocity of vehicle motion, computing respective time differential amounts of a roll angle and a pitch angle with respect to a vertical axis of a vehicle body, and integrating the respective computed time differential amounts of the roll angle and the pitch angle, and estimating the roll angle and the pitch angle;
• vehicle speed estimating means for, on the basis of sensor signals corresponding to respective detected values, computing respective time differential amounts of longitudinal velocity and lateral velocity, and integrating the respective time differential amounts of the longitudinal velocity and the lateral velocity, and estimating the longitudinal velocity and the lateral velocity;
• computing means for, on the basis of the sensor signals and the roll angle and the pitch angle estimated by the attitude angle estimating means, computing respective time differential amounts of the roll angle and the pitch angle obtained from equations of motion for vehicle motion, and, on the basis of the sensor signals and the longitudinal velocity and the lateral velocity estimated by the vehicle speed estimating means, computing respective time differential amounts of the longitudinal velocity and the lateral velocity obtained from equations of motion for vehicle motion;
• drift amount estimating means for estimating respective sensor drift amounts of the sensor signal corresponding to the detected value of the vertical acceleration and the sensor signal corresponding to the detected value of the roll angular velocity by using a relationship that (A) respective time differential amounts of the roll angle and the pitch angle that are computed by the attitude angle estimating means, and (B) the respective time differential amounts of the roll angle and the pitch angle computed by the computing means based on the sensor signals which are corrected on the basis of the respective sensor drift amounts, are equal, and for estimating sensor drift amounts of the sensor signals corresponding to the respective detected values of the longitudinal acceleration, the lateral acceleration, and the yaw angular velocity by using a relationship that (C) respective time differential amounts of the longitudinal velocity and the lateral velocity that are computed by the vehicle speed estimating means, and (D) the respective time differential amounts of the longitudinal velocity and the lateral velocity computed by the computing means based on the sensor signals which are corrected on the basis of the sensor drift amounts, are equal;
• and
• correcting means for, on the basis of the sensor drift amounts estimated by the drift amount estimating means, correcting sensor signals corresponding to respective detected values,
• wherein the attitude angle estimating means estimates the roll angle and the pitch angle on the basis of the sensor signals corresponding to the respective detected values corrected by the correcting means, and
• the vehicle speed estimating means estimates the longitudinal velocity and the lateral velocity on the basis of the sensor signals corresponding to the respective detected values corrected by the correcting means, and estimates a slip angle on the basis of the estimated longitudinal velocity and lateral velocity.

A sensor drift amount estimating device comprising:

• attitude angle estimating means for, on the basis of sensor signals corresponding to respective detected values of vertical acceleration, longitudinal acceleration, lateral acceleration, roll angular velocity, pitch angular velocity, and yaw angular velocity of vehicle motion, computing respective time differential amounts of a roll angle and a pitch angle with respect to a vertical axis of a vehicle body, and integrating the respective computed time differential amounts of the roll angle and the pitch angle, and estimating the roll angle and the pitch angle;
• computing means for, on the basis of the sensor signals and the roll angle and the pitch angle estimated by the attitude angle estimating means, computing respective time differential amounts of the roll angle and the pitch angle obtained from equations of motion for vehicle motion;
• drift amount estimating means for estimating respective sensor drift amounts of the sensor signal corresponding to the detected value of the pitch angular velocity and the sensor signal corresponding to the detected value of the roll angular velocity, by using a relationship that (A) respective time differential amounts of the roll angle and the pitch angle that are computed by the attitude angle estimating means, and (B) the respective time differential amounts of the roll angle and the pitch angle computed by the computing means based on the sensor signals which are corrected on the basis of the respective sensor drift amounts, are equal;
• and
• correcting means for, on the basis of the sensor drift amounts estimated by the drift amount estimating means, respectively correcting the sensor signal corresponding to the detected value of the pitch angular velocity and the sensor signal corresponding to the detected value of the roll angular velocity,
• wherein the attitude angle estimating means estimates the roll angle and the pitch angle on the basis of the sensor signals corresponding to the respective detected values of the vertical acceleration, the longitudinal acceleration, the lateral acceleration, and the yaw angular velocity, and the sensor signals corresponding to the respective detected values of the pitch angular velocity and the roll angular velocity corrected by the correcting means.

A sensor drift amount estimating device comprising:

• attitude angle estimating means for, on the basis of sensor signals corresponding to respective detected values of longitudinal acceleration, lateral acceleration, vertical acceleration, roll angular velocity, pitch angular velocity, and yaw angular velocity of vehicle motion, computing respective time differential amounts of a roll angle and a pitch angle with respect to a vertical axis of a vehicle body, and integrating the respective computed time differential amounts of the roll angle and the pitch angle, and estimating the roll angle and the pitch angle;
• vehicle speed estimating means for, on the basis of sensor signals corresponding to respective detected values, computing respective time differential amounts of longitudinal velocity and lateral velocity, and integrating the respective time differential amounts of the longitudinal velocity and the lateral velocity, and estimating the longitudinal velocity and the lateral velocity;
• computing means for, on the basis of the sensor signals and the roll angle and the pitch angle estimated by the attitude angle estimating means, computing respective time differential amounts of the roll angle and the pitch angle obtained from equations of motion for vehicle motion, and, on the basis of the sensor signals and the longitudinal velocity and the lateral velocity estimated by the vehicle speed estimating means, computing respective time differential amounts of the longitudinal velocity and the lateral velocity obtained from equations of motion for vehicle motion;
• drift amount estimating means for estimating respective sensor drift amounts of the sensor signal corresponding to the detected value of the pitch angular velocity and the sensor signal corresponding to the detected value of the roll angular velocity by using a relationship that (A) respective time differential amounts of the roll angle and the pitch angle that are computed by the attitude angle estimating means, and (B) the respective time differential amounts of the roll angle and the pitch angle computed by the computing means based on the sensor signals which are corrected on the basis of the respective sensor drift amounts, are equal, and for estimating sensor drift amounts of the sensor signals corresponding to the respective detected values of the longitudinal acceleration, the lateral acceleration, and the yaw angular velocity by using a relationship that (C) respective time differential amounts of the longitudinal velocity and the lateral velocity that are computed by the vehicle speed estimating means, and (D) the respective time differential amounts of the longitudinal velocity and the lateral velocity computed by the computing means based on the sensor signals which are corrected on the basis of the sensor drift amounts, are equal;
• and
• correcting means for, on the basis of the sensor drift amounts estimated by the drift amount estimating means, correcting sensor signals corresponding to respective detected values,
• wherein the attitude angle estimating means estimates the roll angle and the pitch angle on the basis of the sensor signals corresponding to the respective detected values corrected by the correcting means, and
• the vehicle speed estimating means estimates the longitudinal velocity and the lateral velocity on the basis of the sensor signals corresponding to the respective detected values corrected by the correcting means, and estimates a slip angle on the basis of the estimated longitudinal velocity and lateral velocity.

A sensor drift amount estimating device comprising:

• lateral velocity estimating means for, on the basis of sensor signals corresponding to respective detected values of lateral acceleration and yaw angular velocity of vehicle motion, and either a sensor signal corresponding to a detected value of vehicle speed or an estimated value by a vehicle speed estimating means that estimates the vehicle speed, computing a time differential amount of lateral velocity, and integrating the time differential amount of the lateral velocity, and estimating the lateral velocity;
• computing means for, on the basis of the sensor signals corresponding to the respective detected values of the lateral acceleration and the yaw angular velocity, and either the sensor signal corresponding to the detected value of the vehicle speed or the estimated value, computing a time differential amount of the lateral velocity obtained from equations of motion for vehicle motion;
• drift amount estimating means for estimating sensor drift amounts of the sensor signals corresponding to the respective detected values of the lateral acceleration and the yaw angular velocity, by using a relationship that (A) a time differential amount of the lateral velocity computed by the lateral velocity estimating means, and (B) the time differential amount of the lateral velocity computed by the computing means based on the sensor signals which are corrected on the basis of the sensor drift amounts, are equal;
• and
• correcting means for correcting the sensor signals corresponding to the respective detected values of the lateral acceleration and the yaw angular velocity, on the basis of the sensor drift amounts estimated by the drift amount estimating means,
• wherein the lateral velocity estimating means estimates the lateral velocity on the basis of the sensor signals corrected by the correcting means.

A sensor drift amount estimating device comprising:

• slip angle estimating means for, on the basis of sensor signals corresponding to respective detected values of lateral acceleration and yaw angular velocity of vehicle motion, and either a sensor signal corresponding to a detected value of vehicle speed or an estimated value by a vehicle speed estimating means that estimates the vehicle speed, computing a time differential amount of a slip angle, and integrating the time differential amount of the slip angle, and estimating the slip angle;
• computing means for, on the basis of the sensor signals corresponding to the respective detected values of the lateral acceleration and the yaw angular velocity, and either the sensor signal corresponding to the detected value of the vehicle speed or the estimated value, computing a time differential amount of the slip angle obtained from equations of motion for vehicle motion;
• drift amount estimating means for estimating sensor drift amounts of the sensor signals corresponding to the respective detected values of the lateral acceleration and the yaw angular velocity by using a relationship that (A) a time differential amount of the slip angle computed by the slip angle estimating means, and (B) the time differential amount of the slip angle computed by the computing means based on the sensor signals which are corrected on the basis of the sensor drift amounts, are equal;
• and
• correcting means for correcting the sensor signals corresponding to the respective detected values of the lateral acceleration and the yaw angular velocity, on the basis of the sensor drift amounts estimated by the drift amount estimating means,
• wherein the slip angle estimating means estimates the slip angle on the basis of the sensor signals corrected by the correcting means.