Collaborative Visual-Inertial Localization of Teams With Floorplan Extraction

Abstract

This paper showcases a real-world example of a system that achieves collaborative localization and mapping of multiple agents within a building. The proposed system processes the odometry and 3D point cloud data collected by the agents moving around the building to automatically generate the building’s floorplan on which the agent trajectories are overlaid. The wearable hardware consists of a low-cost passive integrated sensor that includes both a camera and an IMU (Inertial Measurement Unit) and an embedded compute unit. The system’s capabilities are shown through real-world experiments.