ROS功能包在线把速腾聚创点云格式转为velodyne点云格式

国外算法很多slam算法是基于velodyne_lidar开发的,对国内雷达型号不友好,在这里记录一下使用rs_to_velodyne功能包实时在线将速腾聚创点云转化为velodyne点云的过程

环境:ubuntu16.04+ROSkinetic+robosense16线(其他版本的ros和速腾雷达过程相似可供参考)

一、安装依赖

sudo apt-get install libpcap-dev

二、安装最新的速腾聚创驱动(robosense16老版的驱动没有ring和timestamp参数)

V1.3.0下载:https://github.com/RoboSense-LiDAR/rslidar_sdk/releases

将包解压到RS_SDK/src/下 

三、修改CMakeLists.txt和package.xml

修改rslidar_sdk/下的CMakeLists.txt将第八行的set(COMPILE_METHOD ORIGINAL)改为set(COMPILE_METHOD CATKIN)

修改第13行set(POINT_TYPE XYZI) 改为set(POINT_TYPE XYZIRT)

注释掉Protobu相关项122行到146行

修改rslidar_sdk工程目录下的package_ros1.xml文件重命名为package.xml

修改rslidar_sdk/config/config.yaml 默认是RS128线雷达改为你的雷达即可16线为RS16

 四、编译

catkin_make               //后来我在ubuntu20.04上编译失败了,具体错误如第五步所示

//添加环境变量
source /home/lds/RS_SDK/devel/setup.bash
// /home/lds/是我的工作路径你可以在当前工作空间RS_SDK里打开终端输入pwd查看自己的路径

五、题外话(编译bug,如果你编译成功就跳过步骤五)

将注释掉的Protobu相关项122行到146行替换成如下内容

if(NOT PROTOC MATCHES "NOTFOUND" AND Protobuf_FOUND)
  add_executable(rslidar_sdk_node
              node/rslidar_sdk_node.cpp
              src/manager/adapter_manager.cpp
              ${PROTO_FILE_PATH}/packet.pb.cc
              ${PROTO_FILE_PATH}/scan.pb.cc
              ${PROTO_FILE_PATH}/point_cloud.pb.cc
              )
  target_link_libraries(rslidar_sdk_node yaml-cpp)
  target_link_libraries(rslidar_sdk_node                   
                      ${PCL_LIBRARIES}
                      ${YAML_CPP_LIBRARIES}
                      ${PROTOBUF_LIBRARY}
                      ${rs_driver_LIBRARIES}
                      )
else(NOT PROTOC MATCHES "NOTFOUND" AND Protobuf_FOUND)
  add_executable(rslidar_sdk_node
              node/rslidar_sdk_node.cpp
              src/manager/adapter_manager.cpp
              )
  target_link_libraries(rslidar_sdk_node yaml-cpp)
  target_link_libraries(rslidar_sdk_node                   
                      ${PCL_LIBRARIES}
                      ${YAML_CPP_LIBRARIES}
                      ${rs_driver_LIBRARIES}
                      )
endif(NOT PROTOC MATCHES "NOTFOUND" AND Protobuf_FOUND)

六、设置ip地址

robosense16出厂默认ip地址是192.168.1.200,你需要将你的计算机ip设置为前三段与雷达相同即192.168.1.开头,最后一位取0-255之间不与雷达的ip相同即可。如果你对激光雷达的使用过程不熟悉可参考我的另一篇博客robosense16使用保姆教学

设置ubuntu的IP地址为:192.168.1.100子网掩码为:255.255.255.0

重启网络以便使新ip生效

sudo service network-manager restart

七、启动雷达(正常显示后即可关闭)

source devel/setup.bash

roslaunch rslidar_sdk start.launch

八、安装rs_to_velodyne功能包

打开RS_SDK/src/位置与rslidar_sdk并列新建workspace/src/安装rs_to_velodyne功能包并编译

cd ~/RS_SDK/src
mkdir transition/src
cd transition/src
git clone https://hub.fastgit.org/HViktorTsoi/rs_to_velodyne.git
cd ..
catkin_make

 在transition/src/rs_to_velodyne/下与src并列的位置新建launch文件夹,在此处右键新开终端:

touch rstovelodyne.launch

rstovelodyne.launch写入:

<launch>
  <node pkg="rs_to_velodyne" name="rs_to_velodyne" type="rs_to_velodyne"  args="XYZIRT XYZIRT"   output="screen">
  </node>
</launch>

九、启动rs_to_velodyne转化节点 

cd ~/RS_SDK/src/transition
source devel/setup.bash
roslaunch rs_to_velodyne rstovelodyne.launch

启动转化节点成功 

十、集成launch

打开RS_SDK/src/rslidar_sdk/launch/start.launch在末尾将启动转化节点的launch加进去

 <!--- rs_to_velodyne -->
  <include file="$(find rs_to_velodyne)/launch/rstovelodyne.launch" />

十一、启动rslidar

cd ~/RS_SDK
source devel/setup.bash
roslaunch rslidar_sdk start.launch

  • 9
    点赞
  • 56
    收藏
    觉得还不错? 一键收藏
  • 15
    评论
以下是一个简单的代码示例,用于实时将镭神C16输出的点云格式转换为Velodyne点云数据格式: ```c++ #include <ros/ros.h> #include <sensor_msgs/PointCloud2.h> #include <pcl_conversions/pcl_conversions.h> #include <pcl/io/pcd_io.h> #include <pcl/point_types.h> #include <pcl/point_cloud.h> ros::Publisher pub; void cloud_cb (const sensor_msgs::PointCloud2ConstPtr& input_cloud_msg) { // 将ROS点云消息转换为PCL点云格式 pcl::PointCloud<pcl::PointXYZI>::Ptr input_cloud (new pcl::PointCloud<pcl::PointXYZI>); pcl::fromROSMsg (*input_cloud_msg, *input_cloud); // 创建Velodyne点云数据格式点云 pcl::PointCloud<pcl::PointXYZI>::Ptr output_cloud (new pcl::PointCloud<pcl::PointXYZI>); // 将镭神C16点云数据格式转换为Velodyne点云数据格式 for (size_t i = 0; i < input_cloud->points.size (); ++i) { pcl::PointXYZI point; point.x = input_cloud->points[i].x; point.y = input_cloud->points[i].y; point.z = input_cloud->points[i].z; point.intensity = input_cloud->points[i].intensity; point.ring = 0; // 需要计算或者赋值激光线束编号 point.timestamp = 0; // 需要计算或者赋值时间戳 output_cloud->points.push_back (point); } // 将转换后的Velodyne点云数据格式发布为ROS点云消息 sensor_msgs::PointCloud2 output_cloud_msg; pcl::toROSMsg (*output_cloud, output_cloud_msg); output_cloud_msg.header = input_cloud_msg->header; pub.publish (output_cloud_msg); } int main (int argc, char** argv) { // 初始化ROS节点 ros::init (argc, argv, "c16_to_velodyne"); // 创建ROS节点句柄 ros::NodeHandle nh; // 创建ROS订阅器,用于接收镭神C16输出的点云数据 ros::Subscriber sub = nh.subscribe<sensor_msgs::PointCloud2> ("/c16_point_cloud", 1, cloud_cb); // 创建ROS发布器,用于发布转换后的Velodyne点云数据 pub = nh.advertise<sensor_msgs::PointCloud2> ("/velodyne_points", 1); // 循环等待ROS事件 ros::spin (); return (0); } ``` 在上述代码中,首先通过使用`ros::Subscriber`订阅器订阅镭神C16输出的点云数据。然后,在回调函数`cloud_cb`中,将ROS点云消息转换为PCL点云格式,并使用循环遍历镭神C16点云数据格式的每一个点,将其转换为Velodyne点云数据格式,并添加所需的属性,如激光线束编号和时间戳。最后,使用`ros::Publisher`发布器将转换后的Velodyne点云数据格式发布为ROS点云消息。需要注意的是,上述示例代码仅供参考,具体的实现可能需要根据实际情况进行调整和修改。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 15
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值