ROS订阅雷达话题 获取坐标

import rospy
from sensor_msgs.msg import PointCloud2
from sensor_msgs import point_cloud2

def callback(data):
    gen = point_cloud2.read_points(data)
    for p in gen:
        print(list(p))

def listener():
    rospy.init_node('laser_listener')
    rospy.Subscriber('/velodyne_points',PointCloud2,callback)
    rospy.spin()

if __name__ =='__main__':
    listener()

雷达数据一般为(x,y,z,i,r)的矩阵
x , y, z, 为坐标值
i 为intensity 反射强度系数,一般为雷达的返回强度,当雷达数据被聚类,滤波处理后,也可有特殊含义,如i =0时,表示左边的点,i=1时,是右边的点
r 为ring

16线激光雷达数据包

链接:https://pan.baidu.com/s/15_a6PKv5vbQPFiME6rVv8A
提取码:a2cw

我的其他有关ros 的博客,不妨一看
Ubuntu 安装 ros linux 验证安装成功
http://hotdog29.com/index.php/2019/06/22/ubuntu-安装-ros-kinetic-官方教程-下载-linux/
ROS 订阅雷达话题,获取点云数据,可视化,生成鸟瞰图
http://hotdog29.com/index.php/2019/06/22/ros-订阅雷达话题,获取点云数据,可视化,生成鸟/
ROS订阅雷达话题 获取坐标
http://hotdog29.com/index.php/2019/06/22/ros订阅雷达话题 获取坐标-bag数据包/
快速安装依赖包
https://blog.csdn.net/weixin_41600500/article/details/88432283
.bag 包转化成.pcd文件
https://blog.csdn.net/weixin_41600500/article/details/88432257
ros 播放激光雷达数据包,rviz可视化
http://hotdog29.com/index.php/2019/06/22/ros-播放激光雷达数据包,rviz可视化/
ROS 基础操作
https://blog.csdn.net/weixin_41600500/article/details/86213794
ros 基础操作2
https://blog.csdn.net/weixin_41600500/article/details/88412954

你可能感兴趣的:(代码)