Undelayed 3D RO-SLAM based on Gaussian-mixture and reduced spherical parametrization

Abstract

This paper presents an undelayed range-only simultaneous localization and mapping (RO-SLAM) based on the Extended Kalman filter. The approach is optimized for working in 3D scenarios, reducing the required computational payload at two levels: first, using a reduced spherical state vector parametrization and, second, proposing a new EKF update scheme. The paper proposes a state vector parametrization based on Gaussian-Mixture to cope with the multi-modal nature of range-only measurements and a reduced spherical parametrization of the range sensor positions that allows to shorten the length of the state vector for a given number of hypotheses. The approach is firstly tested and discussed in simulation, followed by experimental results involving a real robot and radio-based range sensors.