Real-time trajectory planning for automated vehicle safety and performance in dynamic environments

Safe trajectory planning for high-performance automated vehicles in an environment with both static and moving obstacles is a challenging problem. Part of the challenge is developing a formulation that can be solved in real-time while including the following set of specifications: minimum time-to-goal, a dynamic vehicle model, minimum control effort, both static and moving obstacle avoidance, simultaneous optimization of speed and steering, and a short execution horizon. This paper presents a nonlinear model predictive control-based trajectory planning formulation, tailored for a large, high-speed unmanned ground vehicle, that includes the above set of specifications. This paper also evaluates NLOptControl's ability to solve this formulation in real-time in conjunction with the KNITRO nonlinear programming problem solver; NLOptControl is our open-source, direct-collocation based, optimal control problem solver. This formulation is tested with various sets of the specifications. In particular, a parametric study relating execution horizon and obstacle speed, indicates that the moving obstacle avoidance specification is not needed for safety when the planner has a small execution horizon ($\leq0.375\;s$) and the obstacles are moving slowly ($\leq2.11\frac{m}{s}$). However, a moving obstacle avoidance specification is needed when the obstacles are moving faster, and this specification improves the overall safety by a factor of $6.73$ ($p=2.2\times10^{-16}$) without, in most cases, increasing the solve-times. Overall, the results indicate that (1) safe trajectory planners for high-performance automated vehicles should include the entire set of specifications mentioned above, unless a static or low-speed environment permits a less comprehensive planner; and (2) NLOptControl can solve the formulation in real-time.

[1]  Kazuma Sekiguchi,et al.  Moving obstacle avoidance control by fuzzy potential method and model predictive control , 2017, 2017 11th Asian Control Conference (ASCC).

[2]  Honglun Wang,et al.  Real-time path planning of unmanned aerial vehicle for target tracking and obstacle avoidance in complex dynamic environment , 2015 .

[3]  Naser Mehrabi,et al.  Nonlinear model predictive control of an upper extremity rehabilitation robot using a two-dimensional human-robot interaction model , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[4]  J. Maciejowski,et al.  Soft constraints and exact penalty functions in model predictive control , 2000 .

[5]  E. Feron,et al.  Real-time motion planning for agile autonomous vehicles , 2000, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[6]  John T. Betts,et al.  Practical Methods for Optimal Control and Estimation Using Nonlinear Programming , 2009 .

[7]  Hans B. Pacejka,et al.  Tire and Vehicle Dynamics , 1982 .

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

[9]  Tulga Ersal,et al.  Combined Speed and Steering Control in High-Speed Autonomous Ground Vehicles for Obstacle Avoidance Using Model Predictive Control , 2017, IEEE Transactions on Vehicular Technology.

[10]  J. Rawlings,et al.  Feasibility issues in linear model predictive control , 1999 .

[11]  Tulga Ersal,et al.  Moving obstacle avoidance for large, high-speed autonomous ground vehicles , 2017, 2017 American Control Conference (ACC).

[12]  Zoltan K. Nagy,et al.  Swelling Constrained Control of an Industrial Batch Reactor Using a Dedicated NMPC Environment: OptCon , 2009 .

[13]  Matthew Kelly,et al.  An Introduction to Trajectory Optimization: How to Do Your Own Direct Collocation , 2017, SIAM Rev..

[14]  Tulga Ersal,et al.  A study on model fidelity for model predictive control-based obstacle avoidance in high-speed autonomous ground vehicles , 2016 .

[15]  Alvar Saenz-Otero,et al.  Model Predictive Control with Ellipsoid Obstacle Constraints for Spacecraft Rendezvous , 2015 .

[16]  P. Alam.  ‘G’ , 2021, Composites Engineering: An A–Z Guide.

[17]  Xiaojing Zhang,et al.  Optimization-Based Collision Avoidance , 2017, IEEE Transactions on Control Systems Technology.

[18]  Oleg A. Yakimenko,et al.  Computing short-time aircraft maneuvers using direct methods , 2010 .

[19]  J. Christian Gerdes,et al.  Using the centre of percussion to design a steering controller for an autonomous race car , 2012 .

[20]  Sebastian Thrun,et al.  Stanley: The robot that won the DARPA Grand Challenge , 2006, J. Field Robotics.

[21]  Emilio Frazzoli,et al.  A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles , 2016, IEEE Transactions on Intelligent Vehicles.

[22]  Charles C MacAdam.  Development of driver/vehicle steering interaction models for dynamic analysis. Final technical report , 1986 .

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

[24]  Michael Bosse,et al.  Driving on Point Clouds: Motion Planning, Trajectory Optimization, and Terrain Assessment in Generic Nonplanar Environments , 2017, J. Field Robotics.

[25]  Nicolas Mansard,et al.  Trajectory generation for quadrotor based systems using numerical optimal control , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[26]  P. Tsiotras,et al.  Aggressive maneuvers on loose surfaces: Data analysis and input parametrization , 2007, 2007 Mediterranean Conference on Control & Automation.

[27]  Christos Katrakazas,et al.  Real-time motion planning methods for autonomous on-road driving: State-of-the-art and future research directions , 2015 .

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

[29]  Colin Greatwood,et al.  Implementation of Fast MPC with a Quadrotor for Obstacle Avoidance , 2013 .

[30]  Michael C Lo,et al.  High-Mobility Multipurpose Wheeled Vehicle Rollover Accidents and Injuries to U.S. Army Soldiers by Reported Occupant Restraint Use, 1992-2013. , 2017, Military medicine.

[31]  Francesco Borrelli,et al.  An auto-generated nonlinear MPC algorithm for real-time obstacle avoidance of ground vehicles , 2013, 2013 European Control Conference (ECC).

[32]  S. Shankar Sastry,et al.  Model-predictive active steering and obstacle avoidance for autonomous ground vehicles , 2009 .