摘要 |
A vehicle having an on-board computer, vehicle sensors, a satellite-positioning unit, a database storing a lane-level map performs a method to determine a new pose of the vehicle using map matching. The method includes the on-board computer of the vehicle receiving new data from at least one of the vehicle sensors and collecting measurements from the vehicle sensors. The method also includes the on-board computer of the vehicle computing propagation of vehicle pose with respect to consecutive time instances and performing a curve-fitting process. The method further includes the on-board computer of the vehicle performing a sub-routine of updating at least one observation model based on results of the curve-fitting process, performing a tracking sub-routine including using a probability distribution to update the vehicle pose in terms of data particles, and performing a particle filtering sub-routine based on the data particles to compute the new vehicle pose. |