Monocular SLAM with inverse scaling parametrization

The recent literature has shown that it is possible to solve the monocular Simultaneous Localization And Mapping using both undelayed features ini- tialization and an Extedend Kalman Filter. The key concept, to achieve this result, was the introduction of a new parametrization called Unified Inverse Depth that produces measurements equations with a high degree of linear- ity and allows an efficient and accurate modeling of uncertainties. In this paper we present a monocular EKF SLAM filter based on an alternative parametrization, i.e., the Inverse Scaling Parametrization, characterized by a reduced number of parameters, a more linear measurement model, and a bet- ter modeling of features uncertainty for both low and high parallax features. Experiments in simulation demonstrate that the use of the Inverse Scaling solution improves the monocular EKF SLAM filter when compared with the Unified Inverse Depth approach, while experiments on real data show the system working in practice as well.