TI voxelsdk点云ros publisher

最新推荐文章于 2024-11-06 11:44:24 发布

zhoudekuai

最新推荐文章于 2024-11-06 11:44:24 发布

阅读量346

点赞数 1

分类专栏： ros 点云文章标签： voxelsdk ros 点云

本文链接：https://blog.youkuaiyun.com/zhoudekuai/article/details/95487405

版权

ros 同时被 2 个专栏收录

2 篇文章

订阅专栏

点云

2 篇文章

订阅专栏

该博客介绍利用TI voxelsdk的python接口，实现点云数据的实时采集，并通过ros进行发布，涉及信息技术中的点云数据处理与发布。

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

利用TI voxelsdk的python接口实时采集点云数据并通过ros发布

import Voxel
import numpy as np
import rospy
import sensor_msgs.point_cloud2 as pc2
from sensor_msgs.msg import PointCloud2
from std_msgs.msg import Header

rospy.init_node('voxel_publisher')
pub=rospy.Publisher('pointcloude', PointCloud2)

def pointcloud_cb(cam, raw_frame, type_):
    frame = Voxel.XYZIPointCloudFrame.typeCast(raw_frame)
    data = np.array(frame.depth, copy=True).astype(np.float)
    data = np.reshape(data, (frame.size.height, frame.size.width))
    // 删除intensity数据
    data = np.delete(data, 3, axis=1)
    // 发布主题
    global pub
    header = Header()
    header.stamp = rospy.Time.now()
    header.frame_id = '%s'%frame.id
    pc = pc2.create_cloud_xyz32(header, data)
    pub.publish(pc)
    
sys=Voxel.CameraSystem()
devs=sys.scan()
cam=sys.connect(devs[0])
cam.registerCallback(Voxel.DepthCamera.FRAME_XYZI_POINT_CLOUD_FRAME, pointcloud_cb)
cam.start()

rate = rospy.Rate(30)
while not rospy.is_shutdown():
    rate.sleep()
    pass
    
cam.stop()