a survey of robot interaction control schemes with experimental comparison .
A unified approach for motion and force control of robot manipulators: The operational space formulation