Improve path following performance