相机与激光雷达数据融合,生成彩色点云

该博客介绍了如何在ROS环境下进行激光雷达与相机的数据融合。首先,详细阐述了不同传感器数据的格式,如sensor_msgs::Image和sensor_msgs::PointCloud2。接着,通过将点云数据转换并结合标定参数投影到相机坐标系,生成带有RGB信息的pcl::PointXYZRGB点云。时间戳同步借助message_filters包完成,确保15Hz相机和10Hz雷达数据的准确配对。尽管未展示实时稠密化点云显示,但代码已经封装成易于集成到激光里程计的类。最后,提供了代码仓库链接和融合效果对比。

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

1.数据格式

相机数据格式:sensor_msgs::Image
激光雷达数据格式:sensor_msgs::PointCloud2
原始点云数据格式:pcl::PointXYZ
融合后点云数据格式:pcl::PointXYZRGB

2.数据融合基本流程

将原始点云sensor_msgs::PointCloud2转换成pcl::PointXYZ,通过标定好的雷达相机外参以及相机内参,投影到相机uv坐标系中,获取对应像素的RGB值,并用pcl::PointXYZRGB存储,转换成sensor_msgs::PointCloud2发布出来。

3.时间戳同步

时间同步使用ros里message_filters类实现,但要做好相机和雷达的初始时间戳同步(重要),本人采用的相机频率为15hz,雷达频率为10hz。

4.待完善

1.实时的显示每帧数据融合效果,点云比较稀疏,在每帧数据前后插入一帧,利用高斯噪声对xyz做一个偏置可稠密化实时显示的点云,但由于当前用不上,已将此代码部分删除。
2.代码封装成了一个类,很方便插入到激光里程计中,调整话题名,就可利用激光里程计生成彩色点云地图。

5.代码链接

https://github.com/KAI-yq/camera_lidar_fusion

6.效果对比

在这里插入图片描述在这里插入图片描述在这里插入图片描述
在这里插入图片描述

评论 63
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值