使用PCL绘制网格

最新推荐文章于 2023-10-17 16:16:50 发布

ll_gg_tt

最新推荐文章于 2023-10-17 16:16:50 发布

阅读量246

点赞数

分类专栏： PCL+VTK 文章标签： PCL 点云绘图网格

本文链接：https://blog.csdn.net/ll_gg_tt/article/details/132845281

版权

PCL+VTK 专栏收录该内容

2 篇文章 0 订阅

订阅专栏

文章介绍了如何使用PCL库在C++中创建和绘制10x10的网格，包括线段点云的生成和坐标轴刻度的显示。展示了`DrawGridAssist`函数中的关键代码片段和`CreatSegment`函数的实现。

摘要由CSDN通过智能技术生成

引言

用过PCL点云库的应该知道，PCL是基于点云进行绘制的，顾名思义就是所有图像均是通过点来构造的。基于此，绘制一些简单图形就需要构造一系列点，然后将这些点交给PCL绘制。

源码

void DrawGridAssist()
{
	const GRID_MARK_CNT = 10; // 10x10的网格
	const double delt = 0.001; // 线段点云的精度
	pcl::PointCloud<pcl::PointXYZ>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZ>);
	QString strRgb = gIniFile->Color_GetViewLine(); // 这里是从配置中读取的，可以自己给颜色
	QColor rtColor(strRgb);

	for (int i = -GRID_MARK_CNT; i <= GRID_MARK_CNT; i++)
	{
		pcl::PointXYZ horStartPt(-1, 0, i * 0.1);
		pcl::PointXYZ horEndPt(1, 0, i * 0.1);
		pcl::PointXYZ verStartPt(i * 0.1, 0, -1);
		pcl::PointXYZ verEndPt(i * 0.1, 0, 1);

		// 构造线段
		CreatSegment(horStartPt, horEndPt, cloud, delt);
		CreatSegment(verStartPt, verEndPt, cloud, delt);

		// 绘制Z方向刻度
		pcl::PointXYZ showHorPos(0, 0, i * 0.1);
		QString strHorID = QString("Grid-z%1").arg(i);
		mViewer->removeText3D(strHorID.toStdString());
		mViewer->addText3D(QString::number(-gMaxDistance/ GRID_MARK_CNT *i).toStdString(), showHorPos, 0.01, rtColor.red(), rtColor.green(), rtColor.blue(), strHorID.toStdString());
	
		// 绘制X方向刻度
		pcl::PointXYZ showVerPos(i * 0.1, 0, 0);
		QString strVerID = QString("Grid-x%1").arg(i);
		mViewer->removeText3D(strVerID.toStdString());
		mViewer->addText3D(QString::number(-gMaxDistance / GRID_MARK_CNT * i).toStdString(), showVerPos, 0.01, rtColor.red(), rtColor.green(), rtColor.blue(), strVerID.toStdString());
	}

	// 绘制点云网格
	pcl::visualization::PointCloudColorHandlerCustom<pcl::PointXYZ> colorHandler(cloud, rtColor.red(), rtColor.green(), rtColor.blue());
	mViewer->removePointCloud(GRIDE_PTCLOUD); // 这里如果使用updatePointCloud，先调用一次addPointCloud
	mViewer->addPointCloud(cloud, colorHandler, GRIDE_PTCLOUD);

// 构造线段点云
void CreatSegment(pcl::PointXYZ& p1, pcl::PointXYZ& p2, pcl::PointCloud<pcl::PointXYZ> ::Ptr cloud, double delt)
{
	Eigen::Vector3d k(p1.x - p2.x, p1.y - p2.y, p1.z - p2.z);
	int num = k.norm() / delt;
	k = k / k.norm();
	for (auto i = 0; i < num; ++i) {
		pcl::PointXYZ pt;
		pt.x = p2.x + delt * i * k[0];
		pt.y = p2.y + delt * i * k[1];
		pt.z = p2.z + delt * i * k[2];
		cloud->push_back(pt);
	}
	
	cloud->push_back(p1);
	cloud->push_back(p2);
}