Gravar-mail: Efficient localization and mapping for robotics : algorithms and tools