首页 > 其他分享 >ORB-SLAM3中IMU初始化

ORB-SLAM3中IMU初始化

时间:2023-12-27 14:56:15浏览次数:38  
标签:wg 初始化 scale 关键帧 优化 SLAM3 IMU ORB

ORB-SLAM3中IMU初始化由LocalMapping线程中的InitializeIMU函数完成。
主要是完成重力方向\(R_{wg}\)和尺度scale的估算,总共进行三次。
InitializeIMU函数包含两部分:InertialOptimization 和 FullInertialBA

InertialOptimization函数

纯IMU的优化,固定关键帧位姿,优化重力方向、尺度、关键帧速度和偏置

FullInertialBA函数

根据上一步得到的\(R_{wg}\)和scale变换到整张地图,再进行IMU+视觉的整体优化
优化的节点:关键帧位姿、速度、加速度和陀螺仪偏置、地图点
优化的边:重投影、旋转变换、位置变化、速度变换、相邻关键帧偏置

第一次初始化

触发条件:10个以上关键帧,关键帧累计时间超过2s(单目),没有进行过IMU初始化
初值:\(R_{wg}\)通过速度变化近似得出,scale设为1

第二次初始化 VIBA1

触发条件:完成第一次初始化、累计时间>5s
初值:\(R_{wg}\)为单位矩阵,scale设为1

第三次初始化 VIBA2

触发条件:完成第二次初始化、累计时间>15s
初值:\(R_{wg}\)为单位矩阵,scale设为1

优化\(R_{wg}\)和scale

后面100s内每隔一定间隔优化\(R_{wg}\)和scale
ScaleRefinement函数仅调用InertialOptimization

标签:wg,初始化,scale,关键帧,优化,SLAM3,IMU,ORB
From: https://www.cnblogs.com/narjaja/p/17930564.html

相关文章

  • CF1887C Minimum Array 题解
    Problem-1887C-CodeforcesMinimumArray-洛谷有点被降智了/ll首先区间修改显然先转化成差分序列单点修改。显然对于相同的操作序列,\(a_i\)的取值对答案无影响,因此我们可以先让\(a_i\)全部取\(0\),最后再加回来即可假如说操作到某一时刻,\(a_i\)的值中第一个......
  • EM(Expectation-Maximum)算法
    EM算法简介EM算法的核心分为两步E步(Expection-Step)M步(Maximization-Step)因为在最大化过程中存在两个参量,其中若知道,则知道;若知道,则知道。且两个量未存在明显的关系,但又互相依存可以采用EM算法其中主要思想为:首先随机初始化参数然后求的在参数下按照极大似然估计求得参数然后根据参......
  • React 的 Suspense 和 ErrorBoundary 还有这种关系?
    Suspense组件想必大家都用过,一般是和React.lazy结合用,用来加载一些异步组件。比如这样一个组件://src/Aaa.jsxexportdefaultfunctionAaa(){return<div>aaa</div>}就可以在另一个组件里用lazy+Suspense异步加载:importReact,{Suspense}from'react';const......
  • CF1881F Minimum Maximum Distance 题解
    因为白点对\(f_i\)没有贡献,所以可以重构出一棵原树的子树,使得所有的叶子都为标记点且标记点数量不变(没有删去标记点)。因为没有标记被删去且结构不变,所以这棵树的答案与原树答案相同。现在,对于所有节点,到它距离最大的标记点一定在叶子上。那么问题就变为:求出树上任意一点到所有......
  • 【持续更新篇】SLAM视觉特征点汇总+ORB特征点+VINS前端
    Harris角点opencv函数cornerHarris提取输入图像的Harris角点检测原理检测思想:使用一个固定窗口在图像上进行任意方向的滑动,对比滑动前后的窗口中的像素灰度变化程度,如果存在任意方向上的滑动,都有较大灰度变化,则认为该窗口中存在角点。\(E(u,v)=\sum_{(x,y)\inW}w(x,y)[......
  • Nacos启动:[NACOS HTTP-POST] The maximum number of tolerable server reconnection e
    一、表象二、分析源码:publicHttpRestResult<String>httpPost(Stringpath,Map<String,String>headers,Map<String,String>paramValues,Stringencode,longreadTimeoutMs)throwsException{finallongendTime=System.currentTi......
  • 题解 LGP7294【[USACO21JAN] Minimum Cost Paths P】/ accoders::NOI 5696【棋子】
    problemFarmerJohn的牧草地可以看作是一个\(N×M\)(\(2≤N≤10^9,2≤M≤2⋅10^5\))的正方形方格组成的二维方阵(想象一个巨大的棋盘)。对于\(x∈[1,N],y∈[1,M]\),从上往下第\(x\)行、从左往右第\(y\)列的方格记为\((x,y)\)。此外,对于每一个\(y∈[1,M]\),第\(y\)列拥有一个......
  • Exchange接入ADFS-CAS,登录后提示报错“WrongAudienceUriOrBadSigningCert”
    cas登录密码验证成功后,跳转到Exchangeowa的时候出现如下报错:https://mail.test19.com/owa/auth/errorfe.aspx?msg=WrongAudienceUriOrBadSigningCert处理方法:1.登录ex,Get-OrganizationConfig|fladfs*,检查AdfsAudienceUris是否有未添加的url,检查AdfsSignCertificateThumbprints......
  • HTTP 错误 403.14 - Forbidden Web 服务器被配置为不列出此目录的内容。没有为请求的
    HTTP错误403.14-ForbiddenWeb服务器被配置为不列出此目录的内容。出现以上这个错误可能有如下解决方法:1.将应用程序池设置成V4.02.在配置文件中加上以下几句代码:<system.webServer><modulesrunAllManagedModulesForAllRequests=“true”/><directoryBrowseenabled=“......
  • 技术美术|游戏中的流体模拟(Fluid Simulation)
    【USparkle专栏】如果你深怀绝技,爱“搞点研究”,乐于分享也博采众长,我们期待你的加入,让智慧的火花碰撞交织,让知识的传递生生不息!一、闲聊最近一直在研究流体模拟,很神奇的一个东西,好在网上有很多参考资料,研究过程不算太困难。分享下最近一段时间的学习心得。二、效果演示 ......