Ros将ros::PointCloud2格式的数据解析为pcl点云数据格式

Ros将ros::PointCloud2格式的数据解析为pcl点云数据格式

#include "ros/ros.h"
#include "sensor_msgs/PointCloud2.h"
#include <iostream>
#include <sensor_msgs/PointCloud.h>
#include <pcl/point_types.h>                 //pcl点云格式头文件
#include <pcl_conversions/pcl_conversions.h> //转换
#include <pcl/point_cloud.h>
#include <sensor_msgs/point_cloud_conversion.h>
using namespace std;

void Callback(const sensor_msgs::PointCloud2& msg){
	//cout<<"height:"<<msg->height<<"    width:"<<msg->width<<endl;
	//解析data数据
	//sensor_msgs::PointCloud convertCloud;
	//sensor_msgs::convertPointCloud2ToPointCloud(msg,convertCloud);
	//for(int i=0;i<convertCloud.points.size();i++)
	//{
	//	cout<<convertCloud.points[i]<<endl;
	//}
	//cout<<"--------------------------------------------------"<<endl;
	pcl::PointCloud<pcl::PointXYZI> cloud_pcl_xyzi;
	pcl::fromROSMsg(msg, cloud_pcl_xyzi);
	for(int i=0;i<cloud_pcl_xyzi.points.size();i++)
	{
		cout<<cloud_pcl_xyzi.points[i]<<endl;
	}
}

int main(int argc,char ** argv){
	ros::init(argc,argv,"read_lidar_snow");
	ros::NodeHandle node;
	ros::Subscriber sub=node.subscribe("/wanji_point",100,Callback);
	ros::spin();
	return 0;
}

参考链接:
https://blog.csdn.net/qq_32115419/article/details/105530070
https://zhuanlan.zhihu.com/p/149209396?utm_source=wechat_session
https://www.cnblogs.com/li-yao7758258/p/6651326.html
https://zhuanlan.zhihu.com/p/55958811
https://www.cnblogs.com/li-yao7758258/p/6651326.html

  • 2
    点赞
  • 18
    收藏
    觉得还不错? 一键收藏
  • 1
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值