LIMO: Lidar-Monocular Visual Odometry

1.Introduction

相机对特征具有较强的追踪性能,但立体视觉对外参标定的依赖过强,对于有细小误差的标定结果可能会导致较大的深度估计误差,然而激光的深度估计误差较小,并且独立于外参估计误差。
目前激光到相机的标定仍是一个活跃领域,精度在几个像素误差之内。
该paper不显式使用任何LIDAR-SLAM算法,实现激光和相机的深度信息融合的里程计和BA,但没有实现回环检测。

pipeline:
monocular image sequence(Camera)

  • Feature extraction
  • Feature preprocessing
  • Frame to frame motion estimation

scale information(LIDAR)

  • scale estimation

fusion

  • compute camera poses and 3d structure

2.Feature extraction and preprocessing

该paper使用了viso2实现了特征提取和匹配,viso2包含了非极大值抑制、剔除离群值等功能,能在30-40ms能匹配2000个特征。作者还使用了深度学习来剔除在运动物体上的landmark


3.Scale estimation

思想:从LIDAR中获得被检测到的特征点的深度

A.方法概述

首先将LIDAR点云转换到相机坐标系,然后投影到图像平面,然后对每一个图像特征点f执行一下五步:

  • 选择f周围的ROI中的LIDAR点云集F(块B)
  • 从F中分割除前景集F_seg(块C)
  • 用前景集F_seg拟合平面p(块D),如果f属于地面,则使用一种特殊的拟合算法(块E)
  • 将p和f对应的视线相交,得到f的深度
  • 对估计的深度执行测试
B.选择邻域(即ROI)

用矩形框作为ROI,ROI中的激光点要能组成一个平面,而不是一条直线上

C.前景分割

由于特征点通常都是角点,如果直接对点集F拟合一个平面,通常都会产生错误的估计,因此需要将前景分割出来。
前景分割算法利用了深度直方图,以深度跳变点作为前后景的分界点,分割后f可以看作是前景平面中的一条边。

D.平面拟合

从F_seg中选择三点张成一个能够稳定估计值的最大面积的三角形F_delta。如果F_delta过小,则不使用该深度估计

E.特例:地面上的点

F_seg拟合得到的平面是垂直于雷达的垂直轴(?我认为是水平轴)的。但在地面上的点是不可以用该方法估计的,因为激光雷达在垂直方向上的精度低于水平方向上的精度。但地面上的点是有价值的,所以利用RANSAC算法对激光雷达点云提取出具有鲁棒拟合特性的地面


4.Frame to frame odometry

用PnP估计相机运动,为了解决具有有效深度的特征点较少的问题,该paper加入了极线约束。为了减少离群值的影响,该paper使用了柯西核函数包裹损失函数和极线约束。


5.后端

该paper提出了一个基于关键帧的BA框架,该框架从结构和软件上独立于先验估计。

A.选择的重要性

衡量了准确率和花销

B.关键帧的选择
C.地标(Landmark)选择

该paper将Landmark分成了三部分:近(Near),中(Middle),远(Far)

  • Near对平移估计较为重要
  • Middle对平移和旋转都重要
  • Far对旋转重要
    为了保证三维地标的均匀分布,该paper对三维地标采用了中值滤波的体素滤波器。对不同的部分使用了不同的选择策略。
D.地标深度插入
E.健壮性和问题公式
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 199,271评论 5 466
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 83,725评论 2 376
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 146,252评论 0 328
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 53,634评论 1 270
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 62,549评论 5 359
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 47,985评论 1 275
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 37,471评论 3 390
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 36,128评论 0 254
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 40,257评论 1 294
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 35,233评论 2 317
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 37,235评论 1 328
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 32,940评论 3 316
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 38,528评论 3 302
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 29,623评论 0 19
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 30,858评论 1 255
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 42,245评论 2 344
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 41,790评论 2 339

推荐阅读更多精彩内容