Method for determining the position of a vehicle

Patent metadata

Field	Value
Publication number	US-11500083-B2
Application number	US-201916241404-A
Country	US
Kind code	B2
Filing date	Jan 7, 2019
Priority date	Jan 25, 2018
Publication date	Nov 15, 2022
Grant date	Nov 15, 2022

Abstract

A method is described for determining the position of a vehicle equipped with a radar system that includes at least one radar sensor adapted to receive radar signals emitted from at least one radar emitter of the radar system and reflected the radar sensor. The method comprises: acquiring at least one radar scan comprising a plurality of radar detection points, wherein each radar detection point is evaluated from a radar signal received at the radar sensor and representing a location in the vicinity of the vehicle; determining, from a database, a predefined map, wherein the map comprises at least one element representing a static landmark in the vicinity of the vehicle; matching at least a subset of the plurality of radar detection points of the at least one scan and the at least one element of the map; deter-mining the position of the vehicle based on the matching.

First claim

We claim:

1. A method for determining a position of a vehicle equipped with a radar system, wherein the radar system includes at least one radar sensor adapted to receive radar signals emitted from at least one radar emitter of the radar system and reflected in a vicinity of the vehicle towards the radar sensor, the method comprising:
acquiring at least one radar scan comprising a plurality of radar detection points, wherein each radar detection point is evaluated from a radar signal received at the radar sensor and representing a location in the vicinity of the vehicle in a vehicle coordinate system;
determining, from a database that includes map data representing a geo-structural model of a driving area that includes the location, a predefined map, the predefined map being a subset of the map data limited to the vicinity of the vehicle and including at least one element representing a static landmark in the vicinity of the vehicle, wherein the at least one element of the map comprises a straight line or a plane that provides a parametric model of the static landmark and information about a global position of the static landmark;
matching, using a rigid transformation function, at least a subset of the plurality of radar detection points of the at least one radar scan and the at least one element of the predefined map in a transformed vehicle coordinate system relative to the world coordinate system, the rigid transformation function being determined by minimizing distances between transformed radar detection points and the at least one element assigned to the plurality of radar detection points, the transformed radar detection points representing the subset of the plurality of radar detection points transformed to the transformed vehicle coordinate system using the rigid transformation function; and
determining the position of the vehicle in the world coordinate system based on the matching.

2. The method of claim 1 , wherein the method does not comprise using data from a space-based radio-navigation system of the vehicle.

3. The method of claim 1 , the method further comprising:
determining, using a pre-filtering of the plurality of radar detection points, the subset of the plurality of radar detection points to be matched, wherein the pre-filtering comprises, for each radar detection point of the plurality of radar detection points;
identifying, from the at least one element of the map data, a respective element having a minimum distance to a respective one of the plurality of radar detection points, and
assigning a respective element so identified to the respective one of the plurality of radar detection points if the distance is below a predefined threshold,

wherein the subset of the plurality of radar detection points includes all radar detection points from the plurality of radar detection points to which an element has been assigned.

4. The method of claim 1 ,
wherein determining the rigid transformation function comprises minimizing

F
⁡
(

P
,
R
,
t

)

=

∑

i
=
1

m

[

n
i
T

(

R
⁢

p
i

+
t

)

-

b
i

]

2

,

wherein
P represents the subset of m radar detection points,
R represents a rotation,
t represents a translation,
p i represents the i-th radar detection point of P,
b 1 represents an orthogonal distance to the element assigned to the i-th radar detection point of P,
n i T represents a transpose of a normal vector with respect to the element assigned to the i-th radar detection point of P.

5. The method of claim 1 , wherein determining the rigid transformation function comprises a probabilistic model, wherein at least one parameter of the probabilistic model represents an expected variance of a respective one of the plurality of radar detection points, wherein the expected variance is non-constant.

6. The method of claim 5 , wherein:
for a respective radar detection point, the expected variance of the radar detection point comprises a first component and a second component,
the first component representing the expected variance with respect to a distance between the location in the vicinity of the vehicle represented by the radar detection point and the at least one radar sensor,
the second component representing the expected variance with respect to an angle identifying a direction of the location in the vicinity of the vehicle represented by the radar detection point relative to the at least one radar sensor, and
the first component being smaller than the second component.

7. The method of claim 1 , wherein the method further comprises
determining, from a motion model of the vehicle, a preliminary position of the vehicle,
wherein determining the position of the vehicle comprises transforming the preliminary position using the rigid transformation function.

8. The method of claim 7 , wherein the motion model is determined based on at least one measurement from at least one motion sensor of the vehicle and/or on the basis of at least some of the plurality of radar detection points.

9. The method of claim 8 , wherein the measurement from the at least one motion sensor comprises a velocity or a yaw rate of the vehicle.

10. The method of claim 1 , wherein the position of the vehicle comprises coordinates representing a location and an orientation of the vehicle.

11. The method of claim 1 , wherein the subset of the plurality of radar detection points includes radar detection points from a plurality of successive radar scans of the radar system, in particular 1 to 20 scans, preferably 10 scans, wherein a scan rate of the radar system is between 10 to 40 Hz, preferably 20 Hz.

12. A vehicle comprising:
a radar system, the radar system including at least one radar sensor adapted to receive radar signals emitted from at least one radar emitter of the radar system and reflected in a vicinity of the vehicle towards the radar sensor; and
a control and processing unit configured to:
acquire at least one radar scan comprising a plurality of radar detection points, wherein each radar detection point

Assignees

• Aptiv Tech Ltd

Inventors

• Pishehvari Ahmad
• Lessmann Stephanie
• Iurgel Uri
• Roese-Koerner Lutz

Classifications

• G01S2013/9314

  Parking operations · CPC title

• G01S2013/93185

  Controlling the brakes · CPC title

• G01S2013/9319

  Controlling the accelerator · CPC title

• G01S7/2923

  based on data belonging to a number of consecutive radar periods · CPC title

• B60W40/105

  Speed · CPC title