A passivity based Cartesian impedance controller for flexible joint robots - part I: torque feedback and gravity compensation | Synapse