Low quality pose lane associator
An autonomous vehicle (AV) includes a vehicle computing system configured to receive map data of a geographic location, obtain position estimate data of the autonomous vehicle and determine a route of the autonomous vehicle including a plurality of roadways in the plurality of submaps. The autonomous vehicle determines a route including a plurality of roadways, determines a first roadway in the plurality of roadways closest to the position estimate and a second roadway outside the plurality of roadways closest to the position estimate of the autonomous vehicle, and determines a pose relative to the first roadway or the second roadway based on a distance between the position estimate of the autonomous vehicle and a roadway associated with a prior pose of the autonomous vehicle to control travel of the autonomous vehicle based on the vehicle pose.
1. An autonomous vehicle comprising:
a vehicle computing system comprising one or more processors, wherein the vehicle computing system is configured to:
receive map data associated with a map of a geographic location, the map comprising a plurality of roadways associated with one or more submaps where an autonomous vehicle can travel, the plurality of roadways comprising one or more routes;
obtain position estimate data associated with a position estimate of the autonomous vehicle in the geographic location;
determine a route of the autonomous vehicle including a subset of the plurality of roadways;
determine a first roadway in the subset of the plurality of roadways of the route closest to the position estimate of the autonomous vehicle;
determine a second roadway outside the subset of the plurality of roadways of the route closest to the position estimate of the autonomous vehicle;
determine a distance between the position estimate of the autonomous vehicle and a roadway associated with a prior pose of the autonomous vehicle;
determine a vehicle pose relative to a submap of the one or more submaps associated with the first roadway or the second roadway based on the distance; and
control travel of the autonomous vehicle based on the vehicle pose.