Extended model predictive control scheme for smooth path following of autonomous vehicles