ROS2关于toROSMsg(pcl转sensor_msgs::msg::PointCloud2)时间戳和fram_id覆盖问题

void CClusterHelper::PreProcessAndGetROI(pcl::PointCloud<PointT>::Ptr cloud_in, pcl::PointCloud<PointT>::Ptr selected_cloud) {
	if (cloud_in->points.empty()) {
    	RCLCPP_ERROR(rclcpp::get_logger("CClusterHelper"), "PreProcessAndGetROI Input point cloud is empty!");
    return;
}
	// 找平并去除地面
    pcl::PointCloud<PointT>::Ptr ground_removed_cloud(new pcl::PointCloud<PointT>());
    removeGround(cloud_in, ground_removed_cloud);
    
    pcl::PointCloud<PointT>::Ptr selected_cloud(new pcl::PointCloud<PointT>());
    pcl::PointCloud<PointT>::Ptr selected_cloud1(new pcl::PointCloud<PointT>());

    // 更新 selected_cloud
    *selected_cloud = *ground_removed_cloud;
	// 滤波点云
	filterCloud(selected_cloud,selected_cloud1); // 对选择的点云进行滤波
    *selected_cloud = *selected_cloud1;


    sensor_msgs::msg::PointCloud2 pcl3d_msg;
    pcl::toROSMsg(*selected_cloud1, pcl3d_msg);
	pcl3d_msg.header.frame_id = "laser_link";
    pcl3d_msg.header.stamp = this->now();
    cloud_publisher_->publish(pcl3d_msg);
	RCLCPP_INFO(rclcpp::get_logger("CClusterHelper"),"selected cloud size:%ld",selected_cloud->points.size()); 

}	

pcl::toROSMsg(*filtered_cloud, pcl3d_msg) 只是将 PCL 点云数据转换为 ROS 消息格式并没有自动复制 header.frame_idheader.stamp

第二种写法:

    sensor_msgs::msg::PointCloud2 pcl3d_msg;
    pcl3d_msg.header.frame_id = "laser_link";
    pcl3d_msg.header.stamp = cluster_node_->now();
    pcl::toROSMsg(*selected_cloud, pcl3d_msg);
    cloud_publisher_->publish(pcl3d_msg);
    /*像这种的先给消息fram_id和时间戳,后转换即有可能被selected_cloud覆盖掉pcl3d_msg的id以及时间戳*/

虽然第二种写法可以可以在topic echo 中显示出数据,但是在rviz中是无法显示出点云的,这是因为被selected_cloud覆盖掉pcl3d_msg的id以及时间戳,rviz没有同步时间戳以及fram_id

 

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

源战士

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值