Operational Space Control of Constrained and Underactuated Systems
A unified approach for motion and force control of robot manipulators: The operational space formulation