Downwash-Aware Trajectory Planning for Large Quadrotor Teams

Abstract

We describe a method for formation-change trajectory planning for large quadrotor teams in obstacle-rich environments. Our method decomposes the planning problem into two stages: a discrete planner operating on a graph representation of the workspace, and a continuous refinement that converts the non-smooth graph plan into a set of C^k-continuous trajectories, locally optimizing an integral-squared-derivative cost. We model the downwash directly, allowing safe flight in dense formations. We demonstrate the computational efficiency in simulation with up to 200 robots and the physical plausibility with an experiment with 32 physical quadrotors. To our knowledge, our approach is the first solution which can compute safe and smooth trajectories for hundreds of quadrotors in dense environments with obstacles in a few minutes.