First Draft of the new Djikstra's Algo implementation