Tight Fusion of Odometry, Kinematic Constraints, and UWB Ranging Systems for State Estimation of Integrated Aerial Platforms

Integrated Aerial Platforms (IAPs), consisting of multiple interconnected aircraft, offer a promising framework for aerial manipulation tasks by enhancing localization accuracy and reliability. Unlike aerial swarms, the interconnected nature of IAPs allows for exploiting physical constraints among aircraft to improve positioning and navigation systems. In this paper, we present an advanced decentralized multi-aircraft visual-inertial-range-physical odometry system that considers the position, velocity, and attitude constraints inherent to IAPs. By tightly fusing visual-inertial-range odometry and Ultra-Wideband (UWB) with kinematic constraints, we optimize odometry accuracy through the use of novel constraint-based methods. Our algorithm’s performance is validated on simulated datasets and self-collected datasets, with flight experiments conducted on the IAP, demonstrating a significant improvement with a 28.7% reduction in drift over the baseline on real-world datasets and a 24.5% reduction on simulation datasets.