Nonlinear force feedback impedance control