Added Node class: holds position/configuration pair

Added NearestNeighborAlgorithm: Skeleton missing/assuming there is a
method to get closest node/neighbors