Added first dijkstra implementation