RADIO-ViPE:面向动态环境下开放词汇语义 SLAM 的在线紧耦合多模态融合 RADIO-ViPE: Online Tightly Coupled Multi-Modal Fusion for Open-Vocabulary Semantic SLAM in Dynamic Environments
在线开放词汇语义 SLAM,从裸 RGB 视频紧耦合视觉-语言-几何,动态鲁棒
前置知识
视觉 SLAM
Simultaneous Localization and Mapping,通过图像序列同时估计相机位姿并构建环境地图。经典框架 ORB-SLAM3 使用特征点法,DROID-SLAM 改用密集光流网络,端到端地估计相机运动和深度。
本文继承 ViPE 与 DROID-SLAM 的密集光流 BA 框架,理解光流残差、投影算子 $\Pi_q$、反投影 $\Pi_q^{-1}$ 是阅读公式 (2)(3) 的前提。
Bundle Adjustment(BA)
在 SLAM 后端通过最小化重投影误差同时优化相机位姿、3D 路标和内参的非线性最小二乘问题。因子图 $\mathcal{G}=(V,E)$ 把关键帧作为节点、几何/语义约束作为边,形成全局一致的能量函数 $E_{\text{total}}$。
RADIO-ViPE 的核心贡献是把语义嵌入相似度作为新残差项嵌入 BA,使 $\{T_i\}$、$\{d_i\}$、$\{K_q\}$ 联合优化,这是论文公式 (12) 的核心思想。
鲁棒核函数(Adaptive Robust Kernel)
用次二次增长损失抑制动态物体等外点。Barron 通用损失 \(\rho_\alpha(r)\) 通过形状参数 \(\alpha\) 在 \(\ell_2\)、Huber、Cauchy 之间平滑切换。
论文把每个像素的时序稳定性场 $S_i(u)$ 映射到 Barron 的形状参数 $\alpha_i(u)$,理解 $\ell_2$/Huber/Cauchy 三态切换是把握动态处理的关键。
开放词汇语义(Open-Vocabulary)
通过预训练视觉-语言基础模型(CLIP、SigLIP)的对齐空间,支持任意自然语言查询而非固定类别标签。RADSeg 把 RADIO 视觉特征投影到 SigLIP 潜空间,从而支持「红色沙发」「木地板」等自由查询。
论文表 III 显示 RADIO-ViPE 在 Replica 上达到 mIoU 24.25(无背景),与依赖 GT 深度/位姿的离线方法竞争,理解 SigLIP 对齐是看懂开放词汇能力的前提。
聚聚型视觉基础模型(Agglomerative Foundation Model)
RADIO [1] 通过多教师蒸馏把多个视觉基础模型的强项聚合为一个统一学生模型;RADSeg [6] 在此基础上训练零样本开放词汇分割。本文的密集多模态嵌入即来自 RADSeg。
理解 RADIO/RADSeg 是 RADIO-ViPE 的特征来源——它们使得语义特征可以自然地嵌入 BA,并在 PCA 压缩到 $D=256$ 后仍保留 $\Delta mIoU<1\%$ 的性能(论文图 4)。
研究动机
现有 SLAM 系统无法同时满足机器人真实部署所需的全部能力。几何型 SLAM(ORB-SLAM3 [12]、RVWO [7]、Kimera [13]、SamSLAM [15]、RGBDS [14])虽然位姿估计精确但缺乏开放词汇语义;离线开放词汇方法(BBQ [16]、ConceptGraphs [17]、HOV-SG [18]、OpenScene [19]、OpenMask3D [20])虽然语义能力强但完全离线、依赖已知位姿和点云;实时开放词汇系统(CLIO [21]、OVO-SLAM [22]、RayFronts [23])不支持动态场景;前馈 SLAM(DUSt3R [11]、VGGT-SLAM [10]、MASt3R-SLAM [9]、ViPE [5])虽然免标定、免深度、免位姿初始化,但假设场景刚性、对动态物体脆弱。论文表 I 把这些维度(在线、语义、定位、构图、动态、免标定)并列展示,明确指出没有方法同时占据六个对勾,限制了真实机器人和野外视频流的应用。
本文的目标是RADIO-ViPE 旨在构建一个真正可部署的在线语义 SLAM 系统,统一三个长期被认为互斥的能力:实时开放词汇语义定位、鲁棒几何构图、对动态与准静态场景的抗干扰。具体输入只有未经标定的单目 RGB 视频流,不要求深度传感器、相机内参先验或初始位姿。系统以 8–10 FPS 运行,在 TUM-RGBD 动态序列上达到最佳平均 ATE(1.63 cm),并在 Replica 开放词汇语义分割上进入前三。
与已有工作不同的是,本文的独特切入角度是把视觉-语言-几何三类信号作为同一个因子图的紧耦合证据,而不是像现有方法那样先独立构图再融合语义、或只把语义当作下游可视化层。具体地:(1) 把 RADSeg/RADIO 密集语义特征嵌入 BA 公式 (7) 的嵌入残差项 $E_{\text{embed}}$,参与相机位姿、深度、内参的联合优化;(2) 提出时序稳定性场 $S_i(u)$,把单帧成对相似度在多边上聚合,从而区分静态、可移动、主动运动三类像素并映射到 Barron 损失的三种形态($\ell_2$/Huber/Cauchy);(3) 通过 GeoCalib 引导式初始化和滑动窗口因子图实现完全免标定在线运行。
核心方法
RADIO-ViPE 以 ViPE [5] 与 DROID-SLAM [25] 为骨架,将 RADSeg [6] 提供的高维视觉-语言特征作为额外观测项融入密集 BA,并设计时序一致的自适应核函数抑制动态像素。整体直觉是:传统 BA 用重投影光度残差约束几何,本文在此基础上新增「跨视图语义一致性」残差,让语义特征反向修正位姿和深度;同时用 $\ell_2$/Huber/Cauchy 三态核函数把「哪些像素不该参与优化」这一判断从硬阈值改为基于时序方差的软分类。技术路线分为八步——相机引导式标定、关键帧筛选、多模态特征提取、深度估计、语义增强的光流初始化、因子图 BA、非关键帧位姿回算、开放词汇语言定位——最终输出 RGB 视频对应的语义-几何一致 3D 地图。
核心创新体现在两层。第一层 BA 残差空间扩展:DROID-SLAM 仅用光流残差 (3),ViPE 只加深度正则 (13),RADIO-ViPE 在 $E_{\text{total}}=\gamma_{\text{photo}}E^{\text{ark}}_{\text{photo}}+\gamma_{\text{embed}}E_{\text{embed}}+E_{\text{reg}}$ 中引入嵌入残差 $r_{\text{embed}}(u)=\sqrt{\lambda_{\text{emb}}}\sqrt{2(1-c^s_{ij}(u))}$,让语义一致性反向驱动位姿估计。第二层动态处理从「掩码+硬剔除」转为「核函数形态自适应」:RVWO 仅靠几何核,SAM 类方法需 Grounding DINO/SAM 显式分割,而 RADIO-ViPE 通过公式 (8) 的时序稳定性场 $S_i(u)=\bar{c}^s_i(u)\cdot(1-\sigma^2_i(u))$ 自动把高方差/低均值像素拉低到 Cauchy 区,首次同时实现「紧耦合语义优化」与「数据驱动的软动态抑制」。
方法步骤详情
方法分八步:(1) GeoCalib [29] 估计 $K_q$,BA 中继续精化;(2) DROID-SLAM 密集光流估计相对运动,超阈值入因子图 $V$;(3) RADSeg 提取密集嵌入 $Z_i$,上采样 $(H/8,W/8)$ 后自注意力与 PCA 压到 $D=256$;(4) UniDepth/MoGe/Metric3D 估计 metric depth,转逆深度 $d_i(u)$,$8\times$ 下采样;(5) 按 (1) $\Omega_{\text{prior}}:=\beta\Omega_{\text{prior}}+(1-\beta)\Omega_{\text{sem}}$ 融合语义光流;(6) 按 (12) 联合优化 $\{T_i\}$、$\{d_i\}$、$\{K_q\}$,因子边由几何共视与 RADSeg 描述子共同连接;(7) 非关键帧与最近两关键帧建单向边,并行光度对齐回算位姿;(8) 3D 点 PCA 特征反投影到 SigLIP 潜空间,与文本查询余弦匹配输出 grounding。
技术新颖性
技术新颖性体现在三点。第一点是把 RADSeg 嵌入从「事后的 3D 语义层」前移到「BA 残差层」,使得语义一致性梯度 $\nabla E_{\text{embed}}\neq 0$ 直接驱动相机位姿和深度梯度更新,这是把 VLM 与 SLAM 紧耦合(而非松耦合)的关键设计。第二点是 Barron 损失 [8] 的 $\alpha$ 参数被提升为「逐像素时序统计量的函数」,通过公式 (9) 的分段线性映射实现 $\ell_2$/Huber/Cauchy 的连续可微切换,这是对 Barron 自适应核向动态 SLAM 的首次扩展。第三点是「语义增强光流」步骤 (5),通过公式 (1) 把语义先验加进 DROID-SLAM 的 correlation volume,缓解了纹理缺失区的光流估计失败。三者合并,使 RADIO-ViPE 在 TUM-RGBD fr3/w 序列(特别是 walking 强动态场景)相比 ViPE [5] 把 ATE 从 2.4/3.46/2.52 降到 1.55/3.39/1.96 cm。
实验结果
第一,TUM-RGBD 动态序列(表 II):RADIO-ViPE$_{\text{ark}}$ 八序列全进前三,平均 ATE 1.63 cm 最佳,优于 DynaMON 1.76 cm 与 ViPE (SAM) 2.17 cm;fr3/w/xyz(1.55 cm)、fr3/w/static(0.50 cm)、fr3/s/xyz(0.98 cm)等关键序列排名第一;纯嵌入残差版本 RADIO-ViPE 平均 1.90 cm 仍超所有不依赖深度监督的基线。第二,Replica 开放词汇分割(表 III):「无背景」mIoU 24.25 / f-mIoU 50.63 / Acc 59.25,「有背景」19.00 / 37.13 / 48.38;对比 RayFronts(在线但需深度位姿)39.37 / 62.03 / 68.80;用 GT 的 RADIO-ViPE$_\text{GT}$ 可达 29.51 / 52.24 / 59.80。PCA 维度消融(图 4)显示 $D=256$ 时 $\Delta mIoU<1\%$。
查看结构化数据
| 任务 | 指标 | 本文 | 基线 | 提升 |
|---|---|---|---|---|
| TUM-RGBD 动态 SLAM 定位(fr3/w/xyz) | ATE (cm, ↓) | 1.55 (RADIO-ViPE_ark) / 1.90 (RADIO-ViPE) | DynaMON 1.4 / DLD-SLAM 1.85 / V3D-SLAM 1.53 / ViPE (SAM) 2.4 | 相比 ViPE [5] 基线提升 0.85 cm,相对降幅 35%;在所有「无需深度监督」方法中排名第一 |
| TUM-RGBD 动态 SLAM 平均 ATE(8 序列) | ATE (cm, ↓) | 1.63 (RADIO-ViPE_ark) | DynaMON 1.76 / V3D-SLAM 2.10 / ViPE (SAM) 2.17 / DGS-SLAM 3.65 | 全类最佳,比最强动态 SLAM DynaMON 再降 0.13 cm(7%),比 ViPE 降 0.54 cm(25%) |
| Replica 开放词汇语义分割(无背景) | mIoU ↑ | 24.25 | RayFronts 39.37(需深度/位姿/标定) / Trident-3D 21.30 / ConceptFusion 21.07 | 在免标定/免深度/免位姿方法中领先;与离线 Trident-3D 相当,超过 ConceptFusion、ConceptGraphs、HOV-SG、NACLIP-3D |
| Replica 开放词汇语义分割(无背景) | f-mIoU ↑ | 50.63 | Trident-3D 43.34 / ConceptFusion 31.51 / NACLIP-3D 35.08 | 在「免标定/在线/无深度」全部约束下达到最佳 f-mIoU 50.63,超过所有离线基线 |
| PCA 特征维度消融 | Replica mIoU 差异 | $D=256$ 时 $\Delta mIoU<1\%$ | 全维度 RADSeg 嵌入 | 压缩 8× 以上(RADIO 原维度 $K\gg256$)性能损失 < 1%,验证特征紧凑性 |
局限与改进
作者在论文 IV-B 末尾明确承认:在 Replica 「有背景」设置下 mIoU 从 28.19(GT 变体)降到 19.00,结构类标签(墙、地板)的分割质量明显恶化,作者将其归为「当前局限」,认为几何/语义双重监督对结构类更友好。本文额外观察到三个限制:(1) 速度仅 8–10 FPS,对真正实时移动机器人仍偏慢,远端嵌入式部署需要进一步蒸馏;(2) RADSeg 与基础深度模型是逐关键帧调用,存储每帧 $H/8\times W/8\times 256$ 浮点特征在大场景下会成为瓶颈;(3) 公式 (8) 的时序稳定性场假设「足够多共视边」存在,对极端稀疏视角或长走廊场景可能退化为零,导致整段像素进入 Cauchy 区而被过度降权。
独立分析的弱点
独立分析有四个弱点及改进方向。第一,公式 (1) 中 $\beta$ 融合权重由光流置信度 vs 峰值语义相似度决定,在低纹理+低语义区分度同时存在的纯白墙面场景两个置信度都偏低,$\beta$ 数值不稳定;改进方向是引入基于方差的鲁棒 $\beta$ 估计 (如 $\beta=\sigma^2_{\text{sem}}/(\sigma^2_{\text{sem}}+\sigma^2_{\text{flow}})$)。第二,$E_{\text{embed}}$ 中 $\lambda_{\text{emb}}=2$ 是全局常数,但不同语义类别特征稳定性差异巨大(家具 vs 装饰品),可学习 $\lambda_{\text{emb}}(c)$。第三,自适应核 $\alpha_i(u)$ 公式 (9) 的阈值 $\theta_s=0.75$、$\theta_m=0.35$ 是手工设定,对高密度人流等未见场景可能失配,可改用数据驱动阈值学习。第四,PCA 投影在 BA 初始化后冻结,对光照/季节切换缺乏适应性,可换成在线字典学习。
未来方向
作者在结论中提到「适用于机器人、AR/VR、野外视频流」的多场景应用潜力,本文可延伸的方向有四个:(1) 与大语言模型对接,把 RADIO-ViPE 输出的 3D grounding 接到 LLM 任务规划,实现「告诉我厨房里有什么红色物品并把它们移到客厅」这类多步指令;(2) 把因子图扩展到多智能体协同 SLAM,不同机器人的相对位姿由 RADIO-ViPE 共享语义特征辅助闭环;(3) 蒸馏到端侧模型,目前 8–10 FPS 依赖 RTX 4090,可把 RADSeg 提取器+BA 求解器蒸馏成 Tiny 版本以适配边缘 GPU;(4) 引入神经辐射场(NeRF)或 3DGS 作为后端地图表示,用 RADIO-ViPE 的语义残差替代或辅助现有几何正则,提升开放词汇 3D 重建的语义一致性。
复现评估
可复现性中等偏上。RADIO [1]、RADSeg [6]、ViPE [5]、DROID-SLAM [25]、GeoCalib [29]、Barron 损失 [8]、SigLIP [31]、UniDepth/MoGe/Metric3D 等均开源,作者提供 Project Page(论文未给具体 GitHub URL)。硬件 Intel Xeon Gold 5320 CPU + RTX 4090,所有超参 $\lambda_{\text{emb}}=2$、$\alpha_{\text{disp}}=1.0$、$\theta_s=0.75$、$\theta_m=0.35$、$\theta=256$ 均明示。复现难点:(1) RADSeg/RADIO 嵌入维度 $K$ 未明确,需查对应论文;(2) Replica 评测需实现 RayFronts [23] 的 evaluation protocol;(3) $\beta$ 调度依赖「峰值语义相似度」实时计算,需参考 ViPE 代码。给定 RTX 4090 算力,约 2–3 周可完整复现。
论文图表
系统封面图,展示了从裸 RGB 视频(左上)经 RADIO-ViPE 处理后,输出带开放词汇语义标注的 3D 重建(右下),并在右上方演示了「pink chair」文本查询被定位到具体 3D 点云区域的过程。
这是论文 motivation 的核心可视化——证明系统能「端到端」地把任意自然语言接到 3D 几何地图,对应「动机」章节说明的「现有方法要么缺语义、要么不在线、要么不动态」的整合缺口。
把 ORB-SLAM3、RVWO、Kimera、SamSLAM、RGBDS、BBQ、ConceptGraphs、HOV-SG、OpenScene、OpenMask3D、CLIO、OVO-SLAM、RayFronts、VGGT、DUSt3R、ViPE、RADIO-ViPE 沿六个维度(在线、语义、定位、构图、动态、免标定)打对勾/叉,RADIO-ViPE 是唯一占据全部六列对勾的方法。
这是 motivation 章节的关键证据表——以一表之力说明「现有方法没有同时满足六个条件」,并把 RADIO-ViPE 定位为第一个填补全部缺口的工作。
8 个动态序列(fr3/w/xyz、fr3/w/rpy、fr3/w/hs、fr3/w/static、fr3/s/xyz、fr3/s/rpy、fr3/s/hs、fr3/s/static)上,DLD-SLAM、DynaSLAM、V3D-SLAM、DGS-SLAM、RoDyn-SLAM、DynaMON、ViPE (SAM)、RADIO-ViPE、RADIO-ViPE_ark 的逐序列 ATE(cm)与平均值;RADIO-ViPE_ark 平均 1.63 cm 最佳。
论文最具说服力的定量证据,对应 results 章节的核心声明——在 TUM-RGBD 动态基准上达到 SOTA。
无背景/有背景两种设置下,ConceptFusion、ConceptGraphs、HOV-SG、NACLIP-3D、Trident-3D、RayFronts、RADIO-ViPE_GT、RADIO-ViPE 的 mIoU、f-mIoU、Acc 三项指标;最右四列指示是否在线、免标定、免深度、免位姿。RADIO-ViPE 在「完全免标定」约束下进入前三。
开放词汇语义分割的核心定量证据,对应 results 章节的 Replica 评估,凸显 RADIO-ViPE 在最严约束下的竞争力。