Dijkstra fully working :D