nonlinear controller fixed