System and method for precision localization and mapping

1. A method for localization and mapping, comprising:

at a camera mounted to a first vehicle, the first vehicle associated with a first global system location and a location error, recording a sequence of images in response to the location error exceeding a threshold error value;

identifying a landmark depicted in an image of the sequence of images with a landmark identification module of a computing system associated with the vehicle, the landmark associated with a landmark geographic location and a known dimension;

identifying the landmark in each of the sequence of images;

extracting a landmark pose from the image, based on the known dimension of the landmark, with a feature extraction module of the computing system;

extracting a corresponding landmark pose from each of the sequence of images;

determining, at the computing system, a relative position between the vehicle and the landmark geographic location based on the landmark pose;

determining a temporal pattern based on the corresponding landmark pose extracted from each of the sequence of images;

determining a vehicle trajectory based on the temporal pattern, wherein the vehicle is controlled along the vehicle trajectory based on the location error, and wherein the vehicle is an autonomous vehicle;

updating, at the computing system, the first global system location based on the relative position;

setting the location error to an error value below the threshold error value in response to updating the global system location;

determining, at the computing system, a speed value and heading value associated with the vehicle, wherein the speed value is associated with a speed error and the heading value is associated with a heading error;

continuously updating the first global system location based on the speed value and heading value; and

continuously incrementing the location error in proportion to an elapsed time subsequent to updating the global system location and based on the speed error and the heading error.

2. The method of claim 1 , further comprising determining the landmark geographic location of the landmark based on the first global system location and the relative position, and storing the landmark geographic location at a database associated with the computing system.

3. The method of claim 1 , further comprising:

identifying a plurality of landmarks depicted in the image, each of the plurality of landmarks associated with a corresponding geographic location;

extracting a corresponding landmark pose associated with each of the plurality of landmarks from the image;

determining a set of landmark geographic locations based on the corresponding landmark poses associated with each of the plurality of landmarks; and

determining the first global system location based on the set of landmark geographic locations.

4. The method of claim 1 , further comprising:

transmitting the first global system location to a second vehicle associated with a second global system location;

determining a second relative position between the second vehicle and the first vehicle; and

updating the second global system location based on the global system location and the second relative position.

5. The method of claim 1 , further comprising determining a route based on an accumulation rate of the location error exceeding a threshold accumulation rate value, and navigating the first vehicle according to the route.

6. The method of claim 1 , wherein the landmark is associated with a landmark position, and further comprising:

determining, at the computing system, a second relative position between the first vehicle and the landmark position;

determining the landmark geographic location based on the first global system location and the second relative position;

associating the landmark pose and the second relative position to generate a pose-position pair;

storing the pose-position pair and the landmark geographic location at a database.

7. The method of claim 6 , further comprising determining a change in the known dimension of the landmark, based on the image, and updating the known dimension at the database based on the change.