Optimization-Based Formation Stabilization : A Centralized Problem with a Distributed Solution
Cooperative control of multi-vehicle systems using cost graphs and optimization