VINS-Mono-后端优化 (四:边缘化原理)

news2024/9/23 5:32:02

滑窗中固定只能有11帧,当来了新的帧的时候旧的帧就需要抹掉,但是不能直接把旧的帧的全部信息抹掉,因为旧的帧的经历过11次优化,其地图点中的优化信息是有用,边缘化的操作就是为了只把最旧帧的变量去掉,但是保留其对应的优化信息留在窗口里面,因为那些信息仍然具有约束作用

边缘化舒尔补

在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
此时公式已经没有 δ x a \delta x_{a} δxa 了,但是保留了 δ x a \delta x_{a} δxa 带来的约束
δ x b \delta x_{b} δxb 左边的矩阵当作新的 H H H,并分解为 J T J J^{T}J JTJ,右边则分解为 J T e J^{T}e JTe

边缘化更详细的讲解看这篇文章 SLAM中的marginalization 和 Schur complement

H 矩阵的构造

由于这个 H H H 矩阵是在ceres中计算的,不会暴露出来,由于这里需要进行边缘化,所以只能自己计算 H H H 矩阵,这基本算是一个手写后端的部分了
有了 H H H 矩阵就可以迭代优化了, H Δ x = g H\Delta x=g HΔx=g

讲一下如何构建这个 H H H 矩阵,现在存在预积分约束和重投影约束,每个约束都存在 H = J T J H=J^{T}J H=JTJ,但是现在需要一个大的 H H H 矩阵

通过把累加的方式构成这个大的矩阵 H = Σ J T J H=\Sigma J^{T}J H=ΣJTJ
J = ∂ e ∂ x J=\frac{\partial e }{\partial x} J=xe

状态向量有, λ \lambda λ 是地图点
在这里插入图片描述
就是把每个 J J J都累加起来构成这个大 H H H

J T J J^{T}J JTJ 的形式如这张图
在这里插入图片描述
代码中要关注一下是怎么累加的

在这里插入图片描述
在这里插入图片描述
在这里插入图片描述
m m m 是地图点, p p p 是位姿,可以看到 p 1 p1 p1 的量被边缘化掉了,然后对 m 1 m1 m1 p 2 p2 p2 建立了关系,原本 m 1 m1 m1,和 p 2 p2 p2 是没有关系的,边缘化后就建立了约束,关系图可以看下面
在这里插入图片描述
这里可以看出,边缘化会带来 fill-in 现象,把原先的稀疏矩阵变成了稠密矩阵,因为会不停地带来额外的约束

VINS中会把地图点也边缘化掉,只剩位姿,速度和零偏这些状态量的约束保留,因为地图点的数量太多了,这样可以减少矩阵的维数

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.coloradmin.cn/o/1202099.html

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈,一经查实,立即删除!

相关文章

霸榜“双11”,高端文创新品发布即售罄,剑南春大促节点再传佳绩

执笔 | 洪大大 编辑 | 萧 萧 作为一年一度的重要促销大节,“双11”线上购物已成为各大品牌奋战的重要战场。而在今年,剑南春也是再一次拔得头筹。 在刚刚出炉的“双11”战报中,天猫剑南春官方旗舰店以超高人气和销售量获得白酒行业交易指…

来看看电脑上有哪些不为人知的小众软件?

​ 电脑上的各类软件有很多,除了那些常见的大众化软件,还有很多不为人知的小众软件,专注于实用功能,简洁干净、功能强悍。 1.桌面停靠栏工具——BitDock ​ BitDock是一款运行在Windows系统中的桌面停靠栏工具,功能实…

RFID汽车制造工业系统解决方案

随着物联网技术的不断发展,汽车行业的信息化水平也在不断提高,随着近几年国产汽车的带动,汽车配件配套市场也已形成了一定的规模,初步形成比较完整成熟的零部件配套体系。 RFID汽车制造工业系统解决方案 与其他行业对比&#xff0…

【Springboot】基于注解式开发Springboot-Vue3整合Mybatis-plus实现分页查询(一)——后端实现思路

系列文章目录 基于注解式开发Springboot-Vue3整合Mybatis-plus实现分页查询(二)——前端el-pagination实现 文章目录 系列文章目录系统版本实现功能操作步骤1. 新建Mybatis的全局分页配置文件2. 编写OrderMapper :继承Mybatis-plus提供的BaseMapper3. 编写OrderSer…

UE基础必学系列:项目和文件结构

官方文档:https://learn.unrealengine.com/course/ 张佳亮:UE4插件相关说明文档 1、uproject,以商城下载的ActionRPG为例 {"FileVersion": 3,"EngineAssociation": "4.20","Category": "Samples","Description&qu…

​《水经注全国三维离线GIS系统》硬件安装教程

有些工作,是需要一些外在动力才能完成的。 为什么这么讲呢? 因为正是在客户的要求下,我们才撰写了《水经注全国三维离线GIS系统》的硬件安装教程,而且还录制了视频教程。 当用户收到货物以后,就可以通过本教程清点货…

医学影像PACS系统:一种用于存储、管理和传输医学影像数据的系统

医疗软件中的影像归档与传输系统软件(Picture Archiving and Communication System,简称PACS)是一种用于存储、管理和传输医学影像数据的系统。 PACS是应用在医院影像科室的系统,主要的任务就是把日常产生的各种医学影像&#xff…

excel记录wFm数值(推理过程)

1 导入计算wfm库2 实例化具体的指标 3 列表循环之前,设置空list 4 单图评测-将图号、图片名、数值记录 列表里面存储dict 5 将excel列表结果逐个存入excel.xlsx文件 完整代码 test_CPD.py ### test_CPD.py ### import torch import torch.nn.functional as Fimpor…

卷积神经网络(CNN)-吴恩达

1 计算机视觉 得益于深度学习的发展,计算机视觉是发展的最好的领域之一。 计算机视觉包括图像分类、 目标检测、神经风格转换 1、图像分类,有时也叫图像识别 2、计算机视觉问题的一个挑战是输入可以是任意大 2 边缘检测例子 1、卷积运算是卷积神经网络…

深度神经网络算子参数量和计算量分析—卷积篇

前言 在用于计算机视觉任务的深度神经网络模型中,卷积算子作为一种重要的特征提取方式被广泛应用,本文针对常见的卷积算子参数量和计算量的计算方法进行分析,主要包括普通卷积、深度可分离卷积、分组卷积,以及自动计算模型参数量和…

无人机交付:跨境电商的数字化未来

随着科技的不断进步,跨境电商行业正经历着前所未有的数字化变革。其中,无人机交付正成为这一领域的未来之路,为电商企业和消费者带来了新的便利和机遇。本文将深入探讨无人机交付在跨境电商中的应用,以及它如何塑造数字化未来。 无…

大促期间治理品牌窜货的诀窍

渠道问题中,最常见的是窜货,窜货还会伴随低价,会影响其他经销商的利益,同时窜货还可能带来假货,所以治理窜货是品牌的责任,对于出货量巨大的双十一大促,品牌更应重视对窜货问题的治理。 力维网络…

上课笔记(11.11之前笔记)

一.数据结构的分类 1.数据结构中分为四大类:线性表,哈希表,树,图。 2.线性表(line table):呈现线性结构的一种数据结构。具有顺序性,也就是所有数据都是有序的; 数组&…

(1)(1.14) LightWare SF10/SF11激光雷达

文章目录 前言 1 串行连接 2 I2C 连接 3 参数说明 前言 Lightware SF20 和 LW20 是体积小、测距远(100m)、精度高的测距仪。有两种型号,LW20/Ser 使用串行接口,LW20/I2C 使用 I2C 接口。 1 串行连接 对于串行连接&#xff0…

Autosar模块介绍:FEE(Flash模拟EEPROM)

上一篇 | 返回主目录 | 下一篇 Autosar模块介绍:FEE(Flash模拟EEPROM 1 基本术语解释2 Ea组成结构图3 Ea基本操作3.1 通用操作3.2 作业的进程(通用需求)3.3 读操作过程3.4 写操作过程3.5 擦除过程3.6 比较过程 4 Ea常用操作时序4.1 初始化4.…

uniapp打包安卓app获取包名

uniapp打包安卓app获取包名的两种方式 1.uniapp云打包 这上面直接可以看到包名,可以修改,也可以在 manifest.json 文件中配置修改 package配置的就是包名,要确保唯一性 2.使用aapt工具获取 1.下载aapt工具,然后添加到环境变量…

汽车FMCW毫米波雷达信号处理流程(推荐---基础详细---清楚的讲解了雷达的过程---强烈推荐)

毫米波雷达在进行多目标检测时,TX发射一个Chirp,在不同距离下RX会接收到多个反射Chirp信号(仅以单个chirp为例)。 雷达通过接收不同物体的发射信号,并转为IF信号,利用傅里叶变换将产生一个具有不同的分离峰…

高端NEV | 地表最强纯电,极氪001 FR上市做到“技惊四座”了吗?

百万超跑赛道越来越“香”,本以为它是来“凑热闹”的,竟成「地表最强」? “友商们,五年内造不出来!”的极氪001 FR上市口号火速传遍全网。 ◎图源网络 上周,号称地表最强纯电“战士”极氪001 FR在北京举行…

修改/etc/fstab文件导致Linux无法正常启动

如果把 /etc/fstab 文件修改错了,也重启了,系统崩溃启动不了了,那该怎么办?比如: [rootlocalhost ~]# vi /etc/fstab UUIDc2ca6f57-b15c-43ea-bca0-f239083d8bd2 ext4 defaults 1 1 UUID0b23d315-33a7-48a4-bd37-9248…

hive里因为列名用了关键字导致建表失败

代码 现象 ParseException line 6:4 cannot recognize input near percent String COMMENT in column name or primary key or foreign key 23/11/13 11:52:57 ERROR org.apache.hadoop.hive.ql.Driver: FAILED: ParseException line 6:4 cannot recognize input near percent …