Downwash-aware trajectory planning for large quadrotor teams

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 Ck-continuous trajectories, locally optimizing an integral-squared-derivative cost. We account for the downwash effect, 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 nano-quadrotors. Our approach can compute safe and smooth trajectories for hundreds of quadrotors in dense environments with obstacles in a few minutes.

[1]  Sven Koenig,et al.  Formation change for robot groups in occluded environments , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[2]  Vijay Kumar,et al.  Goal Assignment and Trajectory Planning for Large Teams of Aerial Robots , 2013, Robotics: Science and Systems.

[3]  N. Roy,et al.  Polynomial Trajectory Planning for Quadrotor Flight , 2012 .

[4]  Ella M. Atkins,et al.  An Empirical Model of Rotorcrafy UAV Downwash for Disturbance Localization and Avoidance , 2015 .

[5]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[6]  Vijay Kumar,et al.  Mixed-integer quadratic program trajectory generation for heterogeneous quadrotor teams , 2012, 2012 IEEE International Conference on Robotics and Automation.

[7]  Paul A. Beardsley,et al.  Optimal Reciprocal Collision Avoidance for Multiple Non-Holonomic Robots , 2010, DARS.

[8]  Jonathan P. How,et al.  Decoupled multiagent path planning via incremental sequential convex programming , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Howie Choset,et al.  M*: A complete multirobot path planning algorithm with performance bounds , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Vijay Kumar,et al.  Minimum snap trajectory generation and control for quadrotors , 2011, 2011 IEEE International Conference on Robotics and Automation.

[11]  Sven Koenig,et al.  Optimal Target Assignment and Path Finding for Teams of Agents , 2016, AAMAS.

[12]  Stephen P. Boyd,et al.  CVXGEN: a code generator for embedded convex optimization , 2011, Optimization and Engineering.

[13]  Steven M. LaValle,et al.  Planning optimal paths for multiple robots on graphs , 2012, 2013 IEEE International Conference on Robotics and Automation.

[14]  Gaurav S. Sukhatme,et al.  Crazyswarm: A large nano-quadcopter swarm , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[15]  Mircea D. Farcas,et al.  About Bernstein polynomials , 2008 .

[16]  Steven M. LaValle,et al.  Multi-agent Path Planning and Network Flow , 2012, WAFR.

[17]  Vijay Kumar,et al.  Safe and complete trajectory generation for robot teams with higher-order dynamics , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[18]  Nathan R. Sturtevant,et al.  Conflict-based search for optimal multi-agent pathfinding , 2012, Artif. Intell..

[19]  Angela P. Schoellig,et al.  Generation of collision-free trajectories for a quadrocopter fleet: A sequential convex programming approach , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  R. Brereton,et al.  Support vector machines for classification and regression. , 2010, The Analyst.

[21]  M. E. Flores.  Real-Time Trajectory Generation for Constrained Nonlinear Dynamical Systems Using Non-Uniform Rational B-Spline Basis Functions , 2008 .

[22]  Vijay Kumar,et al.  The GRASP Multiple Micro-UAV Testbed , 2010, IEEE Robotics & Automation Magazine.

[23]  Jur P. van den Berg,et al.  Reciprocal collision avoidance for robots with linear dynamics using LQR-Obstacles , 2013, 2013 IEEE International Conference on Robotics and Automation.

[24]  Srinivas Akella,et al.  Coordinating Multiple Robots with Kinodynamic Constraints Along Specified Paths , 2005, Int. J. Robotics Res..