关于在ros回调函数中处理激光雷达点云累计数帧数据一起处理的操作

最新推荐文章于 2024-09-27 18:36:05 发布

LimitOut

最新推荐文章于 2024-09-27 18:36:05 发布

阅读量2.9k

点赞数 7

CC 4.0 BY-SA版权

分类专栏： Lidar ROS

本文链接：https://blog.youkuaiyun.com/LimitOut/article/details/103485398

Lidar 同时被 2 个专栏收录

8 篇文章

订阅专栏

ROS

3 篇文章

订阅专栏

本文详细介绍了一种在ROS环境中实现点云数据叠加的方法，通过将多帧点云数据融合成一帧，以提高低线束激光雷达在目标检测中的性能。文章提供了具体的C++代码实现，展示了如何订阅点云数据、进行数据融合，并发布融合后的点云。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

ROS中点云数据的叠加处理

在我们处理点云数据的时候,我们经常会对点云的数据进行累加到一起在进行操作,也就是将几帧数据叠加为一个数据在进行处理,这在低线束的情况下是经常用到的,具体的操作过程如下:

class object3dDetector {
  /*************Publish And  Subcriber*************/
private:
    ros::NodeHandle n;
    ros::Subscriber point_date_sub;
    ros::Publisher raw_point_pub;
    sensor_msgs::PointCloud2 raw_point;

public:
    object3dDetector() {
//     ----------------------sub and scrb defination----------------------
        point_date_sub = n.subscribe("/livox/lidar", 3, &object3dDetector::callback, this);
        raw_point_pub = n.advertise<sensor_msgs::PointCloud2>("/raw_Point", 3);
    }
    void getpoint_callback(const sensor_msgs::PointCloud2::ConstPtr &livox_msg);
    void callback(const sensor_msgs::PointCloud2::ConstPtr &msg);
};
int i=1;//一定要放在回调函数外.
pcl::PointCloud<pcl::PointXYZ>::Ptr temp_cloud(new pcl::PointCloud<pcl::PointXYZ>);

void object3dDetector::callback(const sensor_msgs::PointCloud2::ConstPtr &msg) {
    cout << "msg:" << (msg->height) * (msg->width) << endl;
    auto startTime = std::chrono::steady_clock::now();
    //累计数据
    if (i < 3) {
        pcl::PointCloud<pcl::PointXYZ>::Ptr transfer_cloud(new pcl::PointCloud<pcl::PointXYZ>);
        pcl::fromROSMsg(*msg, *transfer_cloud);
        *temp_cloud += *transfer_cloud;
//        cout<<"COUNT POINTS_NUM[:"<<i<<"]:"<<temp_cloud->points.size()<<endl;
        i++;
    } else {

        pcl::PointCloud<pcl::PointXYZ>::Ptr transfer_cloud(new pcl::PointCloud<pcl::PointXYZ>);
        pcl::fromROSMsg(*msg, *transfer_cloud);
        *temp_cloud += *transfer_cloud;
        pcl::toROSMsg(*temp_cloud, raw_point);
        *********todo****************
   i=1;
temp_cloud->clear();//清除点云数据,进行下一次累计.
}
}
int main(int argc, char **argv) {
t << "------------------DO it!-----------------------" << endl;
    ros::init(argc, argv, "object3d_detector");

    object3dDetector A;
    ros::spin();
    }

到此就可以了.