Initial commit of copied code

CMakeLists copied from other project. Headers and cpp files copied
directly from PCL. No refactoring yet.