Concurrent Goal Assignment and Collision-Free Trajectory Generation for Multiple Aerial Robots

We develop computationally tractable methods for concurrent goal assignment and planning of collision-free trajectories for multiple aerial robot systems. Our method first assigns robots to goals to minimize total time-in-motion, assuming straight-line maximum-speed trajectories. By coupling the assignment and trajectory generation, the initial motion plans tend to require only limited collision resolution. We then refine the plans by checking for potential collisions and resolving them using either start time delays or altitude assignment. Numerical experiments using both methods show significant reductions in the total time required for agents to arrive at goals with only modest additional computational effort in comparison to state-of-the-art prior work.