Vehicle positioning using three metrics
First Claim
1. A method of determining a position of a vehicle relative to a road network formed by road segments represented by a geographic database, the method comprising the steps of:
- determining an intermediate position density along a plurality of road segments in the road network by shifting a prior position density which had been determined along said plurality of road segments by a distance traveled by the vehicle since the prior position density had been determined;
modifying said intermediate position density to take into account sensor data received since the prior position density had been determined to form a second position density wherein the sensor data includes (a) data indicating a position of the vehicle, (b) data indicating a heading of the vehicle, and (c) data indicating a change of heading of the vehicle as a function of distance traveled; and
determining the position of the vehicle to be that location along the plurality of road segments at which the second position density is greatest.
5 Assignments
0 Petitions
Accused Products
Abstract
A program and method are disclosed that provide for determining a position of a vehicle relative to a road network represented by a geographic database. An intermediate position density is determined along a plurality of road segments in the road network by shifting a prior position density which had been determined along the plurality of road segments by a distance traveled by the vehicle since the prior position density had been determined. Then, the intermediate position density is modified to take into account sensor-derived data received since the prior position density had been determined to form a new position density. The sensor-derived data include data indicating three metrics, namely (1) a position of the vehicle, (2) a heading of the vehicle, and (3) a curvature history. The curvature history represents a change of heading of the vehicle as a function of distance. Then, the position of the vehicle is determined to be that location along the plurality of road segments at which the new position density is greatest. Also disclosed is a program and method that operate when it has been determined that the vehicle has just completed a turn. According to this program and method, processed data values from the sensors that indicate the vehicle position are adjusted to correspond to a position along the road network as represented by the geographic database. Further, if it has been determined that the vehicle is located on a straight road segment after having completed a turn, processed data values of the sensors that indicate a vehicle heading are adjusted to correspond to the heading of the straight road segment upon which the vehicle has been determined to be located.
86 Citations
20 Claims
-
1. A method of determining a position of a vehicle relative to a road network formed by road segments represented by a geographic database, the method comprising the steps of:
-
determining an intermediate position density along a plurality of road segments in the road network by shifting a prior position density which had been determined along said plurality of road segments by a distance traveled by the vehicle since the prior position density had been determined;
modifying said intermediate position density to take into account sensor data received since the prior position density had been determined to form a second position density wherein the sensor data includes (a) data indicating a position of the vehicle, (b) data indicating a heading of the vehicle, and (c) data indicating a change of heading of the vehicle as a function of distance traveled; and
determining the position of the vehicle to be that location along the plurality of road segments at which the second position density is greatest. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9)
if the position of the vehicle indicates that the vehicle has just completed a turn, adjusting subsequent sensor data indicating a position of the vehicle to correspond to a position along the road network as represented by the geographic database.
-
-
6. The method of claim 5 further comprising:
if the position of the vehicle indicates that the vehicle has just completed a turn and is located on a straight road segment, adjusting subsequent sensor data indicating a heading of the vehicle to correspond to a heading of the straight road segment upon which the vehicle has been determined to be located.
-
7. The method of claim 1 further comprising:
if the position of the vehicle indicates that the vehicle has just completed a turn and is located on a straight road segment, adjusting subsequent sensor data indicating a heading of the vehicle to correspond to a heading of the straight road segment upon which the vehicle has been determined to be located.
-
8. The method of claim 1 wherein said position densities are represented by step functions.
-
9. The method of claim 8 wherein said step functions are represented by slots shiftable along said road segments.
-
10. A program that determines a position of a vehicle relative to data that represent navigable roads in a geographic region, the program comprising:
-
a first routine that forms an intermediate position density by shifting a prior-determined position density associated with a plurality of said navigable roads represented by said data by a distance traveled since said prior-determined position density was determined, wherein said prior-determined position density represents a probability that the vehicle was located along said plurality of navigable roads at a time to which said prior-determined position density related;
a second routine that modifies said intermediate position density using sensor data obtained since said prior-determined position density was determined to form a new position density, wherein the sensor data includes (a) data indicating a position of the vehicle, (b) data indicating a heading of the vehicle, and (c) data indicating a change of heading of the vehicle; and
a third routine that determines the position of the vehicle to be that location along said plurality of roads at which said new position density is greatest. - View Dependent Claims (11, 12, 13, 14, 15, 16, 17, 18)
a fourth routine that adjusts subsequent sensor data that indicate a position of the vehicle to correspond to a position along the road network as represented by the geographic database if the position of the vehicle determined by the third routine indicates that the vehicle has just completed a turn.
-
-
15. The invention of claim 14 wherein the fourth routine further adjusts subsequent data that indicates a heading of the vehicle to correspond to a heading of a straight road segment upon which the vehicle has been determined to be located if the position of the vehicle determined by the third routine indicates that the vehicle has just completed a turn and is located on a straight road segment.
-
16. The invention of claim 10 further comprising:
a fourth routine that adjusts subsequent data that indicates a heading of the vehicle to correspond to a heading of a straight road segment upon which the vehicle has been determined to be located if the position of the vehicle determined by the third routine indicates that the vehicle has just completed a turn and is located on a straight road segment.
-
17. The invention of claim 10 wherein said first, second, and third routines are stored on a computer-readable medium.
-
18. The invention of claim 10 wherein said program is installed in a navigation system installed in said vehicle.
-
19. A method of determining a position of a vehicle relative to a road network formed by road segments represented by a geographic database, the method comprising the steps of:
-
determining an intermediate position density along a plurality of road segments in the road network by shifting a prior position density which had been determined along said plurality of road segments by a distance traveled by the vehicle since the prior position density had been determined;
modifying said intermediate position density to take into account sensor data received since the prior position density had been determined to form a second position density;
determining the position of the vehicle to be that location along the plurality of road segments at which the second position density is greatest; and
if the vehicle has just completed a turn, adjusting subsequent data indicating a position of the vehicle to correspond to a position along the road network as represented by the geographic database. - View Dependent Claims (20)
if the vehicle has just completed a turn and is located on a straight road segment, adjusting subsequent sensor data indicating a heading of the vehicle to correspond to a heading of the straight road segment upon which the vehicle is located.
-
Specification