Nonlinear 2DOF Displacement Control