fixing nonlinear controller