Observability-Aware Control for Quadrotor Formation Flight with Range-only Measurement
For quadrotor formation flight with range-only sensors, this work provides a control method to enhance estimation precision and robustness, addressing a practical bottleneck in GNSS-denied environments.
The paper develops an observability-aware control principle for quadrotor formation flight using range-only measurements, introducing the Short-Term Local Observability Gramian (STLOG) and the Observability Predictive Controller (OPC). Monte Carlo simulations and flight experiments show that OPC improves positioning confidence and estimator robustness in GNSS-denied ferrying missions.
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.