Fixed problem where nonlinear FES sometimes returned the negative solution.