PCL点云:点云显示&观察视角姿态

  • 导入头文件
#include <iostream>

#include <pcl/point_cloud.h>
#include <pcl/visualization/pcl_visualizer.h>
  • 该段代码用来测试角度
  • 红色是X轴,绿色是Y轴,蓝色是Z,也就是说PCL点云库中使用的是右手三维坐标系
    这个点云的大致模样
//创建点云对象指针和引用
	pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_ptr(new pcl::PointCloud<pcl::PointXYZ>);
	pcl::PointCloud<pcl::PointXYZ>& cloud = *cloud_ptr;

	//创建随机点云
	//这个点云的方向是
	for (float y = -0.5f; y < 0.5f; y += 0.01f) {
		for (float z = -0.5f; z < 0.5f; z += 0.1f) {
			pcl::PointXYZ p;
			p.x = 1.0f - y;
			p.y = y;
			p.z = z;
			cloud_ptr->points.push_back(p);
		}
	}
	cloud.width = (uint32_t)cloud.size();
	cloud.height = 1;
  • 关键的代码段是
  • viewer.setCameraPosition(0, 0, 0, 1, 1, 1, 0, 1, 0); //视点 方向 上方向
  • 参数:
  • 前三个参数 观察点坐标
  • 中间三个参数 观察的方向向量
  • 最后三个参数 观察的上方面
	pcl::visualization::PCLVisualizer viewer("viewer");
	std::cout << "初始的姿态矩阵\n" << viewer.getViewerPose().matrix() << std::endl;

	viewer.addCoordinateSystem(0.5);
	viewer.addPointCloud(cloud_ptr);
	viewer.setCameraPosition(0, 0, 0, 1, 1, 1, 0, 1, 0); //视点 方向 上方向 

	std::cout << "加入相机参数以后\n" <<viewer.getViewerPose().matrix() << std::endl;

	viewer.spin();
  • viewer.setCameraPosition(-1, -1, -1, 1, 1, 1, 0, 1, 0);
  • 观察点是(-1,-1,-1) 观察方向是(1,1,1),上方向是 Y 轴

在这里插入图片描述

  • viewer.setCameraPosition(3, 0, 0, -1, 0, 0, 0, 1, 0);
  • 观察点是(3,0,0) 观察方向是(-1,0,0),上方向是 Y 轴
  • 就是站在X轴上,看X的负方向,其中Y是上方向在这里插入图片描述

全部代码

#include <iostream>

#include <pcl/point_cloud.h>
#include <pcl/visualization/pcl_visualizer.h>

/*用来测试角度*/
/*红色是X轴,绿色是Y轴,蓝色是Z,也就是说PCL点云库中使用的是右手三维坐标系。*/
int main() {

	//创建点云对象指针和引用
	pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_ptr(new pcl::PointCloud<pcl::PointXYZ>);
	pcl::PointCloud<pcl::PointXYZ>& cloud = *cloud_ptr;

	//创建随机点云
	//这个点云的方向是
	for (float y = -0.5f; y < 0.5f; y += 0.01f) {
		for (float z = -0.5f; z < 0.5f; z += 0.1f) {
			pcl::PointXYZ p;
			p.x = 1.0f - y;
			p.y = y;
			p.z = z;
			cloud_ptr->points.push_back(p);
		}
	}
	cloud.width = (uint32_t)cloud.size();
	cloud.height = 1;


	std::cout << "cloud.sensor_orientation_.matrix() :\n" << cloud.sensor_orientation_.matrix() << std::endl; // x y z 方向 偏移 u
	std::cout << "cloud.sensor_origin_\n" << cloud.sensor_origin_ << std::endl;



	pcl::visualization::PCLVisualizer viewer("viewer");
	std::cout << "初始的姿态矩阵\n" << viewer.getViewerPose().matrix() << std::endl;

	viewer.addCoordinateSystem(0.5);
	viewer.addPointCloud(cloud_ptr);
	viewer.setCameraPosition(3, 0, 0, -1, 0, 0, 0, 1, 0); //视点 方向 上方向 

	std::cout << "加入相机参数以后\n" <<viewer.getViewerPose().matrix() << std::endl;

	viewer.spin();

	return 0;



}
  • 10
    点赞
  • 53
    收藏
    觉得还不错? 一键收藏
  • 1
    评论
这个错误是因为你传入的点云类型是pcl::PointXYZI,而PCLVisualizer期望的是pcl::PointXYZ类型的点云。你需要将点云类型转换为pcl::PointXYZ类型的点云,才能调用PCLVisualizer的addPointCloud函数。 以下是一个示例代码,将pcl::PointXYZI类型的点云转换为pcl::PointXYZ类型的点云: ```c++ pcl::PointCloud<pcl::PointXYZI>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZI>); pcl::io::loadPCDFile("input.pcd", *cloud); pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_xyz(new pcl::PointCloud<pcl::PointXYZ>); pcl::copyPointCloud(*cloud, *cloud_xyz); ``` 然后,你可以将转换后的点云传递给PCLVisualizer的addPointCloud函数: ```c++ viewer->addPointCloud(cloud_xyz, "cloud"); ``` 完整代码: ```c++ #include <pcl/io/pcd_io.h> #include <pcl/point_types.h> #include <pcl/visualization/pcl_visualizer.h> #include <opencv2/opencv.hpp> int main(int argc, char** argv) { pcl::PointCloud<pcl::PointXYZI>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZI>); pcl::io::loadPCDFile("input.pcd", *cloud); pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_xyz(new pcl::PointCloud<pcl::PointXYZ>); pcl::copyPointCloud(*cloud, *cloud_xyz); pcl::visualization::PCLVisualizer::Ptr viewer(new pcl::visualization::PCLVisualizer("Cloud Viewer")); viewer->addPointCloud(cloud_xyz, "cloud"); viewer->setPointCloudRenderingProperties(pcl::visualization::PCL_VISUALIZER_POINT_SIZE, 1, "cloud"); viewer->setBackgroundColor(1, 1, 1); pcl::visualization::LookupTable lut; lut.insert(std::make_pair(0.0, cv::Vec3b(0, 0, 0))); lut.insert(std::make_pair(1.0, cv::Vec3b(255, 255, 255))); cv::Mat intensity_image(cloud->height, cloud->width, CV_8UC3); for (int y = 0; y < intensity_image.rows; y++) { for (int x = 0; x < intensity_image.cols; x++) { float intensity = cloud->at(x, y).intensity; cv::Vec3b color = lut.getColor(intensity); intensity_image.at<cv::Vec3b>(y, x) = color; } } cv::imwrite("output.png", intensity_image); return 0; } ```

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值