多机器人在李群上实现容错、多模态定位,提升大规模系统可靠性。
Fault-Tolerant Multi-Modal Localization of Multi-Robots on Matrix Lie Groups
- 在李群上设计新随机运算,融合惯性、速度与伪位姿数据
- 实验表明定位精度优于传统方法,支持实时与可扩展更新
- 适合大规模移动机器人集群,尤其抗传感器故障
协同多机器人系统在导航中保持一致定位面临重大挑战。本文提出一种基于矩阵李群的容错多模态定位框架。引入新型随机运算,实现相关与非相关估计在李群上的组合、差分、逆运算、平均与融合,支持滤波器更新中的伪位姿构建。该方法在扩展卡尔曼滤波(EKF)框架下集成各机器人上的本体感知与外部感知测量,包括惯性、速度及伪位姿传感器数据。预测步骤在李群 $\ ext{SE}_2(3) \times \ ext{R}^3 \times \ ext{R}^3$ 上进行,传播每个机器人的位姿、速度及惯性测量偏差。框架利用机体速度、特征标记的相对位姿测量以及机器人间通信,在李群 $\ ext{SE}(3) \times \ ext{R}^3$ 上实现可扩展的EKF更新。引入故障检测模块,仅融合可靠的特征标记伪位姿数据。通过配备惯性测量单元、轮式里程计和ArUco标记的轮式移动机器人网络实验验证了该方法的有效性。对比结果表明,所提方法具备实时性能、更高效率、更强可靠性和可扩展性,适用于大规模机器人系统。
原文摘要 · Abstract (English)
Consistent localization of cooperative multi-robot systems during navigation presents substantial challenges. This paper proposes a fault-tolerant, multi-modal localization framework for multi-robot systems on matrix Lie groups. We introduce novel stochastic operations to perform composition, differencing, inversion, averaging, and fusion of correlated and non-correlated estimates on Lie groups, enabling pseudo-pose construction for filter updates. The method integrates a combination of proprioceptive and exteroceptive measurements from inertial, velocity, and pose (pseudo-pose) sensors on each robot in an Extended Kalman Filter (EKF) framework. The prediction step is conducted on the Lie group $\mathbb{SE}_2(3) \times \mathbb{R}^3 \times \mathbb{R}^3$, where each robot's pose, velocity, and inertial measurement biases are propagated. The proposed framework uses body velocity, relative pose measurements from fiducial markers, and inter-robot communication to provide scalable EKF update across the network on the Lie group $\mathbb{SE}(3) \times \mathbb{R}^3$. A fault detection module is implemented, allowing the integration of only reliable pseudo-pose measurements from fiducial markers. We demonstrate the effectiveness of the method through experiments with a network of wheeled mobile robots equipped with inertial measurement units, wheel odometry, and ArUco markers. The comparison results highlight the proposed method's real-time performance, superior efficiency, reliability, and scalability in multi-robot localization, making it well-suited for large-scale robotic systems.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。