Made primitive_extractor templateized on point type and filter the point cloud before doing the extraction in the ros wrapper