Vehicular present position detection apparatus and program storage medium
First Claim
1. A vehicular present position detection apparatus comprising:
- an angular velocity sensor configured to detect an angular velocity of a vehicle;
an error estimation portion configured to assume a gain error of the angular velocity sensor to be a state quantity and find an estimated gain error using a Kalman filter;
a turn direction determination portion configured to determine a turn direction of the vehicle; and
a correction amount adjustment portion configured to correct a gain correction amount used for gain correction of an angular velocity detected by the angular velocity sensor based on an estimated gain error found by the error estimation portion,the correction amount adjustment portion correcting a first gain correction amount, which is dedicated to right turn, based on the estimated gain error when the turn direction determination portion determines a right turn,the correction amount adjustment portion correcting a second gain correction amount, which is dedicated to left turn, based on the estimated gain error when the turn direction determination portion determines a left turn.
1 Assignment
0 Petitions
Accused Products
Abstract
There is a need for improving the accuracy of estimating a gain error for an angular velocity sensor. An error estimation section and a correction section are provided as well as a gyroscope that detects an angular velocity of a vehicle. The error estimation section assumes the gain error of the gyroscope to be a state quantity and finds an estimated value for the gain error using a Kalman filter. Based on the gain error found by the error estimation section, the correction section corrects a gain correction amount used for gain correction of values detected by the gyroscope. The correction section corrects the gain correction amount dedicated to right turn based on the gain error found by the error estimation section when the vehicle is assumed to turn right. The correction section corrects the gain correction amount dedicated to left turn based on the gain error found by the error estimation section when the vehicle is assumed to turn left.
5 Citations
7 Claims
-
1. A vehicular present position detection apparatus comprising:
-
an angular velocity sensor configured to detect an angular velocity of a vehicle; an error estimation portion configured to assume a gain error of the angular velocity sensor to be a state quantity and find an estimated gain error using a Kalman filter; a turn direction determination portion configured to determine a turn direction of the vehicle; and a correction amount adjustment portion configured to correct a gain correction amount used for gain correction of an angular velocity detected by the angular velocity sensor based on an estimated gain error found by the error estimation portion, the correction amount adjustment portion correcting a first gain correction amount, which is dedicated to right turn, based on the estimated gain error when the turn direction determination portion determines a right turn, the correction amount adjustment portion correcting a second gain correction amount, which is dedicated to left turn, based on the estimated gain error when the turn direction determination portion determines a left turn. - View Dependent Claims (2, 3, 4, 5, 6)
-
-
7. A method for adjusting a correction amount for an angular velocity sensor for a vehicle, the method comprising:
-
assuming a gain error of the angular velocity sensor to be a state quantity and finding an estimated gain error using a Kalman filter; determining a turn direction of the vehicle; and correcting, based on the estimated gain error, (i) a first gain correction amount being dedicated to right turn, the first gain correction amount being used for gain correction of an angular velocity detected by the angular velocity sensor, when a turn direction is determined to be right turn, and (ii) a second gain correction amount being dedicated to left turn, the second gain correction amount being used for gain correction of an angular velocity detected by the angular velocity sensor, when a turn direction is determined to be left turn.
-
Specification