null - 程序员宅基地

Livox LiDAR点云数据类型的转化——livox_ros_driver/CustomMsg到sensor_msgs/PointCloud2-程序员宅基地

在做Lidar与IMU数据之间的标定时，出现了数据无法读取的问题

主要是代码里读取lidar数据是需要下面的语句

 // add lidar msg
        sensor_msgs::PointCloud2ConstPtr lidar_msg = m.instantiate<sensor_msgs::PointCloud2>();

查看bag文件的数据类型

rosbag info XXX.bag

可以明显看出，用的是自带的sensor_msgs/PointCloud2类型的读取函数，因此这里需要对数据格式进行一个转换
请添加图片描述如图可以看出两种数据类型的区别

进行转换需要首先分析这两种数据类型的存储格式

livox存储格式看这

Livox defined msg format is :
请添加图片描述
CustomPoint format:

代码部分：

点云部分

for (int i = 0; i < point_num; i++)
  {
    
    cloud.points[i].x = msg.points.at(i).x;
    cloud.points[i].y = msg.points.at(i).y;
    cloud.points[i].z = msg.points.at(i).z;
    cloud.points[i].intensity = msg.points.at(i).reflectivity;
  }

其他信息：

  ros_msg.header.stamp = msg.header.stamp;
  ros_msg.header.frame_id = "rslidar";
  ros_msg.header.seq = 0;
  ros_msg.height = 1;
  ros_msg.width = cloud.width;
  ros_msg.point_step = sizeof(pcl::PointXYZI);
  ros_msg.row_step =
      static_cast<uint32_t>(sizeof(pcl::PointXYZI) * ros_msg.width);
  ros_msg.is_dense = false;
  livoxbag.write("/horizontal_laser_3d", ros_msg.header.stamp, ros_msg);

main函数：

int main(int argc, char* argv[])
{
    
  std::string bag_path = "/home/u/ws_livox_pc2/src/data/livox.bag";
  livoxbag.open(bag_path, rosbag::bagmode::Write);

  ros::init(argc, argv, "livox2pointcloud2");
  ros::NodeHandle nh;
  ros::Subscriber imu_sub = nh.subscribe("/livox/imu", 100, &imuCallback);  
  ros::Subscriber livox_sub = nh.subscribe("/livox/lidar", 100, &laserCallback);

  ros::spin();

  return 0;
}

这段代码这里是输入一个新的包进行数据写入

然后打开一个新终端
roscore
输入
./XXX
再打开一个新的终端
rosbag play XXX.bag

就可以实现类型的转换啦
请添加图片描述

本文链接：https://blog.csdn.net/Laney_Midory/article/details/120040285

原作者删帖不实内容删帖广告或垃圾文章投诉

智能推荐

王斌老师的博客_王斌 github-程序员宅基地

文章浏览阅读480次。http://blog.sina.com.cn/s/blog_736d0b9101018cgc.html_王斌 github

ACM OJ Collection_htt//acm.wydtang.top/-程序员宅基地

文章浏览阅读737次。原文来自：http://blog.csdn.net/hncqp/article/details/4455263 ACM OJ Collection（排名不分先后）：中国：浙江大学（ZJU）：http://acm.zju.edu.cn/北京大学（PKU）：htt_htt//acm.wydtang.top/

ios 自己服务器苹果支付_修复苹果IOS支付-程序员宅基地

文章浏览阅读467次。更新记录1.0.0(2019-07-01)插件简介专门用来修复苹果IOS支付时出现"您已购买此App内购买项目。此项目将免费恢复"。问题描述首先在IOS平台里面创建“APP内购买项目”，选择的是“消耗型项目”，然后用uni-app官方的支付api进行支付，多支付几次，有时候就会出现提示“您已购买此App内购买项目。此项目将免费恢复”,特别是在沙盒测试里面支付很大几率出现,我明明选的是消耗型项目，应..._ios开发苹果支付恢复权益

spring MVC mock类单元测试（controller）_mvcmock-程序员宅基地

文章浏览阅读5.6k次。Spring从J2EE的Web端为每个关键接口提供了一个mock实现：MockHttpServletRequest几乎每个单元测试中都要使用这个类，它是J2EE Web应用程序最常用的接口HttpServletRequest的mock实现。MockHttpServletResponse此对象用于HttpServletRespons_mvcmock

【我的世界Minecraft-MC】常见及各种指令大杂烩【2022.8版】_summon生成掉落物-程序员宅基地

文章浏览阅读8.5k次，点赞7次，收藏22次。execute as @a at @s run clear @s minecraft:dark_oak_planks{display:{Name:“{“text”:“第三关[阴森古堡]”,“color”:“red”,“italic”:false}”,color:“16711680”},Enchantments:[{id:“protection”,lvl:1}],Unbreakable:1b} 1。Lore:[“{“text”:“免费”,“color”:“blue”,“italic”:false}”]..._summon生成掉落物

CentOS 7安装教程（图文详解）_centos 安装-程序员宅基地

文章浏览阅读10w+次，点赞487次，收藏2.1k次。CentOS 7安装教程：准备：软件：VMware Workstation 镜像文件：CentOS-7-x86_64-bin-DVD1.iso （附：教程较为详细，注释较多，故将操作的选项进行了加粗字体显示。） 1、文件--新建虚拟机--自定义 2、..._centos 安装

Livox LiDAR点云数据类型的转化——livox_ros_driver/CustomMsg到sensor_msgs/PointCloud2-程序员宅基地

智能推荐

王斌老师的博客_王斌 github-程序员宅基地

ACM OJ Collection_htt//acm.wydtang.top/-程序员宅基地

ios 自己服务器苹果支付_修复苹果IOS支付-程序员宅基地

spring MVC mock类单元测试（controller）_mvcmock-程序员宅基地

【我的世界Minecraft-MC】常见及各种指令大杂烩【2022.8版】_summon生成掉落物-程序员宅基地

CentOS 7安装教程（图文详解）_centos 安装-程序员宅基地

随便推点

Github项目分享——免费的画图工具drow，前端插件化面试_draw github画图-程序员宅基地

如何开始学习人工智能？入门的学习路径和资源是什么？_人工智能学习路径-程序员宅基地

Unity3D 导入资源_unity怎么导入压缩包-程序员宅基地

jqgrid 服务器端验证,javascript – jqgrid服务器端错误消息/验证处理-程序员宅基地

白山头讲PV: 用calibre进行layout之间的比对-程序员宅基地

java exit方法_Java：如何测试调用System.exit（）的方法？-程序员宅基地

推荐文章

热门文章

相关标签