Dijkstra implementation java