Refactor debugging output.
Update comments and fix error in Stage 3.

currentNode should have been startNode in Stage 3.

The results are still not correct but I am getting closer.