A New Trajectory Tracking Algorithm for Autonomous Vehicles Based on Model Predictive Control