Search papers, labs, and topics across Lattice.
This paper introduces a closed-form 4-DoF inter-robot pose estimator that utilizes bearing-only measurements to enhance cooperative localization in environments with minimal infrastructure. By relaxing nonlinear constraints for rotation estimation and employing error projection for translation estimation, the proposed method addresses the challenges of observability degeneracy found in existing 6-DoF approaches. The results from extensive simulations and real-world experiments indicate that this estimator not only achieves higher accuracy but also operates with significantly lower computational costs, while an observability test module optimizes estimation timing without relying on fixed-length sliding windows.
Achieving reliable inter-robot pose estimation with a closed-form 4-DoF approach could revolutionize cooperative localization in resource-constrained environments.
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.
