Nonlinear Model Predictive ControlFast Algorithms and Implementation