Text this: Interlacing Self-Localization, Moving Object Tracking and Mapping for 3D Range Sensors