Implementation of dijkstra for class project