Robust 3D Distributed Formation Control with Application to Quadrotors

Kaveh Fathian, Sleiman Safaoui, Tyler H. Summers, Nicholas R. GansarXiv 2018 · arXiv · OpenReview

TL;DR

This paper introduces a novel distributed control strategy enabling teams of quadrotors to autonomously achieve complex 3D formations without relying on global positioning or inter-robot communication. The approach is robust to sensor noise and inaccuracies, demonstrating its practical applicability through experimental validation.

What Problem Does This Paper Address?

Coordinating multiple autonomous robots, particularly aerial vehicles like quadrotors, to maintain specific geometric formations is crucial for many applications, including surveillance, mapping, and collaborative manipulation. Traditional approaches often depend on centralized control systems or require robots to share global position information and communicate extensively. These methods can be brittle, lacking scalability and resilience to communication failures or GPS jamming. The challenge is to develop a distributed control system where each robot only needs local information (relative positions to neighbors) to achieve a desired collective shape, while also being robust to real-world sensor imperfections.

Methods

The core of the proposed strategy lies in a distributed control law that calculates a desired motion direction for each quadrotor based on the relative positions of its neighbors. This calculation uses constant gain matrices, pre-programmed into each robot, that are derived using a novel semidefinite programming (SDP) formulation. A key assumption is that each quadrotor has a common sense of direction, typically aligned with the measured gravitational force from its IMU. This assumption, however, is not strictly necessary; the method is robust to inaccuracies in this direction, which can arise from sensor noise or accelerations. To address the issue of maintaining a precise scale for the formation, the control law is augmented with a bounded, odd, and smooth map that pushes robots towards or away from their neighbors to achieve the desired inter-robot distances.

Datasets

Not discussed in the paper. The paper focuses on a theoretical framework and experimental validation using a custom setup.

Key Insights and Ideas

  • Decentralized 3D Formation Control: The ability to achieve complex 3D formations using only local relative position measurements is a significant step beyond many existing planar or simpler 3D formation strategies.
  • Robustness to Gravity Direction Inaccuracies: The strategy's resilience to errors in the assumed "down" direction (from IMU gravity measurements) is a critical practical advantage. This means the system can tolerate sensor noise and accelerations without losing formation.
  • SDP for Gain Matrix Design: Employing semidefinite programming to design the control gain matrices offers a systematic and principled way to ensure convergence to the desired formation, even with complex topologies.
  • Emergent Collision Avoidance: The distributed nature of the control, combined with a mechanism to rotate control directions to avoid nearby obstacles (or other robots), naturally leads to a collision avoidance behavior.

Key Results

The paper demonstrates the effectiveness of its proposed distributed control strategy through an experimental setup involving five Crazyflie quadrotors. The quadrotors successfully achieved a desired square pyramid formation, starting from an initial linear configuration. The experiment showcased the system's ability to maintain the formation while navigating and, importantly, avoiding collisions by adjusting their desired motion directions. The visual results (snapshots and trajectory plots) confirm the successful execution of the formation control.

Limitations and Future Work

The authors acknowledge that their distributed collision avoidance scheme, while effective, can potentially lead to gridlock situations. Future work will focus on developing communication-based schemes to detect and resolve these gridlocks. Additionally, they plan to explore leader-follower strategies for more intuitive cooperative navigation and to enable single-operator control of UAV teams in formation.

Summary updated

Abstract

We present a distributed control strategy for a team of quadrotors to autonomously achieve a desired 3D formation. Our approach is based on local relative position measurements and does not require global position information or inter-vehicle communication. We assume that quadrotors have a common sense of direction, which is chosen as the direction of gravitational force measured by their onboard IMU sensors. However, this assumption is not crucial, and our approach is robust to inaccuracies and effects of acceleration on gravitational measurements. In particular, converge to the desired formation is unaffected if each quadrotor has a velocity vector that projects positively onto the desired velocity vector provided by the formation control strategy. We demonstrate the validity of proposed approach in an experimental setup and show that a team of quadrotors achieve a desired 3D formation.
BibTeX
@misc{fathian2018robust,
  author = {Kaveh Fathian and Sleiman Safaoui and Tyler H. Summers and Nicholas R. Gans},
  title = {{Robust 3D Distributed Formation Control with Application to Quadrotors}},
  year = {2018},
  eprint = {1809.00093},
  archivePrefix = {arXiv},
  url = {https://arxiv.org/abs/1809.00093},
}
Figure