Efficient Trajectory Planning for Tractor-Trailer Vehicles with an Incremental Optimization Solving Algorithm
A tractor-trailer vehicle (TTV) consists of an actuated tractor attached with several full trailers. Because of its nonlinear and noncompleted constraints, it is a challenging task to avoid collisions for path planner. In this paper, we propose an efficient method to plan an optimal trajectory for TTV to reach the destination without any collision. To deal with the complicated constraints, the trajectory planning problem is formulated as an optimal control problem uniformly, which can be solved by IPM. A novel incremental optimization solving algorithm (IOSA) is proposed to accelerate the optimization process, which makes the number of trailers and the size of obstacles increase asynchronously. Simulation experiments are carried out in two scenarios with static obstacles. Compared with other methods, the results show that the planning method with IOSA outperforms in the efficiency.