Multi-Robot Relative Pose Estimation and IMU Preintegration Using Passive UWB Transceivers
arXiv:2304.03837 · doi:10.1109/TRO.2024.3370027
Abstract
Ultra-wideband (UWB) systems are becoming increasingly popular as a means of inter-robot ranging and communication. A major constraint associated with UWB is that only one pair of UWB transceivers can range at a time to avoid interference, hence hindering the scalability of UWB-based localization. In this paper, a ranging protocol is proposed that allows all robots to passively listen on neighbouring communicating robots without any hierarchical restrictions on the role of the robots. This is utilized to allow each robot to obtain more range measurements and to broadcast preintegrated inertial measurement unit (IMU) measurements for relative extended pose state estimation directly on SE2(3). Consequently, a simultaneous clock-synchronization and relative-pose estimator (CSRPE) is formulated using an on-manifold extended Kalman filter (EKF) and is evaluated in simulation using Monte-Carlo runs for up to 7 robots. The ranging protocol is implemented in C on custom-made UWB boards fitted to 3 quadcopters, and the proposed filter is evaluated over multiple experimental trials, yielding up to 48% improvement in localization accuracy.
References in corpus (12)
- On-Manifold Preintegration for Real-Time Visual-Inertial Odometry
- Decentralized Visual-Inertial-UWB Fusion for Relative State Estimation of Aerial Swarm
- A micro Lie theory for state estimation in robotics
- Associating Uncertainty to Extended Poses for on Lie Group IMU Preintegration with Rotating Earth
- Relative Position Estimation Between Two UWB Devices with IMUs
- Relative Position Estimation in Multi-Agent Systems Using Attitude-Coupled Range Measurements
- Robust Target-relative Localization with Ultra-Wideband Ranging and Communication
- Sequential TOA-Based Moving Target Localization in Multi-Agent Networks
- BLAS: Broadcast Relative Localization and Clock Synchronization for Dynamic Dense Multi-Agent Systems
- D-SLATS: Distributed Simultaneous Localization and Time Synchronization
- Cascaded Filtering Using the Sigma Point Transformation (Extended Version)
- IMU Preintegration for Multi-Robot Systems in the Presence of Bias and Communication Constraints