多传感器融合(2)——点云地图构建及基于地图的定位

回环检测

多传感器融合(2)——点云地图构建及基于地图的定位_第1张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第2张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第3张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第4张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第5张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第6张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第7张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第8张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第9张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第10张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第11张图片

后端优化

多传感器融合(2)——点云地图构建及基于地图的定位_第12张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第13张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第14张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第15张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第16张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第17张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第18张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第19张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第20张图片多传感器融合(2)——点云地图构建及基于地图的定位_第21张图片多传感器融合(2)——点云地图构建及基于地图的定位_第22张图片多传感器融合(2)——点云地图构建及基于地图的定位_第23张图片多传感器融合(2)——点云地图构建及基于地图的定位_第24张图片

点云地图的建立

多传感器融合(2)——点云地图构建及基于地图的定位_第25张图片

​​​​​​​基于地图的定位

多传感器融合(2)——点云地图构建及基于地图的定位_第26张图片

多传感器融合(2)——点云地图构建及基于地图的定位_第27张图片

Scancontext回环方法的调用:

实际上使用的是下面两个函数:

实时保存当前帧点云,用于回环匹配

sc_manager_.ScancontextAndKeys(*scan_cloud_ptr);

 回环帧检测函数,没有检测到返回-1,检测到回环帧返回对应帧的索引。

sc_manager_.detectLoopClosureID()

 调用回环检测:

多传感器融合(2)——点云地图构建及基于地图的定位_第28张图片

 多传感器融合(2)——点云地图构建及基于地图的定位_第29张图片

然后在相应的hpp文件中加入对应的函数即可(待更新)

你可能感兴趣的:(多传感器融合,slam,定位,传感器)