使用lego_loam 建图,建立的地图保存成 pcd 格式

主要的步骤:

1.录制地图 /laser_cloud_surround 的bag文件

在数据集快要播放结束的时候(因为地图是”累积“的,快结束的时候录制/laser_cloud_surround就可以),执行下面指令,录制 /laser_cloud_surround :

rosbag record -o out /laser_cloud_surround

然后会在当前目录 生成 out_xxxx.bag 文件,例如out_2020-03-30-18-35-12.bag

2.bag 文件转换成 pcd 文件,

rosrun pcl_ros bag_to_pcd out_2020-03-30-18-35-12.bag /laser_cloud_surround  output_pcd

然后会在当前目录下生成一个文件夹output_pcd,output_pcd文件夹下存放着刚刚转换完成的pcd文件,其中最后一个pcd文件 就是SLAM最终建立的地图。

可以用pcl_viewer 来查看

pcl_viewer xxxx.pcd  #xxxx.pcd 为文件名

3.(如果需要的话)将pcd文件转换为ply文件

执行下面指令

pcl_pcd2ply xxxx.pcd  map.ply

然后在当前目录下会生成 xxxx.pcd 对应的 map.ply 文件

  • 5
    点赞
  • 32
    收藏
    觉得还不错? 一键收藏
  • 2
    评论
LeGO-LOAM中的地图配准主要是通过ICP算法实现的。下面是配准的代码: ```c++ void mapOptimization::scan2MapOptimization(){ ... // Step 1: Transform current scan to global map PointCloudT::Ptr transformed_scan_ptr (new PointCloudT()); pcl::transformPointCloud(*laserCloudCornerLast, *transformed_scan_ptr, laserOdometry); // Step 2: Add current scan to global map *laserCloudCornerFromMap += *transformed_scan_ptr; laserCloudCornerFromMapDS->clear(); downSizeFilterCorner.setInputCloud(laserCloudCornerFromMap); downSizeFilterCorner.filter(*laserCloudCornerFromMapDS); // Step 3: Apply ICP algorithm to align current scan with global map pcl::IterativeClosestPoint<PointT, PointT> icp; icp.setInputSource(transformed_scan_ptr); icp.setInputTarget(laserCloudCornerFromMapDS); icp.setMaxCorrespondenceDistance(0.5); icp.setMaximumIterations(50); icp.setTransformationEpsilon(1e-8); icp.align(*transformed_scan_ptr); // Step 4: Transform current scan back to its local frame if (icp.hasConverged()) { laserOdometry = icp.getFinalTransformation().inverse() * laserOdometry; pcl::transformPointCloud(*transformed_scan_ptr, *laserCloudCornerLast, laserOdometry); } ... } ``` 在这个函数中,我们首先将当前的点云数据通过位姿转换,转换到全局地图的坐标系下。然后将当前点云添加到全局地图中。接着,我们使用ICP算法,将当前点云与全局地图进行匹配,得到它们之间的变换关系。最后,我们将当前点云通过变换关系转换回到它的本地坐标系下。 需要注意的是,在LeGO-LOAM中,我们是将当前点云的角点部分与全局地图的角点部分进行匹配,因为角点更具有特征性。另外,我们使用了一个体素滤波器对全局地图进行了下采样,这样可以加快匹配速度,同时也可以去除一些不必要的噪声点。

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值