Model Predictive Planning: Trajectory Planning in Obstruction-Dense Environments for Low-Agility Aircraft (2309.16024v2)
Abstract: We present Model Predictive Planning (MPP), a trajectory planner for low-agility vehicles such as a fixed-wing aircraft to navigate obstacle-laden environments. MPP consists of (1) a multi-path planning procedure that identifies candidate paths, (2) a raytracing procedure that generates linear constraints around these paths to enforce obstacle avoidance, and (3) a convex quadratic program that finds a feasible trajectory within these constraints if one exists. Low-agility aircraft cannot track arbitrary paths, so refining a given path into a trajectory that respects the vehicle's limited maneuverability and avoids obstacles often leads to an infeasible optimization problem. The critical feature of MPP is that it efficiently considers multiple candidate paths during the refinement process, thereby greatly increasing the chance of finding a feasible and trackable trajectory. We demonstrate the effectiveness of MPP on a longitudinal aircraft model.
- M. A. Patterson and A. V. Rao, “GPOPS-II: A MATLAB software for solving multiple-phase optimal control problems using hp-adaptive gaussian quadrature collocation methods and sparse nonlinear programming,” ACM Transactions on Mathematical Software (TOMS), vol. 41, no. 1, pp. 1–37, 2014.
- P. E. Rutquist and M. M. Edvall, “PROPT-Matlab optimal control software,” Tomlab Optimization Inc, vol. 260, no. 1, p. 12, 2010.
- J. H. Lee, “Model predictive control: Review of the three decades of development,” International Journal of Control, Automation and Systems, vol. 9, pp. 415–424, 2011.
- S. Karaman and E. Frazzoli, “Sampling-based algorithms for optimal motion planning,” International Journal of Robotics Research, vol. 30, no. 7, pp. 846–894, 2011.
- M. Ryll, J. Ware, J. Carter, and N. Roy, “Efficient trajectory planning for high speed flight in unknown environments,” in IEEE International Conference on Robotics and Automation (ICRA), 2019, pp. 732–738.
- R. F. Stengel, “Longitudinal motions,” in Flight Dynamics. Princeton University Press, 2005, ch. 5.
- M. Grant and S. Boyd, “CVX: Matlab software for disciplined convex programming, version 2.1,” http://cvxr.com/cvx, Mar. 2014.
- ——, “Graph implementations for nonsmooth convex programs,” in Recent Advances in Learning and Control, ser. Lecture Notes in Control and Information Sciences, V. Blondel, S. Boyd, and H. Kimura, Eds. Springer-Verlag Limited, 2008, pp. 95–110, http://stanford.edu/~boyd/graph_dcp.html.
- S. Fuller, B. Greiner, J. Moore, R. Murray, R. van Paassen, and R. Yorke, “The python control systems library (python-control),” in IEEE Conference on Decision and Control (CDC), 2021, pp. 4875–4881.
- S. Choudhury, S. Scherer, and S. Singh, “RRT*-AR: Sampling-based alternate routes planning with applications to autonomous emergency landing of a helicopter,” in IEEE International Conference on Robotics and Automation (ICRA), 2013, pp. 3947–3952.
- C. Meerpohl, M. Rick, and C. Büskens, “Free-space polygon creation based on occupancy grid maps for trajectory optimization methods,” IFAC-PapersOnLine, vol. 52, no. 8, pp. 368–374, 2019, 10th IFAC Symposium on Intelligent Autonomous Vehicles.
- D. Malyuta, T. P. Reynolds, M. Szmuk, T. Lew, R. Bonalli, M. Pavone, and B. Açıkmeşe, “Convex optimization for trajectory generation: A tutorial on generating dynamically feasible trajectories reliably and efficiently,” IEEE Control Systems Magazine, vol. 42, no. 5, pp. 40–113, 2022.