visualization of a pathfinder is really the best chioce I'm also working on a different pathfinder, and I started with implementing visual representation of all the processes, because I'm coding with a lot of errors... but in this way debugging/optimization is much easier.