Trajectory Tracking of Autonomous Vehicle Using Clothoid Curve

This paper proposes a clothoid-curve-based trajectory tracking control method for autonomous vehicles to solve the problem of tracking errors caused by the discontinuous curvature of the control curve calculated by the pure pursuit tracking algorithm. Firstly, based on the Ackerman steering model, the motion model is constructed for vehicle trajectory tracking, Then, the position of the vehicle after the communication delay of the control system is predicted as the starting point of the clothoid control curve, and the optimization interval of the curve end point is determined. The clothoid control curves are calculated, and their parameters are verified by the vehicle motion and safety constraints, so as to obtain the optimal clothoid control curve satisfying the constraints. Finally, considering the servo system response delay time of the steering system, the steering angle target control value is obtained by previewing the curvature of the clothoid control curve. The field experiment is conducted on the test road, which consists of straight, right-angle turns and lane-change elements under three sets of speed limitations, and the test results show that the proposed clothoid-curve-based trajectory tracking control method greatly improved the tracking accuracy compared with the pure pursuit method; in particular, the yaw deviation is improved by more than 50%.