bool MakePlan::process(pcl::PointCloud<pcl::PointXYZRGB>::Ptr cloud_in, float a, float b, float c, float d, pcl::PointXYZRGB &avrPt) { pcl::PointCloud<pcl::PointXYZRGB>::Ptr cloud_filtered_out (new pcl::PointCloud<pcl::PointXYZRGB>); pcl::PointCloud<pcl::PointXYZRGB>::Ptr cloud_filtered_nan (new pcl::PointCloud<pcl::PointXYZRGB>); removeOutliers(cloud_in, cloud_filtered_out); removeField(cloud_filtered_out, cloud_filtered_nan); bool success = getAveragePoint(cloud_filtered_nan, avrPt); return success; }
bool Polyhedron<Real>::checkIfAveragePointIsInside() const { vector3<Real> averagePoint = getAveragePoint(); return isPointInside(averagePoint); }