arXiv:2512.24688cs.RO2025-12被引 2

多机器人协同定位新系统,无需全局信息也能精准测距测向。

CREPES-X: Hierarchical Bearing-Distance-Inertial Direct Cooperative Relative Pose Estimation System

  • 分两阶段融合视角、距离与惯性数据,实时输出相对位姿。
  • 可抗90%视角异常点,实测定位误差0.073米,角度误差1.817度。
  • 小巧硬件设计适合集群部署,适合复杂环境下的自主机器人协同。

相对定位对自主多机器人系统协作至关重要。现有方法或依赖共享环境特征或惯性假设,或在复杂环境下受非视距和异常值影响严重。数十个机器人的相互测量(如方位、距离、惯性)的鲁棒高效融合仍具挑战。本文提出CREPES-X(带多扩展特征的协作相对位姿估计系统),一种分层相对定位框架,在无需全局信息前提下提升速度、精度与鲁棒性。CREPES-X采用紧凑硬件设计:尺寸不超过6cm³的立方体集成红外LED、红外相机、超宽带模块和IMU。随后构建两级分层估计算法以满足不同需求:第一阶段提出单帧相对估计算法,通过闭式解与鲁棒方位异常值剔除实现多机器人即时相对位姿估计;第二阶段设计多帧相对估计算法,利用机器人中心相对运动学与松耦合/紧耦合优化,结合IMU预积分实现高精度鲁棒状态估计。大量仿真与真实实验验证了其有效性,系统在高达90%方位异常点下仍保持稳定,真实数据集上实现0.073m的均方根误差与1.817°的角度误差。

原文摘要 · Abstract (English)

Relative localization is critical for cooperation in autonomous multi-robot systems. Existing approaches either rely on shared environmental features or inertial assumptions or suffer from non-line-of-sight degradation and outliers in complex environments. Robust and efficient fusion of inter-robot measurements such as bearings, distances, and inertials for tens of robots remains challenging. We present CREPES-X (Cooperative RElative Pose Estimation System with multiple eXtended features), a hierarchical relative localization framework that enhances speed, accuracy, and robustness under challenging conditions, without requiring any global information. CREPES-X starts with a compact hardware design: InfraRed (IR) LEDs, an IR camera, an ultra-wideband module, and an IMU housed in a cube no larger than 6cm on each side. Then CREPES-X implements a two-stage hierarchical estimator to meet different requirements, considering speed, accuracy, and robustness. First, we propose a single-frame relative estimator that provides instant relative poses for multi-robot setups through a closed-form solution and robust bearing outlier rejection. Then a multi-frame relative estimator is designed to offer accurate and robust relative states by exploring IMU pre-integration via robocentric relative kinematics with loosely- and tightly-coupled optimization. Extensive simulations and real-world experiments validate the effectiveness of CREPES-X, showing robustness to up to 90% bearing outliers, proving resilience in challenging conditions, and achieving RMSE of 0.073m and 1.817° in real-world datasets.

多机器人相对定位协同导航传感器融合

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