New implementation of Dijkstra's algorithm

BLAZINGLY FAST!
Stop printing extra nodes to .lst

They get removed by nodefix macro, so shouldn't cause processing to
stop.