TSDF Manifolds: A Scalable and Consistent Dense Mapping Approach

In many applications, maintaining a consistent dense map of the environment is key to enabling robotic platforms to perform higher level decision making. Several works have addressed the challenge of creating precise dense 3D maps. However, during operation over longer missions, reconstructions can easily become inconsistent due to accumulated camera tracking error and delayed loop closure. Without explicitly addressing the problem of map consistency, recovery from such distortions tends to be difficult. We present a novel system for dense 3D mapping which addresses the challenge of building consistent maps while dealing with scalability. Central to our approach is the representation of the environment as a manifold map, comprised of overlapping TSDF volumes. These volumes are localized through feature-based bundle adjustment. Our main contribution is to use a probabilistic measure to identify stable regions in the map, and fuse the contributing subvolumes. This approach allows us to reduce map growth while still maintaining consistency. We demonstrate the proposed system on publicly available datasets, as well as on a number of our own datasets, and demonstrate the efficacy of the proposed approach for building consistent and scalable maps.