Dijkstras is working, but no Queue or early termination yet.