Abstract
We explore the challenges of planning trajectories for quadrotors through cluttered indoor environments. We extend the existing work on polynomial trajectory generation by presenting a method of jointly optimizing polynomial path segments in an unconstrained quadratic program that is numerically stable for high-order polynomials and large numbers of segments, and is easily formulated for efficient sparse computation. We also present a technique for automatically selecting the amount of time allocated to each segment, and hence the quadrotor speeds along the path, as a function of a single parameter determining aggressiveness, subject to actuator constraints. The use of polynomial trajectories, coupled with the differentially flat representation of the quadrotor, eliminates the need for computationally intensive sampling and simulation in the high dimensional state space of the vehicle during motion planning. Our approach generates high-quality trajecrtories much faster than purely sampling-based optimal kinodynamic planning methods, but sacrifices the guarantee of asymptotic convergence to the global optimum that those methods provide. We demonstrate the performance of our algorithm by efficiently generating trajectories through challenging indoor spaces and successfully traversing them at speeds up to 8 m/s. A demonstration of our algorithm and flight performance is available at: http://groups.csail.mit.edu/rrg/quad_polynomial_trajectory_planning.
Access this chapter
Tax calculation will be finalised at checkout
Purchases are for personal use only
References
Abbeel, P., Coates, A., Ng, A.: Autonomous helicopter aerobatics through apprenticeship learning. Int. J. Robot. Res. 29(13), 1608–1639 (2010)
Bertsekas, D.P.: Nonlinear Programming. Athena Scientific, Belmont (1999)
Betts, J.T.: Survey of numerical methods for trajectory optimization. J. Guid. Control Dyn. 21(2), 193–207 (1998)
Bry, A., Bachrach, A., Roy, N.: State estimation for aggressive flight in GPS-denied environments using onboard sensing. In: Proceedings of the International Conference on Robotics and Automation (2012)
Cutler, M., How, J.: Actuator constrained trajectory generation and control for variable-pitch quadrotors. In: Proceedings of the AIAA Guidance, Navigation, and Control Conference (2012)
Faiz, N., Agrawal, S., Murray, R.: Differentially flat systems with inequality constraints: an approach to real-time feasible trajectory generation. J. Guid. Control Dyn. 24(2), 219–227 (2001)
Guennebaud, G., Jacob, B., et al.: Eigen v3 (2010). http://eigen.tuxfamily.org
Hauser, J., Hindman, R.: Aggressive flight maneuvers. In: Proceedings of Conference on Decision and Control (1997)
Hehn, M., D’Andrea, R.: Quadrocopter trajectory generation and control. In: Internatioanl Federation of Automatic Control, World Congress (2011)
How, J.P., Bethke, B., Frank, A., Dale, D., Vian, J.: Real-time indoor autonomous vehicle test environment. IEEE Control Syst. 28(2), 51–64 (2008)
Jeon, J.H., Karaman, S., Frazzoli, E.: Anytime computation of time-optimal off-road vehicle maneuvers using the RRT*. In: Conference on Decision and Control (2011)
Karaman, S., Frazzoli, E.: Incremental sampling-based algorithms for optimal motion planning. In: Proceedings of Robotics Science and Systems (2010)
Karaman, S., Frazzoli, E.: Optimal kinodynamic motion planning using incremental sampling-based methods. In: Conference on Decision and Control (2010)
Kavraki, L.E., et al.: Probabilistic roadmaps for path planning in high-dimensional configuration spaces. IEEE Trans. Robot. Autom. 12(4), 566–580 (1996)
Kuwata, Y., et al.: Real-time motion planning with applications to autonomous urban driving. IEEE Trans. Control Syst. Technol. 17(5), 1105–1118 (2009)
LaValle, S.M., Kuffner, J.J.: Rapidly-exploring random trees: Progress and prospects. In: Workshop on Algorithmic Foundations of Robotics (2000)
LaValle, S.M., Kuffner, J.J.: Randomized kinodynamic planning. Int. J. Robot. Res. 20(5), 378–400 (2001)
Lee, T., Leoky, M., McClamroch, N.H.: Geometric tracking control of a quadrotor uav on se(3). In: Conference on Decision and Control (2010)
Mellinger, D., Kumar. V.: Minimum snap trajectory generation and control for quadrotors. In: Proceedings of International Conference on Robotics and Automation (2011)
Mellinger, D., Michael, N., Kumar, V.: Trajectory generation and control for precise aggressive maneuvers with quadrotors. In: Proceedings of International Symposium on Experimental Robotics (2010)
Mellinger, D., Kushleyev, A., Kumar, V.: Mixed-integer quadratic program trajectory generation for heterogeneous quadrotor teams. In: Proceedings of International Conference on Robotics and Automation (2012)
Murray, R.M., Rathinam, M., Sluis, W.: Differential flatness of mechanical control systems: A catalog of prototype systems. In: Proceedings of ASME International Congress and Exposition (1995)
Pan, J., Zhang, L., Manocha, D.: Collision-free and smooth trajectory computation in cluttered environments. Int. J. Robot. Res. 31(10), 1155–1175 (2012)
Ritz, R., Hehn, M., Lupashin, S., D’Andrea, R.: Quadrocopter performance benchmarking using optimal control. In: Proceedings of International Conference on Intelligent Robots and Systems (2011)
Shen, S., Mulgaonkar, Y., Michael, N., Kumar, V.: Vision-based state estimation and trajectory control towards aggressive flight with a quadrotor. In: Proceedings of Robotics Science and Systems (2013)
Shkolnik, A., Walter, M., Tedrake, R.: Reachability-guided sampling for planning under differential constraints. In: Proceedings of International Conference on Robotics and Automation (2009)
Acknowledgments
The support of the ARO MAST CTA, the ONR under MURI N00014-09-1-1052, and the NDSEG fellowship is gratefully acknowledged.
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2016 Springer International Publishing Switzerland
About this chapter
Cite this chapter
Richter, C., Bry, A., Roy, N. (2016). Polynomial Trajectory Planning for Aggressive Quadrotor Flight in Dense Indoor Environments. In: Inaba, M., Corke, P. (eds) Robotics Research. Springer Tracts in Advanced Robotics, vol 114. Springer, Cham. https://doi.org/10.1007/978-3-319-28872-7_37
Download citation
DOI: https://doi.org/10.1007/978-3-319-28872-7_37
Published:
Publisher Name: Springer, Cham
Print ISBN: 978-3-319-28870-3
Online ISBN: 978-3-319-28872-7
eBook Packages: EngineeringEngineering (R0)