System and method for hybrid simultaneous localization and mapping of 2D and 3D data acquired by sensors from a 3D scene
First Claim
1. A method for registering data, comprising steps of:
- acquiring the data from a scene by a sensor at different viewpoints;
extracting, from the data, three-dimensional (3D) points and 3D lines, and descriptors associated with the 3D points and the 3D lines, wherein each 3D line is extracted as a ray connecting an optional center of the sensor with a two-dimensional (2) point;
selecting a first set of primitives represented in a first coordinate system of the sensor, wherein the first set of primitives includes at least three 3D points;
selecting a second set of primitives represented in a second coordinate system, wherein the second set of primitives includes any combination of 3D points and 3D lines to obtain at least three primitives; and
registering, using the first set of primitives and the second set of primitives, the 3D points with each other using point-to-point correspondence, and the 3D points with the 3D lines using point-to-line correspondence to obtain registered primitives, wherein the registered primitives are used in a simultaneous localization and mapping (SLAM) system, and wherein the steps are performed in a processor.
1 Assignment
0 Petitions
Accused Products
Abstract
A method and system for registering data by first acquiring the data from a scene by a sensor at different viewpoints, and extracting, from the data, three-dimensional (3D) points and 3D lines, and descriptors associated with the 3D points and the 3D lines. A first set of primitives represented in a first coordinate system of the sensor is selected, wherein the first set of primitives includes at least three 3D points. A second set of primitives represented in a second coordinate system is selected, wherein the second set of primitives includes any combination of 3D points and 3D lines to obtain at least three primitives. Then, using the first set of primitives and the second set of primitives, the 3D points are registered with each other, and the 3D points with the 3D lines to obtain registered primitives, wherein the registered primitives are used in a simultaneous localization and mapping (SLAM) system.
28 Citations
13 Claims
-
1. A method for registering data, comprising steps of:
-
acquiring the data from a scene by a sensor at different viewpoints; extracting, from the data, three-dimensional (3D) points and 3D lines, and descriptors associated with the 3D points and the 3D lines, wherein each 3D line is extracted as a ray connecting an optional center of the sensor with a two-dimensional (2) point; selecting a first set of primitives represented in a first coordinate system of the sensor, wherein the first set of primitives includes at least three 3D points; selecting a second set of primitives represented in a second coordinate system, wherein the second set of primitives includes any combination of 3D points and 3D lines to obtain at least three primitives; and registering, using the first set of primitives and the second set of primitives, the 3D points with each other using point-to-point correspondence, and the 3D points with the 3D lines using point-to-line correspondence to obtain registered primitives, wherein the registered primitives are used in a simultaneous localization and mapping (SLAM) system, and wherein the steps are performed in a processor. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11)
-
-
12. A system for registering data, comprising:
-
a sensor, at different viewpoints, configured to acquiring the data from a scene; and processor configured to extract, from the data, three-dimensional (3D) points and 3D lines, and descriptors associated with the 3D points and the 3D lines wherein each 3D line is extracted as a ray connecting an optical center of the sensor with a two-dimensional (2D) point, to select a first set of primitives represented in a first coordinate system of the sensor, wherein the first set of primitives includes at least three 3D points, to select a second set of primitives represented in a second coordinate system, wherein the second set of primitives includes any combination of 3D points and 3D lines to obtain at least three primitives, and to register, using the first set of primitives and the second set of primitives, the 3D points with each other using point-to-point correspondence, and the 3D points with the 3D lines using point-to-line correspondence to obtain registered primitives, wherein the registered primitives are used in a simultaneous localization and mapping (SLAM) system.
-
-
13. A method for registering data, comprising steps of:
-
acquiring the data from a scene by a sensor at different viewpoints; extracting, from the data, three-dimensional (3D) points and 3D lines, and descriptors associated with the 3D points and the 3D lines; selecting a first set of primitives represented in a first coordinate system of the sensor, wherein the first set of primitives includes at least three 3D points; selecting a second set of primitives represented in a second coordinate system, wherein the second set of primitives includes any combination of 3D points and 3D lines to obtain at least three primitives; and registering, using the first set of primitives and the second set of primitives, the 3D points with each other, and the 3D points with the 3D lines to obtain registered primitives, wherein the registered primitives are used in a simultaneous localization and mapping (SLAM) system, wherein the primitives include 3D planes, wherein registering is performed via random sample consensus (RANSAC), which is initialized with triplets of correspondences in a following order of 3 plane-to-plane correspondences, 2 plane-to-plane and 1 point-to-point correspondences, 1 point-to-plane and 2 point-to-point correspondences, 3 point-to-point correspondences, and 3 point-to-point correspondences, and wherein the steps are performed in a processor.
-
Specification