mloam
创始人
2025-06-01 13:28:34
0

以读“pcd”:

读取4个激光雷达数据,input

       estimator.inputCloud(cloud_time, laser_cloud_list);

inputCloud展开:
给每个激光雷达的三维点赋⼀个0-1值,为这个点的时间戳相对于这⼀帧点云的相对时
间,这个与A-LOAM⼀致

	 f_extract_.calTimestamp(v_laser_cloud_in[i], laser_cloud);

聚类分割
⽤类似Lego LOAM的⽅法,给点云⽣成深度图
深度优先搜索对上述深度图进⾏聚类 去除聚类中尺⼨过小或者过⼤的。
⽣成⼀个与上述图同样⼤的label_mat。

  • -1表⽰对应的像素处⽆数据
  • 999999表⽰⽆效的聚类
  • 否则表⽰这个像素属于的聚类的标号

根据label_mat来去除点云中的⽆效点

	img_segment_.segmentCloud(laser_cloud, laser_cloud_segment, laser_cloud_outlier, scan_info);

特征提取

    f_extract_.extractCloud(laser_cloud_segment, scan_info, *feature_frame_ptr[i]);

求出的特征都保存到cloudFeature这样一个数据结构里

std::queue > > feature_buf_;

feature_buf_报错了当前4个激光雷达的特征和时间戳,以队列+pair形式
cloudFeature是字符串-点云对应格式,相当于给点云打一个label

typedef std::map cloudFeature;

然后就是数据处理:

        processMeasurements();

展开里面有一个 process();和 pubOdometry(*this, cur_time_);

process()展开:
如果没有先验外参,对于每个激光雷达,trackCloud以获得每帧的相对位移与绝对位姿,同每个激光雷达单独计算里程计

        pose_rlt_[n] = lidar_tracker_.trackCloud(prev_cloud_feature, cur_cloud_feature, pose_rlt_[n], cur_feature_.first, n);

pose_rlt_ 保存存了第i时刻 全部雷达的运动增量数据
将上⾯得到的每个激光雷达的相对位姿加⼊到待优化队列中

		if (initial_extrinsics_.addPose(pose_rlt_) && (cir_buf_cnt_ == WINDOW_SIZE))//将上⾯得到的每个激光雷达的相对位姿加⼊到待优化队列中

对于每⼀个激光雷达,标定其到主激光雷达的外参的旋转

        if (initial_extrinsics_.calibExRotation(IDX_REF, n, calib_result)) // 标定其到主激光雷达的外参的旋转

成功则标定其到主激光雷达的外参的平移

        if (initial_extrinsics_.calibExTranslation(IDX_REF, n, calib_result)) // 标定其到主激光雷达的外参的平移

上一篇:java IO流的使用

下一篇:存储器介绍

相关内容

热门资讯

监控摄像头接入GB28181平... 流程简介将监控摄像头的视频在网站和APP中直播,要解决的几个问题是:1&...
Windows10添加群晖磁盘... 在使用群晖NAS时,我们需要通过本地映射的方式把NAS映射成本地的一块磁盘使用。 通过...
protocol buffer... 目录 目录 什么是protocol buffer 1.protobuf 1.1安装  1.2使用...
educoder数据结构与算法...                                                   ...
MySQL下载和安装(Wind... 前言:刚换了一台电脑,里面所有东西都需要重新配置,习惯了所...
MFC文件操作  MFC提供了一个文件操作的基类CFile,这个类提供了一个没有缓存的二进制格式的磁盘...
在Word、WPS中插入AxM... 引言 我最近需要写一些文章,在排版时发现AxMath插入的公式竟然会导致行间距异常&#...
有效的括号 一、题目 给定一个只包括 '(',')','{','}'...
Fluent中创建监测点 1 概述某些仿真问题,需要创建监测点,用于获取空间定点的数据࿰...
【Ctfer训练计划】——(三... 作者名:Demo不是emo  主页面链接:主页传送门 创作初心ÿ...