A Non-linear MPC Local Planner for Tractor-Trailer Vehicles in Forward and Backward Maneuvering

—Designing a local planner to control tractor-trailer vehicles in forward and backward maneuvering is a challenging control problem in the research community of autonomous driving systems. Considering a critical situation in the stability of tractor-trailer systems, a practical and novel approach is presented to design a non-linear MPC (NMPC) local planner for tractor-trailer autonomous vehicles in both forward and backward maneuvering. The tractor’s velocity and steering angle are considered as control variables. The proposed NMPC local planner is designed to handle jackknife situations, avoiding multiple static obstacles, and path following in both forward and backward maneuvering. The above-mentioned challenges are converted into a constrained problem that can be handled simultaneously by the proposed NMPC local planner. the direct multiple shooting approach is used to convert the optimal control problem (OCP) into a non-linear programming problem (NLP) that can be solved by IPOPT solvers in CasADi. The controller performance is evaluated through different backup and forward maneuvering scenarios in the Gazebo simulation environment in real-time and achieves asymptotic stability in avoiding static obstacles and accurate tracking performance while respecting path constraints. Finally, the proposed NMPC local planner is integrated with an open-source autonomous driving software stack called Autoware.ai.

[1]  Lihua Xie,et al.  Real-Time Perception-Limited Motion Planning Using Sampling-Based MPC , 2022, IEEE Transactions on Industrial Electronics.

[2]  Giuseppe Oriolo,et al.  Anti-Jackknifing Control of Tractor-Trailer Vehicles via Intrinsically Stable MPC , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Brian Bingham,et al.  Toward Maritime Robotic Simulation in Gazebo , 2019, OCEANS 2019 MTS/IEEE SEATTLE.

[4]  Mohamed W. Mehrez,et al.  Path-following and Adjustable Driving Behavior of Autonomous Vehicles using Dual-Objective Nonlinear MPC , 2019, 2019 IEEE International Conference of Vehicular Electronics and Safety (ICVES).

[5]  Hongzhi Zhang,et al.  Anti-jackknife reverse perpendicular parking control of tractor-trailer vehicle via MPC technique , 2019, 2019 IEEE 9th Annual International Conference on CYBER Technology in Automation, Control, and Intelligent Systems (CYBER).

[6]  Moritz Diehl,et al.  CasADi: a software framework for nonlinear optimization and optimal control , 2018, Mathematical Programming Computation.

[7]  Jing Ren,et al.  Optimal path planning for an autonomous articulated vehicle with two trailers , 2018, Int. J. Autom. Control..

[8]  Ming Yue,et al.  Composite Path Tracking Control for Tractor–Trailer Vehicles Via Constrained Model Predictive Control and Direct Adaptive Fuzzy Techniques , 2017 .

[9]  John Y. Hung,et al.  Path following for a tractor-trailer system using model predictive control , 2017, SoutheastCon 2017.

[10]  Christof Büskens,et al.  WORHP Zen: Parametric Sensitivity Analysis for the Nonlinear Programming Solver WORHP , 2017, OR.

[11]  Avinesh Prasad,et al.  A Geometric Approach to Motion Control of a Standard Tractor-Trailer Robot , 2016, 2016 3rd Asia-Pacific World Congress on Computer Science and Engineering (APWC on CSE).

[12]  Karl Worthmann,et al.  Model Predictive Control of Nonholonomic Mobile Robots Without Stabilizing Constraints and Costs , 2016, IEEE Transactions on Control Systems Technology.

[13]  Thomas Gustafsson,et al.  Effect of kinematic parameters on MPC based on-line motion planning for an articulated vehicle , 2015, Robotics Auton. Syst..

[14]  Thomas Gustafsson,et al.  Real-Time Bug-Like Dynamic Path Planning for an Articulated Vehicle , 2015 .

[15]  Peter Nilsson,et al.  Real-Time NMPC for Semi-Automated Highway Driving of Long Heavy Vehicle Combinations , 2015 .

[16]  Jianwei Zhang,et al.  Manipulation task simulation using ROS and Gazebo , 2014, 2014 IEEE International Conference on Robotics and Biomimetics (ROBIO 2014).

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

[18]  Taehyun Shim,et al.  Constrained model predictive control for backing-up tractor-trailer system , 2012, Proceedings of the 10th World Congress on Intelligent Control and Automation.

[19]  Suk-Hwan Lee,et al.  Vector watermarking scheme for GIS vector map management , 2013, Multimedia Tools and Applications.

[20]  Miguel Torres-Torriti,et al.  Introductory Survey to Open-Source Mobile Robot Simulation Software , 2010, 2010 Latin American Robotics Symposium and Intelligent Robotics Meeting.

[21]  Victor M. Zavala,et al.  Large-scale nonlinear programming using IPOPT: An integrating framework for enterprise-wide dynamic optimization , 2009, Comput. Chem. Eng..

[22]  Pierre-Brice Wieber,et al.  Fast Direct Multiple Shooting Algorithms for Optimal Robot Control , 2005 .

[23]  Peter Biber,et al.  The normal distributions transform: a new approach to laser scan matching , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[24]  Michael A. Saunders,et al.  SNOPT: An SQP Algorithm for Large-Scale Constrained Optimization , 2002, SIAM J. Optim..

[25]  Hans Bock,et al.  A Direct Multiple Shooting Method for Real-Time Optimization of Nonlinear DAE Processes , 2000 .

[26]  O. V. Stryk,et al.  Numerical Solution of Optimal Control Problems by Direct Collocation , 1993 .

[27]  H. Bock,et al.  A Multiple Shooting Algorithm for Direct Solution of Optimal Control Problems , 1984 .