Add test points
Got FPFH working in C++ using PCL.
Made more options settable, added downsampling (I think?)