Subdimensional Expansion: A Framework for Computationally Tractable Multirobot Path Planning
Cooperative control of multi-vehicle systems using cost graphs and optimization