SLAM
文章平均质量分 82
3D-GS Gaussian-Splatting ORB VINS SVO DSO MSCKF and so on (SLAM base sophus ceres eigen 3rd_party gtsam)
大江东去浪淘尽千古风流人物
研究方向:AI,humanoid, XR芯片,感知算法,端侧部署(SLAM/三维重建,空间计算,VLN/VLA)等
欢迎讨论交流 && 专业/职业规划咨询
展开
专栏收录文章
- 默认排序
- 最新发布
- 最早发布
- 最多阅读
- 最少阅读
-
【X-Restormer++】全天候图像恢复赛冠军方案:三项创新解析及对VIO/SLAM前端的工程价值
空间自适应输入缩放(不同区域差异化增强)、梯度引导边缘感知损失(保留几何结构而非只追求视觉清洁)、以及 24,500 对额外的 FoundIR+WeatherBench 数据。它的目标场景覆盖暴雨、大雪、浓雾、沙尘/雾霾等全谱系低能见度天气。对 SLAM/VIO 工程师而言,这类模型的正确定位不是"替代 SLAM 主干",而是可选前处理模块——何时开、何时关、开了是否真能提升 tracking stability,必须以 ATE/RPE 而非 PSNR 为指标实验验证。原创 2026-05-16 12:50:30 · 426 阅读 · 0 评论 -
【Kimera-VIO】MIT SPARK 实时度量-语义 VIO/SLAM:六模块并行架构与智能因子图优化深度解析
Kimera-VIO 是 MIT SPARK 实验室开源的实时视觉惯性里程计(VIO)与度量-语义 SLAM 系统(arXiv:1910.02490)。CPU 实时运行无需 GPU将深度学习语义标签直接融入 3D 网格重建完整的闭环优化链路。系统由六个可独立运行的模块组成,通过线程安全队列并行推进,后端基于 GTSAM 智能因子(Smart Factors)实现边缘化隐式管理,闭环检测依托 DBoW2 词袋模型加 KimeraRPGO 鲁棒求解器完成全局一致轨迹估计。原创 2026-05-13 20:10:59 · 506 阅读 · 0 评论 -
【MASt3R-SLAM】端到端密集SLAM系统:三进程架构与10大核心创新点深度解析
MASt3R-SLAM 是一套以 ViT-Large 为视觉骨干的端到端稠密 SLAM 系统,采用三进程并行架构,在统一的 MASt3R 模型下同时完成特征提取、稠密3D点图重建与回环检测。与传统稀疏特征 SLAM 相比,它无需独立深度估计模块、无需预训练词袋模型、甚至可在无相机标定参数下正常运行。本文从完整工程数据流出发,系统梳理其10大核心创新点,并逐一分析哪些设计可直接移植到 ORB-SLAM、VINS-Mono 等传统系统中。原创 2026-05-02 14:15:52 · 439 阅读 · 0 评论 -
【dynaVINS】动态场景VIO:软权重交替优化与多假设回环深度解析
摘要: dynaVINS针对动态场景中VINS(视觉惯性导航系统)的固有矛盾,提出一种无需语义标签的鲁棒解决方案。传统方法通过RANSAC或核函数硬拒绝动态特征,导致信息丢失或位姿污染。dynaVINS创新性地引入连续权重($w \in [0,1]$)实现动态特征的自适应软加权,结合交替优化(IRLS)解耦位姿与权重估计的耦合问题。其核心设计包括:1)软权重优化目标,通过阻力项和动量项平衡静态与动态特征;2)交替优化策略,分阶段求解权重与位姿;3)动量先验防止权重抖动;4)选择性边缘化避免低权重特征污染信息原创 2026-05-02 11:46:41 · 331 阅读 · 0 评论 -
【DROID-W】 (WildGS-SLAM) 代码深度梳理
DROID-W是CVPR 2026提出的动态场景SLAM系统,在DROID-SLAM基础上创新性地引入可学习逐像素不确定性掩码,并集成3D Gaussian Splatting建图。系统采用三进程并行架构:前端跟踪、在线BA和3D建图。核心创新包括:1)不确定性驱动的BA,通过DINOv2特征加仿射变换实现轻量不确定性估计;2)尺度-偏移联合BA优化,解决单目深度先验的尺度问题;3)两阶段初始化策略;4)语义特征一致性约束。系统通过共享内存实现高效数据交互,在动态场景中表现出色,关键优化如不确定性加权、正则原创 2026-05-02 10:44:41 · 446 阅读 · 0 评论 -
【UV-SLAM】eLSD/LBD 数据维度 UV-SLAM吸收借鉴
本文摘要总结了UV-SLAM系统在线特征处理方面的技术改进方案。第一阶段已完成5项关键优化:调整平行视差阈值(3.6°→5.7°)、三角化后重投影验证、Cauchy核函数替换Huber损失、改进端点匹配门限以及提升LBD描述子维度(25→40),这些改进使RMSE降低1.24%。第二阶段计划实施线参数联合优化(4-DOF表示)和解析Jacobian计算,预计BA速度提升6倍。第三阶段将引入ELSED检测器替代LSD,并添加消失点约束。系统采用LSD检测线段(30ms瓶颈)和LBD描述子(256位二进制),通原创 2026-05-01 16:17:50 · 411 阅读 · 0 评论 -
【UV-SLAM 】彻底吃透UV-SLAM:创新原理、工程实现与直线几何核心代码详解
本文深入解析了UV-SLAM系统,该系统基于VINS-Mono改进,针对低纹理和结构化场景(如室内、走廊、城市街道)中的定位问题,创新性地引入消失点(VP)约束和直线特征优化。核心创新包括:1)消失点投影因子,利用曼哈顿世界的平行结构约束提升精度;2)直线投影因子,适配低纹理场景;3)直线初始化模块,增强鲁棒性。工程实现上,UV-SLAM优化了多线程架构、前端VP检测流水线和消息通信机制,确保实时性。此外,文章详细推导了直线几何的数学公式(如Plücker坐标和正交参数化),并提供了核心代码实现和使用示例,原创 2026-04-24 16:53:50 · 447 阅读 · 0 评论 -
【PL-VINS】代码梳理:入口函数、主体流程与线特征建模详解
PL-VINS是基于VINS-Mono扩展的单目视觉惯性SLAM系统,通过引入线特征(Point+Line)增强系统性能。系统由4个ROS节点组成:点特征跟踪节点(KLT光流)、线特征跟踪节点(LSD+LBD)、核心估计器节点(处理IMU、点线特征)和回环检测节点。核心流程包括数据同步、IMU预积分和图像处理,其中非线性优化阶段会联合优化点线特征和IMU数据。PL-VINS在VINS-Mono框架中新增了线特征跟踪链路,并在BA优化中加入了线投影因子,实现了点线特征的深度融合。原创 2026-04-23 16:44:46 · 377 阅读 · 0 评论 -
【cuVSLAM】接口 / 执行流程 / 设计特点 / 优缺点的技术梳理
它把“多相机几何初始化”做成了一个轻量、在线、局部、职责单一的组件,而把复杂的长期地图维护与精修优化留给上层。原创 2026-04-20 21:55:54 · 395 阅读 · 0 评论 -
【cuVSLAM】GPU 加速、多相机、实时视觉/视觉惯性 SLAM设计优势
cuVSLAM 本身就是一套偏的系统,支持多相机输入,并强调在边缘平台上实时运行。原创 2026-04-20 21:48:54 · 528 阅读 · 0 评论 -
【cuVSLAM】项目解析:一套偏工程实战的 GPU 紧耦合视觉惯性 SLAM
一套以 GPU 并行为底座、以 GFTT+光流为前端、以 IMU 紧耦合为状态估计核心、以局部 SBA + 回环 + PGO 为后端骨架的工业级视觉惯性 SLAM 系统。前端不追求炫技,追求稳定、均匀、可持续跟踪VIO 不做松耦合拼接,而做真正联合优化后端不阻塞前端,异步维持全局一致多相机和 GPU 不是补丁,而是从架构一开始就纳入设计地标、patch、回环、图优化都围绕“机器人现场可用”来组织它把一套经典几何 SLAM,做成了真正面向机器人部署的系统。arXiv。原创 2026-04-20 17:55:29 · 528 阅读 · 0 评论 -
【DROID-W】WildGS-SLAM
现象说明追踪阶段最耗时通常占总耗时约 50%度量深度估计占比中等约占 13–16%DINOv2 特征提取占比较小约占 3–4%全局 BA 与序列长度、关键帧数相关的全局 BA 达到 102.9s轨迹填充可能成为瓶颈轨迹填充达到 77.6sDROID-SLAM 跟踪+ 单目度量深度估计+ DINOv2 图像特征+ 全局 BA+ 3D Gaussian Splatting 建图的完整视觉 SLAM / 重建系统。方面总结输入RGB 图像为核心,可结合深度图和单目先验配置。原创 2026-04-16 16:39:14 · 426 阅读 · 0 评论 -
【Basalt】nfr_mapper 信息重参数化(information reparameterizati)VIO 的 dense 高斯先验,蒸馏成 sparse 几何因子,再结合视觉重建做 BA
本文提出了一种将VIO边缘化先验转化为可优化后端建图约束的创新方法NfrMapper。该方法的核心思想是将VIO边缘化后留下的线性高斯先验(包含状态协方差信息),通过数学转换提取为可继续优化的非线性因子,包括相对位姿因子和Roll/Pitch因子,并结合新的视觉观测进行局部BA优化。文章详细推导了从协方差矩阵到几何因子的转换过程,特别是SE(3)流形上的相对位姿因子构造方法,解释了如何将状态空间的不确定性转化为观测空间的约束权重。这种设计实现了实时系统与高质量建图的解耦,使系统同时具备实时性和精度优势。原创 2026-04-11 18:38:28 · 420 阅读 · 0 评论 -
【Basalt】nfr_mapper 中的“小 SfM/BA 后端”
本文介绍了一个基于VIO边缘化先验的后端稠化映射器NfrMapper。该系统主要功能包括:1)从VIO边缘化输出MargData中恢复关键帧位姿约束;2)重新进行特征提取、跨帧匹配和三角化建图;3)执行局部BA优化。NfrMapper通过将VIO的线性先验转化为非线性位姿因子(包括roll/pitch约束和相对位姿约束),结合重建的视觉特征和地图点,构建了一个可再次优化的因子图模型。该系统与前端VIO形成互补关系,VIO负责实时估计并输出边缘化信息,而NfrMapper则利用这些信息进行更精确的离线优化,实原创 2026-04-11 16:17:08 · 395 阅读 · 0 评论 -
【Basalt】measure 中关键帧管理与滑动窗口梳理
│ 滑动窗口全貌 │。│ 关键帧 普通帧 最新帧 │。│ │KFₙ │F │F │KFₘ │F_cur│ ← 完整状态(位姿+V+B) │。│ │KF₁ │KF₂ │KF₃ │…│ ← 仅位姿,已边缘化速度/bias │。二、measure 的完整流程。四、边缘化触发与选帧策略。三、关键帧的生命历程。原创 2026-04-10 17:10:04 · 263 阅读 · 0 评论 -
【Basalt】Basalt void SqrtKeypointVioEstimator<Scalar_>::optimize() VIO优化流程
@[TOC](【Basalt】Basalt void SqrtKeypointVioEstimator<Scalar_>::optimize() VIO优化流程)(x,l)→linearize→(H,b)→eliminate landmarks→(Hˉ,bˉ)→LM solve(x,l)\rightarrow \text{linearize}\rightarrow (H,b)\rightarrow \text{eliminate landmarks}\rightarrow (\bar H,\ba原创 2026-04-01 16:04:47 · 431 阅读 · 0 评论 -
【Basaalt】Visual-Inertial Mapping with Non-Linear Factor Recovery论文解读
摘要 本文提出一种基于非线性因子恢复的视觉-惯性建图方法,解决VIO局部精度高但全局建图融合困难的问题。方法通过从VIO轨迹中提取浓缩的非线性因子,重构关键帧间运动约束,并与回环检测结合进行全局光束平差优化。核心创新在于利用VIO因子增强地图横滚/俯仰角可观测性,提升鲁棒性与精度。实验表明,该方法在公共数据集上优于主流算法,实现了重力对齐的全局一致地图。原创 2026-03-31 20:51:52 · 367 阅读 · 0 评论 -
【Basaalt】工程实现线程与队列依赖图梳理
本文分析了vio_run_mcap.cpp的多线程架构。程序采用生产者-中转-消费者流水线设计,基础运行时包含7个固定线程:主线程、图像/IMU输入线程、视觉转发线程、状态消费线程以及光流/VIO处理线程。通过队列实现线程间通信,形成两条主数据链:图像处理链和IMU处理链。程序还支持可选线程如GUI显示、队列监控和数据归档。此外,光流和VIO内部使用TBB实现并行计算。这种架构在保证数据顺序依赖的同时,通过多线程提高了整体吞吐量。原创 2026-03-31 14:46:17 · 396 阅读 · 0 评论 -
【Basalt】Basalt主流程梳理
本文描述了VIO(视觉惯性里程计)系统的主流程和实现架构。系统分为前端和后端:前端进行图像特征跟踪,后端融合IMU数据进行状态估计。主流程包括数据加载、初始化、特征跟踪、IMU预积分、关键帧管理、三角化建图、滑窗优化和边缘化处理。程序通过多线程实现数据流处理,包括图像/IMU数据输入、前端处理、后端优化和状态输出。核心算法实现在SqrtKeypointVioEstimator中,涉及状态预测、特征关联、关键帧判断、三角化建点以及联合优化等关键步骤,最终输出位姿、速度和零偏估计。原创 2026-03-31 11:05:40 · 429 阅读 · 0 评论 -
【Basalt】 VIO(sqrt_keypoint_vio)主流程measure函数梳理
本文分析了Basalt VIO系统中measure()接口的实现细节。该接口是VIO前后端的主要入口,负责处理每帧图像和IMU数据的完整流程。主要包含6个步骤:1) IMU状态预测和传播;2) 注册当前视觉观测;3) 关键帧决策和地标点三角化;4) 边缘化准备和优化;5) 状态发布和可视化;6) 计时和返回。接口会处理IMU预积分传播状态、特征点跟踪管理、关键帧判断(基于新特征点比例)、新点三角化,并最终调用后端优化。特别值得注意的是关键帧决策逻辑目前仅基于单目特征点比例,对双目系统可能存在优化空间。原创 2026-03-31 10:55:58 · 467 阅读 · 0 评论 -
【数据格式】mcap 数据/rosbag 包/euroc 数据有什么差异和相同点
文章摘要:本文对比了MCAP、ROS 1 rosbag、ROS 2 rosbag2和EuRoC数据集四种机器人数据记录格式的核心差异。MCAP是通用日志容器格式,不依赖ROS,支持多通道消息存储和随机访问;ROS 1 rosbag是专用录包格式,绑定ROS 1;ROS 2 rosbag2采用插件式存储机制,支持MCAP或SQLite;EuRoC是数据集目录规范。表格对比了它们在本质、载体、ROS依赖、数据组织等方面的差异,并分析了底层文件结构特点。这些格式都能表达时间序列传感器数据,但适用场景不同:MCAP原创 2026-02-26 15:22:37 · 921 阅读 · 0 评论 -
【SLAM】为什么像orb slam,vins等视觉SLAM开源算法里,精度上双目常常低于单目?
摘要:开源视觉SLAM中双目精度常低于单目的深层原因并非理论缺陷,而是工程实现未充分发挥双目优势。关键因素包括:1) 双目深度测量对相机标定、同步、曝光一致性等条件极为敏感,错误深度会引入硬约束偏差;2) 低纹理/遮挡区域的错配深度比单目"无约束"更危害优化;3) 远距离场景下双目深度分辨率不足;4) 开源系统默认参数和评测标准往往偏向单目;5) 在VINS系统中,IMU已提供尺度约束,双目可能引入额外噪声源。本质上,SLAM精度取决于误差管理能力而非传感器数量,改进方向应聚焦标定质量验原创 2026-02-25 18:37:07 · 585 阅读 · 0 评论 -
【SIFT】各特征点与传统SIFT的对比分析
本文对比分析了多种SIFT特征点实现与传统SIFT的差异。VLFeat SIFT在精度上略优(105%),适合COLMAP生态;OpenCV SIFT兼容性好,速度提升10%;AKAZE作为降级方案速度快2-3倍但精度较低(85%);GPU加速版本(PopSift/CUDA SIFT)速度提升4-10倍且保持精度。总结建议:精度优先选VLFeat SIFT,速度优先选GPU加速版本,通用场景选OpenCV SIFT,AKAZE仅作备用方案。不同实现的核心差异体现在精度、速度、硬件依赖和适用场景上。原创 2026-02-24 17:20:30 · 548 阅读 · 0 评论 -
【efficient_QR】efficient_QR分解DSP设计:要点、难点及处理方式
本次设计围绕和开展DSP硬件实现,核心适配近似方阵(15×15~384×375),兼顾内存限制、计算性能与精度,以下为核心要点、设计难点及对应处理方式的简化总结。原创 2026-02-12 16:04:09 · 717 阅读 · 0 评论 -
【pySLAM】pySLAM
pySLAM 凭借其 Python 的易用性和 C++ 的高性能,成为视觉 SLAM 领域一个极具价值的工具。它不仅降低了研究门槛,也为工程落地提供了灵活的框架。未来,随着更多深度学习模型和传感器的集成,pySLAM 将在空间 AI 领域发挥更大的作用。如果你需要,我可以帮你整理一份pySLAM 核心模块的详细技术文档,或者生成一个Windows 环境下的安装和运行指南,方便你直接上手。需要我帮你做吗?原创 2026-02-11 20:27:03 · 807 阅读 · 0 评论 -
【SLAM】Hydra-Foundations 层次化空间感知:机器人如何像人类一样理解3D环境
MIT SPARK实验室的最新研究《Foundations of Spatial Perception for Robotics》提出了突破性的层次化3D场景图表示方法,解决了传统SLAM系统在语义理解和可扩展性方面的局限。该研究通过理论证明层次化图具有小树宽特性,支持高效推理,并开发了基于持久同调的房间分割、神经树架构等创新算法。集成系统Hydra在真实机器人平台上实现了实时性能,显著提升了机器人对复杂环境的理解能力。这项工作为机器人空间感知建立了新范式,将几何SLAM与神经符号推理相结合,为未来大规模应原创 2026-02-11 19:25:52 · 1557 阅读 · 0 评论 -
【SLAM新范式】几何主导=》几何+学习+语义+高效表示的融合
SLAM领域正经历从几何主导到多模态融合的范式变革。本文精选六大前沿研究:1)SLAM-Former首次用Transformer统一SLAM前后端;2)MAGiC-SLAM采用3D高斯泼溅实现高质量重建;3)RUSSO实现声呐-视觉-IMU深度融合;4)SPAQ-DROID通过剪枝量化实现边缘设备部署;5)Hier-SLAM引入LLM构建语义地图;6)FoundationSLAM提出首个SLAM基础模型。这些工作展现了SLAM向智能化、语义化、轻量化的发展趋势,正从定位工具向具身智能核心组件演进。原创 2026-02-07 16:31:04 · 861 阅读 · 0 评论 -
【XR 】XR 公司核心玩家(SLAM)
原创 2026-01-20 14:06:52 · 551 阅读 · 0 评论 -
【SLAM】嵌入式系统硬件存储及其架构设计
本文分析了嵌入式系统中三种关键存储模块的特性与实现。**IPM(内部处理内存)**作为实时计算专用高速内存,采用片上SRAM实现,延迟约3800ns,容量为MB级。**MSS(OCM)**是片上存储子系统,包含缓存和紧耦合内存,容量达256MB级。DTCM-DSP0作为DSP0核心专用数据存储,具有极低延迟(10ns)和256KB容量。三者通过特定内存映射和代码段属性实现高效数据存取,分别满足算法缓冲区、系统存储和专用计算的不同需求。原创 2026-01-07 12:04:25 · 553 阅读 · 0 评论 -
【IMU】温度补偿原理及其使用方式
IMU温度补偿的核心在于角速度计(陀螺仪),因其温漂特性远敏感于加速度计。MEMS陀螺仪基于科里奥利力原理,温度变化会显著改变其弹性模量、热膨胀系数等参数,导致零偏和灵敏度漂移比加速度计高1-3个数量级。误差累积效应使陀螺仪温漂成为姿态解算的主要误差源,短时间内即可造成严重角度偏差。工程实践中,陀螺仪温漂规律性强且补偿效果显著(可降低60%-90%误差),而加速度计温漂影响较小且补偿收益有限。因此,在资源受限时优先补偿陀螺仪能最大化提升IMU性能,尤其在自动驾驶等对姿态精度要求高的场景中更为关键。原创 2026-01-06 16:06:08 · 1114 阅读 · 0 评论 -
【Wins】VLD Visual memory leak check使用教程
文章摘要:本文介绍了Visual Leak Detector(VLD)内存检测工具的安装与使用指南。安装可访问https://kinddragon.github.io/vld/获取。配置部分提供了详细的CMake脚本,包含Windows平台下的VLD路径设置、库链接和调试模式启用说明。使用示例展示了在代码中通过添加#include <vld.h>头文件来启用内存检测,并附有检测结果截图。最后展示了典型的VLD输出报告,包含内存泄漏位置、调用堆栈和泄漏数据详情,帮助开发者快速定位内存问题。原创 2025-08-28 10:50:33 · 1126 阅读 · 0 评论 -
【SLAM】不同相机模型及其常见的链式求导推导
本文介绍了一个用于计算鱼眼相机畸变雅可比矩阵的接口compute_distort_jacobian。该接口通过数学推导实现了两种关键雅可比矩阵的计算:畸变坐标相对于归一化坐标的雅可比矩阵(H_dz_dzn)和畸变坐标相对于相机内参的雅可比矩阵(H_dz_dzeta)。文章详细阐述了鱼眼相机的畸变模型,包括畸变角度θ_d与归一化坐标的关系,以及如何通过链式法则计算各项偏导数。这些雅可比矩阵在相机校正、三维重建等计算机视觉任务中具有重要作用,能够描述输出随输入变化的敏感程度。文章还简要说明了接口的输入输出参数和原创 2025-08-14 16:34:19 · 825 阅读 · 0 评论 -
【SVO】klt与极限搜索块匹配findEpipolarMatchDirect
函数功能摘要 findEpipolarMatchDirect实现基于极线约束的直接特征匹配,用于视觉里程计中的特征跟踪与深度估计。核心步骤包括: 极线端点计算:通过深度范围[d_min_inv, d_max_inv]确定当前帧中的极线搜索区间(px_A, px_B)。 仿射扭曲补偿:计算参考帧到当前帧的仿射变换矩阵,消除视角变化导致的图像变形。 边缘特征过滤:检查边缘特征梯度方向与极线的一致性,剔除不匹配候选。 金字塔搜索:在选定层级上沿极线滑动参考图像块,使用ZMSSD(零均值平方和差)评估匹配质量。 亚原创 2025-07-02 14:16:09 · 907 阅读 · 0 评论 -
【householder given ratation 之间的差异】
(镜面翻转):将向量 (\mathbf{x}) 关于某个超平面(由Householder向量 (\mathbf{v}) 定义)反射,得到 (-\sigma \mathbf{e}_1)(其中 (\sigma) 是缩放因子,(\mathbf{e}_1) 是标准基向量)。• 变换矩阵形式:在 ((i,j)) 平面上的旋转矩阵 (G(i,j,\theta)),仅修改 (i) 和 (j) 行/列的元素。:对 (m \times n) 矩阵QR分解的复杂度为 (O(2n^2(m-n/3))),适合大规模稠密矩阵。原创 2025-04-15 19:41:26 · 480 阅读 · 0 评论 -
【SLAM】左右目匹配和前后帧匹配差异
左右目匹配和前后帧匹配是计算机视觉中两种不同的匹配任务,分别服务于不同的应用目标。它们的核心差异体现在。原创 2025-02-20 09:44:36 · 537 阅读 · 0 评论 -
【SLAM】中ZUPT的原理、名称由来及作用详解
ZUPT通过利用静止阶段的零速度观测,有效校正惯性导航系统的累积误差,是提升SLAM定位精度的关键技术之一。其名称直接体现了核心思想,作用则集中在误差抑制与多传感器融合的鲁棒性增强。原创 2025-02-11 16:35:23 · 1408 阅读 · 0 评论 -
[MOUNT: Learning 6DoF Motion Prediction Based on Uncertainty Estimation for Delayed AR Rendering]
MOUNT: Learning 6DoF Motion Prediction Based on Uncertainty Estimation for Delayed AR Rendering原创 2025-01-21 13:16:25 · 241 阅读 · 0 评论 -
【OV】MSCKF与SLAMupdate更新解读
利用多个相机观测到的特征点,通过优化计算得到当前状态的最优估计。它可以在不使用地图的情况下实现单目视觉里程计的功能。算法实现了特征点管理、相机位姿估计、特征点三角化和优化、测量矩阵构建和状态更新等主要步骤。小姐:零空间投影的主要目的是:消除冗余信息,保证数值稳定性,满足约束条件,提高整个系统的性能和可靠性,特别是在多状态扩展卡尔曼滤波(MSCKF)等复杂优化场景中。原创 2025-01-07 17:57:31 · 872 阅读 · 0 评论 -
【OV】基于滑窗的残差构建(包含投影误差),目标函数构造,优化滑动窗口中的状态变量(如位姿、速度等)。)舒尔补方法实现SchurVINS::Solve3
原本的优化问题中需要优化的变量大幅减少,使得优化问题从高维变为低维。同时,计算过程也更加稀疏化,便于数值优化库(如 Ceres Solver)高效求解。(Schur Complement Method)完成的,该方法用于有效地消除系统中某些变量(如特征点的三维坐标),从而减少计算复杂度并优化求解效率。总之,代码中通过舒尔补方法避免了对特征点的直接优化,大幅降低了计算复杂度,且保留了状态估计的准确性。(特征点变量的增量),使用舒尔补方法得到关于。最终,通过等效赫塞矩阵和梯度,调用。通过舒尔补消去特征点。原创 2025-01-03 16:46:02 · 1437 阅读 · 0 评论 -
【OV】VINS协方差矩阵维护:描述状态的不确定性及各状态变量之间的相关性
协方差矩阵的维度变化:新增状态的维度与原状态向量保持一致。初始化假设:新增状态的协方差与现有状态通过传递模型或初始化值关联。数值稳定性:使用与原状态一致的协方差值作为新增部分的初值,避免数值不稳定。这一过程确保了在扩展状态的同时,系统的不确定性能够正确传播并保持与观测模型一致。这段代码是C++语言编写的,属于一个名为SchurVINS的类的成员函数。这个函数的目的是将一个新的状态(由表示)添加到当前的状态估计中,并且更新状态协方差矩阵。原创 2025-01-03 14:52:29 · 1411 阅读 · 2 评论
分享