PI2-CMA Based Trajectory Planning Method for the Tractor-Trailer Vehicle

The motion primitive-based state lattice trajectory planning method has been widely used in the field of trajectory planning. However, due to the limitations of the search space and resolution of motion primitives, and the lack of consideration of scenario information during offline generation of motion primitives, the tractor-trailer vehicles can easily fall into "jackknife phenomenon" when making large pose adjustments in narrow scenarios, which brings dilemma for trajectory planning. In this paper, a trajectory planning algorithm is proposed based on a general model of tractor-trailer vehicle, which combines global planning and local optimization. The method first generates a series of motion primitives, including forward and backward driving conditions, and then an A
^∗
based global state lattice planner is used to obtain a planning result, which is imported as the initial solution into the local trajectory optimizer based on PI
²
− CMA (Path Integral Policy Improvement with Covariance Matrix Adaptation) algorithm and dynamic potential method. Experiments show that this method significantly improves the performance in the obstacle avoidance, "jackknife phenomenon" avoidance and curvature compared to traditional motion primitive-based state lattice planning methods.