Geometry-Aware Distributed Kalman Filtering for Affine Formation Control under Observation Losses

Abstract

Affine formation control of multiagent systems has recently received increasing attention in various applications. The distributed control of these agents, under single integrator dynamics, relies on the observations of relative positions of the neighboring agents, which when unavailable is detrimental to the mission. In this paper, we propose an adaptive fusion estimator of the relative positions under intermittent and consecutive observation loss settings. A relative affine localization (RAL) solution is developed by exploiting the geometry of affine formation, which is then embedded into a distributed relative Kalman filtering (RKF) framework, leading to the geometry-aware relative Kalman filter (GA-RKF). We show through simulations that the GA-RKF exhibits enhanced robustness to both intermittent and consecutive observation losses, as compared to RAL and existing state-of-art methods.