Created PseudoinverseSolver in eigen_utils that modularizes choosing the pseudoinverse computation method in the GreedyCartesianPlanner.