PCL:实现测试gasd estimation估计
#include <pcl/test/gtest.h>
#include <pcl/point_cloud.h>
#include <pcl/features/gasd.h>
#include <pcl/io/pcd_io.h>
pcl::PointCloud<pcl::PointXYZ>::Ptr cloud;
//
void
createColorCloud (pcl::PointCloud<pcl::PointXYZRGBA> &colorCloud)
{
for (std::size_t i = 0; i < cloud->size (); ++i)
{
pcl::PointXYZRGBA p;
p.getVector3fMap () = (*cloud)[i].getVector3fMap ();
p.rgba = ( (i % 255) << 16) + ( ( (255 - i) % 255) << 8) + ( (i * 37) % 255);
colorCloud.push_back (p);
}
}
//
TEST(PCL, GASDTransformEstimation)
{
pcl::GASDEstimation<pcl::PointXYZ, pcl::GASDSignature512> gasd;
gasd.setInputCloud (cloud);
pcl::PointCloud<pcl::GASDSignature512>