(二)发布KITTI摄像头 激光雷达数据到ROS

本文介绍如何将KITTI数据集中的image_02彩色相机图像和velodyne_points激光雷达数据发布到ROS。针对image_02,通过编写imagePublisher.py脚本读取并转换图片,然后使用CvBridge发布。处理激光雷达数据时,用np.fromfile读取二进制文件并转换为ROS的PointCloud2消息。在rviz中,可以分别查看发布的camera和point_cloud话题。
摘要由CSDN通过智能技术生成

一 、发布image_02 中的文件

在KITTI数据中有四个相机的文件分别是image_00, image_01, image_02, image_03,四个相机,本文使用image_02的彩色相机。
在这里插入图片描述
image_02下的data文件夹中,记录了每秒10帧共314张图片,即31.4s的分帧照片。其名称组成均为10位数字+png。
在这里插入图片描述
我们可以编写一个Publisher文件将文件夹中的image发布出去

创建新文件imagePublisher.py
使用ros发布图片需要处理花建立节点 话题等,通过opencv读取图片,再将图片使用CvBridge转换成ros中的可读取的格式,最后将图片发布出来。

发布图片代码
#!/usr/bin/python2
from rospy.timer import Rate
import cv2
import os
import rospy
from sensor_msgs.msg import Image
from cv_bridge import CvBridge

DATA_PATH = '/home/liqi/dev/catkin_ws/src/KITTI_tutorials/2011_09_26_drive_0014_sync/'

if __name__ == '__main__':
frame =0 
# 初始化一个节点名称设为kitti_node
rospy.init_node('kitti_node',anonymous=True)
# 发布一个话题 名字为kitti_cam 设置一秒钟发10次
cam_pub = rospy.Publisher('kitti_cam',Image,queue_size=10)
# 使用CvBridge使ROS和opencv进行相互联系通讯
bridge = CvBridge()

rate = rospy
  • 4
    点赞
  • 6
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值