This paper presents 6-DOF monocular EKFSLAM with undelayed initialization using linear landmarks with extensible endpoints, based on the Plucker parametrization. A careful analysis of the properties of the Plucker coordinates, defined in the projective space ℙ 5 , permits their direct usage for undelayed initialization. Immediately after detection of a segment in the image, a Plucker line is incorporated in the map. A single Gaussian pdf includes inside its 2-sigma region all possible lines given the observed segment, from arbitrarily close up to the infinity range, and in any orientation. The lines converge to stable 3D configurations as the moving camera gathers observations from new viewpoints. The line's endpoints, maintained out of the map, are constantly retro-projected from the image onto the line's local reference frame. An extending-only policy is defined to update them. We validate the method via Monte Carlo simulations and with real imagery data.
['Joan Sola', 'Teresa A. Vidal-Calleja', 'Michel Devy']
Undelayed initialization of line segments in monocular SLAM