Fixed clearing of voxel map