Travel distance estimation device

• US 10,365,109 B2
• Filed: 05/25/2015
• Issued: 07/30/2019
• Est. Priority Date: 06/04/2014
• Status: Active Grant

• Current Assignee: DENSO Corporation
• Original Assignee: DENSO Corporation
• Inventors: Kumabe, Seigou, Takeyama, Kojiro, Kojima, Yoshiko
• Primary Examiner(s): Goldman, Richard A
• Application Number:
  US15/313,596
• Publication Number:
  US 20170184403A1
• Time in Patent Office: 1,527 Days
• Field of Search: 701500, 701472, 701 292, 701 307
• CPC Class Codes: G01C 21/10 by using measurements of speed or acceleration G01C21/24, G01C21/26 take precedence
• CPC Class Codes: G01C 21/12 executed aboard the object being navigated; Dead reckoning
• CPC Class Codes: G01C 21/14 by recording the course traversed by the object G01C21/16 takes precedence
• CPC Class Codes: G01C 21/165 combined with non-inertial navigation instruments
• CPC Class Codes: G01C 21/188 for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
• CPC Class Codes: G01C 22/00 Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers
• CPC Class Codes: G01C 22/02 by conversion into electric waveforms and subsequent integration, e.g. using tachometer generator G01C22/002, G01C22/004, G01C22/006 take precedence
• CPC Class Codes: G01S 19/38 Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
• CPC Class Codes: G01S 19/40 Correcting position, velocity or attitude
• CPC Class Codes: G01S 19/42 Determining position
• CPC Class Codes: G01S 19/421 by combining or switching between position solutions or signals derived from different satellite radio beacon positioning systems; by combining or switching between position solutions or signals derived from different modes of operation in a single system
• CPC Class Codes: G01S 19/45 by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
• CPC Class Codes: G01S 19/51 Relative positioning

Abstract

A travel distance estimation device is provided. The travel distance estimation device includes an estimated velocity determination unit that successively estimates an estimated velocity of a movable object based on an acceleration integrated value and a velocity initial value a travel distance calculation unit that successively calculates an estimated travel distance of the movable object based on the estimated velocity, and a past velocity correction unit that determines corrected past velocities by correcting pre-correction past estimated velocities so that the corrected past velocities are continuous with the velocity initial value determined this time. The pre-corrected past estimated velocities are the estimated velocities that were successively determined. The travel distance estimation device further includes a travel distance correction unit that recalculates based on the corrected past velocities an estimated travel distance.

Claims

1. A travel distance estimation device comprising:

an acceleration sensor mounted on a vehicle that detects a traveling direction acceleration of the vehicle, the traveling direction acceleration indicating an acceleration of the vehicle in an anteroposterior direction of the vehicle;

a Global Positioning System (GPS) signal receiver mounted on the vehicle that receives a GPS signal from a GPS satellite of a GPS satellite positioning system;

a controller connected to the acceleration sensor and the GPS signal receiver, mounted on the vehicle, and having a processor configured to;

determine a plurality of traveling direction accelerations over a time period, based on output from the acceleration sensor;

calculate an acceleration integrated value by integrating the plurality of traveling direction accelerations determined by the processor over the time period;

calculate a velocity initial value of the vehicle based on a Doppler shift amount of the GPS signal received by the GPS signal receiver from the GPS satellite of the GPS satellite positioning system or a velocity of the vehicle at a time of stoppage of the vehicle;

calculate an estimated velocity of the vehicle based on the acceleration integrated value calculated by the processor and the velocity initial value calculated by the processor;

calculate an estimated travel distance of the vehicle based on the estimated velocity calculated by the processor and a predetermined time;

calculate, upon calculating the velocity initial value, a plurality of corrected past velocities by correcting a plurality of past estimated velocities, the plurality of corrected past velocities being calculated as continuous with the calculated velocity initial value, the plurality of past estimated velocities being previously determined by the processor during the time period, the time period being from when a previous velocity initial value was previously determined by the processor until the velocity initial value is determined by the processor;

recalculate, upon determining the plurality of corrected past velocities by the processor, based on the plurality of corrected past velocities and the time period, an estimated travel distance during the time period; and

estimate a traveling trajectory of the vehicle based on the estimated travel distance during the time period.

2. The travel distance estimation device according to claim 1, the processor being further configured to:

determine a traveling orientation of the vehicle; and

determine, based on the estimated travel distance and the traveling orientation a relative position of the vehicle that is relative to a previous position of the movable object determined at the start of the time period,

wherein

upon recalculating the estimated travel distance, the processor is further configured to recalculate, based on the recalculated estimated travel distance and the traveling orientation, the relative position of the vehicle after the previous velocity initial value was determined by the processor until the velocity initial value is determined by the processor.

3. The travel distance estimation device according to claim 1, wherein the processor is further configured to:

determine the plurality of corrected past velocities based on an assumption of a liner increase in errors of the plurality of past estimated velocities prior to the correcting, by correcting each of the plurality of past estimated velocities with a correction amount obtained by multiplying a difference between the velocity initial value and a latest pre-correction past estimated velocity by a coefficient corresponding to the time period.

4. The travel distance estimation device according to claim 1, wherein processor is further configured to:

calculate the acceleration integrated value and successively calculate a relative azimuth relative to the traveling direction at a base point of time by integrating a yaw rate detected by a yaw rate sensor, the yaw rate sensor detecting the yaw rate of the movable object;

calculate a satellite direction velocity based on the Doppler shift amount of the GPS signal received by the GPS signal receiver from the GPS satellite, the satellite direction velocity being a component of a velocity of the vehicle in the direction to the satellite;

calculate a line-of-sight vector from the vehicle to the satellite based on the GPS signal,

determine, as the velocity initial value, the velocity of the vehicle calculated based on the Doppler shift amount of the GPS signal received by the GPS signal receiver from the GPS satellite of the GPS satellite positioning system,

determine the velocity initial value based on;

a velocity estimation expression showing a relationship among the satellite direction velocity, the line-of-sight vector, the velocity of the vehicle, and a traveling orientation of the vehicle;

the calculated satellite direction velocity;

the calculated line-of-sight vector; and

the calculated relative azimuth, and

wherein, in an expression showing the relationship among the satellite direction velocity, the line-of-sight vector, and a velocity vector of the vehicle in the velocity estimation expression, a magnitude of the velocity vector is constrained by the velocity of the vehicle and a time variation of a direction of the velocity vector is constrained by a time variation of the azimuth of the velocity in the traveling direction.

5. The travel distance estimation device according to claim 1, the processor being further configured to:

calculate a satellite direction velocity based on the Doppler shift amount of the GPS signal received by the GPS signal receiver from the GPS satellite, the satellite direction velocity being a component of a velocity of the vehicle in the direction to the satellite; and

calculate a line-of-sight vector from the vehicle to the satellite based on the satellite signal,

determine, as the velocity initial value, the velocity of the vehicle calculated based on the Doppler shift amount of the GPS signal received by the GPS signal receiver from the GPS satellite of the GPS satellite positioning system,

determine the velocity initial value of the vehicle based on;

a velocity estimation expression showing a relationship among the satellite direction velocity, the line-of-sight vector, the velocity of the vehicle, a traveling orientation of the vehicle, and a clock drift;

the calculated satellite direction velocity; and

the calculated line-of-sight, and

wherein, in an expression showing the relationship among the satellite direction velocity, the line-of-sight vector, a velocity vector of the velocity, and the clock drift in the velocity estimation expression, a magnitude of the velocity vector is constrained by the velocity of the vehicle and the clock drift is constrained by a constraint condition that a time variation of the clock drift is linear.

6. The travel distance estimation device according to claim 4, wherein

the velocity estimation expression includes a clock drift in addition to the satellite direction velocity, the line-of-sight vector, the velocity of the vehicle, and the traveling orientation of the vehicle.

7. The travel distance estimation device according to claim 6, wherein

the velocity estimation expression is further constrained by a condition that a time variation of the clock drift is linear.

8. The travel distance estimation device according to claim 4, wherein:

the velocity estimation expression includes a term of the initial velocity value and a term of the acceleration integrated value as a term of the velocity of the vehicle; and

when determining the velocity initial value by using the velocity estimation expression, the processor is further configured to determine the velocity initial value based on the calculated acceleration integrated value in addition to the velocity estimation expression, the calculated satellite direction velocity, and the calculated line-of-sight vector.