Add basic implementation for adding a neighbor and getting the distance to it