Added Path class to find the route from the start to end (incomplete), currently only implemented breadth first search.