Pulled the core cartesian planning into GreedyCartesianPlanner and factored the pseudoinverse computations out into eigen_utils.h. Created a new test program for testing this version of the planner--- the core next-point integration is still in the test code; it has not yet been moved into the planner proper.