Added debugging code for Dijkstra routing problem