Passive Hierarchical Impedance Control Via Energy Tanks
Impedance Control: An Approach to Manipulation