Online Trajectory Planning for Multiple Quadrotors in Dynamic Environments Using Relative Safe Flight Corridor

This letter presents a new distributed multi-agent trajectory planning algorithm that generates safe, dynamically feasible trajectories considering the uncertainty of obstacles in dynamic environments. We extend the relative safe flight corridor (RSFC) presented in previous work to replace time-variant, non-convex collision avoidance constraints to convex ones, and we adopt a relaxation method based on reciprocal collision avoidance (RCA) to reduce the total flight time and distance without loss of success rate. The proposed algorithm can compute the trajectories for 50 agents on average 49.7 ms per agent with Intel i7 desktop and can generate safe trajectories for 16 agents with a success rate of more than 93% in simulation environments with four dynamic obstacles when the velocity of dynamic obstacles is below the maximum velocity of quadrotors. We validate the robustness of the proposed algorithm through a real flight test with four quadrotors and one moving human.

[1]  Roland Siegwart,et al.  Robust collision avoidance for multiple micro aerial vehicles using nonlinear model predictive control , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[2]  Alexandre M. Bayen,et al.  A time-dependent Hamilton-Jacobi formulation of reachable sets for continuous dynamic games , 2005, IEEE Transactions on Automatic Control.

[3]  Angela P. Schoellig,et al.  Online Trajectory Generation With Distributed Model Predictive Control for Multi-Robot Motion Planning , 2020, IEEE Robotics and Automation Letters.

[4]  Paul A. Beardsley,et al.  Collision avoidance for aerial vehicles in multi-agent scenarios , 2015, Auton. Robots.

[5]  Saptarshi Bandyopadhyay,et al.  Fast, On-line Collision Avoidance for Dynamic Vehicles Using Buffered Voronoi Cells , 2017, IEEE Robotics and Automation Letters.

[6]  Boris Polyak,et al.  Multi-Input Multi-Output Ellipsoidal State Bounding , 2001 .

[7]  Dinesh Manocha,et al.  PRVO: Probabilistic Reciprocal Velocity Obstacle for multi robot navigation under uncertainty , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[8]  Roland Siegwart,et al.  Cooperative Collision Avoidance for Nonholonomic Robots , 2018, IEEE Transactions on Robotics.

[9]  Abhishek Halder,et al.  On the Parameterized Computation of Minimum Volume Outer Ellipsoid of Minkowski Sum of Ellipsoids , 2018, 2018 IEEE Conference on Decision and Control (CDC).

[10]  Mo Chen,et al.  Multi-vehicle collision avoidance via hamilton-jacobi reachability and mixed integer programming , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[11]  Inkyu Jang,et al.  Efficient Multi-Agent Trajectory Planning with Feasibility Guarantee using Relative Bernstein Polynomial , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[12]  Yi Lin,et al.  Online Safe Trajectory Generation for Quadrotors Using Fast Marching Method and Bernstein Basis Polynomial , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Anca D. Dragan,et al.  A Scalable Framework For Real-Time Multi-Robot, Multi-Human Collision Avoidance , 2018, 2019 International Conference on Robotics and Automation (ICRA).

[14]  Javier Alonso-Mora,et al.  Chance-Constrained Collision Avoidance for MAVs in Dynamic Environments , 2019, IEEE Robotics and Automation Letters.

[15]  Dinesh Manocha,et al.  Reciprocal n-Body Collision Avoidance , 2011, ISRR.

[16]  Charles Richter,et al.  Polynomial Trajectory Planning for Aggressive Quadrotor Flight in Dense Indoor Environments , 2016, ISRR.

[17]  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.

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

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