Nonlinear observability of unicycle multi-robot teams subject to nonuniform environmental disturbances

Abstract

In this work, we consider the problem of localizing a team of robots, without access to direct pose measurements, under the influence of nonuniform environmental disturbances and measurement bias. Specifically, we are interested in the conditions under which teams remain range-only localizable when the environmental disturbances vary from robot to robot. We approach this problem through nonlinear observability and graph theory. After analyzing the system’s observability properties, we present theorems that identify the structural conditions under which the system maintains local weak observability. We demonstrate that rigid structures are important not only in defining multi-robot interactions, but also in characterizing the influence of nonuniform disturbances. We also give several example systems to cement intuition on the derived conditions. An observability-based planner is then presented that guides a subset of robots toward trajectories that are highly observable through finite-horizon optimization on robot headings. Simulations are then presented, along with an extended Kalman filter for state estimation, and a comparison to previous methods, to corroborate and demonstrate the results derived.