1.相关参数
line的参数前三个是坐标的(x,y,z),后三个是该直线的方向向量
2.相关程序
#include <iostream>
#include <pcl/io/pcd_io.h>
#include <pcl/point_types.h>
#include <pcl/common/common.h>
#include <pcl/common/intersections.h>
int main(int argc, char** argv)
{
// ---------------------定义直线参数-----------------------
Eigen::VectorXf line_a(6);
line_a(0) = 0;
line_a(1) = 0;
line_a(2) = 0;
line_a(3) = 1;
line_a(4) = 0;
line_a(5) = 0;
Eigen::VectorXf line_b(6);
line_b(0) = 0;
line_b(1) = 1;
line_b(2) = 0;
line_b(3) = 0;
line_b(4) = -1;
line_b(5) = 0;
// --------------计算直线a和直线b的交点------------------------------
Eigen::Vector4f point;
bool flag = pcl::lineWithLin