The 6-DOF monocular camera case possibly represents the harder variant in the context of simultaneous localization and mapping problem. In the last years, several advances have been appeared in this area; however the application of these techniques to real world applications it’s difficult so far.
Recently, the unified inverse depth parametrization has shown to be a good option this challenging problem, in a scheme of EKF for the estimation of the stochastic map and camera pose. In this paper a new
delayed initialization scheme is proposed for adding new features to the stochastic map. The results show that delayed initialization can improve some aspects without losing the performance and unified aspect of the original method, when initial reference points are used in order to fix a metric scale in the map.
CitacióMunguia, R.; Grau, A. Delayed inverse depth monocular SLAM. A: IFAC World Congress. "17th IFAC World Congress". Seoul: PERGAMON PRESS. IFAC SERIES., 2008, p. 2365-2370.