TOPPQuad: Dynamically-Feasible Time Optimal Path Parametrization for Quadrotors (2309.11637v2)
Abstract: Planning time-optimal trajectories for quadrotors in cluttered environments is a challenging, non-convex problem. This paper addresses minimizing the traversal time of a given collision-free geometric path without violating bounds on individual motor thrusts of the vehicle. Previous approaches have either relied on convex relaxations that do not guarantee dynamic feasibility, or have generated overly conservative time parametrizations. We propose TOPPQuad, a time-optimal path parameterization algorithm for quadrotors which explicitly incorporates quadrotor rigid body dynamics and constraints such as bounds on inputs (including motor speeds) and state of the vehicle (including the pose, linear and angular velocity and acceleration). We demonstrate the ability of the planner to generate faster trajectories that respect hardware constraints of the robot compared to several planners with relaxed notions of dynamic feasibility. We also demonstrate how TOPPQuad can be used to plan trajectories for quadrotors that utilize bidirectional motors. Overall, the proposed approach paves a way towards maximizing the efficacy of autonomous micro aerial vehicles while ensuring their safety.
- S. M. LaValle, “Planning algorithms.” Cambridge university press, 2006, ch. 14, pp. ”841–855”.
- D. Mellinger and V. Kumar, “Minimum snap trajectory generation and control for quadrotors,” in 2011 IEEE international conference on robotics and automation. IEEE, 2011, pp. 2520–2525.
- M. J. Van Nieuwstadt and R. M. Murray, “Real-time trajectory generation for differentially flat systems,” International Journal of Robust and Nonlinear Control: IFAC-Affiliated Journal, vol. 8, no. 11, pp. 995–1020, 1998.
- M. Hehn and R. D’Andrea, “Real-time trajectory generation for quadrocopters,” IEEE Transactions on Robotics, vol. 31, no. 4, pp. 877–892, 2015.
- C. Richter, A. Bry, and N. Roy, “Polynomial trajectory planning for aggressive quadrotor flight in dense indoor environments,” in Robotics Research: The 16th International Symposium ISRR. Springer, 2016, pp. 649–666.
- S. Liu, K. Mohta, N. Atanasov, and V. Kumar, “Search-based motion planning for aggressive flight in se (3),” IEEE Robotics and Automation Letters, vol. 3, no. 3, pp. 2439–2446, 2018.
- Z. Wang, X. Zhou, C. Xu, and F. Gao, “Geometrically constrained trajectory optimization for multicopters,” IEEE Transactions on Robotics, vol. 38, no. 5, pp. 3259–3278, 2022.
- T. Lee, M. Leok, and N. H. McClamroch, “Geometric tracking control of a quadrotor uav on se(3),” in 49th IEEE Conference on Decision and Control (CDC), 2010, pp. 5420–5425.
- J. E. Bobrow, S. Dubowsky, and J. S. Gibson, “Time-optimal control of robotic manipulators along specified paths,” The international journal of robotics research, vol. 4, no. 3, pp. 3–17, 1985.
- D. Verscheure, B. Demeulenaere, J. Swevers, J. De Schutter, and M. Diehl, “Time-optimal path tracking for robots: A convex optimization approach,” IEEE Transactions on Automatic Control, vol. 54, no. 10, pp. 2318–2327, 2009.
- T. Lipp and S. Boyd, “Minimum-time speed optimisation over a fixed path,” International Journal of Control, vol. 87, no. 6, pp. 1297–1311, 2014.
- H. Nguyen and Q.-C. Pham, “Time-optimal path parameterization of rigid-body motions: Applications to spacecraft reorientation,” Journal of Guidance, Control, and Dynamics, vol. 39, no. 7, pp. 1667–1671, 2016.
- H. Pham and Q.-C. Pham, “A new approach to time-optimal path parameterization based on reachability analysis,” IEEE Transactions on Robotics, vol. 34, no. 3, pp. 645–659, 2018.
- G. Ryou, E. Tal, and S. Karaman, “Multi-fidelity black-box optimization for time-optimal quadrotor maneuvers,” The International Journal of Robotics Research, vol. 40, no. 12-14, pp. 1352–1369, 2021.
- P. Foehn, A. Romero, and D. Scaramuzza, “Time-optimal planning for quadrotor waypoint flight,” Science Robotics, vol. 6, no. 56, p. eabh1221, 2021.
- L. Consolini, M. Locatelli, A. Minari, and A. Piazzi, “An optimal complexity algorithm for minimum-time velocity planning,” Systems & Control Letters, vol. 103, pp. 50–57, 2017.
- I. Spasojevic, V. Murali, and S. Karaman, “Asymptotic optimality of a time optimal path parametrization algorithm,” IEEE Control Systems Letters, vol. 3, no. 4, pp. 835–840, 2019.
- W. Giernacki, M. Skwierczyński, W. Witwicki, P. Wroński, and P. Kozierski, “Crazyflie 2.0 quadrotor as a platform for research and education in robotics and control engineering,” in 2017 22nd International Conference on Methods and Models in Automation and Robotics (MMAR), 2017, pp. 37–42.
- P. Virtanen, R. Gommers, T. E. Oliphant, M. Haberland, T. Reddy, D. Cournapeau, E. Burovski, P. Peterson, W. Weckesser, J. Bright, S. J. van der Walt, M. Brett, J. Wilson, K. J. Millman, N. Mayorov, A. R. J. Nelson, E. Jones, R. Kern, E. Larson, C. J. Carey, İ. Polat, Y. Feng, E. W. Moore, J. VanderPlas, D. Laxalde, J. Perktold, R. Cimrman, I. Henriksen, E. A. Quintero, C. R. Harris, A. M. Archibald, A. H. Ribeiro, F. Pedregosa, P. van Mulbregt, and SciPy 1.0 Contributors, “SciPy 1.0: Fundamental Algorithms for Scientific Computing in Python,” Nature Methods, vol. 17, pp. 261–272, 2020.
- S. Diamond and S. Boyd, “CVXPY: A Python-embedded modeling language for convex optimization,” Journal of Machine Learning Research, vol. 17, no. 83, pp. 1–5, 2016.
- J. A. E. Andersson, J. Gillis, G. Horn, J. B. Rawlings, and M. Diehl, “CasADi – A software framework for nonlinear optimization and optimal control,” Mathematical Programming Computation, vol. 11, no. 1, pp. 1–36, 2019.
- K. Mao, J. Welde, M. A. Hsieh, and V. Kumar, “Trajectory planning for the bidirectional quadrotor as a differentially flat hybrid system,” in 2023 IEEE International Conference on Robotics and Automation (ICRA), 2023, pp. 1242–1248.
- L. Jarin-Lipschitz, X. Liu, Y. Tao, and V. Kumar, “Experiments in adaptive replanning for fast autonomous flight in forests,” in 2022 International Conference on Robotics and Automation (ICRA), 2022, pp. 8185–8191.
- X. Liu, G. V. Nardari, F. C. Ojeda, Y. Tao, A. Zhou, T. Donnelly, C. Qu, S. W. Chen, R. A. F. Romero, C. J. Taylor, and V. Kumar, “Large-scale autonomous flight with real-time semantic slam under dense forest canopy,” IEEE Robotics and Automation Letters, vol. 7, no. 2, pp. 5512–5519, 2022.
- M.-J. Kim, M.-S. Kim, and S. Y. Shin, “A general construction scheme for unit quaternion curves with simple high order derivatives,” in Proceedings of the 22nd annual conference on Computer graphics and interactive techniques, 1995, pp. 369–376.
- Katherine Mao (5 papers)
- Igor Spasojevic (19 papers)
- M. Ani Hsieh (43 papers)
- Vijay Kumar (191 papers)