Added an implementation of dijkstra