SMS: Constrained receding horizon predictive control for nonlinear systems