workaround annoying "could be used uninitialized" warning. Also use distance calculated by getClosestContactPoint
workaround annoying "could be used uninitialized" warning. Also use distance calculated by getClosestContactPoint

envire/slam-maps,envire/slam-maps