Apparatus and program for finding vehicle position

• US 20090287410A1
• Filed: 05/14/2009
• Published: 11/19/2009
• Est. Priority Date: 05/15/2008
• Status: Active Grant

• Current Assignee: DENSO Corporation
• Original Assignee: DENSO Corporation
• Inventors: KOBAYASHI, Tomokazu
• Granted Patent: US 8,180,566 B2
• Time in Patent Office: Days
• US Class Current: 701/209
• CPC Class Codes: G01C 21/30 Map- or contour-matching

Abstract

A navigation apparatus calculates a current position candidate of a vehicle based on absolute position information, and calculates a travelable area based on road width data and the like, and further calculates a center locus of the travelable area and an estimated position of the vehicle. The estimated position of the vehicle is then evaluated based on a distance between the estimated position and the center locus to yield a position candidate evaluation for displaying a current position mark on a displayed map.

Claims

1. A position finding apparatus comprising:

a position information acquisition unit for acquiring absolute position information indicative of an absolute position of a subject vehicle;

a road data acquisition unit for acquiring information on road links and road width;

a locus finding unit for finding a center locus of travelable area in each of the road links that is indicative of a center of the travelable area based on calculation of the travelable area for the subject vehicle by utilizing the information on road links and road width respectively derived from the road data acquisition unit;

a travel position estimation unit for estimating a travel position of the subject vehicle based on the absolute position derived from the absolute position acquisition unit;

an evaluation unit for performing evaluation of each of the road links that corresponds to the center locus based on a distance between the estimated travel position derived from the travel position estimation unit and the center locus derived from the locus finding unit; and

a current position finding unit for finding a current vehicle position of the subject vehicle on a road link after selecting the road link based on the evaluation of each of the road links.

2. The position finding apparatus of claim 1 further comprising:

a relative travel information acquisition unit for acquiring travel information on relative travel of the subject vehicle, wherein

the travel position estimation unit uses the travel information derived from the relative travel information acquisition unit instead of using the absolute position information derived from the position information acquisition unit.

11. A computer-readable storage medium having instructions that are programmed for causing a computer to be serving as each of the units in the position finding apparatus of claim 1.

3. A position finding apparatus comprising:

a position information acquisition unit for acquiring absolute position information indicative of an absolute position of a subject vehicle;

a relative travel information acquisition unit for acquiring travel information on relative travel of the subject vehicle,

a road data acquisition unit for acquiring information on road links and road width;

a candidate finding unit for finding, based on the absolute position information derived from the position information acquisition unit, one or more position candidates of a current vehicle position on a road link after extracting at least one road link that is possibly traveled by a subject vehicle from among multiple road links acquired by the road data acquisition unit;

a link series finding unit for finding, in association with respective position candidates derived from the candidate finding unit, a series of road links extending from a candidate road link that has the position candidate based on the information on the road links derived from the road data acquisition unit;

a locus finding unit for finding a center locus of travelable area in the series of road links that is indicative of a center of the travelable area based on calculation of the travelable area for the subject vehicle by utilizing the information on road width derived from the road data acquisition unit after the series of road links is found by the link series finding unit;

a position candidate update unit for updating the position candidate of the current vehicle position based on the travel information on the relative travel of the subject vehicle;

a travel position estimation unit for estimating a travel position of the subject vehicle based on the absolute position derived from the absolute position acquisition unit;

an evaluation unit for performing evaluation of the position candidate on the series of road links based on a distance between the estimated travel position derived from the travel position estimation unit and the center locus derived from the locus finding unit; and

a current position finding unit for finding the current vehicle position of the subject vehicle on the candidate road link after selecting one of the position candidates according to an evaluation result of each of the position candidates by the evaluation unit.

4. The position finding apparatus of claim 3, wherein

the link series finding unit finds the series of road links by arranging road links from the candidate road link toward one of a predetermined number of links and a predetermined distance.

5. The position finding apparatus of claim 3, wherein

the link series finding unit finds the series of road links in a manner that prioritizes a straightforward road link that extends in a straight travel direction from the candidate road link.

6. The position finding apparatus of claim 3 further comprising:

a guidance route information acquisition unit for acquiring information on guidance route, wherein

the link series finding unit finds the series of road links that extends along a guidance route that is determined by the information derived from the guidance information acquisition unit.

7. The position finding apparatus of claim 3 further comprising:

a locus calculation unit for calculating a travel locus of the subject vehicle based on the travel information derived from the travel information acquisition unit, wherein

the travel position estimation unit selects, at a predetermined timing, a most matching center locus relative to the travel locus derived from the locus calculation unit from among multiple center loci derived from the locus finding unit, and

the travel position estimation unit sets a matching point on the selected most matching center locus and finds, as the estimated travel position, a position resulting from defining the matching point as a start point of the travel locus that is derived from the locus calculation unit, instead of finding the estimated travel position of the subject vehicle based on the absolute position information derived from the position information acquisition unit.

8. The position finding apparatus of claim 7, wherein

the position candidate update unit defines, as a road surface point, a closest point on the center locus relative to the estimated travel position, and

the position candidate update unit uses a position on the road link that corresponds to the road surface point as the updated position candidate of the current vehicle position.

9. The position finding apparatus of claim 3, wherein

the evaluation unit performs the evaluation based on a distance between the estimated travel position derived from the travel position estimation unit and each of the travelable areas derived from the locus finding unit.

10. The position finding apparatus of claim 3 further comprising:

a candidate elimination unit for eliminating the position candidate after selecting the position candidate according to an evaluation result once the evaluation of each of the position candidates is performed by the evaluation unit.