Combined radar and GPS localization system

Patent metadata

Field	Value
Publication number	US-9562778-B2
Application number	US-201113153137-A
Country	US
Kind code	B2
Filing date	Jun 3, 2011
Priority date	Jun 3, 2011
Publication date	Feb 7, 2017
Grant date	Feb 7, 2017

Abstract

A localization system within a vehicle in one embodiment includes a global position system (GPS) receiver, a radar sensor, a data storage device including program instructions stored therein, a symbolic map stored within the data storage device, and a controller operatively coupled to the data storage device, the GPS receiver, and the radar sensor, the controller configured to execute the program instructions to analyze data from the GPS receiver, data from the radar sensor, and data from the stored symbolic map, and determine a probabilistic vehicle location based upon the analysis.

First claim

What is claimed is:

1. A localization system within a vehicle comprising:
a global position system (GPS) receiver;
a radar sensor;
a data storage device including program instructions stored therein;
a symbolic map stored within the data storage device; and
a controller operatively coupled to the data storage device, the GPS receiver, and the radar sensor, the controller configured to execute the program instructions to
analyze data from the GPS receiver, data from the radar sensor, and data from the stored symbolic map, and
determine a probabilistic vehicle location based upon the analysis,

wherein the symbolic map comprises a map with lane-specific detail, and
the probabilistic vehicle location is a location within an error envelope of a calculated GPS location which is most likely to be the actual vehicle location.

2. The system of claim 1 , wherein analyzing the data from the GPS receiver, data from the radar sensor, and data from the stored symbolic map comprises:
generating a list of possible vehicle locations based upon the data from the GPS receiver, and determining a probabilistic vehicle location comprises:
estimating, for each of the possible vehicle locations, an actual location probability.

3. The system of claim 2 , wherein analyzing the data from the GPS receiver, data from the radar sensor, and data from the stored symbolic map comprises:
determining a velocity for each of a plurality of objects detected by the radar; and
classifying each of the plurality of objects detected by the radar based upon the determined velocity.

4. The system of claim 3 , wherein classifying each of the plurality of objects comprises:
classifying each of the plurality of objects detected by the radar based upon the determined velocity as static or dynamic.

5. The system of claim 4 , wherein determining a probabilistic vehicle location comprises:
determining, for each of the possible vehicle locations, a respective dynamic object alignment score for each of the plurality of objects classified as dynamic; and
determining, for each of the possible vehicle locations, a respective static object alignment score for each of the plurality of objects classified as static.

6. The system of claim 5 , wherein:
the respective dynamic object alignment score is based upon a projected location of a respective one of the plurality of objects classified as dynamic with respect to a first presumed center of a lane; and
the respective static object alignment score is based upon a projected location of a respective one of the plurality of objects classified as static with respect to a second presumed center of a lane.

7. The system of claim 3 , wherein determining a probabilistic vehicle location comprises:
determining, for each of the possible vehicle locations, a respective object alignment score for each of the plurality of objects.

8. The system of claim 7 , wherein:
the respective object alignment score is based upon a projected location of a respective one of the plurality of objects with respect to a presumed center of a lane.

9. The system of claim 1 , wherein the controller is further configured to execute the program instructions to generate a lane-specific navigation instruction based upon the determined probabilistic vehicle location.

10. The system of claim 1 , wherein the controller is further configured to execute the program instructions to generate a lane-specific lane departure warning based upon the determined probabilistic vehicle location.

11. The system of claim 1 , wherein the controller is further configured to execute the program instructions to generate an adaptive cruise instruction based upon the determined probabilistic vehicle location.

12. A method of localizing a vehicle comprising:
determining a global position system (GPS) location;
obtaining radar sensor data associated with a plurality of radar detected objects;
defining a first possible vehicle location with reference to a symbolic map based on the determined GPS location;
projecting a first location of the plurality of radar detected objects with reference to the symbolic map based on the first possible vehicle location;
analyzing the projected first location of the plurality of radar detected objects; and
determining a probabilistic vehicle location based upon the analysis of the projected first location, wherein
the symbolic map comprises a map with lane-specific detail, and
the probabilistic vehicle location is a location within an error envelope of a calculated GPS location which is most likely to be the actual vehicle location.

13. The method of claim 12 , further comprising:
defining a second possible vehicle location with reference to the symbolic map based on the determined GPS location;
projecting a second location of the plurality of radar detected objects with reference to the symbolic map based on the second possible vehicle location;
analyzing the projected second location of the plurality of radar detected objects; and
determining the probabilistic vehicle location based upon the analysis of the projected second location.

14. The method of claim 13 , further comprising:
determining a velocity for each of the plurality of radar detected objects; and
classifying each of the plurality of radar detected objects based upon the determined velocity.

15. The method of claim 14 , wherein classifying each of the plurality of radar detected objects comprises:
classifying each of the plurality of radar detected objects based upon the determined velocity as static or dynamic.

16. The method of claim 15 , wherein determining the probabilistic vehicle location based upon the analysis of the projected first location comprises:
determining a respective dynamic object alignment score for each of the plurality of radar detected objects classified as dynamic; and
determining a respective static object alignment score for each of the plurality of radar detected objects classified as static.

17. The method of claim 16 , wherein:
the respective dynamic object alignment score is based upon a projected location of a respective one of the plurality of radar detected objects classified as dynamic with respect to a first presumed center of a lane; and
the respective static object alignment score is based upon a projected location of a respective one of the plurality of radar detected objects classified as static with respect to a second presumed center of a lane.

18. The method of claim 14 , wherein determining the probabilistic vehicle location based upon the analysis of the projected first location comprises:
determining a respective object alignment score for each of the plurality of radar detected objects.

19. The method of claim 18 , wherein:
the respective object alignment score is based upon a projected location of the respective one of the plurality of radar detected objects with respect to a presumed center of a lane.

Assignees

• Becker Jan
• Pitzer Benjamin
• Bosch Gmbh Robert

Inventors

• Duhadway Charles
• Becker Jan
• Pitzer Benjamin

Classifications

• G01S13/86

  Combinations of radar systems with non-radar systems, e.g. sonar, direction finder · CPC title

• G01S19/45

  by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement · CPC title

• G01S5/0278

  involving statistical or probabilistic considerations (G01S5/0252, G01S5/0294 take precedence) · CPC title

• G01C21/28 Primary

  with correlation of data from several navigational instruments · CPC title