Motion Planning For Micro Aerial Vehicles

A Micro Aerial Vehicle (MAV) is capable of agile motion in 3D making it an ideal platform for developments of planning and control algorithms. For fully autonomous MAV systems, it is essential to plan motions that are both dynamically feasible and collision-free in cluttered environments. Recent work demonstrates precise control of MAVs using time-parameterized trajectories that satisfy feasibility and safety requirements. However, planning such trajectories is non-trivial, especially when considering constraints, such as optimality and completeness. For navigating in unknown environments, the capability for fast re-planning is also critical. Considering all of these requirements, motion planning for MAVs is a challenging problem. In this thesis, we examine trajectory planning algorithms for MAVs and present methodologies that solve a wide range of planning problems. We first introduce path planning and geometric control methods, which produce spatial paths that are inadequate for high speed flight, but can be used to guide trajectory optimization. We then describe optimization-based trajectory planning and demonstrate this method for solving navigation problems in complex 3D environments. When the initial state is not fixed, an optimization-based method is prone to generate sub-optimal trajectories. To address this challenge, we propose a search-based approach using motion primitives to plan resolution complete and sub-optimal trajectories. This algorithm can also be used to solve planning problems with constraints such as motion uncertainty, limited field-of-view and moving obstacles. The proposed methods can run in real time and are applicable for real-world autonomous navigation, even with limited on-board computational resources. This thesis includes a carefully analysis of the strengths and weaknesses of our planning paradigm and algorithms, and demonstration of their performance through simulation and experiments. Degree Type Dissertation Degree Name Doctor of Philosophy (PhD) Graduate Group Mechanical Engineering & Applied Mechanics First Advisor Vijay Kumar

[1]  Maxim Likhachev,et al.  Anytime Safe Interval Path Planning for dynamic environments , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  E. Feron,et al.  Safe receding horizon path planning for autonomous vehicles , 2002 .

[3]  Tomás Lozano-Pérez,et al.  An algorithm for planning collision-free paths among polyhedral obstacles , 1979, CACM.

[4]  Daniel Mellinger,et al.  Trajectory generation and control for quadrotors , 2012 .

[5]  Sebastian Thrun,et al.  ARA*: Anytime A* with Provable Bounds on Sub-Optimality , 2003, NIPS.

[6]  Bruce Randall Donald,et al.  Kinodynamic motion planning , 1993, JACM.

[7]  P. B. Sujit,et al.  An evaluation of UAV path following algorithms , 2013, 2013 European Control Conference (ECC).

[8]  Anthony Stentz,et al.  Optimal and efficient path planning for partially-known environments , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

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

[10]  Roland Siegwart,et al.  Reciprocal Collision Avoidance With Motion Continuity Constraints , 2013, IEEE Transactions on Robotics.

[11]  Edwin Olson,et al.  Iterative path optimization for practical robot planning , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Oliver Brock,et al.  Planning Long Dynamically-Feasible Maneuvers for Autonomous Vehicles , 2009 .

[13]  Hossein Adeli,et al.  Path Planning for Mobile Robots using Iterative Artificial Potential Field Method , 2011 .

[14]  Vijay Kumar,et al.  Estimation, Control, and Planning for Aggressive Flight With a Small Quadrotor With a Single Camera and IMU , 2017, IEEE Robotics and Automation Letters.

[15]  Gaurav S. Sukhatme,et al.  Trajectory Planning for Quadrotor Swarms , 2018, IEEE Transactions on Robotics.

[16]  Kieran Forbes Culligan,et al.  Online trajectory planning for UAVs using mixed integer linear programming , 2006 .

[17]  Kostas E. Bekris,et al.  Efficient and complete centralized multi-robot path planning , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[18]  Vijay Kumar,et al.  Information-theoretic mapping using Cauchy-Schwarz Quadratic Mutual Information , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[19]  Markus Hehn,et al.  A Computationally Efficient Motion Primitive for Quadrocopter Trajectory Generation , 2015, IEEE Transactions on Robotics.

[20]  Erik I. Verriest,et al.  On the linear quadratic minimum-time problem , 1991 .

[21]  Lydia E. Kavraki,et al.  The Open Motion Planning Library , 2012, IEEE Robotics & Automation Magazine.

[22]  Panagiotis Tsiotras,et al.  Use of relaxation methods in sampling-based algorithms for optimal motion planning , 2013, 2013 IEEE International Conference on Robotics and Automation.

[23]  Maxim Likhachev,et al.  D*lite , 2002, AAAI/IAAI.

[24]  Abdelaziz Benallegue,et al.  Backstepping Control for a Quadrotor Helicopter , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[25]  Atsushi Yamashita,et al.  Effective improved artificial potential field-based regression search method for autonomous mobile robot path planning , 2013, Int. J. Mechatronics Autom..

[26]  Jean-Claude Latombe,et al.  Motion planning in the presence of moving obstacles , 1992 .

[27]  Jonathan P. How,et al.  Aggressive collision avoidance with limited field-of-view sensing , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[28]  Roland Siegwart,et al.  Continuous-time trajectory optimization for online UAV replanning , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[29]  Rudolph van der Merwe,et al.  The unscented Kalman filter for nonlinear estimation , 2000, Proceedings of the IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium (Cat. No.00EX373).

[30]  Vijay Kumar,et al.  Safe receding horizon control for aggressive MAV flight with limited range sensing , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[31]  Dimitri P. Bertsekas,et al.  Dynamic Programming and Optimal Control, Two Volume Set , 1995 .

[32]  Robin Deits,et al.  Computing Large Convex Regions of Obstacle-Free Space Through Semidefinite Programming , 2014, WAFR.

[33]  Maxim Likhachev,et al.  Path Planning with Adaptive Dimensionality , 2011, SOCS.

[34]  Shaojie Shen,et al.  Online generation of collision-free trajectories for quadrotor flight in unknown cluttered environments , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[35]  Vijay Kumar,et al.  Towards Collaborative Mapping and Exploration Using Multiple Micro Aerial Robots , 2014, ISER.

[36]  Vijay Kumar,et al.  Robust Stereo Visual Inertial Odometry for Fast Autonomous Flight , 2017, IEEE Robotics and Automation Letters.

[37]  Siddhartha S. Srinivasa,et al.  CHOMP: Gradient optimization techniques for efficient motion planning , 2009, 2009 IEEE International Conference on Robotics and Automation.

[38]  Anthony Stentz,et al.  Using interpolation to improve path planning: The Field D* algorithm , 2006, J. Field Robotics.

[39]  Vijay Kumar,et al.  Experiments in Fast, Autonomous, GPS-Denied Quadrotor Flight , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[40]  R. C. Coulter,et al.  Implementation of the Pure Pursuit Path Tracking Algorithm , 1992 .

[41]  Vijay Kumar,et al.  Incremental micro-UAV motion replanning for exploring unknown environments , 2013, 2013 IEEE International Conference on Robotics and Automation.

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

[43]  Jur P. van den Berg,et al.  Planning High-quality Paths and Corridors Amidst Obstacles , 2008, Int. J. Robotics Res..

[44]  Hanan Samet,et al.  A hierarchical strategy for path planning among moving obstacles [mobile robot] , 1989, IEEE Trans. Robotics Autom..

[45]  Wheeler Ruml,et al.  When Does Weighted A* Fail? , 2012, SOCS.

[46]  Claire J. Tomlin,et al.  Quadrotor Helicopter Trajectory Tracking Control , 2008 .

[47]  Timothy W. McLain,et al.  Vector Field Path Following for Miniature Air Vehicles , 2007, IEEE Transactions on Robotics.

[48]  Charles W. Warren,et al.  Global path planning using artificial potential fields , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[49]  Daniel E. Koditschek,et al.  Smooth extensions of feedback motion planners via reference governors , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[50]  Raffaello D'Andrea,et al.  Quadrocopter Trajectory Generation and Control , 2011 .

[51]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[52]  Robin Deits,et al.  Efficient mixed-integer planning for UAVs in cluttered environments , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[53]  Vijay Kumar,et al.  High speed navigation for quadrotors with limited onboard sensing , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[54]  Dinesh Manocha,et al.  Generalized velocity obstacles , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[55]  Zvi Shiller,et al.  Motion planning in dynamic environments: obstacles moving along arbitrary trajectories , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[56]  Vijay Kumar,et al.  Fast, autonomous flight in GPS‐denied and cluttered environments , 2017, J. Field Robotics.

[57]  Dinesh Manocha,et al.  Reciprocal Velocity Obstacles for real-time multi-agent navigation , 2008, 2008 IEEE International Conference on Robotics and Automation.

[58]  Makoto Kumon,et al.  Optimal path planning method with attitude constraints for quadrotor helicopters , 2014, Proceedings of the 2014 International Conference on Advanced Mechatronic Systems.

[59]  Jean-Claude Latombe,et al.  Randomized Kinodynamic Motion Planning with Moving Obstacles , 2002, Int. J. Robotics Res..

[60]  Vijay Kumar,et al.  Hold Or take Optimal Plan (HOOP): A quadratic programming approach to multi-robot trajectory generation , 2018, Int. J. Robotics Res..

[61]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[62]  Vijay Kumar,et al.  Search-Based Motion Planning for Aggressive Flight in SE(3) , 2017, IEEE Robotics and Automation Letters.

[63]  Robin Deits,et al.  Footstep planning on uneven terrain with mixed-integer convex optimization , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

[64]  Taeyoung Lee,et al.  Geometric tracking control of a quadrotor UAV on SE(3) , 2010, 49th IEEE Conference on Decision and Control (CDC).

[65]  Ross A. Knepper,et al.  Differentially constrained mobile robot motion planning in state lattices , 2009 .

[66]  Steven M. LaValle,et al.  Rapidly-Exploring Random Trees: Progress and Prospects , 2000 .

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

[68]  Davide Scaramuzza,et al.  Aggressive quadrotor flight through narrow gaps with onboard sensing and computing using active vision , 2016, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[69]  Vijay Kumar,et al.  Autonomous multi-floor indoor navigation with a computationally constrained MAV , 2011, 2011 IEEE International Conference on Robotics and Automation.

[70]  Nils J. Nilsson,et al.  A Formal Basis for the Heuristic Determination of Minimum Cost Paths , 1968, IEEE Trans. Syst. Sci. Cybern..

[71]  Alban Grastien,et al.  Online Graph Pruning for Pathfinding On Grid Maps , 2011, AAAI.

[72]  Y. Bouktir,et al.  Trajectory planning for a quadrotor helicopter , 2008, 2008 16th Mediterranean Conference on Control and Automation.

[73]  Vijay Kumar,et al.  Towards Search-based Motion Planning for Micro Aerial Vehicles , 2018, ArXiv.

[74]  Kartik Mohta,et al.  Search-based motion planning for quadrotors using linear quadratic minimum time control , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[75]  David Furcy,et al.  Lifelong Planning A , 2004, Artif. Intell..

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

[77]  Vijay Kumar,et al.  A Survey on Aerial Swarm Robotics , 2018, IEEE Transactions on Robotics.

[78]  Kazuya Yoshida,et al.  Collaborative mapping of an earthquake‐damaged building via ground and aerial robots , 2012, J. Field Robotics.

[79]  Roland Siegwart,et al.  Collaborative transportation using MAVs via passive force control , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[80]  Vijay Kumar,et al.  Capt: Concurrent assignment and planning of trajectories for multiple robots , 2014, Int. J. Robotics Res..

[81]  S. LaValle Rapidly-exploring random trees : a new tool for path planning , 1998 .

[82]  Wolfram Burgard,et al.  OctoMap: an efficient probabilistic 3D mapping framework based on octrees , 2013, Autonomous Robots.

[83]  Maxim Likhachev,et al.  SIPP: Safe interval path planning for dynamic environments , 2011, 2011 IEEE International Conference on Robotics and Automation.

[84]  Vijay Kumar,et al.  Planning Dynamically Feasible Trajectories for Quadrotors Using Safe Flight Corridors in 3-D Complex Environments , 2017, IEEE Robotics and Automation Letters.

[85]  Goele Pipeleers,et al.  Time-optimal quadrotor flight , 2013, 2013 European Control Conference (ECC).

[86]  Ian R. Manchester,et al.  LQR-trees: Feedback Motion Planning via Sums-of-Squares Verification , 2010, Int. J. Robotics Res..

[87]  Radu Bogdan Rusu,et al.  3D is here: Point Cloud Library (PCL) , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

[89]  James Biggs,et al.  Near minimum-time trajectories for quadrotor UAVs in complex environments , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[90]  Daniel Cremers,et al.  Real-time trajectory replanning for MAVs using uniform B-splines and a 3D circular buffer , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[91]  Paolo Fiorini,et al.  Motion Planning in Dynamic Environments Using Velocity Obstacles , 1998, Int. J. Robotics Res..

[92]  Maxim Likhachev,et al.  Path planning for non-circular micro aerial vehicles in constrained environments , 2013, 2013 IEEE International Conference on Robotics and Automation.

[93]  Victor M. Becerra,et al.  Optimal control , 2008, Scholarpedia.

[94]  Yi Lin,et al.  Gradient-based online safe trajectory generation for quadrotor flight in complex environments , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[95]  Mark H. Overmars,et al.  A Comparative Study of Probabilistic Roadmap Planners , 2002, WAFR.

[96]  Dai Feng,et al.  Acceleration-constrained time-optimal control in n dimensions , 1986 .