Safe Navigation of Quadrotor Teams to Labeled Goals in Limited Workspaces

In this work, we solve the labeled multi-robot planning problem. Most proposed algorithms to date have modeled robots as kinematic or kinodynamic agents in planar environments, making them impractical for real-world systems. Here, we present experiments to validate a centralized multi-robot planning and trajectory generation method that explicitly accounts for robots with higher-order dynamics. First, we demonstrate successful execution of solution trajectories. Next, we verify the robustness of the robots’ trajectory tracking to unmodeled external disturbances, in particular, the aerodynamic interactions between co-planar neighbors. Finally, we apply our algorithm to navigating quadrotors away from the downwash of their neighbors to improve safety in three-dimensional workspaces.

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

[2]  Daniela Rus,et al.  An Effective Algorithmic Framework for Near Optimal Multi-robot Path Planning , 2015, ISRR.

[3]  Nathan R. Sturtevant,et al.  Enhanced Partial Expansion A , 2014, J. Artif. Intell. Res..

[4]  Wolfram Burgard,et al.  Finding and Optimizing Solvable Priority Schemes for Decoupled Path Planning Techniques for Teams of Mobile Robots , 2002, PuK.

[5]  Jonathan P. How,et al.  Decentralized control of partially observable Markov decision processes , 2015, 52nd IEEE Conference on Decision and Control.

[6]  Vijay Kumar,et al.  QuadCloud: A Rapid Response Force with Quadrotor Teams , 2014, ISER.

[7]  John Enright,et al.  Optimization and Coordinated Autonomy in Mobile Fulfillment Systems , 2011, Automated Action Planning for Autonomous Mobile Robots.

[8]  Vijay Kumar,et al.  A Complete Algorithm for Generating Safe Trajectories for Multi-robot Teams , 2015, ISRR.

[9]  Vijay Kumar,et al.  Goal assignment and trajectory planning for large teams of interchangeable robots , 2014, Auton. Robots.

[10]  Taeyoung Lee,et al.  Control of Complex Maneuvers for a Quadrotor UAV using Geometric Methods on SE(3) , 2010, ArXiv.

[11]  Kostas E. Bekris,et al.  Push and Swap: Fast Cooperative Path-Finding with Completeness Guarantees , 2011, IJCAI.

[12]  Antonio Bicchi,et al.  Decentralized Cooperative Policy for Conflict Resolution in Multivehicle Systems , 2007, IEEE Transactions on Robotics.

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

[14]  Jonathan P. How,et al.  Decentralized path planning for multi-agent teams in complex environments using rapidly-exploring random trees , 2011, 2011 IEEE International Conference on Robotics and Automation.

[15]  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).

[16]  Christopher Clark,et al.  Decentralized and complete multi-robot motion planning in confined spaces , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[17]  Christopher M. Clark,et al.  Applying kinodynamic randomized motion planning with a dynamic priority system to multi-robot space systems , 2002, Proceedings, IEEE Aerospace Conference.

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

[19]  Alborz Geramifard,et al.  Decentralized control of Partially Observable Markov Decision Processes using belief space macro-actions , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[20]  Taeyoung Lee,et al.  Nonlinear Robust Tracking Control of a Quadrotor UAV on SE(3) , 2013 .

[21]  Howie Choset,et al.  Subdimensional expansion for multirobot path planning , 2015, Artif. Intell..