OctoMap: A probabilistic, flexible, and compact 3D map representation for robotic systems
6d slam - 3d mapping outdoor environments .