2017-03-16 27 views
0

我試圖將平面模型擬合到點雲(具有類似平面的結構)。SACSegmentation檢測奇數平面模型

我遇到的問題是,擬合平面只是雲的一小部分,即使距離閾值設置爲相對較大的值。

這裏有結果的一些圖片:(白點是模型正常值)

enter image description here

你可以看到雲在這裏有多薄:

enter image description here

enter image description here

我調整了SACSegmentation對象的各種參數a甚至嘗試了PCL沒有運氣的多種RANSAC方法。

這是顯示的點雲: https://drive.google.com/file/d/0B0PUIShwQuU7RmFKUW1Cd2V1Zk0/view?usp=sharing

這裏是下面的教程非常密切的最小代碼:

#include <iostream> 
#include <pcl/ModelCoefficients.h> 
#include <pcl/io/pcd_io.h> 
#include <pcl/point_types.h> 
#include <pcl/sample_consensus/method_types.h> 
#include <pcl/sample_consensus/model_types.h> 
#include <pcl/segmentation/sac_segmentation.h> 


int 
main(int argc, char** argv) 
{ 
    pcl::PointCloud<pcl::PointXYZI>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZI>); 
    pcl::io::loadPCDFile<pcl::PointXYZI>("test.pcd", *cloud); //* load the file 

    pcl::ModelCoefficients::Ptr coefficients(new pcl::ModelCoefficients); 
    pcl::PointIndices::Ptr inliers(new pcl::PointIndices); 
    // Create the segmentation object 
    pcl::SACSegmentation<pcl::PointXYZI> seg; 
    // Optional 
    seg.setOptimizeCoefficients(true); 
    // Mandatory 
    seg.setModelType(pcl::SACMODEL_PLANE); 
    seg.setMethodType(pcl::SAC_RANSAC); 
    seg.setDistanceThreshold(0.025); 

    seg.setInputCloud(cloud); 
    seg.segment(*inliers, *coefficients); 

    if (inliers->indices.size() == 0) 
    { 
     PCL_ERROR("Could not estimate a planar model for the given dataset."); 
     return (-1); 
    } 

    std::cerr << "Model coefficients: " << coefficients->values[0] << " " 
     << coefficients->values[1] << " " 
     << coefficients->values[2] << " " 
     << coefficients->values[3] << std::endl; 

    //add points to plane that fit plane model 
    pcl::PointCloud<pcl::PointXYZI>::Ptr output(new pcl::PointCloud<pcl::PointXYZI>); 
    for (size_t i = 0; i < inliers->indices.size(); ++i) 
    { 
     output->push_back(cloud->points[inliers->indices[i]]); 
    } 

    displaySubcloud(cloud, output); 
    displayPlane(cloud, coefficients, "plane"); 

    return (0); 
} 

回答

0

,我想出了一個解決方案,但我不知道爲什麼它修復它。通過將雲更接近原點,它可以檢測到正確的平面模型。