CPC G01S 19/49 (2013.01) [G01C 21/16 (2013.01); G01C 21/1652 (2020.08); G01S 19/485 (2020.05); G05D 1/024 (2013.01)] | 20 Claims |
1. A positioning method, comprising:
obtaining a Global Navigation Satellite System (GNSS) position of a vehicle;
obtaining, based on the GNSS position of the vehicle, standard positioning data around a road where the vehicle is located from preset standard positioning database, wherein the standard positioning data comprises pre-computed and pre-stored laser point data of GNSS-positioned key points of road objects with stable attributes on or by either side of the road;
obtaining laser point cloud data, outputted by a laser sensor of the vehicle, around the road where the vehicle is located;
extracting to-be-matched positioning data around the road where the vehicle is located from the laser point cloud data, wherein the to-be-matched positioning data comprises laser point data of laser-sensor-output key points of at least one road object with a stable attribute on or by either side of the road where the vehicle is located;
obtaining more than one sampling positions corresponding to the vehicle at a previous moment;
combining the more than one sampling positions with a plurality of position points near the more than one sampling positions to form first sampling positions;
forward simulating a motion state of the vehicle based on the first sampling positions, to obtain more than one simulated positions corresponding to the vehicle at a current moment;
converting the to-be-matched positioning data into a coordinate system corresponding to the standard positioning data based on the more than one simulated positions corresponding to the vehicle at the current moment;
matching the to-be-matched positioning data in the coordinate system with the standard positioning data, to obtain a probability that the vehicle is located at each simulated position corresponding to the vehicle at the current moment based on a matching result; and
obtaining a position of the vehicle based on the probability that the vehicle is located at each simulated position corresponding to the vehicle at the current moment.
|