Dynamic whole-body mobile manipulation with a torque controlled humanoid robot via impedance control laws
A passivity based Cartesian impedance controller for flexible joint robots - part I: torque feedback and gravity compensation