Adding debugging tools for djikstra and fixed bug with location.isEqualTo
Merge branch 'dijkstra_fix'