Improved inverse-depth parameterization for monocular simultaneous localization and mapping