Cooperative control of multi-vehicle systems using cost graphs and optimization | Synapse