精读笔记

Problem Setting

论文标题：UNSEEN: Uncertainty-aware Navigation via Sparse Estimation in Unknown Environments（arXiv preprint / 2026-06-23）。

这篇论文处理的不是一般意义上的 UAV exploration，也不是单纯 perception-aware trajectory optimization，而是更窄也更难的设定：未知静态环境中，机器人只有前向 RGB-D 相机，依赖 sparse visual SLAM 同时完成定位、构图和安全点到点导航。真正困难点在于，导航动作会主动改变下一时刻的视觉观测质量；而视觉估计误差又会改变地图、碰撞检查和后续轨迹选择。因此这里的核心问题是一个闭环耦合问题，而不是离线规划或已知地图下的 viewpoint selection。

以前方法通常卡在两个地方：一类方法把 SLAM 当成可靠位姿源，把 map 当成确定几何；另一类方法虽然 perception-aware，但通常只优化相机朝向或 feature count，不把 SLAM 后端的不确定性作为连续信息传到 occupancy 和 planner。UNSEEN 想解决的关键矛盾是：为了到达目标必须进入未知区域，但为了不丢定位又必须持续看见可靠视觉结构；这两个目标在低纹理环境中经常冲突。

Motivation

作者的核心观察是：sparse V-SLAM 并不只是产生 pose 和 landmarks，它还隐含地产生了决策上很有价值的 uncertainty structure；但 smoothing-based V-SLAM 为了效率和精度，通常在优化后不保留可用的边缘协方差，导致下游 planner 只能看到一个过度确定的稀疏点云或 occupancy map。

已有路线缺的不是某一个模块，而是缺一条可闭环使用的不确定性信息流。filtering-based SLAM 有协方差但扩展性差；smoothing-based SLAM 可扩展但常丢 uncertainty；dense mapping 可用于 collision checking 但通常假设 pose 准确；perception-aware planning 多数只最大化可见特征数量或信息增益，并不关心这些特征本身估计得是否可靠。UNSEEN 的动机就是把这些断裂处接起来：估计不确定性要进入地图，地图不确定性要影响规划，规划反过来要改善未来估计条件。

Core Idea

UNSEEN 的核心不是“视觉 SLAM + Octomap + RRT* + B-spline”这个组合，而是把 sparse estimation 的不确定性作为贯穿整个 autonomy stack 的状态变量。它改变的建模方式是：landmark 不再是点，pose/map 也不再是确定量；占据更新、可见性判断和轨迹优化都围绕“哪些区域/landmark 在当前估计下可靠、可见、可用于维持定位”展开。

这个 inductive bias 很明确：在视觉退化环境中，安全导航不应贪图最短路径或最快探索，而应倾向于让相机持续朝向低不确定、可重复观测的结构。它本质上把 perception quality 从一个后验评价指标变成规划约束和优化目标。相比 prior work，它更像是重新组织信息流，而不是发明全新 planner：uncertainty 从 SLAM 后端被提取，经 map probabilistic update 变成可查询的空间风险，再进入 receding-horizon planning 和 SE(3) trajectory optimization。

Method

方法层面最关键的是三种机制。

第一，UNSEEN-SLAM 从 bundle adjustment 的信息矩阵中提取 pose 和 landmark 的 marginal covariance，并把旧估计作为带协方差权重的 Tikhonov regularization 重新注入后端。这解决的是 smoothing-based SLAM 优化后 uncertainty 不可复用的问题。它带来的变化是：后端不只是输出最优估计，还输出下游可消费的置信结构。

第二，UNSEEN-MAP 将 landmark covariance 转换成 voxel occupancy update。每个 landmark 的影响不只落在一个 voxel，而是在协方差椭球内按高斯概率质量分布更新。这解决的是稀疏点云无法直接支持安全 collision checking、且传统 Octomap 假设测量点确定的问题。核心变化是把 sparse SLAM map 变成 probabilistic occupancy interface。

第三，UNSEEN-PLAN/OPT 用 receding horizon 把探索和定位维护耦合起来。全局 RRT* 可以乐观地穿过未知空间以指向目标，但随后通过 FoV truncation 把可执行段限制在已知自由空间，并要求轨迹上保持可见 textured/occupied structure；局部 smoothing 则在 SE(3) 上优化相机朝向和动态可行性。它解决的是全局探索的乐观性与局部安全执行之间的矛盾。

轨迹优化中的 Fisher-Bingham / projected covariance visibility cost 是方法中较有实质性的建模部分：它不只是看 landmark 数量，而是偏向看见低不确定 landmark。这个设计直接对应视觉 SLAM 的可观测性需求。

Key Insight / Why It Works

最可能真正有效的原因是：UNSEEN 把视觉导航中最脆弱的变量——可观测性——提前放进规划闭环，而不是等 SLAM 漂了以后再恢复。低纹理环境下，最短路径和最高探索增益往往会把机器人带到 feature-poor 或 motion-blur-prone 区域；UNSEEN 通过速度/角速度约束、FoV fixation、低不确定 landmark visibility，使轨迹天然偏保守、偏可观测。这比单纯 feature count 更合理，因为 landmark 的估计质量比数量更接近 SLAM conditioning。

核心贡献更可能在“uncertainty representation alignment”而不是某个单独算法：SLAM covariance、occupancy probability、visibility query、trajectory cost 都被对齐到同一个稀疏地图表示上。这种 alignment 让系统可以在低算力下闭环运行，而不需要 dense reconstruction 或多传感器融合。

但需要直接指出：部分增益可能主要来自 engineering 和 conservative motion，而不完全来自理论上的 uncertainty-aware optimality。比如 PAW 相比 PAG 的大幅提升，很可能同时来自更慢、更平滑、更持续看纹理目标，而不是仅仅来自协方差建模。APACE 对比中 UNSEEN 的优势也部分来自 submap query / scaling 设计，不能简单归因于更好的 perception objective。

另一个关键点是，方法并没有真正解决“无纹理障碍”的感知问题。它依赖可见 textured objects 来 carve free space 和维持定位；对于不可见、低纹理但真实存在的障碍，系统仍然只能把它们留作 unknown，并通过保守截断避免进入。这是合理工程策略，但不是对视觉不可观测性的根本突破。

Relation To Prior Work

UNSEEN 位于 sparse visual SLAM、uncertainty-aware exploration、perception-aware trajectory optimization 三条线的交叉处。它和 ORB-SLAM3 / OKVIS / Kimera 的关系是：继承 smoothing-based sparse estimation 的效率，但试图恢复 filtering 系方法中更自然的 uncertainty propagation。真正不同点不是 SLAM 精度更高，而是 SLAM 输出被设计成 planner 可用的 belief representation。

和 FUEL/FALCON 等 exploration planner 相比，UNSEEN 不追求快速覆盖未知空间，而是 exploratory point-to-point：只探索到达目标所需区域，并把 localization robustness 放进路径选择。和 Papachristos 类 belief-space exploration 相比，它更轻量、更 sparse、更工程可部署，但理论上也更近似。

和 APACE、PANTHER、Murali/Bartolomei 等 perception-aware trajectory optimization 相比，UNSEEN 的实质差异是地图未知且估计在环，而且 visibility cost 不只是 landmark count 或 FoV constraint，而是带 landmark uncertainty 和 occlusion query。看似新的部分中，RRT*、Octomap、safe corridor、B-spline、SE(3) optimization 都是已有思想重组；较实质的新意在于把 sparse BA covariance 通过 probabilistic occupancy map 接到 perception-aware receding-horizon planner。

Dataset / Evaluation

评估覆盖了三个层面：SLAM 单独对比、规划/优化仿真对比、完整真机闭环。真机实验是这篇论文最有价值的证据，因为它确实展示了在受控但视觉困难的未知环境中，仅用 RGB-D 相机和 sparse map 可以完成闭环导航，而且不是纯离线 benchmark。

不过 evaluation 对核心 claim 的支撑并不完全充分。SLAM 对 ORB-SLAM3 的提升幅度有限，且旋转误差略变差，说明 covariance regularization 的估计收益不是压倒性的。规划与 APACE 的比较是在已知地图、无探索、ground-truth pose 的简化设定下做的，更强地验证了计算可扩展性和 submap strategy，而不是完整验证 unknown-environment uncertainty-aware planning。

完整 pipeline 的 10 次真机成功很重要，但场景规模较小、环境人为构造、纹理区域通过 AprilTag 图案引入，且无人机外部通过 motion capture 做 evaluation 与安全边界约束。论文没有充分展示跨户外、强光照变化、动态障碍、长距离回环失败等条件。因此它证明的是“在小规模弱纹理室内场景中该系统可工作”，而不是广义 unknown visual navigation 已被解决。

Limitation

最核心限制是方法依赖 uncertainty 可校准。BA 中提取的 marginal covariance 是否真实反映视觉失败风险，文中未充分说明；视觉 SLAM 的协方差常常低估系统性误差，尤其在重复纹理、错误匹配、深度噪声、rolling shutter 或光照变化下。若 covariance 与真实误差脱钩，下游 map 和 planner 会继承错误信心。

第二，安全性实际上是通过保守策略获得的：只在已知自由空间内执行、FoV truncation、不进入未验证区域、限制速度和角速度。这很有效，但也意味着效率和可达性受限。复杂环境中如果可靠纹理不在通向目标的方向上，planner 可能反复停滞或选择过度绕行。

第三，稀疏地图的上限明显。它适合“有少量可靠视觉结构即可定位和避障”的场景，但不适合需要精细几何理解的狭窄、透明、反光、纯色障碍环境。低纹理障碍如果不能产生 landmark 或有效深度结构，系统只能把问题转移给 unknown-space avoidance，而不是识别它。

第四，增益归因不清。UNSEEN 的成功来自 covariance-aware SLAM、probabilistic occupancy、FoV constraints、速度保守化、submap scaling、piecewise smoothing 的组合，论文没有充分消融这些因素。尤其 PAW/PAG 对比中，改进可能主要来自轨迹更慢、更面向纹理，而不是不确定性建模本身。

第五，scalability 仍有隐含上限。协方差提取异步执行且比 BA 慢一个数量级；虽然通过 Schur 结构和局部子图降低成本，但长时、大规模、多回环场景下，旧 covariance 的一致性、map reoptimization、loop closure 后的不确定性传播都没有完全解决。

Takeaway

• 最值得记住的不是某个 planner，而是：sparse SLAM 的 uncertainty 可以被重新包装成导航可用的 representation，而不必走 dense mapping 或多传感器路线。
• 这篇论文推动的方向是 representation alignment：估计、地图、规划共享同一套带置信度的稀疏结构。
• 未来更有价值的问题不是再加一个 cost term，而是让 covariance calibration、semantic/geometric uncertainty、visibility prediction 在同一个 belief map 中一致工作。
• 可迁移的 insight 是：在感知受动作影响的任务中，planner 应该优化未来 estimator conditioning，而不是只优化路径代价。

一句话总结

UNSEEN 是一篇把 sparse visual SLAM 的边缘不确定性转化为地图和规划闭环信号的系统型工作，实质贡献在于 uncertainty representation alignment，而不是单个模块算法突破。