基于pcl库拟合已知空间两点坐标的直线并将其可视化的C++代码

以下是一个基于pcl库拟合已知空间两点坐标的直线，并将其可视化的C++代码示例：

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

int main()
{
    // 创建点云对象
    pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>);
  
    // 添加已知的两个点坐标
    pcl::PointXYZ point1;
    point1.x = 1.0;
    point1.y = 2.0;
    point1.z = 3.0;
    cloud->push_back(point1);
  
    pcl::PointXYZ point2;
    point2.x = 4.0;
    point2.y = 5.0;
    point2.z = 6.0;
    cloud->push_back(point2);
  
    // 创建分割对象
    pcl::ModelCoefficients::Ptr coefficients(new pcl::ModelCoefficients);
    pcl::PointIndices::Ptr inliers(new pcl::PointIndices);
    pcl::SACSegmentation<pcl::PointXYZ> seg;
    seg.setOptimizeCoefficients(true);
    seg.setModelType(pcl::SACMODEL_LINE);
    seg.setMethodType(pcl::SAC_RANSAC);
    seg.setInputCloud(cloud);
    seg.segment(*inliers, *coefficients);
  
    // 创建可视化对象
    pcl::visualization::PCLVisualizer viewer("Line fitting");
    viewer.setBackgroundColor(0.0, 0.0, 0.0);
  
    // 可视化原始点云
    pcl::visualization::PointCloudColorHandlerCustom<pcl::PointXYZ> color(cloud, 255, 255, 255);
    viewer.addPointCloud(cloud, color, "cloud");
  
    // 可视化拟合的直线
    pcl::PointXYZ p1, p2;
    p1.x = cloud->points[inliers->indices[0]].x;
    p1.y = cloud->points[inliers->indices[0]].y;
    p1.z = cloud->points[inliers->indices[0]].z;
    p2.x = cloud->points[inliers->indices[1]].x;
    p2.y = cloud->points[inliers->indices[1]].y;
    p2.z = cloud->points[inliers->indices[1]].z;
    viewer.addLine<pcl::PointXYZ>(p1, p2, "line");
  
    // 显示结果
    while (!viewer.wasStopped())
    {
        viewer.spinOnce();
    }
  
    return 0;
}

这段代码中，我们首先创建了一个点云对象，并添加了两个已知点的坐标。然后，使用SACSegmentation类进行直线拟合，得到直线的模型参数。接下来，创建了一个PCLVisualizer对象，并将原始点云和拟合的直线添加到可视化对象中。最后，通过循环显示可视化结果，直到用户关闭可视化窗口