Systems and methods for landmark generation for visual simultaneous localization and mapping
First Claim
1. A method of creating a landmark for navigation, the method comprising:
- acquiring a plurality of images with a visual sensor of a vehicle;
retrieving dead reckoning data corresponding to the retrieved plurality of images;
using the dead reckoning data to select at least 2 images from the plurality of images, wherein the selected images are taken spaced apart;
identifying visual features common to at least 2 of the selected images;
determining 3-dimensional coordinates of the identified visual features using the selected images;
generating a landmark comprising the one or more identified visual features and their corresponding 3-dimensional coordinates;
storing the generated landmark in a database comprising one or more existing landmarks; and
updating an estimate of the vehicle location and the locations of the existing landmarks and the generated landmark while navigating the same vehicle with the visual sensor based on the updated estimate of the vehicle location, said updating occurring when a landmark stored in the database is visually recognized;
wherein navigating and updating are performed under the control of electronic hardware.
7 Assignments
0 Petitions
Accused Products
Abstract
The invention is related to methods and apparatus that use a visual sensor and dead reckoning sensors to process Simultaneous Localization and Mapping (SLAM). These techniques can be used in robot navigation. Advantageously, such visual techniques can be used to autonomously generate and update a map. Unlike with laser rangefinders, the visual techniques are economically practical in a wide range of applications and can be used in relatively dynamic environments, such as environments in which people move. One embodiment further advantageously uses multiple particles to maintain multiple hypotheses with respect to localization and mapping. Further advantageously, one embodiment maintains the particles in a relatively computationally-efficient manner, thereby permitting the SLAM processes to be performed in software using relatively inexpensive microprocessor-based computer systems.
-
Citations
32 Claims
-
1. A method of creating a landmark for navigation, the method comprising:
-
acquiring a plurality of images with a visual sensor of a vehicle; retrieving dead reckoning data corresponding to the retrieved plurality of images; using the dead reckoning data to select at least 2 images from the plurality of images, wherein the selected images are taken spaced apart; identifying visual features common to at least 2 of the selected images; determining 3-dimensional coordinates of the identified visual features using the selected images; generating a landmark comprising the one or more identified visual features and their corresponding 3-dimensional coordinates; storing the generated landmark in a database comprising one or more existing landmarks; and updating an estimate of the vehicle location and the locations of the existing landmarks and the generated landmark while navigating the same vehicle with the visual sensor based on the updated estimate of the vehicle location, said updating occurring when a landmark stored in the database is visually recognized; wherein navigating and updating are performed under the control of electronic hardware. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11)
-
-
12. A computer program embodied in a tangible non-transitory computer readable medium for creating a landmark for navigation, the computer program comprising:
-
a module with instructions configured to acquire a plurality of images with a visual sensor of a vehicle; a module with instructions configured to retrieve dead reckoning data corresponding to the retrieved plurality of images; a module with instructions configured to use the dead reckoning data to select at least 2 images from the plurality of images, wherein the selected images are spaced apart; a module with instructions configured to identify visual features common to at least 2 of the selected images; a module with instructions configured to determine 3-dimensional coordinates of the identified visual features using the selected images; a module with instructions configured to generate a landmark comprising the one or more identified visual features and their corresponding 3-dimensional coordinates; a module with instructions configured to store the generated landmark in a database comprising one or more existing landmarks; and a module with instructions configured to update an estimate of the vehicle location and the locations of the existing landmarks and the generated landmark while navigating and to navigate the same vehicle with the visual sensor based on the updated estimate of the vehicle location, said update occurring when a landmark stored in the database is visually observed. - View Dependent Claims (13, 14, 15, 16)
-
-
17. A method of creating a landmark for navigation, the method comprising:
-
acquiring a plurality of images with a visual sensor of a vehicle; selecting at least 2 images from a plurality of images, wherein the at least 2 images are spaced apart; identifying visual features common to at least 2 of the selected images; determining 3-dimensional coordinates of the identified visual features using the at least 2 images; generating a landmark comprising the one or more identified visual features and their corresponding 3-dimensional coordinates; storing the generated landmark in a database comprising one or more existing landmarks; and updating an estimate of the vehicle location and the locations of the existing landmarks and the generated landmark while navigating the same vehicle with the visual sensor based on the updated estimate of the vehicle location, said updating occurring when a landmark stored in the database is visually recognized, wherein navigating is performed under the control of electronic hardware. - View Dependent Claims (18, 19, 20, 21, 22, 23, 24, 25, 26)
-
-
27. A circuit for creating a landmark for navigation, the circuit comprising:
-
a circuit configured to acquire a plurality of images with a visual sensor coupled to a vehicle; a circuit configured to select at least 2 images from a plurality of images, where wherein the at least 2 images are spaced apart; a circuit configured to identify visual features common to at least 2 of the selected images; a circuit configured to determine 3-dimensional coordinates of the identified visual features using the at least 2 images; a circuit configured to generate a landmark comprising the one or more identified visual features and their corresponding 3-dimensional coordinates; a circuit configured to store the generated landmark in a database comprising one or more existing landmarks; and a circuit configured to update an estimate of the vehicle location and the locations of the existing landmarks and the generated landmark while navigating and to navigate the same vehicle with the visual sensor based on the updated estimate of the vehicle location, said update occurring when a landmark stored in the database is visually observed. - View Dependent Claims (28, 29)
-
-
30. A computer program embodied in a tangible non-transitory computer readable medium for creating a landmark for navigation, the computer program comprising:
-
a module with instructions configured to acquire a plurality of images with a visual sensor coupled to a vehicle; a module with instructions configured to select at least 2 images from a plurality of images, wherein the at least 2 images are spaced apart; a module with instructions configured to identify visual features common to at least 2 of the selected images; a module with instructions configured to determine 3-dimensional coordinates of the identified visual features using the at least 2 images; a module with instructions configured to generate a landmark comprising the one or more identified visual features and their corresponding 3-dimensional coordinates; a module with instructions configured to store the generated landmark in a database comprising one or more existing landmarks; and a module with instructions configured to update an estimate of the vehicle location and the locations of the existing landmarks and the generated landmark while navigating and to navigate the same vehicle with the visual sensor based on the updated estimate of the vehicle location, said update occurring when a landmark stored in the database is visually observed. - View Dependent Claims (31, 32)
-
Specification