WIP: Started implementing voxel map

Open Daniel Müller requested to merge dev/voxel_map into dev/ground_plane_fitting

Merge request reports