Cleaned up all the graph-alg motion-planning algorithms. Put most visitor-concepts in separate file. Reduced header inclusions.