Hierarchies of octrees for efficient 3D mapping
OctoMap: A probabilistic, flexible, and compact 3D map representation for robotic systems