Observability-Aware Control for Quadrotor Formation Flight with Range-only Measurement

TL;DR

This paper introduces an observability-aware control method for quadrotor formation flight using range-only measurements, enhancing localization accuracy and robustness in GNSS-denied environments.

Contribution

It develops a novel STLOG approximation and an OPC that optimizes information gain, improving estimator stability in formation flight.

Findings

OPC increases estimation accuracy in simulations.

Flight experiments confirm improved robustness and positioning confidence.

STLOG effectively predicts local observability in nonlinear systems.

Abstract

Cooperative Localization is a promising approach to achieving safe quadrotor formation flight through precise positioning via low-cost inter-drone sensors. This paper develops an observability-aware control principle tailored to quadrotor formation flight with range-only inter-drone measurements. The control principle is based on a novel approximation of the local observability Gramian (LOG), which we name the Short-Term Local Observability Gramian (STLOG). The validity of STLOG is established by proving its link to directional estimation precision in nonlinear systems. We propose the Observability Predictive Controller (OPC), a receding-horizon controller that generates optimal inputs to enhance information gain in weakly observable state directions by maximizing the minimum eigenvalue of the STLOG. This reduces the risk of estimator divergence due to the unbounded growth of uncertainty in weakly observed state components. Monte Carlo simulations and flight experiments are conducted with quadrotors in a GNSS-denied ferrying mission, showing that the OPC improves positioning confidence and estimator robustness.