激光雷达发布的数据LaserScan

由于发布的话题/scan是二维数据,在处理时没有点云数据方便,所以想把二维雷达数据转换为PointCloud2点云数据  

通过订阅/scan 可以将其转换为点云数据

具体代码如下:

#!/usr/bin/env python

import rospy
from sensor_msgs.msg import PointCloud2 as pc2
from sensor_msgs.msg import LaserScan
from laser_geometry import LaserProjection

class Laser2PC():
    def __init__(self):
        self.laserProj = LaserProjection()
        self.pcPub = rospy.Publisher("/laserPointCloud", pc2, queue_size=1)
        self.laserSub = rospy.Subscriber("/scan", LaserScan, self.laserCallback) #topic名称可能不同,请根据实际情况进行修改。可以在终端输入rostopic list查看

    def laserCallback(self,data):

        cloud_out = self.laserProj.projectLaser(data)

        self.pcPub.publish(cloud_out)

if __name__ == '__main__':
    rospy.init_node("laser2PointCloud")
    l2pc = Laser2PC()
    rospy.spin()

其中LaserProjection是一个包 可以将/Scan数据转换为PointCloud2数据

这样发布出来的数据就是点云数据了

Logo

DAMO开发者矩阵,由阿里巴巴达摩院和中国互联网协会联合发起,致力于探讨最前沿的技术趋势与应用成果,搭建高质量的交流与分享平台,推动技术创新与产业应用链接,围绕“人工智能与新型计算”构建开放共享的开发者生态。

更多推荐