Vehicle pose assessment

Patent metadata

Field	Value
Publication number	US-12358514-B2
Application number	US-202318193258-A
Country	US
Kind code	B2
Filing date	Mar 30, 2023
Priority date	Apr 6, 2022
Publication date	Jul 15, 2025
Grant date	Jul 15, 2025

Abstract

A method performed by a vehicle pose assessment system for supporting determining a pose of a vehicle in view of a digital map. The approach provided by the method alleviates finding lane segments of the digital map corresponding to current sensor detections, which in turn may support accurate and/or improved vehicle localization. An apparatus and computer storage medium for supporting determining a pose of a vehicle in view of a digital map are also provided.

First claim

The invention claimed is:

1. A method performed by a vehicle pose assessment system for supporting determining a pose of a vehicle in view of a digital map, the method comprising:
predicting a pose of the vehicle based on sensor data acquired by a vehicle localization system;
transforming to a selected coordinate system a set of map road references of a portion of the digital map based on the predicted pose of the vehicle, the transformed set of map road references forming a set of polylines in the selected coordinate system, which set of polylines forms a set of polyline paths respectively comprising segments of polylines;
identifying a set of corresponding sensor-captured road reference features acquired by a vehicle-mounted surrounding detecting device, each identified road reference feature defining a set of measurement coordinates in the selected coordinate system;
projecting each of the identified set of road reference features onto the polyline segments in order to obtain a set of projection points, each projection point defining a set of projection coordinates;
determining for each polyline segment, deviation parameters in view of each identified road reference feature, based on a projection distance between respective road reference feature's measurement coordinates and its corresponding polyline segment projection coordinates, for each polyline segment onto which one or more road reference features are having deviations fulfilling deviation criteria, the polyline segment is assigned predeterminable deviation parameters in view of those one or more road reference features; and
determining by combining the deviation parameters of respective polyline path's polyline segments, a respective path deviation for each polyline path.

2. The method according to claim 1 , further comprising:
identifying the polyline path with the least path deviation.

3. The method according to claim 2 , further comprising:
updating the predicted pose of the vehicle based on the determined deviation parameters of the identified polyline path.

4. The method according to claim 2 , wherein determining deviation parameters comprises respective deviation parameter being weighted with a respective projection distance uncertainty.

5. The method according to claim 2 , wherein determining deviation parameters comprises respective projection distance being weighted based on uncertainties in the predicted pose of the vehicle and/or the road reference feature.

6. The method according to claim 1 , wherein the transforming a set of map road references of a portion of the digital map comprises selecting the portion based on the predicted pose of the vehicle and a set of properties of the surrounding detecting device associated with altitudes deviating from one or both of an altitude of the vehicle and from a field of view of the surrounding detecting device, being discarded.

7. The method according to claim 6 , wherein the set of properties of the surrounding detected device comprise one or both of road map references of the digital map and a digital map portion.

8. The method according to claim 1 , wherein determining deviation parameters comprises respective deviation parameter being weighted with a respective projection distance uncertainty.

9. The method according to claim 1 , wherein determining deviation parameters comprises respective projection distance being weighted based on uncertainties in the predicted pose of the vehicle and/or the road reference feature.

10. A vehicle pose assessment system for supporting determining a pose of a vehicle in view of a digital map, the vehicle pose assessment system comprising:
a pose predicting unit configured to predict a pose of the vehicle based on sensor data acquired by a vehicle localization system;
a map transforming unit configured to transform to a selected coordinate system a set of map road references of a portion of the digital map based on the predicted pose of the vehicle, the transformed set of map road references forming a set of polylines in the selected coordinate system, which set of polylines forms a set of polyline paths respectively comprising segments of polylines;
a features identifying unit configured to identify a set of corresponding sensor-captured road reference features acquired by a vehicle-mounted surrounding detecting device, each identified road reference feature defining a set of measurement coordinates in the selected coordinate system;
a features projecting unit configured to project each of the identified set of road reference features onto the polyline segments in order to obtain a set of projection points, each projection point defining a set of projection coordinates;
a deviation determining unit configured to determine for each polyline segment, deviation parameters in view of each identified road reference feature, based on a projection distance between respective road reference feature's measurement coordinates and its corresponding polyline segment projection coordinates, for each polyline segment onto which one or more road reference features are having deviations fulfilling deviation criteria, the polyline segment is assigned predeterminable deviation parameters in view of those one or more road reference features; and
a path deviation determining configured to determine by combining the deviation parameters of respective polyline path's polyline segments, a respective path deviation for each polyline path.

11. The vehicle pose assessment system according to claim 10 , further comprising:
a path identifying unit configured to identify the polyline path with the least path deviation.

12. The vehicle pose assessment system according to claim 11 , further comprising:
a pose updating unit configured to update the predicted pose of the vehicle based on the determined deviation parameters of the identified polyline path.

13. The vehicle pose assessment system according to claim 11 , wherein the deviation determining unit is configured for a respective deviation parameter being weighted with a respective projection distance uncertainty.

14. The vehicle pose assessment system according to claim 11 , wherein the deviation determining unit is configured for a respective projection distance being weighted based on uncertainties in one or both of the predicted pose of the vehicle and the road reference feature.

15. The vehicle pose assessment system according to claim 10 , wherein the map transforming unit is configured to select the portion based on the predicted pose of the vehicle and a set of properties of the surrounding detecting device associated with altitudes one of both of deviating from an altitude of the vehicle and from a field of view of the surrounding detecting device, being discarded.

16. The vehicle pose assessment system according to claim 15 , wherein the set of properties of the surrounding detected device comprise one or both of road map references of the digital map and a digital map portion.

17. The vehicle pose assessment system according to claim 10 , wherein the deviation determining unit is configured for a respective deviation parameter being weighted with a respective projection distance uncertainty.

18. The vehicle pose assessment system according to claim 10 , wherein the deviation determining unit is configured for a respective projection distance being weighted based on uncertainties in one or both of the predicted pose of the vehicle and the road reference feature.

19. The vehicle pose assessment system according to claim 10 , wherein the vehicle

Assignees

• Zenseact Ab
• Ericsson Telefon Ab L M

Inventors

• Fu Junsheng
• Beauvisage Axel
• Slusarek Blazej
• Caselles Eduardo Sesma
• Kielén Pontus
• Hammarsten Markus
• Gustafsson Tony
• Hägg Eiliv

Classifications

• B60W2420/403

  Image sensing, e.g. optical camera · CPC title

• B60W2520/06

  Direction of travel · CPC title

• B60W40/06

  Road conditions · CPC title

• G06V20/588

  Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road · CPC title

• B60W2050/0005

  Processor details or data handling, e.g. memory registers or chip architecture · CPC title