关闭

港科VINS-Mono系统学习(5) 闭环检测

1275人阅读 评论(0) 收藏 举报
分类:

vins是今年刚开源的vio系统,跑了数据集效果挺好的,所以看了paper和代码。

视频地址:https://www.youtube.com/watch?v=I4txdvGhT6I

github:https://github.com/HKUST-Aerial-Robotics/VINS-Mono.Git


之前的博客对数据预处理、VIO初始化和里程计部分都做了介绍,这次博客主要介绍VINS系统中的最后一个步骤,也就是闭环检测。

闭环检测的步骤如下:

a)在滑动窗口后,把新关键帧加入集合中,再提取500个FAST特征,计算BRIEF描述子

b)通过BoW去搜索匹配到的闭环候选帧

c)在小窗口范围进行特征匹配(这里只对之前的Harris特征进行基础矩阵求解,因为只有这些特征点具有深度),用fundamentalmatrix+RANSAC去outliers

d)利用共视的特征点,将得到的闭环帧放入当前的滑动窗口进行优化。这里闭环帧的位姿是被固定的。


e)4自由度的位姿图优化

   这里roll,pitch是可观的,不进行优化。

f)关键帧地图的构建

                         节点:每次margin后的关键帧,每3帧插入1帧

                          边1:连续的两帧


                          边2:闭环检测得到的帧间关系


                          这几个边都是一个4自由度的变量,平移量+yew角


欢迎批评指正!

EMAIL:wangxf92_hit@163.com


2
0
查看评论

VINS-Mono源码解析(一)系统框架

VINS-Mono源码解析(一)系统框架1. VINS-Mono 简介VINS-Mono是HKUST的Shen Shaojie团队开源的一套Visual-Inertial融合定位算法. 介绍见(https://github.com/HKUST-Aerial-Robotics/VINS-Mono), ...
  • q597967420
  • q597967420
  • 2017-07-25 21:54
  • 4123

港科VINS-Mono系统学习(1)

vins是今年刚开源的vio系统,跑了数据集效果挺好的,所以看了paper和代码。 视频地址:https://www.youtube.com/watch?v=I4txdvGhT6I github:https://github.com/HKUST-Aerial-Robotics/VINS-Mono.g...
  • qq_31785865
  • qq_31785865
  • 2017-07-17 10:30
  • 2203

运行VINS-Mono遇到的问题

1.1 Ubuntuand ROS Ubuntu 14.04 ROS Indigo. [ROS 安装](http://wiki.ros.org/indigo/Installation/Ubuntu) 安装 ROS 包     sudo apt-get inst...
  • snnily
  • snnily
  • 2017-06-10 16:02
  • 2949

VINS-Mono源码解析(三)后端: IMU预积分

VINS-Mono源码解析(三)后端: IMU预积分为什么要预积分? - 论文中的说法是: State Estimation其实是想估计任意时刻的全局坐标系下的位置和姿态, 也就是论文中的pwbk,vwbk,qwbkp_{b_k}^w,v_{b_k}^w,q_{b_k}^w, 分别对应位置,速度,...
  • q597967420
  • q597967420
  • 2017-07-25 21:56
  • 2391

VINS-Mono源码解析(四)后端: Initialization

VINS-Mono源码解析(四)后端: Initialization整个Initialization部分对应Estimator::initialStructure()函数, 包括Vision-only SFM和Visual Inertial Alignment两部分, 它们的实现分别在GlobalS...
  • q597967420
  • q597967420
  • 2017-07-25 21:57
  • 1618

jbpm中的excutionservice详解

最新的流程实例 -- ByKey 下面是为流程定义启动一个新的流程实例的最简单也是 最常用的方法: ProcessInstance processInstance = executionService.startProcessInstanceByKey("ICL"); 上...
  • wangxiaojing123
  • wangxiaojing123
  • 2011-12-08 14:26
  • 1238

VINS-Mono源码解析(二)前端:特征跟踪

VINS-Mono源码解析(二)前端:特征跟踪  VINS-Mono中的前端处理在ROS节点feature_tracker_node中,具体实现是GoodFeatureToTrack + LK光流跟踪。1. 节点概览  该节点的功能是:接收图像数据,进行角点提取和光流跟踪,输出跟踪的特征点(角点)。...
  • q597967420
  • q597967420
  • 2017-07-25 21:56
  • 2182

VINS-Mono源码解析(五)后端: 紧耦合优化

VINS-Mono源码解析(五)后端: 紧耦合优化1. 优化原理a) 优化变量χ第k帧状态:xk相机外参:xbc=[x0,x1,...,xn,     xbc,     λ0,λ1,...,λm]=[...
  • q597967420
  • q597967420
  • 2017-07-25 21:57
  • 1747

【VINS算法分析之一】VINS-Mono(草稿)

VINS-Mono is a real-time SLAM framework for Monocular Visual-Inertial Systems. It uses an optimization-based sliding window formulation for providing ...
  • wangbaodong070411209
  • wangbaodong070411209
  • 2017-10-30 13:53
  • 475

港科VINS-Mono系统学习(2) 预处理

vins是今年刚开源的vio系统,跑了数据集效果挺好的,所以看了paper和代码。 视频地址:https://www.youtube.com/watch?v=I4txdvGhT6I github:https://github.com/HKUST-Aerial-Robotics/VINS-Mono.g...
  • qq_31785865
  • qq_31785865
  • 2017-07-17 10:46
  • 1908
    个人资料
    • 访问:11853次
    • 积分:234
    • 等级:
    • 排名:千里之外
    • 原创:9篇
    • 转载:5篇
    • 译文:0篇
    • 评论:10条
    文章分类
    最新评论