slam框架:紧耦合激光视觉惯性里程计的统一多模态地标点跟踪_unified multi-modal landmark tracking for tightly -程序员宅基地

技术标签: 论文阅读  slam  自动驾驶  计算机视觉  人工智能  

论文题目:

Unified Multi-Modal Landmark Tracking for Tightly Coupled Lidar-Visual-Inertial Odometry

紧耦合激光视觉惯性里程计的统一多模态地标点跟踪

参考链接:

【泡泡点云时空】紧耦合激光视觉惯性里程计的统一多模态地标点跟踪

摘要:

我们为移动平台提出了一种高效的多传感器里程计系统,该系统在单个集成因子图中联合优化视觉、激光雷达和惯性信息。 这使用固定滞后平滑以全帧速率实时运行。为了执行这种紧密集成,提出了一种从激光雷达点云中提取 3D 线和平面图元的新方法。这种方法克服了典型的帧到帧跟踪方法的次优性 将图元视为地标并在多次扫描中跟踪它们。 使用激光雷达和相机帧的微妙被动同步,可以实现激光雷达特征与标准视觉特征和 IMU 的真正集成。  3D 功能的轻量级公式允许在单个 CPU 上实时执行。 我们提出的系统已经在各种平台和场景上进行了测试,包括使用腿式机器人进行地下探索和使用动态移动的手持设备进行户外扫描,总持续时间为 96 分钟,行驶距离为 2.4 公里。 在这些测试序列中,仅使用一个外部感受器会导致失败,原因是几何形状受限(影响激光雷达)或由剧烈的光照变化(影响视觉)引起的无纹理区域。 在这些情况下,我们的因子图自然会使用来自每个传感器模式的最佳信息,而无需任何硬开关。

主要贡献:

• 一种新颖的因子图公式,在单个一致的优化过程中紧密融合视觉、激光雷达和 IMU 测量值;

• 一种提取激光雷达特征的有效方法,然后将其优化为地标。 激光雷达和视觉特征共享统一的表示,因为地标都被视为 n 维参数流形(即点、线和平面)。 这种紧凑的表示允许我们以标称帧速率处理所有激光雷达扫描;

• 与更典型的方法相比,在单个传感器模式失败时挣扎的更典型的方法相比,在一系列场景中进行了广泛的实验评估,展示了卓越的鲁棒性。

我们的工作建立在 VILENS 估计系统的基础上 通过添加激光雷达特征跟踪和激光雷达辅助视觉跟踪,在我们之前的作品 [11]、[12] 中引入。 相机和激光雷达的组合即使在剧烈移动时也能在便携式设备上使用,因为它自然地处理场景中的退化(由于缺乏激光雷达或视觉特征)。

主要图:

 

雷达惯导,雷达视觉惯导,和loam,lego-loam对比:

总结:

1 在一个固定步长的平滑窗口内,视觉提取特征点,激光雷达提取线特征和面特征点集。

2 跟踪视觉特征,使用激光雷达提供深度(投影,查找3个像素之内的对应点,计算残差)如上图3。

3 使用海塞正规式来参数化平面p,使用一个单位向量n以及一个d表示其原点的距离。

4 使用一个旋转矩阵R和两个尺度参数a,b来参数化一个直线,R表示直线方向,ab表示直线上距离原点最近的点

5 使用FAST角点检测器检测特征,并使用KLT特征跟踪器跟踪它们,使用RANSAC滤除外点

6 使用imu做先验,对雷达点云去畸变,并转换到最近的相机帧时间,实现同步,如上图6。

7 进行聚类,滤波,计算曲率取角点和平面点(同loam)。

8 跟踪前一帧中的线和面,具体是:

使用imu预测到当前帧中对应的位置,为了帮助局部跟踪,我们使用最大的点到模型的距离对预测的特征位置进行CP和CL分割。然后,我们执行欧几里得聚类(和平面特征的正态过滤),以去除外点。然后,我们使用PROSAC鲁棒拟合算法将模型拟合到分割后的点云上。最后,我们检查了预测的地标和检测到的地标是否足够相似。当两个平面p_i和p_j的法线与距离原点的距离小于阈值时,被认为是匹配的

9 一旦跟踪了一个特征,特征的内点将从相应的候选集中删除,并对剩余的地标重复这个过程。在跟踪完成后,我们将在剩余的候选云中检测到新的地标。首先使用欧氏聚类对点云进行划分,平面采用基于法向的区域增长算法。然后,我们使用与地标跟踪相同的方法来检测每个集群中的新地标。点云特征只有在跟踪了至少多次连续帧后才包含在优化中

10 当平台静止时,为了限制漂移和因子图的增长,当三种模态(相机、激光雷达、IMU)中的两种更新报告没有运动时,我们向图中添加了零速度约束

版权声明:本文为博主原创文章,遵循 CC 4.0 BY-SA 版权协议,转载请附上原文出处链接和本声明。
本文链接:https://blog.csdn.net/qq_35102059/article/details/121809670

智能推荐

oracle 12c 集群安装后的检查_12c查看crs状态-程序员宅基地

文章浏览阅读1.6k次。安装配置gi、安装数据库软件、dbca建库见下:http://blog.csdn.net/kadwf123/article/details/784299611、检查集群节点及状态:[root@rac2 ~]# olsnodes -srac1 Activerac2 Activerac3 Activerac4 Active[root@rac2 ~]_12c查看crs状态

解决jupyter notebook无法找到虚拟环境的问题_jupyter没有pytorch环境-程序员宅基地

文章浏览阅读1.3w次,点赞45次,收藏99次。我个人用的是anaconda3的一个python集成环境,自带jupyter notebook,但在我打开jupyter notebook界面后,却找不到对应的虚拟环境,原来是jupyter notebook只是通用于下载anaconda时自带的环境,其他环境要想使用必须手动下载一些库:1.首先进入到自己创建的虚拟环境(pytorch是虚拟环境的名字)activate pytorch2.在该环境下下载这个库conda install ipykernelconda install nb__jupyter没有pytorch环境

国内安装scoop的保姆教程_scoop-cn-程序员宅基地

文章浏览阅读5.2k次,点赞19次,收藏28次。选择scoop纯属意外,也是无奈,因为电脑用户被锁了管理员权限,所有exe安装程序都无法安装,只可以用绿色软件,最后被我发现scoop,省去了到处下载XXX绿色版的烦恼,当然scoop里需要管理员权限的软件也跟我无缘了(譬如everything)。推荐添加dorado这个bucket镜像,里面很多中文软件,但是部分国外的软件下载地址在github,可能无法下载。以上两个是官方bucket的国内镜像,所有软件建议优先从这里下载。上面可以看到很多bucket以及软件数。如果官网登陆不了可以试一下以下方式。_scoop-cn

Element ui colorpicker在Vue中的使用_vue el-color-picker-程序员宅基地

文章浏览阅读4.5k次,点赞2次,收藏3次。首先要有一个color-picker组件 <el-color-picker v-model="headcolor"></el-color-picker>在data里面data() { return {headcolor: ’ #278add ’ //这里可以选择一个默认的颜色} }然后在你想要改变颜色的地方用v-bind绑定就好了,例如:这里的:sty..._vue el-color-picker

迅为iTOP-4412精英版之烧写内核移植后的镜像_exynos 4412 刷机-程序员宅基地

文章浏览阅读640次。基于芯片日益增长的问题,所以内核开发者们引入了新的方法,就是在内核中只保留函数,而数据则不包含,由用户(应用程序员)自己把数据按照规定的格式编写,并放在约定的地方,为了不占用过多的内存,还要求数据以根精简的方式编写。boot启动时,传参给内核,告诉内核设备树文件和kernel的位置,内核启动时根据地址去找到设备树文件,再利用专用的编译器去反编译dtb文件,将dtb还原成数据结构,以供驱动的函数去调用。firmware是三星的一个固件的设备信息,因为找不到固件,所以内核启动不成功。_exynos 4412 刷机

Linux系统配置jdk_linux配置jdk-程序员宅基地

文章浏览阅读2w次,点赞24次,收藏42次。Linux系统配置jdkLinux学习教程,Linux入门教程(超详细)_linux配置jdk

随便推点

matlab(4):特殊符号的输入_matlab微米怎么输入-程序员宅基地

文章浏览阅读3.3k次,点赞5次,收藏19次。xlabel('\delta');ylabel('AUC');具体符号的对照表参照下图:_matlab微米怎么输入

C语言程序设计-文件(打开与关闭、顺序、二进制读写)-程序员宅基地

文章浏览阅读119次。顺序读写指的是按照文件中数据的顺序进行读取或写入。对于文本文件,可以使用fgets、fputs、fscanf、fprintf等函数进行顺序读写。在C语言中,对文件的操作通常涉及文件的打开、读写以及关闭。文件的打开使用fopen函数,而关闭则使用fclose函数。在C语言中,可以使用fread和fwrite函数进行二进制读写。‍ Biaoge 于2024-03-09 23:51发布 阅读量:7 ️文章类型:【 C语言程序设计 】在C语言中,用于打开文件的函数是____,用于关闭文件的函数是____。

Touchdesigner自学笔记之三_touchdesigner怎么让一个模型跟着鼠标移动-程序员宅基地

文章浏览阅读3.4k次,点赞2次,收藏13次。跟随鼠标移动的粒子以grid(SOP)为partical(SOP)的资源模板,调整后连接【Geo组合+point spirit(MAT)】,在连接【feedback组合】适当调整。影响粒子动态的节点【metaball(SOP)+force(SOP)】添加mouse in(CHOP)鼠标位置到metaball的坐标,实现鼠标影响。..._touchdesigner怎么让一个模型跟着鼠标移动

【附源码】基于java的校园停车场管理系统的设计与实现61m0e9计算机毕设SSM_基于java技术的停车场管理系统实现与设计-程序员宅基地

文章浏览阅读178次。项目运行环境配置:Jdk1.8 + Tomcat7.0 + Mysql + HBuilderX(Webstorm也行)+ Eclispe(IntelliJ IDEA,Eclispe,MyEclispe,Sts都支持)。项目技术:Springboot + mybatis + Maven +mysql5.7或8.0+html+css+js等等组成,B/S模式 + Maven管理等等。环境需要1.运行环境:最好是java jdk 1.8,我们在这个平台上运行的。其他版本理论上也可以。_基于java技术的停车场管理系统实现与设计

Android系统播放器MediaPlayer源码分析_android多媒体播放源码分析 时序图-程序员宅基地

文章浏览阅读3.5k次。前言对于MediaPlayer播放器的源码分析内容相对来说比较多,会从Java-&amp;amp;gt;Jni-&amp;amp;gt;C/C++慢慢分析,后面会慢慢更新。另外,博客只作为自己学习记录的一种方式,对于其他的不过多的评论。MediaPlayerDemopublic class MainActivity extends AppCompatActivity implements SurfaceHolder.Cal..._android多媒体播放源码分析 时序图

java 数据结构与算法 ——快速排序法-程序员宅基地

文章浏览阅读2.4k次,点赞41次,收藏13次。java 数据结构与算法 ——快速排序法_快速排序法