Implemented broken but functional Djikstra