Motion Planning for Autonomous Vehicles Considering Longitudinal and Lateral Dynamics Coupling

Vehicles are highly coupled and multi-degree nonlinear systems. The establishment of an appropriate vehicle dynamical model is the basis of motion planning for autonomous vehicles. With the development of autonomous vehicles from L2 to L3 and beyond, the automatic driving system is required to make decisions and plans in a wide range of speeds and on bends with large curvature. In order to make precise and high-quality control maneuvers, it is important to account for the effects of dynamical coupling in these working conditions. In this paper, a new single-coupled dynamical model (SDM) is proposed to deal with the various dynamical coupling effects by identifying and simplifying the complicated one. An autonomous vehicle motion planning problem is then formulated using the nonlinear model predictive control theory (NMPC) with the SDM constraint (NMPC-SDM). We validated the NMPC-SDM with hardware-in-the-loop (HIL) experiments to evaluate improvements to control performance by comparing with the planners original design, using the kinematic and single-track models. The comparative results show the superiority of the proposed motion planning algorithm in improving the maneuverability and tracking performance.