arXiv:2602.22006cs.RO2026-02

提出一种高精度低延迟的多机器人相对定位方法,支持高频实时协同

Parallel Reference-Centric Continuous-Time Relative Localization with Augmented Clamped Non-Uniform B-Splines

  • 用改进的分段样条表示状态,消除查询延迟
  • 3秒内从264毫秒时偏收敛到亚毫秒级,定位误差0.046米
  • 适合高速运动场景,适用于需要实时协同的多机器人系统

精确的相对定位对多机器人协作至关重要。在机器人群体中,不同机器人的时间测量异步且存在时钟偏移。尽管连续时间(CT)方法在单机器人SLAM与标定中表现良好,但将其扩展到多机器人场景面临高精度、低延迟和高频性能的挑战,现有方法普遍存在非夹持样条的查询延迟和优化延迟问题。本文提出一种新型连续时间相对惯性里程计框架——CT-RIO。采用夹持非均匀样条(C-NUBS)表示状态,消除查询延迟;进一步引入闭式扩展与收缩操作,在保持样条形状的同时支持在线估计和灵活节点管理。由此提出节点-关键节点策略,在高频下实现样条延伸并保留稀疏关键节点以适应相对运动建模。构建基于参考中心的滑动窗口相对定位问题,仅依赖相对运动学和机器人间约束。为实现低延迟与高频估计,将强耦合优化分解为机器人独立子问题,通过异步块坐标下降并行求解。大量实验表明,CT-RIO可在3秒内从最大264毫秒的时偏收敛至亚毫秒级,实现0.046米的均方根误差与1.8度的姿态误差。在高速运动下相比已有方法性能提升最高达60%。

原文摘要 · Abstract (English)

Accurate relative localization is critical for multi-robot cooperation. In robot groups, measurements from different robots arrive asynchronously and with clock time-offsets. Although Continuous-Time (CT) formulations have proved effective for handling asynchronous measurements in single-robot SLAM and calibration, extending CT methods to multi-robot settings faces great challenges in achieving high-accuracy, low-latency, and high-frequency performance. In particular, existing CT methods suffer from the inherent query-time delay of unclamped B-splines and high optimization latency. This paper proposes CT-RIO, a novel Continuous-Time Relative-Inertial Odometry framework. We adopt Clamped Non-Uniform B-splines (C-NUBS) to represent states, eliminating the query-time delay. We further augment C-NUBS with closed-form extension and shrinkage operations that preserve the spline shape, making it suitable for online estimation and enabling flexible knot management. This flexibility leads to the concept of a knot-keyknot strategy, which supports spline extension at high frequency while retaining sparse keyknots for adaptive relative motion modeling. We then formulate a reference-centric sliding-window relative localization problem that operates purely on relative kinematics and inter-robot constraints. To enable low-latency and high-frequency estimation, we decompose the tightly coupled optimization into robot-wise subproblems and solve them in parallel using asynchronous block coordinate descent. Extensive experiments show that CT-RIO converges from time-offsets as large as 264 ms to sub-millisecond within 3 s, and achieves RMSEs of 0.046 m and 1.8 degree. It consistently outperforms evaluated published methods, with improvements of up to 60% under high-speed motion.

多机器人相对定位连续时间实时系统

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。