Dijkstra algorithm implemented

Almost done :)