Methods and systems for generating and using localization reference data
AssigneeTomTom Global Content B.V.
InventorsKrzysztof Kudrynski, Krzysztof Miksa, Rafal Jan Gliszczynski, Blazej Kubiak
Life of this patent
Estimating the term…
Abstract
Methods and systems for improved positioning accuracy relative to a digital map are disclosed, and which are preferably used for highly and fully automated driving applications, and which may use localisation reference data associated with a digital map. The invention further extends to methods and systems for the generation of localisation reference data associated with a digital map.
Claims15
A method of generating localisation reference data associated with a digital map representing elements of a navigable network, the localisation reference data providing a compressed representation of an environment around at least one junction of the navigable network represented by the digital map, the method comprising:
- obtaining, for at least one junction represented by the digital map, a set of data points in a three-dimensional coordinate system, wherein each data point represents a surface of an object in the environment around the at least one junction of the navigable network;
- generating, from the set of data points, localisation reference data comprising at least one depth map indicative of the environment around the junction projected on to a reference plane, said reference plane being defined by a reference line defined by a radius centred on a reference point associated with the junction, each pixel of the at least one depth map being associated with a position in the reference plane associated with the junction, and the pixel including a depth channel representing the distance to a surface of an object in the environment along a predetermined direction from the associated position of the pixel in the reference plane;
- and
- associating the generated localisation reference data with digital map data indicative of the junction.
A method of determining a position of a vehicle relative to a digital map, the digital map comprising data representative of a junction through which the vehicle is travelling, the method comprising:
- obtaining localisation reference data associated with the digital map for a deemed current position of the vehicle in the navigable network, wherein the location reference data comprises at least one depth map indicative of an environment around the vehicle projected on to a reference plane, said reference plane being defined by a reference line defined by a radius centred on a reference point associated with the junction, each pixel of the at least one depth map being associated with a position in the reference plane associated with the junction through which the vehicle is travelling, and the pixel including a depth channel representing the distance to a surface of an object in the environment along a predetermined direction from the associated position of the pixel in the reference plane;
- determining real time scan data by scanning the environment around the vehicle using at least one sensor, wherein the real time scan data comprises at least one depth map indicative of an environment around the vehicle, each pixel of the at least one depth map being associated with a position in the reference plane associated with the junction, and the pixel including a depth channel representing the distance to a surface of an object in the environment along the predetermined direction from the associated position of the pixel in the reference plane as determined using the at least one sensor;
- calculating a correlation between the localisation reference data and the real time scan data to determine an alignment offset between the depth maps;
- and
- using the determined alignment offset to adjust the deemed current position to determine the position of the vehicle relative to the digital map.
A system for generating localisation reference data associated with a digital map representing elements of a navigable network, the localisation reference data providing a compressed representation of an environment around at least one junction of the navigable network represented by the digital map, the system comprising processing circuitry configured, for at least one junction represented by the digital map, to:
- obtain a set of data points in a three-dimensional coordinate system, wherein each data point represents a surface of an object in the environment around the at least one junction of the navigable network;
- generate, from the set of data points, localisation reference data comprising at least one depth map indicative of the environment around the junction projected on to a reference plane, said reference plane being defined by a reference line defined by a radius centred on a reference point associated with the junction, each pixel of the at least one depth map being associated with a position in the reference plane associated with the junction, and the pixel including a depth channel representing the distance to a surface of an object in the environment along a predetermined direction from the associated position of the pixel in the reference plane;
- and
- associate the generated localisation reference data with digital map data indicative of the junction.
A system for determining a position of a vehicle relative to a digital map, the digital map comprising data representative of a junction through which the vehicle is travelling, the system comprising processing circuitry configured to:
- obtain localisation reference data associated with the digital map for a deemed current position of the vehicle in the navigable network, wherein the location reference data comprises at least one depth map indicative of an environment around the vehicle projected on to a reference plane, said reference plane being defined by a reference line defined by a radius centred on a reference point associated with the junction, each pixel of the at least one depth map being associated with a position in the reference plane associated with the junction through which the vehicle is travelling, and the pixel including a depth channel representing the distance to a surface of an object in the environment along a predetermined direction from the associated position of the pixel in the reference plane;
- determine real time scan data by scanning the environment around the vehicle using at least one sensor, wherein the real time scan data comprises at least one depth map indicative of an environment around the vehicle, each pixel of the at least one depth map being associated with a position in the reference plane associated with the junction, and the pixel including a depth channel representing the distance to a surface of an object in the environment along the predetermined direction from the associated position of the pixel in the reference plane as determined using the at least one sensor;
- calculate a correlation between the localisation reference data and the real time scan data to determine an alignment offset between the depth maps;
- and
- use the determined alignment offset to adjust the deemed current position to determine the position of the vehicle relative to the digital map.
Dependencies are inferred from the claim text.