Simple sampling implementation for cartesian points.

This PR will have to be updated one #33 is accepted.  Also, this PR conflicts with #25.  This PR is simply to address a pressing need to perform sampling on Cartesian points.
You are correct...there should be a `const Eigen::Affine3d &a` argument as well.