A passivity based Cartesian impedance controller for flexible joint robots - part I: torque feedback and gravity compensation
Impedance Control: An Approach to Manipulation