首页/新闻资讯/正文详情

【SLAM】FAST-LIO2论文精读

发布时间:2026/11/16 16:12:54 来源:云帆数科 栏目:资讯中心
【SLAM】FAST-LIO2论文精读
从具体例子读懂这条方法链假设机器人扫描到前方一面墙。它需要回答“按我现在猜的位置把激光点放进地图它们是不是贴在墙上”FAST-LIO2 每帧围绕这个问题修正位姿。输入是带时间信息的点云、IMU 测量与已有局部地图输出是机器人状态和增量地图没有“正确导航动作”的训练标签。一个点怎样变成定位约束激光测到的点p L p_LpL​先通过外参换到 IMU 坐标再通过机器人位姿换到地图坐标。把合并后的变换简写为p W R p L t p_WRp_LtpW​RpL​tR RR表示朝向t tt表示位置W WW表示地图坐标。真实实现里外参和位姿分别处理。在地图中找这个点附近的几个点拟合一小块平面写成n T p d 0 , r n T p W d , ∥ n ∥ 1. n^T pd0,\qquad rn^T p_Wd,\qquad \|n\|1.nTpd0,rnTpW​d,∥n∥1.n nn是垂直于平面的单位方向d dd是平面常数r rr是有正负号的距离单位为米。残差就是当前预测与几何要求的差。教学例子墙是x 5 x5x5m取n ( 1 , 0 , 0 ) n(1,0,0)n(1,0,0)、d − 5 d-5d−5当前估计把点放到了p W ( 5.12 , 2 , 1 ) p_W(5.12,2,1)pW​(5.12,2,1)于是r 0.12 r0.12r0.12m。滤波器会联合很多点和 IMU 先验修正位姿争取让这些距离整体更小。不能只看一个点就武断地把机器人沿 x 轴移动 12 cm朝向误差、外参误差也可能导致类似现象。改了位姿再查一次一帧点云和点时间IMU辅助去畸变用当前位姿把点放到地图坐标ikd-Tree查近邻并拟合局部平面计算点到平面距离迭代滤波综合几何与IMU先验收敛后输出状态增量插点、删远点、维护局部地图直接法是跳过专门的边缘/平面特征提取让采样后的点直接参与地图匹配它仍然需要去畸变、降采样、近邻查询和有效平面判断。ikd-Tree像一个可以边使用边增删的空间通讯录按位置快速找到附近地图点不负责替滤波器计算机器人动作。如果把同一墙上离散的点拟合成平面后发现残差小说明这部分观测与地图一致不代表所有运动方向都被充分约束。与 FAST-LIO 的区别在于匹配点的使用及地图维护方式它仍需要 IMU 与迭代估计。原文依据FAST-LIO2 的点到地图测量模型和增量地图章节。以上墙坐标是教学数值不是论文实验数据。一句话定位在 FAST-LIO 的紧耦合迭代滤波上做「直接法」去畸变、采样后的点直接配地图并用 ikd-Tree 增量维护地图更快更准、更适配多种雷达扫描模式。本页概念卡FAST-LIO2 · FAST-LIOikd-Tree · 点到平面残差IESKF · 运动去畸变 · 紧耦合1. 背景概念给新人直接法这里的含义不先抽边缘/平面特征把采样点直接拿去和地图比类比视觉直接法「不提点、用像素」的思路但是几何距离。ikd-Tree可增量插删的 k-d 树专为实时建图查询。点到平面点到局部平面距离作残差见概念卡。2. 论文在干什么问题特征提取对环境与扫描模式敏感小 FoV / 弱结构时特征不够地图结构更新贵。贡献两条主线① 直接点到地图② ikd-Tree 增量地图。设定多种公开序列 固态雷达实机高转速、杂乱室内等。3. 核心创新点取消手工特征提取原始点进匹配弱结构也能吃到「细微几何」。ikd-Tree点级插入、轴对齐箱删、动态再平衡支持树上降采样。沿用并强化FAST-LIO 的流形迭代卡尔曼 快速增益公式 IMU 去畸变。系统级结果文中报告相对多种 SOTA 更高精度、更低算力室外可到很高里程计频率量级上百 Hz 口径。4.1 状态与传播状态含 IMU 位姿、速度、零偏、重力、雷达到 IMU 外参等流形表示。每个 IMU 时刻前向传播新扫描到达时把点补偿到扫描结束时刻。对每个有效点在地图找近邻 → 拟平面 → 点到平面残差。隐式测量模型真值点应落在平面上噪声导致有符号距离残差。IESKF反复在当前线性化点算H HH、更新误差状态收敛后更新P PP。4.3 建图有效点插入 ikd-Tree超出局部大立方体的点删除控制地图规模。5. 整体框架MermaidIMU前向传播原始扫描点反向去畸变ikd-Tree 近邻拟平面迭代卡尔曼更新状态增量更新 ikd-Treeikd-TreeIESKFIMUikd-TreeIESKFIMU扫描结束时刻状态loop[迭代至收敛]Predict 多次近邻查询局部平面残差H 更新状态插入有效点 / 删远点6. 实验与结论多序列对比精度与耗时优于多种当时 LIOikd-Tree 相对常见动态近邻结构更均衡。小 FoV 固态雷达、高角速度场景表现突出。局限树结构在极端点密度下仍有开销 → Faster-LIO 用体素近似 kNN 再提速。7. 要点总结「直接法」 不提特征不是光度法。8. 开放问题外参在线估计在论文实验中的开启条件

相关推荐

【SLAM】FAST-LIO论文精读
【SLAM】FAST-LIO论文精读

从具体例子读懂这条方法链 把机器人想成手持激光扫描仪走过一面墙:IMU 是测量转动和加速度的惯性传感器,更新快但会漂;LiDAR 用激光测环境表面的位置,能把漂移拉回来。里程计在这里是连续估计机器人位置和朝向的算法,… · 2026/11/15 16:12:51

如何在云端 GPU 上进行 LeIsaac 远程遥操作?ZMQ 跨机器控制完整指南
如何在云端 GPU 上进行 LeIsaac 远程遥操作?ZMQ 跨机器控制完整指南

【免费下载链接】leisaac LeIsaac provides teleoperation functionality in IsaacLab using the SO101Leader (LeRobot), including data collection, data conversion, and subsequent policy training. 项目地址: https://gitcode.com/gh_mirrors/le/leisaac 点击… · 2026/11/11 20:37:32

V2 之后 AI 做的网页还有“模板味”吗?几份实测摆在一起,答案有点意外
V2 之后 AI 做的网页还有“模板味”吗?几份实测摆在一起,答案有点意外

V2 之后 AI 做的网页还有“模板味”吗?几份实测摆在一起,答案有点意外 【免费下载链接】taste-skill Agent skills that give coding agents taste: art direction, reference images and a browser check instead of generic AI pages 项目地址: http… · 2026/11/11 8:21:56

低压电工证要到哪里考千万别踩坑 这些细节99%的人都不知道
低压电工证要到哪里考千万别踩坑 这些细节99%的人都不知道

低压电工证要到哪里考千万别踩坑 这些细节99%的人都不知道 之前考的证在外省能不能转过来?很多人在考低压电工证时都会遇到这个问题,尤其是已经在外地工作的朋友。如果你正准备报考,或者打算把外省的低压电工证转回来, 千万别踩坑… · 2026/11/16 16:12:52

西藏电工证在哪里报考怎么报名 从业者的焦虑与解决方案
西藏电工证在哪里报考怎么报名 从业者的焦虑与解决方案

西藏电工证在哪里报考怎么报名 从业者的焦虑与解决方案 之前考的证在外省能不能转过来?这个问题,我见过太多人问,尤其是在西藏这样地域跨度大、政策相对独立的地方,很多人都在为“怎么报名”发愁。作为在特种作业行业干了10年的老手,我深知证书不仅是… · 2026/11/16 16:12:52

电工证太难考?建筑电工证挂靠分享多久拿证全攻略
电工证太难考?建筑电工证挂靠分享多久拿证全攻略

电工证太难考?建筑电工证挂靠分享多久拿证全攻略 工地太忙根本没时间复习考试,这话真不是吹的。早上六点起床赶工期,晚上十点才能回家,中间还要处理各种突发状况,哪还有精力去刷题、看书?更别提现在建筑行业越来越规范, 建筑电工证挂靠分享… · 2026/11/16 16:12:52

金华婺城电工证培训值不值得考?实操考试心里没底怕挂科
金华婺城电工证培训值不值得考?实操考试心里没底怕挂科

金华婺城电工证培训值不值得考?实操考试心里没底怕挂科 实操考试心里没底怕挂科,这是很多打算报考金华婺城电工证培训的人最真实的感受。尤其是对转岗的从业者来说,面对全新的考试流程和考核内容,难免会感到紧张和焦虑。别急,今天我就从濮阳转岗过来的视… · 2026/11/16 16:12:52

3000字详解煤气作业证理论考试卷:报名渠道、考试内容与避坑指南
3000字详解煤气作业证理论考试卷:报名渠道、考试内容与避坑指南

3000字详解煤气作业证理论考试卷:报名渠道、考试内容与避坑指南 你是不是也遇到过这种情况:听说要考煤气作业证,但不知道去哪报名,担心被中介坑,还怕花冤枉钱?现在市面上培训机构五花八门,很多地方打着“全国通用”的旗号,但证书真假难辨,考试内… · 2026/11/16 16:12:52

特种作业证q5在菏泽哪里考试网上查询全攻略
特种作业证q5在菏泽哪里考试网上查询全攻略

特种作业证q5在菏泽哪里考试网上查询全攻略 怕考不过白交培训费?特种作业证q5在菏泽哪里考试网上查询全攻略来了,帮你避开坑、少走弯路。… · 2026/11/16 16:11:50

长春初级电工证怎么考?通过率揭秘全在这里
长春初级电工证怎么考?通过率揭秘全在这里

长春初级电工证怎么考?通过率揭秘全在这里 之前考的证在外省能不能转过来?这几乎是每个想从事电工工作的人都会问的问题。特别是那些在外地打拼多年、手里握着一张“外地电工证”的人,到了长春想继续干这一行,第一反应就是“我的证能用吗?”。今天我们就… · 2026/11/16 3:21:55

国内电工证报考条件与考试时间
国内电工证报考条件与考试时间

低压电工证怎么考?学历不高也能报名,官方报名入口全在这 你是不是经常听说“电工证是入行门槛”,但又担心自己学历不够、经验不足,根本报不了名?别急,今天就带你从零了解【国内电工证】的报考流程、考试内容,还有怎么在 官方报名入口… · 2026/11/16 3:01:18

电工作业时如何断电?电子证书到底能不能全国通用?
电工作业时如何断电?电子证书到底能不能全国通用?

电工作业时如何断电?电子证书到底能不能全国通用? 实操考试心里没底怕挂科,特别是电工作业时如何断电这一操作,不仅关系到你能不能拿到证书,更关系到以后能不能顺利上岗。很多人觉得这不过就是“断个电”,但其实这里面的门道可不少,稍有不慎就可能出错… · 2026/11/16 8:30:17

电工证培训的通知在哪考?别再被中介骗了
电工证培训的通知在哪考?别再被中介骗了

电工证培训的通知在哪考?别再被中介骗了 你是不是还在为 电工证培训的通知在哪考 发愁?网上搜了一堆信息,结果要么是挂羊头卖狗肉的培训机构,要么就是打着“包过”旗号的骗子?别急,今天我来给你讲讲, 电工证培训的通知… · 2026/11/16 0:00:34

高级电工证企业认可吗保姆级教程:实操考试心里没底怕挂科?看完这些建议再考不迟
高级电工证企业认可吗保姆级教程:实操考试心里没底怕挂科?看完这些建议再考不迟

高级电工证企业认可吗保姆级教程:实操考试心里没底怕挂科?看完这些建议再考不迟 你是不是也这样,站在高压电工实操考试的设备前,手心冒汗,生怕一个操作失误就被判不合格?实操考试心里没底怕挂科,这是很多准备考高级电工证的人的真实写照。别担心,今天… · 2026/11/16 0:00:34

电工证去哪个部门考核值不值得考 信阳转岗人真实经历分享
电工证去哪个部门考核值不值得考 信阳转岗人真实经历分享

电工证去哪个部门考核值不值得考 信阳转岗人真实经历分享 怕考不过白交培训费?你不是一个人,信阳的李师傅去年刚转岗做电工,就因为没搞清楚电工证去哪个部门考核,差点交了8000块的培训费。别急,下面这份实操考试全攻略,告诉你电工证到底值不值得考… · 2026/11/16 0:00:34

双极步进电机控制实战:DRV8818PWPR与PIC18F86K22驱动调试
双极步进电机控制实战:DRV8818PWPR与PIC18F86K22驱动调试

/* MD / 富文本中的 .toc(含博客园搬家等嵌套结构);.toc-box 在侧栏,不受影响 */#content_views .toc,/* 编辑器常在目录前后插入空 p(:empty 仍占 20px),一并去掉避免顶空隙 */#content_views.markdown_views > p:empty:has(+ .toc),#content_views.markdown_views … · 2026/11/15 1:51:20

STM32F207ZG + DRV8818PWPR 步进电机驱动实战解析
STM32F207ZG + DRV8818PWPR 步进电机驱动实战解析

/* MD / 富文本中的 .toc(含博客园搬家等嵌套结构);.toc-box 在侧栏,不受影响 */#content_views .toc,/* 编辑器常在目录前后插入空 p(:empty 仍占 20px),一并去掉避免顶空隙 */#content_views.markdown_views > p:empty:has(+ .toc),#content_views.markdown_views … · 2026/11/15 4:02:19

DRV8818PWPR+dsPIC30F4013工业级双极步进电机控制方案
DRV8818PWPR+dsPIC30F4013工业级双极步进电机控制方案

/* MD / 富文本中的 .toc(含博客园搬家等嵌套结构);.toc-box 在侧栏,不受影响 */#content_views .toc,/* 编辑器常在目录前后插入空 p(:empty 仍占 20px),一并去掉避免顶空隙 */#content_views.markdown_views > p:empty:has(+ .toc),#content_views.markdown_views … · 2026/11/15 3:02:05

了解更多?预约专属演示

我们的顾问将为您一对一讲解产品与方案

企业微信二维码