提出一种无需复杂计算的机器人位姿估计算法,提升协作定位精度与可靠性。
A Closed-Form 4-DoF Inter-Robot Pose Estimator using Bearing-only Measurements

- 通过闭式解放松旋转约束,用误差投影估计平移,简化计算。
- 在两种典型运动模式下仍保持可观测性,对运动激励要求更低。
- 自动判断最优估计时刻,减少数据采集间隔,适合实时应用。
基于视角角度的协同定位因基础设施需求少、通信带宽低,在复杂环境中具有广泛应用前景。然而,现有6自由度方法在快速获取准确可靠的机器人间位姿估计方面仍存在挑战,尤其在特定运动模式下易出现可观测性退化。为此,本文提出一种闭式4自由度机器人间位姿估计算法,放松了旋转估计的非线性约束,采用误差投影进行平移估计。通过理论分析发现,系统在共线和形状保持型构型下会出现退化。分析进一步表明,所提4自由度系统对运动激励要求更宽松,可在更广泛的协同运动中实现可靠估计。此外,引入可观测性测试模块,可自主确定最优估计时刻,避免依赖预设固定长度滑动窗口。大量仿真与实测实验表明,该算法在显著降低计算成本的同时,实现了更高精度的位姿估计,且可观测性测试模块保障了估计可靠性,同时最小化数据采集间隔。
原文摘要 · Abstract (English)
Bearing-odometry-based cooperative localization has attracted increasing research interest due to its minimal infrastructure requirements, low communication bandwidth and broad applicability in complex environments. However, existing 6-DoF approaches still face challenges in rapidly obtaining accurate and reliable inter-robot pose estimation, as the system is prone to observability degeneracy under specific motion patterns. To address these issues, we first propose a closed-form 4-DoF inter-robot pose estimator, which relaxes nonlinear constraints for rotations estimation and employs error projection for translations estimation. We then conduct a theoretical analysis of the system's observability, identifying degeneracy under two typical motion patterns: collinear and shape-preserving formations. The analysis further shows that the proposed 4-DoF system requires less stringent motion excitation for observability, enabling reliable estimation under a broader range of cooperative maneuvers. Furthermore, an observability test module is introduced to autonomously determine the optimal estimation instant, eliminating reliance on a predefined fixed-length sliding window. Extensive simulations and real-world experiments demonstrate that the proposed algorithm achieves higher estimation accuracy with significantly low computational cost, and the observability test module ensures estimation reliability while minimizing the data collection interval.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。