Added path_finding function along with corresponding function for finding neighbors in the map server.