CPC G01S 13/60 (2013.01) [G01S 13/588 (2013.01); G01S 13/589 (2013.01); G01S 13/726 (2013.01); G01S 13/931 (2013.01); G01S 2013/93271 (2020.01)] | 10 Claims |
1. A method for determining a displacement vector of a motor vehicle, comprising:
a) determining, via a radar system fitted to the vehicle, positions, with respect to the vehicle, at a given time, of elements in surroundings of the vehicle that are static with respect to a traffic lane in which the vehicle is moving,
wherein, with a) having been executed at a previous time in order to determine previous positions of said elements with respect to the vehicle, a) is executed again at a following time in order to determine following positions of said elements with respect to the vehicle;
b) associating, via processing circuitry, said previous positions, determined via the radar system fitted to the vehicle, with said following positions, determined via the radar system fitted to the vehicle, to form various pairs of positions each grouping together the previous position and the following position of a same element in the surroundings of the vehicle; and
c) determining, via the processing circuitry by linear regression, respective features of an overall translation and of an overall rotation that make it possible, for the pairs of positions formed in b), to match said previous positions with said following positions, and determining the displacement vector of the vehicle based on the features of said overall translation and rotation, wherein
b) comprises: b1) for various feasible pairs of positions each grouping together one of the following positions and one of the previous positions, determining an individual cost, associated with the feasible pair of positions under consideration, based on the previous position and the following position of the feasible pair of positions.
|