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.