OctoMap: A probabilistic, flexible, and compact 3D map representation for robotic systems
Accurate rough terrain estimation with space-carving kernels