VINS中的初始化方法

已于 2023-09-22 16:13:24 修改
阅读量658 收藏 6
点赞数 1
分类专栏： slam 文章标签： slam 人工智能 算法
于 2023-09-21 13:09:49 首次发布
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/m0_37604894/article/details/133129931
版权
本文详细介绍了VINS中静态和动态初始化策略，重点讨论了IMUPreintegration、VINS-fusion、VI-ORB-SLAM和ORB-SLAM3的初始化流程，以及尺度初始化的重要性。强调了数据准备和VI-BA优化对初始化时间的影响。
摘要由CSDN通过智能技术生成

背景

本文档介绍VINS中常见的初始化方法，静态初始化相对简单，通常1s内可以完成，但如果遇到在运动时的初始化问题，初始化难度相对较大，实际工程问题中，通常会将初始化分为静态和动态初始化两部分，这里主要是介绍动态初始化方案。

一、基础知识:IMU Preintegration

IMU Preintegration

  • 等式两边同时乘以旋转的逆，把IMU测量提取出来
    在这里插入图片描述
  • Bias Updates：bias会影响上面的增量，因此bias更新时通过jacobian更新增量
    在这里插入图片描述
    因此，整体预积分流程为：
    在这里插入图片描述

二、 VINS-fusion初始化方法

与第一帧数据相距>0.1s后,利用局部窗口内的每一帧初始化，初始化流程如下：

1、单目+IMU

在这里插入图片描述

第四步实现细节：
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
在这里插入图片描述

2、双目+IMU

有尺度，初始化又快又简单

  1. 和地图点匹配，SolvePnP，计算当前帧位姿
  2. 双目三角化，计算特征深度
  3. gyro bias矫正
  4. 局部窗口BA优化（视觉余项+IMU余项）

三、VI-ORB-SLAM初始化方法

a.原理介绍

compute an initial estimation for a visual-inertial full BA of the scale, gravity direction, velocity and IMU biases.

在这里插入图片描述
在这里插入图片描述

b. 实验结果分析

在这里插入图片描述

四、ORB-SLAM3初始化

a.原理

在这里插入图片描述

b. 实验结果

在这里插入图片描述

c.加速方案

假设我们这里有尺度来源tof，那么可以进行加速
在这里插入图片描述

五、Fast and Robust Initialization for Visual-Inertial SLAM

在这里插入图片描述
在这里插入图片描述

六、总结

1、 VISLAM的初始化方案需要较长的数据准备时间（1~2s）

2 、为了得到更准确的初值，需要进行VI-BA优化，耗时约几百ms，处理时间相对较久

3、没有尺度来源时，初始化需要充分的IMU激励，这个条件通常较难满足，因此整体初始化时间较久

4、初始化最重要的解释尺度初始化，其他的收敛都很快，所以如果可以有一个先验的尺度来源，很容易把初始化时间控制在1s以内

知也无涯12345
关注
专栏目录
【VINS-Mono 初始化】Monocular Visual-Inertial State Estimator(一)
公众号『机器感知』
09-17 761
机器感知 一个专注于SLAM、三维重建、机器视觉等相关技术文章分享的公众号 1. 测量值预处理 1.1 视觉前端处理 特征跟踪通过KLT光流法跟踪，为了避免特征点越跟越少，同时辅助的在每帧上在提取一些特征点，保证特征点数量在100-300之间。图像特征点首先去畸变，然后使用RANSAC方法计算基础矩阵F来剔除异常点，最后把这些特征点投影到单位球上。 关键帧的选择也是在这一步进行的，关...
vins中imu融合_VINS的初始化与camera-imu外参标定
weixin_39669147的博客
12-21 458
1. 外参旋转矩阵初始化在VINS的Feature Detection and Tracking模块中，用Harris特征匹配，通过F矩阵和RANSAC算法恢复出 ；相应地使用IMU陀螺仪数据预积分得到 ;这两个测量量满足： * = * 将测量得到的R用四元数表示，并用四元数的运算(左乘右乘)得到约束方程： * = 0用多组数据得到超定方程： * = 0通过求最小二乘解，得到 ， ...
VINS-Fusion源码逐行解析：除单目+imu模式外的位姿初始化函数initFramePoseByPnP()及其内部函数
最新发布
shikaiaixuexi的博客
07-12 196
通过之前看processImage函数，我们发现只有单目+imu模式的位姿初始化函数用的是sfm那种，也就是initialStructure()函数，而除了这个模式外的别的模式，如双目+imu、仅双目、和不是初始化过程中位姿初始化函数都使用initFramePoseByPnP()
读懂VINS-Mono——初始化
xiaohu的博客
10-29 4226
估计器初始化 初始化的原因是单目惯性紧耦合系统是一个非线性程度很高的系统，首先单目是无法获得空间中的绝对尺度，而IMU又必然存在偏置，在后面进行求解的时候还需要用到重力加速度（包括大小和方向），对于速度比较敏感的条件下，比如说无人机，又要精确的速度信息，因此，如何有效的在紧耦合系统处理之前计算出这些量，对整个紧耦合系统的鲁棒性有着重大的意义 初始化要做的事其实说起来很简单，就是计算出绝对尺度s、...
VINS-Fusion源码逐行解析：单目+imu模式初始化函数initialStructure()及imu与视觉融合函数visualInitialAlign()
shikaiaixuexi的博客
07-08 912
通俗的讲就是使用imu数据是要有足够的运动。首先，我们检测imu的激励，这里讲一下imu激励是什么，在使用惯性测量单元（IMU）进行传感和数据收集过程中，通过设备的运动来激发IMU传感器，从而产生有效的测量数据。方法得到的位姿，而对于非关键帧，则使用PnP算法求解位姿，最后我们获得了帧容器中存的所有帧的位姿，区别只是关键帧和非关键帧位姿获取方式不同，最后，通过。方法进行全局结构从运动（SFM）重建，计算所有帧的位姿，之后，对所有帧遍历，通过比较时间戳来找出关键帧和非关键帧，关键帧位姿使用sfm模块的。
VINS初始化
sunshine
03-15 527
VINS初始化 VINS初始化之外参在线标定 前面主要分析了外参标定出来旋转矩阵，接下来接着分析初始化。 if (solver_flag == INITIAL) { if (frame_count == WINDOW_SIZE) //WINDOW_SIZE=20 { bool result = false; ...
萌新学VINS-Fusion（二）------初始化
weixin_41843971的博客
01-24 4443
最近在忙别的事情，博客迟迟没更新，现在终于放假了，今天把初始化部分来分析一下。 源码：https://github.com/HKUST-Aerial-Robotics/VINS-Fusion processImage函数 在介绍初始化之前，我们先从后端接收到数据开始。processImage函数就是后端解算位姿的函数。 该函数的参数分别为上一讲最后得到的特征容器，和header中存储的时标。首先调...
Vins初始化
qq_44991021的博客
05-08 1179
Vins初始化
VINS的初始化
CSDN_XCS的博客
08-18 768
首先，明确在系统初始化阶段可以利用的已知量，以及待求解的未知量。 已知：1.各帧相对于第0帧的位姿Rc0ci,tc0ciR_{c_0c_i},t_{c_0c_i}Rc0​ci​​,tc0​ci​​；（根据SfM求得） 2.各相邻帧之间的位姿变化Rbkbk+1,tbkbk+1R_{b_kb_{k+1}},t_{b_kb_{k+1}}Rbk​bk+1​​,tbk​bk+1​​；（根据IMU的预积分求...
VINS-Mono之初始化
qq_38555897的博客
07-07 491
VINS-Mono的初始化
vins视觉初始化流程
batmanShu的博客
05-10 929
之前面试有被问到过，又回头把vins再看了一下，这里总结一下vins中视觉部分的初始化流程 程序入口 vins代码的入口储存在estimator_node.cpp中 其中的main函数 int main(int argc, char **argv) { //ROS初始化，设置句柄n ros::init(argc, argv, "vins_estimator"); ros::NodeHandle n("~"); ros::console::set_logger_level(RO
Vins-Fusion初始化-初始化陀螺零偏Bgs
u010196944的博客
11-18 487
Vins-Fusion初始化-初始化陀螺零偏Bgs
VINS ---初始化
zwlq1314521的专栏
07-21 1081
通过匹配的视觉特征点 对极约束获取本质矩阵E，再分解本质矩阵获得相机的R，T bool MotionEstimator::solveRelativeRT(const vector> &corres, Matrix3d &Rotation, Vector3d &Translation) { if (corres.size() >= 15) { vector ll,
一文详解VINS-Fusion初始化标定
3D视觉工坊
03-22 2681
作者丨卢涛@知乎来源丨https://zhuanlan.zhihu.com/p/358232587编辑丨3D视觉工坊本文基于VINS-Fusion解释VIO系统的初始化，包括在线标定IMU...
VINS_FUSION入门系列－初始化
pj_find的博客
06-01 1653
初始化 初始化前获得IMU的起始姿态,g2r（const Eigen::Vector &g）函数。这个函数主要是为了做一个重力对齐。之后会得到一个初始化的R0, 这个R0​存入滑动窗口的世界坐标系下的旋转Rs[0],具体参考:https://blog.csdn.net/huanghaihui_123/article/details/103075107 //初始第一个imu位姿 void Estimator::initFirstIMUPose(vector<pair<double, Eig
VINS-初始化:【翻译】Robust Initialization of Monocular Visual-Inertial Estimation on Aerial Robots
weixin_45626706的博客
04-29 626
目录用于空中机器人的单目视觉惯性估计的鲁棒初始化摘要简介综述方法纯视觉结构 用于空中机器人的单目视觉惯性估计的鲁棒初始化 摘要 在本文中，我们提出了一种鲁棒的在线估计器初始化算法，为单目视觉惯性系统（VINS）提供高质量的初始状态。由于VINS的非线性，较差的初始化可能会严重影响基于滤波的或基于图像的方法的性能。我们的方法从纯视觉运动恢复结构（SFM）开始，构建相机位姿和特征位姿的尺度结构。通过使用预集成的IMU测量松散地对齐这种结构，我们的方法恢复了公制尺度，速度，重力矢量和陀螺仪偏置，用于作为初始值，以
VINS初始化原理及代码
weixin_41469272的博客
05-08 693
⋅w⋅w表示世界坐标系下的表示，Z轴与重力方向重合。⋅b⋅b表示体坐标系下的表示，与IMU坐标系绑定。⋅c⋅c表示相机坐标系下的表示。qbwq_b^wqbw​和pbwp_b^wpbw​分别表示imu 体坐标系下转换到世界坐标系下对应的旋转和平移。qcbq_c^bqcb​和pcbp_c^bpcb​分别表示相机坐标系下转换到体坐标系下对应的旋转和平移。⋅bk⋅bk​表示第k帧图像对应的体坐标系。⋅ck⋅ck。
第七章——VINS系统初始化
weixin_43008154的博客
05-09 1187
前言 这一章主要内容是讲的VINS系统初始化的事，内容上还是比较全面丰满的，有一些有疑问的点我之后读了代码会在博客里补上。一句话总结初始化：以优化量与观测值构建残差，提取优化量构成最小二乘问题 内容 1. IMU和相机旋转外参qbcq_{bc}qbc​以及角速度计（陀螺仪）的bias 在这一部分的初始化过程中，我们已知的信息有： 相机以一定频率采样得到的帧图像（可提取出相机旋转信息） IMU以一定频率采样得到的角速度值（同样可提取出IMU旋转信息） 旋转外参qbcq_{bc}qbc​我们认为在相机位移过
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值