Receding horizon lateral vehicle control for pure pursuit path tracking

The assimilation of path planning and motion control is a crucial capability for autonomous vehicles. Pure pursuit controllers are a prevalent class of path tracking algorithms for front wheel steering cars. Nonetheless, their performance is rather limited to relatively low speeds. In this paper, we propose a model predictive active yaw control implementation of pure pursuit path tracking that accommodates the vehicle’s steady state lateral dynamics to improve tracking performance at high speeds. A comparative numerical analysis was under taken between the proposed strategy and the traditional pure pursuit controller scheme. Tests were conducted for three different paths at iteratively increasing speeds from 1 m/s up to 20 m/s. The traditional pure pursuit controller was incapable of maintaining the vehicle stable at speeds upwards of 5m/s. The results show that implementing receding horizon strategy for pure pursuit tracking improves their performance. The contribution is apparent by preserving a relatively constant controller effort and consequently maintaining vehicle stability for speeds up to 100Km/h in different scenarios. A Matlab implementation of the proposed controller and datasets of the experimental paths are provided to supplement this work.

[1]  Milan Simic,et al.  Sampling-Based Robot Motion Planning: A Review , 2014, IEEE Access.

[2]  Ryan M. Eustice,et al.  Ford Campus vision and lidar data set , 2011, Int. J. Robotics Res..

[3]  C. D. Boor,et al.  On Calculating B-splines , 1972 .

[4]  Hans Godthelp,et al.  Speed Choice and Steering Behavior in Curve Driving , 1996, Hum. Factors.

[5]  A. Santos,et al.  Summary of Travel Trends: 2009 National Household Travel Survey , 2011 .

[6]  Marko Bacic,et al.  Model predictive control , 2003 .

[7]  Zuduo Zheng,et al.  Recent developments and research needs in modeling lane changing , 2014 .

[8]  T. Kanade,et al.  Toward autonomous driving: the CMU Navlab. II. Architecture and systems , 1991, IEEE Expert.

[9]  Michel Basset,et al.  Combined longitudinal and lateral control for automated vehicle guidance , 2014 .

[10]  Milan Simic,et al.  Steady-State Dynamic Steering , 2014, IDT/IIMSS/STET.

[11]  A. T. van Zanten,et al.  Bosch ESP Systems: 5 Years of Experience , 2000 .

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

[13]  Vicente Mut,et al.  Trajectory-tracking controller design with constraints in the control signals: a case study in mobile robots , 2015, Robotica.

[14]  Mark Whitty,et al.  Robotics, Vision and Control. Fundamental Algorithms in MATLAB , 2012 .

[15]  R. C. Coulter,et al.  Implementation of the Pure Pursuit Path Tracking Algorithm , 1992 .

[16]  Reza N. Jazar,et al.  Vehicle Dynamics: Theory and Application , 2009 .

[17]  Clifford Hildreth,et al.  A quadratic programming procedure , 1957 .

[18]  Rajesh Rajamani Lateral Vehicle Dynamics , 2012 .

[19]  Kara M. Kockelman,et al.  The Travel and Environmental Implications of Shared Autonomous Vehicles, Using Agent-Based Model Scenarios , 2014 .

[20]  Dinggang Shen,et al.  Lane detection and tracking using B-Snake , 2004, Image Vis. Comput..

[21]  Liuping Wang,et al.  Model Predictive Control System Design and Implementation Using MATLAB , 2009 .

[22]  Jarrod M. Snider Automatic Steering Methods for Autonomous Automobile Path Tracking , 2009 .

[23]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[24]  Kirstin L. R. Talvala,et al.  Pushing the limits: From lanekeeping to autonomous racing , 2011, Annu. Rev. Control..

[25]  Norhazimi Hamzah,et al.  A Review of Active Yaw Control System for Vehicle Handling and Stability Enhancement , 2014 .

[26]  William Payre,et al.  Intention to use a fully automated car: attitudes and a priori acceptability , 2014 .

[27]  Nanning Zheng,et al.  Efficient Sampling-Based Motion Planning for On-Road Autonomous Driving , 2015, IEEE Transactions on Intelligent Transportation Systems.

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

[29]  W. V. Winsum,et al.  Lane change manoeuvres and safety margins , 1999 .

[30]  Chris Urmson,et al.  Traffic light mapping and detection , 2011, 2011 IEEE International Conference on Robotics and Automation.

[31]  Jason S. McCarley,et al.  Lane Keeping Under Cognitive Load , 2014, Hum. Factors.

[32]  Milan Simic,et al.  Continuous Path Smoothing for Car-Like Robots Using B-Spline Curves , 2015, J. Intell. Robotic Syst..

[33]  David Q. Mayne,et al.  Model predictive control: Recent developments and future promise , 2014, Autom..

[34]  T. Kanade,et al.  Toward autonomous driving: the CMU Navlab. I. Perception , 1991, IEEE Expert.

[35]  Philippe Chevrel,et al.  Shared Steering Control Between a Driver and an Automation: Stability in the Presence of Driver Behavior Uncertainty , 2013, IEEE Transactions on Intelligent Transportation Systems.

[36]  Gustavo Scaglia,et al.  Trajectory Tracking Controller Design for Unmanned Vehicles: A New Methodology , 2014, J. Field Robotics.

[37]  Takeo Kanade,et al.  Toward autonomous driving: the CMU Navlab. Part I - Perception , 1991, IEEE Expert.

[38]  Azim Eskandarian,et al.  Vehicle Lateral and Steering Control , 2012 .

[39]  Philippe Martinet,et al.  Mixed kinematic and dynamic sideslip angle observer for accurate control of fast off-road mobile robots , 2010 .

[40]  Sebastian Thrun,et al.  Anytime search in dynamic graphs , 2008, Artif. Intell..

[41]  Hermann Winner,et al.  Three Decades of Driver Assistance Systems: Review and Future Perspectives , 2014, IEEE Intelligent Transportation Systems Magazine.

[42]  Vicente Milanés Montero,et al.  Low-Speed Longitudinal Controllers for Mass-Produced Cars: A Comparative Study , 2012, IEEE Transactions on Industrial Electronics.

[43]  Andreas Geiger,et al.  Vision meets robotics: The KITTI dataset , 2013, Int. J. Robotics Res..

[44]  Francesco Borrelli,et al.  Predictive Active Steering Control for Autonomous Vehicle Systems , 2007, IEEE Transactions on Control Systems Technology.

[45]  Michael Sivak,et al.  Public opinion about self-driving vehicles in China, India, Japan, the U.S., the U.K., and Australia , 2014 .

[46]  Claude Laurgeau Intelligent Vehicle Potential and Benefits , 2012 .

[47]  Fawzi Nashashibi,et al.  Adaptive steering control for autonomous lane change maneuver , 2013, 2013 IEEE Intelligent Vehicles Symposium (IV).

[48]  M. Mitchell Waldrop,et al.  Autonomous vehicles: No drivers required , 2015, Nature.

[49]  Michael Sivak,et al.  A Survey of Public Opinion about Autonomous and Self-Driving Vehicles in the U.S., the U.K., and Australia , 2014 .

[50]  Milan Simic,et al.  Improved manoeuvring of autonomous passenger vehicles: Simulations and field results , 2017 .

[51]  T.A. Johansen,et al.  Control allocation for yaw stabilization in automotive vehicles using multiparametric nonlinear programming , 2005, Proceedings of the 2005, American Control Conference, 2005..

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

[53]  John D. Lee,et al.  Fifty Years of Driving Safety Research , 2008, Hum. Factors.

[54]  Hampton C. Gabler,et al.  Safety Benefits of Forward Collision Warning, Brake Assist, and Autonomous Braking Systems in Rear-End Collisions , 2012, IEEE Transactions on Intelligent Transportation Systems.

[55]  S. A. Roth,et al.  Evaluating Path Tracker Performance for Outdoor Mobile Robots , 2002 .

[56]  Mohammad Fard,et al.  Steady-State Vehicle Dynamics , 2015 .

[57]  Georges Bastin,et al.  Structural properties and classification of kinematic and dynamic models of wheeled mobile robots , 1996, IEEE Trans. Robotics Autom..

[58]  Dongbing Gu,et al.  Neural predictive control for a car-like mobile robot , 2002, Robotics Auton. Syst..

[59]  Dongbing Gu,et al.  Receding horizon tracking control of wheeled mobile robots , 2006, IEEE Transactions on Control Systems Technology.

[60]  Sebastian Thrun,et al.  Autonomous driving in semi-structured environments: Mapping and planning , 2009, 2009 IEEE International Conference on Robotics and Automation.