Moved pathsToT into own file.
Cleaned up Pathfinder.