机器人 / SLAM / 控制 / AI Coding 技术深度简报|2026-09-01

摘要

截至 2026-09-01 早间,arXiv Robotics 的最新公开列表仍是 2026-08-31 批次,共 53 条,其中 26 条为 new submissions;Software Engineering 同日共 33 条,其中 17 条为 new submissions(Robotics 列表Software Engineering 列表)。严格最近 24 小时内,高质量、可完整核验且未进入历史覆盖索引的候选不足 5 条,因此本期按任务规范扩展到最近 7 天。最终 8 条主动态的 v1 均提交于 8 月 27–28 日 UTC,全部明确作为“时间回补”。

今天 SLAM 侧最值得看的不是又一个短数据集上的 SOTA,而是一篇长达一年的野外负结果报告。One year in a forest 在亚寒带针叶林累计评估 64 km 数据、9 种里程计/定位/建图方法。结果显示,季节变化、自相似林地和高雪墙会显著放大系统脆弱性;复杂 SLAM 相比本体感知基线带来的精度增益有限,却明显提高失败概率。跨季节地图定位中,LiDAR 管线能完成跨季节定位,而雷达和视觉由于可匹配特征不足,甚至同季节也会出现失败(论文)。这比一组平均 ATE 更接近长期巡检机器人真正需要回答的问题:系统能不能经历一整年仍然工作。

控制侧有两条互补路线。Distributed Model-Based Diffusion 将 sampling MPC 扩展到带通信延迟的多智能体系统,针对高非线性、非凸、非光滑任务给出有限时域收缩与 bounded-delay 鲁棒性分析;即便加入通信延迟,相对集中式 Model-Based Diffusion,circle-swap makespan 改善 31%,空战任务胜率提高 25%(论文)。Contact-Guided Exploration 则处理另一种困难:移动操作中的有效接触太稀疏,普通 PPO 往往在真正碰到物体前就陷入“什么也不做”的局部最优。它增加一个专门的 contact-seeking critic,早期把末端引向通用抓取器给出的候选接触点,随后逐步衰减该 critic,让最终策略重新回到任务最优目标;并在真实四足移动操作机器人上完成椅子运输验证(论文项目页)。

工业机器人安全规划方面,PanelShield 很值得注意。它不把设备说明书只作为大模型上下文,而是从说明书证据生成参数化动作原语序列,再同时用 LTL 与 Safety FSM 检查跨步骤时序正确性和局部状态转移合法性。发现违规时,不只是给出一个失败分数,而是返回“最早违规步骤 + 原因”的结构化 counterexample,再进入 repair → re-verify。三个工业面板 benchmark 中,违规率降到 2.7%,总规划/验证延迟约 4.1 s,并完成真实机器人实验(论文)。

长期语义导航方面,STEGNav 不再把 scene graph 仅仅当成当前对象状态仓库,而是增加时空事件层:空间轴同时维护 query-conditioned instance 和 occupancy-aware exploration frontier,时间轴保留最近决策—轨迹事件以及跨子任务已经验证的结果。它是 training-free 方案,在 GOAT-Bench 达到 66.3% SR / 39.7 SPL,在 HM3Dv1/v2 达到 64.0% / 69.4% SR(论文)。这一设计非常适合长期巡检:机器人真正需要记住的不只是“这里有什么”,还包括“上一次为什么选择这条路、哪个对象已经验证过、哪些探索前沿已经失败”。

VLA 侧本期选择 VLAct,因为它提供了一个比“继续堆机器人数据”更值得中小团队复制的方向:先把 VLM backbone 训练成更适合物理动作的表示,再针对不同机器人挂新的 action head。其 continued pre-training 保留 VLM 先验,同时使用多种连续动作头共同监督,并只在物理意义一致的维度上部分统一跨本体 action layout。LIBERO-Plus 和 RoboTwin 2.0 分别达到 82.6% 与 92.5%;在 continued pre-training 阶段完全没见过的 GR-1 本体上,只使用 RoboCasa-GR1 20% 下游轨迹即可超过论文列出的完整数据 GR00T-N1.6 基线。全部模型、训练流程和权重已经公开(论文项目页)。

AI Coding 侧,本期两条工作共同说明“Coding Agent 底模”和“长期执行控制器”正在被拆成两个独立研究对象。LoopArena 固定 Worker,只评估另一个 Controller 如何在每一轮编码后读取结构化摘要、决定下一步应该继续、验证还是停止。最好的 full-task Strict Success Rate 只有 24.69%,但不同 Controller 平均可减少 64.4% 的推理成本,说明 loop orchestration 本身已经足以显著改变结果(论文代码)。openJiuwen 则从框架层解决相同问题:用共享 execution substrate 和 Rail 组合单 Agent、delegated sub-agent 与 Swarm Flow,并让执行过程中产生的新诊断、测试结果和任务进度动态改变 context、feedback 与控制流。在 SWE-bench Verified / Terminal-Bench 2.1 上分别报告 82.6% / 87.19%(论文开源组织)。

本轮也核验了主流模型厂商近期官方入口。OpenAI 当前 GPT-5.6 旗舰系列仍是 7 月发布、8 月有定价更新;Anthropic 当前主力 Sonnet 5 为 6 月 30 日发布,没有发现 8 月 31 日或 9 月 1 日需要挤掉上述机器人/控制工作的全新旗舰模型正式发布(OpenAI GPT-5.6Claude Sonnet 5)。

1. 一年森林实测:长期 SLAM 的主要敌人可能不是平均误差,而是环境分布持续改变

时间回补:论文 v1 提交于 2026-08-27 19:10 UTC。论文

为什么重要

很多 SLAM 论文在数分钟到数小时、单一季节和固定路线中比较 ATE/RPE。长期巡检却面对完全不同的问题:同一条路线冬天被雪墙重塑,植被季节变化改变视觉外观,林地又具有高度自相似性;GNSS 和云端计算在树冠遮挡与偏远区域也不可靠。

这篇工作最大的价值在于把“跨季节持续运行”变成主要评测对象,而不是附录实验。作者用一台移动机器人进行一年部署,累计 64 km 数据,对 9 种 odometry、localization 和 mapping 方法做系统比较。

算法与传感器观察

论文同时考察 camera、LiDAR、radar 与 proprioception 管线,并将误差与可用特征、confidence weight 分布联系起来。几个结论特别值得工程团队记录:

  • 视觉 SLAM 对季节变化最敏感;
  • 自相似森林与高雪墙会让高复杂度 SLAM 更脆弱;
  • 跨季节 prior-map localization 中,LiDAR 方法能够完成定位,而视觉和 radar 会因为匹配特征过少而失败;
  • 更复杂的 SLAM 并没有在所有条件下显著优于简单本体感知基线,反而增加了系统故障面。

实时性与鲁棒性

这篇工作的重点不是某个模型的 FPS,而是全年任务完成率和跨季节稳定性。对于长期部署,平均计算延迟之外,更应该记录:

连续定位时长
重定位成功率
跨季节地图复用率
失配后的恢复时间
每公里人工干预次数
按季节/天气分桶的漂移

这些指标往往比单次 benchmark 的厘米级 ATE 更能决定是否适合客户现场。

工程风险

不能从这篇论文得出“LiDAR 在森林里永远优于视觉/雷达”。LiDAR 同样会受到植被运动、雪、雨雾和几何重复影响;这里只能说,在作者的跨季节定位实验里,它表现出更强的可复用性。

更大的系统风险是地图本身具有生命周期。长期地图如果永远当成静态真值,季节变化最终会让任何匹配器都变成在错误分布上工作。

适合谁关注

森林、矿区、露天场站、跨季节户外巡检、长期 Teach-and-Repeat,以及需要评估“地图究竟能用多久”的团队。

工程落地启发

长期地图建议从单一版本升级为:

base geometry
+ seasonal submap / appearance
+ map age
+ observation support
+ last successful localization
+ invalidation / refresh policy

同时保留一个简单独立的 wheel/IMU/proprioception baseline。复杂 SLAM 一旦异常,可以立刻判断到底是环境不可观、地图过期,还是算法本身出了问题。

2. Distributed Model-Based Diffusion:让多智能体 Sampling MPC 在通信延迟下仍有可分析结构

时间回补:论文 v1 提交于 2026-08-27 20:16 UTC。论文

为什么重要

多无人机、多车协同规划往往在两个极端之间摇摆:集中式优化可以看到全局,但维度和通信压力快速增长;完全去中心化又容易因为邻居信息过期而产生不一致。

这项工作研究 Distributed Model-Based Diffusion,将 sampling-based MPC 分解到多个 Agent 上,并直接把 bounded communication delay 纳入分析,而不是默认所有状态同步到达。

算法模块

Model-Based Diffusion 的核心仍然是对候选控制序列进行模型 rollout、按照代价对样本逐步重加权/收缩。分布式版本让各 Agent 在本地维护自己的优化变量,同时用延迟到达的邻居信息处理耦合约束与协作目标。

论文重点给出两个理论结果:

  • finite-horizon contraction:有限时域更新会向更优分布收缩;
  • bounded-delay robustness:在通信延迟受限时,分布式更新仍保持可控的偏差与稳定性质。

动力学与系统假设

它适合非线性、非凸、甚至非光滑 multi-agent cost,但这不意味着通信可以无限差。理论成立依赖 delay bound;真实网络里还会出现 packet loss、乱序、时钟偏差和整段断联,这些都必须由 runtime 另外处理。

实时性与结果

作者在 circle-swap、medium-fidelity cooperative driving 和 aerial combat 三类任务验证。即便引入通信延迟,相比 centralized Model-Based Diffusion:circle-swap makespan 改善 31%,空战胜率提高 25%。

公开摘要没有给出一个可以跨硬件搬用的固定控制 Hz,因此工程复现应重点测:

P50 / P95 / P99 solve time
neighbor-state age
packet-loss rate
constraint violation
communication bytes / cycle

鲁棒性与风险

Sampling MPC 的硬伤依旧存在:模型误差、采样分布和代价设计会直接决定结果。延迟鲁棒性也不是安全认证;如果邻机状态太旧,碰撞安全仍需要更低层的 local avoidance / CBF / emergency separation。

适合谁关注

多无人机、高速协同、异构 AMR、分布式 MPC,以及希望减少中心调度器实时负担的团队。

工程落地启发

比较稳妥的产品结构是:

低频中心:任务 / 拓扑 / 冲突优先级
          ↓
中频分布式 Sampling MPC
          ↓
高频单机 Collision / CBF / Servo

中心网络断联时,单机仍能保持安全;恢复通信后再重新进入协同最优。

3. Contact-Guided Exploration:非抓取移动操作的第一难题,是先学会“怎么碰到东西”

时间回补:论文 v1 提交于 2026-08-28 10:00 UTC;已被 IEEE RA-L 接收。论文项目页

为什么重要

推箱子、推椅子、开洗碗机等 non-prehensile manipulation 的奖励高度稀疏。机器人没有建立有效单侧接触以前,任务奖励长期为零;同时 smoothness 和 energy penalty 已经存在,普通 PPO 很容易学会一个“站着不动最安全”的局部最优。

算法模块

作者加入一个独立 exploration critic:

Task Critic
     +
Contact-Seeking Critic
     ↓
Multi-Critic Policy Update

Contact critic 使用 dense contact-seeking reward,把末端引向有意义的候选接触点。候选点不依赖每个任务手工标注,而来自通用 grasping algorithm。随着策略已经学会稳定建立接触,exploration critic 的影响逐渐衰减,最终 objective 回到真正的 task reward。

动力学与接触假设

这是典型 hybrid dynamics:机器人未接触、刚接触、滑动/旋转物体时的动力学完全不同。接触点只是“值得探索的位置”,并不保证最终推力方向、摩擦锥和整机姿态一定可行。

因此产品化仍需要底层 whole-body controller、碰撞限制和关节/扭矩约束。

实时性与实机

论文评估 box pushing、chair transportation 和 dishwasher opening,并在 ALMA 四足移动操作平台上对 chair transport 做大量真机验证,包含不同物体几何和质量。项目页已经公开真实视频,但当前公开材料并未给出一个适合直接引用的统一高频控制周期。

鲁棒性与风险

最大的风险是 exploration bias 本身。如果候选接触点来自视觉抓取器,而目标物体形状、遮挡或摩擦极端异常,策略会被引向“视觉上像接触点、物理上没有用”的区域。

探索 critic 必须真正衰减;否则最终策略会长期为了“接触得漂亮”牺牲任务效率。

适合谁关注

轮足移动操作、重物推移、柜门/抽屉/门体操作、无抓取点的大件搬运,以及 RL 接触任务长期学不起来的团队。

工程落地启发

可把 contact establishment 独立成 reusable prior:

视觉/点云候选接触区
       ↓
Contact Acquisition Policy
       ↓
Task-Specific Manipulation Policy

这样不同任务共享“如何安全建立接触”,后续任务只学习“接触以后怎么完成目标”。

4. PanelShield:工业机器人安全规则不能只留在 Prompt 里

时间回补:论文 v1 提交于 2026-08-28 13:10 UTC。论文

为什么重要

工业面板、开关柜、控制台操作通常同时包含设备说明书、操作顺序、互锁关系和局部安全状态。如果仅让 Foundation Model 阅读说明书后自由生成动作,模型很难保证跨 10–20 个步骤一直遵守所有规则。

PanelShield 的核心转变是:说明书既提供语义知识,也要被编译成可计算、可定位、可复现的约束

算法模块

系统先从 task-relevant manual evidence 生成参数化 action primitive sequence,然后进入双重形式验证:

Manual Evidence
      ↓
Parameterized Action Primitives
      ↓
LTL:跨步骤时序约束
      +
Safety FSM:局部状态转移
      ↓
Pass → Execute
Fail → Counterexample → Repair → Re-verify

LTL 负责诸如“必须先 A 后 B”“某条件未满足前禁止执行 C”;Safety FSM 负责局部面板状态是否允许当前 transition。

实时性与结果

作者建立覆盖 3 种代表性工业设备面板的多层级长时规划 benchmark,并进行 simulation + real robot 实验。违规率降至 2.7%,端到端规划与验证总延迟约 4.1 s。

这显然不是 100 Hz 控制器,而是秒级高层任务规划层;底层运动控制仍应独立运行。

鲁棒性与风险

形式验证只能验证“被编码进模型的规则”。如果说明书抽取漏掉关键条款、面板状态检测错误,LTL/FSM 会非常严格地验证一个不完整世界。

因此必须保存 rule provenance:每个约束来自说明书哪一页、哪个版本、哪条设备型号规则。

适合谁关注

开关柜、设备面板、巡检操作、PLC/机器人协同、危险工艺操作,以及使用 LLM 生成 SOP/任务规划的团队。

工程落地启发

建议逐步把企业 SOP 从 Markdown 迁成:

动作原语
前置条件
后置条件
互锁条件
时序规则
恢复规则
来源文档版本

LLM 负责提出计划,但 Validator 必须能对每一步说出“为什么允许执行”。

5. STEGNav:长期导航需要记“事件”,不只是记“物体”

时间回补:论文 v1 提交于 2026-08-28 12:42 UTC。论文

为什么重要

多目标 lifelong navigation 中,连续任务可能分别用类别、语言描述或参考图像指定目标。传统 scene graph 主要保存 object/state,很难回答:

  • 这个相似对象上一次已经验证过是不是目标?
  • 哪个 frontier 上一轮已经探索失败?
  • 某条路线为什么被放弃?
  • 前一个子任务获得的经验能否直接帮助下一任务?

算法模块

STEGNav 把 scene graph 扩展成 spatio-temporal event graph。

空间轴:query-conditioned instance grounding,同时把 semantic targets 和 occupancy-aware exploration frontiers 放进同一图中。Frontier 不只有坐标,还带 reachability、path cost 和 exploration utility。

时间轴:trajectory-aware dual-window memory,一部分保留近期 decision–trajectory event,另一部分保留已经验证的跨子任务 outcome。

最后 VLM 在这张图上选择:去某个目标实例,或者去某个 exploration frontier。

传感器与导航假设

该方法是 training-free 高层导航框架,并不取代底层 SLAM、occupancy mapping 和 local planner。Graph 中的“对象存在”“frontier 可达”仍然依赖感知与几何地图正确。

因此更适合放在现有导航栈上层,而不是把 VLM 直接接到底盘速度。

结果

GOAT-Bench 达到 66.3% SR / 39.7 SPL;HM3Dv1、HM3Dv2 的 SR 分别为 64.0% 和 69.4%。消融显示空间事件结构和时间事件记忆具有互补收益。

风险

长期 memory 最容易发生的不是“忘了”,而是错误经验永久化。一次错误 object grounding 如果被写成 verified outcome,之后多个子任务都会继承错误。

因此长期 memory 应区分:观察、推断、验证三种状态,不应所有 VLM 结论都直接进入长期事实库。

适合谁关注

跨楼层巡检、连续多目标导航、语义地图、长期 VLM navigation、需要多任务复用经验的机器人。

工程落地启发

可以给现有导航系统增加一个很轻的 event ledger:

timestamp
goal_query
target_candidate
visited_frontier
path_result
verified / rejected
failure_reason

先让历史任务经验可查询,再考虑更复杂的 graph reasoning。

6. VLAct:VLA 的下一条 Scaling 轴可能不是“更多轨迹”,而是更好的动作表示骨干

时间回补:论文 v1 提交于 2026-08-27 17:59 UTC;模型、训练流程与权重已公开。论文项目页

为什么重要

机器人轨迹不像互联网图文数据那样可以低成本抓取。只要数据规模受限,就必须问:同样一条轨迹能不能让 backbone 学到更可迁移的视觉—动作结构?

VLAct 的目标不是提前训练一个永远固定的 action decoder,而是训练适合动作学习的 VLM backbone,以后换机器人、换任务、换 action head 仍能复用。

算法模块

其 continued pre-training 有三条非常值得复制的原则。

Preserve:保留 VLM prior。训练时冻结视觉 encoder 和较低层 LLM,并继续使用 caption supervision,避免机器人动作数据把原有视觉语义能力洗掉。

Diversify:同一个 backbone 同时接受 OFT、PI、GR00T 等多种连续动作头监督。预训练 action heads 最终会被丢弃,真正 downstream 再挂新的 task-specific head。

Unify:跨本体 action 只在物理含义一致的坐标上共享;本体专属维度保持分离,无效维度 mask,周期关节使用 wrap-aware loss。

数据、结果与计算量

LIBERO-Plus 达到 82.6%,RoboTwin 2.0 达到 92.5%。在 continued pre-training 中从未出现的 GR-1 本体上,只使用 20% RoboCasa-GR1 下游轨迹即可达到 49.5%,超过项目页列出的 GR00T-N1.6 100% 数据 47.6% 基线。

continued pre-training 使用公开数据、16 张 GPU;项目页公开 backbone、多个 fine-tuned checkpoint、训练框架和数据准备脚本。

真实机器人与工程假设

项目还在真实 Franka 单臂/双臂上测试,使用固定 D435 与腕部 D405;单臂任务每项 50 demonstrations,双臂每项 100 demonstrations。

需要注意:所谓跨本体共享并不意味着动力学、关节极限和执行器都相同。统一表示是数据接口,不是低层控制器替代品。

风险

共享 action semantics 如果做得过度,会把不同本体硬塞进错误统一空间;做得过少,又退化成每台机器人各训一套。真正关键是定义稳定的 canonical physical semantics。

适合谁关注

VLA 基础模型、跨本体数据平台、需要不断更换机械臂/夹爪的团队,以及机器人数据预算有限但希望长期积累可复用表示的团队。

工程落地启发

内部数据建议同时保留:

raw joint action
canonical EE / base motion
embodiment id
inactive-mask
periodic-joint metadata
contact / task phase

以后换 action head 或本体时,历史数据才不会完全锁死在某一套 SDK 向量里。

7. LoopArena:Coding Agent 以后不只要 Benchmark Worker,还要 Benchmark“谁在指挥 Worker”

时间回补:论文 v1 提交于 2026-08-28 12:44 UTC;代码与 benchmark 已公开。论文代码

突破性工程价值

实际 Coding Agent 工作流越来越像一个 loop:读进度、分配工作、跑检查、判断继续还是停止。即使 Worker 很强,Controller 也可能因为读了过期摘要、跳过验证、预算分配错误或过早停止而失败。

过去只看最终 SWE-bench 是否通过,很难区分到底是 Worker 能力不够,还是 loop controller 指挥错了。

Benchmark 结构

LoopArena 固定 Worker,把待评估模型定义为 Controller:每个 coding round 结束后,Controller 读取结构化运行摘要,输出下一步应该做什么、验证什么,或者是否应该停止。

它设计三个层级:

  • Type I:不真正运行 Worker,只评估 next-step Loop Contract;
  • Type II:在一段受限任务切片上反复控制;
  • Type III:从完整初始状态执行整个配对任务。

结果与成本

full-task 最佳 Strict Success Rate 只有 24.69%,说明长期 orchestration 仍远未解决;但跨 Controller,配对实验的估计推理成本平均下降 64.4%。Type II Core 排序与完整 Type III 排序的 Spearman 相关达到 0.9747,说明可以用更便宜的中型实验先筛 Controller。

可复现性

公开仓库提供固定 case index、Docker image identity 检查、外部 source revision pinning、运行 token/evidence/terminal evaluator receipt 记录,并明确把 provider/runner/container/evaluator 基础设施故障与模型结果分开。

这类“评测 harness 本身可审计”的设计非常适合企业 Agent。

权限、安全风险

Controller 只应该决定“建议下一步”,不应该因为它说“测试通过了”就提升权限。真正的 git SHA、测试 exit code 和部署授权必须来自独立工具证据。

适合谁关注

Codex/Claude Code/OpenHands 类长期 Agent、多 Agent 编排、内部 Coding Agent 平台和成本优化团队。

工程落地启发

建议把 Worker 和 Controller 的指标拆开:

Worker capability
Controller decision accuracy
verification completeness
stale-state rate
stop-too-early rate
token / cost

如果只看最后成功率,很难知道究竟该升级底模还是修 harness。

8. openJiuwen:长期 Coding Agent 的 Harness 开始从静态脚本走向“运行时自适应系统”

时间回补:论文 v1 提交于 2026-08-28 06:31 UTC;框架已开源。论文GitHub

突破性工程价值

长时 Coding Agent 的 repository state、诊断证据、任务进度和上下文相关性一直在变化。如果 harness 仍是一套固定 prompt + 固定工具顺序,底模再强也会不断拿到过时上下文。

openJiuwen 把问题拆成两个轴:

  • Structural Composability:如何在同一执行语义下组合单 Agent、sub-agent 和 Swarm;
  • Runtime Adaptivity:如何让新产生的 evidence 动态改变后续 context、feedback 与 task control。

系统结构

框架提供 shared execution substrate,并以 Rail 组合能力;同一底层 runtime 可以承载单 Agent、delegated sub-agent、Swarm Flow。执行过程中,测试结果、语义诊断、任务进度等被当成结构化 evidence,影响后续控制流,而不是只被追加进聊天上下文。

其开源生态还包含 agent-core、agent-studio、distributed runtime、memory、skill hub 等组件,适合把“Agent 会话”向“长期运行服务”迁移。

结果

论文在 SWE-bench Verified 报告 82.6%,Terminal-Bench 2.1 报告 87.19%,分别高于作者选择的官方 leaderboard 强点估计 3.4 和 3.39 个百分点。

这些数字不能简单跨 harness 横向比较,但至少说明:在固定底模之外,runtime execution semantics 与 evidence routing 能产生实际性能差异。

是否适合真实研发流程

对企业内部平台,最值得关注的是 runtime、state persistence、interrupt/recovery、multi-tenant isolation、tool/skill composition,而不是为了“多 Agent”而多 Agent。

真正生产化仍需要独立 IAM、sandbox、secret manager、网络策略、审计和不可逆操作审批;Agent framework 自身不能成为权限最终来源。

工程风险

Harness 越动态,可观测性要求越高。必须记录:

repo revision
active rail / flow
context sources
tool calls
sub-agent ownership
state transitions
verification evidence
final authorization

否则运行时自适应会变成难以复现的“黑盒工作流漂移”。

适合谁关注

企业内部 Coding Agent、自建智能体平台、长期任务、多 Agent 工作流、需要 Java/Python 双生态和分布式运行时的团队。

工程落地启发

不要先追求几十个角色。先构建一个统一的 execution substrate,让所有 Agent 都消费同一种 artifact、revision 和 verifier receipt;当单 Agent 状态管理可靠以后,再引入 delegated/sub-agent 协作。

经典论文回顾

Voxelized GICP:为什么现代 LiDAR 配准越来越喜欢“把局部高斯统计直接放进 Voxel”

发表时间与历史位置: Kenji Koide 等人的 Voxelized GICP for Fast and Accurate 3D Point Cloud Registration 最早于 2020 年公开,发表于 ICRA 2021(DOI)。官方实现长期维护在 fast_gicp,后续更现代的轻量实现是 small_gicp

核心问题

Generalized ICP 已经比普通 point-to-point ICP 更充分利用局部几何:每个点都带局部 covariance,匹配残差会同时考虑 source 和 target 的表面不确定性。

问题是经典 GICP 仍然依赖大量 nearest-neighbor correspondence 查询。LiDAR 一旦达到十几万点、高频 scan-to-map,kNN 往往变成主要成本之一。

VGICP 的问题可以概括成:

能不能保留 GICP 的局部高斯几何,又避免每次都做昂贵逐点最近邻?

关键数学思想

VGICP 将 target map 划为 voxel,并把 voxel 内多个点的 Gaussian distribution 聚合起来。Source point 进入某个 voxel 后,可以直接与该 voxel 的分布形成 GICP 风格残差,而不是先去找一个离散最近邻点。

这与 NDT 有相似的“voxel statistics”外观,但数学语义不同:NDT 更接近直接从 voxel 中所有位置估计一个空间概率分布;VGICP 保留并聚合每个点局部表面 covariance,因此能更好继承 GICP 对局部平面结构的描述。

原始工作强调,这种聚合在 voxel 内点数较少时也更加稳定,而且对 voxel resolution 没有 NDT 那么敏感。

实时性

原始论文报告约 30 Hz CPU / 120 Hz GPU 的配准速度,同时保持与 GICP 接近的精度。fast_gicp README 给出的典型实现速度也显示 FastVGICP 明显快于传统 GICP;后续 small_gicp 又将数据结构与并行实现进一步简化,官方说明部分场景可达到 fast_gicp 的约 2 倍速度。

这些数字都依赖点数、CPU/GPU 和参数,不能直接当作自己的机器人板卡 FPS;真正应测的是完整 deskew → map query → linearize → solve → map update 的 P95/P99。

传感器与几何假设

VGICP 仍然是局部 registration

  • 需要合理初值;
  • 需要足够 overlap;
  • 假设主要场景静态;
  • voxel 内 covariance 必须具有足够样本与合理正则化;
  • 长走廊、大平面中的真实不可观方向不会因为“换成 voxel”就自动出现信息。

特别要注意 covariance regularization。最近的一些退化研究已经指出,过强正则化会让 Hessian 看起来比真实几何更“健康”。所以 VGICP 的高数值稳定性不能被误读为物理可观测性也很好。

当年为什么重要

它把“GICP 精度”和“voxel map 查询效率”真正结合起来,使 GICP 风格 registration 更适合实时 LiDAR odometry 和 scan-to-map,而不只是离线点云配准。

后来的 GPU VGICP、FastGICP、small_gicp、各种 voxel Gaussian map、surfel/voxel LIO 都沿用了一个共同思想:

地图应该预先保存局部几何统计,定位时直接消费这些统计,而不是每帧重新从原始点云计算一遍。

今天仍在使用的思想

  1. 地图表示和残差模型要协同设计。 如果 residual 需要 normal/covariance,地图就应长期保存它们。
  2. 查询成本和优化成本同样重要。 实时系统不应只盯 Gauss-Newton 迭代次数。
  3. Voxel 是计算预算与几何分辨率之间的显式旋钮。
  4. Point support / covariance quality 应成为地图属性。 低线数 LiDAR 尤其需要知道一个 voxel 的统计到底来自多少真实观测。

已被后续扩展的部分

现代 LIO 已加入 IMU propagation、point-wise deskew、continuous-time motion、dynamic filtering、GPU hash、增量 voxel、degeneracy-aware weighting 和多传感器因子图。

因此 VGICP 不应该被理解成一整套完整 SLAM,而是一个非常强的局部几何 registration / map representation 基础件。

公开代码与可复现性

fast_gicp 使用 BSD-3-Clause 许可证,提供 FastGICP、FastVGICP 和 CUDA 版本;small_gicp 则采用更轻量、现代的 header-oriented C++ 设计,适合直接做工程基线。

对当前低线数 / 多 LiDAR 工程的重新解读

对 16 线 + MID360 或多 LiDAR 系统,更合理的 VGICP 使用方式不是一开始把所有点拼成一帧:

各 LiDAR 独立时间同步 / 去畸变
          ↓
短时间窗口聚合
          ↓
Voxel Gaussian Map
position / normal / covariance
support_count / sensor_source / age
          ↓
VGICP / Hybrid Residual
          ↓
Localizability / Weak Direction
          ↓
IMU / Wheel / RTK / Reflector
补弱方向

对 16 线 LiDAR,短时间聚合可以提高 voxel 统计稳定性,但时间窗过长又会放大运动误差;所以 voxel size × accumulation window × support count 应该一起标定,而不是只调一个 leaf size。

如果真正的问题是长直走廊沿轴向不可观,VGICP 只能让已有信息使用得更高效,不能创造不存在的观测。此时必须把退化方向显式交给 IMU、轮速、RTK、反光标志或其他 LiDAR。

今日结论

今天最重要的 SLAM 信息不是“哪种方法分数最高”,而是长期环境会主动改变传感器的可用信息分布。一年森林实测说明,季节、雪墙和自相似场景会让复杂 SLAM 的故障面迅速扩大;经典 VGICP 又提醒我们,地图统计和局部 registration 只能更高效地使用已有几何,不能替代对可观测性与地图生命周期的管理。

控制侧,两条工作分别在“通信”和“接触”上处理现实复杂性。Distributed Model-Based Diffusion 不再假设多机器人即时同步;Contact-Guided Exploration 不再假设 RL 随机探索能自然遇到稀疏接触。真实机器人算法越来越需要把最困难的结构显式写进学习/优化过程,而不是期待规模自动解决。

PanelShield 和 STEGNav 代表另一条趋势:高层机器人状态正在从自由文本转向结构化可验证对象。 前者把说明书规则转成 LTL/FSM;后者把长期导航经验转成时空 event graph。Foundation Model 可以负责语义,但执行系统需要可追踪的规则、状态和证据。

VLA 的 VLAct 也说明,在机器人数据始终昂贵的前提下,真正可持续的扩展路径不只有数据量。一个能保留通用视觉语言先验、同时学习共享物理动作语义的 backbone,会比“每个机器人单独再训一个动作模型”更适合长期产品线。

AI Coding 侧则越来越清晰:模型、Worker、Controller、Harness、Verifier 本来就是不同层。LoopArena 显示 Controller 自身仍是明显瓶颈;openJiuwen 显示 runtime evidence 和 execution substrate 已经可以独立贡献性能。企业 Agent 的长期竞争点会越来越像传统软件平台:状态、版本、权限、可恢复性和可验证性。

最值得深入研究或尝试复现的方向

  1. 做一套“跨季节 SLAM 健康度”数据协议。 同一路线按月份保存地图版本、定位成功率、特征/几何信息量、人工干预和重定位时间;让地图更新由数据触发,而不是发现机器人迷路后再人工重建。

  2. 在现有多机器人 MPC 中显式注入 state age。 对每个邻居状态保存 timestamp,逐步加入 20/50/100/200 ms 延迟与随机丢包,比较集中式 MPC、分布式 sampling MPC 和本地安全层的约束违规与 P99 latency。

  3. 四足移动操作做 Contact-Acquisition Prior。 先把“找到可用接触并稳定建立接触”独立成共享技能,再在其上训练推椅子、推箱子、开门等任务;对比纯 task reward 的样本效率和失败模式。

  4. Coding Agent 做 Controller/Worker 解耦 A/B。 固定同一个 Worker 与仓库任务,分别比较固定 loop、便宜 Controller、强 Controller;强制所有阶段通过 artifact + repo SHA 传递状态,测 stop-too-early、漏验证和 token 成本,而不只看最终 pass@1。

参考资料

  1. One year in a forest
  2. Distributed Model-Based Diffusion
  3. Contact-Guided Exploration · 项目页
  4. PanelShield
  5. STEGNav
  6. VLAct · 项目页
  7. LoopArena · 代码
  8. openJiuwen · GitHub
  9. Voxelized GICP / ICRA 2021 · fast_gicp · small_gicp
  10. arXiv Robotics 最新列表 · arXiv Software Engineering 最新列表