Base class for path iterator.
Very early version of PRM building.
Changed the top level loop for the path planner experiment.
Completely untested KdTree in PRM.