DijkstraWithHeap siistitty jakamalla pienempiin metodeihin