Combined Speed and Steering Control in High-Speed Autonomous Ground Vehicles for Obstacle Avoidance Using Model Predictive Control

This paper presents a model predictive control-based obstacle avoidance algorithm for autonomous ground vehicles at high speed in unstructured environments. The novelty of the algorithm is its capability to control the vehicle to avoid obstacles at high speed taking into account dynamical safety constraints through a simultaneous optimization of reference speed and steering angle without a priori knowledge about the environment and without a reference trajectory to follow. Previous work in this specific context optimized only the steering command. In this paper, obstacles are detected using a planar light detection and ranging sensor. A multi-phase optimal control problem is then formulated to simultaneously optimize the reference speed and steering angle within the detection range. Vehicle acceleration capability as a function of speed, as well as stability and handling concerns such as preventing wheel lift-off, are included as constraints in the optimization problem, whereas the cost function is formulated to navigate the vehicle as quickly as possible with smooth control commands. Simulation results show that the proposed algorithm is capable of safely exploiting the dynamic limits of the vehicle while navigating the vehicle through sensed obstacles of different sizes and numbers. It is also shown that the proposed variable speed formulation can significantly improve performance by allowing navigation of obstacle fields that would otherwise not be cleared with steering control alone.

[1]  Zoran Filipi,et al.  Validation and Use of SIMULINK Integrated, High Fidelity, Engine-In-Vehicle Simulation of the International Class VI Truck , 2000 .

[2]  Huei Peng,et al.  Rollover Warning for Articulated Heavy Vehicles Based on a Time-to-Rollover Metric , 2005 .

[3]  Kyongsu Yi,et al.  Obstacle avoidance of autonomous vehicles based on model predictive control , 2009 .

[4]  W. Hager,et al.  An hp‐adaptive pseudospectral method for solving optimal control problems , 2011 .

[5]  Tulga Ersal,et al.  A nonlinear model predictive control formulation for obstacle avoidance in high-speed autonomous ground vehicles in unstructured environments , 2018 .

[6]  Francesco Borrelli,et al.  Predictive control for agile semi-autonomous ground vehicles using motion primitives , 2012, 2012 American Control Conference (ACC).

[7]  Alessandro Rucco,et al.  Optimal Control Based Dynamics Exploration of a Rigid Car With Longitudinal Load Transfer , 2014, IEEE Transactions on Control Systems Technology.

[8]  Tulga Ersal,et al.  An MPC Algorithm With Combined Speed and Steering Control for Obstacle Avoidance in Autonomous Ground Vehicles , 2015 .

[9]  Adnan Tahirovic,et al.  General Framework for Mobile Robot Navigation Using Passivity-Based MPC , 2011, IEEE Transactions on Automatic Control.

[10]  Subhash Rakheja,et al.  Development of Directional Stability Criteria for an Early Warning Safety Device , 1990 .

[11]  K. Belarbi,et al.  Nonlinear model predictive control of quadcopter , 2015, 2015 16th International Conference on Sciences and Techniques of Automatic Control and Computer Engineering (STA).

[12]  Edsger W. Dijkstra,et al.  A note on two problems in connexion with graphs , 1959, Numerische Mathematik.

[13]  David H. Douglas,et al.  ALGORITHMS FOR THE REDUCTION OF THE NUMBER OF POINTS REQUIRED TO REPRESENT A DIGITIZED LINE OR ITS CARICATURE , 1973 .

[14]  Tulga Ersal,et al.  A Multi-Stage Optimization Formulation for MPC-Based Obstacle Avoidance in Autonomous Vehicles Using a LIDAR Sensor , 2014 .

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

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

[17]  Taehyun Shim,et al.  Understanding the limitations of different vehicle models for roll dynamics studies , 2007 .

[18]  Hosam K. Fathy,et al.  A Review of Proper Modeling Techniques , 2008 .

[19]  O. Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[20]  Jonas Sjöberg,et al.  Receding horizon maneuver generation for automated highway driving , 2015 .

[21]  Zoran Filipi,et al.  Development and model-based transparency analysis of an Internet-distributed hardware-in-the-loop simulation platform , 2011 .

[22]  Jonathan P. How,et al.  Robust Sampling-based Motion Planning with Asymptotic Optimality Guarantees , 2013 .

[23]  Yoji Kuroda,et al.  High-speed navigation of unmanned ground vehicles on uneven terrain using potential fields , 2007, Robotica.

[24]  A. Hussein,et al.  Metaheuristic optimization approach to mobile robot path planning , 2012, 2012 International Conference on Engineering and Technology (ICET).

[25]  Francesco Borrelli,et al.  Predictive Control of Autonomous Ground Vehicles With Obstacle Avoidance on Slippery Roads , 2010 .

[26]  Petter Ögren,et al.  A convergent dynamic window approach to obstacle avoidance , 2005, IEEE Transactions on Robotics.

[27]  Michel Basset,et al.  Reference generation and control strategy for automated vehicle guidance , 2012, 2012 IEEE Intelligent Vehicles Symposium.

[28]  Tulga Ersal,et al.  The Role of Model Fidelity in Model Predictive Control Based Hazard Avoidance in Unmanned Ground Vehicles Using Lidar Sensors , 2013 .

[29]  Karl Hedrick.  Brake System Modeling, Control and Integrated Brake/Throttle Switching: Phase I , 1997 .

[30]  J. Christian Gerdes,et al.  Model Predictive Control for Vehicle Stabilization at the Limits of Handling , 2013, IEEE Transactions on Control Systems Technology.

[31]  Henrik Gollee,et al.  Trajectory generation for road vehicle obstacle avoidance using convex optimization , 2010 .

[32]  J. Christian Gerdes,et al.  Shared Steering Control Using Safe Envelopes for Obstacle Avoidance and Vehicle Stability , 2016, IEEE Transactions on Intelligent Transportation Systems.

[33]  Emilio Frazzoli,et al.  Optimal motion planning with the half-car dynamical model for autonomous high-speed driving , 2013, 2013 American Control Conference.

[34]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..